Better Control Law with Torque Integration