XMega: Fix bug reading N-Byte messages