Please wait a minute...
浙江大学学报(工学版)
自动化技术     
基于GWLN方法的冗余机械臂关节力矩约束控制
陈鹏, 项基, 韦巍
浙江大学 电气工程学院,浙江 杭州 310027
Torque limit constrained control of redundant manipulator based on GWLN method
CHEN Peng, XIANG Ji, WEI Wei
College of Electrical Engineering,Zhejiang University,Hangzhou 310027, China
 全文: PDF(1155 KB)   HTML
摘要:

针对冗余机械臂受到的关节驱动力矩有限的约束,提出基于广义加权最小范数法(GWLN)的算法.通过引入辅助变量,考虑重力和科里奥利力的影响,排除现有方法对机械臂低速运行的假定.在逆运动学求解时,对扩展变量的加权范数优化,使得规划关节加速度所需的力矩指令保持在驱动器输出范围之内.该算法的有效性通过数学证明得到验证.在MATLAB ROBOTIC TOOLBOX中对PUMA560机械臂的仿真结果证实,基于GWLN方法控制的机械臂在遵循关节力矩约束的同时,准确地完成操作任务.同零空间力矩优化方法及现有加权方法的仿真结果对比显示,基于GWLN方法的控制算法能够更加有效地保证力矩约束,具有更好的稳定性.

Abstract:

A general weighted least norm (GWLN) based algorithm was proposed to solve the torque limit constraint for a redundant manipulator. An auxiliary variable was introduced to consider the Coriolis force and the gravity’s effect in order to eliminate the assumptions made by other algorithms in existence that the manipulator is running slow. The torque command for the planned joint acceleration was kept in the actuators’ output ranges by optimizing the extended variable’s weighted norm during inverse kinematic solution. The validity of the algorithm was demonstrated by a mathematical proof. A simulation of PUMA 560 manipulator in the MATLAB ROBOTIC TOOLBOX shows that the manipulator controlled by the GWLN based method can comply with the joint torque constraint and accomplish the manipulation task. Comparison with the results generated by the null space torque optimization method and the existing weighted norm method shows that the GWLN based method is more effective and stable.

出版日期: 2017-01-01
CLC:  TP 241  
基金资助:

国家自然科学基金资助项目(61374174,61203299);浙江省自然科学基金资助项目(LY13F030001);杭州市重大科技创新项目工业类资助项目(20132111A04).

通讯作者: 韦巍,男,教授,博导.ORCID: 0000-0002-7021-2792.     E-mail: wwei@zju.edu.cn
作者简介: 陈鹏(1986—),男,博士生,从事机械臂优化控制的研究. ORCID: 0000-0002-6646-2748. E-mail:kirayamato@zju.edu.cn
服务  
把本文推荐给朋友
加入引用管理器
E-mail Alert
作者相关文章  

引用本文:

陈鹏, 项基, 韦巍. 基于GWLN方法的冗余机械臂关节力矩约束控制[J]. 浙江大学学报(工学版), 10.3785/j.issn.1008-973X.2017.01.008.

CHEN Peng, XIANG Ji, WEI Wei. Torque limit constrained control of redundant manipulator based on GWLN method. JOURNAL OF ZHEJIANG UNIVERSITY (ENGINEERING SCIENCE), 10.3785/j.issn.1008-973X.2017.01.008.

[1] KIRCANSKI M, KIRCANSKI N. Resolved rate and acceleration control in the presence of actuator constraints [J]. IEEE Control Systems, 1998, 18(1): 42-47.
[2] HOLLERBACH J M, SUH K C. Redundancy resolution of manipulators through torque optimization [J]. IEEE Journal of Robotics and Automation, 1987, 3(4): 308-316.
[3] LIU S, WANG J. Bicriteria torque optimization ofredundant manipulators based on a simplified dual neural network [C]∥2005 IEEE International Joint Conference on Neural Networks. Montreal: IEEE, 2005:2796-2801.
[4] 熊有伦.机器人学[M].北京:机械工业出版社,1993: 263-266.
[5] ZHAO Z, WU Z, LU J, et al. Dynamic dexterity of redundant manipulators [C]∥ IEEE International Conference on Systems, Man and Cybernetics. Vancouver: IEEE, 1995: 928-933.
[6] 陈伟海.冗余自由度机器人优化控制研究[D].北京:北京航空航天大学, 1996.
CHEN Weihai. Research on control of robot with redundant degree of freedom [D]. Beijing: Beihang University, 1996.
[7] 郭大忠,柳洪义,张威,等.冗余度机器人运动学和动力学同时优化[J].东北大学学报:自然科学版,2008,29(7): 1008-1011.
GUO Dazhong, LI Hongyi, ZHANG Wei, et al. Simultaneously kinematical and dynamical optimizations of redundant robots [J]. Journal of Northeastern University: Natural Science, 2008, 29(7): 1008-1011.
[8] 郭宪,王明辉,李斌,等.基于最小无穷范数的蛇形机器人最优力矩控制[J].机器人, 2014, 36(01): 8-13.
GUO Xian, WANG Minghui, LI Bin, et al. Optimal torque control of a snakelike robot based on the minimum infinity norm [J]. Robot, 2014, 36(01): 8-13.
[9] 闫彩霞,闫楚良,陆震.基于加权矩阵的过驱动并联机构驱动力矩调节法[J].吉林大学学报:工学版,2008,38(5): 1215-1219.
YAN Caixia, YAN Chuliang, LU Zhen. Approach to coordinate driving torque of redundant actuated parallel manipulator based on weighted matrix [J]. Journal of Jilin University: Engineering and Technology Edition, 2008, 38(5): 1215-1219.
[10] 金波,陈诚,李伟.基于能耗优化的六足步行机器人力矩分配[J].浙江大学学报:工学版, 2012, 46(07): 1168-1174.
JIN Bo, CHEN Cheng, LI Wei. Optimization of energyefficient torque distribution for hexapod walking robot [J]. Journal of Zhejiang University: Engineering Science, 2012, 46(07): 1168-1174.
[11] BIANCO C G L, GERELLI O. Trajectory scaling for a manipulator inverse dynamics control subject to generalized force derivative constraints [C]∥International Conference on Intelligent Robots and Systems. St. Louis: IEEE, 2009: 5749-5754.
[12] 陈伟海,武桢,丁希伦,等.冗余度机器人动力学容错控制技术研究[J].北京航空航天大学学报,2000, 26(6): 726-730.
CHEN Weihai, WU Zhen, DING Xilun,et al.Research on fault tolerant control of dynamically redundant manipulators [J]. Journal of Beijing University of Aeronautics And Astronautics, 2000, 26(6): 726-730.
[13] ZHANG Yunong, WANG Jun. A dual neural network for constrained joint torque optimization of kinematically redundant manipulators [J]. IEEE Transactions on Systems Man and Cybernetics Part B, 2002, 32(5):654-662.
[14] FLACCO F, LUCA A D, KHATIB O. Motion control of redundant robots under joint constraints: saturation in the null space [C]∥2012 IEEE International Conference on Robotics and Automation (ICRA). St. Paul: IEEE, 2012: 285-292.
[15] LIEGEOIS A. Automatic supervisory control of the configuration and behavior of multibody mechanisms [J]. IEEE Transactions on Systems Man and Cybernetics, 1977, 7(12): 868-871.
[16] NAKAMURA Y, HANAFUSA H, YOSHIKAWA T. Taskpriority based redundancy control of robot manipulators [J]. International Journal of Robotics Research, 1987, 6(2): 315.
[17] XIANG J, ZHONG C W, WEI W. Generalweighted leastnorm control for redundant manipulators [J]. IEEE Transactions on Robotics, 2010, 26(4):660-669.
[18] 钟琮玮.仿人型乒乓球机械手运动学及动力学控制方法研究[D].杭州:浙江大学, 2011.
ZHONG Congwei. Kinematic and dynamic control of a humanoid pingpong manipulator [D]. Hangzhou: Zhejiang University, 2011.
[19] XIANG J, ZHONG C W, WEI W. A varied weights method for the kinematic control of redundant manipulators with multiple constraints [J]. IEEE Transactions on Robotics, 2012, 28(2): 330-340.
[20] CORKE P. Robotics, vision and control [M]. Berlin: Springer, 2011.

[1] 毛晨涛,陈章位,张翔,祖洪飞. 基于相对精度指标的机器人运动学校准[J]. 浙江大学学报(工学版), 2020, 54(7): 1316-1324.
[2] 吴爱国,吴绍华,董娜. 机械臂非奇异快速终端滑模模糊控制[J]. 浙江大学学报(工学版), 2019, 53(5): 862-871.
[3] 李智靖,叶锦华,吴海彬. 基于卷积力矩观测器与摩擦补偿的机器人碰撞检测[J]. 浙江大学学报(工学版), 2019, 53(3): 427-434.
[4] 潜龙昊, 胡士强, 杨永胜. 多节双八面体变几何桁架臂逆运动学解析算法[J]. 浙江大学学报(工学版), 2017, 51(1): 75-81.
[5] 黄水华,江沛,韦巍,项基,彭勇刚. 基于四元数的机械手姿态定向控制[J]. 浙江大学学报(工学版), 2016, 50(1): 173-179.
[6] 江沛, 黄水华, 韦巍, 单才华, 项基.
带关节约束的非冗余机械手臂二阶逆运动学控制
[J]. 浙江大学学报(工学版), 2015, 49(10): 1885-1892.
[7] 刘湘琪,蒙臻,倪敬,朱泽飞. 三自由度液压伺服机械手轨迹优化[J]. 浙江大学学报(工学版), 2015, 49(9): 1776-1782.
[8] 杨钟亮, 唐智川, 陈育苗, 高增桂. 面向双侧训练的前臂外骨骼肌肉力-电关系识别模型[J]. 浙江大学学报(工学版), 2014, 48(12): 2152-2161.
[9] 金博, 刘山. 基于终点时刻末端误差的柔性臂迭代学习控制[J]. J4, 2012, 46(8): 1512-1519.
[10] 倪初锋, 刘山. 变负载条件下柔性臂自适应预整形振动控制[J]. J4, 2012, 46(8): 1520-1525.
[11] 钟琮玮, 项基, 韦巍, 张远辉, 陈鹏. 基于扰动观测器的机械手碰撞检测与安全响应[J]. J4, 2012, 46(6): 1115-1121.
[12] 钟琮玮, 项基, 韦巍, 张远辉. 基于简化非线性观测器的LuGre动态摩擦力补偿[J]. J4, 2012, 46(4): 764-769.
[13] 姜宏超, 刘士荣, 张波涛. 六自由度模块化机械臂的逆运动学分析[J]. J4, 2010, 44(7): 1348-1354.
[14] 帅鑫, 李艳君, 吴铁军. 一种柔性机械臂末端轨迹跟踪的预测控制算法[J]. J4, 2010, 44(2): 259-264.
[15] 张雨浓, 肖秀春, 陈扬文, 等. Hermite前向神经网络隐节点数目自动确定[J]. J4, 2010, 44(2): 271-275.