p54: Move TX/RX code