Abstract:To address the problem of vibration suppression and stable control of a planar single-link flexible manipulator (PSLFM), a particle swarm algorithm-based trajectory optimization and an active disturbance rejection control method is proposed to move the end effector from any initial position to the target position, and restrain the elastic vibration caused by the flexible connecting rod. Firstly, the dynamic model of PSLFM is established based on assumed mode method, and the underactuated characteristic of the model is analyzed to obtain the state constraint relationship between the actuated variable and the underactuated variable. Secondly, based on the constraint relationship, a bidirectional trajectory planning method is used to plan a forward trajectory and a reverse trajectory for the actuated variable. Then, the particle swarm algorithm is used to optimize the trajectory parameters to ensure that the two trajectories are smoothly combined into a complete trajectory. Finally, an active disturbance rejection tracking controller is designed to enable the manipulator to accurately track the optimized trajectory in the presence of external disturbances and unmeasurable angular velocity, realizing the vibration suppression and stable control of the manipulator. Simulation and comparison results show that the proposed control method has better vibration suppression effect and robustness.
Key words: flexible manipulator; trajectory planning; vibration suppression; active disturbance rejection; underactuated system
[1] 陈宵燕, 张秋菊, 孙沂琳. 柔性臂机器人控制关键技术的研究进展 [J]. 机械设计与研究, 2015, 31(01): 22-26+30.
CHEN Xiaoyan, ZHANG Qiuju, SUN Yilin. Research progress on the key control techniques of flexible manipulators [J]. Machine Design and Research, 2015, 31(01): 22-26+30.
[2] RAHIMI H N, NAZEMIZADEH M. Dynamic analysis and intelligent control techniques for flexible manipulators: a review [J]. Advanced Robotics, 2014, 28(2): 63-76.
[3] KIANG C T, SPOWAGE A, YOONG C K. Review of Control and Sensor System of Flexible Manipulator [J]. Journal of Intelligent & Robotic Systems, 2015, 77(1): 187-213.
[4] 孟庆鑫, 赖旭芝, 闫泽, 等. 双连杆刚柔机械臂无残余振动位置控制 [J]. 控制理论与应用, 2020, 37(03): 620-628.
MENG Qing-xin, LAI Xu-zhi, YAN Ze, et al. Position control without residual vibration for a two-link rigid-flexible manipulator [J]. Control Theory & Applications, 2020, 37(3): 620-628.
[5] 刘建英, 王效岳, 宫金良. 考虑不同边界条件悬臂梁的模态研究 [J]. 振动与冲击, 2017, 36(19): 221-226+241.
LIU Jian-ying, WANG Xiao-yu, GONG Jin-liang. Modal analysis of cantilever beams with different boundary conditions [J]. Journal of Vibration and Shock, 2017, 36(19): 221-226+241.
[6] YANG T, SUN N, CHEN H, et al. Neural network-based adaptive antiswing control of an underactuated ship-mounted crane with roll motions and input dead zones [J]. IEEE Transactions on Neural Networks and Learning Systems, 2020, 31(3): 901-914.
[7] 娄军强, 廖江江, 李国平, 等. 压电柔性机械臂的实验辨识及最优极点配置抑振控制 [J]. 振动与冲击, 2017, 36(16): 18-25.
LOU Junqiang, LIAO Jiangjiang, LI Guoping, et al. Experimental identification and vibration suppression of a piezoelectric flexible manipulator using an optimal poles-assignment method [J]. Journal of Vibration and Shock, 2017, 36(16): 18-25.
[8] ALANDOLI E A, SULAIMAN M, RASHID M, et al. A review study on flexible link manipulators [J]. Journal of Telecommunication, Electronic and Computer Engineering (JTEC), 2016, 8(2): 93-97.
[9] ZHANG L, LIU J. Observer-based partial differential equation boundary control for a flexible two-link manipulator in task space [J]. Control Theory & Applications Iet, 2012, 6(13): 2120-2133.
[10] 吴忻生, 邓军. 末端有未知扰动的分布参数柔性机械臂的鲁棒边界控制 [J]. 控制理论与应用, 2011, 28(04): 511-518.
WU Xin-sheng, DENG Jun. Robust boundary control of a distributed-parameter flexible manipulator with tip unknown disturbance [J]. Control Theory & Applications, 2011, 28(04): 511-518.
[11] LIU Z, LIU J. Boundary control of a flexible robotic manipulator with output constraints [J]. Asian Journal of Control, 2017, 19(1): 332-45.
[12] 杨春雨, 许一鸣, 代伟, 等. 柔性机械臂的双时间尺度组合控制 [J]. 控制理论与应用, 2019, 36(04): 659-665.
YANG Chunyu, XU Yiming, DAI Wei, et al. Two-time-scale composite control of flexible manipulators [J]. Control Theory & Applications, 2019, 36(4): 659-665.
[13] 张晓宇, 王润孝, 王战玺, 等. 基于H∞优化抗扰控制的柔性机械臂振动抑制 [J]. 西北工业大学学报, 2017, 35(04): 661-668.
ZHANG Xiaoyu, WANG Runxiao, WANG Zhanxi, et al. Flexible robotic arm vibration suppression based on H∞ optimization of immunity control [J]. Journal of Northwestern Polytechnical University, 2017, 35(04): 661-668.
[14] 王海, 薛彬, 杨春来, 等. 基于压电陶瓷的柔性机器人主动抑振控制策略研究 [J]. 传感技术学报, 2016, 29(07): 1016-1020.
WANG Hai, XUE Bin, YANG Chunlai, et al. Active vibration control of a flexible manipulator using piezoelectric patches [J]. Chinese Journal of Sensors Actuators, 2016, 29(07): 1016-1020.
[15] MENG Q-X, LAI X-Z, WANG Y-W, et al. A fast stable control strategy based on system energy for a planar single-link flexible manipulator [J]. Nonlinear Dynamics, 2018, 94(1): 615-626.
[16] SCHNELLE F, EBERHARD P. Adaptive nonlinear model predictive control design of a flexible-link manipulator with uncertain parameters [J]. Acta Mechanica Sinica, 2017, 33(3): 529-542.
[17] SAYAHKARAJY M, MOHAMED Z, MOHD FAUDZI A A. Review of modelling and control of flexible-link manipulators [J]. Proceedings of the Institution of Mechanical Engineers, Part I: Journal of Systems and Control Engineering, 2016, 230(8): 861-873.
[18] 余峰, 陈新元. N自由度柔性机械臂通用的动力学建模方法研究 [J]. 振动与冲击, 2020, 39(16): 103-111.
YU Feng, CHEN Xinyuan. A study on a general dynamic modeling method for N-degree of freedom flexible manipulators [J]. Journal of Vibration and Shock, 2020, 39(16): 103-111.
[19] KENNEDY J, EBERHART R. Particle swarm optimization [C] // Proceedings of ICNN'95-International Conference on Neural Networks, Piscataway, NJ: IEEE, 1995.
[20] 韩京清. 自抗扰控制器及其应用 [J]. 控制与决策, 1998(01): 19-123.
HAN Jingqing. Active disturbance rejection controller and its application [J]. Control and Decision, 1998(01): 19-123.
[21] HAN J. From PID to active disturbance rejection control [J]. IEEE transactions on Industrial Electronics, 2009, 56(3): 900-906.
[22] GAO Z. Active disturbance rejection control: a paradigm shift in feedback control system design [C] // Proceedings of the 2006 American Control Conference, Piscataway, NJ: IEEE, 2006.
[23] 滕青芳, 佐俊, 潘浩, 等. 基于时变增益扩张状态观测器的逆变器系统自适应super-twisting电压鲁棒控制 [J]. 控制理论与应用, 2020, 37(09): 1880-1894.
TENG Qingfang, ZUO Jun, PAN Hao, et al. Robust voltage control for inverter system using time-varying gain extended state observer-based adaptive super-twisting algorithm [J]. Control Theory & Applications, 2020, 37(9): 1880-1894.
[24] 陈增强, 孙明玮, 杨瑞光. 线性自抗扰控制器的稳定性研究 [J]. 自动化学报, 2013, 39(05): 574-580.
CHEN Zeng-Qiang, SUN Ming-Wei, YANG Rui-Guang. On the stability of linear active disturbance rejection control [J]. Acta Automatica Sinica, 2013, 39(5): 574−580.
[25] ZHANG P, LAI X, WANG Y, et al. Motion planning and adaptive neural sliding mode tracking control for positioning of uncertain planar underactuated manipulator [J]. Neurocomputing, 2019, 334: 197-205.