控制工程 ›› 2019, Vol. 26 ›› Issue (5): 916-921.

• 运动体控制系统 • 上一篇    下一篇

2-DOF关节型机器人轨迹的PCH与PD协调控制

  

  • 出版日期:2019-05-20 发布日期:2023-10-27

2-DOF Joint Robot Trajectory Control System Based on Port-Controlled Hamiltonian and PD Algorithm Coordinate Control

  • Online:2019-05-20 Published:2023-10-27

摘要: 针对二自由度关节型机器人轨迹跟踪控制系统单独使用一种控制方法难以实现快速高效、高精度的问题,设计了基于端口受控哈密顿(PCH)系统与传统PD算法协调控制的方案。端口受控哈密顿(PCH)控制用于确保系统的稳定性问题,传统PD控制主要用于提高系统响应的快速性问题。采用指数函数作为协调函数以实现协调控制策略,从而适应二自由度机器人的误差扰动。该系统既实现了位置信号的快速跟踪,又使机器人的输出信号控制在较高的误差精度范围内。经仿真验证表明,当机器人的机械系统存在建模误差时,采用端口受控哈密顿与传统PD算法协调控制器的二自由度关节型机器人位置控制系统有效的结合了两种控制方法的优点,该系统的动态性能与稳态性能优良,且能够快速消除误差。

关键词: 节型机器人, 端口受控哈密顿, PD控制, 轨迹跟踪控制

Abstract: A hybrid coordinated control method based on Port-controlled Hamilton (PCH) and PD algorithm is designed to solve the problem that a single control method cannot effectively realize the trajectory tracking control of a 2-DOF joint robot. The Port-controlled Hamilton (PCH) control is used to ensure the stability of the system, and the traditional PD control is used to improve the response speed of the system. The exponential function is used as the coordination function to realize the coordinated control strategy of the 2-DOF joint robot, so as to adapt to the error interference of the 2-DOF joint robot. The control system not only achieves fast tracking control, but also makes the output signal of the robot in a higher error precision range. The simulation results show that, even if there are errors in the mechanical system modeling of the robot, the proposed coordinated control method can make the system not only have good dynamic and steady-state performance, but also eliminate errors quickly.

Key words:  Joint Robot, port-controlled Hamiltonian, PD control, trajectory tracking control