Repetitive Motion Control Algorithm Based on Cosine Feedforward Method and Its Application to Underwater Bionic Propulsion System
-
摘要: 常规比例-积分-微分(PID)控制算法在周期性正弦运动跟随上会产生幅值衰减和相位滞后, 且负载越大其幅值衰减和相位滞后越严重, 无法满足仿生推进运动的高精度跟随要求; 针对周期性重复运动设计的重复控制器在受到外界扰动后, 其产生的补偿输出量需滞后一个运动周期才能响应, 无法适应水下变负载运行条件。基于此, 文中针对某水下推进系统在变负载工况下对低频率正弦位置指令跟踪性能问题, 在借鉴前馈控制思想的基础上, 提出了余弦前馈补偿控制算法, 与常规PID控制器一起, 构成复合前馈控制来消除正弦跟随的幅值与相位误差, 并进行了仿真与实验验证。仿真与实验结果表明, 基于余弦前馈的重复运动控制算法较传统PID控制方法效果显著, 在变负载工况下依然可以实现对给定正弦运动指令的精确跟随, 相位差较补偿之前减小了60%左右。文中的研究可为实现仿生推进系统流畅精确的周期运动提供新的解决思路。Abstract: The conventional proportional integral derivative(PID) control algorithm will generate amplitude attenuation and phase lag in the periodic sinusoidal motion follow-up, and the larger the load is, the more serious the amplitude attenuation and the phase lag are, which makes the conventional PID control algorithm cannot meet the high-precision follow-up requirement of the bionic propulsion motion. And for a repetitive controller designed for periodic repetitive motion, its compensation output may be delayed for one motion cycle once external disturbance exists, which leads the controller not to be applicable for the underwater variable load operating conditions. The above controllers cannot meet the performance requirements for the underwater bionic propulsion system. Therefore, this paper proposes a cosine feedforward compensation control algorithm based on the feedforward control idea to combine the conventional PID controller for an underwater propulsion system in variable load conditions. A composite feedforward controller is hence constructed to eliminate the amplitude and phase errors of sinusoidal follow-up. Experimental results show that the repetitive motion control algorithm based on cosine feedforward method is more effective than the conventional PID control method, and under variable load conditions it can still achieve accurate follow-up of a given sinusoidal motion command with about 60% reduction in the phase difference compared with the results without compensation.
-
[1] Wang G M, Shen L C. Analysis on Underwater Biomimetic Pusher[J]. Armament Automation, 2006, 25(5): 7-9. [2] Yu K, Huang S, Hu J, et al. Experimental Research of Fish-imitating Propulsion[J]. J.Huazhong Univ. of Sci. & Tech(Nature Science Edition), 2007, 35(11): 117-120. [3] Jing J, Hu G Y, Xu J, et al. Bionic Propulsion: The Fluid Structure of Two Fish-tail Models in C-starts[J]. Chinese Journal of Ship Research, 2007, 2(6): 16-23. [4] Tomizuka M, Kempf C. Design of Discrete Time Repetitive Controllers with Applications to Mechanical Systems[C]//IFAC 11th Triennial World Congress: Tallinn, Estonia, IFAC, 1990: 243-248. [5] 成巍, 李喜斌, 孙俊岭, 等. 仿生水下机器人运动控制方法研究[J]. 机器人技术与应用, 2004, 25(5): 37-42.Cheng Wei, Li Xi-bin, Sun Jun-lin, et al. Research on Bionic Underwater Vehicle’s Motion Control[J]. Journal of Harbin Engineering University, 2004, 25(5): 37-42. [6] Yu J Z, Liu L Z, Wang L, et al. Turning Control of a Multilink Biomimetic Robotic Fish[J]. IEEE Transactions on Robotics, 2008, 24(1): 201-206. [7] Tomizuka M. Zero Phase Error Tracking Algorithm for Digital Control[J]. Journal of Dynamlc Systems, Measurement and Control, 1987, 109(3): 65-68. [8] Wang Y X, Liu Q W, Liu W, et al. Study of Weighted Parallel-Type Repetitive Control[J]. Transactions of China Electrotechnical Socitey, 2015, 30(8): 127-134. [9] 胡庆波, 吕征宇. 全数字伺服系统中位置前馈控制器的设计[J]. 电气传动, 2005, 35(5): 24-27.Hu Qing-bo, Lü Zheng-yu. Feed-forward Position Controller Design of Full-digitalized Servo System[J]. Ele- ctric Drive, 2005, 35(5): 24-27. [10] 王成元, 夏加宽, 孙宜标. 现代电机控制技术[M]. 北京: 机械工业出版社, 2008. [11] 唐任远. 现代永磁电机理论与设计[M]. 北京: 机械工业出版社, 1997.
点击查看大图
计量
- 文章访问数: 289
- HTML全文浏览量: 25
- PDF下载量: 162
- 被引次数: 0