Servo arm positioning code, redirect stdout to UART for debug output