Updates for servo and additional FET outputs

Signed-off-by: Charles Steinkuehler <charles@steinkuehler.net>