#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 1200000 // Blackout after 20 minutes (hopefully after fix and launch)

// Board heater setpoint

#define HEATER_THRESHOLD 5 // Regulate to 5 degrees Celsius

// Touchdown buzzer

#define BUZZER_RATE 7000

#define BUZZER_DURATION 1000

#define BUZZER_FAILSAFE_DURATION  9600000 // 160min

#define BUZZER_TRIGGER_MINDURATION 2700000 // 45min

#define BUZZER_TRIGGER_MAXALTITUDE 2000 // feet

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

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

#define ERROR_XBEETIMEOUT 5

#define ERROR_FATAL 6

#define ERROR_ATFAIL 7

#define ERROR_EXITAT 8

#define ERROR_INFOTEXT 9

#define ERROR_WATCHDOG 10

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

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

// Slave Sensors config (slavesensors.c)

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

// Slave data structure size

#define MAX_NUM_SENSORS 10	// Maximum number of unique types of sensors in the system

// Node identifier of log destination xbee

#define XBEE_LOGDEST_NAME "HAB-LOGGER"

// Rate to request data from slaves. Must be greater than AT delay * number slaves

#define DATAREQUEST_RATE 3000

// Timeouts

#define TIMEOUT_SLAVEREQUEST 500

#define TIMEOUT_NETWORKSCAN 7000

#define TIMEOUT_EXITAT 2000

#define TIMEOUT_XBEERESPONSE 2000

// Slave data request max retries (for retry upon corrupt data reception)

#define MAX_SLAVEREQUEST_RETRIES 2

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

// Command Parser config (serparser.c)

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

// Maximum payload size of command

#define MAX_PAYLOAD_LEN 16

// Circular serial buffer size. Must be at least MAX_CMD_LEN + 5

#define BUFFER_SIZE 128 

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

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

/*

 * Master Firmware: Slave Sensor Data Acquisition

 *

 * This file is part of OpenTrack.

 *

 * OpenTrack is free software: you can redistribute it and/or modify

 * it under the terms of the GNU Affero General Public License as published by

 * the Free Software Foundation, either version 3 of the License, or

 * (at your option) any later version.

 *

 * OpenTrack is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU Affero General Public License for more details.

 *

 * You should have received a copy of the GNU Affero General Public License

 * along with OpenTrack. If not, see <http://www.gnu.org/licenses/>.

 * 

 * Ethan Zonca

 * Matthew Kanning

 * Kyle Ripperger

 * Matthew Kroening

 *

 */

#include "../config.h"

#include <avr/io.h>

#include <stdbool.h>

#include <stdlib.h>

#include <stdio.h>

#include <string.h>

#include <util/delay.h>

#include <avr/wdt.h>

#include <avr/pgmspace.h>

#include "serial.h"

#include "serparser.h"

#include "slavesensors.h"

#include "sensordata.h"

#include "led.h"

#include "looptime.h"

#include "logger.h"

// !!! Remember to update the ENUM in slavesensors.h when changing things here

// Label lookup table

// Make sure there are never more labels than there are MAX_NUM_SENSORS! 

const char label_0[] PROGMEM = "BoardTemp";

const char label_3[] PROGMEM = "AirTemp";

const char label_5[] PROGMEM = "Humidity";

const char label_6[] PROGMEM = "Pressure";

const char label_7[] PROGMEM = "Altitude";

const char *const labelLookup[] PROGMEM =

{

	label_0,

	label_1,

	label_2,

	label_3,

	label_4,

	label_5,

	label_6,

	label_7,

};

char* slavesensors_getLabel(uint8_t sensorID) 

{

	if(sensorID < 9)

	{

		strncpy_P(labelBuffer,(char*)pgm_read_word(&(labelLookup[sensorID])),15);

		return labelBuffer;

	}

	else 

	{

		return NULL;

	}

}

uint8_t currentSlave = 0;

uint8_t currentSlaveSensor = 0;

bool requesting = false;

//#define DEBUG_NETWORKSCAN

//#define DEBUG_GETSLAVEDATA

char* bufPtr = 0x00;

static char slaveAddressLow[MAX_NUM_SLAVES][9];

static char slaveAddressHigh[MAX_NUM_SLAVES][9];

static char slaveNames[MAX_NUM_SLAVES][15];

static char loggerAddressLow[9];

static char loggerAddressHigh[9];

uint8_t nodeCount = 0;

bool dataReady = false;

void slavesensors_setup()

{

	loggerAddressLow[0] = 0x00;

	loggerAddressHigh[0] = 0x00;

}

char* slavesensors_slavename(uint8_t id) 

{

	return slaveNames[id];

}

void slavesensors_network_scan() 

{

	serial0_ioff();