- yet another servo out implementation
- clean up switch mode check