[发明专利]一种井下三维精确定位系统

说明书

本发明提供了一种井下三维精确定位系统，所述系统包括数字孪生地图、定位服务器、监控终端、通信网络、定位分站、定位装置。系统利用定位分站在矿井二维空间分布的方法，运用现有无线电波测距的技术，实现了移动目标二维初步定位，并充分利用传感器数据，实现了移动目标实时方向监测，进而实现井下移动目标的二维和三维精确定位。系统具有简单有效、建设成本低且定位精度高等特点，可适应煤炭生产少人化、无人化发展方向，满足无人化设备的全局二维和三维定位，具有着广泛地应用前景。

技术领域

本发明涉及一种井下三维精确定位系统，该方法涉及无线通信、地理信息系统、传感器技术、数据处理等领域。

背景技术

目前煤炭生产朝着少人化、无人化方向发展，井下采掘设备、运输设备、移动监测设备等各类生产相关设备的数量将不断增加，并且将逐步实现这些设备的无人化，矿井定位系统除需满足矿井人员定位要求外，还需满足无人化设备的全局二维和三维定位需求。早期的矿井人员定位多采用RFID卡识别和无线电信号定位技术。RFID卡识别利用射频方式进行非接触双向通信，射频卡和读卡器之间不用接触就可实现对移动目标的识别和位置监测。基于RFID卡识别定位属于区域定位技术，只能识别井下移动目标是否经过某个区域，无法对区域内的移动目标进行精确定位。国内外进行了无线电波、超声波、红外、激光等矿井定位技术研究。矿井无线电信号传输衰减严重、无线电传输衰减模型复杂多变、卫星定位信号无法穿透煤层和岩层到达井下、矿井定位需覆盖长达10km的巷道等制约着地面定位技术在矿井应用。超声波、红外、激光等定位技术难以目标身份识别和全矿井定位。此外，目前现有用于井下定位的系统均为沿巷道轴向的一维定位系统，无法实现二维和三维定位；此外，现有RFID、RSSI、飞行时间TOA、飞行时间差TDOA等定位方法在静止条件下，无法对目标的方向向进行定位。

因此，需要一种适合煤矿空间环境的、简单有效、建设成本低且定位精度高的矿井全局二维和三维精确定位系统。

发明内容

本发明提供了一种井下三维精确定位系统，可适应煤炭生产少人化、无人化发展方向，满足无人化设备的全局二维和三维定位需求。所述系统包括数字孪生地图、定位服务器、监控终端、通信网络、定位分站、定位装置；所述定位装置包括至少一个无线定位模块、至少一个测距传感器、至少一个磁力传感器、至少一个陀螺仪传感器、至少一个三轴加速度传感器；所述无线定位模块通过与定位分站进行无线电波通信进行测距；所述测距传感器通过发射和接收测距信号测量定位装置与巷道壁、巷道顶板或巷道底板的距离；所述磁力传感器用于测量定位装置的方向；所述陀螺仪传感器和三轴加速度传感器用于测量定位装置的方向、移动速度和姿态数据；所述系统通过无线定位模块的测距数据获得定位装置沿巷道轴向的一维位置数据，或水平平面的轴向和径向二维位置数据，通过磁力传感器或陀螺仪传感器获得定位装置的方向数据，再参考测距传感器测距数据获得定位装置的三维位置数据；系统通过无线定位模块与定位分站进行无线通信，定位分站通过通信网络与定位服务器和数字孪生地图进行通信；所述系统定位过程为：

(1)定位装置与相邻的两个定位分站A和B进行测距通信，获得定位装置与A和B的直线距离d_A和d_B；

(2)系统依据以上步骤获得的d_A和d_B，和所述定位分站A、B的水平平面坐标(x_A,y_A)、(x_B,y_B)，计算获得坐标(x_m,y_m)，具体算法为

(3)定位装置通过测距传感器测量与巷道顶板或巷道底板的距离d_H，及与巷道壁的距离d_L；

(4)获取定位装置方向；

(5)根据定位装置方向，判定d_L为定位装置与哪一侧巷道壁的距离；