12345qiupeng
/
cartographer_ros
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Follow googlecartographer/cartographer#326. (#370)

master
Wolfgang Hess 2017-06-10 10:41:39 +02:00 committed by Holger Rapp
parent 6658cffa20
commit 8d8cc09f80
1 changed files with 14 additions and 11 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

21
cartographer_ros/cartographer_ros/occupancy_grid_test.cc
View File

@ -16,6 +16,8 @@
#include "cartographer_ros/occupancy_grid.h" #include "cartographer_ros/occupancy_grid.h"
#include <memory>
#include "cartographer/common/time.h" #include "cartographer/common/time.h"
#include "cartographer/sensor/range_data.h" #include "cartographer/sensor/range_data.h"
#include "gtest/gtest.h" #include "gtest/gtest.h"
@ -25,18 +27,19 @@ namespace cartographer_ros {
namespace { namespace {
TEST(OccupancyGridTest, ComputeMapLimits) { TEST(OccupancyGridTest, ComputeMapLimits) {
using ::cartographer::mapping::TrajectoryNode;
constexpr int kTrajectoryId = 0; constexpr int kTrajectoryId = 0;
const ::cartographer::mapping::TrajectoryNode::ConstantData constant_data{ const TrajectoryNode trajectory_node{
std::make_shared<TrajectoryNode::Data>(TrajectoryNode::Data{
::cartographer::common::FromUniversal(52), ::cartographer::common::FromUniversal(52),
::cartographer::sensor::RangeData{ ::cartographer::sensor::RangeData{Eigen::Vector3f::Zero(),
Eigen::Vector3f::Zero(), {Eigen::Vector3f(-30.f, 1.f, 0.f),
{Eigen::Vector3f(-30.f, 1.f, 0.f), Eigen::Vector3f(50.f, -10.f, 0.f)}, Eigen::Vector3f(50.f, -10.f, 0.f)},
{}}, {}},
::cartographer::sensor::Compress( ::cartographer::sensor::Compress(::cartographer::sensor::RangeData{
::cartographer::sensor::RangeData{Eigen::Vector3f::Zero(), {}, {}}), Eigen::Vector3f::Zero(), {}, {}}),
kTrajectoryId, ::cartographer::transform::Rigid3d::Identity()}; kTrajectoryId, ::cartographer::transform::Rigid3d::Identity()}),
const ::cartographer::mapping::TrajectoryNode trajectory_node{ ::cartographer::transform::Rigid3d::Identity()};
&constant_data, ::cartographer::transform::Rigid3d::Identity()};
constexpr double kResolution = 0.05; constexpr double kResolution = 0.05;
const ::cartographer::mapping_2d::MapLimits limits = const ::cartographer::mapping_2d::MapLimits limits =
ComputeMapLimits(kResolution, {trajectory_node}); ComputeMapLimits(kResolution, {trajectory_node});