}

	// TODO: Check SD card switch to see if inserted.

	// this was included in the library, but is commented out right now

	// Open first partition

	partition = partition_open(sd_raw_read, sd_raw_read_interval, sd_raw_write, sd_raw_write_interval, 0);

	// Check that partition was created correctly

	if(!partition)

	{

		serial0_sendString("SD> Error opening partition.\r\n");

		// Error opening partition. MBR might be screwed up.

		led_errorcode(ERROR_SD_PARTITION);

		return;

	}

	// Open FAT filesystem

	fs = fat_open(partition);

	if(!fs)

	{

		// opening filesystem failed

		led_errorcode(ERROR_SD_PARTITION);

		return;

	}

	// Open directory

	fat_get_dir_entry_of_path(fs, "/", &directory);

	dd = fat_open_dir(fs, &directory);

	if(!dd)

	{

		// opening root directory failed

		_delay_ms(10);

		led_errorcode(ERROR_SD_FILE);

		return;

	}

	// Create new log file

	uint8_t logid = eeprom_read_byte(LOGGER_ID_EEPROM_ADDR);

	char filename[48];

	// we pre-increment logid here because it starts at 255, then wraps to 0

	sprintf(filename, "data%d.csv",++logid);

	// TODO: Catch errors here

		led_errorcode(ERROR_SD_FILE);

	}		

	eeprom_update_byte(LOGGER_ID_EEPROM_ADDR, logid);

	// Search for file in current directory and open it

	fd = open_file_in_dir(fs, dd, filename);

	if(!fd)

	{

		led_errorcode(ERROR_SD_FILE);

		_delay_ms(10);

		return;

	}

	// Seek to beginning of file

	// TODO: Is this needed?

	int32_t offset = 0; 

	if(!fat_seek_file(fd, &offset, FAT_SEEK_SET))

	{

		// Error seeking to file

		led_errorcode(ERROR_SD_FILE);

		_delay_ms(10);

		fat_close_file(fd);

		return;

	}

	// Write header information

	logger_log(LOGGER_HEADERTEXT);

	logger_log("\n-- BEGIN DATA --\n");

}	

void logger_log(char *buffer) 

{

	uint8_t len = strlen(buffer);

	if(fat_write_file(fd, (uint8_t*) buffer, len) != len)

	{

		// Error writing to file

		return;

	}

}

void logger_closeLog() 

{

	fat_close_file(fd);

	fat_close_dir(dd);

	fat_close(fs);

	partition_close(partition);

#include "lib/i2c.h"

#include "lib/boardtemp.h"

#include "lib/looptime.h"

#include "lib/slavesensors.h"

#include "lib/serparser.h"

#include "lib/sensordata.h"

int main(void)

{

    _delay_ms(1500); // warmup

	// Initialize libraries

	time_setup();

	watchdog_setup(); // enables interrupts

	led_setup();	

	serial0_setup();

	serial1_setup();

	i2c_init();

	sensordata_setup(); // must happen before sensors/logger/afsk

	slavesensors_setup();

	logger_setup();

	afsk_setup();

	//\f

	serial0_sendString("\r\n---------------------------------\r\n");

	serial0_sendString("HAB Controller 1.0 - Initialized!\r\n");

	serial0_sendString("---------------------------------\r\n");

	serial0_sendString("\r\nHello.\r\n\r\n");

	slavesensors_network_scan();

	led_on(LED_POWER);

	led_off(LED_SIDEBOARD);

	// Buffer for string operations

	char logbuf[128];

	char debugBuf[128];

	// Software timers	

	uint32_t lastAprsBroadcast = 0;

	uint32_t lastLog = 0;

	uint32_t lastLedCycle = 0;

	// Result of last parser run

	int parseResult = PARSERESULT_NODATA;

	// Write CSV header to SD card

	uint8_t ctr = 0;

	void spin() {

		if(ctr == 0) {

			led_on(LED_ACT0);

			led_off(LED_ACT1);

			led_off(LED_ACT2);

			led_off(LED_ACT3);

		}			

		else if (ctr == 1) {

			led_on(LED_ACT1);

			led_off(LED_ACT0);

			led_off(LED_ACT2);

			led_off(LED_ACT3);

		}			

		else if (ctr == 2) {

			led_on(LED_ACT2);

			led_off(LED_ACT1);

			led_off(LED_ACT0);

			led_off(LED_ACT3);

		}			

		else if (ctr == 3) {

			led_on(LED_ACT3);

			led_off(LED_ACT1);

			led_off(LED_ACT2);

			led_off(LED_ACT0);

		}			

		ctr = (ctr + 1) % 4;

	}

	serial1_ioff();

	while(1)

    {

		// Periodic: LED execution indicator

		if(time_millis() - lastLedCycle > LEDCYCLE_RATE) {

			spin();

			if(!afsk_busy())

				serial1_ion();

			lastLedCycle = time_millis();	

		}

		// Periodic: Logging

		if(time_millis() - lastLog > LOGGER_RATE) 

		{