Updated gtsam_unstable for the new nonlinear optimizer
parent
1f66e87046
commit
f3ed18dfdc
|
@ -5,8 +5,7 @@
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <gtsam_unstable/dynamics/imuSystem.h>
|
#include <gtsam_unstable/dynamics/imuSystem.h>
|
||||||
|
#include <gtsam/nonlinear/LevenbergMarquardtOptimizer.h>
|
||||||
#include <gtsam/nonlinear/NonlinearOptimization.h>
|
|
||||||
|
|
||||||
namespace imu {
|
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 {
|
Values Graph::optimize(const Values& init) const {
|
||||||
return gtsam::optimize<Graph>(*this, init);
|
return LevenbergMarquardtOptimizer(*this, init).optimize();
|
||||||
}
|
}
|
||||||
/* ************************************************************************* */
|
/* ************************************************************************* */
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue