发明名称 一种基于同步测量与定位计算的里程计标定方法
摘要 一种基于同步测量与定位计算的里程计标定方法,它有七大步骤:一、将惯组、激光测速仪和里程计安装到载体上,系统上电启动;二、装订初始参数至导航计算机;三、采集和处理陀螺和加速度计的输出数据;并完成系统的粗对准和精对准;四、导航系统由对准模式切换到航位推算模式,同时分别进行惯导/激光测速仪航位推算与惯导/里程计航位推算;五、分别采集惯导/激光测速仪航位推算输出经纬度值与惯导/里程计航位推算输出经纬度值;六、将采集的经纬度值转换成高斯坐标系下坐标值;七、将惯导/里程计航位推算得到的位置值与惯导/激光测速仪航位推算得到的位置值进行比较,利用轨迹相似原理对里程计的航向安装角及标度因数进行标定。
申请公布号 CN104180821A 申请公布日期 2014.12.03
申请号 CN201410430904.8 申请日期 2014.08.27
申请人 北京航空航天大学 发明人 张小跃;宋凝芳;易晓静;牛燕雄;刘鹏博;时海涛
分类号 G01C25/00(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 北京慧泉知识产权代理有限公司 11232 代理人 王顺荣;唐爱华
主权项 一种基于同步测量与定位计算的里程计标定方法,其特征在于:该方法具体步骤如下:步骤1、将惯组、激光测速仪和里程计安装到载体上,系统上电启动;步骤2、装订初始参数,包括初始的经度、纬度、高度、激光测速仪的标度、激光测速仪的安装角、里程计标度初值至导航计算机;步骤3、采集陀螺和加速度计的输出数据,对采集到的陀螺和加速度计数据进行处理,根据捷联惯导系统误差传播特性和古典控制理论,采用二阶调平和方位估算法来完成系统的粗对准,初步确定载体姿态角;粗对准时间为2分钟,粗对准后利用卡尔曼滤波技术精对准3分钟;步骤4、导航系统由对准模式切换到航位推算模式,同时分别进行惯导/激光测速仪航位推算与惯导/里程计航位推算,切换完成后载体开始运动,运动过程中保持航位推算模式;步骤5、分别采集惯导/激光测速仪航位推算输出经纬度值与惯导/里程计航位推算输出经纬度值;步骤6、将采集的经纬度值转换成高斯坐标系下坐标值;步骤7、将惯导/里程计航位推算得到的位置值与惯导/激光测速仪航位推算得到的位置值进行比较,利用轨迹相似原理对里程计的航向安装角及标度因数进行标定。
地址 100191 北京市海淀区学院路37号
您可能感兴趣的专利