三自由度机械臂轨迹规划源程序,输入为空间三维坐标，输出为相应电机需要旋转的角度-Three degrees of freedom manipulator trajectory planning source, enter the three-dimensional coordinates for the space, the output of the corresponding motor rotation angle required