说明：  实现六自由度运动学逆解算法，采用的是通用的平面波展开法,雅克比迭代求解线性方程组课设。
( Six degrees of freedom to achieve inverse kinematics algorithm, Using common plane wave expansion method, Jacobi iteration for solving linear equations class-based.)