煤矿自动驾驶磁寻迹定位技术

Research on magnetic tracking and positioning technology for automatic driving in coal mine

  • 摘要: 煤矿辅助运输车辆大多采用无线定位方式,动态定位精度为3 m以上,不能满足煤矿自动驾驶车辆定位精度的要求;车辆实时定位数据响应时间在400 ms以上,不能满足自动驾驶车辆对定位信息实时获取的要求。针对上述问题,提出了一种煤矿自动驾驶磁寻迹定位技术。在辅助运输自动驾驶车辆的合适位置安装磁感应天线装置,在车辆行驶路线上布置数个带有编号的无源感应磁钉,当感应天线经过无源感应磁钉时,无源感应磁钉受感应天线磁场的作用产生脉冲信号,该脉冲信号发生的位置在磁感应天线磁场范围内的具体位置可实时获取,磁感应天线将定位信息通过CAN总线通信接口转发给车辆控制系统,控制系统根据磁感应天线中心点与磁感应磁钉的相对位置,通过批通知树(BIT*)算法计算出车辆所在巷道位置和行驶路线中心的偏差位置,从而达到定位寻迹的目的。为验证该磁寻迹定位技术的有效性,在陕煤集团神木张家峁煤矿进行了工业性试验:在常规路段采用单排等间距布置磁钉;在井口、弯道和车辆行驶路线的终点前后处,根据不同的应用需求采用5排4磁钉和2排5磁钉相结合的方案布置无源感应磁钉,实现了自动驾驶车辆毫米级高精度、毫秒级低延时、有效的寻迹定位,使自动驾驶车辆按照最优路径准确行驶至终点。

     

    Abstract: Most auxiliary transportation vehicles in coal mine adopt wireless positioning method, and the dynamic positioning precision is more than 3 m. This method can not meet the requirements of automatic driving vehicles positioning precision in coal mine. The response time of real-time vehicle positioning data is more than 400 ms, which cannot meet the requirements of automatic driving vehicles for real-time acquisition of positioning information. In order to solve the above problems, a magnetic tracking and positioning technology for automatic driving in coal mine is proposed. The magnetic induction antenna device is arranged at a suitable position of the automatic driving vehicle for auxiliary transportation. Several numbered passive induction magnetic nails are arranged on the vehicle driving route. When the induction antenna passes through the passive induction magnetic nails, the passive induction magnetic nails generate pulse signals under the action of the magnetic field of the induction antenna. The specific position of the pulse signal generation position within the magnetic field range of the magnetic induction antenna can be obtained in real time. The positioning information is forwarded by the magnetic induction antenna to vehicle control system through the CAN bus communication interface. According to the relative position of the center point of the magnetic induction antenna and the passive induction magnetic nail, the control system calculates the deviation position between the position of the vehicle's roadway and the center of the driving route through the batch informed tree (BIT*) algorithm. Therefore, the purpose of positioning and tracking is achieved. In order to verify the effectiveness of the magnetic tracking and positioning technology, an industrial test is carried out in Shenmu Zhangjiamao Coal Mine of Shaanxi Coal Group. Magnetic nails are arranged in a single row with equal spacing in conventional sections. According to different application requirements, the combination of 5 rows of 4 magnetic nails and 2 rows of 5 magnetic nails is used to arrange passive induction magnetic nails in mine well,roadway turn and before and after destination of vehicles route. This method realizes the millimeter-level high precision, millisecond-level low latency, and effective tracking and positioning of the automatic driving vehicle. And it enables the automatic driving vehicle to accurately drive to the destination according to the optimal path.

     

/

返回文章
返回