X-Git-Url: http://git.droids-corp.org/?p=protos%2Fimu.git;a=blobdiff_plain;f=gps_venus.c;h=01551a68d2a7529e2521a29d85e253854dbba688;hp=7150ef2fcadbb575fd2b91c9993584a67e5c160a;hb=849b29b998a8cbc10cd1900d3e5dd1a8488b77f6;hpb=b80b5b2fa35d632456556f9940314b565a60e802

diff --git a/gps_venus.c b/gps_venus.c
index 7150ef2..01551a6 100644
--- a/gps_venus.c
+++ b/gps_venus.c
@@ -16,6 +16,7 @@
 #include "partition.h"
 #include "sd_raw.h"
 #include "sd_raw_config.h"
+#include "sd_log.h"
 
 #define debug_printf(args...) do { } while (0)
 /* #define debug_printf(args...) printf(args) */
@@ -533,125 +534,6 @@ int gps_venus_init(void)
 	return 0;
 }
 
-static uint8_t find_file_in_dir(struct fat_fs_struct* fs, struct fat_dir_struct* dd, const char* name, struct fat_dir_entry_struct* dir_entry)
-{
-	(void)fs;
-
-    while(fat_read_dir(dd, dir_entry))
-    {
-	if(strcmp(dir_entry->long_name, name) == 0)
-	{
-	    fat_reset_dir(dd);
-	    return 1;
-	}
-    }
-
-    return 0;
-}
-
-static struct fat_file_struct* open_file_in_dir(struct fat_fs_struct* fs, struct fat_dir_struct* dd, const char* name)
-{
-    struct fat_dir_entry_struct file_entry;
-    if(!find_file_in_dir(fs, dd, name, &file_entry))
-	return 0;
-
-    return fat_open_file(fs, &file_entry);
-}
-
-static struct fat_file_struct *open_log_file(void)
-{
-	struct fat_file_struct *fd;
-	struct fat_fs_struct *fs;
-	struct partition_struct *partition ;
-	struct fat_dir_struct *dd;
-	struct fat_dir_entry_struct directory;
-	struct fat_dir_entry_struct file_entry;
-	int16_t i = 0;
-	char name[16];
-
-	/* setup sd card slot */
-	if (!sd_raw_init()) {
-#if SD_DEBUG
-		printf_P(PSTR("MMC/SD initialization failed\n"));
-#endif
-		return NULL;
-	}
-
-	/* open first partition */
-	partition = partition_open(sd_raw_read,
-		sd_raw_read_interval,
-#if SD_RAW_WRITE_SUPPORT
-		sd_raw_write, sd_raw_write_interval,
-#else
-		0, 0,
-#endif
-		0);
-
-	if (!partition) {
-		/* If the partition did not open, assume the storage device
-		 * is a "superfloppy", i.e. has no MBR.
-		 */
-		partition = partition_open(sd_raw_read,
-			sd_raw_read_interval,
-#if SD_RAW_WRITE_SUPPORT
-			sd_raw_write,
-			sd_raw_write_interval,
-#else
-			0,
-			0,
-#endif
-			-1);
-		if (!partition) {
-#if SD_DEBUG
-			printf_P(PSTR("opening partition failed\n"));
-#endif
-			return NULL;
-		}
-	}
-
-	/* open file system */
-	fs = fat_open(partition);
-	if (!fs) {
-#if SD_DEBUG
-		printf_P(PSTR("opening filesystem failed\n"));
-#endif
-		return NULL;
-	}
-
-	/* open root directory */
-	fat_get_dir_entry_of_path(fs, "/", &directory);
-	dd = fat_open_dir(fs, &directory);
-	if (!dd) {
-#if SD_DEBUG
-		printf_P(PSTR("opening root directory failed\n"));
-#endif
-		return NULL;
-	}
-
-	/* print some card information as a boot message */
-	//print_disk_info(fs);
-
-	printf("choose log file name\n");
-	while (1) {
-		snprintf(name, sizeof(name), "log%.4d", i++);
-		if (!find_file_in_dir(fs, dd, name, &file_entry))
-			break;
-	}
-
-	printf("create log file %s\n", name);
-	if (!fat_create_file(dd, name, &file_entry)) {
-		printf_P(PSTR("error creating file: "));
-	}
-
-	fd = open_file_in_dir(fs, dd, name);
-	if (!fd) {
-		printf_P(PSTR("error opening "));
-		return NULL;
-	}
-
-	return fd;
-}
-
 void gps_get_pos(struct gps_pos *pos)
 {
 	memcpy(pos, &gps_pos, sizeof(*pos));
@@ -659,19 +541,12 @@ void gps_get_pos(struct gps_pos *pos)
 
 int gps_loop(void)
 {
-	struct fat_file_struct *fd = NULL;
 	uint32_t ms;
 	uint8_t flags, prio;
 	int16_t len;
 	char buf[128];
 	struct gps_pos pos;
 
-	if (1) {
-		fd = open_log_file();
-		if (fd == NULL)
-			printf("open log failed\r\n");
-	}
-
 	while (1) {
 
 		IRQ_LOCK(flags);
@@ -695,9 +570,9 @@ int gps_loop(void)
 			(double)gps_pos.sea_altitude/100.);
 
 
-		if (fd != NULL) {
+		if (sd_log_enabled()) {
 
-			if (fat_write_file(fd, (unsigned char *)buf, len) != len) {
+			if (sd_log_write(buf, len) != len) {
 				printf_P(PSTR("error writing to file\n"));
 				return -1;
 			}