X-Git-Url: http://git.droids-corp.org/?p=protos%2Fimu.git;a=blobdiff_plain;f=gps_venus.c;fp=gps_venus.c;h=20d8639fb1e44dad2b0086866784fe33d98c021c;hp=7150ef2fcadbb575fd2b91c9993584a67e5c160a;hb=004f99ba874339e50629141ac39e888070b5378e;hpb=b80b5b2fa35d632456556f9940314b565a60e802 diff --git a/gps_venus.c b/gps_venus.c index 7150ef2..20d8639 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)); @@ -666,11 +548,7 @@ int gps_loop(void) char buf[128]; struct gps_pos pos; - if (1) { - fd = open_log_file(); - if (fd == NULL) - printf("open log failed\r\n"); - } + fd = get_log_file(); while (1) {