二自由度机器人迭代闭环PD型轨迹跟踪控制,matlab/simulink仿真程序