xmega: Merged NewStep.c, moved DigitalServoControl.c