这个一个四自由度的机械臂逆解析算法程序。通过设置坐标位置可以输出各个舵机的转动角度。