以平面2-DOF冗余驱动并联机器人为研究对象,结合拉格朗日方程和键合图两种方法,建立了该机器人机电耦合多能域系统动力学模型。针对该机构特点,提出了一种将动力学模型线性化的待定系数法,通过该方法,经过严密的数学推导,得到了机电耦合多能域系统动力学模型的线性化形式,避免了传统的简化方法得到动力学模型线性化形式带来的误差。以五次多项式改进的傅里叶级数优化并联机构末端激励轨迹。搭建了动力学参数辨识试验平台,以加权最小二乘法对其机电耦合多能域系统的动力学参数进行了基于试验的辨识研究。所提的辨识策略不仅可以辨识出机器人机构本体的惯性参数与关节摩擦参数而且还可以辨识出电动机和减速机的等效转动惯量以及等效阻尼系数。设计了基于计算力矩的力位混合控制策略,并将辨识出的动力学参数应用到控制策略中,通过试验验证了机电耦合多能域系统动力学参数辨识的实用性与基于计算力矩的力位混合控制策略的有效性。
李永泉
,
王立捷
,
刘天旭
,
张阳
,
张立杰
. 一种并联机器人机电耦合多能域系统动力学参数辨识、控制及试验[J]. 机械工程学报, 2018
, 54(11)
: 141
-150
.
DOI: 10.3901/JME.2018.11.141
The planar 2-DOF redundant actuation parallel robot is taken as the object of study. Combining with two methods of Lagrange equation and bond graph, the dynamics model of the electromechanical coupling multi-energy domain system of the robot is established. According to the characteristics of the robot, a method of undetermined coefficients for linearization of dynamic models is presented, and by means of this method, the linearized form of dynamic model of the electromechanical coupling multi-energy domain system is obtained, which can avoid the error caused by the linearized form of the dynamic model obtained by the traditional simplified method. The excitation trajectory of identification is constructed by Fourier series improved by quintic polynomial form. The experimental platform of dynamic parameter identification is built, the identification of the dynamic parameters of the electromechanical coupling system is studied by the weighted least square method base on the experiment. The proposed identification strategy can not only identify the inertial parameters and friction parameters of the mechanism, but also identify the equivalent moment of inertia and the equivalent friction coefficient of the motor and the reducer. The force/position hybrid control strategy base on the computed torque is designed, and the identified dynamic parameters are applied to the control strategy. The practicability of the identification of the dynamic parameters of the electromechanical coupling multi-energy domain system and the correctness of the force/position hybrid control strategy based on the computed torque are verified by experiments.
[1] ABDELLATIF H, HEIMANN B. Experimental identification of the dynamics model for 6DOF parallel manipulators[J]. Robotica, 2010, 28(2):359-368.
[2] DCÍAZ-RODRÍGUEZ M, VALERA A, MATA V, et al. Model-based control of a 3-DOF parallel robot based on identified relevant parameters[J]. IEEE/ASME Transactions on Mechatronics, 2013, 19(6):737-1744.
[3] JIN J, GANS N. Parameter identification for industrial robots with a fast and robust trajectory design approach[J]. Robotics and Computer-Integrated Manufacturing, 2015, 31(1):21-29.
[4] FARHAT N, MATA V, PAGE A, et al. Identification of dynamic parameters of a 3-DOF RPS parallel manipulator[J]. Mechanism & Machine Theory, 2008, 43(1):1-17.
[5] WU J, WANG J S, WANG L P, et al. Dynamic formulation of redundant and nonredundant parallel manipulators for dynamic parameter identification[J]. Mechatronics, 2009, 19(4):586-590.
[6] 吴文祥,朱世强,靳兴来. 基于改进傅里叶级数的机器人动力学参数辨识[J]. 浙江大学学报, 2013, 47(2):231-237. WU Wenxiang, ZHU Shiqiang, JIN Xinglai. Dynamic identification for robot manipulators based on modified Fourier series[J]. Journal of Zhejiang University, 2013, 47(2):231-237.
[7] SHANG W, CONG S, KONG F. Identification of dynamic and friction parameters of a parallel manipulator with actuation redundancy[J]. Mechatronics, 2010, 20(2):192-200.
[8] JOAO V F, MARA M D S. On the dynamic performance of parallel kinematic manipulators with actuation and kinematic redundancies[J]. Mechanism & Machine Theory, 2016(103):148-166.
[9] JIANG Yao, LI Tiemin, WANG Liping. Dynamic modeling and redundant force optimization of a 2-DOF parallel kinematic machine with kinematic redundancy[J]. Robotics and Computer-Integrated Manufacturing, 2015(32):1-10.
[10] 丁华锋,祖琪,冯泽民. 基于虚功原理的一种新型锻造操作机主运动机构动力学分析[J]. 机械工程学报, 2016, 52(9):18-27. DING Huafeng, ZU Qi, FENG Zemin. Dynamic analysis of a new forging manipulator's main motion mechanism based on the principle of virtual work[J]. Journal of Mechanical Engineering, 2016, 52(9):18-27.
[11] SHANG W W, SHUANG C, YUAN G. Adaptive computed torque control for a parallel manipulator with redundant actuation[J]. Robotica, 2012, 30(3):457-466.
[12] 郭菲,李永泉,宋肇经,等. 旋量键合图在并联机构动力学建模中的应用[J]. 机械工程学报, 2015, 51(23):16-20. GUO Fei, LI Yongquan, SONG Zhaojing, et al. Screw bond graph in the application of the parallel mechanism dynamics modeling[J]. Journal of Mechanical Engineering, 2015, 51(23):16-20.
[13] 李永泉,宋肇经,郭菲,等. 多能域过约束并联机器人系统动力学建模方法[J]. 机械工程学报, 2016, 52(21):17-25. LI Yongquan, SONG Zhaojing, GUO Fei, et al. Dynamic modeling method for overconstrained multi-energy domain parallel manipulator[J]. Journal of Mechanical Engineering, 2016, 52(21):17-25.
[14] 李永泉. 球面2-DOF并联机构的理论分析与实验研究[D]. 秦皇岛:燕山大学, 2012. LI Yongquan. Theory analysis and experiment research of spherical 2-DOF parallel manipulator[D]. Qinhuangdao:Yanshan University, 2012.