Bugfixing, changed uart_write_blocking
UART might work now, Tests comming soon.