Add Xbee support and improve LCD displaying