Added HAL_UartTaskHandler() to main loop