AHRS

Dependencies:   Eigen

Dependents:   IndNav_QK3_T265

Revision:
28:21dfb161c67c
Parent:
26:1da7c6204775
Child:
29:cd963a6d31c5
diff -r 973e495f4711 -r 21dfb161c67c BMX055.cpp
--- a/BMX055.cpp	Tue Jan 14 14:24:03 2020 +0000
+++ b/BMX055.cpp	Mon Jan 20 12:41:13 2020 +0000
@@ -55,9 +55,9 @@
     x = dt[1] << 8 | (dt[0] & 0xf0);
     y = dt[3] << 8 | (dt[2] & 0xf0);
     z = dt[5] << 8 | (dt[4] & 0xf0);
-    accX = (double)x * acc_factor;
-    accY = (double)y * acc_factor;
-    accZ = (double)z * acc_factor;
+    accX = (float)x * acc_factor;
+    accY = (float)y * acc_factor;
+    accZ = (float)z * acc_factor;
 }
  
 void BMX055::readGyro(void)
@@ -72,9 +72,9 @@
     y = dt[3] << 8 | dt[2];
     z = dt[5] << 8 | dt[4];
 
-    gyroX = (double)x * gyr_factor;
-    gyroY = (double)y * gyr_factor;
-    gyroZ = (double)z * gyr_factor;
+    gyroX = (float)x * gyr_factor;
+    gyroY = (float)y * gyr_factor;
+    gyroZ = (float)z * gyr_factor;
 }
  
 void BMX055::readMag(void)
@@ -90,9 +90,9 @@
     y = (int16_t) (((int16_t)dt[3] << 8) | dt[2]) >> 3;  // 13-bit signed integer for x-axis field
     z = (int16_t) (((int16_t)dt[5] << 8) | dt[4]) >> 1;  // 13-bit signed integer for x-axis field
     
-    magX = (double)y * 0.01f;       // MAGNETOMETER x-y are switched, see BMX055 datasheet page 161
-    magY = (double)x * 0.01f;       // x-y is switched
-    magZ = (double)z * 0.01f;       // z is z
+    magX = (float)y * 0.01f;       // MAGNETOMETER x-y are switched, see BMX055 datasheet page 161
+    magY = (float)x * 0.01f;       // x-y is switched
+    magZ = (float)z * 0.01f;       // z is z
 }
  
 float BMX055::get_chip_temperature()