Go to the source code of this file.
|
| graph | add (BetweenFactor< Pose2 >(1, 2, odometry, odometryNoise)) |
| |
| graph | add (BetweenFactor< Pose2 >(2, 3, odometry, odometryNoise)) |
| |
| graph | addPrior (1, priorMean, priorNoise) |
| |
| Pose2 | odometry (2.0, 0.0, 0.0) |
| |
| Pose2 | priorMean (0.0, 0.0, 0.0) |
| |
| graph add |
( |
BetweenFactor< Pose2 > |
1, 2, odometry, odometryNoise | ) |
|
| graph add |
( |
BetweenFactor< Pose2 > |
2, 3, odometry, odometryNoise | ) |
|
| Pose2 odometry |
( |
2. |
0, |
|
|
0. |
0, |
|
|
0. |
0 |
|
) |
| |
| Pose2 priorMean |
( |
0. |
0, |
|
|
0. |
0, |
|
|
0. |
0 |
|
) |
| |
| NonlinearFactorGraph graph |
| noiseModel::Diagonal::shared_ptr odometryNoise |
| noiseModel::Diagonal::shared_ptr priorNoise |