亲测卡尔曼滤波
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 [更多]
2022-02-15 13:24:19
7.42MB
卡尔曼滤波
1