CN103942383A - 一种深海作业型水下机器人的动力学和运动学估计方法 - Google Patents
一种深海作业型水下机器人的动力学和运动学估计方法 Download PDFInfo
- Publication number
- CN103942383A CN103942383A CN201410153093.1A CN201410153093A CN103942383A CN 103942383 A CN103942383 A CN 103942383A CN 201410153093 A CN201410153093 A CN 201410153093A CN 103942383 A CN103942383 A CN 103942383A
- Authority
- CN
- China
- Prior art keywords
- rov
- centerdot
- operation type
- matrix
- dynamics
- 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 32
- 239000011159 matrix material Substances 0.000 claims abstract description 93
- 239000012530 fluid Substances 0.000 claims abstract description 17
- 230000003068 static effect Effects 0.000 claims abstract description 13
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 8
- 230000005484 gravity Effects 0.000 claims description 26
- 238000013016 damping Methods 0.000 claims description 18
- 238000006243 chemical reaction Methods 0.000 claims description 14
- 230000001133 acceleration Effects 0.000 claims description 6
- 238000006073 displacement reaction Methods 0.000 claims description 4
- 230000003287 optical effect Effects 0.000 claims description 4
- 239000013535 sea water Substances 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 9
- 238000011160 research Methods 0.000 description 7
- 230000007704 transition Effects 0.000 description 7
- 230000033228 biological regulation Effects 0.000 description 4
- 230000008878 coupling Effects 0.000 description 4
- 238000010168 coupling process Methods 0.000 description 4
- 238000005859 coupling reaction Methods 0.000 description 4
- 238000012546 transfer Methods 0.000 description 4
- 238000013519 translation Methods 0.000 description 4
- 238000004458 analytical method Methods 0.000 description 3
- 238000013461 design Methods 0.000 description 3
- 238000009434 installation Methods 0.000 description 3
- 210000000476 body water Anatomy 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 238000005094 computer simulation Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000013178 mathematical model Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000009966 trimming Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 238000013139 quantization Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及深海作业型ROV技术领域,具体地说是一种深海作业型水下机器人的动力学和运动学估计方法。本发明包括:建立定坐标系、随体坐标系和推进器坐标系,估计六自由度坐标转换矩阵;估计作业型水下机器人质量矩阵以及引起的柯氏力和向心力矩阵;估计作业型ROV所受水动力;估计作业型ROV所受静力;估计作业型ROV推力;估计未知干扰项;确定作业型ROV最终的动力学和运动学模型。本发明利用动力学、流体力学和潜艇操纵性等理论进行深海作业型ROV的动力学和运动学建模,针对水下潜器复杂的数学模型,利用对称理论和小量忽略的方法对深海作业型ROV的数学模型进行简化,所建立的模型可以更精确的估计ROV受力情况。
Description
技术领域
本发明涉及深海作业型ROV技术领域,具体地说是一种深海作业型水下机器人的动力学和运动学估计方法。
背景技术
ROV的动力学和运动学模型体现了ROV的运动规律,是水下机器人对于环境和系统信息的一种量化表示,对于水下机器人感知层体系结构中的信息处理技术、环境感知以及指令理解都是重要的参考。研究潜水器在水中受到各种力矩以及力影响下的运动规律,从而建立潜水器的运动方程,是研究其控制系统的基础。但是,如果模型过于复杂,则会导致控制系统很复杂,甚至不能实现;如果模型过于简单,就不能真实反映系统的运动,导致控制性能下降。因此,建立水下机器人空间动力学方程,并适当简化,对于研究水下机器人的控制来说十分重要。
ROV数学模型包括动力学模型和运动学模型,是基于动力学、流体力学和潜艇操纵性等理论建立起来的多变量微分方程组。
1967年美国泰勒海军舰船研究和发展中心(DTNSRDC)发表的《用于潜艇模拟研究的标准运动方程》及1979年修正的潜艇标准运动方程,已经广泛应用于水下潜器建模等方面。但是,方程中含有上百个水动力系数,要获得全部的水动力系数是非常困难的,这就需要对方程进行合理的简化。
作业型ROV普遍使用大功率液压推进系统,液压推进系统作为执行器,其模型的精确程度对最终的控制性能有着直接的影响。实际工程中,推进器的安装角度、位置以及推进器的推力矢量都存在着误差。而在绝大多数水下运载器建模方法的研究中,均忽略了推进系统的安装误差以及推力矢量误差,只是将推进系统推力以及力矩作为理想的固定常数处理,这样的处理方式会对ROV的操纵性能以及稳定性控制等都会产生影响。
发明内容
本发明目的在于提供一种用于实现深海作业型ROV动力学和运动学建模,更适用于深海作业型ROV深海作业型水下机器人的动力学和运动学估计方法。
本发明的目的是这样实现的:
(1)建立定坐标系、随体坐标系和推进器坐标系,估计六自由度坐标转换矩阵;
(2)估计作业型水下机器人质量矩阵以及引起的柯氏力和向心力矩阵;
(3)估计作业型ROV所受水动力;
(4)估计作业型ROV所受静力;
(5)估计作业型ROV推力;
(6)估计未知干扰项;
(7)确定作业型ROV最终的动力学和运动学模型。
所述步骤(1)包括:
(1)建立定坐标系:原点E确定在一定点,Eξ轴位于水平面,并以水下机器人主航向为正向;Eη轴位于Eξ轴所在的水平面,按右手法则将Eξ轴顺时针旋转90°,即Eζ轴垂直于ξEη坐标平面,指向地心为正;
(2)建立随体坐标系:纵轴OX平行于潜水器主体基线,指向艏部为正;横轴OY平行于基线面,指向右舷为正;垂轴OZ位于潜水器主体中纵剖面内,指向底部为正;
(3)建立推进器坐标系:设定推进器中心的具体位置,作为推进器坐标系的原点,推进器坐标系的纵轴OiXi与随动坐标系的纵轴正方向成角度α,根据右手定则OiZi的方向向下,OiYi垂直于XiOiZi面;
(4)计算六自由度坐标转换矩阵:
其中:
φ为艏向角;θ为纵倾角;ψ为横倾角。
所述步骤(2)包括:
(1)计算作业型水下机器人的质量矩阵:
作业型水下机器人质量引起的柯氏力和向心力矩阵:
m为作业型ROV的质量;[xG yG zG]T为作业型ROV重心坐标;Ix、Iy、Iz为ROV绕X、Y、Z三轴的转动惯量,而Ixy、Iyx、Ixz、Izx、Iyz、Izy则为惯性积;
(2)根据对称面原理和小量忽略的方法可将质量矩阵和柯氏力向心力矩阵进行化简作业型水下机器人的质量矩阵:
作业型水下机器人质量引起的柯氏力和向心力矩阵:
所述步骤(3)包括:
(1)计算惯性类水动力系数矩阵以及流体惯性力引起的柯氏力和向心力矩阵:
化简为:
(2)计算流体粘性力系数矩阵
总的粘性水动力阻尼矩阵D(v)分解为线性水动力阻尼矩阵DL(v)和非线性水动力阻尼矩阵DNL(v)之和:
D(v)=DL(v)+DNL(v)
所述步骤(4)包括:
计算作业型水下机器人所受重力W=mg;计算作业型ROV所受浮力,ρ为海水密度,g为重力加速度,为ROV排水体积,则静力模型为:
式中[xC yC zC]T为ROV浮心坐标,ROV通过配重可以将随动坐标系原点与ROV重心重合,则:
所述的步骤(5)包括:
(1)计算随动坐标系到第i个推进器坐标系的包含误差项的坐标转换矩阵
(2)计算推力:
第i个推进器的推力作用在ROV上的力为:
式中fi为推进器的实际推力大小;
(3)计算含有误差项的推力力矩:
式中 为第i个推进器的推力作用在ROV上的力的三个分量;
(4)作业型ROV的推力为:
所述步骤(6):深海作业型ROV所受外界的未知干扰项包括海流的影响、光缆的拖拽力和作业机械手的反冲力,用有界的六自由度力/力矩△f表示。
所述步骤(7)作业型ROV最终的动力学和运动学模型为:
本发明的有益效果在于:
本发明应用动力学、流体力学和潜艇操纵性等理论建立ROV动力学和运动学模型;对ROV的受力分析较为完全,对所受力和力矩的计算较为准确;结构简明,各步骤清晰任务明确,易于理解和便于数学模型的复查、查错;根据相关理论和深海作业型ROV的物理结构特征,利用相关原理和可简化条件,简化了深海作业型ROV的动力学和运动学模型。在可以非常好地表现近似真实的ROV受力情况的基础上,使得深海作业型ROV的模型更加简单明了,降低了模型建立的难度,也为以后的控制设计提供了方便;克服传统ROV建模设计中对推进系统安装误差的忽略,将推进系统的安装误差纳入到ROV模型中;能够清楚地表示出推进器的所有安装误差,包括角度误差和位置误差,使得模型更加地精确;本发明能够将推进器推力矢量的误差转化成推进器的安装误差,简化了推进系统误差模型的建立;本发明的深海作业型ROV模型比较传统深海作业型ROV,尤其在推进系统建模方面更加地精确;本发明通用性好,可广泛用于深海作业型ROV动力学和运动学建模中。
附图说明
附图1是本发明流程示意图。
附图2是本发明固定和随动坐标系示意图。
附图3是本发明推进器坐标系示意图。
附图4是本发明推进器安装示意图。
附图5是本发明推进器安装误(角度和位置误差)差示意图。
附图6是本发明推进器推力矢量误差示意图。
具体实施方式
下面结合附图对本发明做进一步描述。
发明流程示意图如图1。本发明实施例是:
(1)分析深海作业型ROV的受力情况。包括水动力、静力、推进器推力、缆力以和海流影响以及机械手的反冲力等。
(2)建立固定坐标系步骤
忽略地球表面加速度相对于低速ROV的影响,则固定坐标系可以被认为是一个惯性坐标系。原点E可选在地球上某一定点,如海面或海中任一点。Eξ轴位于水平面,并以ROV主航向为正向;Eη轴位于Eξ轴所在的水平面,按右手法则将Eξ轴顺时针旋转90°即是;Eζ轴垂直于ξEη坐标平面,指向地心为正。固定坐标系示意图如图2所示。
(3)建立随动坐标系步骤
以固定于潜水器上的右手直角坐标系O-XYZ为随体坐标系。纵轴OX平行于潜水器主体基线,指向艏部为正;横轴OY平行于基线面,指向右舷为正;垂轴OZ位于潜水器主体中纵剖面内,指向底部为正。随动坐标系示意图如图2所示。
(4)建立推进器坐标系步骤
推进器坐标系固连在ROV本体上。首先要人为设定推进器中心在ROV上的具体位置,以此作为推进器坐标系的原点,然后根据需要设定推进器坐标系。推进器坐标系的纵轴OiXi与随动坐标系的纵轴正方向成一定的角度α,此角度大小由人为规定,根据右手定则OiZi的方向向下,OiYi垂直于XiOiZi面。推进器进行安装时,只要将推进器的中轴线与OiXi轴重合,并且将推进器螺旋桨背离OiXi的方正向。推进器坐标系示意图如图3所示,推进器安装示意图如图4所示。
(5)计算固定坐标系到随动坐标系的坐标转移矩阵步骤
ROV相对于惯性坐标系的速度为v,v在动系上的投影为u(纵向速度)、v(横向速度)、w(垂向速度);同理,潜器以角速度Ω在动系上的投影为p(横倾角速度)、q(纵倾角速度)、r(偏航角速度);ROV所受外力F在动系上的投影为τX(纵向力)、τY(横向力)、τZ(垂向力);力矩M的投影为τK(横倾力矩)、τM(纵倾力矩)、τN(偏航力矩)。指向坐标轴的正向为速度和力的分量的正方向,用右手定则来规定角速度和力矩的正负号。
ROV的空间位置和姿态,可用动系原点的地面坐标值[x y z]T和动系相对于定系的三个姿态角(φ,θ,ψ)来确定。艏向角φ,是主体的对称面XOZ绕铅垂轴Eζ水平旋转,与铅垂面ξEζ的夹角在定系水平面(ξEη)的投影,向右转为正;纵倾角θ是主体的水线面XOY绕OY轴俯仰与定系水平面ξEη的夹角在定系铅垂面的投影,θ向尾倾为正;横倾角ψ是主体的对称面XOZ绕OX轴横倾与定系铅垂面ξEζ的夹角在横滚面ηEζ的投影,向右倾为正。
ROV六自由度位置/姿态向量为:
ROV六自由度速度/角速度向量为:
ROV六自由度力/力矩向量为:
描述ROV沿三轴方向直线运动的速度转换方程为
式中 为速度坐标转换矩阵。
则ROV的速度你转换方程为
描述ROV绕三轴转动的角速度转换方程为
式中为角速度坐标转换矩阵。
总的六自由度坐标转换矩阵为
由以上结果可以得到最终的ROV运动学方程为
(6)作业型ROV质量矩阵以及其引起的柯氏力和向心力矩阵的计算步骤
a.大多数作业型ROV通常是具有近似的三个对称面外型为长方体。因为具有三个近似的对称面,所以质量矩阵的非对角元素远远小于对角元素,因此附加质量惯性矩阵中的非对角元素可以进行忽略;
b.作业型ROV通常是通过配重来决定重心和浮心的相对位置。因此ROV可以将重心位置通过配重移到浮心的正下方,调节初始的纵倾和横倾角度;通过配重可以将随动坐标系原点与ROV重心重合,同时艇体坐标系与ROV的惯性主轴重合。这样对ROV模型的简化具有很重要的意义;
c.由于作业型ROV各种设备外形复杂而且布置凌乱,不同的任务需要更换不同的作业设备,因此内部结构较复杂。作业型ROV参数矩阵中的非对角元素也很难精确获得。但事实上,在大多数应用场合,对角假设已经可以非常好地近似真实的ROV受力情况。
则作业型ROV质量矩阵:
m为作业型ROV的质量;[xG yG zG]T为作业型ROV重心坐标;Ix、Iy、Iz为ROV绕X、Y、Z三轴的转动惯量,而Ixy、Iyx、Ixz、Izx、Iyz、Izy则为惯性积。
可以简化为:
作业型ROV质量引起的柯氏力和向心力矩阵:
可以化简为:
(7)作业型ROV所受水动力建模步骤
1)流体惯性力系数矩阵以及流体惯性力引起的柯氏力和向心力矩阵
a.大多数作业型ROV通常是具有近似的三个对称面外型为长方体。因为具有三个近似的对称面,所以质量矩阵的非对角元素远远小于对角元素,因此附加质量惯性矩阵中的非对角元素可以进行忽略;
b.作业型ROV通常是通过配重来决定重心和浮心的相对位置。因此ROV可以将重心位置通过配重移到浮心的正下方,调节初始的纵倾和横倾角度;通过配重可以将随动坐标系原点与ROV重心重合,同时艇体坐标系与ROV的惯性主轴重合。这样对ROV模型的简化具有很重要的意义;
c.由于作业型ROV各种设备外形复杂而且布置凌乱,不同的任务需要更换不同的作业设备,因此内部结构较复杂。作业型ROV参数矩阵中的非对角元素也很难精确获得。但事实上,在大多数应用场合,对角假设已经可以非常好地近似真实的ROV受力情况。
流体惯性力系数矩阵以及流体惯性力引起的柯氏力和向心力矩阵为:
可以化简为:
2)流体粘性力系数矩阵
ROV在运动时,受到线性和非线性的粘性类水动力。总的粘性水动力阻尼矩阵D(v)可以分解为线性水动力阻尼矩阵DL(v)和非线性水动力阻尼矩阵DNL(v)之和:
D(v)=DL(v)+DNL(v)
对于高速行进的六自由度水下运载器,其将受到高度耦合且非线性的水动力阻尼力。但对于低速运动的具有近似的三个对称面ROV,可以忽略耦合作用,并忽略高于二阶的阻尼项。则粘性水动力阻尼矩阵将为仅包括主运动的一次、二次水动力系数的对角阵,即
式中Xu、Yv等被称为一阶水动系数,其主符号代表运动产生的水动力/力矩的方向,下标则表示运动的方向;w|w|和v|v|等表示该项的大小与w2、v2成正比,而符号随来流方向而变。
(8)作业型ROV所受静力建模步骤
计算作业型ROV所受重力W=mg;计算作业型ROV所受浮力。ρ为海水密度,g为重力加速度,为ROV排水体积。
则静力模型为:
式中[xC yC zC]T为ROV浮心坐标。
ROV可以将重心位置通过配重移到浮心的正下方,调节初始的纵倾和横倾角度;通过配重可以将随动坐标系原点与ROV重心重合,同时艇体坐标系与ROV的惯性主轴重合。则模型可以简化为:
(9)作业型ROV推力建模步骤
因为推进器坐标系是固连在ROV主体上的,所以推进器坐标系相对动坐标系是相对静止的。动坐标系到空间内任一坐标系的位姿转换矩阵为:
此位姿转换矩阵的含义是:定坐标系首先按照向量 平移,使坐标原点与空间内任一坐标系原点相重合,再根据旋转矩阵旋转坐标系就能够使随动坐标系和空间内任一坐标系相重合。
则对于人为确定好的推进器坐标系,规定逆时针旋转为正方向,将平移后坐标原点和推进器坐标系原点相重合的随动坐标系绕X、Y、Z轴分别旋转γi、βi、αi,使得随动坐标系与推进器坐标系重合。但是实际工程中推进器存在安装误差(包括角度误差和位置误差见图5)、推进器存在推力矢量误差,推力矢量误差是指:理想情况下,推进器的推力方向是沿着推进器的中轴的,而大多数情况下我们也是认为推进器的推力方向是沿着推进器的中轴的。但是实际情况中推力方向和中轴线是由偏差的,见图6。则定义误差项△γi、△βi、△αi其中包含了推进器存在的安装角度误差和推力矢量误差。
作业型ROV的推进系统一般都包含多个推进器,则就要相应建立多个推进器坐标系。则随动坐标系到第i个推进器的坐标转换矩阵可以表示为:
则第i个推进器的推力作用在ROV上的力可以表示为:
式中fi为推进器的实际推力大小。
推进器存在的安装位置误差对ROV所受的推理力矩产生影响。第i个推进器的位置用坐标[xi yi zi]T表示,[xi yi zi]T为推进器中心点在动坐标系中的坐标值。
如果存在位置误差,即矢径存在误差,如图5。设矢径误差为△xi、△yi、△zi。则
式中 为第i个推进器的推力作用在ROV上的力的三个分量。
则作业型ROV的推力模型为:
(10)未知干扰项的建模步骤
深海作业型ROV所受外界的未知干扰项包括海流的影响、光缆的拖拽力和作业机械手的反冲力等,它们可以用有界的六自由度力/力矩△f来表示。
(11)作业型ROV最终的动力学和运动学模型步骤
根据以上的建模步骤,深海作业型ROV最终的动力学和运动学模型可以表示为:
本发明目的针对现有水下机器人动力学模型和运动学模型设计的不足:模型简化和推进系统建模不精确方面,提供一种深海作业型ROV动力学和运动学建模的方法,用于实现深海作业型ROV动力学和运动学建模,更适用于深海作业型ROV。发明流程示意图如图1。
本发明具体实施方式是:
(1)分析深海作业型ROV的受力情况。包括水动力、静力、推进器推力、缆力以和海流影响以及机械手的反冲力等。
(2)建立固定坐标系步骤
忽略地球表面加速度相对于低速ROV的影响,则固定坐标系可以被认为是一个惯性坐标系。原点E可选在地球上某一定点,如海面或海中任一点。Eξ轴位于水平面,并以ROV主航向为正向;Eη轴位于Eξ轴所在的水平面,按右手法则将Eξ轴顺时针旋转90°即是;Eζ轴垂直于ξEη坐标平面,指向地心为正。固定坐标系示意图如图2所示。
(3)建立随动坐标系步骤
以固定于潜水器上的右手直角坐标系O-XYZ为随体坐标系。纵轴OX平行于潜水器主体基线,指向艏部为正;横轴OY平行于基线面,指向右舷为正;垂轴OZ位于潜水器主体中纵剖面内,指向底部为正。随动坐标系示意图如图2所示。
(4)建立推进器坐标系步骤
推进器坐标系固连在ROV本体上。首先要人为设定推进器中心在ROV上的具体位置,以此作为推进器坐标系的原点,然后根据需要设定推进器坐标系。推进器坐标系的纵轴OiXi与随动坐标系的纵轴正方向成一定的角度α,此角度大小由人为规定,根据右手定则OiZi的方向向下,OiYi垂直于XiOiZi面。推进器进行安装时,只要将推进器的中轴线与OiXi轴重合,并且将推进器螺旋桨背离OiXi的方正向。推进器坐标系示意图如图3所示,推进器安装示意图如图4所示。
(5)计算固定坐标系到随动坐标系的坐标转移矩阵步骤
ROV相对于惯性坐标系的速度为v,v在动系上的投影为u(纵向速度)、v(横向速度)、w(垂向速度);同理,潜器以角速度Ω在动系上的投影为p(横倾角速度)、q(纵倾角速度)、r(偏航角速度);ROV所受外力F在动系上的投影为τX(纵向力)、τY(横向力)、τZ(垂向力);力矩M的投影为τK(横倾力矩)、τM(纵倾力矩)、τN(偏航力矩)。指向坐标轴的正向为速度和力的分量的正方向,用右手定则来规定角速度和力矩的正负号。
ROV的空间位置和姿态,可用动系原点的地面坐标值[x y z]T和动系相对于定系的三个姿态角(φ,θ,ψ)来确定。艏向角φ,是主体的对称面XOZ绕铅垂轴Eζ水平旋转,与铅垂面ξEζ的夹角在定系水平面(ξEη)的投影,向右转为正;纵倾角θ是主体的水线面XOY绕OY轴俯仰与定系水平面ξEη的夹角在定系铅垂面的投影,θ向尾倾为正;横倾角ψ是主体的对称面XOZ绕OX轴横倾与定系铅垂面ξEζ的夹角在横滚面ηEζ的投影,向右倾为正。
ROV六自由度位置/姿态向量为:
ROV六自由度速度/角速度向量为:
ROV六自由度力/力矩向量为:
描述ROV沿三轴方向直线运动的速度转换方程为
式中 为速度坐标转
换矩阵。
则ROV的速度你转换方程为
描述ROV绕三轴转动的角速度转换方程为
式中为角速度坐标转换矩阵。
总的六自由度坐标转换矩阵为
由以上结果可以得到最终的ROV运动学方程为
(6)作业型ROV质量矩阵以及其引起的柯氏力和向心力矩阵的计算步骤
a.大多数作业型ROV通常是具有近似的三个对称面外型为长方体。因为具有三个近似的对称面,所以质量矩阵的非对角元素远远小于对角元素,因此附加质量惯性矩阵中的非对角元素可以进行忽略;
b.作业型ROV通常是通过配重来决定重心和浮心的相对位置。因此ROV可以将重心位置通过配重移到浮心的正下方,调节初始的纵倾和横倾角度;通过配重可以将随动坐标系原点与ROV重心重合,同时艇体坐标系与ROV的惯性主轴重合。这样对ROV模型的简化具有很重要的意义;
c.由于作业型ROV各种设备外形复杂而且布置凌乱,不同的任务需要更换不同的作业设备,因此内部结构较复杂。作业型ROV参数矩阵中的非对角元素也很难精确获得。但事实上,在大多数应用场合,对角假设已经可以非常好地近似真实的ROV受力情况。
则作业型ROV质量矩阵:
m为作业型ROV的质量;[xG yG zG]T为作业型ROV重心坐标;Ix、Iy、Iz为ROV绕X、Y、Z三轴的转动惯量,而Ixy、Iyx、Ixz、Izx、Iyz、Izy则为惯性积。
可以简化为:
作业型ROV质量引起的柯氏力和向心力矩阵:
可以化简为:
(7)作业型ROV所受水动力建模步骤
1)流体惯性力系数矩阵以及流体惯性力引起的柯氏力和向心力矩阵
a.大多数作业型ROV通常是具有近似的三个对称面外型为长方体。因为具有三个近似的对称面,所以质量矩阵的非对角元素远远小于对角元素,因此附加质量惯性矩阵中的非对角元素可以进行忽略;
b.作业型ROV通常是通过配重来决定重心和浮心的相对位置。因此ROV可以将重心位置通过配重移到浮心的正下方,调节初始的纵倾和横倾角度;通过配重可以将随动坐标系原点与ROV重心重合,同时艇体坐标系与ROV的惯性主轴重合。这样对ROV模型的简化具有很重要的意义;
c.由于作业型ROV各种设备外形复杂而且布置凌乱,不同的任务需要更换不同的作业设备,因此内部结构较复杂。作业型ROV参数矩阵中的非对角元素也很难精确获得。但事实上,在大多数应用场合,对角假设已经可以非常好地近似真实的ROV受力情况。
流体惯性力系数矩阵以及流体惯性力引起的柯氏力和向心力矩阵为:
可以化简为:
2)流体粘性力系数矩阵
ROV在运动时,受到线性和非线性的粘性类水动力。总的粘性水动力阻尼矩阵D(v)可以分解为线性水动力阻尼矩阵DL(v)和非线性水动力阻尼矩阵DNL(v)之和:
D(v)=DL(v)+DNL(v)
对于高速行进的六自由度水下运载器,其将受到高度耦合且非线性的水动力阻尼力。但对于低速运动的具有近似的三个对称面ROV,可以忽略耦合作用,并忽略高于二阶的阻尼项。则粘性水动力阻尼矩阵将为仅包括主运动的一次、二次水动力系数的对角阵,即
式中Xu、Yv等被称为一阶水动系数,其主符号代表运动产生的水动力/力矩的方向,下标则表示运动的方向;w|w|和v|v|等表示该项的大小与w2、v2成正比,而符号随来流方向而变。
(8)作业型ROV所受静力建模步骤
计算作业型ROV所受重力W=mg;计算作业型ROV所受浮力。ρ为海水密度,g为重力加速度,为ROV排水体积。
则静力模型为:
式中[xC yC zC]T为ROV浮心坐标。
ROV可以将重心位置通过配重移到浮心的正下方,调节初始的纵倾和横倾角度;通过配重可以将随动坐标系原点与ROV重心重合,同时艇体坐标系与ROV的惯性主轴重合。则模型可以简化为:
(9)作业型ROV推力建模步骤
因为推进器坐标系是固连在ROV主体上的,所以推进器坐标系相对动坐标系是相对静止的。动坐标系到空间内任一坐标系的位姿转换矩阵为:
此位姿转换矩阵的含义是:定坐标系首先按照向量 平移,使坐标原点与空间内任一坐标系原点相重合,再根据旋转矩阵旋转坐标系就能够使随动坐标系和空间内任一坐标系相重合。
则对于人为确定好的推进器坐标系,规定逆时针旋转为正方向,将平移后坐标原点和推进器坐标系原点相重合的随动坐标系绕X、Y、Z轴分别旋转γi、βi、αi,使得随动坐标系与推进器坐标系重合。但是实际工程中推进器存在安装误差(包括角度误差和位置误差见图5)、推进器存在推力矢量误差,推力矢量误差是指:理想情况下,推进器的推力方向是沿着推进器的中轴的,而大多数情况下我们也是认为推进器的推力方向是沿着推进器的中轴的。但是实际情况中推力方向和中轴线是由偏差的,见图6。则定义误差项△γi、△βi、△αi其中包含了推进器存在的安装角度误差和推力矢量误差。
作业型ROV的推进系统一般都包含多个推进器,则就要相应建立多个推进器坐标系。则随动坐标系到第i个推进器的坐标转换矩阵可以表示为:
则第i个推进器的推力作用在ROV上的力可以表示为:
式中fi为推进器的实际推力大小。
推进器存在的安装位置误差对ROV所受的推理力矩产生影响。第i个推进器的位置用坐标[xi yi zi]T表示,[xi yi zi]T为推进器中心点在动坐标系中的坐标值。
如果存在位置误差,即矢径存在误差,如图5。设矢径误差为△xi、△yi、△zi。则
式中 为第i个推进器的推力作用在ROV上的力的三个分量。
则作业型ROV的推力模型为:
(10)未知干扰项的建模步骤
深海作业型ROV所受外界的未知干扰项包括海流的影响、光缆的拖拽力和作业机械手的反冲力等,它们可以用有界的六自由度力/力矩△f来表示。
(11)作业型ROV最终的动力学和运动学模型步骤
根据以上的建模步骤,深海作业型ROV最终的动力学和运动学模型可以表示为:
Claims (8)
1.一种深海作业型水下机器人的动力学和运动学估计方法,其特征在于:
(1)建立定坐标系、随体坐标系和推进器坐标系,估计六自由度坐标转换矩阵;
(2)估计作业型水下机器人质量矩阵以及引起的柯氏力和向心力矩阵;
(3)估计作业型ROV所受水动力;
(4)估计作业型ROV所受静力;
(5)估计作业型ROV推力;
(6)估计未知干扰项;
(7)确定作业型ROV最终的动力学和运动学模型。
2.根据权利要求1所述的一种深海作业型水下机器人的动力学和运动学估计方法,其特征在于,所述步骤(1)包括:
(1)建立定坐标系:原点E确定在一定点,Eξ轴位于水平面,并以水下机器人主航向为正向;Eη轴位于Eξ轴所在的水平面,按右手法则将Eξ轴顺时针旋转90°,即Eζ轴垂直于ξEη坐标平面,指向地心为正;
(2)建立随体坐标系:纵轴OX平行于潜水器主体基线,指向艏部为正;横轴OY平行于基线面,指向右舷为正;垂轴OZ位于潜水器主体中纵剖面内,指向底部为正;
(3)建立推进器坐标系:设定推进器中心的具体位置,作为推进器坐标系的原点,推进器坐标系的纵轴OiXi与随动坐标系的纵轴正方向成角度α,根据右手定则OiZi的方向向下,OiYi垂直于XiOiZi面;
(4)计算六自由度坐标转换矩阵:
其中:
φ为艏向角;θ为纵倾角;ψ为横倾角。
3.根据权利要求1所述的一种深海作业型水下机器人的动力学和运动学估计方法,其特征在于,所述步骤(2)包括:
(1)计算作业型水下机器人的质量矩阵:
作业型水下机器人质量引起的柯氏力和向心力矩阵:
m为作业型ROV的质量;[xG yG zG]T为作业型ROV重心坐标;Ix、Iy、Iz为ROV绕X、Y、Z三轴的转动惯量,而Ixy、Iyx、Ixz、Izx、Iyz、Izy则为惯性积;
(2)根据对称面原理和小量忽略的方法可将质量矩阵和柯氏力向心力矩阵进行化简作业型水下机器人的质量矩阵:
作业型水下机器人质量引起的柯氏力和向心力矩阵:
4.根据权利要求1所述的一种深海作业型水下机器人的动力学和运动学估计方法,其特征在于,所述步骤(3)包括:
(1)计算惯性类水动力系数矩阵以及流体惯性力引起的柯氏力和向心力矩阵:
化简为:
(2)计算流体粘性力系数矩阵
总的粘性水动力阻尼矩阵D(v)分解为线性水动力阻尼矩阵DL(v)和非线性水动力阻尼矩阵DNL(v)之和:
D(v)=DL(v)+DNL(v)
。
5.根据权利要求1所述的一种深海作业型水下机器人的动力学和运动学估计方法,其特征在于,所述步骤(4)包括:
计算作业型水下机器人所受重力W=mg;计算作业型ROV所受浮力,ρ为海水密度,g为重力加速度,为ROV排水体积,则静力模型为:
式中[xC yC zC]T为ROV浮心坐标,ROV通过配重可以将随动坐标系原点与ROV重心重合,则:
6.根据权利要求1所述的一种深海作业型水下机器人的动力学和运动学估计方法,其特征在于,所述的步骤(5)包括:
(1)计算随动坐标系到第i个推进器坐标系的包含误差项的坐标转换矩阵
为空间任一推进器坐标系原点在动系中的坐标值;
(2)计算推力:
第i个推进器的推力作用在ROV上的力为:
式中fi为推进器的实际推力大小;
(3)计算含有误差项的推力力矩:
式中为第i个推进器的推力作用在ROV上的力的三个分量;
(4)作业型ROV的推力为:
7.根据权利要求1所述的一种深海作业型水下机器人的动力学和运动学估计方法,其特征在于,所述步骤(6):深海作业型ROV所受外界的未知干扰项包括海流的影响、光缆的拖拽力和作业机械手的反冲力,用有界的六自由度力/力矩△f表示。
8.根据权利要求1所述的一种深海作业型水下机器人的动力学和运动学估计方法,其特征在于,所述步骤(7)作业型ROV最终的动力学和运动学模型为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410153093.1A CN103942383B (zh) | 2014-04-17 | 2014-04-17 | 一种深海作业型水下机器人的动力学和运动学估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410153093.1A CN103942383B (zh) | 2014-04-17 | 2014-04-17 | 一种深海作业型水下机器人的动力学和运动学估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103942383A true CN103942383A (zh) | 2014-07-23 |
CN103942383B CN103942383B (zh) | 2017-06-20 |
Family
ID=51190051
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410153093.1A Expired - Fee Related CN103942383B (zh) | 2014-04-17 | 2014-04-17 | 一种深海作业型水下机器人的动力学和运动学估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103942383B (zh) |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104155991A (zh) * | 2014-08-25 | 2014-11-19 | 南京工程学院 | 水下机器人位姿控制方法 |
CN105043333A (zh) * | 2015-03-13 | 2015-11-11 | 哈尔滨工程大学 | 一种小型水下机械手位置角度测量方法 |
CN105549602A (zh) * | 2016-02-06 | 2016-05-04 | 哈尔滨工程大学 | 浮力均衡装置辅助的uuv主动坐底方法 |
CN105607476A (zh) * | 2016-01-04 | 2016-05-25 | 哈尔滨工程大学 | 一种作业型rov六自由度运动控制方法 |
CN106932168A (zh) * | 2017-01-22 | 2017-07-07 | 浙江大学 | 水下步行机器人测试系统及其工作方法 |
CN107037821A (zh) * | 2017-05-12 | 2017-08-11 | 中国人民解放军91550部队 | 连续冲击载荷下的水下潜器运动姿态估计及控制方法 |
CN107697248A (zh) * | 2017-09-26 | 2018-02-16 | 哈尔滨航士科技发展有限公司 | 一种深海作业型机器人推进器的误差及参数修正方法及方法 |
CN108170151A (zh) * | 2017-07-24 | 2018-06-15 | 西北工业大学 | 一种水下机器人的自适应运动控制装置及其方法 |
CN108363400A (zh) * | 2018-01-29 | 2018-08-03 | 哈尔滨工程大学 | 一种基于虚拟锚泊的欠驱动auv三维控制区域镇定控制方法 |
CN109634308A (zh) * | 2019-01-16 | 2019-04-16 | 中国海洋大学 | 基于动力学的速度模型辅助水下智能导航方法 |
CN110083941A (zh) * | 2019-04-28 | 2019-08-02 | 哈尔滨工程大学 | 一种五自由度rov非线性运动学建模方法 |
CN110450154A (zh) * | 2019-07-18 | 2019-11-15 | 广州弘度信息科技有限公司 | 一种基于动力学的机械臂柔性控制方法 |
CN110816792A (zh) * | 2019-11-26 | 2020-02-21 | 南方电网调峰调频发电有限公司 | 一种水下机器人的稳定性调节系统及方法 |
CN112631277A (zh) * | 2020-12-08 | 2021-04-09 | 中山大学 | 一种四足机器人站姿转换的平衡控制方法及系统 |
CN116451508A (zh) * | 2023-06-14 | 2023-07-18 | 天津水动力科技有限公司 | 一种基于磁悬浮深海推进器的动力学建模方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070010983A1 (en) * | 2005-06-27 | 2007-01-11 | Lucent Technologies Inc. | Method and apparatus for predicting scheduled system downtime |
CN103533041A (zh) * | 2013-10-09 | 2014-01-22 | 哈尔滨工程大学 | 一种面向水下无人航行器的软件远程更新方法 |
-
2014
- 2014-04-17 CN CN201410153093.1A patent/CN103942383B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070010983A1 (en) * | 2005-06-27 | 2007-01-11 | Lucent Technologies Inc. | Method and apparatus for predicting scheduled system downtime |
CN103533041A (zh) * | 2013-10-09 | 2014-01-22 | 哈尔滨工程大学 | 一种面向水下无人航行器的软件远程更新方法 |
Non-Patent Citations (1)
Title |
---|
宋辉: "ROV的结构设计及关键技术研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104155991B (zh) * | 2014-08-25 | 2017-11-07 | 南京工程学院 | 水下机器人位姿控制方法 |
CN104155991A (zh) * | 2014-08-25 | 2014-11-19 | 南京工程学院 | 水下机器人位姿控制方法 |
CN105043333A (zh) * | 2015-03-13 | 2015-11-11 | 哈尔滨工程大学 | 一种小型水下机械手位置角度测量方法 |
CN105043333B (zh) * | 2015-03-13 | 2017-10-03 | 哈尔滨工程大学 | 一种小型水下机械手位置角度测量方法 |
CN105607476A (zh) * | 2016-01-04 | 2016-05-25 | 哈尔滨工程大学 | 一种作业型rov六自由度运动控制方法 |
CN105549602A (zh) * | 2016-02-06 | 2016-05-04 | 哈尔滨工程大学 | 浮力均衡装置辅助的uuv主动坐底方法 |
CN106932168B (zh) * | 2017-01-22 | 2020-01-14 | 浙江大学 | 水下步行机器人测试系统及其工作方法 |
CN106932168A (zh) * | 2017-01-22 | 2017-07-07 | 浙江大学 | 水下步行机器人测试系统及其工作方法 |
CN107037821A (zh) * | 2017-05-12 | 2017-08-11 | 中国人民解放军91550部队 | 连续冲击载荷下的水下潜器运动姿态估计及控制方法 |
CN108170151A (zh) * | 2017-07-24 | 2018-06-15 | 西北工业大学 | 一种水下机器人的自适应运动控制装置及其方法 |
CN107697248A (zh) * | 2017-09-26 | 2018-02-16 | 哈尔滨航士科技发展有限公司 | 一种深海作业型机器人推进器的误差及参数修正方法及方法 |
CN108363400A (zh) * | 2018-01-29 | 2018-08-03 | 哈尔滨工程大学 | 一种基于虚拟锚泊的欠驱动auv三维控制区域镇定控制方法 |
CN108363400B (zh) * | 2018-01-29 | 2020-12-22 | 哈尔滨工程大学 | 一种基于虚拟锚泊的欠驱动auv三维控制区域镇定控制方法 |
CN109634308A (zh) * | 2019-01-16 | 2019-04-16 | 中国海洋大学 | 基于动力学的速度模型辅助水下智能导航方法 |
CN110083941A (zh) * | 2019-04-28 | 2019-08-02 | 哈尔滨工程大学 | 一种五自由度rov非线性运动学建模方法 |
CN110450154A (zh) * | 2019-07-18 | 2019-11-15 | 广州弘度信息科技有限公司 | 一种基于动力学的机械臂柔性控制方法 |
CN110816792A (zh) * | 2019-11-26 | 2020-02-21 | 南方电网调峰调频发电有限公司 | 一种水下机器人的稳定性调节系统及方法 |
CN112631277A (zh) * | 2020-12-08 | 2021-04-09 | 中山大学 | 一种四足机器人站姿转换的平衡控制方法及系统 |
CN116451508A (zh) * | 2023-06-14 | 2023-07-18 | 天津水动力科技有限公司 | 一种基于磁悬浮深海推进器的动力学建模方法 |
CN116451508B (zh) * | 2023-06-14 | 2023-08-18 | 天津水动力科技有限公司 | 一种基于磁悬浮深海推进器的动力学建模方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103942383B (zh) | 2017-06-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103942383A (zh) | 一种深海作业型水下机器人的动力学和运动学估计方法 | |
Roberts et al. | Advances in unmanned marine vehicles | |
Healey et al. | Multivariable sliding mode control for autonomous diving and steering of unmanned underwater vehicles | |
Lin et al. | Development of a spherical underwater robot equipped with multiple vectored water-jet-based thrusters | |
Buckham et al. | Dynamics and control of a towed underwater vehicle system, part I: model development | |
Caharija et al. | Path following of underactuated autonomous underwater vehicles in the presence of ocean currents | |
CN104076689B (zh) | 一种全驱动式自主水下航行器协同控制方法 | |
Vervoort | Modeling and control of an unmanned underwater vehicle | |
Kadiyam et al. | Conceptual design of a hybrid propulsion underwater robotic vehicle with different propulsion systems for ocean observations | |
CN107991872B (zh) | 欠驱动auv的虚拟锚泊水平面区域镇定控制方法及实现方法 | |
Villa et al. | Design and control of an unmanned surface vehicle for environmental monitoring applications | |
Proctor | Semi-autonomous guidance and control of a Saab SeaEye Falcon ROV | |
CN111857165B (zh) | 一种水下航行器的轨迹跟踪控制方法 | |
Pandey et al. | Study on turning manoeuvre of catamaran surface vessel with a combined experimental and simulation method | |
Cruz et al. | Modular building blocks for the development of AUVs—From MARES to TriMARES | |
Zavari et al. | Early stage design of a spherical underwater robotic vehicle | |
Ramesh et al. | Heading control of ROV ROSUB6000 using non-linear model-aided PD approach | |
Jin et al. | Back-stepping control design for an underwater robot with tilting thrusters | |
CN112925332A (zh) | 无人艇与水下无人潜器联合系统的协同交会对接控制方法 | |
Kim et al. | Analysis on the controlled nonlinear motion of a test bed AUV–SNUUV I | |
Liu et al. | Dynamics modeling and control simulation of an autonomous underwater vehicle | |
Moe et al. | Path following of underactuated marine underwater vehicles in the presence of unknown ocean currents | |
Yang et al. | Influence of the propeller on motion performance of HUGs | |
Wan et al. | Modeling and motion control strategy for AUV | |
Zain | Underactuated control for an autonomous underwater vehicle with four thrusters |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into 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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170620 |