495203317_bob 发表于 2016-4-12 14:33:26

四轴航向角校正的困惑

最近在学磁力计对航向角的校正,罗盘校正成什么效果算ok?是roll, pitch和yaw三个角度各自独立吗?我用的是匿名的上位机,但是我在改变roll角度时,yaw会有明显变化,正常吗?
我用的公式如下:
Yr = mag_x*sin(roll) - mag_y*cos(roll),
Xr = mag_x*cos(pitch) + mag_y*sin(pitch)*cos(roll) + mag_z*sin(pitch)*cos(roll)
yaw = arctan(Yr/Xr)
页: [1]
查看完整版本: 四轴航向角校正的困惑