CN107894775B - 一种欠驱动无人水下航行器轨迹生成与控制方法 - Google Patents

一种欠驱动无人水下航行器轨迹生成与控制方法 Download PDF

Info

Publication number
CN107894775B
CN107894775B CN201710962628.3A CN201710962628A CN107894775B CN 107894775 B CN107894775 B CN 107894775B CN 201710962628 A CN201710962628 A CN 201710962628A CN 107894775 B CN107894775 B CN 107894775B
Authority
CN
China
Prior art keywords
coordinate system
control
underwater vehicle
matrix
attitude
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
CN201710962628.3A
Other languages
English (en)
Other versions
CN107894775A (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.)
Institute of Acoustics CAS
Original Assignee
Institute of Acoustics CAS
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 Institute of Acoustics CAS filed Critical Institute of Acoustics CAS
Priority to CN201710962628.3A priority Critical patent/CN107894775B/zh
Publication of CN107894775A publication Critical patent/CN107894775A/zh
Application granted granted Critical
Publication of CN107894775B publication Critical patent/CN107894775B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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/08—Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0875—Control of attitude, i.e. control of roll, pitch, or yaw 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)
  • External Artificial Organs (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及一种欠驱动无人水下航行器轨迹生成与控制方法，包括：建立水下航行器的运动学以及动力学模型，并引入单位四元数对姿态进行描述；在已知三维参考位置信息的条件下，设计轨迹生成器，生成姿态指令信息；设计控制器，用于跟踪所述参考位置信息和所述姿态信息。本发明基于单位四元数提出了一种轨迹生成方法，根据已知的位置信息生成了6自由度的参考轨迹，最后设计控制器对所生成的轨迹进行跟踪，并证明闭环系统的稳定性。

Description

一种欠驱动无人水下航行器轨迹生成与控制方法
技术领域
本发明涉及无人水下航行器领域，涉及一种欠驱动无人水下航行器轨迹生成与控制方法。
背景技术
无人水下航行器已经在海洋救助、资源勘探、水文观测、水下测量、水下管道检修、工程施工等领域得到了大量的应用，而且在军事领域也具有广泛的应用前景。随着应用的领域的增加，许多复杂的任务要求水下航行器具有更好的控制性能，从而可以应对水下复杂的环境，因此水下航行器的控制器设计得到了大量的研究。
大部分文献所提出的无人水下航行器模型多为3自由度的平面模型或者是忽略滚转方向的5自由度模型，而实际的水下航行器是一个3维空间的6自由度模型，在许多情况下无法线性化为更简单的模型来考虑，因此6自由度的水下航行器模型的控制器设计更具有实际工程意义；此外，现有技术使用欧拉角来对姿态进行描述，不仅引入了正弦余弦的非线性运算，而且还会导致姿态奇异现象的发生，使得控制器失效；最后，大部分技术是基于全驱动的水下航行器的模型，而通常在水下环境中，要求水下航行器的结构紧凑，节省能量与成本，此时可以使航行器在某个自由度上没有控制器，形成欠驱动系统；而且，当全驱动航行器在某个自由度上控制器发生故障时就会退化为欠驱动系统，因此研究欠驱动水下航行器的控制系统既可以简化水下航行器的结构设计，又能够为全驱动水下航行器提供一种冗余的控制方法，增强航行器水下行驶的可靠性。
发明内容
针对上述问题，本发明考虑了更复杂的6自由度欠驱动水下航行器的控制模型，更具有实际的意义；引入了单位四元数来对姿态进行描述，可以避免奇异现象同时提高运算效率。此外，由于欠驱动系统内部固有的约束，在已知三维位置参考信息的情况下如何得到姿态指令信息也是一个难点，本发明基于单位四元数提出了一种欠驱动无人水下航行器轨迹生成与控制方法，根据已知的位置信息生成了6自由度的参考轨迹，最后设计控制器对所生成的轨迹进行跟踪，并证明闭环系统的稳定性。
为实现上述目的，本发明一方面提供了一种欠驱动无人水下航行器轨迹生成与控制方法，包括：建立水下航行器的运动学以及动力学模型，并引入单位四元数对姿态进行描述；在已知三维参考位置信息的条件下，设计轨迹生成器，生成姿态指令信息；设计控制器，用于跟踪所述参考位置信息和所述姿态信息。
优选地，所述无人水下航行器模型包括运动学模型、动力学模型，其表达式为：
运动学表达式：
Figure BDA0001435591400000021
其中，η1为航行器浮心在惯性坐标系下的位置坐标，单位四元数Q为机体坐标系{B}相对于惯性坐标系{E}的姿态,
Figure BDA0001435591400000022
动力学表达式：
Figure BDA0001435591400000023
其中，M包含附加质量的惯性矩阵，C(v)由科氏力矩阵CRB(v)与向心力矩阵CA(v)组成，D(v)为流体水动力阻尼矩阵，G(η)为恢复力与力矩向量。
优选地，基于四元数对姿态的描述，航行器动力学方程变换成位置动力学方程和姿态动力学方程，其表达式为：
位置动力学方程：
Figure BDA0001435591400000031
其中，
Figure BDA0001435591400000032
Figure BDA0001435591400000033
W为航行器受到的重力，B为航行器所产生的浮力，N代表航行器沿着本体坐标系b1方向的控制推力；
姿态动力学方程：
Figure BDA0001435591400000034
其中，M22是M质量惯性矩阵的一个分量，C21(v1)和C22(v2)是C(v)的两个分量，D22(v2)是D(v)流体水动力阻尼矩阵的一个分量，
Figure BDA0001435591400000035
为重心相对于浮心在本体坐标系下的位置坐标，Γ＝(Γ1,Γ2,Γ3)T为控制力矩。
优选地，所述轨迹生成器生成理想姿态指令信息为：
Figure BDA0001435591400000036
其中，
Figure BDA0001435591400000037
优选地，所述控制器包括控制推力和控制力矩，其表达式为：
控制推力：
Figure BDA0001435591400000038
F＝(F1,F2,F3)T
Figure BDA0001435591400000039
Figure BDA0001435591400000041
其中，
Figure BDA0001435591400000042
k1，c1为大于零的控制增益；
控制力矩：
Figure BDA0001435591400000043
Figure BDA0001435591400000044
其中，辅助控制量设计为
Figure BDA0001435591400000045
kQ，k2，kβ为大于零的控制增益。
优选地，所述控制推力跟踪所述参考位置信息，所述控制力矩来跟踪所述姿态信息。
优选地，所述无人水下航行器模型为6自由度欠驱动水下航行器的控制模型。
本发明建立基于单位四元数的6自由度欠驱动水下航行器的模型，模型更加精确，符合实际的应用；利用单位四元数对姿态进行描述，提高了计算效率，避免了奇异现象；设计了轨迹生成的方法，可以得到姿态子系统的参考姿态信息；所提出的控制器的闭环稳定性得到了证明。
附图说明
为了更清楚地说明本发明实施例的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍。显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1为欠驱动无人水下航行器轨迹生成与控制方法流程示意图；
图2为本发明实施例欠驱动水下航行器结构图；
图3为本发明实施例欠驱动水下航行器三维轨迹跟踪效果图；
图4为本发明实施例欠驱动水下航行器姿态指令qd1、qd2、qd3和λd生成与跟踪图。
具体实施方式
下面通过附图和实施例，对本发明的技术方案做进一步的详细描述。
图1为欠驱动无人水下航行器轨迹生成与控制方法流程示意图。如图1所示，本发明提供一种欠驱动无人水下航行器轨迹生成与控制方法，其具体步骤包括：
步骤S101，建立水下航行器的运动学以及动力学模型，并引入单位四元数对姿态进行描述。
建立欠驱动无人水下航行器模型，定义北东地{E}＝[e1,e2,e3]T为惯性坐标系，e1＝[1,0,0]T,e2＝[0,1,0]T,e3＝[0,0,1]T为惯性坐标系{E}在x，y，z方向上的单位向量；{B}＝[b1,b2,b3]T为本体坐标系b1＝[1,0,0]T,b2＝[0,1,0]T,b3＝[0,0,1]T为本体坐标系{B}在x，y，z方向上的单位向量。本体坐标系{B}的原点与航行器的浮心CB重合rb＝(0,0,0)T，为了产生恢复力矩，航行器的重心CM在b3的正半轴，重心在本体坐标系下的坐标为rg＝(0,0,zg)T。
定义如下变量来描述航行器的运动状态：
Figure BDA0001435591400000051
η1＝[x,y,z]T，Q＝[q1,q2,q3,λ]T；
Q＝[qT,λ]T，q＝(q1,q2,q3)T；
Figure BDA0001435591400000052
v1＝[u,v,w]T，v2＝[p,q,r]T；
其中，η1为航行器浮心在惯性坐标系下的位置坐标，单位四元数Q为机体坐标系{B}相对于惯性坐标系{E}的姿态。v1为航行器浮心在机体坐标系{B}中的线速度大小，v2为机体坐标系{B}相对于惯性坐标系{E}的角速度大小在机体坐标系{B}中的投影。
定义单位四元数为
Figure BDA0001435591400000061
其中称q＝(q1,q2,q3)T∈R3为单位四元数矢量部分，称
Figure BDA0001435591400000062
为单位四元数标量部分，单位四元数的各个分量满足qTq+λ2＝1。
Figure BDA0001435591400000063
为从惯性坐标系到本体坐标系的旋转矩阵，利用Rodrigues定理，可以得到由单位四元数表示的本体系{B}相对于惯性系{E}的旋转矩阵为
Figure BDA0001435591400000064
其中I3×3为三阶的单位对角矩阵，||·||为向量欧式范数。S(×)为3×3斜对称矩阵，对于一个三维的列向量a＝(a1,a2,a3)T，其斜对称矩阵可以表示为：
Figure BDA0001435591400000065
由单位四元数表示的从本体坐标系{B}到惯性坐标系{E}的旋转矩阵为
Figure BDA0001435591400000066
满足||R(Q)||＝1。
将式(2)展开可得
Figure BDA0001435591400000067
则航行器在机体坐标系{B}与在惯性坐标系{E}中的线速度矢量满足
Figure BDA0001435591400000068
水下航行器结构如图1所示，其运动学以及动力学微分方程表示为
Figure BDA0001435591400000069
Figure BDA0001435591400000071
其中，
Figure BDA0001435591400000072
M包含附加质量的惯性矩阵，定义为
Figure BDA0001435591400000073
Figure BDA0001435591400000074
Figure BDA0001435591400000075
其中，m为航行器的质量，
Figure BDA0001435591400000076
为航行器的转动惯量；
Figure BDA0001435591400000077
Figure BDA0001435591400000078
Figure BDA0001435591400000079
为关于附加质量的流体参数。
C(v)由科氏力矩阵CRB(v)与向心力矩阵CA(v)组成，定义为
Figure BDA00014355914000000710
其中，
Figure BDA00014355914000000711
为重心相对于浮心在本体坐标系下的位置坐标。
D(v)为流体水动力阻尼矩阵，定义为
Figure BDA00014355914000000712
其中，Xu,Yv,Zw,Kp,Mq,Nr,X|u|u,Y|v|v,Z|w|w,K|p|p,M|q|q,N|r|r为关于阻力的流体参数。
G(η)为恢复力与力矩向量，定义为
Figure BDA0001435591400000081
其中，W为航行器受到的重力，B为航行器所产生的浮力。
控制输入定义为
τ＝(N,0,0,Γ1,Γ2,Γ3)T (10)
其中N代表航行器沿着本体坐标系b1方向的控制推力，Γ＝(Γ1,Γ2,Γ3)T为控制力矩，控制力矩与三个控制舵δ＝(δrb,δlb,δr)T的关系满足Γ＝M(u)δ，
Figure BDA0001435591400000082
根据式(6)-(10)，可将式(5)展开为
Figure BDA0001435591400000083
Figure BDA0001435591400000084
由式(4)可知
Figure BDA0001435591400000085
代入式(12)可得惯性坐标系下的位置坐标动力学方程为
Figure BDA0001435591400000086
可得
Figure BDA0001435591400000091
Figure BDA0001435591400000092
变换后的方程式(16)为惯性坐标系下的位置坐标动力学方程，称为位置子系统，式(17)为本体坐标系下的姿态动力学方程，称为姿态子系统。
步骤S102，在已知三维参考位置信息的条件下，设计轨迹生成器，生成姿态指令信息。
由上述航行器动力学微分方程以及控制输入(10)可知，位置子系统(16)为欠驱动系统，在横向b2与升沉b3方向没有执行器产生控制量。观察式(17)可知，控制输入为Γ，系统状态变量为Q，因此姿态子系统是全驱动的。为了使系统能够跟踪一个三维的理想位置坐标轨迹
Figure BDA0001435591400000093
姿态信息需要作为额外的控制量，使得式(16)的控制推力扩展为一个三维的控制输入来跟踪已知的理想位置坐标轨迹，生成一个被约束的理想姿态信息以作为姿态子系统的参考轨迹，并设计控制力矩来跟踪所生成的理想姿态信息。
定义
Figure BDA0001435591400000094
为所生成的理想姿态信息，根据上述的思路，可将式(16)改写为
Figure BDA0001435591400000095
其中，
F:＝NR(Qd)Tb1 (19)
为推力与理想姿态信息所合成的三维控制力，
Figure BDA0001435591400000096
为理想姿态与实际姿态之间的误差对位置子系统所造成的影响，可以求得
Figure BDA0001435591400000097
为
Figure BDA0001435591400000098
设推力与理想姿态所合成的控制力的三维分量为F＝(F1,F2,F3)T，可以通过已知的F的信息反解出实际的推力N与理想姿态信息Qd。
将式(19)展开为
Figure BDA0001435591400000101
观察式(21)可知未知量有N与Qd共5个，又已知单位四元数满足
Figure BDA0001435591400000102
因此式(21)具有4个待求的量，而方程组是三维的，解有无穷多个。为了得到唯一的一组解，可将Qd的某个分量固定。由于航行器在行驶过程中要求滚转方向不能有太大的变化，因此对滚转方向进行约束，令qd1＝0，并根据式(22)，可将式(21)写为
Figure BDA0001435591400000103
将式(23)前两行的平方相加，可得
Figure BDA0001435591400000104
通过配方法可以解出
Figure BDA0001435591400000105
根据式(23)第一行可知，
Figure BDA0001435591400000106
因此可得
Figure BDA0001435591400000107
从而可以得到实际的控制推力为
Figure BDA0001435591400000108
将式(26)代入式(25)可以解出λd为
Figure BDA0001435591400000109
根据式(23)后两行与式(26)-(27)，可以解出qd为
Figure BDA0001435591400000111
进而得到通过理想姿态可以得到理想角速度为
Figure BDA0001435591400000112
根据上述步骤，利用已知的合成控制力F可以生成理想的姿态信息，结合已知的理想位置信息
Figure BDA0001435591400000113
可以得到最终系统状态的目标轨迹pd与Qd，并设计控制推力N与控制力矩Γ对所生成的轨迹进行跟踪。
步骤S103，设计控制器，用于跟踪所述参考位置信息和所述姿态信息。
控制器包括控制推力和控制力矩，控制推力来跟踪参考位置信息，控制力矩来跟踪姿态信息。
(1)控制推力N的设计
注意到N是一维控制推力，作用在三维的位置子系统上，因此N与系统状态并不是一一对应的，上述性质使直接对N进行设计具有一定的难度。而通过式(26)可知N与三维合成控制力F的对应关系，因此对推力N的设计可以首先转化为对F的设计，在得到F的表达式后根据式(26)可以得到实际的控制推力N。
位置子系统给定的参考轨迹为
Figure BDA0001435591400000114
可以得到位置误差为
Figure BDA0001435591400000115
速度误差为
Figure BDA0001435591400000116
加速度误差为
Figure BDA0001435591400000117
将上述位置误差表达式代入位置子系统微分方程(18)可得
Figure BDA0001435591400000118
将上式展开得
Figure BDA0001435591400000119
Figure BDA0001435591400000121
设计中间控制律为
Figure BDA0001435591400000122
其中
Figure BDA0001435591400000123
Figure BDA0001435591400000124
k1，c1为大于零的控制增益。
(2)控制力矩Γ的设计
通过式(32)以及姿态信息可以生成姿态子系统的目标轨迹Qd与ωd。利用单位四元数的运算关系，可得本体坐标系与理想坐标系之间的姿态误差以及角速度误差为
Figure BDA0001435591400000125
其中
Figure BDA0001435591400000126
Figure BDA0001435591400000127
为理想坐标系到机体坐标系的旋转矩阵，其导数关系满足
Figure BDA0001435591400000128
将上述姿态误差表达式代入姿态子系统微分方程(17)可得
Figure BDA0001435591400000129
设计控制力矩为
Figure BDA00014355914000001210
Figure BDA0001435591400000131
辅助控制量设计为
Figure BDA0001435591400000132
其中，
Figure BDA0001435591400000133
kQ，k2，kβ为大于零的控制增益。
根据提出的控制器，关于其稳定性分析：
利用Lyapunov理论对闭环系统进行稳定性分析，定义如下Lyapunov函数
Figure BDA0001435591400000134
其中，
Figure BDA0001435591400000135
根据单位四元数运算关系可知
Figure BDA0001435591400000136
Figure BDA0001435591400000137
对式(39)求导可得
Figure BDA0001435591400000138
展开得到
Figure BDA0001435591400000139
注意到
Figure BDA00014355914000001310
为斜对称矩阵，因此
Figure BDA00014355914000001311
最终可得
Figure BDA0001435591400000141
将所设计的位置子系统控制律式(32)-(33)以及姿态子系统控制律式(36)-(38)代入式(42)可得
Figure BDA0001435591400000142
可知
Figure BDA0001435591400000143
s1，
Figure BDA0001435591400000144
s2是有界的。又因为
Figure BDA0001435591400000145
有界，可知
Figure BDA0001435591400000146
一致连续。根据Barbalat引理可知
Figure BDA0001435591400000147
因此s1→0，
Figure BDA0001435591400000148
s2→0，状态误差渐进收敛，即η1→pd，
Figure BDA0001435591400000149
Q→Qd，v2→ωd。
所提出的控制器的闭环稳定性得到了证明。
实施例
航行器质量为m＝5400kg；重力加速度为g＝9.8m/s2；惯性矩阵为Io＝diag(2038,13587,13587)kg·m2，水的密度为ρ＝1000kg/m3,航行器长度为L＝5.3m；
关于附加质量的流体参数为：
Figure BDA00014355914000001410
Figure BDA00014355914000001411
重心在本体系的坐标为：
Figure BDA00014355914000001412
关于阻力的流体参数为：
Xu＝0kg/s,Yv＝-1404.5kg/s,Zw＝-4213.5kg/s,Kp＝-4399.76kg·m/s,Mq＝-14045.05kg·m/s,Nr＝-6312.38kg·m/s，
X|u|u＝-30.9kg/m,Y|v|x＝-206.5kg/m,Z|w|w＝-338.1kg/m,K|p|p＝0kg·m,M|q|q＝-214.66kg·m,N|r|r＝-346.26kg·m；
舵与力矩的对应参数为：Kdb＝5.7×10-4,Mab＝3.5×10-3,Ndr＝-1.3×10-2；
控制增益为：k1＝10，c1＝5，kQ＝20，k2＝40，kβ＝10。
系统变量初始状态为η1(0)＝(1,1,7)Tm，
Figure BDA0001435591400000151
q(0)＝(0.5,0.5,0.5)T，λ(0)＝1，v2(0)＝(0,0,0)Trad/s。
参考轨迹为：pd＝(-2.5πcos(t/2π),1.25πcos(t/2π),-2t)Tm，为使航行器螺旋下潜的指令。
仿真结果如图3所示，在航行器三维轨迹跟踪中航行器实际轨迹与参考轨迹基本重合，说明仿真效果比较好。
图4为姿态指令qd1、qd2、qd3和λd跟踪效果图。如图4所示，欠驱动无人水下航行器的仿真姿态信息与理想姿态信息也基本吻合。
根据图3-图4可以看出本发明提出的方法能很好对无人水下航行器的轨迹信息和姿态信息进行跟踪。
以上所述的具体实施方式，对本发明的目的、技术方案和有益效果进行了进一步详细说明，所应理解的是，以上所述仅为本发明的具体实施方式而已，并不用于限定本发明的保护范围，凡在本发明的精神和原则之内，所做的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (6)

1.一种欠驱动无人水下航行器轨迹生成与控制方法，其特征在于，包括：
建立水下航行器的运动学以及动力学模型，并引入单位四元数对姿态进行描述；
在已知三维参考位置信息的条件下，设计轨迹生成器，生成姿态指令信息,方法为:以姿态信息需要作为额外的控制量，生成一个被约束的理想姿态信息以作为动力学模型姿态子系统的参考轨迹；
设计控制器，用于跟踪所述参考位置信息和所述姿态信息；使用控制推力跟踪所述参考位置信息，控制力矩来跟踪所述姿态信息。
2.如权利要求1所述的无人水下航行器轨迹生成与控制方法，其特征在于，所述无人水下航行器模型包括运动学模型、动力学模型，其表达式为：
运动学表达式：
Figure FDA0002571653410000011
其中，η1为航行器浮心在惯性坐标系下的位置坐标，定义单位四元数为
Figure FDA0002571653410000012
其中称
Figure FDA0002571653410000013
为单位四元数矢量部分，称
Figure FDA0002571653410000014
为单位四元数标量部分，v1为航行器浮心在机体坐标系{B}中的线速度大小，v2为机体坐标系{B}相对于惯性坐标系{E}的角速度大小在机体坐标系{B}中的投影,
Figure FDA0002571653410000015
为从惯性坐标系到本体坐标系的旋转矩阵,
Figure FDA0002571653410000016
I3×3为三阶的单位对角矩阵，S(×)为3×3斜对称矩阵；
动力学表达式：
Figure FDA0002571653410000017
其中，M包含附加质量的惯性矩阵，C(v)由科氏力矩阵CRB(v)与向心力矩阵CA(v)组成，D(v)为流体水动力阻尼矩阵，G(η)为恢复力与力矩向量,τ为控制输入,
Figure FDA0002571653410000021
为一阶导数。
3.如权利要求2所述的无人水下航行器轨迹生成与控制方法,其特征在于，基于四元数对姿态的描述，航行器动力学方程变换成位置动力学方程和姿态动力学方程，其表达式为：
位置动力学方程：
Figure FDA0002571653410000022
其中，
Figure FDA0002571653410000023
Figure FDA0002571653410000024
W为航行器受到的重力，B为航行器所产生的浮力，N代表航行器沿着本体坐标系b1方向的控制推力,M11是M质量惯性矩阵的一个分量,C12(v1)是C(v)的一个分量,D11(v1)是D(v)的一个分量,e3为惯性坐标系{E}在z方向上的单位向量；
姿态动力学方程：
Figure FDA0002571653410000025
其中，M22是M质量惯性矩阵的一个分量，C21(v1)和C22(v2)是C(v)的两个分量，D22(v2)是D(v)流体水动力阻尼矩阵的一个分量，
Figure FDA0002571653410000026
为重心相对于浮心在本体坐标系下的位置坐标，Γ＝(Γ1,Γ2,Γ3)T为控制力矩。
4.如权利要求1所述的无人水下航行器轨迹生成与控制方法，其特征在于，
定义单位四元数为
Figure FDA0002571653410000027
其中称
Figure FDA0002571653410000028
为单位四元数矢量部分，称
Figure FDA0002571653410000029
为单位四元数标量部分,定义
Figure FDA00025716534100000210
Figure FDA00025716534100000211
为所生成的理想姿态信息。
5.如权利要求1所述的无人水下航行器轨迹生成与控制方法，其特征在于，所述控制器包括控制推力和控制力矩，其表达式为：
控制推力：
Figure FDA0002571653410000031
F＝(F1,F2,F3)T
Figure FDA0002571653410000032
其中,N是一维控制推力,F为三维合成控制力,F1、F2、F3为其分量，
Figure FDA0002571653410000033
Figure FDA0002571653410000034
k1，c1为大于零的控制增益，
Figure FDA0002571653410000035
为三维的理想位置坐标轨迹，其中,
Figure FDA0002571653410000036
为理想坐标轨迹pd的一阶、二阶导数；
控制力矩：
Figure FDA0002571653410000037
Figure FDA0002571653410000038
其中，辅助控制量设计为
Figure FDA0002571653410000039
kQ，k2，kβ为大于零的控制增益，ωd为理想角速度；η1为航行器浮心在惯性坐标系下的位置坐标，定义单位四元数为
Figure FDA00025716534100000310
其中称
Figure FDA00025716534100000311
为单位四元数矢量部分，称
Figure FDA00025716534100000312
为单位四元数标量部分，v1为航行器浮心在机体坐标系{B}中的线速度大小，v2为机体坐标系{B}相对于惯性坐标系{E}的角速度大小在机体坐标系{B}中的投影,
Figure FDA00025716534100000313
为从惯性坐标系到本体坐标系的旋转矩阵，S(×)为3×3斜对称矩阵,M22是M质量惯性矩阵的一个分量，C21(v1)和C22(v2)是C(v)的两个分量，D22(v2)是D(v)流体水动力阻尼矩阵的一个分量，
Figure FDA00025716534100000314
为重心相对于浮心在本体坐标系下的位置坐标，e3为惯性坐标系{E}在z方向上的单位向量。
6.如权利要求1所述的无人水下航行器轨迹生成与控制方法，其特征在于，所述无人水下航行器为6自由度欠驱动水下航行器。
CN201710962628.3A 2017-10-16 2017-10-16 一种欠驱动无人水下航行器轨迹生成与控制方法 Active CN107894775B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710962628.3A CN107894775B (zh) 2017-10-16 2017-10-16 一种欠驱动无人水下航行器轨迹生成与控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710962628.3A CN107894775B (zh) 2017-10-16 2017-10-16 一种欠驱动无人水下航行器轨迹生成与控制方法

Publications (2)

Publication Number Publication Date
CN107894775A CN107894775A (zh) 2018-04-10
CN107894775B true CN107894775B (zh) 2020-08-28

Family

ID=61802797

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710962628.3A Active CN107894775B (zh) 2017-10-16 2017-10-16 一种欠驱动无人水下航行器轨迹生成与控制方法

Country Status (1)

Country Link
CN (1) CN107894775B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108873925B (zh) * 2018-08-02 2021-08-24 深圳市吉影科技有限公司 一种水下无人机的定俯仰角运动控制方法及其装置
CN111781938B (zh) * 2020-06-23 2021-06-18 中国科学院声学研究所 欠驱动水下航行器及其镇定方法与装置
CN115576334B (zh) * 2022-09-07 2023-05-02 中国科学院声学研究所 一种欠驱动水下航行器编队控制方法及系统
CN115357037B (zh) * 2022-09-14 2023-05-09 中国科学院声学研究所 一种水下航行器自适应量化控制方法及系统

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105841698B (zh) * 2016-03-28 2018-10-26 中国船舶重工集团公司第七一〇研究所 一种无需调零的auv舵角精确实时测量系统
CN105929842B (zh) * 2016-04-20 2019-01-11 哈尔滨工程大学 一种基于动态速度调节的欠驱动uuv平面轨迹跟踪控制方法
CN107168312B (zh) * 2017-05-17 2019-12-06 哈尔滨工程大学 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法

Also Published As

Publication number Publication date
CN107894775A (zh) 2018-04-10

Similar Documents

Publication Publication Date Title
Hu et al. Adaptive sliding mode tracking control for a flexible air-breathing hypersonic vehicle
CN107894775B (zh) 一种欠驱动无人水下航行器轨迹生成与控制方法
CN110308735B (zh) 一种针对输入时滞的欠驱动uuv轨迹跟踪滑模控制方法
Mokhtari et al. Disturbance observer based hierarchical control of coaxial-rotor UAV
CN103488814B (zh) 一种适用于再入飞行器姿态控制的闭环仿真系统
Crowther et al. Kinematic analysis and control design for a nonplanar multirotor vehicle
Zhang et al. Extended state observer based robust adaptive control on SE (3) for coupled spacecraft tracking maneuver with actuator saturation and misalignment
Tang et al. Nonlinear dynamic modeling and hybrid control design with dynamic compensator for a small-scale UAV quadrotor
Liu et al. Prescribed performance tracking control of a free-flying flexible-joint space robot with disturbances under input saturation
CN112241125A (zh) 一种基于微分平坦特性的无人机轨迹跟踪方法
Wang et al. Nonlinear aeroelastic control of very flexible aircraft using model updating
CN111857165B (zh) 一种水下航行器的轨迹跟踪控制方法
Bhat et al. Real-Time Flight Simulation of Hydrobatic AUVs Over the Full 0$^{\circ} $–360$^{\circ} $ Envelope
Geder et al. Fuzzy logic PID based control design and performance for a pectoral fin propelled unmanned underwater vehicle
Liu et al. Continuous dynamic simulation for morphing wing aeroelasticity
Dong et al. Hamiltonian formulation with reduced variables for flexible multibody systems under linear constraints: Theory and experiment
Ferreira et al. Control of the MARES autonomous underwater vehicle
Worrall et al. Autonomous planetary rover control using inverse simulation
Mehta et al. Nonlinear control of hypersonic missiles for maximum target penetration
Dounia et al. Trajectory tracking performance with two nonlinear controllers of quadrotor under wind effect
Razzanelli et al. Development of a Hybrid Simulator for Underwater Vehicles With Manipulators
Tuzcu et al. Aeroelastic modeling and adaptive control of GTM
Morton et al. Generalized trajectory control for tree-structured aerial manipulators
Sahoo et al. Adaptive fuzzy pid controller for a compact autonomous underwater vehicle
Gunes et al. Stabilizer Autopilot Design For Fixed Wing UAV Using ODSMC

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