Fix timing issues.

It is worth noting that MS2ST and US2ST functions provided by ChibiOS are approximations, so they break with very small timesteps.
Add XBee configuration notes.
Define pi to 20 decimal digits.
Minor change to UART loop timing.
Include math.
Configure MPU-6000.