Added XBee code to node firmware