Extracts motor control logic from commander task.
Switch to 400Hz pwm.
Added ESC arming.