diff --git a/gtsam/navigation/AHRSFactor.cpp b/gtsam/navigation/AHRSFactor.cpp index 2c8c3e22f..c77eb523e 100644 --- a/gtsam/navigation/AHRSFactor.cpp +++ b/gtsam/navigation/AHRSFactor.cpp @@ -277,8 +277,6 @@ Rot3 AHRSFactor::predict(const Rot3& rot_i, const imuBias::ConstantBias& bias, const Vector3& omegaCoriolis, boost::optional body_P_sensor) { const double& deltaTij = preintegratedMeasurements.deltaTij_; -// const Vector3 biasAccIncr = bias.accelerometer() - -preintegratedMeasurements.biasHat_.accelerometer(); const Vector3 biasOmegaIncr = bias.gyroscope() - preintegratedMeasurements.biasHat_.gyroscope();