【文件属性】：
文件名称：卡尔曼滤波（我亲测可以用）
文件大小：7.42MB
文件格式：ZIP
更新时间：2018-03-09 14:21:56
卡尔曼滤波
亲测卡尔曼滤波
void Angle Calcu void
{
aax GetData ACCEL XOUT H ;
aax aax 16 384;
if aax>1500
{
aax 1998 aax 2;
}
else
aax aax;
gy GetData GYRO YOUT H ;
gy gy 102;
ggy gy;
if ggy>30000
{
ggy ggy 65536;
}
else
ggy ggy 1 8;
ggy ggy 16 4;
kalmanCalculate x aax ggy 0 003 ;
}">亲测卡尔曼滤波
void Angle Calcu void
{
aax GetData ACCEL XOUT H ;
aax aax 16 384;
if aax>1500
{
aax 1998 aax 2;
}
else
aax aax;
gy GetData GYRO YOUT H ;
gy gy 102;
ggy gy;
if ggy>30000 [更多]
网友评论
- 一个字注释读没有，真是垃圾
- 卡尔曼滤波