diff --git a/tests/timeMultifrontalOnDataset.cpp b/tests/timeMultifrontalOnDataset.cpp index dcd8470b5..0b329fdc6 100644 --- a/tests/timeMultifrontalOnDataset.cpp +++ b/tests/timeMultifrontalOnDataset.cpp @@ -35,6 +35,9 @@ int main(int argc, char *argv[]) { pair, shared_ptr > data = load2D(dataset(datasetname)); + // Add a prior on the first pose + data.first->addPrior(0, Pose2(), sharedSigma(Pose2::Dim(), 0.0005)); + tic_("Z 1 order"); Ordering::shared_ptr ordering(data.first->orderingCOLAMD(*data.second)); toc_("Z 1 order"); diff --git a/tests/timeSequentialOnDataset.cpp b/tests/timeSequentialOnDataset.cpp index 9be51d0ad..79c32469c 100644 --- a/tests/timeSequentialOnDataset.cpp +++ b/tests/timeSequentialOnDataset.cpp @@ -35,6 +35,9 @@ int main(int argc, char *argv[]) { pair, shared_ptr > data = load2D(dataset(datasetname)); + // Add a prior on the first pose + data.first->addPrior(0, Pose2(), sharedSigma(Pose2::Dim(), 0.0005)); + tic_("Z 1 order"); Ordering::shared_ptr ordering(data.first->orderingCOLAMD(*data.second)); toc_("Z 1 order");