CN113625706B - 一种动力定位船自动定点混合控制模式的导引方法 - Google Patents

一种动力定位船自动定点混合控制模式的导引方法 Download PDF

Info

Publication number
CN113625706B
CN113625706B CN202110772106.3A CN202110772106A CN113625706B CN 113625706 B CN113625706 B CN 113625706B CN 202110772106 A CN202110772106 A CN 202110772106A CN 113625706 B CN113625706 B CN 113625706B
Authority
CN
China
Prior art keywords
ship
los
control
auto
point
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
CN202110772106.3A
Other languages
English (en)
Other versions
CN113625706A (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.)
Harbin Engineering University
Original Assignee
Harbin Engineering University
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 Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN202110772106.3A priority Critical patent/CN113625706B/zh
Publication of CN113625706A publication Critical patent/CN113625706A/zh
Application granted granted Critical
Publication of CN113625706B publication Critical patent/CN113625706B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/0206Control of position or course in two dimensions specially adapted to water vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明提供一种动力定位船自动定点混合控制模式的导引方法,混合控制器中速度反馈环的加入,混合控制器能够根据期望位置和LOS导引点得出期望视向点,并得出期望视向点与当前位置的差值,动力定位系统能够输入艏向、纵向和横向方向上的控制命令,根据导引算法可以求出固定坐标系中的期望导引点,经由转换公式计算,求得船体坐标系下的期望船舶位姿,传递至运动控制器来进行控制。本发明方法能够控制船舶位姿,并且能够用操作手柄进行船舶运动的控制,本发明所设计的控制器能够操纵Joystick控制船舶围绕控制点做旋转运动,符合Joystick+Auto Surge&Sway模式的要求。

Description

一种动力定位船自动定点混合控制模式的导引方法
技术领域
本发明属于船舶动力定位控制技术领域,具体为某半潜船自动定点混合控制模式(Joystick+Auto Surge&Sway)的导引方法。
背景技术
动力定位是一项在海洋工程中和深海开发中广泛使用的一种技术,目前全世界已经有超过2000艘具有动力定位系统的船舶,动力定位可以通过推进器保持位置和艏向于固定点或设定航迹上,并能够保证控制的精度,灵活有效,尤其是在锚泊受限的深海区,能够展现其强大的优势。目前,动力定位技术已经应用在了海洋铺管、深海吊装、海上钻井、穿梭邮轮、海上补给等多种作业任务。船舶上的动力定位系统极其复杂,与船舶上所有的设备相关,其中比较核心的为推进器系统和运动控制系统。
由于海洋环境极其复杂,推进器的效率也比较低,对船舶进行精确的控制会比较困难。并且近年加大了对海洋深度的探索,船舶的稳定性和控制精度也需要随之提高。因此,能够设计出一个高精度的控制器对于动力定位系统功能的提高有着非常重要的意义。本发明结合LOS导引算法和PID控制方法,推导出某半潜船Joystick+Auto Surge&Sway混合控制模式的导引律,以解决混合控制模式下半潜船的路径导引问题。
发明内容
本发明的目的主要针对半潜船的运动控制,因此提出一种动力定位船舶混合控制模式的导引方法,用于混合控制模式下半潜船的路径导引问题,并进行控制船舶位置姿态的仿真分析。
本发明的目的是这样实现的:
设计混合控制器与设计自动控制器有两点区别,第一点为混合控制器中速度反馈环的加入,第二点为混合控制器能够根据期望位置和LOS导引点得出期望视向点,并得出期望视向点与当前位置的差值。
动力定位系统能够输入艏向、纵向和横向方向上的控制命令,根据导引算法可以求出固定坐标系中的期望导引点,经由转换公式计算,求得船体坐标系下的期望船舶位姿,传递至运动控制器来进行控制。本设计方法能够控制船舶位姿,并且能够用操作手柄进行船舶运动的控制。半潜船运动导引律设计思路如下:
第一,半潜船动力学方程如下:
式中:HXt、HYt、HNt——作用在船体上力和力矩;
xg——船舶重心在x轴方向上的位置坐标。
第二,由公式(1)可以得到船舶的加速度及角加速度,积分可以求得船舶速度,控制器接收反馈信号,并由运动学方程计算固定坐标系下船舶速度,方程如下:
第三,由公式(2)可以得到固定坐标系下在三自由度方向上的船舶速度,积分可以求得船舶在固定坐标系中的位置并向控制器反馈。
第四,由船舶期望位置和船舶实时位姿,求出导引点坐标(Nlos,Elos)。
为了计算出未知LOS点的坐标plos=(Nlos,Elos),必须满足下面两式:
(Nlos-Nt)2+(Elos-Et)2=R2 (3)
式中:R——导引半径。
另:e=Nk,f=Ek
定义下式:
a=1+d2 (5)
b=2(dg-dEt-Nt) (6)
1)ΔN>0
Elos=d(Nlos-Nk)+Ek (9)
当ΔE=0时,Elos=Ek=Ek+1
2)ΔN<0
Elos=d(Nlos-Nk)+Ek (11)
当ΔE=0时,Elos=Ek=Ek+1
3)ΔN=0
当ΔE=0时,Elos=Nk=Nk+1
①对于ΔE>0
②对于ΔE<0
本发明中导引律为Joystick+Auto sway&Yaw模式导引律,设计方式如下:可以由Auto Position和Joystick模式转入此模式。按下Auto Sway按钮和Auto Surge按钮后,指示灯开始闪烁,当速度比限定速度小时,Auto Sway按钮和Auto Surge按钮状态为常亮,对当前的位置和航向(N0,E00)进行记录,此时Auto Sway和Auto Surge方向运动受限制,可操纵Joystick控制船舶围绕控制点做旋转运动。此时船舶在围绕固定点的回转运动的导引律如下图1所示。
图中,(Nt,Ett)代表船舶当前位置,(Nd,Edd)代表船舶的期望位置和航向;ld代表期望的导引路径,lv代表与期望路径垂直的路径,ld与lv相交点为d,代表船舶期望导引位置。
船舶的期望航向可用下式表示:
ψd=ψt (14)
与上述情况类似,导引路径为:
Ed=E0 (15)
Nd=N0 (16)
此种情况下的导引律由(14)、(15)和(16)组成。
第五,PID控制的原理表达式如下:
式中:KP,KI,KD——各环节增益系数;KP——有差调节;KI——静差调节;KD——偏差变化率,
由公式(17)进行三自由度方向上运动控制器的构建,操纵手柄能够通过对应不同的速度环来控制船舶三个自由度的速度。动力定位系统运动控制器由速度内环控制和位置外环控制来控制船舶运动。
与现有技术相比,本发明的有益效果是:
本发明所设计的控制器能够操纵Joystick控制船舶围绕控制点做旋转运动,符合Joystick+Auto Surge&Sway模式的要求。
附图说明
图1是Joystick Auto Surge&Sway路径导引示意图。
具体实施方式
下面结合附图与具体实施方式对本发明作进一步详细描述。
第一步,确定半潜船各项参数信息,为混合控制模式导引律的计算做好准备。
第二步,根据半潜船的各项参数信息,确定半潜船动力学方程。
第三步,由半潜船的动力学方程得到船舶的加速度及角加速度,并进行积分,求得船舶三自由度速度。
第四步,控制器接收反馈信号,并由运动学方程计算固定坐标系下船舶速度。
第五步,对固定坐标系下在三自由度方向上的船舶速度进行积分,可以求得船舶在固定坐标系中的位置并向控制器反馈。
第六步,根据北东坐标系下的期望位移指令和反馈的实时船舶位姿确定导引路径,得出路径导引公式。
第七步,根据导引路径公式求出导引点坐标(Nlos,Elos)。并进行导引律具体求解。
第八步,进行三自由度方向上运动控制器的构建,操纵手柄能够通过对应不同的速度环来控制船舶三个自由度的速度。动力定位系统运动控制器由速度内环控制和位置外环控制来控制船舶运动。
设计混合控制器与设计自动控制器有两点区别,第一点为混合控制器中速度反馈环的加入,第二点为混合控制器能够根据期望位置和LOS导引点得出期望视向点,并得出期望视向点与当前位置的差值。
动力定位系统能够输入艏向、纵向和横向方向上的控制命令,根据导引算法可以求出固定坐标系中的期望导引点,经由转换公式计算,求得船体坐标系下的期望船舶位姿,传递至运动控制器来进行控制。本设计方法能够控制船舶位姿,并且能够用操作手柄进行船舶运动的控制。半潜船运动导引律设计思路如下:
第一,半潜船动力学方程如下:
式中:HXt、HYt、HNt——作用在船体上力和力矩;
xg——船舶重心在x轴方向上的位置坐标。
第二,由公式(1)可以得到船舶的加速度及角加速度,积分可以求得船舶速度,控制器接收反馈信号,并由运动学方程计算固定坐标系下船舶速度,方程如下:
第三,由公式(2)可以得到固定坐标系下在三自由度方向上的船舶速度,积分可以求得船舶在固定坐标系中的位置并向控制器反馈。
第四,由船舶期望位置和船舶实时位姿,求出导引点坐标(Nlos,Elos)。
为了计算出未知LOS点的坐标plos=(Nlos,Elos),必须满足下面两式:
(Nlos-Nt)2+(Elos-Et)2=R2 (3)
式中:R——导引半径。
另:e=Nk,f=Ek
定义下式:
a=1+d2 (5)
b=2(dg-dEt-Nt) (6)
1)ΔN>0
Elos=d(Nlos-Nk)+Ek (9)
当ΔE=0时,Elos=Ek=Ek+1
2)ΔN<0
Elos=d(Nlos-Nk)+Ek (11)
当ΔE=0时,Elos=Ek=Ek+1
3)ΔN=0
当ΔE=0时,Elos=Nk=Nk+1
①对于ΔE>0
②对于ΔE<0
本发明中导引律为Joystick+Auto sway&Yaw模式导引律,设计方式如下:可以由Auto Position和Joystick模式转入此模式。按下Auto Sway按钮和Auto Surge按钮后,指示灯开始闪烁,当速度比限定速度小时,Auto Sway按钮和Auto Surge按钮状态为常亮,对当前的位置和航向(N0,E00)进行记录,此时Auto Sway和Auto Surge方向运动受限制,可操纵Joystick控制船舶围绕控制点做旋转运动。此时船舶在围绕固定点的回转运动的导引律如下图1所示。
图中,(Nt,Ett)代表船舶当前位置,(Nd,Edd)代表船舶的期望位置和航向;ld代表期望的导引路径,lv代表与期望路径垂直的路径,ld与lv相交点为d,代表船舶期望导引位置。
船舶的期望航向可用下式表示:
ψd=ψt (14)
与上述情况类似,导引路径为:
Ed=E0 (15)
Nd=N0 (16)
此种情况下的导引律由(14)、(15)和(16)组成。
第五,PID控制的原理表达式如下:
式中:KP,KI,KD——各环节增益系数;KP——有差调节;KI——静差调节;KD——偏差变化率,
由公式(17)进行三自由度方向上运动控制器的构建,操纵手柄能够通过对应不同的速度环来控制船舶三个自由度的速度。动力定位系统运动控制器由速度内环控制和位置外环控制来控制船舶运动。

Claims (1)

1.一种动力定位船自动定点混合控制模式的导引方法,其特征是,包括如下步骤:
步骤一,根据半潜船的各项参数信息,确定半潜船动力学方程:
式中:HXt、HYt、HNt——作用在船体上力和力矩;
xg——船舶重心在x轴方向上的位置坐标;
步骤二,由公式(1)可以得到船舶的加速度及角加速度,积分可以求得船舶速度,控制器接收反馈信号,并由运动学方程计算固定坐标系下船舶速度,方程如下:
步骤三,由公式(2)可以得到固定坐标系下在三自由度方向上的船舶速度,积分可以求得船舶在固定坐标系中的位置并向控制器反馈;
步骤四,由船舶期望位置和船舶实时位姿,求出导引点坐标(Nlos,Elos);
为了计算出未知LOS点的坐标plos=(Nlos,Elos),必须满足下面两式:
(Nlos-Nt)2+(Elos-Et)2=R2 (3)
式中:R——导引半径;
另:e=Nk,f=Ek
定义下式:
a=1+d2 (5)
b=2(dg-dEt-Nt) (6)
1)ΔN>0
Elos=d(Nlos-Nk)+Ek (9)
当ΔE=0时,Elos=Ek=Ek+1
2)ΔN<0
Elos=d(Nlos-Nk)+Ek (11)
当ΔE=0时,Elos=Ek=Ek+1
3)ΔN=0
当ΔE=0时,Elos=Nk=Nk+1
①对于ΔE>0
②对于ΔE<0
导引律为Joystick+Auto sway&Yaw模式导引律,设计方式如下:由Auto Position和Joystick模式转入此模式:按下Auto Sway按钮和Auto Surge按钮后,指示灯开始闪烁,当速度比限定速度小时,Auto Sway按钮和Auto Surge按钮状态为常亮,对当前的位置和航向(N0,E00)进行记录,此时Auto Sway和Auto Surge方向运动受限制,操纵Joystick控制船舶围绕控制点做旋转运动;
(Nt,Ett)代表船舶当前位置,(Nd,Edd)代表船舶的期望位置和航向;ld代表期望的导引路径,lv代表与期望路径垂直的路径,ld与lv相交点为d,代表船舶期望导引位置;
船舶的期望航向可用下式表示:
ψd=ψt (14)
与上述情况类似,导引路径为:
Ed=E0 (15)
Nd=N0 (16)
此种情况下的导引律由(14)、(15)和(16)组成;
步骤五,PID控制的原理表达式如下:
式中:KP,KI,KD——各环节增益系数;KP——有差调节;KI——静差调节;KD——偏差变化率,
由公式(17)进行三自由度方向上运动控制器的构建,操纵手柄能够通过对应不同的速度环来控制船舶三个自由度的速度;动力定位系统运动控制器由速度内环控制和位置外环控制来控制船舶运动。
CN202110772106.3A 2021-07-08 2021-07-08 一种动力定位船自动定点混合控制模式的导引方法 Active CN113625706B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110772106.3A CN113625706B (zh) 2021-07-08 2021-07-08 一种动力定位船自动定点混合控制模式的导引方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110772106.3A CN113625706B (zh) 2021-07-08 2021-07-08 一种动力定位船自动定点混合控制模式的导引方法

Publications (2)

Publication Number Publication Date
CN113625706A CN113625706A (zh) 2021-11-09
CN113625706B true CN113625706B (zh) 2023-12-12

Family

ID=78379316

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110772106.3A Active CN113625706B (zh) 2021-07-08 2021-07-08 一种动力定位船自动定点混合控制模式的导引方法

Country Status (1)

Country Link
CN (1) CN113625706B (zh)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3287862A1 (en) * 2016-08-25 2018-02-28 Imotec Holding B.V. Method for steering an underactuated ship
CN108052009A (zh) * 2018-01-23 2018-05-18 哈尔滨工程大学 基于滤波反步法的水面目标救援跟踪观测控制器设计方法
CN110456658A (zh) * 2019-07-24 2019-11-15 哈尔滨工程大学 一种动力定位船舶的变旋转中心运动控制仿真方法
CN110609553A (zh) * 2019-09-16 2019-12-24 哈尔滨工程大学 一种用于铺管船舶圆弧路径的los导引控制方法
CN112230566A (zh) * 2020-10-29 2021-01-15 哈尔滨工程大学 一种使用多水面船的无动力浮体协同定位控制方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10926855B2 (en) * 2018-11-01 2021-02-23 Brunswick Corporation Methods and systems for controlling low-speed propulsion of a marine vessel

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3287862A1 (en) * 2016-08-25 2018-02-28 Imotec Holding B.V. Method for steering an underactuated ship
CN108052009A (zh) * 2018-01-23 2018-05-18 哈尔滨工程大学 基于滤波反步法的水面目标救援跟踪观测控制器设计方法
CN110456658A (zh) * 2019-07-24 2019-11-15 哈尔滨工程大学 一种动力定位船舶的变旋转中心运动控制仿真方法
CN110609553A (zh) * 2019-09-16 2019-12-24 哈尔滨工程大学 一种用于铺管船舶圆弧路径的los导引控制方法
CN112230566A (zh) * 2020-10-29 2021-01-15 哈尔滨工程大学 一种使用多水面船的无动力浮体协同定位控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
动力定位船舶全速度路径跟踪CB导引自适应闭环控制;张爱华;赵春刚;王明红;徐金龙;;船舶工程(第04期);全文 *

Also Published As

Publication number Publication date
CN113625706A (zh) 2021-11-09

Similar Documents

Publication Publication Date Title
CN107168335B (zh) 一种考虑混合多目标避障的水面无人艇路径跟踪制导方法
CN109828570B (zh) 一种自适应边界层水面无人艇控制导引方法
CN110609553B (zh) 一种用于铺管船舶圆弧路径的los导引控制方法
CN112147899B (zh) 一种基于模糊滑模算法的水下机器人自主避障控制方法
Salumäe et al. Motion control of a hovering biomimetic four-fin underwater robot
CN106737659A (zh) 一种水下无人航行器和机械手系统的手艇协调控制方法
CN112527018B (zh) 一种欠驱动自主水下航行器的三维镇定控制方法
Loc et al. Development and control of a new AUV platform
CN111487966A (zh) 一种基于航路点的水面无人艇自适应路径跟踪控制方法
CN107991872B (zh) 欠驱动auv的虚拟锚泊水平面区域镇定控制方法及实现方法
CN111857165B (zh) 一种水下航行器的轨迹跟踪控制方法
CN109946976B (zh) 一种宽航速auv运动控制方法
Tran et al. Design, control, and implementation of a new AUV platform with a mass shifter mechanism
CN106681352A (zh) 一种可旋转舵推进器的水下机器人控制方法
CN107741744B (zh) 一种海洋观测平台的最优艏向控制方法
CN112947504A (zh) 一种无人潜航器自主回收控制系统及其控制方法
CN113325859A (zh) 一种游走混合型水下机器人沿斜面直立攀爬行走控制方法
CN113741433B (zh) 一种水面无人船的分布式编队方法
CN113296505B (zh) 一种基于速变los的无人船多模式路径跟踪控制方法
CN102346485A (zh) 面向复杂海况的欠驱动uuv大攻角潜浮自适应串级控制方法
CN113625706B (zh) 一种动力定位船自动定点混合控制模式的导引方法
CN108363400B (zh) 一种基于虚拟锚泊的欠驱动auv三维控制区域镇定控制方法
CN113625705B (zh) 一种动力定位船舶自动定横混合控制模式的导引方法
CN113359737A (zh) 一种考虑队形伸缩的船舶编队自适应事件触发控制方法
CN110456786B (zh) 基于地形特征提取的uuv海底地形跟踪系统及跟踪方法

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