[发明专利]陀螺仪辅助定位方法无效
申请号: | 201310607804.3 | 申请日: | 2013-11-27 |
公开(公告)号: | CN103644911A | 公开(公告)日: | 2014-03-19 |
发明(设计)人: | 闫智勇;李建平 | 申请(专利权)人: | 南京城际在线信息技术有限公司 |
主分类号: | G01C21/16 | 分类号: | G01C21/16 |
代理公司: | 北京市京大律师事务所 11321 | 代理人: | 方晓明 |
地址: | 210006 江苏省南京*** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明公开了一种陀螺仪辅助定位方法,包括以下步骤:首先、姿态角的测量:对加速度计的测量值和磁传感器的测量值分别经过高斯牛顿迭代得到姿态误差速率,陀螺仪直接通过四元数微分方程得到姿态四元数速率,两个加起来积分得到姿态四元数;其次、初始点的获取:利用加速度计和陀螺仪芯片两者的数据,进行轨迹推算,以将轨迹周期提高到惯性测量单元的数据周期;第三、速度和移动距离的计算;第四、计算位置点;第五:纠正位置。本发明针对性的解决了陀螺仪的漂移、载体的线性加速度和周围局部磁场的干扰问题,根据道路数据,对定位结果进行投影修正,并利用修正结果计算下一个位置点,这样就有效地减小累计误差。 | ||
搜索关键词: | 陀螺仪 辅助 定位 方法 | ||
【主权项】:
一种陀螺仪辅助定位方法,其特征在于包括以下步骤:首先、姿态角的测量:对加速度计的测量值和磁传感器的测量值分别经过高斯牛顿迭代得到姿态误差速率,陀螺仪直接通过四元数微分方程得到姿态四元数速率,两个加起来积分得到姿态四元数;其次、初始点的获取:利用加速度计和陀螺仪芯片两者的数据,进行轨迹推算,以将轨迹周期提高到惯性测量单元的数据周期;第三、速度和移动距离的计算:根据修正过的欧拉角,计算三轴的加速度的分量,从而计算出实际的加速度;在已知初速度,加速度和时间的情况下,通过对初速度积分和加速度二次积分,计算出移动距离;第四、计算位置点: 根据移动距离和方向计算当前的位置点的经纬度;第五:纠正位置: 根据计算的位置点,在道路上进行投影,进行平滑处理,得到纠正后的位置点。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于南京城际在线信息技术有限公司,未经南京城际在线信息技术有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201310607804.3/,转载请声明来源钻瓜专利网。
- 上一篇:混凝土养生后表面强度测试装置及其试验方法
- 下一篇:复合片耐磨测试装置