Re-add servoSetDirection, remove unnecessary code in uart.c