Print over UART.
Move setup_comm to main.
Add delay to let setup functions finish.

Otherwise, the system hangs.
Create second comm thread on USART3.