#include <stdio.h>
float Q_angle=0.001;//过程噪声的协方差
float Q_gyro=0.003;//0.003 过程噪声的协方差 过程噪声的协方差为一个一行两列矩阵
float R_angle=0.5;// 测量噪声的协方差 既测量偏差
float dt=0.005;//注意：dt的取值为kalman滤波器采样时间;
float P[2][2] = {{ 1, 0 },{ 0, 1 }};
float Angle,Angle_dot;
float Pdot[4] ={0,0,0,0};
const char C_0 = 1;
float Q_bias, Angle_err, PCt_0, PCt_1, E, K_0, K_1, t_0, t_1;
......................
阅读全部
|
Mr_Rain
贴于 2022年5月1日 19:12
hide
bbsi
#include <stdio.h>
/************************************/
//增量式PID
/*************************************/
//初始化变量
struct _PID{
float SetSpeed; //设定值
float ActualSpeed; //检测值
float Err; //当前误差
float Err_last; //上一次误差
float Err_llast; //上上次的误差
......................
阅读全部
|
Mr_Rain
贴于 2022年4月29日 19:37
hide
bbsi
#include <stdio.h>
/************************************/
//位置式PID
/*************************************/
//初始化变量
struct _PID{
float SetSpeed; //设定值
float ActualSpeed; //检测值
float Err; //当前误差
float Err_last; //上一次误差
float KP,KI,KD; //PID参数
......................
阅读全部
|
Mr_Rain
贴于 2022年4月29日 18:57
hide
bbsi
#include <stdio.h>
int main() {
printf("我在编程中国学C语言\n\n");
// 练习一下循环的使用
int i;
for (i=1; i<=20; i++) {
printf("我爱编程中国 %d 次\n", i);
}
printf("\n\n绘制一个心形图案：");
......................
阅读全部
|
曾大仙
贴于 2022年4月28日 15:45
hide
bbsi
#include <iostream>
using namespace std;
int main()
{
return 0;
}
阅读全部
|
YH_21_LIU
贴于 2022年4月26日 18:14
hide
bbsi
#include <stdio.h>
#include <iostream>
#include <math.h>
float f(float x, float y, float z) {
float a = x * x + 9.0f / 4.0f * y * y + z * z - 1;
return a * a * a - x * x * z * z * z - 9.0f / 80.0f * y * y * z * z * z;
}
float h(float x, float z) {
for (float y = 1.0f; y >= 0.0f; y -= 0.001f)
if (f(x, y, z) <= 0.0f) {
......................
阅读全部
|
YH_21_LIU
贴于 2022年4月26日 18:02
hide
bbsi
num=int(input("请输入一个整数:"))
if num%2==0:
print("even\n"*8)
else:
print("odd\n"*8)
阅读全部
|
小呆阳
贴于 2022年4月25日 17:31
hide
bbsi
#include <stdio.h>
#include <assert.h>
#include <string.h>
//memcpy制作
void* my_memcpy(void* dest, const void* src, size_t num)
{
assert(dest && src);
char* tmp = dest;
while (num--)
{
*(char*)tmp = *(char*)src;
tmp = (char*)tmp+1;
......................
|
nn154189906
贴于 2022年4月25日 16:20
hide
bbsi
#include <stdio.h>
int main()
{
int i,m=0;
for (i = 100; i <= 200; i++)
{
if (i % 3 == 0) continue;
printf("%d,", i);
m=m+1;
if(m%10==0)
printf("\n");
}
......................
阅读全部
|
jinping
贴于 2022年4月21日 16:49
hide
bbsi