CN116853970A - 塔机无人驾驶控制系统及无人驾驶控制方法 - Google Patents
塔机无人驾驶控制系统及无人驾驶控制方法 Download PDFInfo
- Publication number
- CN116853970A CN116853970A CN202310872243.3A CN202310872243A CN116853970A CN 116853970 A CN116853970 A CN 116853970A CN 202310872243 A CN202310872243 A CN 202310872243A CN 116853970 A CN116853970 A CN 116853970A
- Authority
- CN
- China
- Prior art keywords
- tower crane
- data
- path
- lifting
- sensor
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 52
- 230000007613 environmental effect Effects 0.000 claims abstract description 17
- 230000008569 process Effects 0.000 claims abstract description 17
- 230000004888 barrier function Effects 0.000 claims abstract description 13
- 230000033001 locomotion Effects 0.000 claims description 28
- 238000012544 monitoring process Methods 0.000 claims description 25
- 238000004891 communication Methods 0.000 claims description 23
- 230000007246 mechanism Effects 0.000 claims description 22
- 238000012545 processing Methods 0.000 claims description 15
- 230000005540 biological transmission Effects 0.000 claims description 11
- 238000004422 calculation algorithm Methods 0.000 description 13
- 238000010586 diagram Methods 0.000 description 8
- 230000001133 acceleration Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000005286 illumination Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000007781 pre-processing Methods 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 230000011218 segmentation Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C23/00—Cranes comprising essentially a beam, boom, or triangular structure acting as a cantilever and mounted for translatory of swinging movements in vertical or horizontal planes or a combination of such movements, e.g. jib-cranes, derricks, tower cranes
- B66C23/88—Safety gear
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C13/00—Other constructional features or details
- B66C13/16—Applications of indicating, registering, or weighing devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C13/00—Other constructional features or details
- B66C13/18—Control systems or devices
- B66C13/22—Control systems or devices for electric drives
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C13/00—Other constructional features or details
- B66C13/18—Control systems or devices
- B66C13/46—Position indicators for suspended loads or for crane elements
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C23/00—Cranes comprising essentially a beam, boom, or triangular structure acting as a cantilever and mounted for translatory of swinging movements in vertical or horizontal planes or a combination of such movements, e.g. jib-cranes, derricks, tower cranes
- B66C23/62—Constructional features or details
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Abstract
本发明提供了一种塔机无人驾驶控制系统及无人驾驶控制方法,控制方法包括:实时获取塔机运行过程中的塔机吊钩的起吊高度、塔机小车的运转幅度以及塔机起重臂的回转角度数据并计算得到塔机的初始姿态数据;实时获取塔机周围环境障碍物的三维建模数据并根据三维建模数据生成塔机周围环境障碍物的三维模型数据;获取塔机运行的地面吊装点和目的卸货点的空间位置数据;生成塔机的预设运行路径和目标姿态数据;将预设运行路径和目标姿态数据转换为路径操控指令并根据路径操控指令驱动塔机吊钩运行至地面吊装点或目的卸货点。塔机系统自主收集塔机运行状态和周围环境数据,并生成路径规划控制塔机运行,解决了现有技术中的塔机操作智能化程度低的问题。
Description
技术领域
本发明涉及无人驾驶领域,具体而言,涉及一种塔机无人驾驶控制系统及无人驾驶控制方法。
背景技术
塔机是建筑工地上常用的起重设备,目前塔机的操控方式是塔司与地面指挥人员配合操作,塔司需要进入位于高空的塔机驾驶室进行操作,极端天气下塔司进出操作室极为不便,且塔机司机需在高空中作业,工作环境恶劣,如遇到塔机倒塌事故,塔司生命安全将受到重大威胁。塔机上使用的安全监控系统,通过多种传感器和摄像头实时监测塔机的工作状态,辅助塔司进行安全作业,并具有防碰撞功能,在临近额定限值时发出声光预警和报警,实现塔吊危险作业自动截断。但是并未解决塔司高空的作业模式,而且现有塔机安全系统还存在以下问题:
1.安全监控系统中的视频监控易受天气光照等环境因素和塔机作业高度影响,导致识别度降低,易出现误操作;
2.现有安全系统中防碰撞功能只能实现安装同一型号防碰撞设备的塔机与塔机之间的碰撞问题,不能解决已安装防碰撞设备的塔机与安装不同型号防碰撞设备的塔机之间、已安装防碰撞设备的塔机与未安装防碰撞设备的塔机之间的碰撞问题,更解决不了塔机与周围建筑物的碰撞问题;
3.塔司需要地面指挥人员配合,才能知道吊挂物的具体位置以及吊装路径是否安全,导致作业效率低,并存在一定的安全隐患。
因此,塔机智能化操作的发展趋势已成为必然。
发明内容
本发明的主要目的在于提供一种塔机无人驾驶控制系统及无人驾驶控制方法,以至少解决现有技术中的塔机操作智能化程度低的问题。
为了实现上述目的,本发明提供了一种塔机无人驾驶控制系统及无人驾驶控制方法。
为了实现上述目的,根据本发明的一个方面,提供了塔机无人驾驶控制系统,包括两个对讲定位操控终端、信息传感器组、激光雷达传感器、中央控制单元、塔机电控单元、塔机执行机构以及无线通信模块;两个对讲定位操控终端分别位于地面吊装点和目的卸货点,两个对讲定位操控终端用于分别获取塔机运行过程中地面吊装点和目的卸货点的实时空间位置数据;信息传感器组设置在塔机上,信息传感器组用于获取塔机运行过程中的塔机吊钩的起吊高度、塔机小车的运转幅度以及塔机起重臂的回转角度数据;激光雷达传感器设置在塔机上,激光雷达传感器用于发射激光束以扫描塔机周围环境障碍物的三维建模数据;中央控制单元与信息传感器组和激光雷达传感器均连接,中央控制单元用于根据激光雷达传感器扫描的三维建模数据生成塔机周围环境障碍物的三维模型数据,以及根据塔机吊钩的起吊高度、塔机小车的运转幅度、塔机起重臂的回转角度数据、地面吊装点或目的卸货点的实时空间位置数据以及三维模型数据生成塔机预设运行路径;塔机电控单元与中央控制单元连接,塔机电控单元用于接收中央控制单元根据塔机预设运行路径转化的塔机电控单元可执行的路径操控指令;塔机执行机构与塔机电控单元连接,塔机执行机构根据塔机电控单元执行路径操控指令以驱动塔机按照塔机预设运行路径运转;无线通信模块与中央控制单元连接,无线通信模块用于收发无线通讯信号;其中,两个对讲定位操控终端通过无线通信模块与中央控制单元连接以使两个对讲定位操控终端与中央控制单元进行通信,两个定位操作终端通过无线通信模块相互之间进行通信。
进一步地,信息传感器组包括高度传感器、幅度传感器以及角度传感器;高度传感器设置在塔机平衡臂的起升机构齿轮上,高度传感器用于实时监测塔机吊钩的起吊高度;幅度传感器设置在塔机起重臂的变幅机构齿轮上,幅度传感器用于实时监测塔机小车的运转幅度;角度传感器设置在塔机回转上部结构齿圈外侧,角度传感器用于实时测量塔机起重臂的回转角度。
进一步地,信息传感器组还包括风速传感器和重量传感器;风速传感器设置在塔机平衡臂的中段位置,风速传感器用于实时监测塔机的环境风速;重量传感器设置在塔机起重臂的后端,重量传感器用于实时监测塔机起重的货物重量;其中,风速传感器和重量传感器均与中央控制单元连接,中央控制单元还用于根据塔机的环境风速和塔机起重的货物重量生成运转控制指令;塔机电控单元根据运转控制指令控制塔机执行机构启动或停止运转。
进一步地,中央控制单元包括数据传输模块、数据处理模块、运动规划模块以及适配器;数据传输模块与信息传感器组、激光雷达传感器以及无线通信模块均连接,数据传输模块用于收集并下发塔机吊钩的起吊高度、塔机小车的运转幅度、塔机起重臂的回转角度数据、三维建模数据以及地面吊装点和目的卸货点的实时空间位置数据;数据处理模块与数据传输模块连接,数据处理模块用于根据三维建模数据生成三维模型数据;运动规划模块与数据处理模块连接,运动规划模块用于根据塔机吊钩的起吊高度、塔机小车的运转幅度、塔机起重臂的回转角度数据、地面吊装点或目的卸货点的实时空间位置数据以及三维模型数据生成并下发塔机预设运行路径,并将塔机预设运行路径转化为路径操控指令;适配器与运动规划模块连接,适配器用于接收路径操控指令并转化成塔机各部位参数以及下发。
进一步地,塔机无人驾驶控制系统还包括云台,云台安装在塔机起重臂的臂根,激光雷达传感器设置在云台上。
根据本发明的另一方面,提供了一种塔机无人驾驶控制方法,塔机无人驾驶控制方法应用于上述任一项的塔机无人驾驶控制系统,塔机无人驾驶控制方法包括:
实时获取塔机运行过程中的塔机吊钩的起吊高度、塔机小车的运转幅度以及塔机起重臂的回转角度数据并根据塔机吊钩的起吊高度、塔机小车的运转幅度以及塔机起重臂的回转角度数据计算得到塔机的初始姿态数据;
实时获取塔机周围环境障碍物的三维建模数据并根据三维建模数据生成塔机周围环境障碍物的三维模型数据;
获取塔机运行的地面吊装点和目的卸货点的空间位置数据;
根据初始姿态数据、三维模型数据以及地面吊装点或目的卸货点的空间位置数据生成塔机的预设运行路径和目标姿态数据;
将预设运行路径和目标姿态数据转换为路径操控指令并根据路径操控指令驱动塔机吊钩运行至地面吊装点或目的卸货点。
进一步地,实时获取塔机周围环境障碍物的三维建模数据并根据三维建模数据生成塔机周围环境障碍物的三维模型数据包括:
向塔机周围环境发射激光束;
接收塔机周围环境的障碍物反射的激光束信号并转换成电信号;
对转换的电信号进行处理和计算以得到障碍物的位置信息和几何形状信息;
通过周期扫描障碍物并将获得的障碍物的位置信息和几何形状信息进行拼接、去噪和特征提取以生成塔机周围环境障碍物的三维模型数据。
进一步地,根据初始姿态数据、三维模型数据以及地面吊装点或目的卸货点的空间位置数据生成塔机的预设运行路径和目标姿态数据包括:
根据初始姿态数据和三维模型数据生成全局代价地图;
调取全局代价地图计算生成地面吊装点和目的卸货点之间的全局路径规划并选出全局最优路径;
根据实时获取的三维模型数据生成本地代价地图;
调取本地代价地图计算生成地面吊装点和目的卸货点之间的本地路径规划,并结合初始姿态数据、三维模型数据以及全局最优路径选出本地最优路径以尽量符合全局最优路径;
将本地最优路径设定为塔机预设运行路径并生成目标姿态数据。
进一步地,根据路径操控指令驱动塔机吊钩运行之前,塔机无人驾驶控制方法还包括:
实施监测塔机的环境风速以及塔机起重的货物重量;
在塔机的环境风速大于预设值和/或塔机起重的货物重量大于预设值时控制塔机吊钩停止运行。
进一步地,根据路径操控指令驱动塔机吊钩运行过程中,塔机无人驾驶控制方法还包括:
实施监测塔机的环境风速以及塔机起重的货物重量;
在塔机的环境风速大于预设值和/或塔机起重的货物重量发生突变时控制塔机吊钩停止运行。
本发明技术方案的塔机无人驾驶控制方法包括:实时获取塔机运行过程中的塔机吊钩的起吊高度、塔机小车的运转幅度以及塔机起重臂的回转角度数据并根据塔机吊钩的起吊高度、塔机小车的运转幅度以及塔机起重臂的回转角度数据计算得到塔机的初始姿态数据;实时获取塔机周围环境障碍物的三维建模数据并根据三维建模数据生成塔机周围环境障碍物的三维模型数据;获取塔机运行的地面吊装点和目的卸货点的空间位置数据;根据初始姿态数据、三维模型数据以及地面吊装点或目的卸货点的空间位置数据生成塔机的预设运行路径和目标姿态数据;将预设运行路径和目标姿态数据转换为路径操控指令并根据路径操控指令驱动塔机吊钩运行至地面吊装点或目的卸货点。塔机系统自主收集塔机运行状态和周围环境数据,并生成路径规划控制塔机运行,解决了现有技术中的塔机操作智能化程度低的问题。
附图说明
构成本申请的一部分的说明书附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1是根据本发明实施例可选的一种塔机无人驾驶控制系统的结构示意图;
图2是根据本发明实施例可选的一种塔机无人驾驶控制系统的信息传感器组结构示意图;
图3是根据本发明实施例可选的一种塔机无人驾驶控制系统的中央控制单元结构示意图;
图4是根据本发明实施例可选的一种塔机无人驾驶控制方法的流程框图;
图5是根据本发明实施例可选的一种塔机无人驾驶控制方法的S104的流程框图;
图6是根据本发明实施例可选的一种塔机无人驾驶控制方法的S108的流程框图;
图7是根据本发明实施例可选的一种塔机无人驾驶控制方法的S110的流程框图;
图8是根据本发明实施例可选的ROS MoveIt平台的原理图;
图9是根据本发明实施例可选的一种塔机无人驾驶控制方法的预设路径规划的原理图;
图10是根据本发明实施例可选的一种塔机无人驾驶控制方法的预设路径规划的流程图。
其中,上述附图包括以下附图标记:
10、两个对讲定位操控终端;20、信息传感器组;21、高度传感器;22、幅度传感器;23、角度传感器;24、风速传感器;25、重量传感器;30、激光雷达传感器;40、中央控制单元;41、数据传输模块;42、数据处理模块;43、运动规划模块;44、适配器;50、塔机电控单元;60、塔机执行机构;70、无线通信模块;80、云台。
具体实施方式
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本发明。
根据本发明一种实施例的一种塔机无人驾驶控制系统,如图1所示,包括两个对讲定位操控终端10、信息传感器组20、激光雷达传感器30、中央控制单元40、塔机电控单元50、塔机执行机构60以及无线通信模块70;两个对讲定位操控终端10分别位于地面吊装点和目的卸货点,两个对讲定位操控终端10用于分别获取塔机运行过程中地面吊装点和目的卸货点的实时空间位置数据;信息传感器组20设置在塔机上,信息传感器组20用于获取塔机运行过程中的塔机吊钩的起吊高度、塔机小车的运转幅度以及塔机起重臂的回转角度数据;激光雷达传感器30设置在塔机上,激光雷达传感器30用于发射激光束以扫描塔机周围环境障碍物的三维建模数据;中央控制单元40与信息传感器组20和激光雷达传感器30均连接,中央控制单元40用于根据激光雷达传感器30扫描的三维建模数据生成塔机周围环境障碍物的三维模型数据,以及根据塔机吊钩的起吊高度、塔机小车的运转幅度、塔机起重臂的回转角度数据、地面吊装点或目的卸货点的实时空间位置数据以及三维模型数据生成塔机预设运行路径;塔机电控单元50与中央控制单元40连接,塔机电控单元50用于接收中央控制单元40根据塔机预设运行路径转化的塔机电控单元50可执行的路径操控指令;塔机执行机构60与塔机电控单元50连接,塔机执行机构60根据塔机电控单元50执行路径操控指令以驱动塔机按照塔机预设运行路径运转;无线通信模块70与中央控制单元40连接,无线通信模块70用于收发无线通讯信号;其中,两个对讲定位操控终端10通过无线通信模块70与中央控制单元40连接以使两个对讲定位操控终端10与中央控制单元40进行通信,两个定位操作终端通过无线通信模块70相互之间进行通信。两个对讲定位操控终端10可以实现地面操作人员之间沟通的功能,实时定位、一键呼叫塔机以及近距离操作塔机的功能。塔机系统自主收集塔机运行状态和周围环境数据,并生成路径规划控制塔机运行,解决了现有技术中的塔机操作智能化程度低的问题。
具体实施时,如图2所示,信息传感器组20包括高度传感器21、幅度传感器22以及角度传感器23;高度传感器21设置在塔机平衡臂的起升机构齿轮上,高度传感器21用于实时监测塔机吊钩的起吊高度;幅度传感器22设置在塔机起重臂的变幅机构齿轮上,幅度传感器22用于实时监测塔机小车的运转幅度;角度传感器23设置在塔机回转上部结构齿圈外侧,角度传感器23用于实时测量塔机起重臂的回转角度,实现了对塔机运行过程中的塔机吊钩的起吊高度、塔机小车的运转幅度以及塔机起重臂的回转角度数据的监测功能。
进一步地,信息传感器组20还包括风速传感器24和重量传感器25;风速传感器24设置在塔机平衡臂的中段位置,风速传感器24用于实时监测塔机的环境风速;重量传感器25设置在塔机起重臂的后端,重量传感器25用于实时监测塔机起重的货物重量;其中,风速传感器24和重量传感器25均与中央控制单元40连接,中央控制单元40还用于根据塔机的环境风速和塔机起重的货物重量生成运转控制指令;塔机电控单元50根据运转控制指令控制塔机执行机构60启动或停止运转,通过监测塔机的环境风速和塔机起重的货物重量保证塔机在安全状态运行。
具体实施时,如图3所示,中央控制单元40包括数据传输模块41、数据处理模块42、运动规划模块43以及适配器44;数据传输模块41与信息传感器组20、激光雷达传感器30以及无线通信模块70均连接,数据传输模块41用于收集并下发塔机吊钩的起吊高度、塔机小车的运转幅度、塔机起重臂的回转角度数据、三维建模数据以及地面吊装点和目的卸货点的实时空间位置数据;数据处理模块42与数据传输模块41连接,数据处理模块42用于根据三维建模数据生成三维模型数据;运动规划模块43与数据处理模块42连接,运动规划模块43用于根据塔机吊钩的起吊高度、塔机小车的运转幅度、塔机起重臂的回转角度数据、地面吊装点或目的卸货点的实时空间位置数据以及三维模型数据生成并下发塔机预设运行路径,并将所述塔机预设运行路径转化为所述路径操控指令;适配器44与运动规划模块43连接,适配器44用于接收路径操控指令并转化成塔机各部位参数以及下发。智能控制系统负责各种传感器数据、激光雷达障碍物的位置信息和几何形状信息和定位对讲机实时坐标等数据的采集、处理以及给塔机电控单元下达操控指令等工作。
进一步地,塔机无人驾驶控制系统还包括云台80,云台80安装在塔机起重臂的臂根,激光雷达传感器30设置在云台80上,可随塔机回转360度旋转,避免塔机运行时振动对激光雷达传感器30稳定性影响,确保数据准确性,云台80还可以对激光雷达传感器的视场角进行角度补偿,增大雷达扫描范围。
根据本发明另一种实施例的一种塔机无人驾驶控制方法,塔机无人驾驶控制方法应用于上述任一项的塔机无人驾驶控制系统,如图4所示,塔机无人驾驶控制方法包括:
S102:实时获取塔机运行过程中的塔机吊钩的起吊高度、塔机小车的运转幅度以及塔机起重臂的回转角度数据并根据塔机吊钩的起吊高度、塔机小车的运转幅度以及塔机起重臂的回转角度数据计算得到塔机的初始姿态数据;
S104:实时获取塔机周围环境障碍物的三维建模数据并根据三维建模数据生成塔机周围环境障碍物的三维模型数据;
S106:获取塔机运行的地面吊装点和目的卸货点的空间位置数据;
S108:根据初始姿态数据、三维模型数据以及地面吊装点或目的卸货点的空间位置数据生成塔机的预设运行路径和目标姿态数据;
S110:将预设运行路径和目标姿态数据转换为路径操控指令并根据路径操控指令驱动塔机吊钩运行至地面吊装点或目的卸货点。
具体实施时,如图5所示,在步骤S104中,实时获取塔机周围环境障碍物的三维建模数据并根据三维建模数据生成塔机周围环境障碍物的三维模型数据包括:
S1041:向塔机周围环境发射激光束;使用激光雷达来动态实时监测塔机周围环境的变化,激光雷达对光照变化不敏感,不受夜晚场景的影响,可以全天候工作;
S1042:接收塔机周围环境的障碍物反射的激光束信号并转换成电信号;
S1043:对转换的电信号进行处理和计算以得到障碍物的位置信息和几何形状信息等点云数据,激光雷达测距精度相比其他传感器都要高,具有一定的抗干扰能力,可实时探测生成环境物三维图形;
S1044:通过周期扫描障碍物并将获得的障碍物的位置信息和几何形状信息等点云数据进行拼接、去噪和特征提取以生成塔机周围环境障碍物的三维模型数据。
具体实施时,如图6所示,在步骤108中,根据初始姿态数据、三维模型数据以及地面吊装点或目的卸货点的空间位置数据生成塔机的预设运行路径和目标姿态数据包括:
S1081:根据初始姿态数据和三维模型数据生成全局代价地图;塔机施工前,激光雷达旋转一周,生成周围环境三维模型,即全局代价地图,属于静态地图;
S1082:调用全局路径规划器通过碰撞检测算法和路径规划算法根据全局代价地图计算生成地面吊装点和目的卸货点之间的全局路径规划并选出全局最优路径;全局规划器就是在运动之前,根据接收到的塔机位姿数据,基于全局代价地图并调用对应的路径规划算法生成一条从当前位置到目标位置的路径,然后交给本地路径规划器;
S1083:根据实时获取的三维模型数据生成本地代价地图;本地代价地图是基于激光雷达的实时数据生成的动态地图;
S1084:调取本地路径规划器通过碰撞检测算法和路径规划算法根据本地代价地图计算生成地面吊装点和目的卸货点之间的本地路径规划,并结合初始姿态数据和三维模型数据选出本地最优路径以尽量符合全局最优路径;本地路径规划器将全局最优路径分成很多的小段,分段执行,并结合本地代价地图再进行本地路径规划,实现了对动态障碍物的避障;
S1085:将本地最优路径设定为塔机预设运行路径并生成目标姿态数据,通过碰撞监测算法和路径规划算法,在躲避环境障碍物的同时,调用全局路径规划器找到一条到达目标姿态的较优路径,并调用本地路径规划器使塔机在运行过程中能沿着规划路径前进并动态规避障碍物;当塔机运动的导航路线受阻的时候,会触发“异常恢复”插件的功能,来对导航路线进行调整,如果调整失败,会结束导航。
具体实施时,如图7所示,在步骤S110中,根据路径操控指令驱动塔机吊钩运行之前,塔机无人驾驶控制方法还包括:
S1101:实施监测塔机的环境风速以及塔机起重的货物重量;
S1102:在塔机的环境风速大于预设值和/或塔机起重的货物重量大于预设值时控制塔机吊钩停止运行。
具体实施时,在步骤S110中,根据路径操控指令驱动塔机吊钩运行过程中,塔机无人驾驶控制方法还包括:
S1103:实施监测塔机的环境风速以及塔机起重的货物重量;
S1104:在塔机的环境风速大于预设值和/或塔机起重的货物重量发生突变时控制塔机吊钩停止运行。
塔机无人驾驶控制方法借助ROS MoveIt平台,如图8所示,实现对塔机的建模、运动规划、避障等操作。使塔机在复杂的环境中进行运动规划,从一个地点安全的到达另外一个地点。使用激光雷达传感器30实时的监控塔机周围的环境,并反馈给运动规划系统。塔机再根据这些变化,进行动态的调整。MoveIt中的Move_group节点将根据塔机模型URDF文件、配置SRDF文件、塔机初始状态信息、塔机目标位姿信息、环境信息,调用KDL运动学算法,OMPL运动规划算法、插补算法、FCL碰撞监测算法生成所需的运动轨迹,此轨迹以PVT格式数组的形式表示塔机运动轨迹上的位姿、速度、加速度等信息。采用KDL正逆运动学求解器及OMPL轨迹规划器,能够快速将笛卡尔空间位姿转化为对应的关节角位姿。采用RRT算法作为塔机仿真分析的路径规划算法,RRT找到路径之后,MoveIt对路径进行塔机位姿插补、逆运动学求解等运动规划,最终生成塔机控制器可执行的关节实时运动信息文件。如图9和图10所示,在进行运动规划前,需要对定位对讲机的坐标信息进行采集处理,转化为塔机的姿态信息作为目标位姿信息,首先设定塔机的目标姿态,然后发送运动规划请求。规划请求适配器对目标位姿进行预处理请求,帮助纠正塔机各机构的非法状态,同时也可添加速度、加速度约束,实现参数化运动规划。运动规划器根据设定的位置、方向约束条件进行运动规划,并生成轨迹,同时规划请求适配器可对生成的轨迹添加时间参数等,最终生成运动轨迹信息,并转化为塔机路径操控指令发送给塔机电控单元50,塔机电控单元50驱动塔机执行机构60实现对塔机的控制。自主路径规划和自主运行使塔机达到了塔机无人驾驶的智能化操控水平,主动防碰撞功能为塔机的安全有效吊装提供了强有力的支撑,从实际出发达到塔机施工智能化、少人化、无人化的理念。
塔机无人驾驶控制方法具体实施时,地面操作人员先后使用两个对讲定位操控终端10远程呼叫塔机;塔机收到呼叫指令后,中央控制单元40通过无线通信模块70定位地面操作人员的目标位置并获取地面吊装点和目的卸货点的实时空间位置数据,信息传感器组20收集塔机运行过程中的塔机吊钩的起吊高度、塔机小车的运转幅度以及塔机起重臂的回转角度数据并下发,激光雷达传感器30扫描获取塔机周围环境的三维建模数据并下发;中央控制单元40用于根据激光雷达传感器30扫描的三维建模数据生成塔机周围环境障碍物的三维模型数据,以及根据塔机吊钩的起吊高度、塔机小车的运转幅度、塔机起重臂的回转角度数据、地面吊装点或目的卸货点的实时空间位置数据以及三维模型数据生成塔机预设运行路径,并转化成路径操控指令;塔机电控单元50执行路径操作指令,以驱使塔机执行机构60驱动塔机按照塔机预设运行路径运转。控制方法包括两个对讲定位操控终端10操作、智能吊装自主路径规划、主动防碰撞和自主运行等功能,实现从“塔机高空操作变地面操作”到“远程智能控制”的跨越,解决塔司在高空中作业的恶劣环境,提高现场吊装精度,有效保障了司机人身安全。
以上仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种塔机无人驾驶控制系统,其特征在于,包括:
两个对讲定位操控终端(10),两个所述对讲定位操控终端(10)分别位于地面吊装点和目的卸货点,两个所述对讲定位操控终端(10)用于分别获取所述塔机运行过程中所述地面吊装点和所述目的卸货点的实时空间位置数据;
信息传感器组(20),所述信息传感器组(20)设置在所述塔机上,所述信息传感器组(20)用于获取所述塔机运行过程中的塔机吊钩的起吊高度、塔机小车的运转幅度以及塔机起重臂的回转角度数据;
激光雷达传感器(30),所述激光雷达传感器(30)设置在所述塔机上,所述激光雷达传感器(30)用于发射激光束以扫描所述塔机周围环境障碍物的三维建模数据;
中央控制单元(40),所述中央控制单元(40)与所述信息传感器组(20)和所述激光雷达传感器(30)均连接,所述中央控制单元(40)用于根据所述激光雷达传感器(30)扫描的所述三维建模数据生成所述塔机周围环境障碍物的三维模型数据,以及根据所述塔机吊钩的起吊高度、所述塔机小车的运转幅度、所述塔机起重臂的回转角度数据、所述地面吊装点或所述目的卸货点的实时空间位置数据以及所述三维模型数据生成塔机预设运行路径;
塔机电控单元(50),所述塔机电控单元(50)与所述中央控制单元(40)连接,所述塔机电控单元(50)用于接收所述中央控制单元(40)根据所述塔机预设运行路径转化的所述塔机电控单元(50)可执行的路径操控指令;
塔机执行机构(60),所述塔机执行机构(60)与所述塔机电控单元(50)连接,所述塔机执行机构(60)根据所述塔机电控单元(50)执行所述路径操控指令以驱动所述塔机按照所述塔机预设运行路径运转;
无线通信模块(70),所述无线通信模块(70)与所述中央控制单元(40)连接,所述无线通信模块(70)用于收发无线通讯信号;
其中,两个所述对讲定位操控终端(10)通过所述无线通信模块(70)与所述中央控制单元(40)连接以使两个所述对讲定位操控终端与所述中央控制单元(40)进行通信,所述两个定位操作终端通过所述无线通信模块(70)相互之间进行通信。
2.根据权利要求1所述的塔机无人驾驶控制系统,其特征在于,所述信息传感器组(20)包括:
高度传感器(21),所述高度传感器(21)设置在塔机平衡臂的起升机构齿轮上,所述高度传感器(21)用于实时监测所述塔机吊钩的起吊高度;
幅度传感器(22),所述幅度传感器(22)设置在所述塔机起重臂的变幅机构齿轮上,所述幅度传感器(22)用于实时监测所述塔机小车的运转幅度;
角度传感器(23),所述角度传感器(23)设置在所述塔机回转上部结构齿圈外侧,所述角度传感器(23)用于实时测量所述塔机起重臂的回转角度。
3.根据权利要求1所述的塔机无人驾驶控制系统,其特征在于,所述信息传感器组(20)还包括:
风速传感器(24),所述风速传感器(24)设置在所述塔机平衡臂的中段位置,所述风速传感器(24)用于实时监测所述塔机的环境风速;
重量传感器(25),所述重量传感器(25)设置在所述塔机起重臂的后端,所述重量传感器(25)用于实时监测所述塔机起重的货物重量;
其中,所述风速传感器(24)和所述重量传感器(25)均与所述中央控制单元(40)连接,所述中央控制单元(40)还用于根据所述塔机的环境风速和所述塔机起重的货物重量生成运转控制指令;所述塔机电控单元(50)根据所述运转控制指令控制所述塔机执行机构(60)启动或停止运转。
4.根据权利要求3所述的塔机无人驾驶控制系统,其特征在于,所述中央控制单元(40)包括:
数据传输模块(41),所述数据传输模块(41)与所述信息传感器组(20)、所述激光雷达传感器(30)以及所述无线通信模块(70)均连接,所述数据传输模块(41)用于收集并下发所述塔机吊钩的起吊高度、所述塔机小车的运转幅度、所述塔机起重臂的回转角度数据、所述三维建模数据以及所述地面吊装点和所述目的卸货点的实时空间位置数据;
数据处理模块(42),所述数据处理模块(42)与所述数据传输模块(41)连接,所述数据处理模块(42)用于根据所述三维建模数据生成所述三维模型数据;
运动规划模块(43),所述运动规划模块(43)与所述数据处理模块(42)连接,所述运动规划模块(43)用于根据所述塔机吊钩的起吊高度、所述塔机小车的运转幅度、所述塔机起重臂的回转角度数据、所述地面吊装点或所述目的卸货点的实时空间位置数据以及所述三维模型数据生成并下发所述塔机预设运行路径,并将所述塔机预设运行路径转化为所述路径操控指令;
适配器(44),所述适配器(44)与所述运动规划模块(43)连接,所述适配器(44)用于接收所述路径操控指令并转化成所述塔机各部位参数以及下发。
5.根据权利要求1所述的塔机无人驾驶控制系统,其特征在于,所述塔机无人驾驶控制系统还包括:
云台(80),所述云台(80)安装在所述塔机起重臂的臂根,所述激光雷达传感器(30)设置在所述云台(80)上。
6.一种塔机无人驾驶控制方法,其特征在于,所述塔机无人驾驶控制方法应用于权利要求1至5中任一项所述的塔机无人驾驶控制系统,所述塔机无人驾驶控制方法包括:
实时获取塔机运行过程中的塔机吊钩的起吊高度、塔机小车的运转幅度以及塔机起重臂的回转角度数据并根据所述塔机吊钩的起吊高度、所述塔机小车的运转幅度以及所述塔机起重臂的回转角度数据计算得到塔机的初始姿态数据;
实时获取塔机周围环境障碍物的三维建模数据并根据所述三维建模数据生成所述塔机周围环境障碍物的三维模型数据;
获取塔机运行的地面吊装点和目的卸货点的空间位置数据;
根据所述初始姿态数据、所述三维模型数据以及所述地面吊装点或所述目的卸货点的空间位置数据生成所述塔机的预设运行路径和目标姿态数据;
将所述预设运行路径和所述目标姿态数据转换为路径操控指令并根据所述路径操控指令驱动塔机吊钩运行至所述地面吊装点或所述目的卸货点。
7.根据权利要求6所述的塔机无人驾驶控制方法,其特征在于,所述实时获取塔机周围环境障碍物的三维建模数据并根据所述三维建模数据生成所述塔机周围环境障碍物的三维模型数据包括:
向塔机周围环境发射激光束;
接收所述塔机周围环境的障碍物反射的激光束信号并转换成电信号;
对转换的所述电信号进行处理和计算以得到障碍物的位置信息和几何形状信息;
通过周期扫描所述障碍物并将获得的障碍物的位置信息和几何形状信息进行拼接、去噪和特征提取以生成所述塔机周围环境障碍物的三维模型数据。
8.根据权利要求6所述的塔机无人驾驶控制方法,其特征在于,所述根据所述初始姿态数据、所述三维模型数据以及所述地面吊装点或所述目的卸货点的空间位置数据生成所述塔机的预设运行路径和目标姿态数据包括:
根据所述初始姿态数据和所述三维模型数据生成全局代价地图;
调取所述全局代价地图计算生成所述地面吊装点和所述目的卸货点之间的全局路径规划并选出全局最优路径;
根据实时获取的所述三维模型数据生成本地代价地图;
调取所述本地代价地图计算生成所述地面吊装点和所述目的卸货点之间的本地路径规划,并结合所述初始姿态数据、所述三维模型数据以及所述全局最优路径选出本地最优路径;
将所述本地最优路径设定为所述塔机预设运行路径并生成所述目标姿态数据。
9.根据权利要求6所述的塔机无人驾驶控制方法,其特征在于,所述根据所述路径操控指令驱动塔机吊钩运行之前,所述塔机无人驾驶控制方法还包括:
实施监测塔机的环境风速以及塔机起重的货物重量;
在所述塔机的环境风速大于预设值和/或所述塔机起重的货物重量大于预设值时控制所述塔机吊钩停止运行。
10.根据权利要求6所述的塔机无人驾驶控制方法,其特征在于,所述根据所述路径操控指令驱动塔机吊钩运行过程中,所述塔机无人驾驶控制方法还包括:
实施监测塔机的环境风速以及塔机起重的货物重量;
在所述塔机的环境风速大于预设值和/或所述塔机起重的货物重量发生突变时控制所述塔机吊钩停止运行。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310872243.3A CN116853970A (zh) | 2023-07-17 | 2023-07-17 | 塔机无人驾驶控制系统及无人驾驶控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310872243.3A CN116853970A (zh) | 2023-07-17 | 2023-07-17 | 塔机无人驾驶控制系统及无人驾驶控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116853970A true CN116853970A (zh) | 2023-10-10 |
Family
ID=88224800
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310872243.3A Pending CN116853970A (zh) | 2023-07-17 | 2023-07-17 | 塔机无人驾驶控制系统及无人驾驶控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116853970A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117105097A (zh) * | 2023-10-23 | 2023-11-24 | 杭州未名信科科技有限公司 | 一种智能塔机控制系统、方法及控制设备 |
-
2023
- 2023-07-17 CN CN202310872243.3A patent/CN116853970A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117105097A (zh) * | 2023-10-23 | 2023-11-24 | 杭州未名信科科技有限公司 | 一种智能塔机控制系统、方法及控制设备 |
CN117105097B (zh) * | 2023-10-23 | 2024-04-02 | 杭州未名信科科技有限公司 | 一种智能塔机控制系统、方法及控制设备 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11167964B2 (en) | Control augmentation apparatus and method for automated guided vehicles | |
EP3660231A1 (en) | System and method for autonomous operation of heavy machinery | |
CN116853970A (zh) | 塔机无人驾驶控制系统及无人驾驶控制方法 | |
CN111712458B (zh) | 具有防撞装置的起重机及用于运行多个起重机的方法 | |
CN112279104B (zh) | 吊车防撞控制方法、装置、系统、计算机设备和存储介质 | |
CN110914152B (zh) | 提升负载的方法和装置 | |
CN109405804B (zh) | 作业辅助方法及系统 | |
KR20190078984A (ko) | 인양물의 크레인 충돌방지를 위한 감시 시스템 | |
CN111891922B (zh) | 一种起重机作业实时导航系统及方法 | |
CA3229184A1 (en) | Mining worksite mapping | |
KR101811926B1 (ko) | 무인비행체를 이용한 타워크레인의 운전 보조시스템 및 이를 이용한 타워크레인의 영상 제공 방법 | |
CN110642148A (zh) | 一种无人驾驶塔机的控制系统及控制方法 | |
CN211454364U (zh) | 一种无人驾驶拖拉机控制系统 | |
US20230019162A1 (en) | Crane, crane body, and non-transitory computer readable medium storing program | |
CN220745205U (zh) | 塔机无人驾驶控制系统 | |
JP3250159B2 (ja) | クレーン制御システム | |
EP3754450B1 (en) | Autonomous vehicle monitoring | |
JP2022179081A (ja) | 遠隔操作支援システム、遠隔操作支援装置 | |
WO2022176783A1 (ja) | ショベル、情報処理装置 | |
CN218879232U (zh) | 确定悬挂物位置的设备和塔机 | |
KR20200039336A (ko) | 3차원 센싱을 이용한 조선소의 크레인 충돌방지 시스템 및 방법 | |
EP4325318A1 (en) | Obstacle detection for a mining vehicle | |
CN214623416U (zh) | 作业机械集群的控制系统 | |
KR20230140778A (ko) | 타워크레인의 전복 및 충돌 방지 모니터링 시스템 및 그 방법 | |
CN114217606A (zh) | 一种门座起重机远程智能化控制系统及其方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |