parent
e8b0bfb285
commit
41fc7e38cc
|
@ -97,7 +97,7 @@ std::shared_ptr<mapping::Submap2D> MapBuilderContext::UpdateSubmap2D(
|
|||
} else {
|
||||
// If the submap is unfinished set the 'num_range_data' to 0 since we
|
||||
// haven't changed the HybridGrid.
|
||||
submap_2d_ptr->SetNumRangeData(0);
|
||||
submap_2d_ptr->set_num_range_data(0);
|
||||
}
|
||||
}
|
||||
return submap_2d_ptr;
|
||||
|
@ -131,7 +131,7 @@ std::shared_ptr<mapping::Submap3D> MapBuilderContext::UpdateSubmap3D(
|
|||
} else {
|
||||
// If the submap is unfinished set the 'num_range_data' to 0 since we
|
||||
// haven't changed the HybridGrid.
|
||||
submap_3d_ptr->SetNumRangeData(0);
|
||||
submap_3d_ptr->set_num_range_data(0);
|
||||
}
|
||||
}
|
||||
return submap_3d_ptr;
|
||||
|
|
|
@ -70,8 +70,8 @@ Submap2D::Submap2D(const MapLimits& limits, const Eigen::Vector2f& origin)
|
|||
Submap2D::Submap2D(const proto::Submap2D& proto)
|
||||
: Submap(transform::ToRigid3(proto.local_pose())),
|
||||
probability_grid_(ProbabilityGrid(proto.probability_grid())) {
|
||||
SetNumRangeData(proto.num_range_data());
|
||||
SetFinished(proto.finished());
|
||||
set_num_range_data(proto.num_range_data());
|
||||
set_finished(proto.finished());
|
||||
}
|
||||
|
||||
void Submap2D::ToProto(proto::Submap* const proto,
|
||||
|
@ -88,8 +88,8 @@ void Submap2D::ToProto(proto::Submap* const proto,
|
|||
void Submap2D::UpdateFromProto(const proto::Submap& proto) {
|
||||
CHECK(proto.has_submap_2d());
|
||||
const auto& submap_2d = proto.submap_2d();
|
||||
SetNumRangeData(submap_2d.num_range_data());
|
||||
SetFinished(submap_2d.finished());
|
||||
set_num_range_data(submap_2d.num_range_data());
|
||||
set_finished(submap_2d.finished());
|
||||
if (submap_2d.has_probability_grid()) {
|
||||
probability_grid_ = ProbabilityGrid(submap_2d.probability_grid());
|
||||
}
|
||||
|
@ -147,13 +147,13 @@ void Submap2D::InsertRangeData(const sensor::RangeData& range_data,
|
|||
const RangeDataInserter2D& range_data_inserter) {
|
||||
CHECK(!finished());
|
||||
range_data_inserter.Insert(range_data, &probability_grid_);
|
||||
SetNumRangeData(num_range_data() + 1);
|
||||
set_num_range_data(num_range_data() + 1);
|
||||
}
|
||||
|
||||
void Submap2D::Finish() {
|
||||
CHECK(!finished());
|
||||
probability_grid_ = ComputeCroppedProbabilityGrid(probability_grid_);
|
||||
SetFinished(true);
|
||||
set_finished(true);
|
||||
}
|
||||
|
||||
ActiveSubmaps2D::ActiveSubmaps2D(const proto::SubmapsOptions2D& options)
|
||||
|
|
|
@ -209,8 +209,8 @@ Submap3D::Submap3D(const proto::Submap3D& proto)
|
|||
common::make_unique<HybridGrid>(proto.high_resolution_hybrid_grid())),
|
||||
low_resolution_hybrid_grid_(
|
||||
common::make_unique<HybridGrid>(proto.low_resolution_hybrid_grid())) {
|
||||
SetNumRangeData(proto.num_range_data());
|
||||
SetFinished(proto.finished());
|
||||
set_num_range_data(proto.num_range_data());
|
||||
set_finished(proto.finished());
|
||||
}
|
||||
|
||||
void Submap3D::ToProto(proto::Submap* const proto,
|
||||
|
@ -230,8 +230,8 @@ void Submap3D::ToProto(proto::Submap* const proto,
|
|||
void Submap3D::UpdateFromProto(const proto::Submap& proto) {
|
||||
CHECK(proto.has_submap_3d());
|
||||
const auto& submap_3d = proto.submap_3d();
|
||||
SetNumRangeData(submap_3d.num_range_data());
|
||||
SetFinished(submap_3d.finished());
|
||||
set_num_range_data(submap_3d.num_range_data());
|
||||
set_finished(submap_3d.finished());
|
||||
if (submap_3d.has_high_resolution_hybrid_grid()) {
|
||||
high_resolution_hybrid_grid_ =
|
||||
submap_3d.has_high_resolution_hybrid_grid()
|
||||
|
@ -271,12 +271,12 @@ void Submap3D::InsertRangeData(const sensor::RangeData& range_data,
|
|||
high_resolution_hybrid_grid_.get());
|
||||
range_data_inserter.Insert(transformed_range_data,
|
||||
low_resolution_hybrid_grid_.get());
|
||||
SetNumRangeData(num_range_data() + 1);
|
||||
set_num_range_data(num_range_data() + 1);
|
||||
}
|
||||
|
||||
void Submap3D::Finish() {
|
||||
CHECK(!finished());
|
||||
SetFinished(true);
|
||||
set_finished(true);
|
||||
}
|
||||
|
||||
ActiveSubmaps3D::ActiveSubmaps3D(const proto::SubmapsOptions3D& options)
|
||||
|
|
|
@ -76,15 +76,13 @@ class Submap {
|
|||
|
||||
// Number of RangeData inserted.
|
||||
int num_range_data() const { return num_range_data_; }
|
||||
|
||||
// Whether the submap is finished or not.
|
||||
bool finished() const { return finished_; }
|
||||
|
||||
void SetNumRangeData(const int num_range_data) {
|
||||
void set_num_range_data(const int num_range_data) {
|
||||
num_range_data_ = num_range_data;
|
||||
}
|
||||
|
||||
void SetFinished(bool finished) { finished_ = finished; }
|
||||
// Whether the submap is finished or not.
|
||||
bool finished() const { return finished_; }
|
||||
void set_finished(bool finished) { finished_ = finished; }
|
||||
|
||||
private:
|
||||
const transform::Rigid3d local_pose_;
|
||||
|
|
Loading…
Reference in New Issue