Fig. (16)
Control torque of joint 1 by controller (43).