基于力/位混合算法的7自由度机械臂精细操控方法

nicholas

基于力/位混合算法的7自由度机械臂精细操控方法

基于力-位混合算法的7自由度机械臂精细操控方法.pdf (915.1 KB, 下载次数: 10)

2016-12-7 13:39 上传

点击文件名下载附件
下载积分: 金钱 -1

基于力/位混合算法的7自由度机械臂精细操控方法

常健1, 王亚珍2, 李斌1

1. 中国科学院沈阳自动化研究所机器人学国家重点实验室，辽宁 沈阳 110016; 2. 浙江省特种设备检测研究院，浙江 杭州 310003

Accurate Operation Control Method Based on Hybrid Force/Position Algorithm for 7-DOF Manipulator

CHANG Jian1, WANG Yazhen2, LI Bin1

1. The State Key Laboratory of Robotics, Shenyang Institute of Automation, Chinese Academy of Sciences, Shenyang 110016, China; 2. Zhejiang Provincial Special Equipment Inspection and Research Institute, Hangzhou 310015, China

摘要 为了使冗余机械臂在具有良好的自治性和灵活性的同时保证末端的执行精度，提出一种基于力/位混合控制的冗余机械臂精细控制方法．通过建立准确的运动学模型，分析机械臂系统的运动特性，利用固定角度与梯度下降相结合的方法求动力学逆解．在对机械臂的力/位混合控制律建模的基础上，利用位置控制和力控制对机械臂末端的运动轨迹进行规划．针对受环境约束的机械臂的控制问题，提出冗余自由度机械臂的适从坐标系建立方法，使得末端执行器能够在任意曲面完成作业任务．在仿真分析和实验中，令机械臂末端跟随任意设定的曲线轨迹到达给定点．通过多次测量得出，力精度误差小于2%，并且在保证作用力方向精确的条件下，机械臂末端轨迹的偏离值小于5%．结果表明，所设计的力/位混合控制方法对7自由度机械臂控制精度效果良好． 关键词 ： 力/位混合控制,  冗余机械臂,  动力学逆解,  环境约束,  力精度    Abstract：To ensure the execution accuracy of the end-point as well as the autonomy and flexibility of redundant manipulators, a precise control method based on hybrid force/position algorithm is proposed. Firstly, motion characteristics of the manipulator system are analyzed by establishing precise kinematic model. Then, the inverse dynamic can be solved by the combination of gradient descent method and fixed angle method. And the path of the manipulator end-point can be planned according to the force and position control methods by establishing the model of hybrid force/position control law. For the restricted manipulator control in complex environments, an algorithm for establishing the slave coordinate system of the redundant DOF (degree of freedom) manipulator is proposed to enable the end-effector to operate on a random curved surface. Finally, the manipulator end-point is controlled to track an arbitrary preset curve to a given point in simulation analysis and experiments. As results of multiple measurements, the errors of force accuracy are less than 2%, and the deviation values of the end-point's trajectory are less than 5% while guaranteeing the precision of force direction. Results show that the proposed hybrid force/position control method performs well in precision on a 7-DOF manipulator. Key words： hybrid position and force control           redundancy manipulator           inverse dynamics           constrained environment           force accuracy 收稿日期: 2016-02-23      出版日期: 2016-07-18 1: TP24 基金资助:国家科技支撑计划（2014BAK12B01） 通讯作者: 常健，changjian@sia.cn    E-mail: changjian@sia.cn 作者简介: 常健（1983-），男，博士，副研究员．研究领域：机械臂轨迹规划，机器人自主运动及控制． 引用本文:    常健, 王亚珍, 李斌. 基于力/位混合算法的7自由度机械臂精细操控方法[J]. 机器人, 2016, 38(5): 531-539.         CHANG Jian, WANG Yazhen, LI Bin. Accurate Operation Control Method Based on Hybrid Force/Position Algorithm for 7-DOF Manipulator. ROBOT, 2016, 38(5): 531-539.