diff --git a/gtsam/linear/NoiseModel.cpp b/gtsam/linear/NoiseModel.cpp index 1cf9ff109..80210c3b7 100644 --- a/gtsam/linear/NoiseModel.cpp +++ b/gtsam/linear/NoiseModel.cpp @@ -696,7 +696,7 @@ Huber::Huber(double k, const ReweightScheme reweight) } double Huber::weight(double error) const { - return (error < k_) ? (1.0) : (k_ / fabs(error)); + return (fabs(error) > k_) ? k_ / fabs(error) : 1.0; } void Huber::print(const std::string &s="") const {