fix reset timing for torque integration in MTQ controller

fix reset timing for torque integration in MTQ controller #534