Add PID torque behavior