机械臂轨迹的分层循环MPC跟踪控制策略

Manipulator trajectory tracking control strategy based on layered cycle MPC controller

  • 摘要: 为了实现机械臂对给定轨迹的高精度实时跟踪,设计了分层循环MPC控制器。建立了6自由度机械臂的动力学模型和状态空间模型。从分钟级控制器和秒级控制器2个层次设计了控制器,分钟级控制器使用MPC控制实现,用于改善对给定轨迹的跟踪精度;秒级控制器使用PID控制实现,用于改善控制的实时性。将秒级控制器的控制结果反馈给分钟级控制器,分钟级控制器对控制律进行实时优化,实现了分层循环控制。经仿真验证,PID控制下机械臂末端轨迹的SSE为1 840.9,分层循环MPC控制下机械臂末端轨迹SSE为1 221.3,比PID控制结果减少了33.66%,表明分层循环MPC控制具有更高跟踪精度。使用机械臂实验对控制器的动态性能进行验证,PID控制的调节时间为0.34 s,分层循环MPC控制的调节时间为0.08 s,比单纯PID控制减少了4倍以上。以上数据说明了分层循环MPC控制器具有更优的控制效果。

     

    Abstract: In order to realize high-precision real-time tracking of a given trajectory, a layered cycle MPC controller is designed. The dynamic model and state space model of 6-DOF manipulator are established. Controller is designed from two level, that is minute level controller and second level controller. The minute level controller is realized by MPC control to improve the tracking accuracy of the given trajectory; the second level controller is implemented by PID control to improve the real-time performance of the control. The control results of the second level controller are fed back to the minute level controller. The minute level controller optimizes the control law in real time and hierarchical cycle control is realized. The simulation results show that the SSE of manipulator end trajectory under PID control is 1 840.9, and SSE of manipulator end trajectory under layered cycle MPC control is 1 221.3, which is 33.66% less than that of PID control, which indicates that hierarchical cycle MPC control has higher tracking accuracy. The control time of PID control is 0.34 s, and that of hierarchical MPC is 0.08 s, which is more than 4 times less than that of PID control. The above data show that the control effect of layered cycle MPC controller is better.

     

/

返回文章
返回