imuboard/gps: increase position reset timeout

[fpv.git] / imuboard / gps_venus.c

diff --git a/imuboard/gps_venus.c b/imuboard/gps_venus.c
index 2aa8f83..3c089fa 100644 (file)
--- a/imuboard/gps_venus.c
+++ b/imuboard/gps_venus.c
@@ -563,7 +563,7 @@ static void gps_venus_cb(struct callout_mgr *cm, struct callout *tim, void *arg)
        }
 
        diff = ms - last_valid;
-       if (is_valid == 1 && diff > 100) {
+       if (is_valid == 1 && diff > 500) {
 
                is_valid = 0;
                /* update global structure */
@@ -617,7 +617,7 @@ void gps_get_pos(struct gps_pos *pos)
        memcpy(pos, &gps_pos, sizeof(*pos));
 }
 
-int gps_log(void)
+int gps_log(uint8_t to_stdout)
 {
        uint32_t ms;
        uint8_t flags, prio;
@@ -646,13 +646,13 @@ int gps_log(void)
                (double)gps_pos.sea_altitude / 100.);
 
 
-       if (sd_log_enabled()) {
+       if (!to_stdout && sd_log_enabled()) {
                if (sd_log_write(buf, len) != len) {
                        printf_P(PSTR("error writing to file\n"));
                        return -1;
                }
        }
-       else {
+       else if (to_stdout) {
                printf_P(PSTR("%s"), buf);
        }