rid

map学习笔记1已成功在Ubuntu18.04系统上源码编译grid

map的多层定义中心坐标系定义栅格单元定义迭代器的类型定义等当然也有一些grid

map封装好的packges比如支持的可视化数据类型点云向量占据栅格等支持的各种栅格地图过滤器等。

grid

githubhttps://github.com/ANYbotics/grid_map

本文系统环境

map是指一个平面地图在这个地图上将整个空间分割成一个个大小相等的方格每个方格称为一个网格grid。

每个网格都可以用一个值来表示其在地图上的属性例如障碍物、自由空间、未知区域等。

这些属性值通常用颜色来表示比如灰色代表障碍物白色代表自由空间黑色代表未知区域等。

单层grid

map通常用于机器人地图构建和路径规划中机器人通过传感器获取周围环境信息然后根据这些信息更新地图上各个网格的属性值。

机器人在规划路径时可以使用单层grid

map来表示环境根据不同网格的属性值计算出可行的路径从而避开障碍物并尽可能地避免未知区域。

单层grid

map相对于其他类型的地图具有简单、易于实现、易于存储和处理等优点。

但它也存在一些限制例如无法表示多层信息、无法表达细节等。

单层grid

map的中心默认在栅格地图的中心栅格地图的坐标系定义遵从右手法则x朝前y朝左z朝上每张grid

map地图从左上角开始编号依次是(0,0)、(0,1)...(n,m)

getMapSize()该函数用于获取地图的大小。

输出为地图的宽度和高度通常以网格数来表示。

在机器人地图构建和路径规划中通常需要获取地图的大小以便进行合理的路径规划和地图构建。

getPosition(grid_x,

grid_y)该函数用于将网格坐标转化为世界坐标。

输入参数为网格坐标(grid_x,

grid_y)输出为该网格的世界坐标。

在机器人地图构建和路径规划中通常需要将机器人在地图上的位置转化为世界坐标以便更好地进行路径规划和控制。

getGridIndex(pos_x,

pos_y)该函数用于将世界坐标转化为网格坐标。

输入参数为世界坐标(pos_x,

pos_y)输出为该坐标所在网格的网格坐标。

在机器人地图构建和路径规划中通常需要将传感器获取到的障碍物位置转化为网格坐标以便更新地图上各个网格的属性值。

getResolution()该函数用于获取网格地图的分辨率即每个网格代表的实际距离。

输出为一个实数值单位为米/格。

在机器人路径规划中通常需要利用网格地图的分辨率计算机器人的运动距离和速度等参数。

getSize()该函数用于获取网格地图的大小即网格地图的宽度和高度以网格数为单位。

输出为一个整数对格式为(width,

height)。

在机器人路径规划和地图构建中通常需要获取网格地图的大小以便进行合理的路径规划和地图构建。

getLength()该函数用于获取网格地图的尺寸即网格地图的总网格数。

输出为一个整数值表示网格地图中网格的总数。

在机器人路径规划和地图构建中通常需要获取网格地图的尺寸以便进行合理的路径规划和地图构建。

getIndex(x,

y)该函数用于将网格地图中的坐标转化为网格地图中的索引。

输入参数为坐标(x,

y)输出为该坐标在网格地图中的索引。

在机器人路径规划中通常需要将世界坐标转化为网格地图中的索引以便进行路径规划。

1.2

map的基础上增加了多个层次的信息表示。

每个层次的信息表示可以包括不同的地图属性例如高度、颜色、温度等。

每个网格在多层grid

多层grid

map常用于机器人导航和环境建模中它可以同时表示不同层次的信息例如机器人所处的高度、周围环境的颜色、温度和湿度等从而更准确地表示环境信息增强机器人的感知能力和路径规划能力。

在多层grid

value)该函数用于设置指定层次和指定网格的属性值。

输入参数为层次(layer)、网格坐标(grid_x,

grid_y)和属性值(value)用于更新地图上指定层次和指定网格的属性值。

getGridValue(layer,

grid_y)该函数用于获取指定层次和指定网格的属性值。

输入参数为层次(layer)、网格坐标(grid_x,

map的分辨率即每个网格代表的实际距离。

输出为一个实数值单位为米/格。

多层grid

map具有更丰富的信息表示能力但也会带来更高的计算和存储成本。

1.3

map中迭代所有网格。

该迭代器按行优先row-major的顺序遍历网格即先遍历第一行的所有网格然后是第二行的所有网格以此类推。

使用该迭代器可以遍历整个地图。

GridMapIteratorRow用于在grid

map中迭代指定行的所有网格。

该迭代器按列优先column-major的顺序遍历网格即先遍历第一列的所有网格然后是第二列的所有网格以此类推。

使用该迭代器可以遍历指定行的所有网格。

GridMapIteratorRectangle用于在grid

map中迭代指定矩形区域内的所有网格。

该迭代器按行优先的顺序遍历矩形区域内的网格。

使用该迭代器可以遍历指定矩形区域内的所有网格。

GridMapIteratorSubmap用于在grid

map中迭代指定子地图内的所有网格。

该迭代器按行优先的顺序遍历子地图内的网格。

使用该迭代器可以遍历指定子地图内的所有网格。

map中迭代指定圆形区域内的所有网格。

使用该迭代器可以遍历指定圆形区域内的所有网格。

GridMapLineIterator用于在grid

map中迭代指定线段路径上的所有网格。

使用该迭代器可以遍历指定线段路径上的所有网格。

GridMapPolygonIterator用于在grid

map中迭代指定多边形区域内的所有网格。

使用该迭代器可以遍历指定多边形区域内的所有网格。

GridMapEllipseIterator用于在grid

map中迭代指定椭圆形区域内的所有网格。

使用该迭代器可以遍历指定椭圆形区域内的所有网格。

GridMapSpiralIterator用于在grid

map中迭代指定螺旋线区域内的所有网格。

使用该迭代器可以遍历指定螺旋线区域内的所有网格。

可以根据具体的需求选择不同的迭代器。

在实际应用中可以通过使用这些迭代器来实现各种操作例如遍历网格、更新网格属性、计算路径等。

网格图子图圆形线

begin()和end()函数GridMapIteratorRow:

beginRow()和endRow()函数GridMapIteratorRectangle:

beginRectangle()和endRectangle()函数GridMapIteratorSubmap:

beginSubmap()和endSubmap()函数GridMapCircleIterator:

GridMapCircleIterator()构造函数GridMapLineIterator:

GridMapLineIterator()构造函数GridMapPolygonIterator:

GridMapPolygonIterator()构造函数GridMapEllipseIterator:

GridMapEllipseIterator()构造函数GridMapSpiralIterator:

例如以下代码演示了使用GridMapIterator遍历grid

GridMapIterator

}类似地以下代码演示了使用GridMapCircleIterator遍历grid

iter(grid_map,

}需要注意的是在使用迭代器访问网格时可以使用索引index或坐标position方式来访问。

例如以下代码演示了使用索引方式来访问网格

遍历grid

grid_map.atPosition(layer_name,

position);//

map中位置移动可以通过使用grid_map库提供的函数来实现。

grid_map库提供了一系列函数可以方便地对网格地图进行平移和旋转操作。

比如对于平移操作可以使用grid_map::move函数。

该函数接受一个Eigen::Vector2d类型的偏移量参数用于指定网格地图在x和y方向上的平移量。

例如以下代码可以将网格地图平移一个单位

grid_map::GridMap

offset);对于旋转操作可以使用grid_map::rotate函数。

该函数接受一个double类型的旋转角度参数以弧度为单位。

例如以下代码可以将网格地图旋转45度

grid_map::GridMap

angle);需要注意的是调用这些函数后网格地图的大小和分辨率不会发生变化。

如果需要改变网格地图的大小和分辨率可以使用grid_map::GridMap::add函数或grid_map::GridMap::setGeometry函数。

功能包

grid_map_rviz_plugin是一个ROS中的插件用于在ROS可视化工具RViz中显示二维栅格地图。

它是grid_map库的一部分该库是ROS中用于管理和处理2D网格地图的常用库。

使用grid_map_rviz_plugin用户可以在RViz中可视化网格地图的不同层例如高程、占用度或其他用户定义的层。

此外该插件还支持在RViz中可视化其他信息例如机器人传感器读数、路径规划结果等。

使用grid_map_rviz_plugin用户可以执行以下操作

在RViz中添加grid_map_rviz_plugin插件。

在RViz中选择grid_map_rviz_plugin作为显示类型并选择要显示的网格地图层。

使用grid_map_rviz_plugin用户可以更轻松地理解和分析网格地图数据从而更好地实现机器人导航、路径规划等应用。

同时由于RViz支持交互式操作用户还可以通过RViz直接与网格地图进行交互例如缩放、平移、旋转等操作。

2.2

grid_map_sdf是一个ROS包中的功能包用于构建二维栅格地图并计算该地图中每个栅格的有向距离场Signed

Distance

SDF是一种表示几何对象的方法可以用于计算两个对象之间的距离。

对于一个给定的点SDF可以告诉我们该点离最近的对象表面的距离以及该点是否在对象内部或外部。

这种表示方式被广泛用于机器人导航和避障等应用中。

在ROS中grid_map_sdf包提供了一种使用栅格地图计算SDF的方法。

它使用Fast

Marching算法来计算每个栅格到最近障碍物的距离可以有效地处理复杂的环境和障碍物形状。

使用grid_map_sdf包可以将传感器数据转换为栅格地图并计算出每个栅格的SDF值。

这些值可以用于机器人的导航和避障以及其他需要几何信息的任务。

2.3

是一种将网格地图可视化的方法或工具。

网格地图是一种将环境或区域划分为规则网格单元的表示方式通常用于机器人导航、路径规划、环境建模等应用。

grid_map_visualization节点订阅grid_map_msgs/GridMap类型的主题并发布可在RViz中可视化的消息。

可视化工具发布的主题可以使用

YAML

参数文件进行完全配置。

可以添加任意数量的具有不同参数的可视化。

2.3.1

订阅的主题比较明确就是grid_map_msgs/GridMap类型的栅格图主题默认为/grid_map

2.3.2

发布的主题通过YAML参数文件进行配置。

可能的主题有点云(Point

cloud)向量(Vectors)占用网格(Occupancy

grid)网格单元(Grid

cells)等这里以grid_map/grid_map_demos/config/tutorial_demo.yaml配置文件为例

点云向量占用栅格网格单元

将网格图显示为“平面”点云即所有点都具有相同高度。

在RViz的帮助下可以方便地可视化RViz中的2D地图或图像甚至视频流Color

Transformer。

该参数height确定平面点云需要的z位置

name:

0.0注意为了从空/无效单元格中省略平面点云中的点请指定使用来检查效果的图层setBasicLayers(...)

将网格地图的矢量数据可视化为视觉标记。

使用参数指定保存保护的x、y和z数量的层layer_prefix该参数position_layer定义使用矢量起点的图层

name:

将网格地图的图层可视化为占用网格。

使用参数指定要可视化的图层layer并使用和指定上限和data_min下限data_max

name:

将网格地图的图层可视化为网格单元。

使用参数指定要可视化的图层layer并使用和指定上限和lower_threshold下限upper_threshold

name:

grid_map_filters包包含过滤器可以将它们评估多个网格地图以对图层中的数据执行计算。

网格地图过滤器基于ROS

Filters这意味着过滤器链可以配置为YAML文件。

另外可以通过

ROS

插件机制编写附加过滤器并设置可用例如来自包的过滤器。

InpaintFiltergrid_map_cv

如果condition_layer超过上限或下限阈值一次仅一个阈值则将输出层中的值设置指定值

name:

gridMapFilters/ThresholdFilterparams:condition_layer:

0.0

.infgridMapFilters/MeanInRadiusFilter

name:

gridMapFilters/MeanInRadiusFilterparams:input_layer:

inputoutput_layer:

m.gridMapFilters/MedianFillFilter

计算一个层的每个NAN单元的中位数有限的贴片内有限的中位数。

可选地将中位数计算用于已经有限的值这些点的补丁半径由现有value_radius给出。

请注意仅当Fill_mask对此有效时才执行填充计算。

name:

gridMapFilters/MedianFillFilterparams:input_layer:

inputoutput_layer:

enabled.gridMapFilters/NormalVectorsFilter

name:

gridMapFilters/NormalVectorsFilterparams:input_layer:

0.05normal_vector_positive_axis:

zgridMapFilters/NormalColorMapFilter

name:

gridMapFilters/NormalColorMapFilterparams:input_layers_prefix:

normal_colorgridMapFilters/MathExpressionFilter

EigenLab

gridMapFilters/MathExpressionFilterparams:output_layer:

outputexpression:

sum.gridMapFilters/SlidingWindowMathExpressionFilter

在网格图层上的滑动窗口中解析并评估数学矩阵表达式。

有关表达式的文档请参见EigenLab

name:

gridMapFilters/SlidingWindowMathExpressionFilterparams:input_layer:

inputoutput_layer:

sumOfFinites([0,-1,0;-1,5,-1;0,-1,0].*elevation_inpainted)

Sharpen

mgridMapFilters/DuplicationFilter

name:

gridMapFilters/DuplicationFilterparams:input_layer:

inputoutput_layer:

outputgridMapFilters/DeletionFilter

从网格图中删除图层

gridMapFilters/DeletionFilterparams:layers:

[color,

gridMapCv/InpaintFilterparams:input_layer:

inputoutput_layer:

https://github.com/anybotics/grid_map