this is simply the inverse of what the flight code does
SITL: Added setup note to comment SITL: IE24: Add Error param and cycle battery pwr