Added support for servos (not working...)