diff --git a/Peripherals/Inc/peripherals_imu_icm.hpp b/Peripherals/Inc/peripherals_imu_icm.hpp index 4ecb0d9..c3c2cff 100644 --- a/Peripherals/Inc/peripherals_imu_icm.hpp +++ b/Peripherals/Inc/peripherals_imu_icm.hpp @@ -214,7 +214,7 @@ public: float accelerometerRawToReading(const std::int16_t bit) const { - return float(bit) * accel_fs_to_bit_constants_[std::uint32_t(scale_accel_)]; + return (float(bit) * accel_fs_to_bit_constants_[std::uint32_t(scale_accel_)]) * 9.8f; } float gyroRawToReading(const std::int16_t bit) const