Added Xbee capability (either Xbee or LCD), current addresses are hardcoded and xbee radios are switch 5 and 6. A lot of cleanup is required to make it all sensible