XMega: Make debug echo the message