diff --git a/gtsam_unstable/dynamics/VelocityConstraint3.h b/gtsam_unstable/dynamics/VelocityConstraint3.h index 24d866829..83506e2d5 100644 --- a/gtsam_unstable/dynamics/VelocityConstraint3.h +++ b/gtsam_unstable/dynamics/VelocityConstraint3.h @@ -36,7 +36,7 @@ public: return boost::static_pointer_cast( gtsam::NonlinearFactor::shared_ptr(new VelocityConstraint3(*this))); } - /** g(x) with optional derivative2 */ + /** x1 + v*dt - x2 = 0, with optional derivatives */ Vector evaluateError(const LieScalar& x1, const LieScalar& x2, const LieScalar& v, boost::optional H1 = boost::none, boost::optional H2 = boost::none,