Revert this change, it didn't work.
Put the XBee timing logic in the XBee file.
Switch to using interrupts off the MPU.