Figure 4: Simulink block diagram of the robot Jacobian