该源代码经本次测试后,可以正常运行。可以在MATLAB中实现机械臂的轨迹规划