CN114150725B - 一种抓斗挖泥船精挖控制系统 - Google Patents

一种抓斗挖泥船精挖控制系统 Download PDF

Info

Publication number
CN114150725B
CN114150725B CN202111312980.5A CN202111312980A CN114150725B CN 114150725 B CN114150725 B CN 114150725B CN 202111312980 A CN202111312980 A CN 202111312980A CN 114150725 B CN114150725 B CN 114150725B
Authority
CN
China
Prior art keywords
winch
closing
opening
grab
lifting
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
CN202111312980.5A
Other languages
English (en)
Other versions
CN114150725A (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 National Engineering Research Center of Dredging Technology and Equipment Co Ltd
Original Assignee
CCCC National Engineering Research Center of Dredging Technology and Equipment 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 National Engineering Research Center of Dredging Technology and Equipment Co Ltd filed Critical CCCC National Engineering Research Center of Dredging Technology and Equipment Co Ltd
Priority to CN202111312980.5A priority Critical patent/CN114150725B/zh
Publication of CN114150725A publication Critical patent/CN114150725A/zh
Application granted granted Critical
Publication of CN114150725B publication Critical patent/CN114150725B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F5/00—Dredgers or soil-shifting machines for special purposes
    • E02F5/28—Dredgers or soil-shifting machines for special purposes for cleaning watercourses or other ways
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F3/00—Dredgers; Soil-shifting machines
    • E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/46—Dredgers; Soil-shifting machines mechanically-driven with reciprocating digging or scraping elements moved by cables or hoisting ropes ; Drives or control devices therefor
    • E02F3/47—Dredgers; Soil-shifting machines mechanically-driven with reciprocating digging or scraping elements moved by cables or hoisting ropes ; Drives or control devices therefor with grab buckets
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F3/00—Dredgers; Soil-shifting machines
    • E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/46—Dredgers; Soil-shifting machines mechanically-driven with reciprocating digging or scraping elements moved by cables or hoisting ropes ; Drives or control devices therefor
    • E02F3/58—Component parts
    • 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/2029—Controlling the position of implements in function of its load, e.g. modifying the attitude of implements in accordance to vehicle speed
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/0205—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system
    • G05B13/024—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Civil Engineering (AREA)
  • Mining & Mineral Resources (AREA)
  • Mechanical Engineering (AREA)
  • Evolutionary Computation (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Software Systems (AREA)
  • Medical Informatics (AREA)
  • Health & Medical Sciences (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Artificial Intelligence (AREA)
  • Control And Safety Of Cranes (AREA)

Abstract

本发明属于疏浚工程技术领域，提出了一种抓斗挖泥船的精挖控制系统，其特征在于，包括：臂架角度传感器、船舶吃水传感器、开闭绞车编码器、升降绞车编码器、升降绞车变量泵、开闭绞车变量泵和运算计算机；所述运算计算机包括精挖控制软件，其输出与升降绞车变量泵、开闭绞车变量泵连接；运算计算机根据精挖控制软件的计算结果，控制变量泵排量以驱动相应绞车达到期望转速。本发明提高了抓斗挖掘精度，节省了疏浚工作的工程量。

Description

一种抓斗挖泥船精挖控制系统
技术领域
本发明涉及疏浚工程技术领域，具体地，涉及一种挖泥船的抓斗精挖控制系统。
技术背景
抓斗挖泥船配备有升降绞车与开闭绞车，抓斗通过钢丝绳连接至绞车，绞车转动带动抓斗运动。当前抓斗挖泥船大多为施工人员手动控制抓斗闭合过程。抓斗下放到目标深度后，升降绞车保持静止，开闭绞车向钢丝绳收回的方向转动，抓斗闭合。闭合过程中，斗齿运动轨迹在竖直平面内的投影为一条曲线，因此抓斗控制精度低，且挖掘后形成的水底面高低不平。
因此采用自动化程序控制抓斗升降绞车与开闭绞车转动速度，使斗齿运动轨迹在竖直平面内的投影为一条直线，即挖掘后形成的水底面为平面，成为目前亟待解决的技术问题。
发明内容
本发明提供一种抓斗挖泥船精挖控制系统，使斗齿运动轨迹在垂直面内的投影为一条直线，提高抓斗挖掘精度。
技术方案：
一种抓斗挖泥船的精挖控制系统，其特征在于，包括：臂架角度传感器、船舶吃水传感器、开闭绞车编码器、升降绞车编码器、升降绞车变量泵、开闭绞车变量泵和运算计算机；
所述臂架角度传感器安装在抓斗挖泥船臂架与船体连接位置，所述船舶吃水传感器安装于船舶艏艉两端，所述开闭绞车编码器安装在抓斗开闭绞车上，所述升降绞车编码器安装于抓斗升降绞车上，在抓斗控制室安装升降绞车变量泵和开闭绞车变量泵以控制抓斗升降绞车和抓斗开闭绞车转速，在抓斗控制室安装运算计算机；
所述臂架角度传感器、船舶吃水传感器、升降绞车编码器和开闭绞车编码器的输出提供给运算计算机；
所述运算计算机包括精挖控制软件，其输出与升降绞车变量泵、开闭绞车变量泵连接；运算计算机根据精挖控制软件的计算结果，控制变量泵排量以驱动相应绞车达到期望转速。
所述精挖控制软件包括以下模块：数据采集模块、当前时刻位置计算模块、下一时刻位置计算模块、绞车转速计算模块和绞车变量泵控制模块；
所述数据采集模块收集臂架角度α、船舶吃水Dd、抓斗升降绞车编码器计数r1和抓斗开闭绞车编码器计数r2；
所述当前时刻位置计算模块，基于数据采集模块中的臂架角度、抓斗升降绞车编码器计数和抓斗开闭绞车编码器计数，计算当前t时刻抓斗升降滑轮高度yd、开闭滑轮高度yc和斗齿高度ya；
所述下一时刻位置计算模块，其通过牛顿迭代法来求解抓斗平挖运动控制方程，计算t+1时刻抓斗升降滑轮和开闭滑轮应该到达的位置；
所述绞车转速计算模块基于下一时刻抓斗升降滑轮和开闭滑轮应该到达的位置，计算升降绞车和开闭绞车转速；
所述绞车变量泵控制模块根据升降绞车和开闭绞车转速控制泵排量，驱动相应绞车达到目标转速。
有益效果
与现有技术相比，本发明提高了抓斗挖掘精度，可以使斗齿运动轨迹在竖直平面内的投影为一条直线，即挖掘后形成的水底面为平面，节省了疏浚工作的工程量。
附图说明
图1为抓斗挖泥船结构图。
图2为臂架及钢丝绳尺寸标注示意图
图3为精挖控制软件模块划分示意图。
图4为抓斗挖泥船精挖控制流程框图。
图5为抓斗几何模型。
图6为t时刻和t+1时刻抓斗形态示意图。
具体实施方式
以下结合附图对本发明技术方案做进一步说明。
一种基于牛顿迭代法的抓斗挖泥船精挖控制方法，其特征在于，包括以下步骤：
步骤1，在抓斗挖泥船臂架与船体连接位置安装角度传感器，在抓斗升降绞车和抓斗开闭绞车安装编码器，在抓斗控制室安装变排量泵控制抓斗升降绞车和抓斗开闭绞车转速，在抓斗控制室安装高性能运算计算机；如图1所示。
步骤2，基于抓斗升降绞车和抓斗开闭绞车编码器和臂架角度传感器，计算当前t时刻抓斗升降滑轮高度yd、开闭滑轮高度yc和斗齿高度ya；
步骤3，基于牛顿迭代法，求解抓斗平挖运动控制方程，计算t+1时刻抓斗升降滑轮和开闭滑轮应该到达的位置；
步骤4，基于下一时刻抓斗升降滑轮和开闭滑轮应该到达的位置，计算升降绞车和开闭绞车转速；根据升降绞车和开闭绞车转速控制泵排量，驱动相应绞车达到目标转速。
如图4所示。
步骤2，基于抓斗升降绞车和抓斗开闭绞车编码器和臂架角度传感器，计算当前t时刻抓斗升降滑轮高度yd、开闭滑轮高度yc和斗齿高度ya；如图5，图6，图中A点为斗齿、C点为开闭滑轮，线段BD为抓斗撑杆。θ1为线段AC与抓斗中垂线的夹角，θ2为线段AC与BC夹角，该角度由抓斗几何尺寸决定，在抓斗闭合过程中不发生变化，θ3为线段BC与DC的夹角，θ4为线段DC与抓斗中垂线的夹角。e为线段AB长度，b为线段BD长度，b、e由抓斗几何尺寸决定，为固定值。c为线段CD长度。g为D点到抓斗中垂线的水平距离。
包括以下步骤：
步骤2.1，利用臂架角度传感器计算臂架顶端点高度ybm＝L*sin(α)+Hd，其中，L为臂架长度，α为臂架角度传感器示数，Hd为臂架与船体连接点距离水面的高度，Hd＝Hbm2-Dd，其中，Hbm2为臂架底端点至船底的高度，Dd为吃水，通过船舶吃水传感器获得；
步骤2.2，根据升降绞车编码器示数r1和开闭绞车编码器示数r2，计算升降钢丝绳长度lr1＝r1*π*d1和开闭钢丝绳长度lr2＝r2*π*d2，其中，d1,d2分别为升降绞车和开闭绞车直径；
步骤2.3，计算升降绞车出绳点到臂架顶端的钢丝绳长度l″r1和开闭绞车到臂架顶端的钢丝绳长度l″r2， 其中，dbp1,dbp2分别为臂架底端点至升降绞车出绳点和开闭绞车出绳点的距离，γ1,γ2分别为臂架底端点至升降绞车出绳点和开闭绞车出绳点连线与垂线的夹角、α为臂架与水平线夹角；
步骤2.4，计算升降滑轮到臂架顶端钢丝绳长度l′r1＝lr1-l″r1，开闭滑轮到臂架顶端钢丝绳长度l′r2＝lr2-l″r2；
步骤2.5，计算升降滑轮高度yd＝ybm-l′r1和开闭滑轮高度yc＝ybm-l′r2；
步骤2.6，根据抓斗升降滑轮和抓斗开闭滑轮高度，计算抓斗斗齿高度ya＝a*cos(θ1)，θ1＝π-θ2-θ3-θ4， 斗齿水平坐标xa＝a*sin(θ)。
步骤3中，抓斗精挖过程中，t+1时刻位置斗齿坐标为(x′a,y′a)，xa′＝xa-Δx，y′a＝ya，Δx与设定的闭斗速度相关；t+1时刻抓斗开闭滑轮垂向坐标为 为线段C′A′与中线的夹角。
基于牛顿迭代法计算t+1时刻抓斗升降滑轮和开闭滑轮期望位置，步骤如下：
步骤3.1设t+1时刻升降滑轮垂向位置为y′d，开闭滑轮垂向位置为y′c，线段C′D′与中线夹角
步骤3.2求C′点与D′点的间的距离，
步骤3.3求角度抓斗闭合过程中，角度θ2为固定值，
步骤3.4定义函数Func(y′d)＝θ1′+θ2′+θ3′+θ4′-π；
步骤3.5将t时刻D点高度yd赋值给y′d，即y′d←yd；
步骤3.6将D点高度值y′d带入函数Func(y′d)，计算得到函数Func(y′d)的值为F；
步骤3.7定义一个微小量Δy，将当前D点高度值加上一个微小量Δy，计算函数Func(y′d+Δy)的值F′；
步骤3.8计算作为新的D点高度赋值给y′d，即/>
重复步骤3.6-步骤3.8，直到停止，此时y′d为t+1时刻升降滑轮应该达到的位置，ε为自定义的迭代停止判定条件。
步骤4中，根据t+1时抓斗升降滑轮和开闭滑轮应该到达的位置，即抓斗升降滑轮高度y′d和开闭滑轮高度y′c，用于计算升降滑轮移动速度开闭滑轮移动速度/>根据升降滑轮移动速度计算升降绞车转速/>和计算开闭绞车转速/>控制变量泵排量以驱动相应绞车达到期望转速。
本发明还提供了一种抓斗挖泥船的精挖控制系统，包括：臂架角度传感器、船舶吃水传感器、开闭绞车编码器、升降绞车编码器、升降绞车变量泵、开闭绞车变量泵和运算计算机。
所述臂架角度传感器安装在抓斗挖泥船臂架与船体连接位置，所述船舶吃水传感器安装于船舶艏艉两端，所述开闭绞车编码器安装在抓斗开闭绞车上，所述升降绞车编码器安装于抓斗升降绞车上，在抓斗控制室安装升降绞车变量泵和开闭绞车变量泵以控制抓斗升降绞车和抓斗开闭绞车转速，在抓斗控制室安装运算计算机。
所述臂架角度传感器、船舶吃水传感器、升降绞车编码器和开闭绞车编码器的输出提供给运算计算机。
所述运算计算机包括精挖控制软件，其输出与升降绞车变量泵、开闭绞车变量泵连接。运算计算机根据精挖控制软件的计算结果，用于控制变量泵排量以驱动相应绞车达到期望转速。
所述运算计算机运行精挖控制软件，该软件包括以下模块：数据采集模块、当前时刻位置计算模块、下一时刻位置计算模块、绞车转速计算模块和绞车变量泵控制模块。如图3所示。
所述数据采集模块收集臂架角度α、船舶吃水Dd、抓斗升降绞车编码器计数r1和抓斗开闭绞车编码器计数r2。
所述当前时刻位置计算模块，基于数据采集模块中的臂架角度、抓斗升降绞车编码器计数和抓斗开闭绞车编码器计数，计算当前t时刻抓斗升降滑轮高度yd、开闭滑轮高度yc和斗齿高度ya；具体算法如下：
先利用臂架角度α计算臂架顶端点高度ybm＝L*sin(α)+Hd，其中，L为臂架长度，Hd为臂架与船体连接点距离水面的高度，Hd＝Hbm2-Dd，其中，Hbm2为臂架底端点至船底的高度，Dd为船舶吃水；
再根据抓斗升降绞车编码器计数r1和抓斗开闭绞车编码器计数r2，计算升降钢丝绳长度lr1＝r1*π*d1和开闭钢丝绳长度lr2＝r2*π*d2，其中，d1,d2分别为升降绞车和开闭绞车直径；
接着，计算升降绞车出绳点到臂架顶端的钢丝绳长度l″r1和开闭绞车到臂架顶端的钢丝绳长度l″r2， 其中，dbp1,dbp2分别为臂架底端点至升降绞车出绳点和开闭绞车出绳点的距离，γ1,γ2分别为臂架底端点至升降绞车出绳点和开闭绞车出绳点连线与垂线的夹角、α为臂架角度，臂架角度为臂架与水平线夹角；
接着，计算升降滑轮到臂架顶端钢丝绳长度l′r1＝lr1-l″r1，开闭滑轮到臂架顶端钢丝绳长度l′r2＝lr2-l″r2；
接着，计算升降滑轮高度yd＝ybm-l′r1和开闭滑轮高度yc＝ybm-l′r2；
接着，根据抓斗升降滑轮和抓斗开闭滑轮高度，计算抓斗斗齿高度ya＝a*cos(θ1)，θ1＝π-θ2-θ3-θ4， 斗齿水平坐标xa＝a*sin(θ)。
所述下一时刻位置计算模块，其通过牛顿迭代法来求解抓斗平挖运动控制方程，计算t+1时刻抓斗升降滑轮和开闭滑轮应该到达的位置；抓斗精挖过程中，t+1时刻位置斗齿坐标为(x′a,y′a)，xa′＝xa-Δx，y′a＝ya，Δx与设定的闭斗速度相关；t+1时刻抓斗开闭滑轮垂向坐标为为线段C′A′与中线的夹角。
基于牛顿迭代法计算t+1时刻抓斗升降滑轮和开闭滑轮期望位置，算法如下：
S1.设t+1时刻升降滑轮垂向位置为y′d，开闭滑轮垂向位置为y′c，线段C′D′与中线夹角
S2.求C′点与D′点的间的距离，
S3.求角度抓斗闭合过程中，角度θ2为固定值，/>
S4.定义函数Func(y′d)＝θ1′+θ2′+θ3′+θ4′-π；
S5.将t时刻D点高度yd赋值给y′d，即y′d←yd；
S6.将D点高度值y′d带入函数Func(y′d)，计算得到函数Func(y′d)的值为F；
S7.定义一个微小量Δy，将当前D点高度值加上一个微小量Δy，计算函数Func(y′d+Δy)的值F′；
S8.计算作为新的D点高度赋值给y′d，即/>
重复步骤S6-S8，直到停止，此时y′d为t+1时刻升降滑轮应该达到的位置，ε为自定义的迭代停止判定条件。
所述绞车转速计算模块基于下一时刻抓斗升降滑轮和开闭滑轮应该到达的位置，计算升降绞车和开闭绞车转速；根据t+1时刻抓斗升降滑轮高度y′d和开闭滑轮高度y′c，计算升降滑轮移动速度开闭滑轮移动速度/>根据升降滑轮移动速度计算升降绞车转速/>和开闭绞车转速/>
所述绞车变量泵控制模块根据升降绞车和开闭绞车转速控制泵排量，驱动相应绞车达到目标转速。
以下基于本发明技术方案给出具体的实施例。
实施例1
在升降绞车和开闭绞车分别安装1个变量泵用于驱动绞车转动，在升降绞车和开闭绞车分别安装1个编码器，用于计算绞车当前圈数。进行编码器校零：定义出绳量为零时，绞车圈数为零，在臂架与船底连接点安装角度传感器，测量臂架与水平线夹角α。
本实施例中，升降绞车d1和开闭绞车直径d2均为1000mm。臂架L长度为26402.2989mm，臂架底端到船底的距离Hbm2为6629.5953mm，臂架底端点至升降绞车出绳点距离dbp1＝3754.9623mm，臂架底端点至升降绞车出绳点的夹角γ1＝0.3141，臂架底端点至开闭绞车出绳点的距离dbp2＝6146.4088mm，臂架底端点至开闭绞车出绳点连线与垂线的夹角γ2＝0.6457。抓斗几何尺寸a＝3968.9751,b＝55421.6942,d＝3020.8448,e＝3399.4051,g＝598.8471。抓斗运动计算的时间间隔Δt＝1s。
在t时刻，船舶吃水Dd为3000mm，臂架角度传感器示数计算臂架顶端到水面高度ybm＝Hbm2-Dd+L*sin(α)＝22298.8398mm。
绞车编码器显示，在t时刻，升降绞车圈数r1＝11.5524，升降绞车圈数r2＝13.8100。计算升降钢丝绳长度lr1＝r1*π*d1＝36293.0234mm，开闭钢丝绳长度lr2＝r2*π*d2＝43385.4547mm。
计算升降滑轮到臂架顶端钢丝绳长度 开闭滑轮到臂架顶端钢丝绳长度/>
计算升降滑轮到臂架顶端钢丝绳长度l′r1＝lr1-l″r1＝11369.8570mm，开闭滑轮到臂架顶端钢丝绳长度l′r2＝lr2-l″r2＝17123.5070mm。
计算升降滑轮高度yd＝ybm-l′r1＝10928.9828mm，开闭滑轮高度yc＝ybm-l′r2＝5175.3328mm。
计算 θ1＝π-θ2-θ3-θ4＝0.8317，斗齿水平坐标xa＝a*sin(θ1)＝2933.6107mm，斗齿高度ya＝a*cos(θ1)＝2502.0031mm。
设定闭合速度为500mm/s，t+1时刻，xa′＝2433.6107mm，y′a＝ya＝2502.0031mm，
应用牛顿迭代法求解y′d，具体为：
(1)将yd赋值给y′d，y′d＝10928.9828mm，定义ε＝0.1，Δy＝1mm；
(2) F＝Func(y′d)＝θ1′+θ2′+θ3′+θ4′-π＝-0.0281；
(3)将y′d加上Δy，重复计算θ′4＝0.1126，c′＝5326.4195mm，θ′3＝1.3586，θ2′＝0.9817，F′＝Func(y′d)＝-0.0284；
(4)计算
(5)更新y′d＝10927.9939；
(6)比较与ε，此时未满足迭代停止条件/>重复(3)-(6)。
经过96次迭代，满足停止条件，此时y′d＝10840.8385mm。
计算升降滑轮的移动速度开闭滑轮的移动速度/>
计算升降绞车转速和开闭绞车转速/> 计算所需的液压泵排量，驱动绞车达到相应转速。至此，完成t+1时刻的计算，反复重复以上步骤，即可实现抓斗精挖自动控制。

Claims (1)

1.一种抓斗挖泥船的精挖控制系统，其特征在于，包括：臂架角度传感器、船舶吃水传感器、开闭绞车编码器、升降绞车编码器、升降绞车变量泵、开闭绞车变量泵和运算计算机；
所述臂架角度传感器安装在抓斗挖泥船臂架与船体连接位置，所述船舶吃水传感器安装于船舶艏艉两端，所述开闭绞车编码器安装在抓斗开闭绞车上，所述升降绞车编码器安装于抓斗升降绞车上，在抓斗控制室安装升降绞车变量泵和开闭绞车变量泵以控制抓斗升降绞车和抓斗开闭绞车转速，在抓斗控制室安装运算计算机；
所述臂架角度传感器、船舶吃水传感器、升降绞车编码器和开闭绞车编码器的输出提供给运算计算机；
所述运算计算机包括精挖控制软件，其输出与升降绞车变量泵、开闭绞车变量泵连接；运算计算机根据精挖控制软件的计算结果，控制变量泵排量以驱动相应绞车达到期望转速；
数据采集模块、当前时刻位置计算模块、下一时刻位置计算模块、绞车转速计算模块和绞车变量泵控制模块；
所述数据采集模块收集臂架角度α、船舶吃水Dd、抓斗升降绞车编码器计数r1和抓斗开闭绞车编码器计数r2；
所述当前时刻位置计算模块，基于数据采集模块中的臂架角度、抓斗升降绞车编码器计数和抓斗开闭绞车编码器计数，计算当前t时刻抓斗升降滑轮高度yd、开闭滑轮高度yc和斗齿高度ya；
设：A点为斗齿、C点为开闭滑轮，线段BD为抓斗撑杆；θ1为线段AC与抓斗中垂线的夹角，θ2为线段AC与BC夹角，该角度由抓斗几何尺寸决定，在抓斗闭合过程中不发生变化，θ3为线段BC与线段DC的夹角，θ4为线段DC与抓斗中垂线的夹角；e为线段AB长度，b为线段BD长度，b、e由抓斗几何尺寸决定，为固定值；c为线段CD长度；g为D点到抓斗中垂线的水平距离；
所述下一时刻位置计算模块，其通过牛顿迭代法来求解抓斗平挖运动控制方程，计算t+1时刻抓斗升降滑轮和开闭滑轮应该到达的位置；
所述绞车转速计算模块基于下一时刻抓斗升降滑轮和开闭滑轮应该到达的位置，计算升降绞车和开闭绞车转速；
所述绞车变量泵控制模块根据升降绞车和开闭绞车转速控制泵排量，驱动相应绞车达到目标转速；
所述下一时刻位置计算模块，其通过牛顿迭代法来求解抓斗平挖运动控制方程，计算t+1时刻抓斗升降滑轮和开闭滑轮应该到达的位置；抓斗精挖过程中，t+1时刻位置斗齿坐标为(x′a,y′a)，xa′＝xa-Δx，y′d＝ya，Δx与设定的闭斗速度相关；t+1时刻抓斗开闭滑轮垂向坐标为 为线段C′A′与中线的夹角；
基于牛顿迭代法计算t+1时刻抓斗升降滑轮和开闭滑轮期望位置，算法如下：
S1.设t+1时刻升降滑轮垂向位置为y′d，开闭滑轮垂向位置为y′c，线段C′D′与中线夹角
S2.求C′点与D′点的间的距离，
S3.求角度抓斗闭合过程中，角度θ2为固定值，/>
S4.定义函数Func(y′d)＝θ1′+θ2′+θ3′+θ4′-π；
S5.将t时刻D点高度yd赋值给y′d，即y′d←yd；
S6.将D点高度值y′d带入函数Func(y′d)，计算得到函数Func(y′d)的值为F；
S7.定义一个微小量Δy，将当前D点高度值加上一个微小量Δy，计算函数Func(y′d+Δy)的值F′；
S8.计算作为新的D点高度赋值给y′d，即/>
重复步骤S6-S8，直到停止，此时y′d为t+1时刻升降滑轮应该达到的位置，ε为自定义的迭代停止判定条件；
所述绞车转速计算模块基于下一时刻抓斗升降滑轮和开闭滑轮应该到达的位置，计算升降绞车和开闭绞车转速；根据t+1时刻抓斗升降滑轮高度y′d和开闭滑轮高度y′c，计算升降滑轮移动速度开闭滑轮移动速度/>根据升降滑轮移动速度计算升降绞车转速/>和开闭绞车转速/>其中，d1,d2分别为升降绞车和开闭绞车直径。
CN202111312980.5A 2021-11-08 2021-11-08 一种抓斗挖泥船精挖控制系统 Active CN114150725B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111312980.5A CN114150725B (zh) 2021-11-08 2021-11-08 一种抓斗挖泥船精挖控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111312980.5A CN114150725B (zh) 2021-11-08 2021-11-08 一种抓斗挖泥船精挖控制系统

Publications (2)

Publication Number Publication Date
CN114150725A CN114150725A (zh) 2022-03-08
CN114150725B true CN114150725B (zh) 2023-09-19

Family

ID=80459045

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111312980.5A Active CN114150725B (zh) 2021-11-08 2021-11-08 一种抓斗挖泥船精挖控制系统

Country Status (1)

Country Link
CN (1) CN114150725B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117342428A (zh) * 2023-12-06 2024-01-05 河南卫华重型机械股份有限公司 一种酿酒用平层取糟抓斗起重机控制方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0577930A1 (de) * 1992-07-06 1994-01-12 Liebherr-Werk Nenzing Ges.mbH. Verfahren zur Steuerung des Greifers eines Seilbaggers
CN203392776U (zh) * 2013-06-27 2014-01-15 三一集团有限公司 抓斗控制系统、起重机及工程船舶
CN106291462A (zh) * 2016-08-31 2017-01-04 合肥飞友网络科技有限公司 一种精确定位飞机位置的方法
CN206362327U (zh) * 2016-12-29 2017-07-28 中交天津港航勘察设计研究院有限公司 抓斗挖泥船抓斗姿态测量系统
CN112081167A (zh) * 2020-09-08 2020-12-15 镇江市亿华系统集成有限公司 高平整度抓斗船基槽精挖作业控制方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0577930A1 (de) * 1992-07-06 1994-01-12 Liebherr-Werk Nenzing Ges.mbH. Verfahren zur Steuerung des Greifers eines Seilbaggers
CN203392776U (zh) * 2013-06-27 2014-01-15 三一集团有限公司 抓斗控制系统、起重机及工程船舶
CN106291462A (zh) * 2016-08-31 2017-01-04 合肥飞友网络科技有限公司 一种精确定位飞机位置的方法
CN206362327U (zh) * 2016-12-29 2017-07-28 中交天津港航勘察设计研究院有限公司 抓斗挖泥船抓斗姿态测量系统
CN112081167A (zh) * 2020-09-08 2020-12-15 镇江市亿华系统集成有限公司 高平整度抓斗船基槽精挖作业控制方法

Also Published As

Publication number Publication date
CN114150725A (zh) 2022-03-08

Similar Documents

Publication Publication Date Title
CN114150725B (zh) 一种抓斗挖泥船精挖控制系统
JP7341949B2 (ja) ショベル及びショベル用の制御装置
CN107318288B (zh) 一种电液悬挂控制装置
CN111441416A (zh) 一种挖掘机作业控制方法及系统
CN114150724B (zh) 一种基于牛顿迭代法的抓斗挖泥船精挖控制方法
CN109375584A (zh) 臂架关节控制方法及系统及包含该系统的工程机械
CN109375585A (zh) 臂架末端位置控制方法及系统及包含该系统的工程机械
JP4960402B2 (ja) グラブ浚渫船による浚渫方法
CN105329788B (zh) 臂架式起重机匀速变幅控制方法
CN109750701A (zh) 一种绞吸挖泥船最大产量自动挖泥控制方法
JP7017948B2 (ja) ポンプ浚渫船及びポンプ浚渫方法
JP2007146481A (ja) 堆積物の浚渫装置
CN110258689A (zh) 一种龙门式绞吸机
CN109469328A (zh) 臂架末端位置控制方法及系统及包含该系统的工程机械
CN104190893B (zh) 一种用于自动化连铸系统的调速装置及调速方法
CN112077836B (zh) 一种基于四柔索牵引并联执行器的高架吊杆误差校正方法
CN112064700B (zh) 一种装载机最佳铲装轨迹匹配方法
JPS6145885A (ja) グラブバケツトの水平掘削制御装置
JP2006027830A (ja) グラブ浚渫施工支援装置および浚渫方法
CN108343106B (zh) 一种带有水下泵的耙吸船挖掘中粗砂的方法
JPH0119011B2 (zh)
CN112795727A (zh) 一种脱硫铁水自动扒渣的三维定位方法
CN117661600B (zh) 一种挖掘机自动基坑边缘修砌方法
CN220247054U (zh) 挖泥船抓斗控制系统
Zhang et al. Design of a One-Button Dredging Fully Automatic Control System for Grab Dredgers

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