一种六自由度机械手奇异回避算法

摘要/Abstract

摘要： 针对传统机械手奇异回避算法存在的计算量大、实时性差的问题，提出了基于“奇异分离+指数级阻尼倒数”的奇异回避算法。首先，在对机械手运动学建模分析的基础上，通过Jacobian矩阵计算将导致奇异的参数分离出来；然后，介绍了指数级阻尼倒数算法的原理，并对采用指数级阻尼倒数进行奇异回避导致的误差进行了研究。仿真与实验结果表明，该算法可实现关节角速度在奇异域的平稳光滑过渡，且仅牺牲了机械臂末端在部分方向上的精度，由此算法的有效性和实用性得到验证。

关键词: 六自由度机械手, 奇异回避, 奇异分离, 指数级阻尼倒数

Abstract: Aiming at the problems of the heavier calculation burden and worse real-time of traditional singularity avoidance algorithms, a novel approach (named “singularity separation plus exponential order damped reciprocal” algorithm) was proposed for 6-DOF manipulators. Firstly, the singularity configurations were analyzed and the singularity parameters were separated based on the kinematics calculation. Then, the principle of exponential order damped reciprocal algorithm was introduced and error coefficient caused by the exponential order damped reciprocal algorithm was analyzed. The simulation and experimental results show that the proposed algorithm may achieve smooth transition of joint angular velocities and only part velocities accuracy of the end-effector are sacrificed, the effectiveness and practicability of the proposed algorithm are proved.

Key words: 6-DOF manipulator, singularity avoidance, singularity separation, exponential order damped reciprocal

中图分类号:

TP242.2

崔洪新, 李焕良, 韩金华, 李沛. 一种六自由度机械手奇异回避算法[J]. 中国机械工程.

CUI Hongxin, LI Huanliang, HAN Jinhua, LI Pei. A Novel Avoid Singularity Algorithm for 6-DOF Manipulators[J]. China Mechanical Engineering.

参考文献

[1]刘海涛. 工业机器人的高速高精度控制方法研究[D]. 广州：华南理工大学，2012.
LIU Haitao. Research on High-speed and High-precision Control of Industrial Robots [D]. Guangzhou: South China University of Technology,2012.

[2]CHIAVERINI S, SICILIANO B，EGELAND O. Review of Damped Least-squares Inverse Kinematics with Experiments on an Industrial Robot Manipulator[J]. IEEE Transactions on Control Systems Technology,1994,2(2):123-134.

[3]CHENOWETH S K M, SORIA J, OOI A. A Singularity-avoiding Moving Least Squares Scheme for Two-dimensional Unstructured Meshes[J]. Journal of Computational Physics,2009,228(15):5592-5619.

[4]CHIAVERINI S. Singularity-robust Task-priority Redundancy Resolution for Real-time Kinematic Control of Robot Manipulators[J]. IEEE Transactions on Robotics and Automation,1997,13(3):398-410.

[5]XIAO Wenlei, JI Huan. Redundancy and Optimization of a 6R Robot for Five-axis Milling Applications: Singularity, Joint Limits and Collision[J]. Production Engineering,2012,6(3):287-296.

[6]刘玮, 常思勤. 一种新型并联机器人的奇异性与工作空间研究[J]. 中国机械工程, 2012, 23(7): 786-789.
LIU Wei, CHANG Siqin. Study on Singularity and Workspace of a Novel Parallel Manipulator[J]. China Mechanical Engineering,2012,23(7):786-789.

[7]CHENG F T, HOUR T L, SUN Y Y, et al. Study and Resolution of Singularities for a 6-DOF PUMA Manipulator[J]. IEEE Transactions on System, Man and Cybernetics, Part B: Cybernetics,1997,27(2):332-343.

[8]徐文福,梁斌,刘宇,等. 一种新的PUMA类型机器人奇异回避算法[J]. 自动化学报, 2008,34(6): 670-675.
XU Wenfu, LIANG Bin, LIU Yu, et al. A Novel Approach to Avoid Singularities of PUMA-type Manipulators[J]. Acta Automatica Sinica,2008,34(6):670-675.

[9]PENDAR H, MAHNAMA M, ZOHOOR H. Singularity Analysis of Parallel Manipulators Using Constraint Plane Method[J]. Mechanism and Machine Theory,2011,46(1):33-43.

[10]LI Qinchuan, XIANG J, CHAI X, et al. Singularity Analysis of a 3-RPS Parallel Manipulator Using Geometric Algebra[J]. Chinese Journal of Mechanical Engineering,2015,28(6):1204-1212.

[11]PARK J O, IM Y D. Singularity Avoidance of CMGs by Virtual Actuators[J]. International Journal of Control Automation and Systems,2010,8(4):891-895.

[12]MCMAHON J, SCHAUB H. Simplified Singularity Avoidance Using Variable-speed Control Moment Gyroscope Null Motion[J]. Journal of Guidance Control and Dynamics, 2009,32(6):1938-1943.

[1]	肖帆;李光;游雨龙. 空间3R机械手逆向运动学的多模块神经网络求解[J]. 中国机械工程, 2019, 30(10): 1233-1238.
[2]	刘洋;赵臣;王旭浩;张佳俊. 喷涂机器人静电旋杯的新模型[J]. 中国机械工程, 2019, 30(06): 709-715.
[3]	张铁1;李昌达1;覃彬彬1;刘晓刚2. SCARA机器人的自适应迭代学习轨迹跟踪控制[J]. 中国机械工程, 2018, 29(14): 1724-1729.
[4]	韩江；谷涛涛；夏链;董方方. 基于混合插值的工业机器人关节轨迹规划算法[J]. 中国机械工程, 2018, 29(12): 1460-1466.
[5]	张旭1;贾君慧1;张刚2. 基于镜面反射的手眼标定方法[J]. 中国机械工程, 2018, 29(10): 1153-1158,1165.
[6]	张铁;张斌. 机器人砂带磨削路径优化插补算法[J]. 中国机械工程, 2018, 29(08): 983-990.
[7]	李毅1,2,3;陈佳洋1;胡圣贤1;邓鑫1;张枫涛1;谢晓雪1. 基于旋转电弧的机器人角焊缝跟踪建模及仿真[J]. 中国机械工程, 2018, 29(03): 348-352.
[8]	董甲甲;王太勇;董靖川;张永宾;陶浩. 改进B样条曲线应用于6R机器人轨迹优化[J]. 中国机械工程, 2018, 29(02): 193-200.
[9]	陈国良, 马辉, 张钏钏. 微操作中操作者瞳孔的定位方法研究[J]. 中国机械工程, 2017, 28(04): 385-390.
[10]	李宏胜, 汪允鹤, 黄家才, 施昕昕. 工业机器人倍四元数轨迹规划算法的研究[J]. 中国机械工程, 2016, 27(20): 2711-2716.
[11]	张铁, 苏杰汶. 基于改进蚁群算法的机器人末端路径排序优化[J]. 中国机械工程, 2016, 27(19): 2624-2629.
[12]	杨仲升, 黄云, 邹莱, 任旭. 铝合金轮毂机器人光整加工控制技术研究[J]. 中国机械工程, 2016, 27(14): 1857-1862.
[13]	黄康, 何春生, 甄圣超, 洪健, 赵福民. 基于区间分析的机器人绝对定位精度分析方法[J]. 中国机械工程, 2016, 27(11): 1467-1473.
[14]	秦利, 刘福才, 梁利环, 金振林. 基于滑模的混联仿人空间机械臂轨迹跟踪控制[J]. 中国机械工程, 2015, 26(4): 435-441.
[15]	卞永明;蒋佳;杨礼斌. 基于弱磁控制的工程机械自适应电子差速控制[J]. 中国机械工程, 2014, 25(14): 1972-1977.