diff --git a/src/ImuSensor.cc b/src/ImuSensor.cc index 5ae1f7ce..7cc7f8b2 100644 --- a/src/ImuSensor.cc +++ b/src/ImuSensor.cc @@ -268,7 +268,9 @@ bool ImuSensor::Update(const std::chrono::steady_clock::duration &_now) GaussianNoiseModelPtr gaussian = std::dynamic_pointer_cast( this->dataPtr->noises[noiseType]); - return (float) (gaussian->StdDev() * gaussian->StdDev()); + if (gaussian) { + return static_cast(gaussian->StdDev() * gaussian->StdDev()); + } } return 0.001f; };