Figure 7:
Simulink model of robot.