Skip to content

Commit

Permalink
update timeLago.cpp with newer Sampler interface
Browse files Browse the repository at this point in the history
  • Loading branch information
acxz committed Jun 14, 2021
1 parent 9430807 commit 7bdaff3
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions timing/timeLago.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -41,11 +41,11 @@ int main(int argc, char *argv[]) {

// add noise to create initial estimate
Values initial;
Sampler sampler(42u);
Values::ConstFiltered<Pose2> poses = solution->filter<Pose2>();
SharedDiagonal noise = noiseModel::Diagonal::Sigmas((Vector(3) << 0.5, 0.5, 15.0 * M_PI / 180.0).finished());
Sampler sampler(noise);
for(const Values::ConstFiltered<Pose2>::KeyValuePair& it: poses)
initial.insert(it.key, it.value.retract(sampler.sampleNewModel(noise)));
initial.insert(it.key, it.value.retract(sampler.sample()));

// Add prior on the pose having index (key) = 0
noiseModel::Diagonal::shared_ptr priorModel = //
Expand Down

0 comments on commit 7bdaff3

Please sign in to comment.