掘进机全站仪与捷联惯导组合定位方法 论文

针对基于全站仪的掘进机定位方法因井下粉尘过大等导致光路被遮挡而无法进行定位、基于捷联惯导的掘进机定位方法累计误差随时间推移逐渐增大的问题，提出一种掘进机全站仪与捷联惯导组合定位方法。首先，采用全站仪测量掘进机位置参数，采用捷联惯导测量掘进机位姿参数并进行解算；然后，将捷联惯导测量的掘进机所在位置经纬度转换为西安80坐标系下的坐标值，实现与全站仪测量坐标系的统一；最后，采用卡尔曼滤波方法将全站仪与捷联惯导测量数据进行融合，获取掘进机位姿数据。试验结果表明该方法具有较高的定位精度：x方向的定位误差最大值为0.0291 m，最小值为0.0100 m，平均值为0.01993 m；y方向的定位误差最大值为0.0295 m，最小值为0.0110 m，平均值为0.01826 m。