/*

 * Master Firmware: Configuration

 *

 * Wireless Observational Modular Aerial Network

 * 

 * Ethan Zonca

 * Matthew Kanning

 * Kyle Ripperger

 * Matthew Kroening

 *

 */

#ifndef CONFIG_H_

#define CONFIG_H_

#include <avr/pgmspace.h>

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

// 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_TIMEOUT 300000 // Blackout after 5 minutes (hopefully after fix)

// Board heater setpoint

// Touchdown buzzer

#define BUZZER_RATE 5000

#define BUZZER_DURATION 1000

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

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

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

// Slave data structure size

#define MAX_NUM_SLAVES 5	// Maximum number of nodes in the system

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

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

// TX delay in milliseconds

#define TX_DELAY      200

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

// (read more about digipeating paths here: http://wa8lmf.net/DigiPaths/ )

// The recommended digi path for a balloon is WIDE2-1 or pathless. The default

// is pathless. Uncomment the following two lines for WIDE2-1 path:

#define DIGI_PATH1      "WIDE2"

#define DIGI_PATH1_TTL  1

// Transmit the APRS sentence every X milliseconds

#define APRS_TRANSMIT_PERIOD 20000

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

// Logger config (logger.c)

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

// Log number EEPROM address (this number is incremented on boot, used for filenames)

#define LOGGER_ID_EEPROM_ADDR 0x10

// Watchdog save/restore of program timer

#define WATCHDOG_PROGTIMER_EEPROM_ADDR 0x20

// Written to the beginning of every log file

// Log to SD card every X milliseconds

#define LOGGER_RATE 1000 

// LED cycle indicator speed

#define LEDCYCLE_RATE 100 

#endif /* CONFIG_H_ */

 */

#include "../config.h"

#include <stdio.h>

#include <stdbool.h>

#include <string.h>

#include "sensordata.h"

#include "slavesensors.h"

#include "sensors.h"

#include "looptime.h"

#include "gps.h"

#include "logger.h"

// Slave sensor reading storage

int32_t slaves[MAX_NUM_SLAVES][MAX_NUM_SENSORS];

void sensordata_setup() 

{

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

	{

		for(int j=0; j<MAX_NUM_SENSORS; j++) 

		{

			slaves[i][j] = -2111111111; // minimum value of 16 bit integer

		}

	}

}

// Store a sensor value in memory

void sensordata_set(uint8_t nodeID, uint8_t type, int32_t value)

{

	if(nodeID < MAX_NUM_SLAVES) 

	{

		slaves[nodeID][type] = value;

	}	

}

// Retrieve a sensor value from memory

int32_t sensordata_get(uint8_t nodeID, uint8_t type) 

{

	// Avoid reading out of bad places!

	if(nodeID < MAX_NUM_SLAVES) 

	{

		return slaves[nodeID][type];

	}

	else 

	{

		return 0;

	}

}

bool isEven = true;

// Generate APRS comment

// TODO: Can we move this buffer to a local scope of this function?

char* slavesensors_getAPRScomment(char* commentBuffer, uint16_t bufferSize) 

{

	snprintf(commentBuffer,bufferSize, "~v%s~_%s~|%s", get_speedKnots(), get_latitudeLSBs(), get_longitudeLSBs());

	if(isEven) 

	{

		// Master details

		uint16_t len = strlen(commentBuffer);

		snprintf(commentBuffer + len, bufferSize-len, "~t9%d~s%s~h%s", sensors_getBoardTemp(), get_sv(), get_hdop());

		// Find slave sensors to include in this log

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

		{

			// Board temperature sensors (all slaves)

			uint32_t val = sensordata_get(i, SENSOR_BOARDTEMP);

			if(val != -2111111111) {

				uint16_t len = strlen(commentBuffer);

				snprintf(commentBuffer + len, bufferSize-len, "~t%u%li",i,val);

			}

			// Battery voltages (all slaves)

			val = sensordata_get(i, SENSOR_BATTERYLEVEL);

			if(val != -2111111111) {

				uint16_t len = strlen(commentBuffer);

				snprintf(commentBuffer + len, bufferSize-len, "~l%u%li",i,val);

			}

			// Pressure

			val = sensordata_get(i, SENSOR_PRESSURE);

			if(val != -2111111111) {

				uint16_t len = strlen(commentBuffer);

				snprintf(commentBuffer + len, bufferSize-len, "~P%li",val);

			}

			// Air Temperature

			val = sensordata_get(i, SENSOR_AIRTEMP);

			if(val != -2111111111) {

				uint16_t len = strlen(commentBuffer);

				snprintf(commentBuffer + len, bufferSize-len, "~C%li",val);

			}

			// Altitude

			val = sensordata_get(i, SENSOR_ALTITUDE);

			if(val != -2111111111) {

				uint16_t len = strlen(commentBuffer);

				snprintf(commentBuffer + len, bufferSize-len, "~A%li",val);

			}

			// Radiation

			val = sensordata_get(i, SENSOR_CPM_RADIATION);

			if(val != -2111111111) {

				uint16_t len = strlen(commentBuffer);

				snprintf(commentBuffer + len, bufferSize-len, "~R%li",val);

			}

		}

		if(logger_aprsInfoTextAvailable())

		{

			uint16_t len = strlen(commentBuffer);

			snprintf(commentBuffer + len, bufferSize-len, "~%s",logger_getAprsInfoText());

			logger_aprsInfoTextConsumed();

		}

		isEven = false;

	}

	else {

		// odd does nothing

		isEven = true;

	}	

	return commentBuffer;

}

// Generates CSV headers on first run and logs values to the SD card (if data available)

bool dataWasReady = false;

void sensordata_logvalues() 

{

	// Generate CSV header after we have queried all slaves once

	if(slavesensors_dataReady()) 

	{

		// Only generate/write header the first time data is ready

		if(!dataWasReady) 

		{

			#define CSV_BUFFER_SIZE 64

			char csvHeader[CSV_BUFFER_SIZE];

			csvHeader[0] = 0x00;

			// Add master data headers

			logger_log("Time,BoardTemp,VBatt,GPSTime,GPSLat,GPSLon,GPSSpeed,GPSHDOP,GPSCourse,GPSSV,");

			// Add slave data headers

			for(uint8_t i=0; i<MAX_NUM_SLAVES; i++) 

			{

				for(uint8_t j=0; j<MAX_NUM_SENSORS; j++) 

				{

					int32_t tmp = sensordata_get(i, j);

					// If a sensor value exists, write a header for it

					if(tmp != -2111111111) 

					{

						snprintf(csvHeader, CSV_BUFFER_SIZE,"%s-%s,", slavesensors_slavename(i), slavesensors_getLabel(j));

						logger_log(csvHeader);

					}

				}

			}

			// End line and write to SD card

			snprintf(csvHeader, CSV_BUFFER_SIZE,"\r\n");

			logger_log(csvHeader);

			dataWasReady = true;

		}

		// Write CSV sensor values to SD card

		#define CSV_LOGLINE_SIZE 512

		char logbuf[CSV_LOGLINE_SIZE];

		logbuf[0] = 0x00;

		// Write master sensor values

		snprintf(logbuf, CSV_LOGLINE_SIZE, "%lu,%d,%u,%s,%s,%s,%s,%s,%s,%s,", time_millis(), sensors_getBoardTemp(), sensors_getBatt(), get_timestamp(),get_latitudeTrimmed(),get_longitudeTrimmed(),get_speedKnots(),get_hdop(), get_course(), get_sv());

		// Write slave sensor values

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

		{

			for(int j=0; j<MAX_NUM_SENSORS; j++) 

			{

				int32_t tmp = sensordata_get(i, j);

				// If a sensor value exists, log the data

				if(tmp != -2111111111) 

				{