Fix XBee connection & data sending