Current measurement fixes - though it does not work correctly on ESC32