Floorbot fix, better charging code