Simulink仿真中利用S-fuction实现的双关节机械臂PD控制器