基于捷联惯导和里程计的组合导航矿井定位方法和装置
实质审查的生效
摘要
本发明提供基于捷联惯导和里程计的组合导航矿井定位方法,包括获取由捷联惯导系统采集的角速率增量和加速度增量;对角速率增量进行圆锥误差补偿,对加速度增量进行划船误差补偿;构建机身坐标系与地理坐标系的转换矩阵,提取出井下载体在地理坐标系的姿态,并通过姿态矩阵转换获取井下载体在地理坐标系的位置信息;获取里程计采集的里程增量,通过姿态矩阵转换获取里程计在地理坐标系的位置信息;对捷联系统位置信息与里程计位置信息建立量测方程,构建卡尔曼滤波方程来校正捷联惯导系统的位置信息,得到最优的捷联惯导系统的位置信息。本发明还提供了基于捷联惯导和里程计的组合导航矿井定位装置。
基本信息
专利标题 :
基于捷联惯导和里程计的组合导航矿井定位方法和装置
专利标题(英):
暂无
公开(公告)号 :
CN114383609A
申请号 :
CN202111582177.3
公开(公告)日 :
2022-04-22
申请日 :
2021-12-22
授权号 :
暂无
授权日 :
暂无
发明人 :
李小燕田原陈宁张婷索艳春董孟阳李涛郭皇煌贾曲
申请人 :
中国煤炭科工集团太原研究院有限公司;山西天地煤机装备有限公司
申请人地址 :
山西省太原市山西示范区科技创新城科荟路1号
代理机构 :
北京清亦华知识产权代理事务所(普通合伙)
代理人 :
孙诗惠
优先权 :
CN202111582177.3
主分类号 :
G01C21/16
IPC分类号 :
G01C21/16
IPC结构图谱
G
G部——物理
G01
测量;测试
G01C
测量距离、水准或者方位;勘测;导航;陀螺仪;摄影测量学或视频测量学
G01C21/00
导航;不包含在G01C1/001至G01C19/00组中的导航仪器
G01C21/10
通过速度或加速度的测量
G01C21/12
在被导航的物体上进行测量;根据测量推算航位
G01C21/16
采用积分加速度或速度的方法,即惯性导航
法律状态
2022-05-10 :
实质审查的生效
IPC(主分类) : G01C 21/16
申请日 : 20211222
申请日 : 20211222
2022-04-22 :
公开
注:本法律状态信息仅供参考,即时准确的法律状态信息须到国家知识产权局办理专利登记簿副本。
文件下载
暂无PDF文件可下载