EAST 六自由度内窥机械臂的逆运动学算法研究

核聚变与等离子体物理 ›› 2015, Vol. 35 ›› Issue (2): 131-136.

EAST 六自由度内窥机械臂的逆运动学算法研究

魏小洋，王堃，潘洪涛，赵文龙

(1. 中国科学院等离子体物理研究所，合肥 230031；2. 中国科学技术大学，合肥 230026)

出版日期:2015-06-15 发布日期:2015-06-15
作者简介:魏小洋(1991-)，男，安徽马鞍山人，硕士研究生，精密仪器及机械专业。
基金资助:
国家磁约束核聚变能发展研究专项(2014GB101003)

Inverse kinematics algorithm preliminary research for EAST in-vessel viewing 6R manipulators

WEI Xiao-yang1, WANG Kun1, PAN Hong-tao1, 2, ZHAO Wen-long1

(1. Institute of Plasma Physics, Chinese Academy of Sciences, Hefei 230031； 2. University of Science and Technology of China, Hefei 230026)

Online:2015-06-15 Published:2015-06-15

摘要/Abstract

摘要：

为了实现 EAST 装置真空室内的内窥多关节机械臂的实时高精度控制，提出了一种逆运动学算法，即建立机械臂多变量的方程组，转化成为矩阵的特征值问题求解。为了验证和满足实际控制的需要，还基于 VC++6.0 开发了 MFC 运动学算法程序。结果表明，该算法能在 ms 级别内得到机械臂的所有运动学逆解。

关键词: EAST, 内窥机械臂, 矩阵特征值, 逆运动学, 实时, 高精度

Abstract:

A universal inverse kinematics algorithm which aim is for EAST in-vessel viewing manipulators with coupled articulated structure has been proposed to realize its real-time and high accuracy control. This is to build manipulator kinematics multivariable equations, which can be expressed as a univariate matrix polynomial and solved through getting the eigenvalues of the matrix determinant eventually. Moreover, in order to meet the requirement of programming and actual control of manipulator, positive and inverse kinematics was validated by software developed based on MFC of VC++6.0. The solved instance indicated that the proposed algorithm can obtain all of the inverse kinematics solutions of the manipulators in ms level.

Key words: EAST, Viewing manipulator, Matrix eigenvalues, Inverse kinematics, Real-time, High accuracy

中图分类号:

TP242.3

魏小洋，王堃，潘洪涛，赵文龙. EAST 六自由度内窥机械臂的逆运动学算法研究[J]. 核聚变与等离子体物理, 2015, 35(2): 131-136.

WEI Xiao-yang1, WANG Kun1, PAN Hong-tao1, 2, ZHAO Wen-long1. Inverse kinematics algorithm preliminary research for EAST in-vessel viewing 6R manipulators[J]. NUCLEAR FUSION AND PLASMA PHYSICS, 2015, 35(2): 131-136.

[1]	梁启超, 张伟, 刘鲁南, 秦成明, 毛玉周, 杨桦. EAST装置上新型离子回旋天线法拉第屏蔽的设计及应用[J]. 核工业西南物理研究院, 2025, 45(1): 1-6.
[2]	杨先科, 殷磊, 姚达毛. EAST 装置高场侧 NBI 束透区第一壁的设计和分析[J]. 核工业西南物理研究院, 2024, 44(4): 450-455.
[3]	顾永奇, 郑元阳, 袁忠, 王俊, 魏文琪 . EAST 准直测量基准控制网升级改造方案的设计及实施[J]. 核工业西南物理研究院, 2024, 44(3): 290-296.
[4]	龚少博, 余羿, 王志斌, 王华杰, 袁金榜, 刘灏, 吴婷, 龙婷, 陈逸航, 柯锐, 聂林, 王占辉, 孙爱萍, 许敏. HL-2A装置相衬成像系统的安全连锁与远程监控[J]. 核工业西南物理研究院, 2024, 44(2): 157-162.
[5]	王泽, 胡纯栋, 谢亚红, 刘伟, 崔庆龙, 赵远哲, 许永建, 班挺, 段练. 射频负离子源中性束关键参数监控报警系统研制[J]. 核工业西南物理研究院, 2024, 44(2): 183-190.
[6]	陈小璐, 李鹏远, 魏海鸿, 许婉韵, 陈辉. 遥操作机械臂在托卡马克内运动轨迹的虚拟仿真研究[J]. 核工业西南物理研究院, 2024, 44(2): 191-197.
[7]	陈明, 沈飊, Shinichiro Kado, 陈大龙, 张恒, 郭笔豪, 黄耀, 蔡福瑞, 肖炳甲. EAST等离子体边界可见光成像系统研究[J]. 核工业西南物理研究院, 2024, 44(2): 222-228.
[8]	孟凡卫, 张小辉, 胡广海, 孔德峰, 叶扬, 黄艳清, 齐美彬, 赵志豪, 李博, 董期龙. EAST-CTI测试平台上六硼化镧等离子体源的研制[J]. 核工业西南物理研究院, 2024, 44(1): 24-29.
[9]	杨明, 张新军, 李新霞, 吕波, 古敬仁. EAST低杂波加热对同向切向中性束碰撞力矩影响的研究[J]. 核工业西南物理研究院, 2024, 44(1): 92-97.
[10]	李宜轩, 夏凡, 杨宗谕, 龚新文, 陈程远, 肖国梁, 朱晓博 . 基于深度学习的 HL-2A 装置 ELM 实时控制系统的研制[J]. 核工业西南物理研究院, 2023, 43(4): 380-385.
[11]	郑盈盈, 林士耀, 吴国斌, 赵金龙, 张继宗, 周润晖, 李强, 曹宏睿, 袁旗平, 肖炳甲 . 二维硬 X 射线探测器自动标定平台研究 [J]. 核工业西南物理研究院, 2023, 43(3): 324-331.
[12]	王保国, 朱大焕, 丁锐, 穆磊, 李长君, 陈俊凌 . EAST 边缘等离子体中钨表面电弧诱导实验研究[J]. 核聚变与等离子体物理, 2023, 43(2): 156-160.
[13]	章志涛, 丁芳, 罗宇, 陈夏华, 叶大为, 张青, 胡振华, 罗广南. 基于小波变换的 Stark 展宽算法的优化研究 [J]. 核聚变与等离子体物理, 2023, 43(2): 212-218.
[14]	谢飞, 郑玮, 张明, 唐畴尧, 徐鑫, 阳成, 何波, 徐佳宇. 基于 LabVIEW 的实时控制框架在 J-TEXT 上的应用[J]. 核聚变与等离子体物理, 2022, 42(4): 393-398.
[15]	李孟曼妮, 侯吉磊, 左桂忠, 陈跃, 李成龙, 刘建文, 叶凯萱, 黄佳, 胡建生 . EAST中加热功率对弹丸注入加料效率的影响 [J]. 核聚变与等离子体物理, 2022, 42(4): 426-432.