引用本文:汪乃茜,李德伟,席裕庚.采用预测控制的龙门架式冗余自由度机械臂轨迹规划算法[J].控制理论与应用,2016,33(8):989~998.[点击复制]
WANG Nai-qian,LI De-wei,XI Yu-geng.The trajectory planning of redundant manipulator with gantry by using model predictive control[J].Control Theory and Technology,2016,33(8):989~998.[点击复制]
采用预测控制的龙门架式冗余自由度机械臂轨迹规划算法
The trajectory planning of redundant manipulator with gantry by using model predictive control
摘要点击 2990  全文点击 1692  投稿时间:2016-01-11  修订日期:2016-05-06
查看全文  查看/发表评论  下载PDF阅读器
DOI编号  10.7641/CTA.2016.60019
  2016,33(8):989-998
中文关键词  机械臂  冗余  轨迹规划  预测控制  柔性横梁
英文关键词  manipulators  redundancy  trajectory planning  model predictive control  flexible beam
基金项目  国家自然科学基金项目(61374110, 61521063, 61590924, 61573239), 国家高新技术研究发展计划(“863”计划)项目(2015AA043102), 上海市自 然科学基金项目(15ZR1418600)资助.
作者单位E-mail
汪乃茜 上海交通大学 naiqianwang@126.com 
李德伟* 上海交通大学 dwli@sjtu.edu.cn 
席裕庚 上海交通大学  
中文摘要
      为解决近年来工业常用的复杂结构大型机械臂的运动控制问题, 本文以龙门架式机械臂为研究对象, 首先 结合材料力学分析, 对在双臂荷载下的横梁挠度公式进行推导, 进而对机械臂系统建立精确的运动学模型. 为了便 于后期算法设计, 又在此基础上进行了降阶、线性化等模型简化工作. 针对这一具有关节限位等约束条件和冗余自 由度的多输入多输出高维复杂系统, 提出了一种基于预测控制的轨迹规划算法. 该算法根据模型中不同关节的运 动范围以及定位精度等特性, 划定其不同的运动优先级, 通过在优化问题中对各个关节控制量设置不同的权重, 来 解决冗余问题. 同时通过实时更新与滚动优化, 很好的保证了控制的及时性. 仿真结果表明了本文所推导的挠度公 式的准确性和所提出算法的有效性, 不仅很好地解决了冗余问题, 而且充分利用不同关节的运动特性, 针对不同类 型的跟踪目标值给出相适应的轨迹规划方案.
英文摘要
      To solve the motion control problem of large-scale complex manipulators which are commonly used in industry recently, this paper focuses on manipulator system composed of a gantry and small-sized manipulators. Firstly the calculation formula for beam deflection under two independent concentrated loads is deduced by analyzing material mechanics. Then an accurate kinematics model of manipulator system is presented. On this basis, the model is simplified to be linear and low-order, for following algorithm design. For the multi-input multi-output (MIMO) high dimensional redundant model with joint constraints, an algorithm based on model predictive control (MPC) is proposed for trajectory planning. All of the joints are classified into different movement priorities according to their motion range and positioning accuracy. The redundancy problem can be solved by setting different weights for control variable of each joint in optimization problem. Meanwhile, rolling optimization style of MPC scheme makes it possible to online continuously make trajectory planning with updated information. The simulation results illustrate effectiveness of the algorithm proposed in this paper. In addition, for various setting points, different weighting selections are considered by analyzing joints’ motion characteristics.