Add Serial Port Command Interface and StateMachine