Cleanup + echo on/off for UART mode