LibrePilot/flight/PiOS/Common/pios_sdcard.c

/**
 ******************************************************************************
 *
 * @file       pios_sdcard.c  
 * @author     The OpenPilot Team, http://www.openpilot.org Copyright (C) 2009.   
 * @brief      Sets up basic system hardware, functions are called from Main.
 * @see        The GNU Public License (GPL) Version 3
 * @defgroup   PIOS_SDCARD SDCard Functions
 * @{
 *
 *****************************************************************************/
/* 
 * This program is free software; you can redistribute it and/or modify 
 * it under the terms of the GNU General Public License as published by 
 * the Free Software Foundation; either version 3 of the License, or 
 * (at your option) any later version.
 * 
 * This program 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 General Public License 
 * for more details.
 * 
 * You should have received a copy of the GNU General Public License along 
 * with this program; if not, write to the Free Software Foundation, Inc., 
 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
 */


/* Project Includes */
#include "pios.h"

/* File system object for each logical drive */
FATFS Fatfs[_DRIVES];

/* Create struct for logfile */
FIL logfile;

/**
* Initialises SDCard
*/
void PIOS_SDCARD_Init(void)
{
	int result;
	
	/* Initialise FatFS disk */
	if(f_mount(0, &Fatfs[0]) != FR_OK) {
		/* Failed to setup MicroSD memory structure, flash LED1 forever */
		while(1) {
			for(int i = 0; i < 100000; i++);
			PIOS_LED_Toggle(LED1);
		}
	} else {
		/* Try to Open Logging file */
		if ( f_open(&logfile, LOG_FILENAME, FA_CREATE_ALWAYS | FA_WRITE ) != FR_OK ) {
			/* Failed to mount MicroSD or create file, flash LED1 forever */
			while(1) {
				for(int i = 0; i < 100000; i++);
				PIOS_LED_Toggle(LED1);
			}
		} else {
			result = f_puts("Hello\n", &logfile );
			if ( result != EOF ) { result = f_puts("pios rocks!\n", &logfile ); }
			f_close( &logfile );
		}
	}
}