根据旋转矩阵计算智能手机航向

问题描述

要开发室内定位应用程序,我需要从IMU传感器计算出的旋转矩阵(Rzxy)中计算航向。但是,当航向达到180度极限时,在轨迹的末端(在图像上显示)存在镜像问题。是单数问题还是可以通过arctan2操作解决?任何解决方案都值得欢迎。 我当前的代码和结果:

heading = np.arctan2(R[0,1],R[1,1])

the PDR based calculated trajectory

sign of arctan2 inputs

解决方法

暂无找到可以解决该程序问题的有效方法,小编努力寻找整理中!

如果你已经找到好的解决方法,欢迎将解决方案带上本链接一起发送给小编。

小编邮箱:dio#foxmail.com (将#修改为@)