Change debug USART, finish routing