改用卡尔曼滤波.除了角速度收敛有点慢以外,角度几乎完美
1
1
将控制的程序移到control.c,更新了卡尔曼滤波,除了角速度收敛有点慢以外,其他完美,