diff --git a/timing/timeIncremental.cpp b/timing/timeIncremental.cpp index 8f5be86d6..e09b83232 100644 --- a/timing/timeIncremental.cpp +++ b/timing/timeIncremental.cpp @@ -153,8 +153,8 @@ int main(int argc, char *argv[]) { if(!isam2.getLinearizationPoint().exists(lmKey)) { Pose pose = isam2.calculateEstimate(poseKey); - Rot2 measuredBearing = measurement->measured().first; - double measuredRange = measurement->measured().second; + Rot2 measuredBearing = measurement->measured().bearing(); + double measuredRange = measurement->measured().range(); newVariables.insert(lmKey, pose.transform_from(measuredBearing.rotate(Point2(measuredRange, 0.0)))); } diff --git a/timing/timeSchurFactors.cpp b/timing/timeSchurFactors.cpp index f00e5d6f7..9e057f830 100644 --- a/timing/timeSchurFactors.cpp +++ b/timing/timeSchurFactors.cpp @@ -40,7 +40,7 @@ void timeAll(size_t m, size_t N) { static const int D = CAMERA::dimension; typedef Eigen::Matrix Matrix2D; KeyVector keys; - vector Fblocks; + vector > Fblocks; for (size_t i = 0; i < m; i++) { keys.push_back(i); Fblocks.push_back((i + 1) * Matrix::Ones(2, D));