综采工作面巡检机器人自主定位方法  

Autonomous positioning method for inspection robots in fully mechanized working face

作　　者：黄西平 杨飞[1] HUANG Xiping;YANG Fei(School of Electrical Engineering and Automation,Wuhan University,Wuhan 430072,China)

机构地区：[1]武汉大学电气与自动化学院,湖北武汉430072

出　　处：《工矿自动化》2023年第4期86-91,共6页Journal Of Mine Automation

摘　　要：目前综采工作面巡检机器人中应用较广泛的是轨道式机器人,机器人经过轨道连接件时会产生抖动,造成惯性导航/里程计组合定位误差增大。针对该问题,在惯性导航/里程计组合导航算法的基础上,采用基于抖动检测的分段滤波方法,实现巡检机器人的自主定位。根据巡检机器人经过轨道连接件时的陀螺仪数据,采用滑动窗口方法对机器人俯仰角速度进行动态分析,通过求导数和判断局部最大上升沿和局部最大下降沿,当最大上升沿与最大下降沿交替出现时,即认为识别到轨道连接件,实现抖动检测,从而将机器人运动状态分为平稳运行状态和抖动状态。当机器人处于平稳运行状态时,陀螺仪和里程计数据均较平稳,此时用惯性导航/里程计组合导航方式进行滤波解算,同时根据陀螺仪数据应该稳定在零值附近的特性来矫正陀螺仪误差;当机器人处于抖动状态时,里程计可能会由于车轮打滑、弹起悬空而产生误差,此时采用纯惯性导航算法消除里程计误差对组合导航定位的影响。实验结果表明,抖动检测算法可准确判断轨道连接件,基于抖动检测的分段滤波方法能有效提升巡检机器人定位精度,平均定位误差小于5 mm,满足综采工作面精确定位要求。At present,the track type robot is widely used in the inspection robot of the fully mechanized working face.When the robot passes through the track connection,it will produce jitter.It causes an increase in the positioning error of the inertial navigation/odometer combination.In order to solve this problem,based on the integrated navigation algorithm of inertial navigation/odometer,a piecewise filtering method based on jitter detection is adopted to achieve autonomous positioning of the inspection robot.Based on the gyroscope data of the inspection robot passing through the track connector,a sliding window method is used to dynamically analyze the pitch angular velocity of the robot.The local maximum rising edge and local maximum falling edge are determined by calculating the derivative sum.When the maximum rising edge and maximum falling edge alternately appear,it is considered that the track connector has been recognized.The jitter detection is achieved,thus dividing the robot's motion state into stable operation state and jitter state.When the robot is in a stable operation state,both the gyroscope and odometer data are relatively stable.At this time,the inertial navigation/odometer combination navigation method is used for filtering and solving.The gyroscope error is corrected based on the characteristic that the gyroscope data should be stable near zero.When the robot is in a jitter state,the odometer may generate errors due to wheel slip and bouncing in the air.At this time,a pure inertial navigation algorithm is used to eliminate the impact of odometer errors on the integrated navigation positioning.The experimental results show that the jitter detection algorithm can accurately determine the track connections.The segmented filtering method based on jitter detection can effectively improve the positioning precision of the inspection robot. The average positioning error is less than 5 mm, meeting the precise positioning requirements of the fully mechanized working face.

关 键 词：巡检机器人 轨道式机器人 自主定位 抖动检测 分段滤波 惯性导航 里程计 

分 类 号：TD67[矿业工程—矿山机电]