DE refactored as state machine

Dependencies:   Motor Servo