// Debug Output

//#define DEBUG_OUTPUT

// Blackout (turn off all but power LEDs)

//#define BLACKOUT_ENABLE

#define BLACKOUT_TIMEOUT 300000 // Blackout after 5 minutes (hopefully after fix)

// Board heater setpoint

#define HEATER_THRESHOLD 80

// Touchdown buzzer

#define BUZZER_FAILSAFE_DURATION 600000

#define BUZZER_TRIGGER_MINDURATION 1

#define BUZZER_TRIGGER_MAXALTITUDE 1

// --------------------------------------------------------------------------

// Error Codes config (logger.c)

// --------------------------------------------------------------------------

// SD Card

#define ERROR_SLAVETIMEOUT 0

#define ERROR_SD_INIT 1

#define ERROR_SD_PARTITION 2

// --------------------------------------------------------------------------

// Baud rates for XBEE and GPS serial ports

#define USART0_BAUDRATE 115200

#define USART1_BAUDRATE 115200

// --------------------------------------------------------------------------

// AX.25 config (ax25.c)

// --------------------------------------------------------------------------

// TX delay in milliseconds

// Maximum packet delay

#define MAX_PACKET_LEN 512  // bytes

// --------------------------------------------------------------------------

// APRS config (aprs.c)

// --------------------------------------------------------------------------

// Set your callsign and SSID here. Common values for the SSID are

// (from http://zlhams.wikidot.com/aprs-ssidguide):

//

	afsk_setup();

	serial0_sendString("\r\nHello.\r\n\r\n");

	// Blocking ZigBee node discovery

	slavesensors_network_scan();

	// Software timers	

	uint32_t lastAprsBroadcast = 0;

	uint32_t lastLog = 0;

	uint32_t lastLedCycle = 0;

	uint32_t lastDataReq = 0;

	uint32_t lastBuzz = 0;

	// Result of last parser run

	int parseResult = PARSERESULT_NODATA;

	while(1)

    {

		// Periodic: LED execution indicator

		if(time_millis() - lastLedCycle > LEDCYCLE_RATE) 

		{

			led_power_toggle();

			led_spin();

			// Write CSV header and log data values

			sensordata_logvalues();			

			led_off(LED_CYCLE);

			lastLog = time_millis();

		}		

		// Periodic: Buzzer

		if(time_millis() - lastBuzz > BUZZER_RATE) {

			if(sensordata_isTouchdown())

			{

				led_on(LED_BUZZ);

			}			

			lastBuzz = time_millis();

		}

		// Periodic: Data Request

		if(time_millis() - lastDataReq > DATAREQUEST_RATE)  

		{

			// Start getting values for next transmission

			if(slavesensors_isrequesting())

			{

				// This probably is a non-issue

				//error_log_msg(ERROR_FATAL, false, "Still requesting on following loop");

			}

			else

			{

				slavesensors_startprocess();