[Firmware] fixed wrong current conversion

-Fixed the amplifier gain.
-Reduced the max value of the integrator of the current regulator, to
minimize the current overshoot.