while(!serial0_hasChar()) {

			if(time_millis() - scanStart > 7000) {

				led_errorcode(ERROR_XBEETIMEOUT);

				return;

			}

			wdt_reset();

		}

		// Scan data end when newline by itself ("")	

		int lineCount = 0;	

		while(1) {

			bufPtr = serial0_readLine();

			// If we're starting a new block but got a newline instead, we're done!

			if(lineCount == 0 && strcmp(bufPtr, "") == 0) {

				break;			

			}

			if(lineCount == 1) {

				strncpy(slaveAddressHigh[nodeCount],bufPtr, 9);

			}

			else if(lineCount == 2) {

				strncpy(slaveAddressLow[nodeCount],bufPtr, 9);

			}

			else if(lineCount == 3) {

				strncpy(slaveNames[nodeCount], bufPtr, 20);

			}

			// If we've finished one chunk (including the newline after it). Can't be else if because it controls increment.

			if(lineCount == 9) {

				// bufPtr should be null at this point, because we read in a newline after one chunk

				nodeCount++;

				lineCount = 0;

			}

			else {

				lineCount++;

			}

		}		

		slavesensors_exitAT();

	}

	// Display number of found nodes on spinning indicator

	switch(nodeCount) {

		case 0:

			break;

		case 3:

			led_on(LED_ACT2);

			_delay_ms(100);

		case 2:

			led_on(LED_ACT1);

			_delay_ms(100);	

		case 1:

			led_on(LED_ACT0);

			_delay_ms(100);

	}

	led_on(LED_SIDEBOARD);

	_delay_ms(200);

	led_off(LED_SIDEBOARD);

	#ifdef DEBUG_OUTPUT

	char debugBuf[64];

	serial0_sendString("Discovered: \r\n");

	for(int i=0; i<nodeCount; i++) {

		snprintf(debugBuf, 64, "  %s - %s%s (%u)\r\n", slaveNames[i],slaveAddressHigh,slaveAddressLow[i], i);

		serial0_sendString(debugBuf);

	}

	serial0_sendString("\r\n");

	if(atOK != 0) {

		serial0_sendString("AT mode failed \r\n");

	}

	#endif

	for(int i=0; i<nodeCount; i++) 

	{

		if(strcmp(slaveNames[i], XBEE_LOGDEST_NAME) == 0) 

		{

			loggerIndex = i;

		}

	}

	_delay_ms(100);

	slavesensors_selectlogger();

	serial0_ion();

}

// #define DEBUG_SELECTNODE

void slavesensors_selectnode(uint8_t nodeIndex)

{

	serial0_ioff();

	#ifdef DEBUG_SELECTNODE

	serial0_sendString("Switch to node ");

	serial0_sendChar(nodeIndex + 0x30);

	serial0_sendString("\r\n");

	#endif

	_delay_ms(20);

	char tmpBuf[23];

	// If we can get into AT mode

	if(slavesensors_enterAT() == 0) {

		snprintf(tmpBuf, 23, "ATDH %s%c",slaveAddressHigh[nodeIndex], 0x0D);

		serial0_sendString(tmpBuf);

		if(xbeeIsOk() != 0) {

			led_errorcode(ERROR_NOXBEE);

			return;

		}

		snprintf(tmpBuf, 23, "ATDL %s%c",slaveAddressLow[nodeIndex], 0x0D);

		serial0_sendString(tmpBuf);

		if(xbeeIsOk() != 0) {

			led_errorcode(ERROR_NOXBEE);

			return;

		}

		slavesensors_exitAT();

	}

	_delay_ms(2);

	#ifdef DEBUG_SELECTNODE

	serial0_sendString("Selected ");

	serial0_sendChar(nodeIndex + 0x30);

	serial0_sendString("\r\n");

	#endif

	serial0_ion();

	return;

}

void slavesensors_selectlogger() 

{

	if(loggerIndex != 255) {

		slavesensors_selectnode(loggerIndex);

	}	

}

void slavesensors_exitAT() 

{

	// Exit AT

	serial0_sendString("ATCN");

	serial0_sendChar(0x0D);

	_delay_ms(2);

	//// Wait until we get "OK"

	//int atStart = time_millis();

	//while(!serial0_hasChar()) {

		//if(time_millis() - atStart > 500) {

			//led_errorcode(ERROR_EXITAT);

			//wdt_reset();

			//return 1;

		//}

	//};

	xbeeIsOk();

}

// Enter AT mode. Leaves "OK" on the buffer.

int slavesensors_enterAT() 

{

	// Delay guard time

	_delay_ms(2);

	serial0_ioff(); // interrupts MUST be off

	// Enter AT mode

	serial0_sendChar('+'); // Enter AT mode

	serial0_sendChar('+');

	serial0_sendChar('+');

	_delay_ms(2);

	// Wait 1ms until we get "OK"

	//int atStart = time_millis();

	//while(!serial0_hasChar()) {

		//if(time_millis() - atStart > 500) {

			//led_errorcode(ERROR_ATFAIL);

			//wdt_reset();

			//return 1;

		//}

	//};	

	return xbeeIsOk();

}

int xbeeIsOk() 

{

	char* tmppntr = serial0_readLine();

	if(strcmp(tmppntr, "OK") == 0)

	{

		return 0;

	}

	else

	{

		led_errorcode(ERROR_NOXBEE);

		return 1;

	}

}

bool slavesensors_dataReady() {

	return dataReady;

}

bool slavesensors_isrequesting() 

{

	return requesting;	

}

void slavesensors_startprocess() 

{

	requesting = true;

	slavesensors_request();		

}

// TODO: inline. static.

void slavesensors_request() 

{

	if(currentSlave == loggerIndex) {

		currentSlave++;

	}

	slavesensors_selectnode(currentSlave);

	serial_sendCommand("@"); // Request data!

	slavesensors_selectlogger();