摘要
本文研究了一种具有变质量负载的双连杆机械臂结构的振动反馈控制.利用刚体动力学方法计算了随时间变化的惯性力,包括伺服电机、端点时变质量负载和连杆分布质量引起的惯性力.基于有限元理论建立了双连杆-变质量结构的动力学模型,并使用Bathe法求解该时变系统动力学方程,根据响应分析了质量变化对系统动力学特性的影响,发现当质量改变时,质量变化诱发了系统残余振动幅值的剧烈变化,主要原因是质量变化引起了一个阻尼力的作用.在动力学特性分析的基础上,通过速度比例负反馈控制器,利用压电材料实现结构残余振动的主动控制.开展了多种工况下双连杆机械臂结构的残余振动控制仿真,包括随时间增大的质量负载和随时间减小的质量负载,以及典型运动形式下的双连杆.结果表明通过施加反馈控制可以有效抑制结构的残余振动,提高机械臂的运动稳定性和定位精度.
柔性机械臂结构在工业自动化或者智能装备等领域的普及率越来越高,有效地提高了工业生产效率.在机械臂工作过程中,构件的刚体运动或者操作对象的质量变化都会引起结构整体参数的改变.关于含变质量构件的旋转运动结构的动力学问题研究开展得相对较少,而在工业机器人、建筑机械、空天大型柔性结构及荷载机械臂等实际工程问题中,又迫切地需要开展变质量-刚柔耦合系统的动力学响应及其振动主被动控制方面的科学研
近年来机器人工业的蓬勃发展,进一步推动了刚柔耦合结构振动控制方面的研究.Mohamed Z
在之前工作的研究基础
含变质量构件的双连杆结构如

图1 含变质量负载的双连杆机构
Fig.1 Double link mechanism with variable mass load

图2 角速度历程
Fig.2 Angular velocity history
根据有限单元
(1) |
单元位移可以通过形函数N和节点位移di来表示:
(2) |
同时需要一个转换矩阵来描述杆件单元的节点位移,转换矩阵T具有如下形式,
(3) |
其中,
(4) |
利用转换矩阵T,任意角度处的第i个单元的位移向量d,刚度矩阵k,质量矩阵m和外力向量f都可以通过转换矩阵来表示,
(5) |
其中,和为梁单元的单元刚度矩阵和质量矩阵, 为单元惯性载荷向量,具体形式
(6) |
其中,h为单元长度,杆件单位长度的重量为,x和y方向的由电机驱动引起的加速度分别为和,那么x和y方向的惯性力分量分别为和[
(7) |
其中M,C,K和F分别为总体质量矩阵、总体阻尼矩阵、总体刚度矩阵和载荷向量.阻尼C为比例阻尼,用比例阻尼系数和表示,
(8) |
因为伺服电机具有一定的刚度k1,因此,O点处(矩阵中位置)的刚度为:
(9) |
在A点处(矩阵中位置)我们需要考虑伺服电机的质量m2和转动惯量I2,质量矩阵修改为:
(10) |
同时还要考虑伺服电机2的刚度k2,刚度矩阵在修改为,
(11) |
在B点(矩阵中位置)忽略末端负载对刚度的影响,只考虑集中质量m3对系统总体质量矩阵的影响:
(12) |
根据前面的介绍已知质量变化会引起一个附加的阻力
(13) |
双连杆结构中杆OA和杆AB的材料参数如
使用

图3 不同θ12时结构的振型
Fig.3 Mode shapes for different θ12
在本文中只研究了一种典型的运动模式如

图4 双连杆结构的运动状态
Fig.4 The motion state of the double-link structure

图5 两根杆件的旋转角
Fig.5 Rotation angle of two rods
通过Bathe

图6 Bathe法计算流程
Fig.6 The flow chart of the Bathe’s method


图7 负载质量恒定时系统自由端的加速度响应曲线
Fig.7 Acceleration response curves of the free end of the system with a constant payload


图8 负载质量变化时系统自由端的加速度响应曲线
Fig.8 Acceleration response curves of the free end of the system with a time-varying payload
在杆AB上靠近电机A的位置粘贴PZT-5A压电片,利用压电致动效应产生反馈控制力,压电片的尺寸为30*20*0.5 m
首先仿真了负载质量恒定时双连杆结构的残余振动抑制,控制前后系统自由端附近的加速响应曲线如


图9 负载质量恒定时的控制效果
Fig.9 Control results for the system with constant payload
然后对含变质量负载的双连杆机构开展数值模拟,负载质量仍然从0.4kg线性增大到2kg,或从2kg线性减小到0.4kg,在质量增大工况和质量减小工况下控制结果分别如


图10 负载质量变化时的控制效果
Fig.10 Control results for the system with time varying payload
本文主要开展了含变质量负载的双连杆机构的动力学分析及振动主动控制两个方面的工作.研究表明,负载的质量变化对系统的动力学响应有非常显著的影响,除了对频率的改变,还引起了一个附加的阻尼力效果.当负载质量增大时,引起一个正的阻尼力效果;当负载质量减小时,引起一个负的阻尼力效果.附加阻尼力对系统的动力学响应影响十分显著,当附加的负阻尼力的作用效果超过结构阻尼时,甚至会引起系统振动幅度的增大.在动力学分析的基础上,对含变质量负载的双连杆机构开展了主动控制研究,通过施加速度负反馈控制,有效地抑制系统的残余振动,从而提高了结构的运动稳定性和定位精度.后期的主要工作是变质量-双连杆结构的试验平台设计和先进控制算法在该类结构振动抑制中的使用,本文的工作可以为高精度机械臂结构的设计提供一定的参考.
参考文献
邱志成.柔性机械臂的变结构振动控制研究.动力学与控制学报,2007,5(1):62~67 [百度学术]
Qiu Z C. Research on vibration control of flexible manipulator with variable structure. Journal of Dynamics and Control,2007, 5(1):62~67(in Chinese) [百度学术]
曹青松,周继惠,黎林,等. 基于模糊自整定PID算法的压电柔性机械臂振动控制研究. 振动与冲击,2010,29(12):181~186,247 [百度学术]
Zhou Q S, Zhou J H, Li L, et al. Research on vibration control of piezoelectric flexible manipulator based on fuzzy self-tuning PID algorithm. Journal of Vibration and Shock,2010, 29(12):181~186,247(in Chinese) [百度学术]
曹青松,洪芸芸,周继惠,等. 基于PSO自整定PID控制器的柔性臂振动控制. 振动.测试与诊断,2014,34(6):1045~1049,1168 [百度学术]
Cao Q S, Hong Y Y, Zhou J H, et al. Vibration control of piezoelectric flexible manipulator based on fuzzy self-tuning PID algorithm. Vibration. Testing and Diagnosis,2014, 34(6): 1045~1049,1168(in Chinese) [百度学术]
洪昭斌,陈力,李文望. 柔性空间机械臂协调运动的鲁棒神经网络控制及柔性振动PD反馈控制. 力学季刊,2014,35(1):98~104 [百度学术]
Hong S B, Chen L, Li W W. Robust neural network control for coordinated motion of flexible space manipulator and PD feedback control for flexible vibration. Mechanics Quarterly,2014, 35(1):98~104(in Chinese) [百度学术]
娄军强,魏燕定,杨依领,等. 智能柔性机械臂的建模和振动主动控制研究. 机器人,2014, 36(5):552~559,575 [百度学术]
Lou J Q, Wei Y D, Yang Y L, et al. Research on modeling and active vibration control of intelligent flexible manipulator. Robot,2014,36(5): 552~559,575(in Chinese) [百度学术]
娄军强,魏燕定,杨依领,等. 空间柔性机械臂弯扭耦合振动的主动控制研究. 振动工程学报,2014,27(3):400~407 [百度学术]
Lou Q J, Wei Y D, Yang Y L, et al. Active control of flexural and torsional coupling vibration of space flexible manipulator. Journal of Vibration Engineering,2014, 27(3):400~407(in Chinese) [百度学术]
Mohamed Z, Khairudin M, Husain A R, et al. Linear matrix inequality-based robust proportional derivative control of a two-link flexible manipulator. Journal of Vibration and Control, 2016, 22(5): 1244~1256 [百度学术]
Lochan K, Roy B K, Subudhi B. SMC controlled chaotic trajectory tracking of two-link flexible manipulator with PID sliding surface. IFAC-Papers OnLine, 2016, 49(1): 219~224 [百度学术]
荣吉利,项阳,辛鹏飞,等. 考虑关节柔性的双连杆机械臂振动控制及实验研究.宇航学报,2017,38(10):1024~1031 [百度学术]
Rong J L, Xiang Y, Xin P F, et al. Vibration control and experimental study of double-link manipulator with flexible joints. Acta Astronautica,2017,38(10):1024~1031 (in Chinese) [百度学术]
Xu B, Yuan Y. Two performance enhanced control of flexible-link manipulator with system uncertainty and disturbances. Science China Information Sciences, 2017, 60(5): 050202 [百度学术]
Karagülle H, Malgaca L, Dirilmiş M, et al. Vibration control of a two-link flexible manipulator. Journal of Vibration and Control, 2017, 23(12): 2023~2034 [百度学术]
Gao H, He W, Zhou C, et al. Neural network control of a two-link flexible robotic manipulator using assumed mode method. IEEE Transactions on Industrial Informatics, 2018, 15(2): 755~765 [百度学术]
邱志成,李城. 基于加速度反馈的两杆柔性机械臂振动控制与实验研究. 空间控制技术与应用,2018, 44(5):1~6,13 [百度学术]
Qiu Z C, Li C. Vibration control and experimental study of two-bar flexible manipulator based on acceleration feedback. Space Control Technology And Application,2018,44(5):1~6,13(in Chinese) [百度学术]
杜严锋,王聪.柔性机械臂残余振动控制. 振动与冲击,2019,38(7):165~171 [百度学术]
Du Y F, Wang C. Residual vibration control of flexible manipulator. Journal of Vibration and Shock,2019,38(7): 165~171(in Chinese) [百度学术]
Qiu Z, Li C, Zhang X. Experimental study on active vibration control for a kind of two-link flexible manipulator. Mechanical Systems and Signal Processing, 2019, 118:623~644 [百度学术]
马驰骋,罗亚军,郭宗和,等. 时变质量梁系统的振动主动控制研究. 压电与声光,2018,40(01):119~123 [百度学术]
Ma C C, Luo Y J, Guo Z H, et al. Active vibration control of time-varying mass beam system. Piezoelectric & Acousto-optic,2018,40(01):119~123(in Chinese) [百度学术]
马驰骋,张希农,代祥俊,等.含变质量构件的轴向运动梁的横向振动主动控制. 振动工程学报,2019,32(3):396~403 [百度学术]
Ma C C, Zhang X N, Dai J X, et al. Active lateral vibration control of axially moving beams with variable mass components. Journal of Vibration Engineering,2019, 32(3): 396~403(in Chinese) [百度学术]
马驰骋,罗亚军,张希农,等. 基于模糊PID控制器的变质量-柔性梁结构振动主动控制. 振动与冲击,2018,37(23):197~203,240 [百度学术]
Ma C C, Luo Y J, Zhang X N, et al. Active vibration control of flexible beam structure with variable mass based on fuzzy PID controller. Journal of Vibration and Shock,2018,37(23):197~203,240(in Chinese) [百度学术]
王勖成. 有限单元法. 北京:清华大学出版社,2003(Wang M C. Finite element method. Beijing: Tsinghua university press, 2003(in Chinese)) [百度学术]
Bathe K J. Finite element procedures. New Jersey: Prentice Hall,2006 [百度学术]