| 陈文皞， 吴建民.基于模型预测控制的协作焊接双机械臂轨迹跟踪算法[J].轻工机械,2019,37(1):55-60 |
| 基于模型预测控制的协作焊接双机械臂轨迹跟踪算法 |
| Trajectory Tracking Algorithm of Collaborative Welding Dual Manipulators Based on Model Predictive Control |
| |
| DOI：10.3969/j.issn.1005 2895.2019.01.010 |
| 中文关键词: 焊接机器人 双机械臂 模型预测控制 主/从位置协调控制 轨迹跟踪 |
| 英文关键词:welding robot dual manipulators model predictive control master slave position coordinated control trajectory tracking |
| 基金项目: |
|
| 摘要点击次数: 1093 |
| 全文下载次数: 1371 |
| 中文摘要: |
| 焊接双机械臂协作焊接时，存在从动机械臂对主机械臂末端位置的轨迹跟踪的精确性问题，课题组提出了基于模型预测控制算法的主/从位置协调控制方法。根据所建立的六自由度双机械臂的运动学模型，建立末端位置与关节角度的变换关系以及机械臂的运动预测模型；通过上述模型，对主机械臂采用位置控制方法，并通过从动机械臂末端的三维激光扫描仪测距传感器所获取的主机械臂位置及方向，对从动机械臂采用基于模型预测控制算法的位置控制；根据机械臂关节角度变换旋转运算序列及末端位置的预测模型，通过动态矩阵控制算法，由当前时刻的位置状态及下一时刻位置输入状态对未来某时域内的位置输出状态进行预测，从而实现期望的位置跟踪。最后，采用仿真实验测试来验证该算法的实用有效性，结果表明：从动机械臂末端在有较小超调的情况下快速达到稳态，实现对期望轨迹的跟踪；与传统PID控制算法相比，模型预测控制算法能够更快速、更稳定地达到对期望轨迹的跟踪效果；该算法对期望轨迹的跟踪误差在有小幅波动的情况下可保持在±0.05 mm之内，在无波动的情况下可迅速趋近于零。基于该算法，从动机械臂可根据主机械臂末端动态位置信息更加有效地实现对期望轨迹的实时跟踪。 |
| 英文摘要: |
| Research group presents a master slave position coordinated control method based on model predictive control algorithm (MPC), to improve the trajectory tracking accuracy of slave arm according to the master arm end position when two manipulators are coordinating motion to execute welding tasks. According to the kinematics model of 6 DOF dual manipulators, transformation relationship between end position and joint angle and motion predictive model of manipulator were built; Through models mentioned above, position control was adopted for master arm and position control based on MPC algorithm was adopted for the slave arm where a distance measuring sensor with 3D laser scanner was installed in the end position to obtain position and direction information of master arm; On the basis of rotation operation sequence of joint angle transformation and predictive model of end position for manipulators, the current position state and the position input state of next step were used for predicting position output state during some future time domain with dynamic matrix control algorithm, to realize the desired trajectory tracking. Finally, simulation testing for effectiveness of this algorithm was implemented, and then result shows that slave arm end with smaller overshoot can reach steady state rapidly to realize desired trajectory tracking; compared with traditional PID control algorithm, MPC algorithm can achieve desired trajectory tracking more rapidly and more stable; tracking error of desired trajectory based on this algorithm can be kept within ±0.05 mm with slight fluctuation or approach to zero rapidly without fluctuation. Based on this algorithm, slave arm can more effectively realize real time tracking desired trajectory according to dynamic information from the end position of master arm. |
| 查看全文 查看/发表评论 下载PDF阅读器 |
| 关闭 |
