diff --git a/gtsam_unstable/dynamics/imuSystem.cpp b/gtsam_unstable/dynamics/imuSystem.cpp index e5eaa3dff..209615bcc 100644 --- a/gtsam_unstable/dynamics/imuSystem.cpp +++ b/gtsam_unstable/dynamics/imuSystem.cpp @@ -5,8 +5,7 @@ */ #include - -#include +#include namespace imu { @@ -56,7 +55,7 @@ void Graph::addRange(Key key1, Key key2, double z, const SharedNoiseModel& noise /* ************************************************************************* */ Values Graph::optimize(const Values& init) const { - return gtsam::optimize(*this, init); + return LevenbergMarquardtOptimizer(*this, init).optimize(); } /* ************************************************************************* */