实现六自由度运动学逆解算法，包括 MUSIC算法，ESPRIT算法 ROOT-MUSIC算法，快速扩展随机生成树算法。- Six degrees of freedom to achieve inverse kinematics algorithm, Including the MUSIC algorithm, ESPRIT algorithm ROOT-MUSIC algorithm, Rapid expansion of random spanning tree algorithm.