Work on arduino calibrationloop fsm