J Shanghai Jiaotong Univ Sci ›› 2024, Vol. 29 ›› Issue (3): 450-456.doi: 10.1007/s12204-023-2661-4

• Automation & Computer Technologies • Previous Articles     Next Articles

Establishment of Constraint Relation of Robot Dynamics Equation Based on Kinematic Influence Coefficients Method

基于影响系数法的机器人动力学方程约束关系建立

XU Yaru1,2 (徐亚茹), LI Kehong1,2(李克鸿), SHANG Xinna2(商新娜), JIN Xiaoming1,2(金晓明), LIU Rong3(刘荣), ZHANG Jiancheng1,2(张建成)   

  1. (1. Beijing Engineering Research Center of Smart Mechanical Innovation Design Service, Beijing Union University, Beijing 100027, China; 2. College of Robotics, Beijing Union University, Beijing 100020, China; 3. Robotics Institute, Beihang University, Beijing 100191, China)
  2. (1. 北京联合大学 北京市智能机械创新设计服务工程技术研究中心,北京 100027;2. 北京联合大学 机器人学院,北京 100020;3. 北京航空航天大学 机器人研究所,北京 100191)
  • Accepted:2023-02-27 Online:2024-05-28 Published:2024-05-28

Abstract: Due to the diversity of work requirements and environment, the number of degrees of freedom (DOFs) and the complexity of structure of industrial robots are constantly increasing. It is difficult to establish the accurate dynamical model of industrial robots, which greatly hinders the realization of a stable, fast and accurate trajectory tracking control. Therefore, the general expression of the constraint relation in the explicit dynamic equation of the multi-DOF industrial robot is derived on the basis of solving the Jacobian matrix and Hessian matrix by using the kinematic influence coefficients method. Moreover, an explicit dynamic equation with general constraint relation expression is established based on the Udwadia-Kalaba theory. The problem of increasing the time of establishing constraint relationship when the multi-DOF industrial robots complete complex task constraints is solved. With the SCARA robot as the research object, the simulation results show that the proposed method can provide a new idea for industrial robot system modeling with complex constraints.

Key words: industrial robot, constraint relationship, kinematic influence coefficients method, Jacobian matrix, Hessian matrix

摘要: 工作要求和环境的多样性使得工业机器人的自由度数和结构复杂性不断增加,难以建立其精确的动力学模型,对实现稳定、快速、准确的轨迹跟踪控制造成很大的阻碍。因此,在利用运动学影响系数法求解Jacobian矩阵和Hessian矩阵的基础上,推导了多自由度工业机器人解析动力学方程中约束关系的一般表达式,建立了基于Udwadia-Kalaba理论的含一般约束关系表达式的解析动力学方程,从而解决了多自由度工业机器人在完成复杂任务约束时增加约束关系建立时间的问题。以SCARA机器人为研究对象,仿真结果表明:该方法为复杂约束条件下的工业机器人系统建模提供了一种新的思路。

关键词: 工业机器人,约束关系,影响系数法,Jacobian矩阵,Hessian矩阵

CLC Number: