*

 * Created: 1/22/2013 3:40:53 PM

 *  Author: kripperger

 */ 

#include <inttypes.h>

#include <avr/io.h>

#include <stdio.h>

#include "../config.h"

#include "masterComm.h"

#include "serial.h"

#include "serparser.h"

#include "inputOutput.h"

#include "sensors.h"

#include "geiger.h"

#include "led.h"

#include "loopTimer.h"

uint8_t dataTypes;

volatile uint32_t lastRX;

char buff2[64];

char masterComm_checksum(const char* stringPtr)

{

	char sum = 0;

	while(*stringPtr != 0x00)

	{

		sum += *stringPtr;

		stringPtr++;

	}

	return sum;

}

void masterComm_types()

{

	switch(io_getModuleId())

	{

		case 0:

			// Generic

			dataTypes = DATATYPES_GENERIC;

			break;

		case 1:

			// Sensors

			dataTypes = DATATYPES_SENSOR;

			break;

		case 2:

			// Geiger

			dataTypes = DATATYPES_GEIGER;

			break;

		case 3:

			// Camera

			dataTypes = DATATYPES_CAMERA;

			break;

		default:

			dataTypes = DATATYPES_GENERIC;

			break;

	}

}

void masterComm_packetSend_unsigned(uint8_t id, uint32_t data)

{

	serial0_sendChar('[');

	snprintf(buff2,64,"%u%lu",id,data);

	serial0_sendString(buff2);

	serial0_sendChar(']');

	serial0_sendChar(masterComm_checksum(buff2));

}

void masterComm_packetSend_signed(uint8_t id, int32_t data)

{

	serial0_sendChar('[');

	snprintf(buff2,64,"%u%ld",id,data);

	serial0_sendString(buff2);

	serial0_sendChar(']');

	serial0_sendChar(masterComm_checksum(buff2));

}

void masterComm_modules()

{

	// Send Board Temperature (Common for all modules)

	masterComm_packetSend_signed(0,sensors_getBoardTemp());

	// Send Heater Status (Common for all modules)

	masterComm_packetSend_unsigned(1,io_heaterStatus());

	// Send Battery Level (Common for all modules)

	// Send module specific sensor readings

	switch(io_getModuleId())

	{

		case 0:

			// Generic

			break;

		case 1:

			// Sensors

			// Send SPI Temperature (Air)

			masterComm_packetSend_unsigned(3,sensors_getSpiTemp());

			// Send Ambient Light (Needs to be formatted)

			masterComm_packetSend_unsigned(4,sensors_getLux());

			// Send Humidity

			masterComm_packetSend_unsigned(5,/*Humidity Get Function Here */999);		

			// Send Pressure 

			masterComm_packetSend_unsigned(6,sensors_getPressure());			

			// Send Altitude

			masterComm_packetSend_unsigned(7,sensors_getAltitude());

			break;

		case 2:

			// Geiger

			// Send CPM (radiation)

			masterComm_packetSend_unsigned(8,geiger_getCpm());

			break;

		case 3:

			// Camera

			break;

		default:

			break;

	}

}

void masterComm_send()

{

	masterComm_types();		// Calculates how many data types to send

	// Return request with number of data types to be sent

	serial0_sendChar('[');						// Send opening bracket

	snprintf(buff2,64,"@%u",dataTypes);				// Send package (@ reply and number of data types)

	serial0_sendString(buff2);

	serial0_sendChar(']');						// Send closing bracket

	serial0_sendChar(masterComm_checksum(buff2));	// Calculate and send checksum

	masterComm_modules();	// Send sensor data

}

void masterComm_checkParser()

{

	if ((time_millis() - lastRX) > 200)	// Timer for LED

	{

		led_off(2);

	}

	if (serparser_parse() == PARSERESULT_PARSEOK)

	{

		if (getPayloadType() == ('@'-0x30))		// Request for data recieved

		{

			led_on(2);

			lastRX = time_millis();

			// Send all data

			masterComm_send();

		}	

	}

}