diff --git a/cartographer/mapping/global_trajectory_builder.h b/cartographer/mapping/global_trajectory_builder.h index b585464..f09f3b4 100644 --- a/cartographer/mapping/global_trajectory_builder.h +++ b/cartographer/mapping/global_trajectory_builder.h @@ -71,8 +71,8 @@ class GlobalTrajectoryBuilder void AddSensorData(const sensor::OdometryData& odometry_data) override { CHECK(odometry_data.pose.IsValid()) << odometry_data.pose; - local_trajectory_builder_.AddOdometerData(odometry_data); - sparse_pose_graph_->AddOdometerData(trajectory_id_, odometry_data); + local_trajectory_builder_.AddOdometryData(odometry_data); + sparse_pose_graph_->AddOdometryData(trajectory_id_, odometry_data); } void AddSensorData( diff --git a/cartographer/mapping/sparse_pose_graph.h b/cartographer/mapping/sparse_pose_graph.h index 2111cf1..274b72b 100644 --- a/cartographer/mapping/sparse_pose_graph.h +++ b/cartographer/mapping/sparse_pose_graph.h @@ -88,7 +88,7 @@ class SparsePoseGraph { const sensor::ImuData& imu_data) = 0; // Inserts an odometry measurement. - virtual void AddOdometerData(int trajectory_id, + virtual void AddOdometryData(int trajectory_id, const sensor::OdometryData& odometry_data) = 0; // Finishes the given trajectory. diff --git a/cartographer/mapping_2d/local_trajectory_builder.cc b/cartographer/mapping_2d/local_trajectory_builder.cc index ba3c429..47f52f9 100644 --- a/cartographer/mapping_2d/local_trajectory_builder.cc +++ b/cartographer/mapping_2d/local_trajectory_builder.cc @@ -212,7 +212,7 @@ void LocalTrajectoryBuilder::AddImuData(const sensor::ImuData& imu_data) { extrapolator_->AddImuData(imu_data); } -void LocalTrajectoryBuilder::AddOdometerData( +void LocalTrajectoryBuilder::AddOdometryData( const sensor::OdometryData& odometry_data) { if (extrapolator_ == nullptr) { // Until we've initialized the extrapolator we cannot add odometry data. diff --git a/cartographer/mapping_2d/local_trajectory_builder.h b/cartographer/mapping_2d/local_trajectory_builder.h index a2210b0..13c6794 100644 --- a/cartographer/mapping_2d/local_trajectory_builder.h +++ b/cartographer/mapping_2d/local_trajectory_builder.h @@ -68,7 +68,7 @@ class LocalTrajectoryBuilder { std::unique_ptr AddRangeData( common::Time, const sensor::TimedRangeData& range_data); void AddImuData(const sensor::ImuData& imu_data); - void AddOdometerData(const sensor::OdometryData& odometry_data); + void AddOdometryData(const sensor::OdometryData& odometry_data); private: std::unique_ptr AddAccumulatedRangeData( diff --git a/cartographer/mapping_2d/sparse_pose_graph.cc b/cartographer/mapping_2d/sparse_pose_graph.cc index 84dd32b..ea5f213 100644 --- a/cartographer/mapping_2d/sparse_pose_graph.cc +++ b/cartographer/mapping_2d/sparse_pose_graph.cc @@ -160,11 +160,11 @@ void SparsePoseGraph::AddImuData(const int trajectory_id, }); } -void SparsePoseGraph::AddOdometerData( +void SparsePoseGraph::AddOdometryData( const int trajectory_id, const sensor::OdometryData& odometry_data) { common::MutexLocker locker(&mutex_); AddWorkItem([=]() REQUIRES(mutex_) { - optimization_problem_.AddOdometerData(trajectory_id, odometry_data); + optimization_problem_.AddOdometryData(trajectory_id, odometry_data); }); } diff --git a/cartographer/mapping_2d/sparse_pose_graph.h b/cartographer/mapping_2d/sparse_pose_graph.h index 4854838..f3ee710 100644 --- a/cartographer/mapping_2d/sparse_pose_graph.h +++ b/cartographer/mapping_2d/sparse_pose_graph.h @@ -78,7 +78,7 @@ class SparsePoseGraph : public mapping::SparsePoseGraph { void AddImuData(int trajectory_id, const sensor::ImuData& imu_data) override EXCLUDES(mutex_); - void AddOdometerData(int trajectory_id, + void AddOdometryData(int trajectory_id, const sensor::OdometryData& odometry_data) override EXCLUDES(mutex_); void AddFixedFramePoseData( diff --git a/cartographer/mapping_2d/sparse_pose_graph/optimization_problem.cc b/cartographer/mapping_2d/sparse_pose_graph/optimization_problem.cc index f592b5b..5faf24d 100644 --- a/cartographer/mapping_2d/sparse_pose_graph/optimization_problem.cc +++ b/cartographer/mapping_2d/sparse_pose_graph/optimization_problem.cc @@ -66,7 +66,7 @@ void OptimizationProblem::AddImuData(const int trajectory_id, imu_data_.Append(trajectory_id, imu_data); } -void OptimizationProblem::AddOdometerData( +void OptimizationProblem::AddOdometryData( const int trajectory_id, const sensor::OdometryData& odometry_data) { odometry_data_.Append(trajectory_id, odometry_data); } diff --git a/cartographer/mapping_2d/sparse_pose_graph/optimization_problem.h b/cartographer/mapping_2d/sparse_pose_graph/optimization_problem.h index 5caa48f..e4923e8 100644 --- a/cartographer/mapping_2d/sparse_pose_graph/optimization_problem.h +++ b/cartographer/mapping_2d/sparse_pose_graph/optimization_problem.h @@ -64,7 +64,7 @@ class OptimizationProblem { OptimizationProblem& operator=(const OptimizationProblem&) = delete; void AddImuData(int trajectory_id, const sensor::ImuData& imu_data); - void AddOdometerData(int trajectory_id, + void AddOdometryData(int trajectory_id, const sensor::OdometryData& odometry_data); void AddTrajectoryNode(int trajectory_id, common::Time time, const transform::Rigid2d& initial_pose, diff --git a/cartographer/mapping_3d/local_trajectory_builder.cc b/cartographer/mapping_3d/local_trajectory_builder.cc index b7196ab..f69b6bf 100644 --- a/cartographer/mapping_3d/local_trajectory_builder.cc +++ b/cartographer/mapping_3d/local_trajectory_builder.cc @@ -175,7 +175,7 @@ LocalTrajectoryBuilder::AddAccumulatedRangeData( std::move(insertion_result)}); } -void LocalTrajectoryBuilder::AddOdometerData( +void LocalTrajectoryBuilder::AddOdometryData( const sensor::OdometryData& odometry_data) { if (extrapolator_ == nullptr) { // Until we've initialized the extrapolator we cannot add odometry data. diff --git a/cartographer/mapping_3d/local_trajectory_builder.h b/cartographer/mapping_3d/local_trajectory_builder.h index aabe851..e922e6b 100644 --- a/cartographer/mapping_3d/local_trajectory_builder.h +++ b/cartographer/mapping_3d/local_trajectory_builder.h @@ -64,7 +64,7 @@ class LocalTrajectoryBuilder { // otherwise 'nullptr'. std::unique_ptr AddRangeData( common::Time time, const sensor::TimedRangeData& range_data); - void AddOdometerData(const sensor::OdometryData& odometry_data); + void AddOdometryData(const sensor::OdometryData& odometry_data); const mapping::PoseEstimate& pose_estimate() const; private: diff --git a/cartographer/mapping_3d/sparse_pose_graph.cc b/cartographer/mapping_3d/sparse_pose_graph.cc index 8038817..f401253 100644 --- a/cartographer/mapping_3d/sparse_pose_graph.cc +++ b/cartographer/mapping_3d/sparse_pose_graph.cc @@ -157,11 +157,11 @@ void SparsePoseGraph::AddImuData(const int trajectory_id, }); } -void SparsePoseGraph::AddOdometerData( +void SparsePoseGraph::AddOdometryData( const int trajectory_id, const sensor::OdometryData& odometry_data) { common::MutexLocker locker(&mutex_); AddWorkItem([=]() REQUIRES(mutex_) { - optimization_problem_.AddOdometerData(trajectory_id, odometry_data); + optimization_problem_.AddOdometryData(trajectory_id, odometry_data); }); } diff --git a/cartographer/mapping_3d/sparse_pose_graph.h b/cartographer/mapping_3d/sparse_pose_graph.h index bc749ec..f5ae928 100644 --- a/cartographer/mapping_3d/sparse_pose_graph.h +++ b/cartographer/mapping_3d/sparse_pose_graph.h @@ -78,7 +78,7 @@ class SparsePoseGraph : public mapping::SparsePoseGraph { void AddImuData(int trajectory_id, const sensor::ImuData& imu_data) override EXCLUDES(mutex_); - void AddOdometerData(int trajectory_id, + void AddOdometryData(int trajectory_id, const sensor::OdometryData& odometry_data) override EXCLUDES(mutex_); void AddFixedFramePoseData( diff --git a/cartographer/mapping_3d/sparse_pose_graph/optimization_problem.cc b/cartographer/mapping_3d/sparse_pose_graph/optimization_problem.cc index 1006972..61f73bb 100644 --- a/cartographer/mapping_3d/sparse_pose_graph/optimization_problem.cc +++ b/cartographer/mapping_3d/sparse_pose_graph/optimization_problem.cc @@ -86,7 +86,7 @@ void OptimizationProblem::AddImuData(const int trajectory_id, imu_data_.Append(trajectory_id, imu_data); } -void OptimizationProblem::AddOdometerData( +void OptimizationProblem::AddOdometryData( const int trajectory_id, const sensor::OdometryData& odometry_data) { odometry_data_.Append(trajectory_id, odometry_data); } diff --git a/cartographer/mapping_3d/sparse_pose_graph/optimization_problem.h b/cartographer/mapping_3d/sparse_pose_graph/optimization_problem.h index ef90bb6..d4f25cf 100644 --- a/cartographer/mapping_3d/sparse_pose_graph/optimization_problem.h +++ b/cartographer/mapping_3d/sparse_pose_graph/optimization_problem.h @@ -67,7 +67,7 @@ class OptimizationProblem { OptimizationProblem& operator=(const OptimizationProblem&) = delete; void AddImuData(int trajectory_id, const sensor::ImuData& imu_data); - void AddOdometerData(int trajectory_id, + void AddOdometryData(int trajectory_id, const sensor::OdometryData& odometry_data); void AddFixedFramePoseData( int trajectory_id,