Massive updates to the Xbee.cpp code