#endif

	#ifdef DEBUG_CONTEXTSWITCH

	uint32_t switchTime = time_millis() - startTime;

	char tmpB[32];

	snprintf(tmpB, 32, "CTXSW: %lu ms\r\n", switchTime);

	serial0_sendString(tmpB);

	#endif

	serial0_ion();

	return true;

}

void slavesensors_selectlogger() 

{

	if(loggerAddressLow[0] != 0x00) 

	{

		slavesensors_selectaddress(loggerAddressHigh,loggerAddressLow);

	}	

}

void slavesensors_exitAT() 

{

	// Exit AT

	serial0_sendString("ATCN");

	serial0_sendChar(0x0D);

	if(waitTimeout(TIMEOUT_EXITAT)) 

	{

		return;

	}

	xbeeIsOk();

}

bool waitTimeout(uint32_t timeout) {

	uint32_t scanStart = time_millis();

	uint32_t lastBlink = 0;

	while(!serial0_hasChar())

	{

		if(time_millis() - scanStart > timeout)

		{

			error_log(ERROR_XBEETIMEOUT, true);

			return true;

		}

		if(time_millis() - lastBlink > 50)

		{

			led_spin();

			lastBlink = time_millis();

		}

		wdt_reset();

	}

	return false;

}

// 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('+');

	return xbeeIsOk();

}

int xbeeIsOk() 

{

	if(waitTimeout(TIMEOUT_XBEERESPONSE)) {

		error_log(ERROR_XBEETIMEOUT, true);

		return 1;

	}

	char* tmppntr = serial0_readLine();

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

	{

		return 0;

	}

	else

	{

		error_log(ERROR_SLAVETIMEOUT, true);

		return 1;

	}

}

bool slavesensors_dataReady() 

{

	return dataReady;

}

bool slavesensors_isrequesting() 

{