Go to the documentation of this file.
33 using namespace gtsam;
35 int main(
int argc,
char** argv) {
52 initial.print(
"\nInitial Estimate:\n");
58 params.orderingType = Ordering::METIS;
virtual const Values & optimize()
A nonlinear optimizer that uses the Levenberg-Marquardt trust-region scheme.
Pose2 priorMean(0.0, 0.0, 0.0)
static const SmartProjectionParams params
Pose2 odometry(2.0, 0.0, 0.0)
void addPrior(Key key, const T &prior, const SharedNoiseModel &model=nullptr)
void print(const std::string &str="", const KeyFormatter &keyFormatter=DefaultKeyFormatter) const
A class for computing marginals in a NonlinearFactorGraph.
Factor Graph consisting of non-linear factors.
int main(int argc, char **argv)
NonlinearFactorGraph graph
A non-templated config holding any types of Manifold-group elements.
IsDerived< DERIVEDFACTOR > emplace_shared(Args &&... args)
Emplace a shared pointer to factor of given type.
void print(const std::string &str="NonlinearFactorGraph: ", const KeyFormatter &keyFormatter=DefaultKeyFormatter) const override
gtsam
Author(s):
autogenerated on Fri Nov 1 2024 03:33:48