摘要
为了实现EAST装置真空室内的内窥多关节机械臂的实时高精度控制,提出了一种逆运动学算法,即建立机械臂多变量的方程组,转化成为矩阵的特征值问题求解。为了验证和满足实际控制的需要,还基于VC++6.0开发了MFC运动学算法程序。结果表明,该算法能在ms级别内得到机械臂的所有运动学逆解。
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.
出处
《核聚变与等离子体物理》
CAS
CSCD
北大核心
2015年第2期131-136,共6页
Nuclear Fusion and Plasma Physics
基金
国家磁约束核聚变能发展研究专项(2014GB101003)
关键词
EAST
内窥机械臂
矩阵特征值
逆运动学
实时
高精度
EAST
Viewing manipulator
Matrix eigenvalues
Inverse kinematics
Real-time
High accuracy
