本文整理汇总了C++中GridMap::getIdxForPosition方法的典型用法代码示例。如果您正苦于以下问题：C++ GridMap::getIdxForPosition方法的具体用法？C++ GridMap::getIdxForPosition怎么用？C++ GridMap::getIdxForPosition使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类GridMap的用法示例。
在下文中一共展示了GridMap::getIdxForPosition方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: inflateBlacklist
void inflateBlacklist(GridMap& map, std::set<tf::Vector3> positions, int radius)
{
CHECK_RADIUS(radius);
static GridMask* grid_mask = NULL;
static int last_radius = -1;
if (!grid_mask || radius != last_radius)
{
delete grid_mask;
grid_mask = makeCircularMask(radius);
last_radius = radius;
}
ApplyMaskOperator op = [](int8_t cell, int8_t mask_cell)
{
// If the cell isn't unknown, set it as unreachable.
if (cell == GridMap::UNKNOWN)
return cell;
else
return std::max(cell, mask_cell);
};
for (tf::Vector3 pos : positions)
{
index_t idx = map.getIdxForPosition(pos);
ROS_WARN_STREAM("Applying mask at idx=" << idx);
apply_mask_at_idx(map, *grid_mask, op, idx);
}
}