Control of tail fin flaping of robofish
-
摘要: 两关节尾鳍拍动控制是一个在高速、大载荷下的运动控制问题,它要求同时保证速度和位置波形失真都比较小.论证了尾鳍拍动推进方式与鱼体波动推进方式的一致性,根据尾鳍拍动的运动规律导出了用于拍动控制的数学模型.基于SPC-III机器鱼硬件平台,在主臂控制上,提出了根据摆角位置解算转速,并结合时间与摆角位置关系进行速度补偿的算法;在小臂控制上,提出了根据两关节摆角位置的关系及程序循环周期解算小臂目标位置的跟随算法.对高频拍动的实现进行了探讨.在试验中对尾鳍拍动的跟随性进行了验证.Abstract: Flipping control of the tail fin with two degrees is a problem of motion control in the condition of high speed and heavy load.It demands that there be little distortion of transformation of speed and position synchronously. The sameness between propulsion by tail fin flipping and that by undulation of fish body was verified, and a math model used for flipping control was deduced according to the rule of tail fin flipping. Based on the SPC-III robot fish, in terms of the control of the main joint, the algorithm, which computes the rotational speed according to its angle position and adds compensative speed via combining the relation of its position and the time variable, was put forward. In terms of the control of the assistant joint, the following algorithm, which computes the assistant joint′s target position according to the relation of the two joints′ position and the cycle period of the program, was put forward. The achievement of high-frequency flipping was discussed. During the experimentation, the following performance of tail fin flipping was validated.
-
Key words:
- bionic robot fish /
- motion control /
- tail fin /
- flipping
-
[1] Triantafyllou M S,Barrett D S,Yue D K P. A new paradigm of propulsion and maneuvering for marine vehicles[J]. Trans Soc Naval Architects Marine Eng, 1996, 104:81-100 [2] Triantafyllou M S, Triantafyllou G S.An efficient swimming machine [J]. Scientific American, 1995, 272:64-70 [3] Barrett D S, Triantafyllou M S, Yue D K P, et al. Drag reduction in fishlike locomotion[J]. Journal of Fluids Mechanics, 1999, 392:183-212 [4] Morgansen K A.Nonlinear control methods for planar carangiform robot fish locomotion Proc 2001 IEEE International Conference on Robotic & Automation. New York:IEEE Press,2001:523-528 [5] 梁建宏,王田苗,魏洪兴.水下仿生机器鱼的研究进展I——鱼类波动推进机理[J]. 机器人,2002,24(2):107-111 Liang Jianhong,Wang Tianmiao, Wei Hongxing.Research and development of underwater robofish-development of a small experimental robofish[J]. Journal of Robot,2002,24(2):107-111(in Chinese) [6] 杨海峰,李奇,姬伟 .高精度伺服稳定跟踪平台数字控制器研制[J].东南大学学报(自然科学版),2004,34:96-100 Yang Haifeng,Li Qi,Ji Wei.Controller design for high accuracy digital servo stabilized tracking platform[J].Journal of Southeast University(Natural Science Edition),2004,34:96-100(in Chinese) [7] 王晓明.电动机的单片机控制[M]. 北京:北京航空航天大学出版社,2002 Wang Xiaoming.Motor control based on MCU[M].Beijing:Beijing University of Aeronautics and Astronautics Press,2002(in Chinese)
点击查看大图
计量
- 文章访问数: 3421
- HTML全文浏览量: 139
- PDF下载量: 810
- 被引次数: 0