原创力文档- 1、本文档共6页，可阅读全部内容。
- 2、原创力文档（book118）网站文档一经付费（服务费），不意味着购买了该文档的版权，仅供个人/单位学习、研究之用，不得用于商业用途，未经授权，严禁复制、发行、汇编、翻译或者网络传播等，侵权必究。
- 3、本站所有内容均由合作方或网友上传，本站不对文档的完整性、权威性及其观点立场正确性做任何保证或承诺！文档内容仅供研究参考，付费前请自行鉴别。如您付费，意味着您自己接受本站规则且自行承担风险，本站不退款、不进行额外附加服务；查看《如何避免下载的几个坑》。如果您已付费下载过本站文档，您可以点击 这里二次下载。
- 4、如文档侵犯商业秘密、侵犯著作权、侵犯人身权等，请点击“版权申诉”（推荐），也可以打举报电话：400-050-0827(电话支持时间：9:00-18:30)。
查看更多
在地面坐标中重力加速度方向为
在传感器坐标中原重力加速度方向为：
（方向可归一化）
归一化条件：(1)
在传感器坐标中加速度为：
（注意不能归一化，要有大小参考值）
在传感器中真实重力加速度方向为：
（方向可归一化）
归一化条件：(2)
的转轴为
（3）
修正量最小需满足的条件是
（4）
（5）
(6)
加速度向真实加速方向投影
(8)
所以得到
(9)
(10)
在新坐标中
()
在原来坐标中
(12)
(13)
这里并不能求解出。通过实验发现其中方向角是比较稳定的，因此这里可以不改变方向角。利用求出方向角，利用求出横滚角和俯仰角。通过三个角合成求出新的四元素。
(14)
文档评论（0）