Coerce SERVO mode to OUTPUT mode

Signed-off-by: Rick Waldron <waldron.rick@gmail.com>
v0.3.2

Signed-off-by: Rick Waldron <waldron.rick@gmail.com>