摘要
基于曲面预测与模型预测控制算法提出磨削机器人对连续曲面工作时的末端力控制算法。给出机械臂离散、线性化的动力学模型;根据曲面预测算法计算未来时刻的曲面坐标,通过快速算法和求逆解运算获得机械臂满足设定值时各关节的期望角度;由动态矩阵控制算法求得机械臂各关节的输入力矩,以实现对期望关节角的轨迹跟踪。在仿真试验中控制机械臂追踪未知连续曲面,证明了机械臂针对未知曲面作业时所提算法力控制的实时有效性,并且达到目标要求。
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.
作者
刘哲
宋锐
邹涛
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)
出处
《山东大学学报（工学版）》
CAS
北大核心
2018年第1期42-49,共8页
Journal of Shandong University（Engineering Science）
基金
国家自然科学基金资助项目(61773366
61503257)
NSFC-浙江两化融合联合基金资助项目(U1509212)
山东省重点研发计划资助项目(2017CXGC0915)
关键词
接触环境
机械臂
力控制
模型预测控制
interaction environment
manipulator
force control
model predictive control
