本程序为类人机器人的一个运动学正解程序，非常好的参考程序，可以继续在上面扩充-This program is a humanoid robot kinematics program, very good reference program, you can continue to expand in the above