headCode has run pid in a seperate function
Transmit battery voltages for diagnostics.
Minimum loop time is now 50ms. Stop movement before calibration and ignore a repeated calibrate command.