Fix endless loop in uart0_wait_for_tx_fifo, fixes #5