Fig. (11)
Control torque of joint 1 by controller (29).