I decided to ditch the home brew serial comms over xbee and go with a more professional/hobby radio control system. In the meatime, I wanted to continue to code the control system, so I added a display to give me independence from the arduino serial monitor screen.

Here we see the yaw, pitch and roll numbers from the mpu, zero lag I'm happy to say.