即时定位与地图构建SLAM

图1：初始位置 （由于机器人相对于路标A的位置为估计值，所以路标A用圆圈表示A的实际的可能值在圆圈内）
图2：机器人移动到新位置 （在新的位置，机器人相对于A的真实值可能落在圈内）
图3：路标C被观测到 （在新的位置，路标C被观测到，路标C的相对于A的位置也是一个估计值（更大的圈）
图4：路标B被观测到
对于SLAM的认识
Simultaneous Localization and Mapping 即时定位与地图构建
SLAM指的是机器人在自身位置不 确定的条件下,在完全未知环境中 创建地图,同时利用地图进行自主 定位和导航。
SLAM问题可以描述为: 机器 人在未知环境中从一个未知位置开 始移动,在移动过程中根据位置估 计和传感器数据进行自身定位,同 时建造增量式地图。
环境的描述--地图 目前各国研究者已经提出了多种表示法，大致可分为三类：栅格表示、几何信 息表示和拓扑图表示，每种方法都有自己的优缺点。 栅格地图表示法即将整个环境分为若干相同大小的栅格，对于每个栅格各指出 其中是否存在障碍物。这种方法最早由Elfes和Moravec提出，而后Elfes进行了 进一步的研究。优点是(1)创建和维护容易，(2)尽量保留了整个环境的各种信息， (3)借助于该地图，可以方便地进行自定位和路径规划。缺点在于：当栅格数量增 大时(在大规模环境或对环境划分比较详细时)，对地图的维护行为将变得困难， 同时定位过程中搜索空间很大，如果没有较好的简化算法，实现实时应用比较困 难。 几何信息地图表示法是指机器人收集对环境的感知信息，从中提取更为抽象的 几何特征，例如线段或曲线，使用这些几何信息描述环境。该表示法更为紧凑， 且便于位置估计和目标识别。几何方法利用卡尔曼滤波在局部区域内可获得较高 精度，且计算量小，但在广域环境中却难以维持精确的坐标信息。几何信息的提 取需要对感知信息作额外处理，且需要一定数量的感知数据才能得到结果。 拓扑地图抽象度高，特别在环境大而简单时。这种方法将环境表示为一张拓扑 意义中的图(graph)，图中的节点对应于环境中的一个特征状态、地点。如果节点 间存在直接连接的路径则相当于图中连接节点的弧。优点是：(1)有利于进一步的 路径和任务规划，(2)存储和搜索空间都比较小，计算效率高，(3)可以使用很多 现有成熟、高效的搜索和推理算法。缺点在于对拓扑图的使用是建立在对拓扑节 点的识别匹配基础上的，如当环境中存在两个很相似的地方时，拓扑图方法将很 难确定这是否为同一点。
不确定信息的描述和处理方法
在未知环境中，环境信息的不确定性尤为明显。研究人员已经提出了 多种用来处理不确定性的度量方法，如模糊度量、概率度量、信任度量、 可能性度量、证据理论度量等等。目前在SLAM中使用较多的主要是模 糊度量和概率度量的方法。 以概率描述信息的不确定性，其优点在于：适应不确定模型，对于性 能差的传感器也适用，在实际应用中鲁棒性较好，在很多实现中得到应 用。缺点是计算量较大，算法建立在一定假设条件上，而假设的合理性 有争议。 因此，有些学者认为使用模糊度的描述方法更适合于该任务。他们认为 模糊逻辑(fuzzy logic)提供了一个关于处理不确定信息更自然的框架，是 一个更为鲁棒且有效的工具(尤其对于声纳感知过程引起的不确定性)。 同时，在对多种不确定性信息进行建模和融合时有更多的操作符供选择。
1）使用extend kalman filter （EKF) 进行定位 2）获取所有的路标和机器人的位置信息作为先决条件 3）使用矢量方程来存储路标和机器人的位置 4）通过循环迭代来减少每次的误差量
状态估计是卡尔曼滤波的重要组成部分。一般来说，根据观测数据 对随机量进行定量推断就是估计问题，特别是对动态行为的状态估 计，它能实现实时运行状态的估计和预测功能。比如对飞行器状态 估计。状态估计对于了解和控制一个系统具有重要意义，所应用的 方法属于统计学中的估计理论。最常用的是最小二乘估计，线性最 小方差估计、最小方差估计、递推最小二乘估计等。其他如风险准 则的贝叶斯估计、最大似然估计、随机逼近等方法也都有应用。 受噪声干扰的状态量是个随机量，不可能测得精确值，但可对 它进行一系列观测，并依据一组观测值，按某种统计观点对它进行 估计。使估计值尽可能准确地接近真实值，这就是最优估计。真实 值与估计值之差称为估计误差。若估计值的数学期望与真实值相等， 这种估计称为无偏估计。卡尔曼提出的递推最优估计理论，采用状 态空间描述法，在算法采用递推形式，卡尔曼滤波能处理多维和非 平稳的随机过程。 卡尔曼滤波理论的提出，克服了威纳滤波理论的局限性使其在 工程上得到了广泛的应用，尤其在控制、制导、导航、通讯等现代 工程方面。
几种典型SLAM方法 目前SLAM方法大致可分为两类：一类为基于概率模型的方法，另一类为非概率模型方 法。许多基于卡尔曼滤波的SLAM方法如完全SLAM、压缩滤波、FastSLAM就属于概率模 型方法。非概率模型方法有SM-SLAM①、扫描匹配②、数据融合(data association)③、 基于模糊逻辑④等。 ①在一个未知的室内结构化环境中提出了基于栅格表示的局部模型与基于几何信息表 示的全局模型相结合的环境建模方式。环境特征的提取采用了Hough transform与 Clustering相结合的方法。感知数据的融合采用了扩展卡尔曼滤波方式。 ②提出的算法不需任何人为设定的参照物(如路标、灯塔)并且可适用于非多边形及动 态环境，同时和基于SLAM的卡尔曼滤波策略比较，其计算复杂度较小、与路标数量、环 境大小无关。环境建模策略由3部分构成：(1)收集环境信息；(2)扫描注册；(3)构建栅格 地图。在扫描注册中综合使用了几何模式匹配与扫描匹配。环境特征提取采用Hough transform技术。采用HIMM (Histogramic In-Motion Mapping)方法来构建栅格地图。在定 位方面，融合使用地图匹配与基于Petri网的离散事件控制策略。 ③有以下优势：(1)在无任何人工路标的情况下，能创建准确地图；(2)扩展了扫描匹 配的应用范围，使其能应用于非多边形的环境；(3)提高了几何模式匹配在多边形环境中 的精确度；(4)每次扫描注册精度都将与以前所有局部区域扫描结果进行比较，以保证全 局地图的准确性；(5)计算复杂度较小。离散事件控制策略的运用能更好的进行位置估测 与对定位错误的处理。 ④提出了使用SM(Set Membership)方法，解决同种多机器人SLAM问题。在地图融合 方面，把2D地图分解为两个1D地图来进行，进一步降低计算复杂度。在SLAM中使用SPModel(Symmetries and Perturbations Model)，对任何几何元素它提供了一个统一的表示 方式，并避免了参数过多的问题。
征的位置（如果知道自己的位置）
SLAM： 机器人在定位的同时建立环境地图
其基本原理是运过概率统计的方法，通过多特 征匹配来达到定位和减少定位误差的。
基本的SLAM应用的kalman filter。
Sk表示传感器测试获取数据，Mk-1表示第K-1时刻的局部地图，Rk 表示K时刻机器人的位姿。
SLAM问题包括四个基本方面
图5：机器人返回到初始位置 （此时机器人的位置相对于没有移动前更加不确定，一个超大的椭圆表示了其可能的真实位置值范围）
图6：对A点的重新测量 （通过对A的重新测量，图4中的超大椭圆值被大大的缩小了，其位置真值落入了一个比较小的范围内）
图7：对B点的重新测量
（通过对B的重新测量，机器人的位置点被重新估计，其位置真值范围又进一步缩小，同时B和C点的位置真值范围也大大缩小了）
SLAM的相关理论与关键技术(Theories and technologies of SLAM )
该领域所涉及的关键性问题可以归结为： (1) 地图的表示方式 (大致可分为3类:栅格表示、几何特征表示和拓扑图表示) (2) 不确定性信息处理方法------不确定性信息处理必须解决以下问题： · 在地图和位置的表示中，如何描述运动和感知信息的不确定性? · 在迭代过程中，如何处理旧信息与新信息的关系，连续更新地 图与位置? · 如何依据不确定的信息进行决策? (3) 数据的关联； (为了获得全局的环境地图和实现定位，还需要将不同时间、不同地 点的 感知信息进行匹配和联合，存在局部数据之间的关联问题，也存在局部数据 与全局数据的关联与匹配问题) (4) 自定位； (移动机器人的定位按照有无环境地图可以分为基于地图的定位和无地图的 定位) (5) 探索规划 (主要目的是提高地图创建的效率，使机器人在较短的时间内感知范围 覆盖尽可能大的区域，在这方面的研究成果较少)
说明：机器人在定位误差随着机器人的移动而增加。

说明：机器人在定位误差随着机器人的移动而增加，但是由于有了路标的纠正，其误差相对就小了很多。
说明：通过2次对路标的测定，其定位误差已经大大减少
说明：经过3次误差校正，其定位精度已经很好了，但是随着路标位置的丢失，其定位误差又一次的扩大了。
基于霍夫曼方法的SLAM的基本过程为：
SLAM（Simultaneous Localization And Mapping ）中文称 “同步定位及建图”
是目前在机器人定位方面的热门研究课题。到 目前为止，也取得了不少进展。
定位(localization): 机器人必须知道自己在
环境中位置。
建图(mapping): 机器人必须记录环境中特
对未知环境中移动机器人SLAM 问题的研究，这不仅有非常现实 的实用意义，也是对人工智能的 一个挑战。我们认为目前机器人 SLAM问题在以下几方面需进一 步研究：
· 更有效的环境的不确定性表示 尝试更多不同的度量方法在不 确定 性表示的不同层次、不同应 用对象上的结合。 · 三维环境特征的提取 · 多机器人协作完成SLAM问题 的总体解决方案
SLA M中定位与环境特征提取 移动机器人自定位与环境建模问题是紧密相关的。环境模型的准确性依赖于定位 精度，而定位的实现又离不开环境模型。在未知环境中，机器人没有什么参照物， 只能依靠自己并不十分准确的传感器来获取外界信息，如同一个盲人在一个陌生 环境中摸索的情况。这种情况下，定位是比较困难的。有地图的定位和有定位的 地图创建都是容易解决的，但无地图的定位和未解决定位的地图创建如同"鸡--蛋 "问题，无从下手。已有的研究中对这类问题的解决方法可分为两类：一类利用 自身携带的多种内部传感器(包括里程仪、罗盘、加速度计等)，通过多种传感信 息的融合减少定位的误差，使用的融合算法多为基于卡尔曼滤波的方法。这类方 法由于没有参考外部信息，在长时间的漫游后误差的积累会比较大。另一类方法 在依靠内部传感器估计自身运动的同时，使用外部传感器(如激光测距仪、视觉 等)感知环境，对获得的信息进行分析提取环境特征并保存，在下一步通过对环 境特征的比较对自身位置进行校正。但这种方法依赖于能够取得环境特征。 环境特征提取的方法有：(1)Hough transform是一类基于灰度图探察直线和其他 曲线的方法。该方法需要一簇能被搜索的预准备的特定曲线，并根据显示的灰度 图中一簇曲线产生曲线参数。(2)Clustering分析是一种数据探测工具，对于未分 类样例是有效的，同时，它的目标就是把所针对对象分组成自然类别或基于相似 性或距离的簇类。在被提取对象类别未知的情况中，簇技术是一类比Hough Transform更有效的技术。簇类应是以"凝聚"为中心，而不是支离破碎的、不相交 的。而环境特征有时是很难提取出的，例如： · 环境特征不够明显时； · 传感器信息比较少，难以从一次感知信息中获得环境特征。