Added stuff to separate out and select I2C vs SPI operation.

NOT COMPLETE!
Misc mods for testing SPI operation with XBees and various power setups.
Added in test stuff to check for XBee messages. Seems to work!