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

// Hardware settings

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

#define F_CPU 11059200

#define BOARDTEMP_ADDR 0x90

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

// Module config (master.c)

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

// 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

#define ERROR_SD_FILE 3

#define ERROR_XBEETIMEOUT 4

#define ERROR_FATAL 5

#define ERROR_ATFAIL 6

#define ERROR_EXITAT 7

#define ERROR_INFOTEXT 8

#define ERROR_WATCHDOG 9

// !!! Please specify/update detailed messages for these error codes in logger.c

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

// Slave Sensors config (slavesensors.c)

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

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

// GPS config (xxx.c)

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

// NMEA circular buffer size. Must be large enough to hold all received sentences

#define NMEABUFFER_SIZE 150

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

// USART config (serial.c)

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

// 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):

//

// - Balloons:  11

// - Cars:       9

// - Home:       0

// - IGate:      5

#define S_CALLSIGN      "KD8TDF"

#define S_CALLSIGN_ID   9 // 11

// Destination callsign: APRS (with SSID=0) is usually okay.

#define D_CALLSIGN      "APRS"

#define D_CALLSIGN_ID   0

// Digipeating paths:

	_delay_ms(1000);

	led_setup();

	gps_setup();

	serial0_setup();

	serial1_setup();

	i2c_init();

	sensordata_setup(); // must happen before slavesensors/logger/AFSK

	slavesensors_setup();

	sensors_setup();

	logger_setup();

	watchdog_checkreset();

	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();

			// Enable GPS serial interrupts if we aren't doing AFSK

			if(!afsk_busy())

				serial1_ion();

			lastLedCycle = time_millis();	

		}

		// Periodic: Logging

		if(time_millis() - lastLog > LOGGER_RATE) 

		{

			led_on(LED_CYCLE);

			else 

			{

				led_off(LED_SIDEBOARD);

			}

			sensors_readBoardTemp();

			sensors_readBatt();

			//char buftmp[15];

			//snprintf(buftmp, 15, "vbatt: %u\r\n", sensors_getBatt());

			//serial0_sendString(buftmp);

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

			}

			lastDataReq = time_millis();

		}

		// Periodic: APRS transmission

		if(time_millis() - lastAprsBroadcast > APRS_TRANSMIT_PERIOD) 

		{

			// Check for touchdown

			sensordata_checkTouchdown();