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

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

作　　者：刘哲[1,2] 宋锐 邹涛[1] LIU Zhe1,2,SONG Rui3,ZOU Tao1(1. Key Laboratory of Networked Control System of CAS, Shenyang Institute of Automation of Chinese Academy of Sciences, Shenyang 110016, Liaoning, China; 2. University of Chinese Academy of Sciences, Beijing 100049, China; 3. School of Control Science and Engineering, Shandong University, Jinan 250061, Shandong, Chin)

机构地区：[1]中国科学院沈阳自动化研究所中国科学院网络化控制系统重点实验室,辽宁沈阳110016 [2]中国科学院大学,北京100049 [3]山东大学控制科学与工程学院,山东济南250061

出　　处：《山东大学学报（工学版）》2018年第1期42-49,共8页Journal of Shandong University（Engineering Science）

基　　金：国家自然科学基金资助项目(61773366;61503257);NSFC-浙江两化融合联合基金资助项目(U1509212);山东省重点研发计划资助项目(2017CXGC0915)

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

关 键 词：接触环境 机械臂 力控制 模型预测控制 

分 类 号：TP242[自动化与计算机技术—检测技术与自动化装置]