看了楼主的程序,自己亲测是可以用而且很准,但是楼主测的是X轴的倾角,我现在想测Y轴的倾角,修改程序如下, 发现 角度不灵敏,滞后至少一秒 ,楼主能帮忙解决下么?
void getangle()
{
accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);//读取原始6个数据
angleAy=atan2(ay,az)*180/PI;//计算与x轴夹角 AX全部变成Ay GY全部变成Gx
gyroGx=-gy/131.00;//计算角速度
Yijielvbo(angleAy,gyroGx);//一阶滤波
Erjielvbo(angleAy,gyroGx);//二阶滤波
Kalman_Filter(angleAy,gyroGx); //卡尔曼滤波
} |