环境建模基础：栅格地图、几何地图、拓扑地图的构建与对比

做路径规划这么多年，我越来越觉得一个道理：地图选不对，算法全白费。你想想看，机器人要导航，首先得知道自己在哪、周围长什么样。这个「长什么样」就是环境建模。

说白了，环境建模就是把真实世界翻译成机器人能理解的语言。我见过太多新手一上来就怼算法，结果地图模型没选好，跑起来各种撞墙。嗯，今天咱们就把三种主流地图模型掰开揉碎了讲清楚。

1. 栅格地图：最直观的「像素化」世界

栅格地图，我个人习惯叫它「格子地图」。就是把环境切成一个个小方格，每个格子要么是障碍物（黑色），要么是自由空间（白色）。

我在做仓储机器人项目时，就用的栅格地图。当时仓库里堆满了货架，用栅格地图特别方便——直接把货架位置标成黑色格子，机器人路径就绕开走。

栅格地图的构建步骤

1. 确定分辨率：每个格子代表实际多大面积。比如0.1m×0.1m
2. 传感器数据映射：激光雷达或超声波数据，反算出哪些格子被占据
3. 概率更新：用贝叶斯公式不断更新每个格子的占据概率
4. 二值化：设定阈值，概率高于阈值的标记为障碍物

// 伪代码：栅格地图更新
for each laser_scan_point:
    grid_x = floor(point.x / resolution)
    grid_y = floor(point.y / resolution)
    if point.is_obstacle:
        grid[grid_x][grid_y].prob += log_odds_hit
    else:
        grid[grid_x][grid_y].prob -= log_odds_miss

栅格地图的优缺点

优点	缺点
构建简单，直观易懂	存储量大，尤其大场景
支持概率更新，鲁棒性好	分辨率固定，无法自适应
适合局部路径规划	全局规划时路径不平滑

2. 几何地图：用数学描述世界

几何地图就不一样了。它不画格子，而是用点、线、面来描述环境。你想想看，一面墙在栅格地图里是一堆黑色格子，在几何地图里就是一条线段。

我记得有一次做室外无人车项目，场地有几百米长。用栅格地图？内存直接爆了。后来换成几何地图，用线段和圆弧描述道路边界，内存占用降了两个数量级。

常见的几何地图形式

• 特征地图：提取环境中的特征点（墙角、柱子），用坐标表示
• 线段地图：用直线段拟合墙壁、路沿
• 多边形地图：用多边形表示障碍物轮廓

// 几何地图示例：线段表示墙壁
struct WallSegment {
    Point start;  // 起点 (x1, y1)
    Point end;    // 终点 (x2, y2)
    double thickness; // 墙厚度
};

// 障碍物多边形
struct ObstaclePolygon {
    vector<Point> vertices; // 顶点列表
    bool is_convex;        // 是否凸多边形
};

3. 拓扑地图：只关心「怎么走」

拓扑地图是最抽象的一种。它不关心具体尺寸，只关心节点之间的连通关系。说白了就是一张「地铁线路图」——你知道哪站到哪站，但不知道站台具体长什么样。

我做过一个酒店送物机器人项目，整栋楼几十个房间。用拓扑地图就特别合适：每个房间是一个节点，走廊是边，机器人只需要知道「从A房间到B房间经过C走廊」就行。

拓扑地图的构建方法

1. 节点提取：识别环境中的关键位置（房间、路口、电梯口）
2. 边连接：判断两个节点之间是否有直接路径
3. 权重赋值：给每条边加上距离、时间或难度权重
4. 图优化：去除冗余节点，简化拓扑结构

// 拓扑地图数据结构
struct TopoNode {
    int id;
    string name;        // 比如 "Room_301"
    Point position;     // 实际坐标（可选）
    vector<int> neighbors; // 相邻节点ID列表
};

struct TopoEdge {
    int from_node;
    int to_node;
    double weight;      // 距离或通行代价
    bool is_door;       // 是否经过门
};

4. 三种地图的对比与选型

你可能会问：那我到底该用哪种？别急，我整理了一张对比表，看完你就明白了。

对比维度	栅格地图	几何地图	拓扑地图
存储空间	大（O(n²)）	中（O(m)）	小（O(k)）
构建难度	低	中	高
定位精度	高	中	低
路径规划速度	慢（格子多）	中	快（节点少）
适用场景	室内、小范围	结构化环境	大场景、多楼层

我个人习惯的选型原则是这样的：

• 小范围室内（比如家庭、办公室）：栅格地图，简单粗暴
• 结构化大场景（比如工厂、停车场）：几何地图，省内存
• 多楼层、多房间（比如酒店、医院）：拓扑地图，规划快

5. 三种地图的核心逻辑关系

为了让你更直观地理解这三种地图的关系，我画了一张图。你看完就明白它们各自在路径规划中扮演什么角色了。

从这张图你能看出来：真实环境是源头，三种地图是不同角度的抽象。栅格地图保留了最完整的空间信息，几何地图去掉了冗余细节，拓扑地图只保留连通性。越往右，信息越精简，但规划速度越快。

好了，环境建模这块就聊到这儿。你先把这三种地图吃透，后面讲路径规划算法时，你会发现很多算法都是基于这些地图模型来设计的。