Working FreeRTOS serial port