1.本发明涉及一种防碰撞检测方法,具体说是大型可移动的门式起重机与门座式起重机联合作业时的防碰撞检测方法。
背景技术:2.rtk接收机广泛应用于导航和测绘领域,在测量方面主要应用于高精度的场景。通常rtk接收机使用的是网络1+1或者电台1+1的模式,也就是架设一个rtk接收机作为基站,通过网络或电台的方式发送差分数据,另一台用于测量的rtk接收机作为移动站。
3.目前,传统的门式起重机与门座式起重机联合作业时的防碰撞检测均是采用惯性导航对运行的位置进行预测的。虽然,惯性导航在正常时准备度较高。但是,惯性导航需要通过卫星传输信号,一旦出现卫星信号弱的情况,会使得信号传递不及时,从而导致检测失败。门式起重机与门座式起重机联合作业时,均是调运重型装置,一旦检测失败、出现碰撞,会造成极其严重的损失。
技术实现要素:4.本发明要解决的技术问题是提供一种大型可移动门式起重机与门座式起重机联合作业时的防碰撞检测方法,采用该方法不会检测失败,不会造成严重损失。解决了背景技术中因卫星信号弱而出现预测失败的问题。
5.为解决上述问题,提供以下技术方案:本发明的门式起重机与门座式起重机联合作业时的防碰撞检测方法的特点是包括如下步骤:s1,在3d软件中,通过线条图建立工作区域中所有门式起重机、门座式起重机的外形空间模型及rtk移动站在门座式起重机模型中的安装位置,确定门式起重机和门座式起重机在3d软件的x、y、z三轴空间中的定位点信息模型。其中,所述三轴空间的x轴为水平平面内的左右轴,即x轴与门式起重机主梁的纵向平行,y轴为水平平面内的前后轴,z轴为竖直向上轴,且x轴、y轴和z轴互相垂直。
6.s2,按照固定时间间隔,获取rtk移动站在时间点t1、t2、t3
…
tn的位置信息,得到rtk移动站实时位置经纬度坐标,并通过算法将经纬度坐标转换为三轴空间中的坐标p1、p2、p3
ꢀ…ꢀ
pn。
7.s3,依据上述三轴空间中的坐标,计算门式起重机位置、门座式起重机的吊臂旋转角度及姿态,根据惯性导航算法,确定下一rtk移动站采集时间节点tn+1时,门式起重机及门座式起重机的理论预测位置坐标fpn+1。
8.s4,将tn+1时的rtk移动站实时位置坐标pn+1与fpn+1进行精度对比,选择精度高的那个作为后续位置建模的空间坐标。
9.s5,根据s4确定的空间坐标,并结合门式起重机、门座式起重机的外形及尺寸信息、rtk移动站部署的高度,计算出门式起重机、门座式起重机的外表面各位置点坐标,并输
出到3d软件中。
10.s6,通过3d软件直接计算出不同门座式起重机外表面间的最近距离及所有门座式起重机与所有门式起重机间的最近距离,在3d软件中进行防碰撞预警,进而实现防碰撞检测。
11.其中,s1中的线条图是结合门式起重机、门座式起重机的外形构造参数建立的。
12.s2中,固定间隔时间为1秒。
13.s2中的算法为llh-enu转换算法。
14.s4中判断精度高的机制是:根据时段卫星接收信号强度优先选择策略,即当连续5秒卫星信号强度大于-145dbm时,判定为pn+1的精度高,否则判定为fpn+1的精度高。
15.s6中防碰撞预警的方式包括提醒、预警和报警。具体机制是:20米<最近距离≤35米,提醒;10米<最近距离≤20米时,预警;最近距离≤10米时,报警。
16.采取以上方案,具有以下优点:由于本发明的大型可移动门式起重机与门座式起重机联合作业时的防碰撞检测方法融合了rtk定位及惯性导航定位技术,将rtk基站安装于固定位,将rtk移动站安装于门座式起重机上,实时检测安装点位的位置,并对门式起重机与门座式起重机坐标建模,确定门式起重机、门座式起重机机在三维空间中的当前测量位,同时利用惯性导航算法,根据门式起重机、门座式起重机机的测量位数据,计算出其后一时间节点的惯导预测位,在后一时间节点时,将测量位与惯导预测位进行精度对比,选择更为准确的位置数据作为基准,进行防碰撞检测。这方法利用融合了rtk定位及惯性导航定位技术,在卫星信号弱,惯性导航定失败的情况下,以rtk为的数据作为基准,进行防碰撞检测,从而不会出现因信号弱而预测失败的情况,保证工作区域内,多个门座式起重机及其上的工件不会相撞,进而避免了因撞击而造成的严重损失不会发生。
附图说明
17.图1是本发明的大型可移动门式起重机与门座式起重机联合作业时的防碰撞检测方法的工作流程图;图2是大型可移动门式起重机与门座式起重机联合作业的场景示意图。
具体实施方式
18.如图1和图2所示,本发明的门式起重机与门座式起重机联合作业时的防碰撞检测方法包括如下步骤:s1,在3d软件中,结合门式起重机、门座式起重机的外形构造参数建立门式起重机和门座式起重机的线条图,通过线条图建立工作区域中所有门式起重机、门座式起重机的外形空间模型及rtk移动站在门座式起重机模型中的安装位置,确定门式起重机和门座式起重机在3d软件的x、y、z三轴空间中的定位点信息模型。所述3d软件为移动式设备实时位置展示软件,如cmsoft软件。机械工程与自动化期刊于2012年2月发表的基于solidworks和vrml的门式起重机三维虚拟仿真的论文也公开实现本发明的3d软件的方法。其中,所述三轴空间的x轴为水平平面内的左右轴,即x轴与门式起重机主梁的纵向平行,y轴为水平平面
内的前后轴,z轴为竖直向上轴,且x轴、y轴和z轴互相垂直,如图2所示。
19.s2,按照固定时间间隔,获取rtk移动站在时间点t1、t2、t3
…
tn的位置信息,得到rtk移动站实时位置经纬度坐标,并通过llh-enu转换算法将经纬度坐标转换为三轴空间中的坐标p1、p2、p3
ꢀ…ꢀ
pn。本实施例中,固定间隔时间为1秒。
20.s3,依据上述三轴空间中的坐标,计算门式起重机位置、门座式起重机的吊臂旋转角度及姿态,根据惯性导航算法,确定下一rtk移动站采集时间节点tn+1时,门式起重机及门座式起重机的理论预测位置坐标fpn+1。
21.s4,将tn+1时的rtk移动站实时位置坐标pn+1与fpn+1进行精度对比,机制是:根据时段卫星接收信号强度优先选择策略,即当连续5秒卫星信号强度大于-145dbm时,判定为pn+1的精度高,否则判定为fpn+1的精度高。选择精度高的那个作为后续位置建模的空间坐标。
22.s5,根据s4确定的空间坐标,并结合门式起重机、门座式起重机的外形及尺寸信息、rtk移动站部署的高度,计算出门式起重机、门座式起重机的外表面各位置点坐标,并输出到3d软件中。
23.s6,通过3d软件直接计算出不同门座式起重机外表面间的最近距离及所有门座式起重机与所有门式起重机间的最近距离,在3d软件中进行防碰撞预警,进而实现防碰撞检测。防碰撞预警的方式包括提醒、预警和报警,机制是:20米<最近距离≤35米,提醒;10米<最近距离≤20米时,预警;最近距离≤10米时,报警。
24.本发明在门座式起重机加装rtk流动站采集设备,在固定点位部署rtk基站,通过rtk获取龙门吊和门座机的实时经纬度坐标并将其转换为x、y、z三轴坐标。再建立门座机、龙门吊的真实尺寸外框比例模型,并建立其在x、y、z三轴坐标中的移动轨迹空间模型。之后,通过rtk和惯性导航算法,实时修正门座机、龙门吊的姿态和空间位置。最后,在移动轨迹空间模型中,计算各机械碰撞的可能性,分别进行提醒、预警、报警等分等级输出,实现碰撞的动态检测。
25.本发明通过rtk可解决因卫星信号弱或信号丢失时而无法获取定位信息时的设备碰撞检测问题。实现空间内任意两个大型可移动式设备外表面所有点的防碰撞检测。