Please wait a minute...
 首页  期刊介绍 期刊订阅 联系我们 横山亮次奖 百年刊庆
 
最新录用  |  预出版  |  当期目录  |  过刊浏览  |  阅读排行  |  下载排行  |  引用排行  |  横山亮次奖  |  百年刊庆
清华大学学报(自然科学版)  2020, Vol. 60 Issue (12): 1007-1015    DOI: 10.16511/j.cnki.qhdxxb.2020.25.019
  机械工程 本期目录 | 过刊浏览 | 高级检索 |
针对关节限位优化的7自由度机械臂逆运动学解法
胡奎,张继文,董云飞,吴丹*()
清华大学 机械工程系, 北京 100084
Inverse kinematic optimization for 7-DoF serial manipulators with joint limits
Kui HU,Jiwen ZHANG,Yunfei DONG,Dan WU*()
Department of Mechanical Engineering, Tsinghua University, Beijing 100084, China
全文: PDF(2065 KB)   HTML
输出: BibTeX | EndNote (RIS)      
摘要 

为解决机械臂运行过程中避让关节限位的问题,该文以S-R-S构型的7自由度机械臂为对象,提出了一种机械臂逆运动学优化算法。首先,引入臂角变量,推导得到含臂角变量的逆运动学封闭解,并在此基础上,将关节限位和臂角可行范围进行映射;其次,定义一种包含权重函数的避限位优化目标函数,其中权重函数取值与关节实际位置有关;最后,通过线性展开方法简化臂角与关节位置的关系式,从而将原有复杂形式的优化目标函数简化为二次函数,结合求得的臂角可行范围完成优化求解,实现关节避限位。计算结果表明:该算法可以有效避让关节限位,且直观、简单、运算效率较高,可以进行实时运算。

服务
把本文推荐给朋友
加入引用管理器
E-mail Alert
RSS
作者相关文章
胡奎
张继文
董云飞
吴丹
关键词 冗余机械臂逆运动学避限位7自由度    
Abstract

An optimized inverse kinematic algorithm was developed for 7 degrees of freedom (7-DoF) manipulators with an S-R-S kinematic structure that avoids joint limits. The first step determines the closed-form solution of the inverse kinematics model based on the arm angle parameter. The result is then used to determine feasible arm angle intervals for the given joint limits. Then, an optimal weighted target function is defined to avoid the joint limits with the weights determined according to the joint positions. The relations between the joint angles and the arm angles are then linearized to simplify the complex optimal target function to a quadratic function. The optimization problem that includes the feasible arm angle intervals then avoids the joint limit. This intuitive, efficient algorithm is effective, avoids the joint limits and can be computed online.

Key wordsredundant manipulator    inverse kinematics    joint limit avoidance    7-DoF
收稿日期: 2019-09-27      出版日期: 2020-10-14
通讯作者: 吴丹     E-mail: wud@tsinghua.edu.cn
引用本文:   
胡奎,张继文,董云飞,吴丹. 针对关节限位优化的7自由度机械臂逆运动学解法[J]. 清华大学学报(自然科学版), 2020, 60(12): 1007-1015.
Kui HU,Jiwen ZHANG,Yunfei DONG,Dan WU. Inverse kinematic optimization for 7-DoF serial manipulators with joint limits. Journal of Tsinghua University(Science and Technology), 2020, 60(12): 1007-1015.
链接本文:  
http://jst.tsinghuajournals.com/CN/10.16511/j.cnki.qhdxxb.2020.25.019  或          http://jst.tsinghuajournals.com/CN/Y2020/V60/I12/1007
  S-R-S构型的7自由度机械臂
10.16511/j.cnki.qhdxxb.2020.25.019.T001

机械臂D-H参数表

序号 ai di αi θi 关节范围/(°)
1 0 dBS - π/2 θ1 [θ1l, θ1u]
2 0 0 π/2 θ2 [θ2l, θ2u]
3 0 dSE - π/2 θ3 [θ3l, θ3u]
4 0 0 π/2 θ4 [θ4l, θ4u]
5 0 dEW - π/2 θ5 [θ5l, θ5u]
6 0 0 π/2 θ6 [θ6l, θ6u]
7 0 dWF 0 θ7 [θ7l, θ7u]
  
机械臂D-H参数表
  臂角的定义
  函数Ci=h(ψ)图
  at2+bt2ct2≤0时关节角度随臂角变化图
  at2+bt2ct2>0时关节角度随着臂角的变化
  权重函数(a=2.38,b=2.28)
  当优化臂角ψt+1opt不在可行范围内的情况
  7自由度机械臂
  不同算法对应的圆弧轨迹逆运动学计算结果
10.16511/j.cnki.qhdxxb.2020.25.019.T002

不同算法计算的圆弧轨迹最终关节位置表

关节 圆弧轨迹最终关节位置/(°)
非优化算法 本文算法 文[3]算法
1 8.69 6.27 26.16
2 85.95 98.68 78.63
3 57.17 101.31 -11.72
4 35.39 35.39 35.39
5 -26.49 -75.30 52.30
6 -124.31 -113.16 -119.59
7 -24.39 -34.68 -0.47
  
不同算法计算的圆弧轨迹最终关节位置表
1 YAN L, MU Z G, XU W F. Analytical inverse kinematics of a class of redundant manipulator based on dual arm-angle parameterization[C]//2014 IEEE International Conference on Systems, Man, and Cybernetics. San Diego, USA: IEEE, 2014: 3744-3749.
2 WAN J , WU H T , MA R , et al. A study on avoiding joint limits for inverse kinematics of redundant manipulators using improved clamping weighted least-norm method[J]. Journal of Mechanical Science and Technology, 2018. 32 (3): 1367- 1378.
doi: 10.1007/s12206-018-0240-7
3 SHIMIZU M, YOON W K, KITAGAKI K. A practical redundancy resolution for 7-DoF redundant manipulators with joint limits[C]//Proceedings of the 2007 IEEE International Conference on Robotics and Automation. Roma, Italy: IEEE, 2007: 4510-4516.
4 FARIA C , FERREIRA F , ERLHAGEN W , et al. Position-based kinematics for 7-DoF serial manipulators with global configuration control, joint limit and singularity avoidance[J]. Mechanism and Machine Theory, 2018. 121, 317- 334.
doi: 10.1016/j.mechmachtheory.2017.10.025
5 WANG W R, GU J L, ZHU M C, et al. An obstacle avoidance method for redundant manipulators based on artificial potential field[C]//2018 IEEE International Conference on Mechatronics and Automation (ICMA). Changchun, China: IEEE, 2018: 2151-2156.
6 GONG M D , LI X D , ZHANG L . Analytical inverse kinematics and self-motion application for 7-DoF redundant manipulator[J]. IEEE Access, 2019. 7, 18662- 18674.
doi: 10.1109/ACCESS.2019.2895741
7 ZHAO L L, ZHAO J D, LIU H, et al. Efficient inverse kinematics for redundant manipulators with collision avoidance in dynamic scenes[C]//2018 IEEE International Conference on Robotics and Biomimetics (ROBIO). Kuala Lumpur, Malaysia: IEEE, 2018: 2502-2507.
8 KIM H , ROSEN J . Predicting redundancy of a 7-DoF upper limb exoskeleton toward improved transparency between human and robot[J]. Journal of Intelligent & Robotic Systems, 2015. 80 (1): 99- 119.
10 ZHAO J, XU T, FANG Q Q, et al. A synthetic inverse kinematic algorithm for 7-DoF redundant manipulator[C]//2018 IEEE International Conference on Real-time Computing and Robotics (RCAR). Kandima, Maldives: IEEE, 2018: 112-117.
11 LIéGEOIS 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.
doi: 10.1109/TSMC.1977.4309644
12 WANG J G , LI Y M , ZHAO X H . Inverse kinematics and control of a 7-DoF redundant manipulator based on the closed-loop algorithm[J]. International Journal of Advanced Robotic Systems, 2010. 7 (4): 1- 9.
14 SINGH G K, CLAASSENS J. An analytical solution for the inverse kinematics of a redundant 7-DoF manipulator with link offsets[C]//2010 IEEE/RSJ International Conference on Intelligent Robots and Systems. Taipei, China: IEEE, 2010: 2976-2982.
16 CHEN B C, CAO G Z, LI W B, et al. An analytical solution of inverse kinematics for a 7-DoF redundant manipulator[C]//2018 15th International Conference on Ubiquitous Robots (UR). Honolulu, HI, USA: IEEE, 2018: 523-527.
17 SINHA A, CHAKRABORTY N. Geometric search-based inverse kinematics of 7-DoF redundant manipulator with multiple joint offsets[C]//2019 International Conference on Robotics and Automation (ICRA). Montreal, Canada: IEEE, 2019: 5592-5598.
18 LI S P, WANG Z J, ZHANG Q, et al. Solving inverse kinematics model for 7-DoF robot arms based on space vector[C]//2018 International Conference on Control and Robots (ICCR). Hong Kong, China: IEEE, 2018: 1-5.
21 KUHLEMANN I, SCHWEIKARD A, JAUER P, et al. Robust inverse kinematics by configuration control for redundant manipulators with seven DoF[C]//20162nd International Conference on Control, Automation and Robotics (ICCAR). Hong Kong, China: IEEE, 2016: 49: 55.
[1] 李亚昕, 王国磊, 张剑辉, 田鑫亮, 安静, 陈恳. 基于碰撞反馈的冗余机器人避障规划算法[J]. 清华大学学报(自然科学版), 2022, 62(3): 408-415.
[2] 郭吉昌, 朱志明, 王鑫, 马国锐. 全位置焊接机器人逆运动学数值求解及轨迹规划方法[J]. 清华大学学报(自然科学版), 2018, 58(3): 292-297.
Viewed
Full text


Abstract

Cited

  Shared   
  Discussed   
版权所有 © 《清华大学学报(自然科学版)》编辑部
本系统由北京玛格泰克科技发展有限公司设计开发 技术支持:support@magtech.com.cn