拿在手中晃动,看上位机姿态+波形,基本就能看出来。实际也能很好飞行。
低动态下的角度,拿在手中直接看波形。真正角度是否能飞行,还得飞起来才知道。
你把Kp调小一点,降低加速度对融合角度的影响。把halfT和Ki按照你的姿态结算周期带进去,halfT不是姿态解算周期的一半,肯定姿态是不正确的。
四轴在一个平面平移的时候,会在移动方向产生加速度,这样的加速度融合到角度里,就会带来误差。实际飞行的时候,运动速度较低时,加速度产生的影响较小;运动加速度较大时,这时候一般是你在打摇杆了,这时候使用融合后的角度叠加了摇杆控制量进行控制。对于你的姿态问题,先把积分时间halfT纠正了再说吧。