PUMA560机械臂的正逆解+轨迹规划

代码说明：

Puma560机械臂的运动学正逆解、基于三次多项式和五次多项式的轨迹规划。没有用机器人工具箱，纯自己看公式手动编程。程序包括运动学正解、运动学逆解、工作空间计算、轨迹规划。