imuboard: allow to log on stdout even if sdcard is enabled

[fpv.git] / imuboard / imu.c

diff --git a/imuboard/imu.c b/imuboard/imu.c
index c113e1c..14f8479 100644 (file)
--- a/imuboard/imu.c
+++ b/imuboard/imu.c
@@ -99,7 +99,8 @@ void imu_get_pos_euler(struct euler *euler)
 }
 
 
-int imu_log(void)
+
+int imu_log(uint8_t to_stdout)
 {
        char buf[128];
        int16_t len;
@@ -124,9 +125,14 @@ int imu_log(void)
                imu.gx, imu.gy, imu.gz,
                imu.ax, imu.ay, imu.az,
                imu.mx, imu.my, imu.mz);
-       if (sd_log_write(buf, len) != len) {
-               printf_P(PSTR("error writing to file\n"));
-               return -1;
+       if (!to_stdout && sd_log_enabled()) {
+               if (sd_log_write(buf, len) != len) {
+                       printf_P(PSTR("error writing to file\n"));
+                       return -1;
+               }
+       }
+       else if (to_stdout) {
+               printf_P(PSTR("%s"), buf);
        }
 
        return 0;