CN107526369A - 多推进器的遥控式水下机器人轨迹跟踪控制方法 - Google Patents
多推进器的遥控式水下机器人轨迹跟踪控制方法 Download PDFInfo
- Publication number
- CN107526369A CN107526369A CN201710964946.3A CN201710964946A CN107526369A CN 107526369 A CN107526369 A CN 107526369A CN 201710964946 A CN201710964946 A CN 201710964946A CN 107526369 A CN107526369 A CN 107526369A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- rov
- underwater robot
- control method
- geographic
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 19
- 239000011159 matrix material Substances 0.000 claims description 14
- 238000004804 winding Methods 0.000 claims description 6
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 3
- 239000012530 fluid Substances 0.000 claims description 2
- 230000000694 effects Effects 0.000 abstract description 3
- 238000010276 construction Methods 0.000 abstract 1
- 230000003044 adaptive effect Effects 0.000 description 5
- 238000013528 artificial neural network Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000013178 mathematical model Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005094 computer simulation Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
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
本发明公开了一种多推进器的遥控式水下机器人轨迹跟踪控制方法，用于解决现有水下机器人控制方法实用性差的技术问题。技术方案是基于ROV体坐标系的运动方程建立ROV的两个基本坐标系分别为固定坐标系和运动坐标系，选取的坐标系有：地心惯性坐标Oexiyizi、地球坐标系Oexeyeze、地理坐标系Oxnynzn和ROV体坐标系Oxbybzb，通过定义跟踪误差，取控制律，实现水下机器人控制。本发明利用轨迹跟踪控制器，不需要准确的数学模型，具有结构简单、参数整定方便、易于工业实现和适用面广等优点，通过调整参数使***得到满意的控制效果。
Description
技术领域
本发明涉及一种水下机器人控制方法，特别涉及一种多推进器的遥控式水下机器人轨迹跟踪控制方法。
背景技术
由于ROV(遥控式水下机器人)运动惯性比较大、水动力系数不确定、机械手的作业运动影响机器人主体的动力学特性，且存在海流等随机干扰，其动力学模型难以确定，而且具有强耦合和非线性的特点，导致ROV难于控制。随着ROV应用范围的扩大，对其自主性、运动控制的精度和稳定性的要求都随之增加，如何提高其运动控制性能成了研究的重要课题。
水下机器人是一个非常复杂的***，要建立精确的数学运动模型是非常困难的，从而难以通过计算机仿真确定其控制参数。随着控制技术的不断发展，智能控制技术不断涌现，如神经网络、模糊控制、自适应控制等多种智能控制技术。俞建成、张艾群、王晓辉、苏立娟在《自动化学报》2007年08期第840-846页发表的“基于模糊神经网络水下机器人直接自适应控制”提出了基于广义动态模糊神经网络的水下机器人直接自适应控制方法，该控制方法完全通过在线自适应学习算法构建水下机器人的逆动力学模型，提出了基于这种网络结构的水下机器人直接自适应控制器，使用直接自适应控制器对水下机器人进行控制。但该控制方法的参数调试繁琐，且适应性不强，在工程实际应用中难以实现。
发明内容
为了克服现有水下机器人控制方法实用性差的不足，本发明提供一种多推进器的遥控式水下机器人轨迹跟踪控制方法。该方法基于ROV体坐标系的运动方程建立ROV的两个基本坐标系分别为固定坐标系和运动坐标系，选取的坐标系有：地心惯性坐标Oexiyizi、地球坐标系Oexeyeze、地理坐标系Oxnynzn和ROV体坐标系Oxbybzb，通过定义跟踪误差，取控制律，实现水下机器人控制。本发明利用轨迹跟踪控制器，不需要准确的数学模型，具有结构简单、参数整定方便、易于工业实现和适用面广等优点，通过调整参数使***得到满意的控制效果。
本发明解决其技术问题所采用的技术方案：一种多推进器的遥控式水下机器人轨迹跟踪控制方法，其特点是包括以下步骤：
步骤一、基于ROV体坐标系的运动方程如下：
其中M为广义质量正定矩阵，为水下机器人位置与偏航角，v＝[ur vrr]为广义水流速度，ur为纵向速度，vr为横侧向速度，r为偏航角速率， 为偏航角，C(v)为广义阻力系数斜对称矩阵，D(v)为流体动力学参数，τc为控制力矩向量；
步骤二、建立ROV的两个基本坐标系分别为固定坐标系和运动坐标系，固定坐标系和运动坐标系均为直角坐标系，并满足右手定则。选取的坐标系有：地心惯性坐标Oexiyizi、地球坐标系Oexeyeze、地理坐标系Oxnynzn和ROV体坐标系Oxbybzb，对于ROV来说，其地理坐标系通过三次旋转得到体坐标系，地理坐标系到ROV体坐标系的旋转矩阵为：
其中ψ为地理坐标系第一次绕Ozn轴旋转的角度，旋转后地理坐标系变为Ox'ny'nzn，第二次绕Oy'n旋转θ角度，旋转后地理坐标系变为Ox″ny'nz'n，第三次绕轴Ox″n旋转φ角度，旋转后的地理坐标系即与ROV体坐标系重合。
步骤三、定义跟踪误差，其中ηd为理想轨迹向量，η为实际轨迹向量；
其中ηd为理想轨迹，η为实际轨迹；
步骤四、取控制律：
其中，Kp,Ki,Kd分别为比例项、积分项和微分项的增益矩阵，且满足Kp>03×3。
本发明的有益效果是：该方法基于ROV体坐标系的运动方程建立ROV的两个基本坐标系分别为固定坐标系和运动坐标系，选取的坐标系有：地心惯性坐标Oexiyizi、地球坐标系Oexeyeze、地理坐标系Oxnynzn和ROV体坐标系Oxbybzb，通过定义跟踪误差，取控制律，实现水下机器人控制。本发明利用轨迹跟踪控制器，不需要准确的数学模型，具有结构简单、参数整定方便、易于工业实现和适用面广等优点，通过调整参数使***得到满意的控制效果。
下面结合附图和具体实施方式对本发明作详细说明。
附图说明
图1是本发明多推进器的遥控式水下机器人轨迹跟踪控制方法的流程图。
具体实施方式
参照图1。本发明多推进器的遥控式水下机器人轨迹跟踪控制方法具体步骤如下：
步骤一、基于ROV体坐标系的运动方程如下：
其中M为广义质量正定矩阵，为水下机器人位置与偏航角，v＝[ur vr r]为广义水流速度，ur为纵向速度，vr为横侧向速度，r为偏航角速率，为偏航角，C(v)为广义阻力系数斜对称矩阵，D(v)为流体动力学参数，τc为控制力矩向量；各矩阵及参数取值如下：
其中m11＝47.5，m22＝94.1，m33＝13.6，m23＝m32＝5.2，d11＝13.5，d22＝50.2，d33＝27.2，d23＝41.4，m32＝17.3。
步骤二、建立合适的坐标系，建立ROV的两个基本坐标系分别为固定坐标系和运动坐标系，以上两坐标系均为直角坐标系，并满足右手定则。选取的坐标系有：地心惯性坐标Oexiyizi、地球坐标系Oexeyeze、地理坐标系Oxnynzn、ROV体坐标系Oxbybzb，对于ROV来说，其地理坐标系通过三次旋转得到体坐标系，地理坐标系到ROV体坐标系的旋转矩阵为：
其中ψ为地理坐标系第一次绕Ozn轴旋转的角度，旋转后地理坐标系变为Ox'ny'nzn，第二次绕Oy'n旋转θ角度，旋转后地理坐标系变为Ox″ny'nz'n，第三次绕轴Ox″n旋转φ角度，旋转后的地理坐标系即与ROV体坐标系重合。
步骤三、定义跟踪误差，其中ηd为理想轨迹向量，η为实际轨迹向量；
其中ηd为理想轨迹，η为实际轨迹；
步骤四、取控制律：
其中，Kp,Ki,Kd分别为比例项、积分项和微分项的增益矩阵，且满足Kp>03×3；
其中，Kp,Ki,Kd分别为比例项、积分项和微分项的增益矩阵，且满足
本发明未详细说明部分属于本领域技术人员公知常识。
Claims (1)
1.一种多推进器的遥控式水下机器人轨迹跟踪控制方法，其特征在于包括以下步骤：
步骤一、基于ROV体坐标系的运动方程如下：
其中M为广义质量正定矩阵，为水下机器人位置与偏航角，v＝[ur vr r]为广义水流速度，ur为纵向速度，vr为横侧向速度，r为偏航角速率， 为偏航角，C(v)为广义阻力系数斜对称矩阵，D(v)为流体动力学参数，τc为控制力矩向量；
步骤二、建立ROV的两个基本坐标系分别为固定坐标系和运动坐标系，固定坐标系和运动坐标系均为直角坐标系，并满足右手定则；选取的坐标系有：地心惯性坐标Oexiyizi、地球坐标系Oexeyeze、地理坐标系Oxnynzn和ROV体坐标系Oxbybzb，对于ROV来说，其地理坐标系通过三次旋转得到体坐标系，地理坐标系到ROV体坐标系的旋转矩阵为：
<mrow>
<msubsup>
<mi>R</mi>
<mi>n</mi>
<mi>b</mi>
</msubsup>
<mrow>
<mo>(</mo>
<mi>&Theta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mi>cos</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&phi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>cos</mi>
<mi>&psi;</mi>
<mo>-</mo>
<mi>cos</mi>
<mi>&phi;</mi>
<mi>sin</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&phi;</mi>
<mi>cos</mi>
<mi>&psi;</mi>
<mo>+</mo>
<mi>sin</mi>
<mi>&phi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&phi;</mi>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&phi;</mi>
<mi>sin</mi>
<mi>&psi;</mi>
<mo>+</mo>
<mi>cos</mi>
<mi>&phi;</mi>
<mi>cos</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&phi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&psi;</mi>
<mo>-</mo>
<mi>sin</mi>
<mi>&phi;</mi>
<mi>cos</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&phi;</mi>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中ψ为地理坐标系第一次绕Ozn轴旋转的角度，旋转后地理坐标系变为Ox'ny'nzn，第二次绕Oy'n旋转θ角度，旋转后地理坐标系变为Ox″ny'nz'n，第三次绕轴Ox″n旋转φ角度，旋转后的地理坐标系即与ROV体坐标系重合；
步骤三、定义跟踪误差，其中ηd为理想轨迹向量，η为实际轨迹向量；
<mrow>
<mover>
<mi>&eta;</mi>
<mo>~</mo>
</mover>
<mo>=</mo>
<mi>&eta;</mi>
<mo>-</mo>
<msub>
<mi>&eta;</mi>
<mi>d</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
其中ηd为理想轨迹，η为实际轨迹；
步骤四、取控制律：
<mrow>
<msubsup>
<mi>&tau;</mi>
<mi>c</mi>
<mo>*</mo>
</msubsup>
<mo>=</mo>
<msub>
<mi>K</mi>
<mi>p</mi>
</msub>
<mo>&CenterDot;</mo>
<mover>
<mi>&eta;</mi>
<mo>~</mo>
</mover>
<mo>+</mo>
<msub>
<mi>K</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<mo>&Integral;</mo>
<mover>
<mi>&eta;</mi>
<mo>~</mo>
</mover>
<mi>d</mi>
<mi>t</mi>
<mo>+</mo>
<msub>
<mi>K</mi>
<mi>d</mi>
</msub>
<mo>&CenterDot;</mo>
<mover>
<mover>
<mi>&eta;</mi>
<mo>~</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
其中，Kp,Ki,Kd分别为比例项、积分项和微分项的增益矩阵，且满足Kp>03×3。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710964946.3A CN107526369B (zh) | 2017-10-17 | 2017-10-17 | 多推进器的遥控式水下机器人轨迹跟踪控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710964946.3A CN107526369B (zh) | 2017-10-17 | 2017-10-17 | 多推进器的遥控式水下机器人轨迹跟踪控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107526369A true CN107526369A (zh) | 2017-12-29 |
| CN107526369B CN107526369B (zh) | 2020-05-12 |
Family
ID=60685399
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710964946.3A Expired - Fee Related CN107526369B (zh) | 2017-10-17 | 2017-10-17 | 多推进器的遥控式水下机器人轨迹跟踪控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107526369B (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111913489A (zh) * | 2019-05-10 | 2020-11-10 | 欧舶智能科技（上海）有限公司 | 水下机器人多推进器耦合控制方法及*** |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5708626A (en) * | 1996-12-30 | 1998-01-13 | The United States Of America As Represented By The Secretary Of The Navy | Trajectory measurement system for underwater vehicles |
| WO2009023058A2 (en) * | 2007-05-30 | 2009-02-19 | Oceaneering International, Inc. | Hybrid remotely/autonomously operated underwater vehicle |
| CN103064296A (zh) * | 2011-10-21 | 2013-04-24 | 中国科学院沈阳自动化研究所 | 一种水下机器人辅助控制*** |
| CN104850133A (zh) * | 2015-05-18 | 2015-08-19 | 哈尔滨工程大学 | 一种模块化的rov控制*** |
| CN105549611A (zh) * | 2014-10-30 | 2016-05-04 | 中国科学院沈阳自动化研究所 | 自主水下机器人的海洋环境自识别的航迹精确跟踪方法 |
| CN105607476A (zh) * | 2016-01-04 | 2016-05-25 | 哈尔滨工程大学 | 一种作业型rov六自由度运动控制方法 |
| RU2593651C1 (ru) * | 2015-06-09 | 2016-08-10 | Федеральное государственное бюджетное учреждение науки институт океанологии им. П.П. Ширшова Российской академии наук | Гидроакустический способ определения местоположения автономного подводного аппарата |
| CN106054607A (zh) * | 2016-06-17 | 2016-10-26 | 江苏科技大学 | 水下检测与作业机器人动力定位方法 |
| CN106154835A (zh) * | 2016-08-23 | 2016-11-23 | 南京航空航天大学 | 一种基于时延估计的水下运载器终端滑模控制方法 |
-
2017
- 2017-10-17 CN CN201710964946.3A patent/CN107526369B/zh not_active Expired - Fee Related
Patent Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5708626A (en) * | 1996-12-30 | 1998-01-13 | The United States Of America As Represented By The Secretary Of The Navy | Trajectory measurement system for underwater vehicles |
| WO2009023058A2 (en) * | 2007-05-30 | 2009-02-19 | Oceaneering International, Inc. | Hybrid remotely/autonomously operated underwater vehicle |
| CN103064296A (zh) * | 2011-10-21 | 2013-04-24 | 中国科学院沈阳自动化研究所 | 一种水下机器人辅助控制*** |
| CN105549611A (zh) * | 2014-10-30 | 2016-05-04 | 中国科学院沈阳自动化研究所 | 自主水下机器人的海洋环境自识别的航迹精确跟踪方法 |
| CN104850133A (zh) * | 2015-05-18 | 2015-08-19 | 哈尔滨工程大学 | 一种模块化的rov控制*** |
| RU2593651C1 (ru) * | 2015-06-09 | 2016-08-10 | Федеральное государственное бюджетное учреждение науки институт океанологии им. П.П. Ширшова Российской академии наук | Гидроакустический способ определения местоположения автономного подводного аппарата |
| CN105607476A (zh) * | 2016-01-04 | 2016-05-25 | 哈尔滨工程大学 | 一种作业型rov六自由度运动控制方法 |
| CN106054607A (zh) * | 2016-06-17 | 2016-10-26 | 江苏科技大学 | 水下检测与作业机器人动力定位方法 |
| CN106154835A (zh) * | 2016-08-23 | 2016-11-23 | 南京航空航天大学 | 一种基于时延估计的水下运载器终端滑模控制方法 |
Non-Patent Citations (2)
| Title |
|---|
| LIU YU: "《Backstepping Based Integral Sliding Mode Control for Autonomous Underwater Vehicles》", 《PROCEEDINGS OF THE 32ND CHINESE CONTROL CONFERENCE》 * |
| 朱康武: "《作业型ROV多变景位姿鲁棒控制方法研究》", 《中国博士学位论文全文数据库工程科技辑》 * |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111913489A (zh) * | 2019-05-10 | 2020-11-10 | 欧舶智能科技（上海）有限公司 | 水下机器人多推进器耦合控制方法及*** |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107526369B (zh) | 2020-05-12 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Khodayari et al. | Modeling and control of autonomous underwater vehicle (AUV) in heading and depth attitude via self-adaptive fuzzy PID controller | |
| CN109100939B (zh) | 考虑输入饱和的水面无人艇全状态约束轨迹跟踪控制方法 | |
| Fossen et al. | Line-of-sight path following for dubins paths with adaptive sideslip compensation of drift forces | |
| Almeida et al. | Cooperative control of multiple surface vessels in the presence of ocean currents and parametric model uncertainty | |
| CN109901605A (zh) | 一种四旋翼飞行器跟踪无人水面船的控制方法 | |
| CN113433955B (zh) | 有向切换拓扑下多auv编队队形一致性控制方法 | |
| CN111487966A (zh) | 一种基于航路点的水面无人艇自适应路径跟踪控制方法 | |
| CN104881038A (zh) | 环境干扰下的水下无人航行器航迹跟踪控制优化方法 | |
| CN108267953A (zh) | 一种基于领航者-跟踪者水下机器人位置跟踪方法 | |
| Liu et al. | Model predictive controller design with disturbance observer for path following of unmanned surface vessel | |
| Hamel et al. | Transverse function control of a motorboat | |
| CN115390564A (zh) | 用于欠驱动水面无人船舶的编队控制方法、介质及设备 | |
| Gao et al. | Command filtered path tracking control of saturated ASVs based on time‐varying disturbance observer | |
| Peimin et al. | The design of gain scheduling PID controller of the USV course control system | |
| CN107526369B (zh) | 多推进器的遥控式水下机器人轨迹跟踪控制方法 | |
| Zhao et al. | Model predictive control based integral line-of-sight curved path following for unmanned aerial vehicle | |
| Fu et al. | Adaptive safety motion control for underactuated hovercraft using improved integral barrier lyapunov function | |
| CN112947448B (zh) | 一种无人船集群协同包围多目标模糊控制器结构及设计方法 | |
| CN116088309A (zh) | 一种基于故障辨识的水面船复合学习容错控制方法 | |
| Ding et al. | Based on disturbance observer of Air Cushion Vehicle course sliding backstepping control | |
| Yuan et al. | Combined depth and heading control and experiment of ROV under the influence of residual buoyancy, current disturbance, and control dead zone | |
| Liu et al. | Active disturbance rejection path following control of USV based on fuzzy optimization | |
| Li et al. | Adaptive tracking control of underactuated USV based on back-stepping and RBF neural network | |
| Li et al. | Path following control of the asymmetric USV via backsteppin sliding mode technique | |
| Ma et al. | Fixed-time sliding-mode reaching based trajectory tracking control of unmanned underwater vehicles |
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 | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200512 Termination date: 20201017 |
|
| CF01 | Termination of patent right due to non-payment of annual fee |