基于矩阵分解的一般6R机器人实时高精度逆运动学算法

为解决现有的一般6R机器人实时逆运动学算法存在计算过程复杂和有增根的问题，提出一种优化的实时高精度算法。将6个基础逆运动学方程作变形处理，通过符号运算把目标矩阵从24阶降低到16阶，提高计算效率的同时消除了增根。采用矩阵特征分解方法求解关节变量，保证了算法的稳定性和精度。在VC++环境中编译和调用CLAPACK进行矩阵运算，所有计算过程采用C/C++语言和面向对象程序设计方法实现。求解实例表明，提出的算法能在平均1.37 ms内得到一般6R机器人的16组逆运动学解，并使对应的正运动学末端位姿矩阵元素精确到小数点后12位，可用于实时高精度在线控制。

Real-time and High-accurate Inverse Kinematics Algorithm for General 6R Robots Based on Matrix Decomposition

In order to solve the problem that the existing real time algorithms for inverse kinematics of general 6R robots have complex procedures and extraneous roots,an optimized algorithm with real-time and high-accuracy performances is proposed.The 6 basic inverse kinematics equations are transformed through symbolic processing and the order of target matrix is reduced from 24 to 16,thus improving the algorithmic efficiency while eliminating extraneous roots.Eigen-decomposition is exploited to extract roots from ...