CN107326956B - 一种挖泥船的抓斗平挖控制方法及其系统 - Google Patents

一种挖泥船的抓斗平挖控制方法及其系统 Download PDF

Info

Publication number
CN107326956B
CN107326956B CN201710476232.8A CN201710476232A CN107326956B CN 107326956 B CN107326956 B CN 107326956B CN 201710476232 A CN201710476232 A CN 201710476232A CN 107326956 B CN107326956 B CN 107326956B
Authority
CN
China
Prior art keywords
bucket
grab bucket
dredger
grab
motion
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.)
Active
Application number
CN201710476232.8A
Other languages
English (en)
Other versions
CN107326956A (zh
Inventor
刘国生
何东萍
刘烈晖
董恒瑞
赖盖文
韦纪军
吴守根
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
CCCC Guangzhou Dredging Co Ltd.
Original Assignee
CCCC Guangzhou Dredging Co Ltd.
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by CCCC Guangzhou Dredging Co Ltd. filed Critical CCCC Guangzhou Dredging Co Ltd.
Priority to CN201710476232.8A priority Critical patent/CN107326956B/zh
Publication of CN107326956A publication Critical patent/CN107326956A/zh
Application granted granted Critical
Publication of CN107326956B publication Critical patent/CN107326956B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F7/00—Equipment for conveying or separating excavated material
    • E02F7/04—Loading devices mounted on a dredger or an excavator hopper dredgers, also equipment for unloading the hopper
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20—Drives; Control devices
    • E02F9/2025—Particular purposes of control systems not otherwise provided for
    • E02F9/2037—Coordinating the movements of the implement and of the frame

Abstract

本发明提供一种挖泥船的抓斗平挖控制方法及其系统，其中，本发明的一种挖泥船的抓斗平挖控制方法，包括以下步骤基于开口度传感器和深度传感器，以获取抓斗的斗齿运动位置信息；基于斗齿空间运动模型，计算抓斗下一运动状态的斗齿运动位置坐标；基于所获取的抓斗下一运动状态的斗齿运动位置坐标，控制抓斗运动。本发明的一种挖泥船的抓斗平挖控制方法，通过开度传感器和深度传感器以获取抓斗的斗齿空间状态，并将其通过斗齿空间运动模型，以计算获取抓斗的下一运动状态的斗齿运动位置坐标，由操作人员根据获取到的坐标位置，控制抓斗的运动，从而实现其平挖的功能。

Description

一种挖泥船的抓斗平挖控制方法及其系统
技术领域
本发明涉及疏浚工程技术领域，更具体地，涉及一种挖泥船的抓斗平挖控制方法及其系统。
背景技术
当前国内外针对抓斗式挖泥船平挖功能，既有SKK公司成熟的液力变矩器驱动+碟刹系统的抓斗斗齿运动方案，也有高校正在研发的变频器驱动方案。但对于部分的非标准设计建造的大型抓斗式挖泥船，其本身没有平挖功能，且采用特殊定制的挖泥作业操作控制设备，如果在短时间内直接介入对船载挖泥机具进行大规模设备改造，风险较大。
因此，如何实现对抓斗的虚拟斗齿空间挖泥轨迹可视化显示，以指导船员人工完成平挖施工工艺操作流程而提高其挖掘精度及施工效率，并满足工程设计要求，已成为目前急需解决的技术问题。
发明内容
本发明提供一种挖泥船的抓斗平挖控制方法及其系统，以解决上现有大型抓斗式挖泥船无平挖功能的技术难题。
根据本发明的一个方面，提供一种挖泥船的抓斗平挖控制方法，包括以下步骤：
步骤S1.在挖泥船的抓斗上设置开口度传感器和深度传感器；
步骤S2.基于开口度传感器和深度传感器，以获取抓斗的斗齿运动位置信息；
步骤S3.基于斗齿空间运动模型，计算抓斗下一运动状态的斗齿运动位置坐标；
步骤S4.基于所获取的抓斗下一运动状态的斗齿运动位置坐标，控制抓斗运动。
在上述方案基础上优选，步骤S1中所述抓斗上的开口度传感器为多个。
在上述方案基础上优选，所述步骤S3中，斗齿空间运动模型为：
Figure BDA0001328319410000021
yn＝Cnk+hn；
其中，xn表示斗齿的水平移动位置；yn表示斗齿的垂向移动位置；an表示抓斗侧向投影几何运动轨迹修正参数；Cn表示开口传感器输出量；hn表示深度传感器输出量；n＝1～9；k表示与抓斗几何形状相关的拟合曲线修正参数，由试验获得
Figure BDA0001328319410000022
在上述方案基础上优选，所述步骤S2中的抓斗的斗齿运动位置信息包括抓斗的斗齿的深度参数和开度参数。
本发明还提供了一种挖泥船的抓斗平挖控制系统，包括挖泥船、抓斗和运算处理器，所述抓斗装设在所述挖泥船上，所述挖泥船上设有控制设备，所述控制设备用于控制所述挖泥船和抓斗的运动，并在所述抓斗上装设有开度传感器和深度传感器，所述运算处理器内设有斗齿空间运动模型，用于拟合所述抓斗的运动轨迹，所述运算处理器的输出端与所述的控制设备电气相连。
在上述方案基础上优选，所述运算处理器中的斗齿空间运动模型为
Figure BDA0001328319410000031
yn＝Cnk+hn；
其中，xn表示斗齿的水平移动位置；yn表示斗齿的垂向移动位置；an表示抓斗侧向投影几何运动轨迹修正参数；Cn表示开口传感器输出量；hn表示深度传感器输出量；n＝1～9；k表示与抓斗几何形状相关的拟合曲线修正参数，由试验获得
Figure BDA0001328319410000032
在上述方案基础上优选，所述开度传感器为多个，多个所述开度传感器间隔均匀设置在所述抓斗的边缘。
在上述方案基础上优选，所述运算处理器上还连接有显示屏和语音播报器，所述的显示屏和语音播报器与所述的运算处理器电气相连。
本发明的一种挖泥船的抓斗平挖控制方法，通过开度传感器和深度传感器以获取抓斗的斗齿空间状态，并将其通过斗齿空间运动模型，以计算获取抓斗的下一运动状态的斗齿运动位置坐标，由操作人员根据获取到的坐标位置，控制抓斗的每一步运动动作，从而实现其平挖的功能。
由于本发明通过斗齿空间运动模型在线推演斗齿轨迹趋势，指导操作员操作抓斗挖泥驱动设备，纠正合斗挖掘过程中，抓斗高程坐标可能偏离目标挖深水平线的最大允许值，使每一斗都能开挖出一快平整有效区域，进而形成连片平整地形区域，保证挖深都控制在工程设计高程指标范围内。
附图说明
图1为本发明的一种挖泥船的抓斗平挖控制方法的流程框图。
具体实施方式
下面结合附图和实施例，对本发明的具体实施方式作进一步详细描述。以下实施例用于说明本发明，但不用来限制本发明的范围。
请参阅图1所示，本发明提供一种挖泥船的抓斗平挖控制方法，包括以下步骤：
步骤S1.在挖泥船的抓斗上设置开口度传感器和深度传感器；
步骤S2.基于开口度传感器和深度传感器，以获取抓斗的斗齿运动位置信息，其中，斗齿运动位置信息包括抓斗的斗齿的深度参数和开度参数；
步骤S3.基于斗齿空间运动模型，计算抓斗下一运动状态的斗齿运动位置坐标；
步骤S4.基于所获取的抓斗下一运动状态的斗齿运动位置坐标，控制抓斗运动。
其中，本发明步骤S1中抓斗上的开口度传感器为多个，优选为9个，以准确获取抓斗的开合度。
进一步的，本发明的步骤S3中，斗齿空间运动模型为：
Figure BDA0001328319410000041
yn＝Cnk+hn；
其中，xn表示斗齿的水平移动位置；yn表示斗齿的垂向移动位置；an表示抓斗侧向投影几何运动轨迹修正参数，an是根据抓斗的出厂设计图纸逐点测量以获取的；Cn表示开口传感器输出量；hn表示深度传感器输出量；k表示与抓斗几何形状相关的拟合曲线修正参数；n＝1～9，n表示抓斗上的每一个开口度传感器，即当n＝9时，表示抓斗上有9个开口度传感器。
为了便于说明，本发明设定n＝9，即开口度传感器和深度传感器为9个，9个开口度传感器和深度传感器以分别获取斗齿的开口量参数Cn和深度参数hn，根据公式yn＝Cnk+hn，以计算获取当前点的斗齿下一位置的垂向移动位置，然后根据计算获取的当前点的斗齿下一位置的垂向移动位置yn以计算当前点斗齿的下一位置的水平移动位置xn。通过上述公式分别计算出9个点的下一位置的水平移动位置xn和垂向移动位置yn，得到9个位置坐标，根据这9个位置坐标以得到抓斗的运动曲线，然后，根据该运动曲线，控制抓斗运动，从而实现其平挖施工的目的。
本发明还提供了一种挖泥船的抓斗平挖控制系统，包括挖泥船、抓斗和运算处理器，抓斗装设在挖泥船上，挖泥船上设有控制设备，控制设备用于控制挖泥船和抓斗的运动，并在抓斗上装设有开度传感器和深度传感器，运算处理器内设有斗齿空间运动模型，用于拟合所述抓斗的运动轨迹，运算处理器的输出端与控制设备电气相连。
使用过程中，利用开度传感器和深度传感器分别获取抓斗的斗齿开度参数和深度参数，并将其发送至运算处理器，通过运算处理器内的斗齿空间运动模型，计算出斗齿下一运动位置以拟合抓斗的运动轨迹，然后，将其发送至控制设备，通过控制设备以控制抓斗的运动，从而实现其平挖的目的。
需要说明的是，本发明的控制设备包括显示屏和操作台，显示屏用于显示抓斗的运动轨迹，而操作台用于操作人员控制抓斗的运动。
进一步的，本发明的运算处理器中的斗齿空间运动模型为
Figure BDA0001328319410000061
yn＝Cnk+hn；
其中，xn表示斗齿的水平移动位置；yn表示斗齿的垂向移动位置；an表示抓斗侧向投影几何运动轨迹修正参数，an是根据抓斗的出厂设计图纸逐点测量以获取的；Cn表示开口传感器输出量；hn表示深度传感器输出量；k表示与抓斗几何形状相关的拟合曲线修正参数；n＝1～9，n表示抓斗上的每一个开口度传感器，即当n＝9时，表示抓斗上有9个开口度传感器。
为了便于说明，本发明设定n＝9，即开口度传感器和深度传感器为9个，9个开口度传感器和深度传感器以分别获取斗齿的开口量参数Cn和深度参数hn，根据公式yn＝Cnk+hn，以计算获取当前点的斗齿下一位置的垂向移动位置，然后根据计算获取的当前点的斗齿下一位置的垂向移动位置yn以计算当前点斗齿的下一位置的水平移动位置xn。通过上述公式分别计算出9个点的下一位置的水平移动位置xn和垂向移动位置yn，得到9个位置坐标，根据这9个位置坐标和斗齿空间运动模型以得到抓斗拟合运动曲线，然后，根据该运动曲线，控制抓斗运动，从而实现其平挖施工的目的。
优选的，本发明的开度传感器和深度传感器为多个，多个开度传感器和深度传感器间隔均匀设置在抓斗的边缘，用于采集抓斗的不同位置斗齿的开度和深度参数。
进一步的，本发明运算处理器上还连接有显示屏和语音播报器，显示屏和语音播报器与运算处理器电气相连。
本发明的一种挖泥船的抓斗平挖控制方法，通过开度传感器以获取抓斗的开合状态，并将其通过斗齿空间运动模型，以计算获取抓斗的下一运动状态的斗齿运动位置坐标，由操作人员根据获取到的坐标位置，控制抓斗的运动，从而实现其平挖的功能。
由于本发明通过斗齿空间运动模型在线推演斗齿轨迹趋势，指导操作员操作抓斗挖泥驱动设备，纠正合斗挖掘过程中，抓斗高程坐标可能偏离目标挖深水平线的最大允许值，使每一斗都能开挖出一快平整有效区域，进而形成连片平整地形区域，保证挖深都控制在工程设计高程指标范围内。
最后，本申请的方法仅为较佳的实施方案，并非用于限定本发明的保护范围。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (6)

1.一种挖泥船的抓斗平挖控制方法，其特征在于，包括以下步骤：
步骤S1.在挖泥船的抓斗上设置开口度传感器和深度传感器；
步骤S2.基于开口度传感器和深度传感器，以获取抓斗的斗齿运动位置信息；
步骤S3.基于斗齿空间运动模型，计算抓斗下一运动状态的斗齿运动位置坐标，且所述斗齿空间运动模型为：
Figure FDA0002646718330000011
yn＝Cnk+hn；
其中，xn表示斗齿的水平移动位置；yn表示斗齿的垂向移动位置；an表示抓斗侧向投影几何运动轨迹修正参数；Cn表示开口传感器输出量；hn表示深度传感器输出量；n＝1～9；k表示抓斗的运动曲线修正参数，
Figure FDA0002646718330000012
步骤S4.基于所获取的抓斗下一运动状态的斗齿运动位置坐标，控制抓斗运动。
2.如权利要求1所述的一种挖泥船的抓斗平挖控制方法，其特征在于，步骤S1中所述抓斗上的开口度传感器为多个。
3.如权利要求1所述的一种挖泥船的抓斗平挖控制方法，其特征在于，所述步骤S2中的抓斗的斗齿运动位置信息包括抓斗的斗齿的深度参数和开度参数。
4.一种挖泥船的抓斗平挖控制系统，其特征在于，包括挖泥船、抓斗和运算处理器，所述抓斗装设在所述挖泥船上，所述挖泥船上设有控制设备，所述控制设备用于控制所述挖泥船和抓斗的运动，并在所述抓斗上装设有开度传感器和深度传感器，所述运算处理器内设有斗齿空间运动模型，用于拟合所述抓斗的运动轨迹，所述运算处理器的输出端与所述的控制设备电气相连，且所述运算处理器中的斗齿空间运动模型为
Figure FDA0002646718330000021
yn＝Cnk+hn；
其中，xn表示斗齿的水平移动位置；yn表示斗齿的垂向移动位置；an表示抓斗侧向投影几何运动轨迹修正参数；Cn表示开口传感器输出量；hn表示深度传感器输出量；n＝1～9；k表示抓斗的运动曲线修正参数，
Figure FDA0002646718330000022
5.如权利要求4所述的一种挖泥船的抓斗平挖控制系统，其特征在于，所述开度传感器为多个，多个所述开度传感器间隔均匀设置在所述抓斗的边缘。
6.如权利要求4所述的一种挖泥船的抓斗平挖控制系统，其特征在于，所述运算处理器上还连接有显示屏和语音播报器，所述的显示屏和语音播报器与所述的运算处理器电气相连。
CN201710476232.8A 2017-06-21 2017-06-21 一种挖泥船的抓斗平挖控制方法及其系统 Active CN107326956B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710476232.8A CN107326956B (zh) 2017-06-21 2017-06-21 一种挖泥船的抓斗平挖控制方法及其系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710476232.8A CN107326956B (zh) 2017-06-21 2017-06-21 一种挖泥船的抓斗平挖控制方法及其系统

Publications (2)

Publication Number Publication Date
CN107326956A CN107326956A (zh) 2017-11-07
CN107326956B true CN107326956B (zh) 2020-11-20

Family

ID=60193992

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710476232.8A Active CN107326956B (zh) 2017-06-21 2017-06-21 一种挖泥船的抓斗平挖控制方法及其系统

Country Status (1)

Country Link
CN (1) CN107326956B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109138018B (zh) * 2018-09-07 2021-08-20 中交广州航道局有限公司 抓斗控制方法和系统、计算机设备、计算机存储介质
CN114150724B (zh) * 2021-11-08 2023-06-23 中交疏浚技术装备国家工程研究中心有限公司 一种基于牛顿迭代法的抓斗挖泥船精挖控制方法

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106546211A (zh) * 2016-12-29 2017-03-29 中交天津港航勘察设计研究院有限公司 一种抓斗挖泥船抓斗姿态测量系统

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3461407B2 (ja) * 1995-06-08 2003-10-27 日立建機株式会社 油圧ショベルの運転室干渉防止装置
JPH10183668A (ja) * 1996-12-27 1998-07-14 Kubota Corp バックホウ
JP5597222B2 (ja) * 2012-04-11 2014-10-01 株式会社小松製作所 油圧ショベルの掘削制御システム
JP5603520B1 (ja) * 2012-10-19 2014-10-08 株式会社小松製作所 油圧ショベルの掘削制御システム

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106546211A (zh) * 2016-12-29 2017-03-29 中交天津港航勘察设计研究院有限公司 一种抓斗挖泥船抓斗姿态测量系统

Also Published As

Publication number Publication date
CN107326956A (zh) 2017-11-07

Similar Documents

Publication Publication Date Title
CN107326956B (zh) 一种挖泥船的抓斗平挖控制方法及其系统
CN104476548B (zh) 一种挖掘机器人自主作业控制方法
CN104358280B (zh) 液压挖掘机的挖掘控制系统
EP3159455B1 (en) Shovel and method for controlling same
DE112014000134B4 (de) Stellungsberechnungsvorrichtung für eine Arbeitsmaschine, Arbeitsmaschine und Stellungsberechnungsverfahren für eine Arbeitsmaschine
US10266117B2 (en) Device and method for providing a vehicle environment view for a vehicle
US20180182120A1 (en) Measurement device of shovel
US20170321395A1 (en) Posture calculation device of working machinery, posture calculation device of excavator, and working machinery
JP7210129B2 (ja) ショベル
US11828039B2 (en) Shovel
CN102520723B (zh) 基于上悬无线传输摄像头的轮椅室内全局视频监控导航系统
EP3951079A1 (en) Shovel
US9435101B2 (en) Semi-automatic control of a joystick for dozer blade control
EP3767038A1 (en) Work machine
US11168466B2 (en) Shovel, display device of shovel, and method of displaying image for shovel
US20210332566A1 (en) Display control device for work machine, work machine, and display control method for work machine
EP4001513A1 (en) Work machine and assistance device that assists work using work machine
CN109296019A (zh) 挖掘机臂运动控制方法、系统及装置
KR20170136057A (ko) 원격조종 굴삭기 모니터링 시스템 및 그 시스템을 이용한 모니터링 방법
EP2386076B1 (en) Method and device for controlling a mobile ground working device
CN107435349B (zh) 一种电传挖掘机的辅助扫平作业功能实现方法
CN114592559A (zh) 一种特殊环境下的液压挖掘机远程自动控制系统
CN111779051B (zh) 平地机及铲刀控制方法
CN117629216A (zh) 一种挖掘机自主作业规划系统及方法
CN116065646A (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
GR01 Patent grant
GR01 Patent grant