一种单轨吊机车高精度定位与位置校准系统的制作方法
本发明涉及矿山智能化运输,具体涉及一种单轨吊机车高精度定位与位置校准系统。
背景技术:
1、单轨吊机车是煤矿井下辅助运输的重要设备,广泛应用于人员、物料和设备的运输。随着煤矿智能化建设的推进,单轨吊机车的无人驾驶和智能调度对机车定位精度提出了越来越高的要求。
2、目前矿山领域现有的人员定位网络虽然可以尝试用于单轨吊机车定位场景,但存在以下突出问题:
3、(1)网络线路部署困难:传统定位系统必须使用网络通讯线路(如rs485、光纤、lora)连接各个定位基站,井下作业空间有限,布线施工需要配合矿井生产计划,施工窗口有限,部署周期长、成本高。
4、(2)扩展灵活性差:一旦网络建成,新增基站意味着重新布线或增加中继设备,实施困难,无法根据生产布局变化灵活调整定位基站位置。
5、(3)故障容错率低:传统定位系统采用链式或总线式网络结构,单一基站发生故障可能导致下游节点全部瘫痪,故障排除需要结合网络排查,存在线缆故障影响,不易快速定位问题。
6、(4)维护成本高:复杂的网络线路对维护人员技术要求较高,线缆存在损坏风险,维护工作对生产有影响,后期维护成本巨大。
7、(5)定位精度不足:传统定位方式多采用rssi信号强度测距或简单的tof测距,受井下多径效应和非视距传播影响较大,定位精度通常在米级,无法满足单轨吊机车精确定点停车和防撞预警的厘米级精度要求。
8、(6)缺乏位置校准机制:单轨吊机车通常配备编码器进行里程计定位,但长时间运行会产生累计误差,现有系统缺乏有效的外部基准校准手段,导致定位误差随运行距离增大而累积。
9、近年来,uwb(超宽带)技术凭借其纳秒级脉冲信号和高时间分辨率,在室内定位领域取得了厘米级的定位精度。ds-twr(双边双向测距)算法是uwb定位中常用的测距方法,但传统ds-twr算法通常采用三次握手,且需要定位基站之间保持时间同步或网络连接,不适合井下无专网支持的部署场景。因此,亟需一种部署简单、成本低廉、定位精度高且具备位置校准能力的单轨吊机车定位系统。
技术实现思路
1、本发明的目的在于针对现有技术的不足,提供一种单轨吊机车高精度定位与位置校准系统,解决传统定位系统部署困难、成本高、扩展不灵活、定位精度不足和缺乏位置校准的问题,实现单轨吊机车的厘米级高精度定位、编码器累计误差校准、精确定点停车和同轨机车防撞。
2、为实现上述目的,本发明提供如下技术方案:一种单轨吊机车高精度定位与位置校准系统,包括机车基站、若干定位基站和上位机;
3、所述机车基站部署在单轨吊机车的头部或尾部,通过rj45接口接入单轨吊机车现有的wi-fi6网络,经机车现有网络与上位机或调度中心通信;
4、所述定位基站部署于单轨吊机车轨道附近或轨道上,各定位基站之间无需相互通讯、无需连接网络,仅需供电;定位基站的定向天线与机车基站的定向天线相对安装,使机车运行过程中机车基站与定位基站始终处于视距范围内;
5、机车基站与定位基站之间基于uwb技术通过四次握手消息交互获取时间戳,根据改进的ds-twr双边双向测距算法计算机车基站与定位基站之间的距离;
6、机车基站将距离信息经机车现有网络上传至上位机,上位机采用tdoa算法确定单轨吊机车的位置坐标并在矢量图上显示;
7、所述系统还包括校准基站,所述校准基站由定位基站改装而成并增设被动触发模块,单轨吊机车上安装有主动触发臂,当主动触发臂触发被动触发模块时,校准基站向机车基站发送设备编号,上位机根据预分配的绝对物理位置对机车编码器累计误差进行校准。
8、优选的,所述机车基站与定位基站之间的四次握手消息交互包括:
9、第一次握手:机车基站广播poll消息并记录发送时间戳t1;
10、第二次握手:定位基站接收poll消息并记录接收时间戳t2,延时后返回resp消息并记录发送时间戳t3;
11、第三次握手:机车基站接收resp消息并记录接收时间戳t4,延时后发送final消息并记录发送时间戳t5;
12、第四次握手:定位基站接收final消息并记录接收时间戳t6,返回last消息,last消息中携带定位基站端记录的时间戳t2、t3、t6;
13、机车基站收到last消息后,按以下公式计算飞行时间和距离;
14、优选的,所述改进的ds-twr双边双向测距算法的距离计算公式为:
15、tof_dtu=[((t4t1)×(t6t3))((t5t4)×(t3t2))]/(t6+t5t1t2)
16、tof=tof_dtu×(1/499.2e6/128)
17、distance=tof×c
18、其中,t1为机车基站发送poll消息的时间戳,t2为定位基站接收poll消息的时间戳,t3为定位基站发送resp消息的时间戳,t4为机车基站接收resp消息的时间戳,t5为机车基站发送final消息的时间戳,t6为定位基站接收final消息的时间戳,1/499.2e6/128为时间常量约等于15.65ps,c为光速299702547m/s,distance单位为厘米。
19、优选的,所述系统支持线性定位、平面定位和空间定位三种模式:
20、线性定位模式下,机车基站仅与运行过程中遇到的单个定位基站进行四次握手测距,根据距离和轨道拓扑确定机车在轨道上的线性位置;
21、平面定位模式下,机车基站需同时与至少三个定位基站完成四次握手测距,将三个距离信息上传至上位机,上位机采用tdoa算法计算机车平面坐标;
22、空间定位模式下,机车基站需同时与至少四个定位基站完成四次握手测距,将四个距离信息上传至上位机,上位机采用tdoa算法计算机车空间坐标;
23、平面定位和空间定位中,各定位基站接收到poll消息后按各自预设的不同延迟时间分时发送resp消息,机车基站循环接收各定位基站的resp消息和last消息,直至收集到所需数量的定位基站数据或超时退出。
24、优选的,所述校准基站的被动触发模块为机械触发开关或红外感应触发模块,所述主动触发臂安装在单轨吊机车的侧面或顶部,其伸出长度和角度根据校准基站的安装位置调整;每个校准基站的设备编号在上位机中预分配有唯一的绝对物理位置坐标,当机车经过校准基站且主动触发臂触发被动触发模块时,机车基站接收该校准基站的设备编号并上传至上位机,上位机将该绝对物理位置作为机车当前位置的基准值,对机车编码器累计产生的位置误差进行清零或修正校准。
25、优选的,在单轨吊机车需要定点停车的特定区域内,沿轨道方向部署多组间距相等的校准基站,相邻校准基站之间的间距为预设固定值d;机车依次触发各校准基站时,上位机根据相邻两次触发的时间间隔δt和间距d计算机车的实际行驶速度v=d/δt,结合机车制动距离模型和定点停车目标位置,向机车控制系统发送减速和制动指令,实现精确定点停车;每组校准基站的绝对物理位置用于实时校准机车位置,消除编码器累计误差对定点停车精度的影响。
26、优选的,在单轨吊机车的尾部或头部部署一个防撞基站,所述防撞基站由定位基站构成;
27、当同轨前后两辆机车行驶至较近距离时,前车的机车基站与轨道上的定位基站测距,后车的机车基站与前车的防撞基站测距,机车基站优先处理防撞基站的距离信息;
28、上位机根据前车与定位基站的距离、机车自身长度和后车与防撞基站的距离推算后车的实际位置,实现同轨机车级联定位;当两车间距小于安全阈值时,系统发出防撞预警信号并触发紧急制动。
29、优选的,所述定位基站包括有源定位基站和无源定位基站两种:
30、有源定位基站通过交流电接入供电,适用于轨道附近有电源接入条件的区域;无源定位基站依靠自身内置电池供电,适用于无电源接入条件的区域,电池续航时间不低于6个月;
31、定位基站的安装采用支架固定方式,可根据生产布局变化随时调整安装位置,无需配合矿井生产计划进行大规模施工。
32、优选的,所述上位机采用tdoa算法计算机车位置坐标的具体过程为:
33、上位机接收机车基站上传的多个定位基站距离信息,以各定位基站的已知坐标为球心、对应测距值为半径构建多个球面方程,通过最小二乘法求解机车基站的三维坐标;
34、对于线性定位场景,上位机根据轨道拓扑数据将测距结果映射到轨道中心线的里程坐标上;
35、上位机将机车实时位置叠加显示在巷道矢量地图上,支持位置历史轨迹回放、超速报警和越界报警功能。
36、优选的,所述系统具有单点故障容错机制:
37、各定位基站独立工作,单个定位基站发生故障时不影响其他定位基站的正常运行,系统自动跳过故障基站并使用其余正常基站的数据进行定位计算;
38、当机车基站与定位基站的四次握手中任意一次消息交互失败时,机车基站重新发起测距流程,连续三次测距失败则标记该定位基站为故障状态并上报上位机;
39、故障定位基站的更换无需排查网络线路,仅需检查供电并更换设备,普通电工即可完成维护操作。
40、与现有技术相比,本发明具有以下有益效果:
41、1、部署简单、成本低廉:采用逆向基站部署方式,定位基站仅需供电无需网络,避免了井下专网布线施工,部署成本降低60%以上,可在生产间隙快速部署。
42、2、扩展灵活:定位基站独立工作,可根据生产布局变化随时增减和调整位置,无需配合生产计划进行大规模工程改造。
43、3、定位精度高:基于uwb技术和改进的ds-twr四次握手测距算法,定位精度可达厘米级,满足单轨吊机车精确定点停车和防撞预警的要求。
44、4、具备位置校准能力:通过被动触发式校准基站提供绝对物理位置基准,实时校准编码器累计误差,保证长时间运行的定位精度。
45、5、功能完整:集线性定位、平面定位、空间定位、位置校准、定点停车和同轨防撞于一体,覆盖单轨吊机车全场景的定位与安全管控需求。
46、6、维护便捷:单点故障不影响系统运行,故障排除无需排查网络线路,普通电工即可更换定位基站,维护成本大幅降低。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com