Modified stk600.c to UART example