parent
1905b6bb59
commit
ceddabbcbb
|
@ -124,10 +124,11 @@ ProbabilityGridRangeDataInserter2D::ProbabilityGridRangeDataInserter2D(
|
|||
void ProbabilityGridRangeDataInserter2D::Insert(
|
||||
const sensor::RangeData& range_data, GridInterface* const grid) const {
|
||||
ProbabilityGrid* const probability_grid = static_cast<ProbabilityGrid*>(grid);
|
||||
CHECK(probability_grid != nullptr);
|
||||
// By not finishing the update after hits are inserted, we give hits priority
|
||||
// (i.e. no hits will be ignored because of a miss in the same cell).
|
||||
CastRays(range_data, hit_table_, miss_table_, options_.insert_free_space(),
|
||||
CHECK_NOTNULL(probability_grid));
|
||||
probability_grid);
|
||||
probability_grid->FinishUpdate();
|
||||
}
|
||||
|
||||
|
|
|
@ -77,7 +77,7 @@ RangeDataInserter3D::RangeDataInserter3D(
|
|||
|
||||
void RangeDataInserter3D::Insert(const sensor::RangeData& range_data,
|
||||
HybridGrid* hybrid_grid) const {
|
||||
CHECK_NOTNULL(hybrid_grid);
|
||||
CHECK(hybrid_grid != nullptr);
|
||||
|
||||
for (const sensor::RangefinderPoint& hit : range_data.returns) {
|
||||
const Eigen::Array3i hit_cell = hybrid_grid->GetCellIndex(hit.position);
|
||||
|
|
|
@ -229,8 +229,8 @@ bool FastCorrelativeScanMatcher2D::MatchWithSearchParameters(
|
|||
const transform::Rigid2d& initial_pose_estimate,
|
||||
const sensor::PointCloud& point_cloud, float min_score, float* score,
|
||||
transform::Rigid2d* pose_estimate) const {
|
||||
CHECK_NOTNULL(score);
|
||||
CHECK_NOTNULL(pose_estimate);
|
||||
CHECK(score != nullptr);
|
||||
CHECK(pose_estimate != nullptr);
|
||||
|
||||
const Eigen::Rotation2Dd initial_rotation = initial_pose_estimate.rotation();
|
||||
const sensor::PointCloud rotated_point_cloud = sensor::TransformPointCloud(
|
||||
|
|
|
@ -118,7 +118,7 @@ double RealTimeCorrelativeScanMatcher2D::Match(
|
|||
const transform::Rigid2d& initial_pose_estimate,
|
||||
const sensor::PointCloud& point_cloud, const Grid2D& grid,
|
||||
transform::Rigid2d* pose_estimate) const {
|
||||
CHECK_NOTNULL(pose_estimate);
|
||||
CHECK(pose_estimate != nullptr);
|
||||
|
||||
const Eigen::Rotation2Dd initial_rotation = initial_pose_estimate.rotation();
|
||||
const sensor::PointCloud rotated_point_cloud = sensor::TransformPointCloud(
|
||||
|
|
|
@ -35,7 +35,7 @@ float RealTimeCorrelativeScanMatcher3D::Match(
|
|||
const transform::Rigid3d& initial_pose_estimate,
|
||||
const sensor::PointCloud& point_cloud, const HybridGrid& hybrid_grid,
|
||||
transform::Rigid3d* pose_estimate) const {
|
||||
CHECK_NOTNULL(pose_estimate);
|
||||
CHECK(pose_estimate != nullptr);
|
||||
float best_score = -1.f;
|
||||
for (const transform::Rigid3f& transform : GenerateExhaustiveSearchTransforms(
|
||||
hybrid_grid.resolution(), point_cloud)) {
|
||||
|
|
|
@ -18,8 +18,8 @@
|
|||
|
||||
#include "Eigen/Geometry"
|
||||
#include "absl/memory/memory.h"
|
||||
#include "cartographer/transform/rigid_transform_test_helpers.h"
|
||||
#include "gtest/gtest.h"
|
||||
#include "transform/rigid_transform_test_helpers.h"
|
||||
|
||||
namespace cartographer {
|
||||
namespace mapping {
|
||||
|
|
Loading…
Reference in New Issue