//Serial

#define USART0_BAUDRATE 115200

#define USART1_BAUDRATE 115200 

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

#define BUFFER_SIZE 32

// Maximum payload size of command

#define MAX_PAYLOAD_LEN 16

// Number of datatypes to transmit per module type

#define DATATYPES_GENERIC 3

#define DATATYPES_SENSOR 8

#define DATATYPES_GEIGER 4

#define DATATYPES_CAMERA 3

//Sensors and IO

#define SENSOR_LOOP 100				// Frequency of sensor reads (in ms) (should be 200)

#define HEATER_THRESHOLD 40			// Temperature threshold in Fahrenheit where heater is activated

 //I2C Addresses

 #define EEPROM_ADDR 0xA0		// Read 0xA1 - Write 0xA0

 #define BOARDTEMP_ADDR 0x90	// Read 0x91 - Write 0x90

 #define RTC_ADDR 0xB2			//DEBUG [Used for testing]      // Read 0xA3 - Write 0xA2

 #endif /* CONFIG_H_ */

	masterComm_packetSend_signed(0,sensors_getBoardTemp());

	// Send Heater Status (Common for all modules)

	masterComm_packetSend_unsigned(1,/*Heater Status Get Function Here */0);

	// Send Battery Level (Common for all modules)

	masterComm_packetSend_unsigned(2,/*Battery Level Get Function Here */0);

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

			// Send Humidity

			// Send Pressure 

			// Send Altitude

			break;

		case 2:

			// Geiger

			// Send CPM (radiation)

			masterComm_packetSend_unsigned(8,geiger_getCpm());

			break;

		case 3:

			// Camera

			break;

		default:

			break;

	}

}

void masterComm_send()

{

	uint8_t four = send_spi(0xFF);

	DESELECT_TEMP;

	int16_t temperature = ((one<<4)|(two>>4));	// Shift and place into larger int. (Cuts off Decimal)

	temperature = (temperature & (0x0800)) ? (temperature & 0xF000) : temperature;	// Sign extend

	//int16_t temperature = ((one<<6)|(two>>2));	// Shift and place into larger int. (Includes Decimal)

	//temperature = (temperature & (0x2000)) ? (temperature & 0xC000) : temperature;	// Sign extend

	temperature = (two & 0x01) ? 0x00DE : temperature;	// Error Condition. If error is detected output is set to 222 degrees (0x00DE)

	// Note: Temperature still needs to be scaled in order to be accurate (eg. boil water). Do this before implementing.

	spiTemp = temperature;

}

void sensors_readBoardTemp()

{

	boardTemp = i2c_read(BOARDTEMP_ADDR, 0x00);		// Read only the first byte of data (we don't need the resolution here)

	boardTemp = ((boardTemp*18)/10) + (32);			// Converting Celsius to Fahrenheit

	boardTemp = boardTemp - 3;						// Linear offset

}

void sensors_readPressure()

{

	_delay_us(4500);							//wait 4.5 ms

	ut = i2c_read(PRESSURE_ADDR, 0xF6);

	ut = ut << 8;

	ut = ut | i2c_read(PRESSURE_ADDR, 0xF7);	//ut = MSB<<8 + LSB

	_delay_us(4500);							//wait 4.5 ms

	up = i2c_read(PRESSURE_ADDR, 0xF6);

	up = up << 8;

	up = up | i2c_read(PRESSURE_ADDR, 0xF7);	//up = (MSB<<16 + LSB<<8 + XLSB(NOT USED)) >> (8-oss)

	//calculate true temperature

	x1 = ((ut - ac6) * ac5) >> 15;

	x2 = (mc << 11) / (x1 + md);

	b5 = x1 + x2;

	trueTemp = (b5 + 8) >> 4;

	//calculate b3

	b6 = b5 - 4000;

	x1 = (b2 * (b6 * b6) >> 12) >> 11;

	x2 = (ac2 * b6) >> 11;

	x3 = x1 + x2;

	b3 = ((ac1 * 4 + x3) + 2) / 4;

	//calculate b4

	x1 = (ac3 * b6) >> 16;

	x2 = (b1 * ((b6 * b6) >> 12)) >> 16;

	x3 = ((x1 + x2) + 2) >> 2;

	b4 = (ac4 * (x3 + 32768)) >> 15;

	TIMSK2 = 0x01;			// Enable interrupt on overflow

	sei();					// Enable all interrupts

 }

 void modules_cameras_setup()

 {

 }

 void modules_generic()

 {

	// Gathers data and performs functions for generic daughter board

 }

 void modules_sensors()

 {

	// Gathers data and performs functions for sensor daughter board

	sensors_readBoardTemp();		//Data Read

	sensors_readSpiTemp();			//Data Read

	//sensors_readHumid();				//Data Read

	sensors_readBatt();

 }

 void modules_geiger()

 {

	// No data gatering function needed for geiger daughter board

		// This is taken care of in interrupt (See geiger.c)

 }

 void modules_cameras()

 {

	// Gathers data and performs functions for cameras daughter board

 } 

	//uint8_t test2;	//Debug	

	// Serial output //DEBUG

	char buff[64];							//Buffer for serial output //DEBUG

	serial0_sendString("Starting Slave\r\n");

    while(1)

    {	

		// Master communication

		masterComm_checkParser();

		// Main slave operations

		if ((time_millis() % SENSOR_LOOP) == 0)	// Uses program timer to run every so often. Time interval defined in config.h

		{

			led_on(0);

			sensors_readBoardTemp();	// Read board temperature sensor (Common on all slaves) (Data Read)

			modules_run(io_getModuleId());		// Runs specific module functions (like data reading)

			io_regulateTemp();			// Gets board temperature and enables heater if below threshold

			_delay_ms(2);		// Delay to prevent the sensor loop from running again before time_millis changes

			led_off(0);

			led_off(2);

		}

    }

	return 0;

}

		/********Examples of data reading and getting******************

		x = geiger_getCpm();				//Data get

		x = sensors_getSpiTemp();			//Data get

		x = sensors_getBoardTemp();			//Data get

		sensors_readSpiTemp();				//Data Read

		sensors_readBoardTemp();			//Data Read

		led_output(0xFF);					//Output value to LED array