PUMA560机器人的前三关节动力学模型纯simulink模块搭建_及计算力矩(CTC)轨迹跟踪控制matlab仿真