diff --git a/gtsam/linear/LossFunctions.cpp b/gtsam/linear/LossFunctions.cpp index 6573beac9..7307c4a68 100644 --- a/gtsam/linear/LossFunctions.cpp +++ b/gtsam/linear/LossFunctions.cpp @@ -350,8 +350,8 @@ double DCS::weight(double distance) const { const double e2 = distance*distance; if (e2 > c_) { - const double w = c_/(c_ + e2); - return 2.0*w*w; + const double w = 2.0*c_/(c_ + e2); + return w*w; } return 1.0;