AHRS
Dependencies: Eigen
Diff: BMX055.cpp
- 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()