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