一种采煤机多惯导定位装置及方法

摘要

本发明公开了一种采煤机多惯导定位装置及方法，属于采煤机惯性定位技术领域。以两个惯导为例，在采煤机前端和后端分别固定防爆外壳，其中前端防爆外壳内安装主惯导和解算系统，后端防爆外壳内安装从惯导和解算系统，轴编码器安装在采煤机行走部。解算系统采集惯导姿态角和轴编码器速度数据，采用航位推算法解算主惯导和从惯导的位置坐标并传输到扩展卡尔曼滤波器。滤波器输出为主惯导和从惯导北东天的位置坐标，将主惯导北东天的位置坐标传输到数据采集显示系统作为采煤机的定位结果。扩展卡尔曼滤波器是根据两个惯导安装后相对距离为固定值的约束条件建立的。该方法用低成本的从惯导校准中等成本的主惯导，达到高精度定位。