Working arm control
Merge branch 'arm-servo-control' into bluetooth-connection
Restructured usart code into shared lib