cleanup of brushless.cpp with state machine. startup is BROKEN