Research on positioning method of underground robot based on strapdown inertial navigation and odometer
-
摘要: 针对现有煤矿井下移动机器人定位方法存在定位难、精度低的问题,提出了一种基于捷联惯导和里程计的井下机器人定位方法。该方法利用卡尔曼滤波对捷联惯导进行初始对准,以此确定定位的初始坐标,得到初始姿态转换矩阵;利用捷联惯导独立完成机器人位置解算,同时利用里程计输出的速度信息与捷联惯导输出的实时姿态转换矩阵进行航位推算解算,再次得到机器人的位置信息;为了减少累积误差对捷联惯导的影响,使用里程计和捷联惯导构成航位推算系统,采用Sage-Husa自适应滤波设计组合定位算法,选择误差作为系统状态,经过滤波计算和校正,可获得机器人的精确位置信息。实验结果表明,该方法可实现机器人实时定位,有效减少捷联惯导累积误差的影响;定位精度较高,机器人在Y向运动4.3 m,Z向运动0.25 m后,Y向定位误差为0.25 m,Z向定位误差为0.005 m。Abstract: In order to solve problems of difficult positioning and low precision in positioning method of underground mobile robots, a positioning method of underground robot based on strapdown inertial navigation and odometer was proposed. The method uses Kalman filter to perform initial alignment for strapdown inertial navigation to determine initial coordinates of the positioning, and obtain initial attitude transformation matrix. Then, it uses strapdown inertial navigation to calculate position of the robot independently, and uses the speed information output by the odometer and the real-time attitude transformation matrix output by strapdown inertial navigation to calculate the dead reckoning, so as to obtain the position information of the robot again. In order to reduce influence of the accumulated error on the strapdown inertial navigation, it adopts odometer and strapdown inertial navigation to construct dead reckoning system, and uses Sage-Husa adaptive filtering to design combined positioning algorithm to select errors as the system state. After filtering calculation and correction, the accurate position information of the robot is obtained. The experimental results show that the method can realize real-time positioning of the robot and can effectively reduce influence of the accumulated errors of strapdown inertial navigation. And the method has higher positioning accuracy. After the robot moves 4.3 m in Y direction and 0.25 m in Z direction, the positioning error in Y direction is 0.25 m and the positioning error in Z direction is 0.005 m.
点击查看大图
计量
- 文章访问数: 57
- HTML全文浏览量: 6
- PDF下载量: 14
- 被引次数: 0