两关节机器鱼无升潜游动动力学建模与仿真

更新时间:2023-05-11 06:21:01 阅读量: 实用文档 文档下载

说明:文章内容仅供预览,部分内容可能不全。下载后的文档,内容与下面显示的完全一致。下载之前请确认下面内容是否您想要的,是否完整无缺。

制造业信息化

MANUFACTURING

INFORMATIONALIZATIONM

两关节机器鱼无升潜游动动力学建模与仿真

刘英想,

刘军考,

陈维山

(哈尔滨工业大学,哈尔滨150001)

要:以两关节机器鱼为研究对象,建立坐标系并选取合适的广义坐标,归纳出了两关节机器鱼无升潜游动动力学的

正解和逆解问题。应用Lagrange方程,推导出了两关节机器鱼无升潜游动的动力学模型,给出了动力学模型中各个系数项的意义。通过机器鱼的动力学仿真,得到了鱼体摆动特性与机器鱼质量分布、尾部摆动频率的关系,给出了鱼体摆动对机器鱼运动学参数的影响。

关键词:机器鱼;动力学模型;鱼体摆动;Lagrange方程;动力学仿真;无升潜游动中图分类号:TP242.3文献标识码:A文章编号:1002-2333(2007)05-0019-04

TheDynamicModeBuildingandSimulationofTwo-jointFishRobotinNoUpandDownMovement

LIUYing-xiang,LIUJun-kao,CHENWei-shan

(HarbinInstituteofTechnology,Harbin150001,China)

Abstract:Thispapertakesthetwo-jointfishrobotastheresearchtarget.Thecoordinatesystemisfounded,andthegeneralcoordinatesareselected.Thepositiveandinversedynamicsofthefishrobotinnoupanddownmovementarepresented.BasedontheLagrangeequation,thedynamicmodeofthefishrobotinnoupanddownmovementisdeduced.Themeaningofthecoefficientsinthedynamicmodeisgiven.Basedonthedynamicsimulationofthefishrobot,therelationbetweentheswingofthefishbodyandthemassdistributionofthefishrobotisgained,andtherelationbetweentheswingofthefishbodyandtheswingfrequencyofthetailisgained,andtheimpactoftheswingofthefishbodyonthekinematicsparametersisgainedtoo.

Keywords:fishrobot;dynamicmode;swingofthefishbody;Lagrangeequation;dynamicsimulation;noupanddownmovement

1前言推进的影响的基础,是建立多关节柔性机器鱼的三维运动动力学模型的基础。在不考虑水动力作用的条件下,通过动力学仿真,分析了影响鱼体摆动特性的主要因素以及鱼体摆动对机器鱼运动学参数的影响。

目前,仿生机器鱼的研究已成为机器人研究领域的热点,其中机器鱼的动力学是研究中的一个难点[1]。1961年,“二维波动板理论”,该理论中将鱼当作一Wu首次提出了

弹性薄板,是一个比较实际的用于分析鲹科模式的水动“细长体理论”用于力学理论[2]。1970年,Lightill首次将

鲹科推进模式鱼类的水动力学分析[3],并于1971年考虑

[4]

尾鳍的任意摆幅的运动,提出了“大摆幅细长体理论”。

2研究对象的选择

目前国内外已经建立的机器鱼多种多样,本文选取

两关节机器鱼来进行研究

,其结构示意图见图1,机器鱼由鱼体、尾柄、尾鳍和胸鳍组成,鱼体和尾柄之间以及尾柄和尾鳍部之间均采用转动关节联接。机器鱼通过尾柄和尾鳍的摆动击水产生向前的推进力。两关节机器鱼是

多关节机器鱼的最简形式,其分析理论具有普遍意义。

为了简化动力学分析,对两关节机器鱼作如下假设:—两关节(1)将两关节机器鱼看作是一个三刚体——的机构,鱼体、尾柄、尾鳍在惯性力和水作用力下不发生变形;

(2)机器鱼潜水深度不变,且无侧倾和俯仰运动;(3)不考虑胸鳍运动,将其看作和鱼体固联处理。

1977年,M.G.Chgopra和T.Kambe提出了可用于大摆幅、

[5]新月形尾鳍推进系统的“二维抗力理论”。在国内,童秉

纲等提出了三维波动板理论,研究了加速运动的推力性“SPC-能,考虑了大幅摆动和尾涡层演化[6]。王田苗等对仿生机器鱼进行了仿真,对鱼体摆动进行了分析[7]。前Ⅱ”

人的研究偏重在了鱼体和尾鳍的水动力学方面,对于机器鱼整体的动力学模型研究很少。此外,大家很少考虑鱼体的摆动,而鱼体的摆动,会减小尾鳍摆动轴的平动幅值,改变尾鳍的击水角度,影响推进力和推进效率。

本文以两关节机器鱼为研究对象,考虑机器鱼的头部摆动,采用Lagrange方程推导机器鱼无升潜游动的动力学模型。机器鱼无升潜游动动力学模型,是分析机器鱼直线游动特性、转向特性、鱼体摆动特性以及鱼体摆动对

!!!!!!!!!!!!!!!!基金项目:国家自然科学基金资助项目(59705011)

机械工程师2007年第5期

19

3.1

制造业信息化

MANUFACTURING

INFORMATIONALIZATION

3坐标系的建立和广义坐标的选取以及机器鱼受力分析

坐标系的建立和广义坐标的选取

对于

两关节

机器鱼,

建立如图

2所示的坐标系。

其中:O1、O2、

O3均位于机器鱼

中线上,O1为鱼体质心,O2Z2为尾柄

关节的转动轴线,O3Z3为尾鳍关节的转动轴线。O-XYZ为静坐标系,O1-X1Y1Z1为固联于鱼体的动坐标系,O2-

关参数,并分析其受力的基础上,可以归纳出机器鱼无升潜游动动力学要解决的两个主要问题,分别称为动力学的逆解和正解问题:

(t)和θ(t),求解(1)动力学逆解问题:就是已知θ2132(t)、(t)、(t)、(θXO1YO1M(102t)和M3t)的问题;即在给定尾柄和尾鳍关节摆动函数的条件下,求鱼体摆动函数、鱼体直线游动函数、鱼体侧向平移函数、尾柄和尾鳍关节驱动力矩函数。

(2)动力学正解问题:就是已知M((2t)和M3t),求解(t)、(t)、(t)、(t)和θ(t)的问题;即在给定尾柄θYO1XO1θ102132和尾鳍关节驱动力矩函数的条件下,求鱼体摆动函数、鱼体侧向平移函数、鱼体直线游动函数、尾柄和尾鳍关节摆动函数。

本文采用Lagrange方程建立动力学模型,首先给出著名的Lagrange方程的一般形式:

X2Y2Z2为固联于尾柄的动坐标系,O3-X3Y3Z3为固联于尾

鳍的动坐标系。机器鱼无升潜游动时,坐标系O1-X1Y1Z1相对O-XYZ的运动为沿OX和OY方向的直线运动以及绕O1Z1的转动;坐标系O2-X2Y2Z2相对O1-X1Y1Z1的运动为绕O2Z2的转动;坐标系O3-X3Y3Z3相对O2-X2Y2Z2的运动为绕O3Z3的转动。

两关节机器鱼无升潜游动时具有5个自由度,广义坐标的数目应该等于机器鱼的自由度数目。分析机器鱼

的运动情况,选取XO1、YO1、

!10、!21、!32为广

义坐标(见图

-"L=Q("q

j=1,2,…,n(1)

3),其中XO1为

O1点在静坐标系OX轴上的坐标,YO1为O1点在静坐标

系OY轴上的坐标,!10为O1X1与OX的夹角,逆时针为正;!21为O2X2与O1X1的夹角,逆时针为正;!32为O3X3与

式中:L为Lagrange函数,L=T-V,T为系统总动能,V为系统总势能;qj为广义位移;Qj为非保守力;n为系统自由度数目。

由Lagrange方程可以得到机器鱼直线游动的动力学模型:

#

%%%%%%%%%%%%%%$%%%%%%%%%%%%%&

O2X2的夹角,逆时针为正。

定义机器鱼的质量和转动惯量参数如下:鱼体质量

m1,尾柄质量m2,

尾鳍质量m3,鱼体相对于O1Z1轴的转动惯量JC1,尾柄相对于过C2与OZ平行的轴

线的转动惯量JC2,尾鳍相对于过C3与OZ平行的轴线的转动惯量JC3。定义机器鱼长度几何参数如图4,其中C2、

dddddC3分别为尾柄和尾鳍的质心,L0为鱼体长度,L1为O1与O2的距离,L2为尾柄长度,L3为尾鳍长度,L4为C2与O2

的距离,L5为C3与O3的距离。

"L"L=Q-1(1010"!

"L

-"L=Q2

(21"!21

"L

-"L=Q3

(32"!32

"L"L=Q-4(O1O1"X

"L"L=Q-5(O1O1"Y

(2)

"""式中:Q1、Q2、Q3、Q4和Q5分别为对应于θθθXO1和10、21、32、

3.2机器鱼受力分析

为了简化建模,将尾柄和尾鳍均看作刚性平板,将鱼

YO1的非保守力。

由于不考虑机器鱼的升潜运动,计算Lagrange函数的时候,只需要计算系统的动能即可。

体的水阻力等效成了一个X方向的阻力F1X、一个Y方向的阻力F1Y和一个绕O1Z1的阻力矩M1;尾柄水动力等效为一个沿O2Y2的集中力F2;尾鳍水动力等效为一个沿

(2(2/2

鱼体动能T1:T1=m(1XO1+YO1)/2+JC1!10/2

尾柄动能T2:

O3Y3的集中力F3,这样机器鱼受力可以简化成图5形式。L6为F2作用点与O2的距离,L7为F3作用点与O3的距离。4

机器鱼无升潜游动动力学模型建立

在建立两关节机器鱼坐标系,选取广义坐标,定义相

(2(2(L1!(O1L1!(10)2+(L4!(20)2-2X(10sinθT2=m[2XO1+YO1+10-(O1L4!(20sinθ((2X20+2L1L4!10!20cosθ21+

2(O1L1!((10cosθ((20

]/2+JC2!/22Y10+2YO1L4!20cosθ20

20

机械工程师2007年第5期

制造业信息化

MANUFACTURING

INFORMATIONALIZATIONM

式中:θ20=θ21+θ10。

尾鳍动能T3:

)i或Dij!)j的惯性力;于Dij!

’2j表示关节j的速度!’j在关节iDijj-向心项系数,Dijj!

上产生的向心力;

"2"2(L1!"10)2+’20)2+"30)2-2X"O1L2!"20sinθ(L2!(L5!T3=m[3XO1+YO1+20+"O1L2!"20cosθ""""2Y20-2XO1L5!30sinθ30-2XO1L1!10sinθ10+"O1L5!"30cosθ""""2Y30+2L2L5!20!30cosθ32+2YO1L1!10cosθ10+

2"10!"20cosθ""’30

(θ)]/2+JC3!/22L1L2!21+2L1L5!10!30cos32+θ21

’2j表示关节i的速度!’i在自身关Diii-向心项系数,Diii!

节上产生的向心力;

’j!’k表示关节j的速度!’j和关Dijk-哥式力项系数,Dijk!

’k引起的作用于关节i的哥式力,哥式力是由节k的速度!

于牵连运动是转动造成的。

(3)

动力学方程中的惯量项和重力项在机器鱼控制中特只有当机器鱼别重要,将直接系统的稳定性和定位精度。

(4)

高速运动时,向心力项和哥氏力项才是重要的。传动装置的惯量值往往较大,对系统动态特性的影响也不可忽略。

式中:θ30=θ32+θ21+θ10。

则两关节机器鱼的Lagrange函数L为:

L=T1+T2+T3

根据虚功原理,非保守力计算公式如下:

Qj=!Fi"ri+!Mi"!i

ji=1ji=1

NM

j=1,2,…,n

式中:n为系统自由度数目;N为系统非保守力个数;M为系统非保守力矩个数;Fi为系统非保守力;ri为Fi作用点在静坐标系下的位置矢量;Mi为系统非保守力矩;θj为对应Mi的角度坐标。

应用式(4)可得非保守力Q1~Q5为:

5机器鱼动力学仿真

通过观察式(10)不难发现,机器鱼无升潜游动动力

学模型的解析解的求解十分复杂,数值解计算量也很大。本文采用仿真软件ADAMS来进行机器鱼动力学仿真,仿真过程中不施加水动力,主要研究尾柄和尾鳍按照给定的规律摆动的时候,鱼体的摆动特性,主要包括鱼体摆动频率和摆角幅值;研究影响鱼体摆动特性的主要因素以及鱼体摆动对机器鱼运动学参数的影响。仿真过程中,尾柄关节和尾鳍关节的摆动均满足正弦规律,并保证尾鳍平动、摆动的相位差为90°。

Q1=F2

-Lsin!-Lsin!-Lsin!-Lsin!-Lsin!+F"+M"#$Lcos!+Lcos!Lcos!+Lcos!+Lcos!

10

20

10

20

30

10

20

10

20

30

(5)

Q2=F2

%Lcos!$"$Lcos!+Lcos!-Lsin!Q=F"+M$Lcos!

11

Q=F+F"$+F"$00

00+F"$Q=F+F"$11

-L6sin!20

20

+F3

-L2sin!20-L7sin!30

20

30

+M2(6)(7)(8)(9)

30

5.1m1(/m2+m3)与鱼体摆动特性的关系

首先通过动力学仿真来分析鱼体质量与尾柄、尾鳍质量和的比值对鱼体摆动特性的影响。选取尾柄和尾鳍,改变鱼体、关节的摆动频率为1Hz,摆角幅值均为20°

尾柄、尾鳍的质量,进行了50次仿真,得到了图6所示的曲线。其中:曲线1是当m2/m3=3/7时,鱼体摆角幅值与m1(/m2+m3)的关系;曲线2是当m2/m3=3/7时,鱼体摆角幅值与m1(/m2+m3)的关系。此外,仿真结果显示,鱼体的摆动频率保持1Hz不变,与m1(/m2+m3)值的大小无关。

通过分析图6中曲线不难发现,随着m1(/m2+m3)的不断

33

730

41X23

51Y23

将式(3)、(5)、(6)、(7)、(8)和式(9)代入式(2)中,并写成矩阵形式,就得到了两关节机器鱼无升潜游动的动力学数学模型:

&

’’’’’’’’’’’’’’(

D11D21D31D41D51D12D22D32D42D52D13D23D33D43D53D14D24D34D44D54D15D25D35D45D55

,).*.*.*.*.*.*.*-*.*.*.*.*.*.*.+/

)10!)21!

)32!)O1X

)01Y&’D112’’’D’212’’

D312’’’

D412’’’’

D512(

.......1.......2

D111D211+D311

D411D511

&’’’’’’’’’’’’’’(D122D222D322D422D522

)**,*.*.*.*..*-*.*.*.*.*./**+

D133D233D333D433D533’10!’21!’21!’32!’10!’32!

)**,*.*.*.*..*-*.*.*.*.*.*/*+

2’10!

2+’21!2’32!

0.....1.....2

增大,鱼体摆角幅值不断减小,当m1(/m2+m3)大于30以后,鱼体摆角幅值的减小开始变得缓慢,当m1(/m2+m3)大于60以后,减小的趋势变得更加缓慢;此外,当m1(/m2+m3)恒定时,尾鳍的质量减小会使鱼体摆角幅值减小。因此,在机器鱼的设计过程中,适当地增大鱼体的质量,减小尾柄和尾鳍的质量

,尤其是减小尾鳍的质量,有助于抑制鱼体摆动。

D123

D232D323D423D523D113D213D313D413D513

0.....1.....2

.Q10..

Q2.

..1=Q3.(10).

Q4..

..

Q52

,......-....../

式中,系数D的物理意义如下:

)i将在Dii-关节i的有效惯量,因为关节i的加速度!)i的惯性力;关节i上产生一个等于Dii!

Dij-关节i和关节j之间的耦合惯量,因为关节i和)i和!)j将在关节j或关节i上产生一个等关节j的加速度!

机械工程师2007年第5期

21

5.2

制造业信息化

MANUFACTURING

INFORMATIONALIZATION

尾柄尾鳍摆动频率对鱼体摆动的影响

在m1(/m2+m3)恒定的条件下,尾柄和尾鳍的摆动频

见,当质量比选取一个合适值的时候,尾鳍摆动轴平动幅值的衰减率会达到100%,此时,尾鳍推进作用降到了最低。

率也会影响鱼体摆动特性。仿真过程中,改变尾柄和尾鳍的摆动频率,得到了图7、图8所示曲线(选取m1(/m2+m3)=20、

6结论

以两关节机器鱼为研究对象,在建立坐标系并进行了受力分析的基础上,归纳出了机器鱼无升潜游动动力学的正解和逆解问题。应用Lagrange方程和虚功原理,推导出了机器鱼无升潜游动的动力学模型,并给出了方程中各个系数项的物理意义。推导出的动力学模型以机器鱼整体为研究对象,充分考虑了由于侧向力和惯性力引起的鱼体摆动。本文中的建模思想对其它运动形式和推进模式的机器鱼的动力学建模具有指导意义。

应用ADAMS对两关节机器鱼进行了动力学仿真,仿真结果表明:

(1)随着m1(/m2+m3)的不断增大,鱼体摆角幅值不断减小。当m1(/m2+m3)大于30以后,鱼体摆角幅值的减小开始变得缓慢。因此,在机器鱼的设计过程中,适当地增大鱼体的质量,减小尾柄和尾鳍的质量,尤其是减小尾鳍的质量,有助于抑制鱼体摆动。

(2)尾柄和尾鳍的摆动频率从0Hz增加到5Hz过程中(取m1(/m2+m3)=20、m1/m3=7/3),鱼体的摆角幅值总体成增大趋势,但变化的范围不大,当频率大于2.5Hz以

2/m3

=7/3)。

从图7中曲线可以发现,尾柄和尾鳍的摆动频率从

后,鱼体摆角幅值变化很小,没有出现共振现象。

(3)鱼体的摆动频率等于尾柄和尾鳍的摆动频率,与

0Hz增加到5Hz过程中,鱼体的摆角幅值总体成增大趋

势,但变化的范围不大,而且有增有减,当频率大于2.5Hz以后,鱼体摆角幅值变化很小。随着摆动频率的变化,鱼这表体摆动没有出现明显的峰值,即共振现象没有发生。明,此时机器鱼的固有频率不在0到5Hz之间。图8中曲线说明,鱼体摆动频率等于尾鳍和尾柄的摆动频率。

m1(/m2+m3)值的大小无关。

(4)鱼体的摆动会减小尾鳍转动轴平动幅值和尾鳍最大摆角。随着m1(/m2+m3)的减小,尾鳍摆动轴平动幅值和尾鳍最大摆角衰减加剧。机器鱼直线推进时,尾柄和尾鳍相对鱼体的摆动规律是不变的。因此,尾鳍摆动轴平动幅值和尾鳍最大摆角的衰减会减弱尾鳍的推进作用,而鱼体的摆动也会增加前进的阻力,这些都会降低推进效率。

本文仿真过程中没有施加水动力,与实际机器鱼游动的情况存在差别,但得出的结论对于机器鱼设计具有一定的指导意义。

[参考文献]

[1][2][3][4][5]

喻俊志,陈尔奎,等.仿生机器鱼研究进展分析[J].控制理论与应用,2003,20(4):485-491.

5.3鱼体摆动对机器鱼运动学参数的影响

前人在进行机器鱼动力学研究时,普遍没有考虑鱼

体摆动,而鱼体摆动最直接的就是减小尾鳍摆动轴平动幅值(O3点在OY方向的平动幅值)和尾鳍的最大摆角(O3X3和OX的夹角幅值)。选取m2/m3=7/3,尾柄和尾鳍的摆动频率为1Hz的条件来进行仿真,得到了图8所示的曲线。曲线1为尾鳍摆动轴平动幅值衰减率与m1(/m2+m3)的关系曲线,曲线2为尾鳍最大摆角衰减率与m1(/m2+m3)的关系曲线,这里的衰减率是指减小值与理论值的比值。

[6][7]

T.Y.Wu.SwimmingofWavingPlate.JournalofFluidsMechanics,

1961,10:321-344.

M.J.Lightill.AquaticAnimalPropulsionofHighHydromechanical

[J].JournalofFluidsMechanics,1970,44:265-301.Efficiency

M.J.Lightill.LargeAmplitudeElongated-bodyTheoryofFish

[J].Proc.R.Soc.Lond.B,1971,179:125-138.Locomotion

M.G.Chopra,T.Kambe.HydromechanicsofLunate-tailSwimming

[J].JournalofFluidMechanics,1977,79(1):Propulsion,Part2

49-69.

陶祖莱.生物流体力学[M].北京:科学出版社,1984.

王田苗,张丽,等.仿生机器鱼艏向摆动动力学仿真及分析[J].计算机仿真,2006,23(2):133-136.(编辑黄荻)

!!!!!!!!!!

通过图8中曲线可以发现,鱼体的摆动会减小尾鳍转动轴平动幅值和尾鳍最大摆角。随着m1(/m2+m3)的减小,尾鳍摆动轴平动幅值和尾鳍最大摆角衰减加剧。可以预

作者简介:刘英想(1982-),男,硕士研究生,研究领域为仿生机器鱼、

并联机构。

陈维山(1965-),男,博士,博士研究生导师。

收稿日期:2007-01-18

22

机械工程师2007年第5期

本文来源:https://www.bwwdw.com/article/0sbe.html

Top