Improved bit-bang UART test func for demo