潜器动力定位的仿生鱼尾推进控制分析.DOC

1、Comment yang1: 补充二级学院名称Comment yang2: 是指函数吗？该句是指尾柄按 (t)的正弦规律摆动吗？1潜器动力定位的仿生鱼尾推进控制分析周国齐 1，杨 晔 2，袁 鹏 1，刘作军 1（1河北工业大学 控制科学与工程学院，天津 300401；2中国船舶重工集团公司 第 707研究所，天津 300131）摘 要：以仿生鱼尾推进器为研究对象，建立仿生鱼尾动力学模型和以仿鱼尾推进的潜器动力定位模型。利用仿真试验得出的数据分析仿生鱼尾摆动频率、摆动幅度和各关节之间相位差等因素对仿生鱼尾推进性能的影响，采用 PID控制算法对仿鱼尾推进的潜器在一维方向的动力定位进行仿真。仿真结果

2、表明，仿生鱼尾推进在潜器的动力定位中可以实现初步的性能要求。关键词：仿生鱼尾；水下推进器；数学模型；动力定位；潜器中图分类号：U661.43 文献标志码：A 【DOI】10.13788/ki.cbgc.2017.07.037Control Analysis of Bionic Tail Propulsion forSubmarine Dynamic PositioningZHOU Guoqi1, YANG Ye2, YUAN Peng1, LIU Zuojun1(1. Hebei University of Technology, School of Control Science and E

3、ngineering Tianjin 300401, China; 2. China Shipping Heavy-duty Machine Group Co. 707 Research Institute, Tianjin 300131, China)Abstract: Bionic fishtail underwater propeller is a kind of the new thruster with high efficiency, high maneuverability and low noise. Establishing the bionic fishtail dynam

4、ics model of the new propeller, building the dynamic positioning model of submersible with the bionic fish tail propulsion. The influencing factors of the propulsion performance of bionic fishtail was analyzed, including tail swing frequency, swing amplitude and phase difference of each joint by usi

5、ng the simulation data. The PID control algorithm was applied to the dynamic positioning with fishtail propulsion in one-dimensional direction. The simulation results show that the bionic fishtail propulsion can achieve the initial performance requirements in the dynamic positioning of the submersib

6、le.Key words: bionic fishtail; underwater propeller; mathematical model; dynamic positioning; submarine0 引言鱼类经进化形成了高效的尾鳍推进和定位能力，相对于螺旋桨驱动，鱼类尾鳍具有噪声低、效率高等特点，给水下推进技术的研究提供了新思路。模仿鱼尾推进的原理及方法的新型水下推进器称为仿鱼尾推进器，它是仿生学与机械、电子、控制、材料等学科交叉融合的产物。目前，国内外研究学者已经研制出多种仿鱼尾推进器样机，逐渐掌握了仿鱼尾推进器的设计理论知识、研制技术手段以及检测试验方法，众多试验和报道表明这是一

7、种非常有前途的水下推进器 1-2。本文将针对潜器动力定位的需求，分析这种推进技术及控制方法。1 仿生鱼尾推进的数学模型1.1 尾鳍的运动分析研究表明，鲹科类鱼游动时，主要靠尾鳍的摆动提供动力。本文将从较简单的双关节仿鲹科类鱼尾研究入手，分析该类鱼尾工作方式。如图 1所示，将尾部简化为由刚性的尾柄和尾鳍 2部分，尾鳍在尾柄的带动下横移，同时围绕着尾柄端部左右摆动。尾鳍的运动是平动和摆动的复合运动 3。为了便于尾部的运动研究、分析和计算，假设尾柄摆动按照函数 (t)（尾柄摆动幅值 0，摆动频率 f）的正弦规律摆动，尾柄Comment yang3: 是指函数吗？该句是指尾柄按 (t)的正弦规律摆动吗

8、？Comment yang4: 是指函数吗？该句是指尾柄按 (t)的正弦规律摆动吗？Comment yang5: 首次出现的变量的含义需说明Comment yang6: 首次出现的变量的含义需说明2与尾鳍之间摆角相位差为 。尾鳍做平动运动函数 H(t)（尾鳍平动运动幅值 H0，尾鳍平动频率 f）与摆动0运动函数 (t)（尾鳍最大摆角幅值 0，频率 f）的复合运动，摆动相位比平动相位超前 0。X 轴正向为前进方向，尾鳍长度为 a，尾柄长度为 b。图 1 尾部运动示意图尾柄末端运动轨迹方程为：（1）1()cos()inXtVbtY尾鳍末端运动轨迹方程为：（2）21()()sitat式中：V 为尾部

9、直线运动速度；函数 (t)为尾柄相对于尾部中线瞬时摆动角度；函数 (t)为尾鳍相对于尾部中线瞬时摆动角度。在本研究中，将尾鳍近似为均匀流速流场中运动的刚性水翼或者平板，该水翼做平动和绕自身摆动轴摆动的复合运动。尾柄简化为只有一个平面旋转关节，尾鳍绕该关节做近似正弦规律的方式反复摆动。尾鳍的复合运动规律表示为：（3）00()sin(2)Htft则平动速度和摆动速度可以表示为：（4）100()co()sVtfft式中： V 为平动速度； 1为摆动角速度。以 V0表示水流速度，则尾鳍相对水流速度可以表示为：（5）10()t式中： V 1(t)为尾鳍相对水流速度；V 为平动速度。1.2 尾柄的运动分析

10、设定尾柄的摆动频率与尾鳍摆动频率相同（摆动频率 f） ，以摆动幅值为 0的正弦规律摆动，尾柄与尾鳍之间摆角相位差为 ，则有：0尾柄的运动规律表示为：（6）()sin2)tft尾柄摆动角速度为：（7）200co(根据波动板理论，当尾柄简化为刚性的平板时，尾柄重心点的速度近似为尾柄的摆动速度，尾柄重心到尾柄摆动关节的距离为 r，如图 1所示。当尾柄正弦规律摆动时，重心点的位移为 S近似表示为：（8）00sin(si2)SrftY / m尾鳍长 a尾柄长 bX / mVrComment yang7: 首次出现的变量的含义需说明Comment yang8: 图中?为何意3尾柄重心点的速度，也即尾柄摆动

11、的速度近似表示为：（9）00()2cos(）VtrfftV0表示水流速度，尾柄重心点相对水流速度为：（10）式中：V 2(t)为尾柄重心点相对水流速度；V 为尾柄摆动速度。1.3 推进力的分析推进力的分析计算主要包括 2部分，即尾鳍推进力计算和尾柄推进力计算。推进力主要分为流体压力产生的推进力和涡流推力产生的推进力 2部分。1.3.1 尾鳍推进力计算在流场中运动的物体都会受到来自周围流体的压强，从而在物体表面产生压力。根据流体力学伯努利方程原理，在仿生鱼尾运动速度较低的情况下，水中运动时每个关节都会受到来自流体的压力，该压力垂直于尾部表面，其在前进运动方向上的分力即为尾鳍的推进力，如图 2所示

12、。图 2 仿生鱼尾流体压力示意图流体压力产生的推进力为：（11）211200()sin4cos()inFVtSfHft式中： 为流体密度；S 1为仿生尾鳍的面积；V 1(t)为尾鳍与流体之间的相对速度。鱼类游动时，尾部往复摆动形成尾涡，尾流的结构是具有推进作用的，其旋转方向与推进力的方向是一致的。根据用于计算大展弦比机翼受力的类平衡翼理论 4，尾部运动过程中，尾鳍将受到来自流体的涡流推力作用，涡流推力 F方向与尾鳍相对流体运动速度的方向垂直，如图 3所示。图 3 仿生鱼尾涡流推力示意图流体中涡流推力在前进方向上的推动力为：Y / m尾鳍尾柄F V ( t )X / mF F Y / m尾鳍尾柄

13、F F F F V ( t )X / mComment yang9: 写出具体的公式编号4（12）2211200000()sincoi4s()in2)siart()cnFLCVtfHftftV 式中：L 为尾鳍展长；C 为尾鳍弦长； 为尾鳍瞬时相对击水角度。综上可知，尾鳍产生的总推力为：（13）1220000000(4cos()ins(2)sinarti()FSfHftftLVfftft 鳍1.3.2 尾柄推进力计算尾柄推进力的计算方法类似于尾鳍推进力的计算方法，需要指出的是，计算涡流推力时，展长和弦长的乘积近似用尾柄的面积 S2来替代。因此，尾柄产生的总推进力大小为：（14）20 00014

14、cos()ins(2)()sinart si()FVfrftftfftft 柄综合以上分析可知，双关节的仿生鱼尾推进器在水中摆动的过程中，产生的总推进力为：（15）2210000000220(4cos()ins(2)sin(arct)i()14osFSVfHftftLCfftftSVfft 总 鳍 柄 00nsi2(c()()sinarct iftrfftft 由上面的式子（15）可知，仿生鱼尾推进器总的推进力受到尾鳍的面积、水流速度、尾部摆动频率、尾鳍摆动幅度、尾柄尾鳍摆动相位差和尾鳍平动摆动相位差等因素的影响，由于机构的限制，尾鳍的形状、尾部关节数以及尾柄长度等都会降低出力能力。2 潜器动

15、力定位的数学模型2.1 潜器的运动模型为了实现水下潜器动力定位的控制，要求对水下潜器进行数学建模，建立水下潜器的运动方程。为便于研究，进一步简化动力定位控制维度，将研究限定在 XOY水平面上，忽略沿垂直水平方向的 Z轴运动以Comment yang10: 请写公司全称Comment yang11: 式中首次出现的变量的含义均需说明Comment yang12: 与上文及图 1中 r含义不一样，尾柄重心到尾柄摆动关节的距离，请更换变量5及其对其他方向的耦合关系 5-6。以天津深之蓝海洋设备科技有限公司的 MINI型水下潜器为研究对象，固定坐标系下的潜器外形如图 4所示。图 4 固定坐标系下潜器示

16、意图潜器的运动方程简化为：（16）ZXmxYyNI式中：X 为潜器所受合力在 X轴方向上的分力；Y 为潜器所受合力在 Y轴方向上的分力；N 为潜器所受合外力对于垂轴的力矩；m 为潜器的质量；I Z为潜器质量对通过重心的铅垂轴的惯性矩； 为潜器艏向角度；、 和 分别为 x、y 和 对时间的二阶导数，即 X轴、 Y轴的加速度和艏向角加速度，其中，x 和 y分x别为潜器在 X轴和 Y轴上的位移。潜器在 XOY水平面运动的一般方程为：（17）2GZuvxNI式中：u 为潜器重心在 X轴方向上的瞬时速度；v 为潜器重心在 Y轴方向上的瞬时速度； 为潜器艏向角速度； 为潜器重心相对坐标系原点的距离。Gx2

17、.2 潜器动力定位的低频运动模型对于潜器的动力定位而言，不论是定点控制还是轨迹跟踪，潜器通常是处于低速运动状态。在低速运动状态下，考虑水动力对于潜器运动的影响，可假设阻尼是线性的，进而可以得到一个适用于潜器动力定位的低频运动模型 7：（18）vJMD式中： 为固定坐标系下潜器的位置；J()为转换矩阵， ；M 为惯性矩阵，cosin0()1J；D 为线性水动力阻尼系数， ； 为仿生鱼尾推uvGrrZ0-mXYxIN uvr0XYND进器产生的推力。3 数值仿真与分析3.1 仿生鱼尾推进的性能仿真在对仿生鱼尾推进器的设计过程中，影响推进力的因素有很多。在仿真试验中，通过对仿生鱼尾推进器的尾部摆动频

18、率、尾鳍摆动幅度、尾柄尾鳍摆动相位差和尾鳍平动摆动相位差采取不同的数值方法，经过仿真试验并对结果进行分析，求得最优的推进效果。Y/mX/m?Comment yang13: 图 5-图 8的图题一样，请根据具体情况进行修改63.1.1 仿生尾鳍摆动频率对推进力的影响根据设计方案，设定尾鳍面积为 0.018 m2，水流速度为 0.5 m/s，尾鳍的平动幅值为 0.04 m，尾柄面积为 0.004 m2，尾柄摆动幅度为 /9；对于其他影响的参数，初步设定尾柄尾鳍摆动相位差为 /3，尾鳍摆动幅度为 /6，尾鳍摆动平动相位差为 /2，尾柄尾鳍的摆动频率一致，分别取 f 为 1Hz、2Hz、3Hz 、4H

19、z。得到的仿生鱼尾推进力大小随时间变化的曲线如图 5所示。a) f=1Hz b) f=2 Hzc) f=3 Hz d) f=4 Hz图 5 不同摆动频率的推力- 时间曲线由图 5可知，仿生鱼尾推进器两关节尾部推进系统产生的推进力在一定范围内会随着尾部摆动频率的增大而增大。3.1.2 仿生尾鳍摆动幅度对推进力的影响针对尾鳍摆动幅度对推进力的影响进行仿真，分别取尾鳍摆动幅度 0为 20、30、45、60，得到的推力变化曲线如图 6所示。a) 0=20 b) 0=30Comment yang14: 请根据上文作统一修改，到底是 0还是 7c) 0=45 d) 0=60图 6 尾鳍不同摆动幅度的推力-

20、 时间曲线由图 6可知，尾鳍的摆动幅度对推进力的影响比较明显，在一定的摆动幅度范围内产生的推进力大小随摆动幅度的增加而增大，但超过一定幅值时，推进力基本不变。3.1.3 仿生尾鳍摆动、平动相位差对推进力的影响尾鳍的运动是平动和摆动的复合运动，并且，平动、摆动运动之间存在一定的相位差关系， 0分别取90、 60、45、30。仿真结果如图 7所示。a) 0=90 b) 0=60c) 0=45 d) 0=30图 7 不同尾鳍摆动、平动相位差的推力- 时间曲线尾鳍摆动时，推进力的大小随着平动-摆动相位差的减小逐渐减小，在尾鳍平动 -摆动相位差减小到 30时，推进效果明显降低。3.1.4 仿生尾鳍、尾柄

21、摆动相位差对推进力的影响仿生鱼尾推进系统是由尾柄和尾鳍两关节组成，尾部摆动是尾柄和尾鳍相互协调运动的过程，摆动时两关节之间摆动的相位差对推进力大小也会有一定影响。选取不同相位差值进行仿真分析，研究其对推进力的影响，相位差值 分别选取 30、45 、60、90 。仿真结果如图 8所示。0a) =30 b) =4500Comment yang15: s的含义需说明Comment yang16: 对参数说明含义8c) =60 d) =9000图 8 尾鳍、尾柄摆动不同相位差推力- 时间曲线对所取不同的尾柄、尾鳍摆动相位差值的仿真结果分析后发现，尾柄、尾鳍摆动相位差对推进力大小的影响不是很明显。综合其

22、他因素，本设计中选取尾柄和尾鳍之间的摆动相位差为 60。3.2 仿生鱼尾推进的潜器动力定位仿真为了验证仿生鱼尾推进的潜器动力定位效果，以天津深之蓝海洋设备科技有限公司的 MINI型水下潜器为控制对象进行仿真，得到该潜器模型参数为： ，2.390.81.742M。以 X轴方向为例，对于 X轴方向的运动，建立传递函数为：0.3850.427.1963D（19）2.85Gss（ ）式中：s 为复变量。采用传统的 PID控制算法 8-9，应用 MATLAB软件进行仿真，结果输出如图 9和图 10所示。图 9 潜器动力定位的 X轴方向响应图图 10 潜器动力定位的艏向角度响应图通过对仿真模块进行参数调试

23、，确定 PID控制器的 3个参数，比例参数 KP=1.2，积分参数 KI=0.9，微分参数 KD=0.2。采用一般的 PID控制，可以初步得到潜器动力定位的理想状态。4 结论本文分析了双关节鲹科类鱼尾推进原理，建立两自由度仿生鱼尾鳍的数学模型，对尾柄和尾鳍两个摆动关节的运动分别进行了数学分析，计算两关节协调摆动时产生的总推进力。建立以仿生鱼尾推进的潜器动力定位模型，对两关节的仿生鱼尾推进系统的模型进行了仿真试验，研究了尾鳍摆动幅度、摆动频率、9尾柄-尾鳍摆动相位差和尾鳍平动-摆动相位差几个关键参数对推进力的影响。通过对潜器单一方向上一维的动力定位控制性能的仿真可以看出，利用双关节仿鱼尾推进器并

24、采取适当的控制来实现潜器的动力定位是可行且有效的。参考文献：1 KOPMAN V, PORFIRI M. Design, Modeling, and Characterization of a Miniature Robotic Fish for Research and Education in Biomimetics and BioinspirationJ. IEEE/ASME Transactions on Mechatronics, 2013, 18(2): 471-483.2 XU Jianxin, REN Qinyuan, GAO Wenchao, et al. Mimicry o

25、f Fish Swimming Patterns in a Robotic FishC/ IEEE International Symposium on Industrial Electronics. 2012.3 孙维维. 仿生机器鱼尾鳍推进系统的研究与设计D. 河北秦皇岛 : 燕山大学, 2008.4 SUEBSAIPROM P, LIN C L. Fish-Tail Modeling for Fish RobotC/ International Symposium on Computer, Consumer and Control. 2012.5 王芳, 万磊, 徐玉如, 等. 深水半潜

26、式钻井平台动力定位建模与仿真J. 船舶工程, 2011, 33(3): 75-78.6 李殿璞. 船舶运动与建模M. 2 版. 北京: 国防工业出版社, 2008.7 童进军, 何黎明, 田作华. 船舶动力定位系统的数学模型J. 船舶工程, 2002(5): 27-29.8 王猛. 模糊 PID 控制方法在船舶动力定位系统中的应用研究D. 武汉: 武汉理工大学, 2013.9 杨凌轩, 王晓辉. 模糊自适应 PID 控制在载人潜器动力定位中的应用研究J. 船海工程, 2004(6): 39-42.收稿日期：2017-01-08；修回日期：基金项目：国家自然科学基金项目（NO.61203076 、NO.61174009）作者简介：周国齐（1992） ，男，硕士研究生，研究方向：水下潜器动力定位的新型推进技术。