Go to the source code of this file.
|
| graph | add (BetweenFactor< Pose2 >(1, 2, Pose2(2, 0, 0), model)) |
| |
| graph | add (BetweenFactor< Pose2 >(2, 3, Pose2(2, 0, M_PI_2), model)) |
| |
| graph | add (BetweenFactor< Pose2 >(3, 4, Pose2(2, 0, M_PI_2), model)) |
| |
| graph | add (BetweenFactor< Pose2 >(4, 5, Pose2(2, 0, M_PI_2), model)) |
| |
| graph | add (BetweenFactor< Pose2 >(5, 2, Pose2(2, 0, M_PI_2), model)) |
| |
| graph | addPrior (1, Pose2(0, 0, 0), priorNoise) |
| |
|
| NonlinearFactorGraph | graph |
| |
| noiseModel::Diagonal::shared_ptr | model |
| |
| noiseModel::Diagonal::shared_ptr | priorNoise |
| |
| graph add |
( |
BetweenFactor< Pose2 > |
1, 2, Pose2(2, 0, 0), model | ) |
|
| graph add |
( |
BetweenFactor< Pose2 > |
2, 3, Pose2(2, 0, M_PI_2), model | ) |
|
| graph add |
( |
BetweenFactor< Pose2 > |
3, 4, Pose2(2, 0, M_PI_2), model | ) |
|
| graph add |
( |
BetweenFactor< Pose2 > |
4, 5, Pose2(2, 0, M_PI_2), model | ) |
|
| graph add |
( |
BetweenFactor< Pose2 > |
5, 2, Pose2(2, 0, M_PI_2), model | ) |
|
| NonlinearFactorGraph graph |
| noiseModel::Diagonal::shared_ptr model |
| noiseModel::Diagonal::shared_ptr priorNoise |