-
我亲自测试并证实了卡尔曼滤波的可用性
资源介绍
亲测卡尔曼滤波
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 [更多]
- 上一篇: 平衡小车源码（互补滤波版）
- 下一篇: 基于STM32的Kalman惯导调方法，实现定位功能