Fig. (12)
Control torque of joint 2 by controller (29).