基于模型预测控制的磨削机器人末端力跟踪控制算法

基于曲面预测与模型预测控制算法提出磨削机器人对连续曲面工作时的末端力控制算法。给出机械臂离散、线性化的动力学模型;根据曲面预测算法计算未来时刻的曲面坐标,通过快速算法和求逆解运算获得机械臂满足设定值时各关节的期望角度;由动态矩阵控制算法求得机械臂各关节的输入力矩,以实现对期望关节角的轨迹跟踪。在仿真试验中控制机械臂追踪未知连续曲面,证明了机械臂针对未知曲面作业时所提算法力控制的实时有效性,并且达到目标要求。

End force tracking control algorithm of grinding robot based on model predictive control

A precise control algorithm using the model predictive control and surface prediction was proposed. The dynamic model and the prediction model of the manipulator were given. The surface coordinates of the next moment were obtained according to the surface prediction algorithm, and the desired rotation angle of each joint was obtained by the fast algorithm and the inverse kinematic algorithm. And in order to realize the overshoot tracking of the desired joint angle, the dynamic matrix control algorithm was used to solve the input torque of each joint motor. The end-point of manipulator was controlled to track the continuous surface by experimental and simulation. The results showed that the end force control algorithm using surface prediction and model prediction algorithm could effectively track the continuous surface in real time, which satisfied the ideal force control requirement.