Fig. (17)
Control torque of joint 2 by controller (43).