Figure 19: Applied torque for joint using the control scheme.