双臂协调机器人相对动力学建模

Relative Dynamic Modeling of Dual-arm Coordination Robot

双臂机器人动力学建模是研究双臂协调运动的关键技术,难点在于同一系统中建立两机械臂之间联系。针对双臂协调机器人动力学建模问题,基于拉格朗日方程建立了两臂动力学模型一般形式,运用矢量解析法求解单臂角速度雅可比矩阵,然后结合虚位移原理,基于相对雅可比矩阵建立双臂协调机器人相对动力学模型,确立两机械臂末端相对作用力与关节参数之间关系。仿真和试验结果验证了矢量解析法与相对动力学模型的正确性,该模型能够求解两机械臂末端相对力,为分析双臂协调运动提供理论依据。

The dynamic modeling of dual-arm robot is the key technology to study the coordinated motion of the two arms.The difficulty lies in establishing the connection between the two robot arms in the same system.Aiming at the problem of dynamic modeling of dual-arm coordination robot,the general dynamic models of the two manipulators based on the Lagrangian equation is established,and the vector analytical method is used to solve the angular velocity Jacobian matrix of the single arm.Then combining the principle of virtual displacement,and based on the relative Jacobian matrix,the relative dynamics model of the dual-arm coordination robot is established.And the relationship between the relative forces of the ends of the two manipulators and the joint parameters is established.Simulation and experimental results demonstrate the correctness of vector analytical method and relative dynamics model.The model can solve the relative force of the ends of the two manipulators and provide a theoretical basis for analyzing the coordinated motion of the two arms.