Simulink 三自由度机械臂连续轨迹控制