MPU9250 motionlog: initialize values, slightly lower sample rate

1 files changed, 9 insertions, 4 deletions

diff --git a/src/app/mpu9250_motionlog/main.cc b/src/app/mpu9250_motionlog/main.cc
index fc9ac1d..9bdfe0c 100644
--- a/src/app/mpu9250_motionlog/main.cc
+++ b/src/app/mpu9250_motionlog/main.cc
@@ -8,14 +8,18 @@
 #endif
 #include "driver/mpu9250.h"
 
+#define INIT0(val) int val = 0, min_ ## val = 0, max_ ## val = 0;
 #define UPDATE_MIN(min_val, val) if ((val) < (min_val)) { (min_val) = (val); }
 #define UPDATE_MAX(max_val, val) if ((val) > (max_val)) { (max_val) = (val); }
 
 int main(void)
 {
-	int ax, ay, az, gx, gy, gz;
-	int max_ax, max_ay, max_az, max_gx, max_gy, max_gz;
-	int min_ax, min_ay, min_az, min_gx, min_gy, min_gz;
+	INIT0(ax);
+	INIT0(ay);
+	INIT0(az);
+	INIT0(gx);
+	INIT0(gy);
+	INIT0(gz);
 	unsigned char i = 0;
 
 	arch.setup();
@@ -49,17 +53,18 @@ int main(void)
 		UPDATE_MAX(max_gz, gz);
 
 		if (i++ == 200) {
-			kout << "Temp: " << mpu9250.getTemperature() << endl;
 			kout << "Min Accel: " << min_ax << " / " << min_ay << " / " << min_az << endl;
 			kout << "Max Accel: " << max_ax << " / " << max_ay << " / " << max_az << endl;
 			kout << "Min Gyro: " << min_gx << " / " << min_gy << " / " << min_gz << endl;
 			kout << "Max Gyro: " << max_gx << " / " << max_gy << " / " << max_gz << endl;
+			kout << "Temp: " << mpu9250.getTemperature() << endl;
 			min_ax = min_ay = min_az = 0;
 			min_gx = min_gy = min_gz = 0;
 			max_ax = max_ay = max_az = 0;
 			max_gx = max_gy = max_gz = 0;
 			i = 0;
 		}
+		arch.delay_ms(1);
 	}
 
 	return 0;