第10卷第5期 智能系统学报 Vol.10 No.5 2015年10月 CAAI Transactions on Intelligent Systems 0ct.2015 D0I:10.11992/is.201403017 网s络出版t地址：htp:/ww.cmki.net/kcms/detail/23.1538.tp.20150930.1556.018.html 测距式传感器同时定位与地图创建综述 刘建华12，刘华平3，杨建国，高蒙2，孙富春3 (1.东华大学机械工程学院，上海201620：2.石家庄铁道大学电气与电子工程学院，河北石家庄050043：3.清华 大学智能技术与系统国家重点实验室，北京100084) 摘要：移动机器人的同时定位与地图创建(SLAM)是当前机器人领域中的热点问题，基于测距传感器SLAM实质 是距离信息的在线提取和描述，本文针对这一问题进行了详细介绍。此外，阐述了测距式机器人SLAM的解决思路、 关键技术和实现方法：重点探讨了扩展卡尔曼滤波(EKF)、粒子滤波(P℉)和矩阵奇异值分解(SVD)3种主要方法的 实现过程和存在的问题：对基于测距式的SLAM方法需要解决问题、完善的方面及研究前景进行了阐述。 关键词：移动机器人：测距：扩展卡尔曼滤波：粒子滤波：奇异值分解：同时定位与地图创建 中图分类号：TP24文献标志码：A文章编号：1673-4785(2015)05-0655-08 中文引用格式：刘建华，刘华平，杨建国，等.测距式传感器同时定位与地图创建综述[J].智能系统学报，2015,10(5)：655-662. 英文引用格式：LIUJianhua,LIU Huaping,YANG Jianguo,etal.A survey of range-only SLAM for mobile robots[J].CAAl Transactions on Intelligent Systems,2015,10(5):655-662. A survey of range-only SLAM for mobile robots LIU Jianhua'2,LIU Huaping3,YANG Jianguo',GAO Meng?,SUN Fuchun? (1.College of Mechanical Engineering,Donghua University,Shanghai 201620,China:2.College of Electrical and Electronic Engi- neering,Shijiazhuang Tiedao University,Shijiazhuang 050043,China;3.Key Laboratory of Intelligent Technology and Systems,Tsin- ghua University,Beijing 100084,China) Abstract:This paper details the research on simultaneous localization and mapping (SLAM)for mobile robots, currently a hot spot in robotics.The essence of range-only SLAM is online extraction and representation of range in- formation.The basic idea,key technology,and solution for range-only SLAM are discussed;then a performance comparison of the fundamental methods is made.Three of the most commonly used methods:Kalman filter,particle filter and singular value decomposition are discussed in detail,emphasizing the realization process and some practi- cal problems.Further research,on the problems,improvements,and development prospects for range-only SLAM, is discussed. Keywords:mobile robot;range-only;Kalman filter;particle filter:singular value decomposition:simultaneous lo- calization and mapping (SLAM) 同时定位与地图创建(simultaneous localization 计)。因此，机器人位姿估计和地图构建之间的相 and mapping,SLAM)是移动机器人研究领域中一个 互依赖使SLAM问题变得极富挑战性，需要在高维 关键技术)，是在未知环境中通过自定位过程获取 空间中搜索解决方法[)。 周围环境信息，并在行进过程中逐步构建周围环境 目前，国内外的研究重点侧重于基于特征地图 的增量式地图，同时不断地重复观测已构建的地图 的定位方法[)，即通过存储在地图中的环境特征与 来消除不确定因素，进而完成自身位姿的精确估 抽象所感知真实环境的特征是否匹配及相对于机器 人SLAM的位置来确定机器人的当前位姿，因此环 收稿日期：2014-03-05.网络出版日期：2015-09.30. 基金项目：国家高技术研究发展计划资助项目(2007AA04Z232):国 境地图的表示方式是否合适以及环境特征提取是否 家自然科学基金资助项目(61075027,91120011)：河北省 准确，直接影响环境特征匹配的效率，进而影响机器 自然科学基金资助项目(F2010001106,F2013210094) 通信作者：杨建国.E-mail:lfengju(@163.com 人定位和地图构建的准确性和实时性：测距传感器
第 １０ 卷第 ５ 期 智 能 系 统 学 报 Ｖｏｌ．１０ №．５ ２０１５ 年 １０ 月 ＣＡＡＩ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｉｎｔｅｌｌｉｇｅｎｔ Ｓｙｓｔｅｍｓ Ｏｃｔ． ２０１５ ＤＯＩ：１０．１１９９２ ／ ｔｉｓ．２０１４０３０１７ 网络出版地址：ｈｔｔｐ： ／ ／ ｗｗｗ．ｃｎｋｉ．ｎｅｔ ／ ｋｃｍｓ／ ｄｅｔａｉｌ ／ ２３．１５３８．ｔｐ．２０１５０９３０．１５５６．０１８．ｈｔｍｌ 测距式传感器同时定位与地图创建综述 刘建华１，２ ，刘华平３ ，杨建国１ ，高蒙２ ，孙富春３ （１． 东华大学 机械工程学院，上海 ２０１６２０； ２． 石家庄铁道大学 电气与电子工程学院，河北 石家庄 ０５００４３； ３． 清华 大学 智能技术与系统国家重点实验室，北京 １０００８４） 摘 要：移动机器人的同时定位与地图创建（ＳＬＡＭ）是当前机器人领域中的热点问题，基于测距传感器 ＳＬＡＭ 实质 是距离信息的在线提取和描述，本文针对这一问题进行了详细介绍。 此外，阐述了测距式机器人 ＳＬＡＭ 的解决思路、 关键技术和实现方法；重点探讨了扩展卡尔曼滤波（ＥＫＦ）、粒子滤波（ＰＦ）和矩阵奇异值分解（ ＳＶＤ）３ 种主要方法的 实现过程和存在的问题；对基于测距式的 ＳＬＡＭ 方法需要解决问题、完善的方面及研究前景进行了阐述。 关键词：移动机器人；测距；扩展卡尔曼滤波；粒子滤波；奇异值分解；同时定位与地图创建 中图分类号：ＴＰ２４ 文献标志码：Ａ 文章编号：１６７３⁃４７８５（２０１５）０５⁃０６５５⁃０８ 中文引用格式：刘建华，刘华平，杨建国，等． 测距式传感器同时定位与地图创建综述［Ｊ］． 智能系统学报， ２０１５， １０（５）： ６５５⁃６６２． 英文引用格式：ＬＩＵ Ｊｉａｎｈｕａ， ＬＩＵ Ｈｕａｐｉｎｇ， ＹＡＮＧ Ｊｉａｎｇｕｏ， ｅｔ ａｌ． Ａ ｓｕｒｖｅｙ ｏｆ ｒａｎｇｅ⁃ｏｎｌｙ ＳＬＡＭ ｆｏｒ ｍｏｂｉｌｅ ｒｏｂｏｔｓ［ Ｊ］． ＣＡＡＩ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｉｎｔｅｌｌｉｇｅｎｔ Ｓｙｓｔｅｍｓ， ２０１５， １０（５）： ６５５⁃６６２． Ａ ｓｕｒｖｅｙ ｏｆ ｒａｎｇｅ⁃ｏｎｌｙ ＳＬＡＭ ｆｏｒ ｍｏｂｉｌｅ ｒｏｂｏｔｓ ＬＩＵ Ｊｉａｎｈｕａ １，２ ， ＬＩＵ Ｈｕａｐｉｎｇ ３ ， ＹＡＮＧ Ｊｉａｎｇｕｏ １ ， ＧＡＯ Ｍｅｎｇ ２ ， ＳＵＮ Ｆｕｃｈｕｎ ３ （１． Ｃｏｌｌｅｇｅ ｏｆ Ｍｅｃｈａｎｉｃａｌ Ｅｎｇｉｎｅｅｒｉｎｇ， Ｄｏｎｇｈｕａ Ｕｎｉｖｅｒｓｉｔｙ， Ｓｈａｎｇｈａｉ ２０１６２０， Ｃｈｉｎａ； ２． Ｃｏｌｌｅｇｅ ｏｆ Ｅｌｅｃｔｒｉｃａｌ ａｎｄ Ｅｌｅｃｔｒｏｎｉｃ Ｅｎｇｉ⁃ ｎｅｅｒｉｎｇ， Ｓｈｉｊｉａｚｈｕａｎｇ Ｔｉｅｄａｏ Ｕｎｉｖｅｒｓｉｔｙ， Ｓｈｉｊｉａｚｈｕａｎｇ ０５００４３， Ｃｈｉｎａ； ３． Ｋｅｙ Ｌａｂｏｒａｔｏｒｙ ｏｆ Ｉｎｔｅｌｌｉｇｅｎｔ Ｔｅｃｈｎｏｌｏｇｙ ａｎｄ Ｓｙｓｔｅｍｓ， Ｔｓｉｎ⁃ ｇｈｕａ Ｕｎｉｖｅｒｓｉｔｙ， Ｂｅｉｊｉｎｇ １０００８４， Ｃｈｉｎａ） Ａｂｓｔｒａｃｔ：Ｔｈｉｓ ｐａｐｅｒ ｄｅｔａｉｌｓ ｔｈｅ ｒｅｓｅａｒｃｈ ｏｎ ｓｉｍｕｌｔａｎｅｏｕｓ ｌｏｃａｌｉｚａｔｉｏｎ ａｎｄ ｍａｐｐｉｎｇ （ ＳＬＡＭ） ｆｏｒ ｍｏｂｉｌｅ ｒｏｂｏｔｓ， ｃｕｒｒｅｎｔｌｙ ａ ｈｏｔ ｓｐｏｔ ｉｎ ｒｏｂｏｔｉｃｓ． Ｔｈｅ ｅｓｓｅｎｃｅ ｏｆ ｒａｎｇｅ⁃ｏｎｌｙ ＳＬＡＭ ｉｓ ｏｎｌｉｎｅ ｅｘｔｒａｃｔｉｏｎ ａｎｄ ｒｅｐｒｅｓｅｎｔａｔｉｏｎ ｏｆ ｒａｎｇｅ ｉｎ⁃ ｆｏｒｍａｔｉｏｎ． Ｔｈｅ ｂａｓｉｃ ｉｄｅａ， ｋｅｙ ｔｅｃｈｎｏｌｏｇｙ， ａｎｄ ｓｏｌｕｔｉｏｎ ｆｏｒ ｒａｎｇｅ⁃ｏｎｌｙ ＳＬＡＭ ａｒｅ ｄｉｓｃｕｓｓｅｄ； ｔｈｅｎ ａ ｐｅｒｆｏｒｍａｎｃｅ ｃｏｍｐａｒｉｓｏｎ ｏｆ ｔｈｅ ｆｕｎｄａｍｅｎｔａｌ ｍｅｔｈｏｄｓ ｉｓ ｍａｄｅ． Ｔｈｒｅｅ ｏｆ ｔｈｅ ｍｏｓｔ ｃｏｍｍｏｎｌｙ ｕｓｅｄ ｍｅｔｈｏｄｓ： Ｋａｌｍａｎ ｆｉｌｔｅｒ， ｐａｒｔｉｃｌｅ ｆｉｌｔｅｒ ａｎｄ ｓｉｎｇｕｌａｒ ｖａｌｕｅ ｄｅｃｏｍｐｏｓｉｔｉｏｎ ａｒｅ ｄｉｓｃｕｓｓｅｄ ｉｎ ｄｅｔａｉｌ， ｅｍｐｈａｓｉｚｉｎｇ ｔｈｅ ｒｅａｌｉｚａｔｉｏｎ ｐｒｏｃｅｓｓ ａｎｄ ｓｏｍｅ ｐｒａｃｔｉ⁃ ｃａｌ ｐｒｏｂｌｅｍｓ． Ｆｕｒｔｈｅｒ ｒｅｓｅａｒｃｈ， ｏｎ ｔｈｅ ｐｒｏｂｌｅｍｓ， ｉｍｐｒｏｖｅｍｅｎｔｓ， ａｎｄ ｄｅｖｅｌｏｐｍｅｎｔ ｐｒｏｓｐｅｃｔｓ ｆｏｒ ｒａｎｇｅ⁃ｏｎｌｙ ＳＬＡＭ， ｉｓ ｄｉｓｃｕｓｓｅｄ． Ｋｅｙｗｏｒｄｓ：ｍｏｂｉｌｅ ｒｏｂｏｔ； ｒａｎｇｅ⁃ｏｎｌｙ； Ｋａｌｍａｎ ｆｉｌｔｅｒ； ｐａｒｔｉｃｌｅ ｆｉｌｔｅｒ； ｓｉｎｇｕｌａｒ ｖａｌｕｅ ｄｅｃｏｍｐｏｓｉｔｉｏｎ； ｓｉｍｕｌｔａｎｅｏｕｓ ｌｏ⁃ ｃａｌｉｚａｔｉｏｎ ａｎｄ ｍａｐｐｉｎｇ （ＳＬＡＭ） 收稿日期：２０１４⁃０３⁃０５． 网络出版日期：２０１５⁃０９⁃３０． 基金项目：国家高技术研究发展计划资助项目（ ２００７ＡＡ０４Ｚ２３２）；国 家自然科学基金资助项目（ ６１０７５０２７，９１１２００１１）；河北省 自然科学基金资助项目（Ｆ２０１０００１１０６，Ｆ２０１３２１００９４）． 通信作者：杨建国． Ｅ⁃ｍａｉｌ：ｌｆｅｎｇｊｕ＠ １６３．ｃｏｍ． 同时定位与地图创建（ ｓｉｍｕｌｔａｎｅｏｕｓ ｌｏｃａｌｉｚａｔｉｏｎ ａｎｄ ｍａｐｐｉｎｇ，ＳＬＡＭ）是移动机器人研究领域中一个 关键技术［１］ ，是在未知环境中通过自定位过程获取 周围环境信息，并在行进过程中逐步构建周围环境 的增量式地图，同时不断地重复观测已构建的地图 来消除不确定因素，进而完成自身位姿的精确估 计［２］ 。 因此，机器人位姿估计和地图构建之间的相 互依赖使 ＳＬＡＭ 问题变得极富挑战性，需要在高维 空间中搜索解决方法［３］ 。 目前，国内外的研究重点侧重于基于特征地图 的定位方法［４］ ，即通过存储在地图中的环境特征与 抽象所感知真实环境的特征是否匹配及相对于机器 人 ＳＬＡＭ 的位置来确定机器人的当前位姿，因此环 境地图的表示方式是否合适以及环境特征提取是否 准确，直接影响环境特征匹配的效率，进而影响机器 人定位和地图构建的准确性和实时性；测距传感器
·656 智能系统学报 第10卷 由于具有数据处理简单、实时性高和鲁棒性好等优 定位：此外，根据机器人所在环境的特点，提取具有 点，得到了广泛的应用；基于测距式传感器的机器人 独特信息的特征作为路标信息，文献[10-12]提取环 定位和地图构建的基本思想是通过融合传感器信 境中圆作为定位路标信息，文献[6]提取环境中矩 息，把自身与参照点（如障碍物、环境特征等）及其 形特征作为定位路标信息。随着环境的复杂性越来 相互关系的距离信息和方位信息在线抽象描述为全 越高，对环境二维建模不能满足需要，文献[13-14] 局地图信息。 等提取环境三维特征作为定位路标信息。栅格地图 基于测距式传感器机器人SLAM主要从3方面 模型是根据测距传感器的原始数据获得障碍物占据 考虑：环境特征的提取方法、地图的表示方式和解决 栅格情况，从而构建环境地图】。 SLAM问题的核心算法[]。本文总结目前流行的基 测距式传感器采集真实环境的数据是点的集 于测距式传感器的SLAM方法，从以上3方面进行 合，如何对这些离散的点处理获得环境的抽象描述， 了归类和比较，指出需要解决的关键问题，并根据已 即局部地图，很多文献采用了Hough变换的方法进 有的研究成果提出未来的研究方向。 行局部地图的构建，但其计算量非常大，很难保证局 部地图构建实时性的要求，文献[15]比较详细地分 1典型传感器类型及其作用 析比较了11种数据点提取特征直线的算法，其中以 根据机器人所携带传感器在SLAM系统中的主 数据分割拟合(split--and-merge)算法较优，因此该算 要作用，传感器大致可分为两大类，一类是本体传感 法得到了广泛应用：此后，研究者在分析总结上述算 器（也称内部传感器），如里程计、陀螺仪、指南针、 法的基础上，对这些算法做了改进，也提出了很多不 同的特征提取算法，如文献[16]通过建立角点函数 速度或加速度计等：另一类是外部传感器，如激光雷 达、超声波、红外线、微波雷达、kinect'),机器人通过 来衡量扫描点是角点特征的程度，利用非极大值抑 外部传感器可以获得真实环境特征的抽象描述及距 制方法去除干扰信息来提取环境的角点特征，文献 [l7]根据split-and-merge算法思想，采用模糊聚类 离信息或图像深度信息。基于测距式的SLAM主要 算法分割数据，利用最小二乘法拟合。 框架是采用本体传感器和外部传感器相融合的定位 直线参数使线段分割的鲁棒性和线段提取的精 方法，利用本体传感器来实现机器人航迹推算，通过 度得到了很大提高，也显著提高了算法效率。此外， 外部传感器（一种或多种）抽象获得的外部环境特 有研究者将比较成熟的优化算法应用到环境特征的 征及其距离信息与已构建环境地图的特征匹配，消 提取，如文献[18]将自组织竞争学习神经网络(slf 除航迹推算的累积误差，获得当前机器人的位姿偏 organizing feature mapping,SOM)方法用于激光雷达 差，并不断修正机器人自身位姿，构建增量式的环境 数据的处理，提取更加精确的环境线段、角点等特 地图。 征，提高了算法的计算效率以及分类性能得到进一 2环境模型及测距式传感器特征提取 步的提高。也有研究者采用卡尔曼滤波对环境的线 段等特征进行提取，不仅对线段特征的误差标准等 真实环境的抽象描述也称为地图构建，即用点 概率特性进行较好地描述和更新，而且受传感器的 和线或栅格的集合近似表达真实环境，是将真实环 非线性影响也较小。 境中连续场景表示成2-D区段，是移动机器人 SLAM的一个重要环节6)。地图中环境特征表征 3基于测距式传感器SLAM常用方法 的准确与否直接影响机器人定位和构建地图的精确 目前，未知环境中机器人利用测距式传感器的 性，因此环境特征的表示要注重特征的鲁棒性和稳 距离信息完成SLAM任务，其基本思想是通过寻找 定性。测距式传感器SALM的环境模型主要有2 当前局部环境地图与已获得的增量式全局环境地图 类，基于特征的地图和密集型地图（栅格地图），前 间的对应关系，减少航迹推算误差造成的移动机器 者主要应用于稀疏障碍物或结构化环境，将环境特 人定位的不确定性9)，获得尽可能精确的机器人当 征作为路标信息，后者主要应用于非结构化环境。 前位姿信息，完备全局环境地图。目前主要方法可 在平面坐标系中机器人根据2条相交的直线就可以 分为基于贝叶斯理论的概率推理定位算法和基于矩 完成自定位，由于环境中存在诸如角、线的特征较 阵分解的定位算法两大类。前者把概率理论应用到 多，而从测距式传感器检测到的原始数据中提取这 移动机器人定位过程中，即在机器人每个可能的位 些特征相对容易，其存储与匹配也简洁方便，因此采 置设置一种概率值，根据机器人运动过程中测距式 用角、线描述环境成为机器人SLAM问题中最常用 传感器感知到的新环境距离信息更新机器人可能位 的特征描述方式。针对缺少角、线特征的环境，文献 置的概率值，从而减少机器人位置不确定性。其实 [6,8-9]通过提取天花板的角、线特征来完成机器人 质是把移动机器人SLAM问题认为是贝叶斯评估过
由于具有数据处理简单、实时性高和鲁棒性好等优 点，得到了广泛的应用；基于测距式传感器的机器人 定位和地图构建的基本思想是通过融合传感器信 息，把自身与参照点（如障碍物、环境特征等） 及其 相互关系的距离信息和方位信息在线抽象描述为全 局地图信息。 基于测距式传感器机器人 ＳＬＡＭ 主要从 ３ 方面 考虑：环境特征的提取方法、地图的表示方式和解决 ＳＬＡＭ 问题的核心算法［２］ 。 本文总结目前流行的基 于测距式传感器的 ＳＬＡＭ 方法，从以上 ３ 方面进行 了归类和比较，指出需要解决的关键问题，并根据已 有的研究成果提出未来的研究方向。 １ 典型传感器类型及其作用 根据机器人所携带传感器在 ＳＬＡＭ 系统中的主 要作用，传感器大致可分为两大类，一类是本体传感 器（也称内部传感器），如里程计、陀螺仪、指南针、 速度或加速度计等；另一类是外部传感器，如激光雷 达、超声波、红外线、微波雷达、ｋｉｎｅｃｔ ［５］ ，机器人通过 外部传感器可以获得真实环境特征的抽象描述及距 离信息或图像深度信息。 基于测距式的 ＳＬＡＭ 主要 框架是采用本体传感器和外部传感器相融合的定位 方法，利用本体传感器来实现机器人航迹推算，通过 外部传感器（一种或多种）抽象获得的外部环境特 征及其距离信息与已构建环境地图的特征匹配，消 除航迹推算的累积误差，获得当前机器人的位姿偏 差，并不断修正机器人自身位姿，构建增量式的环境 地图。 ２ 环境模型及测距式传感器特征提取 真实环境的抽象描述也称为地图构建，即用点 和线或栅格的集合近似表达真实环境，是将真实环 境中连 续 场 景 表 示 成 ２⁃Ｄ 区 段， 是 移 动 机 器 人 ＳＬＡＭ 的一个重要环节［６⁃７］ 。 地图中环境特征表征 的准确与否直接影响机器人定位和构建地图的精确 性，因此环境特征的表示要注重特征的鲁棒性和稳 定性。 测距式传感器 ＳＡＬＭ 的环境模型主要有 ２ 类，基于特征的地图和密集型地图（栅格地图），前 者主要应用于稀疏障碍物或结构化环境，将环境特 征作为路标信息，后者主要应用于非结构化环境。 在平面坐标系中机器人根据 ２ 条相交的直线就可以 完成自定位，由于环境中存在诸如角、线的特征较 多，而从测距式传感器检测到的原始数据中提取这 些特征相对容易，其存储与匹配也简洁方便，因此采 用角、线描述环境成为机器人 ＳＬＡＭ 问题中最常用 的特征描述方式。 针对缺少角、线特征的环境，文献 ［６，８⁃９］通过提取天花板的角、线特征来完成机器人 定位；此外，根据机器人所在环境的特点，提取具有 独特信息的特征作为路标信息，文献［１０⁃１２］提取环 境中圆作为定位路标信息，文献［６］提取环境中矩 形特征作为定位路标信息。 随着环境的复杂性越来 越高，对环境二维建模不能满足需要，文献［１３⁃１４］ 等提取环境三维特征作为定位路标信息。 栅格地图 模型是根据测距传感器的原始数据获得障碍物占据 栅格情况，从而构建环境地图［２］ 。 测距式传感器采集真实环境的数据是点的集 合，如何对这些离散的点处理获得环境的抽象描述， 即局部地图，很多文献采用了 Ｈｏｕｇｈ 变换的方法进 行局部地图的构建，但其计算量非常大，很难保证局 部地图构建实时性的要求，文献［１５］比较详细地分 析比较了 １１ 种数据点提取特征直线的算法，其中以 数据分割拟合（ｓｐｌｉｔ⁃ａｎｄ⁃ｍｅｒｇｅ）算法较优，因此该算 法得到了广泛应用；此后，研究者在分析总结上述算 法的基础上，对这些算法做了改进，也提出了很多不 同的特征提取算法，如文献［１６］通过建立角点函数 来衡量扫描点是角点特征的程度，利用非极大值抑 制方法去除干扰信息来提取环境的角点特征，文献 ［１７］根据 ｓｐｌｉｔ⁃ａｎｄ⁃ｍｅｒｇｅ 算法思想，采用模糊聚类 算法分割数据，利用最小二乘法拟合。 直线参数使线段分割的鲁棒性和线段提取的精 度得到了很大提高，也显著提高了算法效率。 此外， 有研究者将比较成熟的优化算法应用到环境特征的 提取，如文献［１８］将自组织竞争学习神经网络（ｓｅｌｆ⁃ ｏｒｇａｎｉｚｉｎｇ ｆｅａｔｕｒｅ ｍａｐｐｉｎｇ，ＳＯＭ）方法用于激光雷达 数据的处理，提取更加精确的环境线段、角点等特 征，提高了算法的计算效率以及分类性能得到进一 步的提高。 也有研究者采用卡尔曼滤波对环境的线 段等特征进行提取，不仅对线段特征的误差标准等 概率特性进行较好地描述和更新，而且受传感器的 非线性影响也较小。 ３ 基于测距式传感器 ＳＬＡＭ 常用方法 目前，未知环境中机器人利用测距式传感器的 距离信息完成 ＳＬＡＭ 任务，其基本思想是通过寻找 当前局部环境地图与已获得的增量式全局环境地图 间的对应关系，减少航迹推算误差造成的移动机器 人定位的不确定性［１９］ ，获得尽可能精确的机器人当 前位姿信息，完备全局环境地图。 目前主要方法可 分为基于贝叶斯理论的概率推理定位算法和基于矩 阵分解的定位算法两大类。 前者把概率理论应用到 移动机器人定位过程中，即在机器人每个可能的位 置设置一种概率值，根据机器人运动过程中测距式 传感器感知到的新环境距离信息更新机器人可能位 置的概率值，从而减少机器人位置不确定性。 其实 质是把移动机器人 ＳＬＡＭ 问题认为是贝叶斯评估过 ·６５６· 智 能 系 统 学 报 第 １０ 卷
第5期 刘建华，等：测距式传感器同时定位与地图创建综述 ·657 程，通过融合内部传感器输入数据和外部传感器观 大：文献[22]针对EKF中观测噪声方差估计不准确 测数据，完成移动机器人隐式位姿的预测及更新，使 导致滤波器性能下降甚至发散的问题，将模糊卡尔 其隐式位姿状态信度达到最优。比较典型的方法 曼滤波技术应用于基于声呐的移动机器人的定位 有：基于扩展卡尔曼滤波(extended kalman filter, 中，提出了根据信息方差理论值和实际值的一致程 EKF)和基于粒子滤波(particle filter,PF)SLAM。 度在线调整观测噪声方差的自适应调节算法，解决 后者通过分析数据矩阵的特点，把矩阵分解出能反 了系统观测噪声水平不确定的问题，其性能优于 映原矩阵的某些特征的因式矩阵，通过回归计算因 EKF;文献[23]在光电系统中利用差分方式实现非 式矩阵获得当前机器人的位姿和环境信息，完成 线性函数线性化的EKF算法，这种方法无需计算复 SLAM任务。 杂的雅克比阵，且能得到更好的定位跟踪精度：文献 3.1基于EKF的SLAM定位方法 [2,24]提出将随机梯度下降法引入SLAM问题，达 EKF是将非线性模型（运动模型和观测模型） 到最小化系统非线性误差的影响，但是系统的收敛 在状态向量的邻域内泰勒展开，并取其一阶或二阶 速度变慢了。 项近似表示机器人的运动模型与观测模型。该方法 基于扩展的卡尔曼滤波器方法得到机器人领域 的基本思想是通过对包含移动机器人与环境特征之 广泛地接受，但随着SLAM问题研究的深入，出现了 间的关系以及机器人运动模型、观测模型不确定性 计算复杂度和数据关联问题，即缺陷二。协方差阵 信息的雅可比矩阵的迭代过程，完成误差协方差矩 的引入是EKF的最大特点，对协方差阵的计算也是 阵和增益矩阵的递推计算。正常情况下，雅可比矩 该算法的核心。当环境中的不确定因素和环境特征 阵是单调递减且收敛的，因此，对雅可比矩阵的处理 增加时，协方差阵的元素平方级增加，计算量复杂度 是EKF的核心。 为0(K)(K为特征数目)[2，即使在某一刻只观 基于扩展卡尔曼滤波器的SLAM方法是通过增 测到一个特征，整个协方差阵元素都必须更新，计算 量评估移动机器人位姿和环境特征位置的联合后验 量急剧增加。此外，机器人与环境特征及环境特征 概率来估计机器人位姿和构建地图，是一个循环迭 与环境特征之间的交叉相关性进一步增加了计算复 代地估计与校正过程。即机器人根据运动模型估计 杂度。文献[26]采用FPGA技术和并行处理流程 其新位置，根据机器人观测模型估计其可能观测到 完成多个特征同时匹配过程，提高了特征匹配效率； 的环境特征的距离信息：计算估计的观测值间与实 文献[27]采用表示环境特征之间相对位置的相对 际的观测值之间的误差，利用协方差计算卡尔曼滤 地图代替绝对地图，解决了环境特征之间的相关问 波增益参数，并利用该参数对机器人的估计位置校 题：文献[28]用稀疏化信息矩阵代替协方差矩阵， 正：将新观测到的环境特征信息加入地图，逐步完成 即稀疏扩展信息滤波方法，使更新时间变为常数，不 增量式环境地图的构建。在估计与校正过程中若系 随特征的增加而增加。 统状态的协方差较大，侧用观测值校正，使系统偏差 另外，基于EKF的SLAM算法存在2个较难解 变小：若观测协方差较大，则认为观测值不可靠，对 决的问题：1)假设观测量与环境特征的数据关联为 观测值做轻微校正20)。 已知，即认为它们之间必存在数据关联，一旦观测值 以EKF理论为基础的SLAM的方法存在一些 和环境特征之间出现微小的关联错误，将会导致 固有的缺陷。缺陷一是非线性误差的存在)，由于 EKF滤波器发散而使SLAM过程失败。2)机器人 EKF算法在估计点处通过泰勒展开式对非线性系 状态向量无法表征机器人的历史路径，无法解耦地 统进行局部线性化，舍去了高阶项，虽然简化了问 图信息与机器人状态的关系，当环境地图增大时导 题，但使系统产生了截断误差。如系统非线性程度 致计算量急剧增大。因此，该方法不适合大规模环 较高时，由于系统无法满足上述线性化假设而产生 境和动态环境的SLAM。 很大的误差，从而造成系统不收敛的严重后果，因而 目前，在EKF的SLAM方法的基础上，提出了 基于EKF的SLAM的精度和鲁棒性受到影响。针 一些改进算法，如无迹变换的UKF-SLAM、容积卡尔 对EKF线性化存在的误差，研究者在如何提高 曼滤波SLAM、平方根容积卡尔曼滤波SLAM等。 SLAM问题的精度上展开了研究，提出了许多改进 通过不同的方法获得SLAM的后验概率密度，提高 算法。如文献[21]提出迭代扩展卡尔曼滤波算法 了定位精度。 (iterated extended Kalman filter,IEKF),结合微光雷 3.2基于PF的SLAM定位方法 达传感器采集的外部环境特征信息，在测量更新阶 P℉是20世纪90年代中后期发展起来的一种 段多次迭代滤波估计值，从而减少由于泰勒展开局 比较新的滤波算法。文献[29]将P℉与机器人运动 部线性化带来的截断误差，提高了SLAM的定位精 及感知的概率模型相结合，提出了P℉的定位方法； 度，但是其缺点是由于迭代次数的增加，计算量会增 其主要思想是用多个滤波器来估计机器人的各个可
程，通过融合内部传感器输入数据和外部传感器观 测数据，完成移动机器人隐式位姿的预测及更新，使 其隐式位姿状态信度达到最优。 比较典型的方法 有：基于扩展卡尔曼滤波 （ ｅｘｔｅｎｄｅｄ ｋａｌｍａｎ ｆｉｌｔｅｒ， ＥＫＦ） 和基于粒子滤波（ ｐａｒｔｉｃｌｅ ｆｉｌｔｅｒ， ＰＦ） ＳＬＡＭ。 后者通过分析数据矩阵的特点，把矩阵分解出能反 映原矩阵的某些特征的因式矩阵，通过回归计算因 式矩阵获得当前机器人的位姿和环境信息，完成 ＳＬＡＭ 任务。 ３．１ 基于 ＥＫＦ 的 ＳＬＡＭ 定位方法 ＥＫＦ 是将非线性模型（运动模型和观测模型） 在状态向量的邻域内泰勒展开，并取其一阶或二阶 项近似表示机器人的运动模型与观测模型。 该方法 的基本思想是通过对包含移动机器人与环境特征之 间的关系以及机器人运动模型、观测模型不确定性 信息的雅可比矩阵的迭代过程，完成误差协方差矩 阵和增益矩阵的递推计算。 正常情况下，雅可比矩 阵是单调递减且收敛的，因此，对雅可比矩阵的处理 是 ＥＫＦ 的核心。 基于扩展卡尔曼滤波器的 ＳＬＡＭ 方法是通过增 量评估移动机器人位姿和环境特征位置的联合后验 概率来估计机器人位姿和构建地图，是一个循环迭 代地估计与校正过程。 即机器人根据运动模型估计 其新位置，根据机器人观测模型估计其可能观测到 的环境特征的距离信息；计算估计的观测值间与实 际的观测值之间的误差，利用协方差计算卡尔曼滤 波增益参数，并利用该参数对机器人的估计位置校 正；将新观测到的环境特征信息加入地图，逐步完成 增量式环境地图的构建。 在估计与校正过程中若系 统状态的协方差较大，则用观测值校正，使系统偏差 变小；若观测协方差较大，则认为观测值不可靠，对 观测值做轻微校正［２０］ 。 以 ＥＫＦ 理论为基础的 ＳＬＡＭ 的方法存在一些 固有的缺陷。 缺陷一是非线性误差的存在［２］ ，由于 ＥＫＦ 算法在估计点处通过泰勒展开式对非线性系 统进行局部线性化，舍去了高阶项，虽然简化了问 题，但使系统产生了截断误差。 如系统非线性程度 较高时，由于系统无法满足上述线性化假设而产生 很大的误差，从而造成系统不收敛的严重后果，因而 基于 ＥＫＦ 的 ＳＬＡＭ 的精度和鲁棒性受到影响。 针 对 ＥＫＦ 线性化存在的误差， 研究者在如何提高 ＳＬＡＭ 问题的精度上展开了研究，提出了许多改进 算法。 如文献［２１］提出迭代扩展卡尔曼滤波算法 （ｉｔｅｒａｔｅｄ ｅｘｔｅｎｄｅｄ Ｋａｌｍａｎ ｆｉｌｔｅｒ，ＩＥＫＦ），结合激光雷 达传感器采集的外部环境特征信息，在测量更新阶 段多次迭代滤波估计值，从而减少由于泰勒展开局 部线性化带来的截断误差，提高了 ＳＬＡＭ 的定位精 度，但是其缺点是由于迭代次数的增加，计算量会增 大；文献［２２］针对 ＥＫＦ 中观测噪声方差估计不准确 导致滤波器性能下降甚至发散的问题，将模糊卡尔 曼滤波技术应用于基于声呐的移动机器人的定位 中，提出了根据信息方差理论值和实际值的一致程 度在线调整观测噪声方差的自适应调节算法，解决 了系统观测噪声水平不确定的问题，其性能优于 ＥＫＦ；文献［２３］在光电系统中利用差分方式实现非 线性函数线性化的 ＥＫＦ 算法，这种方法无需计算复 杂的雅克比阵，且能得到更好的定位跟踪精度；文献 ［２，２４］提出将随机梯度下降法引入 ＳＬＡＭ 问题，达 到最小化系统非线性误差的影响，但是系统的收敛 速度变慢了。 基于扩展的卡尔曼滤波器方法得到机器人领域 广泛地接受，但随着 ＳＬＡＭ 问题研究的深入，出现了 计算复杂度和数据关联问题，即缺陷二。 协方差阵 的引入是 ＥＫＦ 的最大特点，对协方差阵的计算也是 该算法的核心。 当环境中的不确定因素和环境特征 增加时，协方差阵的元素平方级增加，计算量复杂度 为 Ｏ（Ｋ ２ ） （ Ｋ 为特征数目） ［２５］ ，即使在某一刻只观 测到一个特征，整个协方差阵元素都必须更新，计算 量急剧增加。 此外，机器人与环境特征及环境特征 与环境特征之间的交叉相关性进一步增加了计算复 杂度。 文献［２６］ 采用 ＦＰＧＡ 技术和并行处理流程 完成多个特征同时匹配过程，提高了特征匹配效率； 文献［２７］采用表示环境特征之间相对位置的相对 地图代替绝对地图，解决了环境特征之间的相关问 题；文献［２８］用稀疏化信息矩阵代替协方差矩阵， 即稀疏扩展信息滤波方法，使更新时间变为常数，不 随特征的增加而增加。 另外，基于 ＥＫＦ 的 ＳＬＡＭ 算法存在 ２ 个较难解 决的问题：１）假设观测量与环境特征的数据关联为 已知，即认为它们之间必存在数据关联，一旦观测值 和环境特征之间出现微小的关联错误，将会导致 ＥＫＦ 滤波器发散而使 ＳＬＡＭ 过程失败。 ２） 机器人 状态向量无法表征机器人的历史路径，无法解耦地 图信息与机器人状态的关系，当环境地图增大时导 致计算量急剧增大。 因此，该方法不适合大规模环 境和动态环境的 ＳＬＡＭ。 目前，在 ＥＫＦ 的 ＳＬＡＭ 方法的基础上，提出了 一些改进算法，如无迹变换的 ＵＫＦ⁃ＳＬＡＭ、容积卡尔 曼滤波 ＳＬＡＭ、平方根容积卡尔曼滤波 ＳＬＡＭ 等。 通过不同的方法获得 ＳＬＡＭ 的后验概率密度，提高 了定位精度。 ３．２ 基于 ＰＦ 的 ＳＬＡＭ 定位方法 ＰＦ 是 ２０ 世纪 ９０ 年代中后期发展起来的一种 比较新的滤波算法。 文献［２９］将 ＰＦ 与机器人运动 及感知的概率模型相结合，提出了 ＰＦ 的定位方法； 其主要思想是用多个滤波器来估计机器人的各个可 第 ５ 期 刘建华，等：测距式传感器同时定位与地图创建综述 ·６５７·
·658 智能系统学报 第10卷 能位置的概率，利用观测对每个滤波器进行加权处 的行进轨迹，利用观侧值计算各个粒子的权重。具 理，使机器人最有可能位置的概率越来越大[0。在 体到每个粒子，机器人的行进轨迹是确定的，环境特 实际应用中，基于PF的SLAM方法是用一组相关 征标志之间相互独立，特征标志的观测信息仅与机 权重的随机样本集合，以及基于这些样本的估计来 器人的位姿有关。每个粒子采用N个卡尔曼滤波 近似表征后验概率密度函数，采用样本均值代替积 器分别估计地图中N个特征的位置。对于 分运算来获得状态最小方差估计的过程。 FastSLAM算法的复杂度，如果采用K个粒子实现 SLAM主要任务是位姿估计和地图构建，2者之 SLAM,总共有KN个卡尔曼滤波器，其复杂度为 间又存在相互依赖的关系，这使基于PF的SLAM O(KN),利用一些算法（如树型数据结构）进行优 问题变得非常复杂。文献[31]提出了SLAM问题 化，其复杂度可以进一步减小到O(KogN)2)。针 的一种有效解决方案，即后验概率估计的处理方法， 对数据关联错误，通过减小该粒子的权重来降低关 其基本思想是通过Rao-Blackwellized将SLAM问题 联错误对定位的影响[3]。FastSLAM方法的另一个 分解为轨迹估计过程与地图估计过程。先用粒子滤 优点是相比较于卡尔曼滤波定位方法，可以较好地 波器估计移动机器人的运动轨迹，再用卡尔曼滤波 解决机器人的非线性和非高斯运动问题。 估计环境地图，从而将SLAM问题转化为低维估计 以PF为理论基础的FastSLAM算法， 问题[32.3 FastSLAM1.0和FastSLAM2.0有2个版本。 p(s,m|z14,山1-1）=p(s1|4,u1-1） FastsLAM1.0用粒子滤波器估计移动机器人位姿，用 p(m1之14,41-1)=p(s1114,山1t-1)p(m|5141） EKF估计环境特征。但其直接把SLAM过程模型作 式中：s,为移动机器人轨迹，山1-1为里程计测量， 为采样粒子重要性函数，从重要性函数抽取的样本 m为观测z1,得到的地图。 不能准确表达真实的后验概率密度函数，当环境观 在已知s,和的条件下，可以得到地图的后 测值噪声较小时，易造成严重的样本退化问题和定 验概率p(mlsa,it),而建图的Rao-Blackweiiized 位精度下降。FatSLAM2.0用EKF递归估计机器人 通过P℉方法得到机器人潜在轨迹的后验概率 位姿，构建融入机器人前期位姿信息的高斯分布函 数为重要函数，缓解了样本退化问题，提高了算法的 p(s1114,山1-1)，并为每个粒子分配一个合适的 精度。针对测距式传感器，如激光雷达，影响粒子滤 “粒子地图”，该地图是在给定了由相应粒子所表示 波器性能主要因素是建议分布的选择和选择性采 的s1和1条件下建立；换言之，机器人在未知环 境中循环运行一圈，每个粒子都估计机器人的轨迹， 样。由于激光扫描仪的精度导致了峰值很高的似然 函数，与大部分粒子滤波器选用里程计运动模型 并相应保留一个“粒子地图”，该地图根据轨迹估计 不断更新，即根据已知位姿构建地图。 p(s,Is-1,山，-1)为建议分布不同，其选用高斯建议 分布。这样既考虑了最近观测数据，也为高效采样 常用的Rao-Blackweiiized粒子滤波器建图过程 提供了可能，其结果比用里程计运动模型更具有确 主要有以下4个步骤： 定性)。在重采样过程中，低权值粒子被高权值粒 1)采样，子代粒子是从当前粒子中根据建议分 子代替，这有可能删除较好的粒子。在构建图过程 布g采样得到： 中，尤其在嵌套环路环境中，外层环路构建图中需要 2)每个粒子赋重要性权值： 的粒子并不一定是内层环路高权值的粒子。文献 p(x|x4,之14，u1） ω= [35]介绍了一种衡量有效粒子数的方法来评价当 q(x1xi,21,山1t） 前粒子集能否表征后验估计，只有在需要时重采样 3)重采样，其包含2层意思：1)用有限粒子近 才被执行，降低了较好粒子被替换的几率。文献 似一个连续分布，2)重采样允许在真实分布与建议 [36]通过迭代卡尔曼滤波方法融入新的观测值，用 分布有差异的情况下使用粒子滤波器： 复制样本与剔除样本的线性组合降低样本退化及样 4)地图估计，通过已知位姿更新每个粒子的 本贫化。 “粒子地图”。 综上所述，FastSLAM算法获取建议分布函数与 在Rao-Blackwellized粒子滤波的基础上，Monte- 估计环境特征位置依然是基于EKF理论，同样存在 merlo等[3]提出FastSLAM算法，与基于EKF的 样本退化问题。因此，FastSLAM算法发展趋势主要 SLAM方法不同，其用不同的粒子表征机器人的历 从以下2方面考虑： 史路径，能够解耦地图特征信息与机器人状态信息： 1)改进机器人位姿路径评估的粒子滤波。改 即将SLAM问题看成机器人行进轨迹的PF估计和 进建议分布使其近似真实分布：改进重采样策略：改 机器人位姿估计上环境特征位置卡尔曼滤波估计过 进自适应机制，如自适应粒子数目、自适应重采样技 程。粒子滤波器中每个粒子代表机器人的一条可能 术及自适应运动模型
能位置的概率，利用观测对每个滤波器进行加权处 理，使机器人最有可能位置的概率越来越大［３０］ 。 在 实际应用中，基于 ＰＦ 的 ＳＬＡＭ 方法是用一组相关 权重的随机样本集合，以及基于这些样本的估计来 近似表征后验概率密度函数，采用样本均值代替积 分运算来获得状态最小方差估计的过程。 ＳＬＡＭ 主要任务是位姿估计和地图构建，２ 者之 间又存在相互依赖的关系，这使基于 ＰＦ 的 ＳＬＡＭ 问题变得非常复杂。 文献［３１］ 提出了 ＳＬＡＭ 问题 的一种有效解决方案，即后验概率估计的处理方法， 其基本思想是通过 Ｒａｏ⁃Ｂｌａｃｋｗｅｌｌｉｚｅｄ 将 ＳＬＡＭ 问题 分解为轨迹估计过程与地图估计过程。 先用粒子滤 波器估计移动机器人的运动轨迹，再用卡尔曼滤波 估计环境地图，从而将 ＳＬＡＭ 问题转化为低维估计 问题［３２⁃３３］ 。 ｐ（ｓ１：ｔ，ｍ ｜ ｚ１：ｔ，ｕ１：ｔ－１ ） ＝ ｐ（ｓ１：ｔ ｜ ｚ１：ｔ，ｕ１：ｔ－１ ） ｐ（ｍ ｜ ｚ１：ｔ，ｕ１：ｔ－１ ） ＝ ｐ（ｓ１：ｔ ｜ ｚ１：ｔ，ｕ１：ｔ－１ ）ｐ（ｍ ｜ ｓ１：ｔ，ｚ１：ｔ） 式中： ｓ１：ｔ 为移动机器人轨迹， ｕ１：ｔ－１ 为里程计测量， ｍ 为观测 ｚ１：ｔ 得到的地图。 在已知 ｓ１：ｔ 和 ｚ１：ｔ 的条件下，可以得到地图的后 验概率 ｐ（ｍ ｜ ｓ１：ｔ，ｚ１：ｔ） ，而建图的 Ｒａｏ⁃Ｂｌａｃｋｗｅｉｉｉｚｅｄ 通过 ＰＦ 方法得到机器人潜在轨迹的后验概率 ｐ（ｓ１：ｔ ｜ ｚ１：ｔ，ｕ１：ｔ－１ ） ，并为每个粒子分配一个合适的 “粒子地图”，该地图是在给定了由相应粒子所表示 的 ｓ１：ｔ 和 ｚ１：ｔ 条件下建立；换言之，机器人在未知环 境中循环运行一圈，每个粒子都估计机器人的轨迹， 并相应保留一个“粒子地图”，该地图根据轨迹估计 不断更新，即根据已知位姿构建地图。 常用的 Ｒａｏ⁃Ｂｌａｃｋｗｅｉｉｉｚｅｄ 粒子滤波器建图过程 主要有以下 ４ 个步骤： １）采样，子代粒子是从当前粒子中根据建议分 布 ｑ 采样得到； ２）每个粒子赋重要性权值： ω ｉ ｔ ＝ ｐ（ｘ ｉ ｔ ｜ ｘ ｉ １：ｔ，ｚ１：ｔ，ｕ１：ｔ） ｑ（ｘ ｉ ｔ ｜ ｘ ｉ １：ｔ，ｚ１：ｔ，ｕ１：ｔ） ３）重采样，其包含 ２ 层意思：１） 用有限粒子近 似一个连续分布，２）重采样允许在真实分布与建议 分布有差异的情况下使用粒子滤波器； ４）地图估计，通过已知位姿更新每个粒子的 “粒子地图”。 在 Ｒａｏ⁃Ｂｌａｃｋｗｅｌｌｉｚｅｄ 粒子滤波的基础上，Ｍｏｎｔｅ⁃ ｍｅｒｌｏ 等［３３］ 提 出 ＦａｓｔＳＬＡＭ 算 法， 与 基 于 ＥＫＦ 的 ＳＬＡＭ 方法不同，其用不同的粒子表征机器人的历 史路径，能够解耦地图特征信息与机器人状态信息； 即将 ＳＬＡＭ 问题看成机器人行进轨迹的 ＰＦ 估计和 机器人位姿估计上环境特征位置卡尔曼滤波估计过 程。 粒子滤波器中每个粒子代表机器人的一条可能 的行进轨迹，利用观测值计算各个粒子的权重。 具 体到每个粒子，机器人的行进轨迹是确定的，环境特 征标志之间相互独立，特征标志的观测信息仅与机 器人的位姿有关。 每个粒子采用 Ｎ 个卡尔曼滤波 器分 别 估 计 地 图 中 Ｎ 个 特 征 的 位 置。 对 于 ＦａｓｔＳＬＡＭ 算法的复杂度，如果采用 Ｋ 个粒子实现 ＳＬＡＭ，总共有 ＫＮ 个卡尔曼滤波器，其复杂度为 Ｏ（ＫＮ），利用一些算法（如树型数据结构） 进行优 化，其复杂度可以进一步减小到 Ｏ（ＫｌｏｇＮ） ［２５］ 。 针 对数据关联错误，通过减小该粒子的权重来降低关 联错误对定位的影响［３４］ 。 ＦａｓｔＳＬＡＭ 方法的另一个 优点是相比较于卡尔曼滤波定位方法，可以较好地 解决机器人的非线性和非高斯运动问题。 以 ＰＦ 为 理 论 基 础 的 ＦａｓｔＳＬＡＭ 算 法， ＦａｓｔＳＬＡＭ１． ０ 和 ＦａｓｔＳＬＡＭ２． ０ 有 ２ 个 版 本。 ＦａｓｔｓＬＡＭ１．０ 用粒子滤波器估计移动机器人位姿，用 ＥＫＦ 估计环境特征。 但其直接把 ＳＬＡＭ 过程模型作 为采样粒子重要性函数，从重要性函数抽取的样本 不能准确表达真实的后验概率密度函数，当环境观 测值噪声较小时，易造成严重的样本退化问题和定 位精度下降。 ＦａｔＳＬＡＭ２．０ 用 ＥＫＦ 递归估计机器人 位姿，构建融入机器人前期位姿信息的高斯分布函 数为重要函数，缓解了样本退化问题，提高了算法的 精度。 针对测距式传感器，如激光雷达，影响粒子滤 波器性能主要因素是建议分布的选择和选择性采 样。 由于激光扫描仪的精度导致了峰值很高的似然 函数，与大部分粒子滤波器选用里程计运动模型 ｐ（ｓｔ ｜ ｓｔ－１ ，ｕｔ－１ ） 为建议分布不同，其选用高斯建议 分布。 这样既考虑了最近观测数据，也为高效采样 提供了可能，其结果比用里程计运动模型更具有确 定性［３］ 。 在重采样过程中，低权值粒子被高权值粒 子代替，这有可能删除较好的粒子。 在构建图过程 中，尤其在嵌套环路环境中，外层环路构建图中需要 的粒子并不一定是内层环路高权值的粒子。 文献 ［３５］介绍了一种衡量有效粒子数的方法来评价当 前粒子集能否表征后验估计，只有在需要时重采样 才被执行，降低了较好粒子被替换的几率。 文献 ［３６］通过迭代卡尔曼滤波方法融入新的观测值，用 复制样本与剔除样本的线性组合降低样本退化及样 本贫化。 综上所述，ＦａｓｔＳＬＡＭ 算法获取建议分布函数与 估计环境特征位置依然是基于 ＥＫＦ 理论，同样存在 样本退化问题。 因此，ＦａｓｔＳＬＡＭ 算法发展趋势主要 从以下 ２ 方面考虑： １）改进机器人位姿路径评估的粒子滤波。 改 进建议分布使其近似真实分布；改进重采样策略；改 进自适应机制，如自适应粒子数目、自适应重采样技 术及自适应运动模型。 ·６５８· 智 能 系 统 学 报 第 １０ 卷
第5期 刘建华，等：测距式传感器同时定位与地图创建综述 ·659. 2)改进环境特征评估的EKF。采用混合卡尔 出最优的关联匹配，利用SVD获得路标在全局坐标 曼滤波器、UT变换的无迹卡尔曼滤波和无迹粒子滤 系和局部坐标系下的关系，完成地图的更新。文献 波等方法提高计算的有效性。 [40]将测距式SALM问题看成距离信息矩阵SVD 3.3基于矩阵奇异值分解(SVD)的SLAM方法 的过程，通过把距离矩阵SVD得到包含有路标信息 矩阵的分解因式是原矩阵特殊存在形式，能明 和机器人位姿的2个矩阵：通过线性回归算法或机 显反映出原矩阵的某些特征，从而为系统分析提供 器学习算法得到路标信息和机器人位姿，较好解决 有效的计算方法和理论分析根据。矩阵SVD是一 了传感器数据不同步和数据遗漏问题，其实质是在 种应用比较广泛的分解形式。在基于卡尔曼滤波定 系统状态空间搜索识别子空间，与其它定位算法相 位算法中，协方差矩阵对舍入误差较敏感，特别是高 比，不需要线性化模型，具有计算量小、跟踪性能好 维的复杂系统，在迭代过程中经常出现矩阵病态问 等优点。 题，导致协方差矩阵失去对称性和正定性，从而导致 文献[39-40]将基于矩阵SVD的SLAM与传统 算法失效。文献[37-38]通过协方差矩阵迭代分解 的基于概率“位置预测-观测-测量-预测-匹配更 计算，避免了协方差阵的求逆运算，减少了计算量， 新”过程比较，只依靠测距传感器来完成机器人的 提高了算法的稳定性。文献[39]通过激光雷达获 LAM问题，从理论上避免了运动模型的偏差和“绑 得障碍物和方向距离信息，求取直线交点坐标作为 架”问题。 路标，建立路标的相关矩阵，由直线、路标和相关矩 表1列出了3种方法的优缺点及其改进算法。 阵构成局部地图，通过匹配局部地图与全局地图找 表13种方法的优缺点及其改进算法 Table 1 The characteristics of the three methods and the improved algorithm 方法 优缺点 研究成果 改进的思路及性能 优点：计算量小（小环 无迹卡尔曼滤波 通过无迹变换估计后验密度，避免EKF中忽 境)，易于实现： UKF-SLAMC4] 略高阶项带来的问题，无需计算雅克比矩阵，达 缺点：概率密度函数 基于容积卡尔曼滤波到3阶精度，精度和稳定性优于EKF-SLAM; 满足高斯分布、线性化处SLAM2] 通过相同权重点经过非线性系统方程转换 EKF-SLAM 理误差大、对错误数据关 平方根容积卡尔曼滤后产生新的点预测系统状态，避免非线性模型的 联敏感、计算复杂（大环波SLAM) 线性化处理。 境)。 平方根容积卡尔曼滤波计算后验概率密度」 降低线性化误差，稳定性高于EKF-SLAM,UKF- SLAM,定位精度较EKF-SLAM提高1倍。 优点：模型非线性、高 UFastSLAM(44-4] 无迹变换估计转移概率密度和粒子建议分 维运算降为低维运算，在 辅助UFastSLAM算法可布函数，具有3阶非线性估计精度，估计精度高 计算复杂度、数据关联等 CFastSLAM[4-9] 于EKF-SLAM、UKF-SLAM、FastSLAM: 方面具有优势： 平方根容积FastSLAM倒 建议分布函数引入最近的观测值，估计精度 缺点：样本退化、样本 高于UFastSLAM、FastSLAM算法，复杂度高于 FastSLAM 贫化。 FastSLAM: 利用容积卡尔曼滤波产生建议分布函数，估 计精度高于UFastSLAM、FastSLAM算法，耗时少： 容积律计算非线性转移概率密度，容积律具 有3阶非线性估计精度，粒子数目少时，性能优 于UFastSLAM与FastSLAM.。 优点：不需要线性化 协方差矩阵奇异值分 避免了协方差阵的求逆运算、计算误差和舍 模型，降维，具有计算量解3】 入误差，保证了状态协方差矩阵失去正定性，减 小、跟踪性能好，避免了运 路标矩阵奇异值分少计算量，提高了算法的稳定性： SVD-SLAM 动模型的偏差和“绑架”问解[o 把SLAM看做矩阵分解过程，解耦距离矩阵 题； 为路标信息矩阵和机器人位姿矩阵，有效抑制噪 缺点：依据实际情况 声对滤波的影响，定位精度高，实时性高。 不同，如病态矩阵
２）改进环境特征评估的 ＥＫＦ。 采用混合卡尔 曼滤波器、ＵＴ 变换的无迹卡尔曼滤波和无迹粒子滤 波等方法提高计算的有效性。 ３．３ 基于矩阵奇异值分解（ＳＶＤ）的 ＳＬＡＭ 方法 矩阵的分解因式是原矩阵特殊存在形式，能明 显反映出原矩阵的某些特征，从而为系统分析提供 有效的计算方法和理论分析根据。 矩阵 ＳＶＤ 是一 种应用比较广泛的分解形式。 在基于卡尔曼滤波定 位算法中，协方差矩阵对舍入误差较敏感，特别是高 维的复杂系统，在迭代过程中经常出现矩阵病态问 题，导致协方差矩阵失去对称性和正定性，从而导致 算法失效。 文献［３７⁃３８］通过协方差矩阵迭代分解 计算，避免了协方差阵的求逆运算，减少了计算量， 提高了算法的稳定性。 文献［３９］ 通过激光雷达获 得障碍物和方向距离信息，求取直线交点坐标作为 路标，建立路标的相关矩阵，由直线、路标和相关矩 阵构成局部地图，通过匹配局部地图与全局地图找 出最优的关联匹配，利用 ＳＶＤ 获得路标在全局坐标 系和局部坐标系下的关系，完成地图的更新。 文献 ［４０］将测距式 ＳＡＬＭ 问题看成距离信息矩阵 ＳＶＤ 的过程，通过把距离矩阵 ＳＶＤ 得到包含有路标信息 和机器人位姿的 ２ 个矩阵；通过线性回归算法或机 器学习算法得到路标信息和机器人位姿，较好解决 了传感器数据不同步和数据遗漏问题，其实质是在 系统状态空间搜索识别子空间，与其它定位算法相 比，不需要线性化模型，具有计算量小、跟踪性能好 等优点。 文献［３９⁃４０］将基于矩阵 ＳＶＤ 的 ＳＬＡＭ 与传统 的基于概率“位置预测－观测－测量－预测－匹配更 新”过程比较，只依靠测距传感器来完成机器人的 ＳＬＡＭ 问题，从理论上避免了运动模型的偏差和“绑 架”问题。 表 １ 列出了 ３ 种方法的优缺点及其改进算法。 表 １ ３ 种方法的优缺点及其改进算法 Ｔａｂｌｅ １ Ｔｈｅ ｃｈａｒａｃｔｅｒｉｓｔｉｃｓ ｏｆ ｔｈｅ ｔｈｒｅｅ ｍｅｔｈｏｄｓ ａｎｄ ｔｈｅ ｉｍｐｒｏｖｅｄ ａｌｇｏｒｉｔｈｍ 方法 优缺点 研究成果 改进的思路及性能 ＥＫＦ⁃ＳＬＡＭ 优点：计算量小（小环 境），易于实现； 缺点：概率密度函数 满足高斯分布、线性化处 理误差大、对错误数据关 联敏 感、 计 算 复 杂 （ 大 环 境）。 无迹卡尔曼滤波 ＵＫＦ⁃ＳＬＡＭ ［４１］ 基于容积卡尔曼滤波 ＳＬＡＭ ［４２］ 平方根容积卡尔曼滤 波 ＳＬＡＭ ［４３］ 通过无迹变换估计后验密度，避免 ＥＫＦ 中忽 略高阶项带来的问题，无需计算雅克比矩阵，达 到 ３ 阶精度，精度和稳定性优于 ＥＫＦ⁃ＳＬＡＭ； 通过相同权重点经过非线性系统方程转换 后产生新的点预测系统状态，避免非线性模型的 线性化处理。 平方根容积卡尔曼滤波计算后验概率密度， 降低线性化误差，稳定性高于 ＥＫＦ⁃ＳＬＡＭ、ＵＫＦ⁃ ＳＬＡＭ，定位精度较 ＥＫＦ⁃ＳＬＡＭ 提高 １ 倍。 ＦａｓｔＳＬＡＭ 优点：模型非线性、高 维运算降为低维运算，在 计算复杂度、数据关联等 方面具有优势； 缺点：样本退化、样本 贫化。 ＵＦａｓｔＳＬＡＭ ［４４⁃４６］ 辅助 ＵＦａｓｔＳＬＡＭ 算法［４７］ ＣＦａｓｔＳＬＡＭ ［４８⁃４９］ 平方根容积 ＦａｓｔＳＬＡＭ ［３２］ 无迹变换估计转移概率密度和粒子建议分 布函数，具有 ３ 阶非线性估计精度，估计精度高 于 ＥＫＦ⁃ＳＬＡＭ、ＵＫＦ⁃ＳＬＡＭ、ＦａｓｔＳＬＡＭ； 建议分布函数引入最近的观测值，估计精度 高于 ＵＦａｓｔＳＬＡＭ、 ＦａｓｔＳＬＡＭ 算 法， 复 杂 度 高 于 ＦａｓｔＳＬＡＭ； 利用容积卡尔曼滤波产生建议分布函数，估 计精度高于 ＵＦａｓｔＳＬＡＭ、ＦａｓｔＳＬＡＭ 算法，耗时少； 容积律计算非线性转移概率密度，容积律具 有 ３ 阶非线性估计精度，粒子数目少时，性能优 于 ＵＦａｓｔＳＬＡＭ 与 ＦａｓｔＳＬＡＭ。 ＳＶＤ⁃ＳＬＡＭ 优点：不需要线性化 模型， 降 维， 具 有 计 算 量 小、跟踪性能好，避免了运 动模型的偏差和“绑架”问 题； 缺点：依据实际情况 不同，如病态矩阵。 协方差矩阵奇异值分 解［３７⁃３８］ 路标 矩 阵 奇 异 值 分 解［４０］ 避免了协方差阵的求逆运算、计算误差和舍 入误差，保证了状态协方差矩阵失去正定性，减 少计算量，提高了算法的稳定性； 把 ＳＬＡＭ 看做矩阵分解过程，解耦距离矩阵 为路标信息矩阵和机器人位姿矩阵，有效抑制噪 声对滤波的影响，定位精度高，实时性高。 第 ５ 期 刘建华，等：测距式传感器同时定位与地图创建综述 ·６５９·
·660 智能系统学报 第10卷 CHENG Huabin,ZHANG Yingchao.Research on localiza- 4 结论与展望 tion of mobile robot based on ultrasonic wave sensor[J]. 目前，有关移动机器人SLAM研究成果很多，并 Transducer and Microsystem Technologies,2013,32(4): 逐步趋于成熟，使得智能移动机器人的工作环境从 58-60,64. 办公环境向着未知、非结构化环境方面延伸。结合 [5]韩峥，刘华平，黄文炳，等.基于Kinect的机械臂目标抓 目前实际应用，未知环境中移动机器人的SLAM问 取[J].智能系统学报，2013,8(2)：1-8. 题有待从算法效率、应用领域等方面进一步完 HAN Zheng,LIU Huaping,HUANG Wenbing,et al.Ki- 善s0 nect-based object grasping by manipulator[J].CAAI Trans- 1)作为目前移动机器人定位主流的概率算法， actions on Intelligent System,2013,8(2):1-8. [6]HWANG S Y,SONG J B.Monocular vision-based global lo- 需要对系统和观测模型中的噪声做在线自适应评 calization using position and orientation of ceiling features 估，对在线实时执行的SLAM算法做深入的研究，实 [C//IEEE International Conference on Robotics and Auto- 现对移动机器人位姿的有效评估； mation (ICRA).Karlsruhe,Germany,2013:3770-3775. 2)引入智能化优化算法和多种非线性滤波器相 [7]WURM K M,STACHNISS C,GRISETTI G.Bridging the 结合的方法，虽然目前已有一些这方面的研究成果， gap between feature-and grid-based SLAM[J].Robotics and 但仍有很大的研究空间： Autonomous Systems,2010,58(2):140-148. 3)研究粒子滤波中粒子数目与滤波器收敛速度 [8]CHOI H,KIM D Y,HWANG J P,et al.Efficient simulta- 的关系，针对如何克服粒子退化和保持粒子多样性 neous localization and mapping based on ceiling-view:ceil- 问题，研究自适应重采样策略及提高粒子多样性修 ing boundary feature map approach[].Advanced Robotics, 复能力的方法，研究考虑了测距传感器精度的粒子 2012,26(5-6):653-671. 建议分布： [9]HWANG S Y,SONG J B,KIM M S.Robust extraction of 4)如何更高效地将测距传感器与其他异质传感 arbitrary-shaped features in ceiling for upward-looking cam- 器信息进行策略级的高级融合： era-based SLAM[C]//Proceedings of the 18th IFAC World 5)为使机器人在较短的时间内能够感知的范围 Congress.Milano,Italy,2011:8165-8170. 尽可能大，进而提高SLAM地图创建的效率，应在探 [10]ZHANG S,ADAMS M,TANG F,et al.Geometrical fea- 索规划方面展开研究： ture extraction using 2D range scanner [C]//The Fourth 6)考虑二维动态环境和三维动态环境下机器人 International Conference on Control and Automation.Mont- SLAM问题； real,Canada,2003:901-905. 7)对于多机协作SLAM技术提高地图创建的准 [11]STURM J,KONOLIGE K,STACHNISS C,et al.Vision- based detection for learning articulation models of cabinet 确性和鲁棒性，急需解决自定位多机协作模式、系统 doors and drawers in household environments Cl//IEEE 控制结构、局部子地图融为全局地图的融合算法及 International Conference on Robotics and Automation 多机分布式多传感器间信息融合等问题。 (ICRA).Anchorage.USA,2010:362-368. 总体而言，在未来的工作中，将在现有工作基础 [12]WU Zhe,KONG Qinjie,LIU Jiapeng,et al.A rectangle 上，重点需要在信息融合、多机协作系统、室外动态 detection method for real-time extraction of large panel edge 环境的三维实时重建算法等方面开展进一步的研究。 [C]//The 6th International Conference on Image and 参考文献： Graphics (ICIG).Hefei,China,2011:382-387. [13]De La PUENTE P,RODRIGUEZ-L D,VALERO A,et al. [1]WANG Heng,HUANG Shoudong,KHOSOUSSI K,et al. 3D feature based mapping towards mobile robots'enhanced Dimensionality reduction for point feature SLAM problems performance in rescue missions [C]//IEEE/RSJ Interna- with spherical covariance matrices[J].Automatica,2015, tional Conference on Intelligent Robots and Systems 51:149-157. (IR0S).St Louis,USA,2009:1138-1143. [2]VALIENTE D.GIL A,FERNANDEZ L,et al.A compari- [14]KHAN S,DOMETIOS A,VERGINIS C,et al.RMAP:a son of EKF and SGD applied to a view-based SLAM ap- rectangular cuboid approximation framework for 3D environ- proach with omnidirectional images[].Robotics and Auton- ment mapping [J].Autonomous Robots,2014,37 (3): omous Systems,2014,62(2):108-229. 261-277. [3]STACHNISS C.机器人地图创建与环境探索[M].陈白 [15]NGUYEN V,MARTINRLLI A,TOMATIS N,et al.A 帆，刘丽珏.译，北京：国防工业出版社，2013：75. comparison of line extraction algorithms using 2D range da- [4]程华彬，张颖超.基于超声波传感器的移动机器人定位 ta for indoor mobile robotics[J.Autonomous Robots, 研究[J].传感器与微系统，2013,32(4)：58-60,64. 2007.23(2)：97-111
４ 结论与展望 目前，有关移动机器人 ＳＬＡＭ 研究成果很多，并 逐步趋于成熟，使得智能移动机器人的工作环境从 办公环境向着未知、非结构化环境方面延伸。 结合 目前实际应用，未知环境中移动机器人的 ＳＬＡＭ 问 题有待 从 算 法 效 率、 应 用 领 域 等 方 面 进 一 步 完 善［５０］ 。 １）作为目前移动机器人定位主流的概率算法， 需要对系统和观测模型中的噪声做在线自适应评 估，对在线实时执行的 ＳＬＡＭ 算法做深入的研究，实 现对移动机器人位姿的有效评估； ２）引入智能化优化算法和多种非线性滤波器相 结合的方法，虽然目前已有一些这方面的研究成果， 但仍有很大的研究空间； ３）研究粒子滤波中粒子数目与滤波器收敛速度 的关系，针对如何克服粒子退化和保持粒子多样性 问题，研究自适应重采样策略及提高粒子多样性修 复能力的方法，研究考虑了测距传感器精度的粒子 建议分布； ４）如何更高效地将测距传感器与其他异质传感 器信息进行策略级的高级融合； ５）为使机器人在较短的时间内能够感知的范围 尽可能大，进而提高 ＳＬＡＭ 地图创建的效率，应在探 索规划方面展开研究； ６）考虑二维动态环境和三维动态环境下机器人 ＳＬＡＭ 问题； ７）对于多机协作 ＳＬＡＭ 技术提高地图创建的准 确性和鲁棒性，急需解决自定位多机协作模式、系统 控制结构、局部子地图融为全局地图的融合算法及 多机分布式多传感器间信息融合等问题。 总体而言，在未来的工作中，将在现有工作基础 上，重点需要在信息融合、多机协作系统、室外动态 环境的三维实时重建算法等方面开展进一步的研究。 参考文献： ［１］ ＷＡＮＧ Ｈｅｎｇ， ＨＵＡＮＧ Ｓｈｏｕｄｏｎｇ， ＫＨＯＳＯＵＳＳＩ Ｋ， ｅｔ ａｌ． Ｄｉｍｅｎｓｉｏｎａｌｉｔｙ ｒｅｄｕｃｔｉｏｎ ｆｏｒ ｐｏｉｎｔ ｆｅａｔｕｒｅ ＳＬＡＭ ｐｒｏｂｌｅｍｓ ｗｉｔｈ ｓｐｈｅｒｉｃａｌ ｃｏｖａｒｉａｎｃｅ ｍａｔｒｉｃｅｓ［ Ｊ］． Ａｕｔｏｍａｔｉｃａ， ２０１５， ５１：１４９⁃１５７． ［２］ＶＡＬＩＥＮＴＥ Ｄ， ＧＩＬ Ａ， ＦＥＲＮÁＮＤＥＺ Ｌ， ｅｔ ａｌ． Ａ ｃｏｍｐａｒｉ⁃ ｓｏｎ ｏｆ ＥＫＦ ａｎｄ ＳＧＤ ａｐｐｌｉｅｄ ｔｏ ａ ｖｉｅｗ⁃ｂａｓｅｄ ＳＬＡＭ ａｐ⁃ ｐｒｏａｃｈ ｗｉｔｈ ｏｍｎｉｄｉｒｅｃｔｉｏｎａｌ ｉｍａｇｅｓ［Ｊ］． Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｎ⁃ ｏｍｏｕｓ Ｓｙｓｔｅｍｓ， ２０１４， ６２（２）： １０８⁃２２９． ［３］ＳＴＡＣＨＮＩＳＳ Ｃ． 机器人地图创建与环境探索［Ｍ］． 陈白 帆， 刘丽珏， 译， 北京： 国防工业出版社， ２０１３： ７５． ［４］程华彬， 张颖超． 基于超声波传感器的移动机器人定位 研究［Ｊ］． 传感器与微系统， ２０１３， ３２（４）： ５８⁃６０， ６４． ＣＨＥＮＧ Ｈｕａｂｉｎ， ＺＨＡＮＧ Ｙｉｎｇｃｈａｏ． Ｒｅｓｅａｒｃｈ ｏｎ ｌｏｃａｌｉｚａ⁃ ｔｉｏｎ ｏｆ ｍｏｂｉｌｅ ｒｏｂｏｔ ｂａｓｅｄ ｏｎ ｕｌｔｒａｓｏｎｉｃ ｗａｖｅ ｓｅｎｓｏｒ ［ Ｊ］． Ｔｒａｎｓｄｕｃｅｒ ａｎｄ Ｍｉｃｒｏｓｙｓｔｅｍ Ｔｅｃｈｎｏｌｏｇｉｅｓ， ２０１３， ３２ （ ４）： ５８⁃６０， ６４． ［５］韩峥， 刘华平，黄文炳，等． 基于 Ｋｉｎｅｃｔ 的机械臂目标抓 取［Ｊ］． 智能系统学报， ２０１３， ８（２）： １⁃８． ＨＡＮ Ｚｈｅｎｇ， ＬＩＵ Ｈｕａｐｉｎｇ， ＨＵＡＮＧ Ｗｅｎｂｉｎｇ， ｅｔ ａｌ． Ｋｉ⁃ ｎｅｃｔ⁃ｂａｓｅｄ ｏｂｊｅｃｔ ｇｒａｓｐｉｎｇ ｂｙ ｍａｎｉｐｕｌａｔｏｒ［Ｊ］． ＣＡＡＩ Ｔｒａｎｓ⁃ ａｃｔｉｏｎｓ ｏｎ Ｉｎｔｅｌｌｉｇｅｎｔ Ｓｙｓｔｅｍ， ２０１３， ８（２）： １⁃８． ［６］ＨＷＡＮＧ Ｓ Ｙ， ＳＯＮＧ Ｊ Ｂ． Ｍｏｎｏｃｕｌａｒ ｖｉｓｉｏｎ⁃ｂａｓｅｄ ｇｌｏｂａｌ ｌｏ⁃ ｃａｌｉｚａｔｉｏｎ ｕｓｉｎｇ ｐｏｓｉｔｉｏｎ ａｎｄ ｏｒｉｅｎｔａｔｉｏｎ ｏｆ ｃｅｉｌｉｎｇ ｆｅａｔｕｒｅｓ ［Ｃ］ ／ ／ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏ⁃ ｍａｔｉｏｎ （ＩＣＲＡ）． Ｋａｒｌｓｒｕｈｅ， Ｇｅｒｍａｎｙ， ２０１３： ３７７０⁃３７７５． ［７］ ＷＵＲＭ Ｋ Ｍ， ＳＴＡＣＨＮＩＳＳ Ｃ， ＧＲＩＳＥＴＴＩ Ｇ． Ｂｒｉｄｇｉｎｇ ｔｈｅ ｇａｐ ｂｅｔｗｅｅｎ ｆｅａｔｕｒｅ⁃ａｎｄ ｇｒｉｄ⁃ｂａｓｅｄ ＳＬＡＭ［Ｊ］． Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｎｏｍｏｕｓ Ｓｙｓｔｅｍｓ， ２０１０， ５８（２）： １４０⁃１４８． ［８］ＣＨＯＩ Ｈ， ＫＩＭ Ｄ Ｙ， ＨＷＡＮＧ Ｊ Ｐ， ｅｔ ａｌ． Ｅｆｆｉｃｉｅｎｔ ｓｉｍｕｌｔａ⁃ ｎｅｏｕｓ ｌｏｃａｌｉｚａｔｉｏｎ ａｎｄ ｍａｐｐｉｎｇ ｂａｓｅｄ ｏｎ ｃｅｉｌｉｎｇ⁃ｖｉｅｗ： ｃｅｉｌ⁃ ｉｎｇ ｂｏｕｎｄａｒｙ ｆｅａｔｕｒｅ ｍａｐ ａｐｐｒｏａｃｈ［Ｊ］． Ａｄｖａｎｃｅｄ Ｒｏｂｏｔｉｃｓ， ２０１２，２６（５⁃６）： ６５３⁃６７１． ［９］ＨＷＡＮＧ Ｓ Ｙ， ＳＯＮＧ Ｊ Ｂ， ＫＩＭ Ｍ Ｓ． Ｒｏｂｕｓｔ ｅｘｔｒａｃｔｉｏｎ ｏｆ ａｒｂｉｔｒａｒｙ⁃ｓｈａｐｅｄ ｆｅａｔｕｒｅｓ ｉｎ ｃｅｉｌｉｎｇ ｆｏｒ ｕｐｗａｒｄ⁃ｌｏｏｋｉｎｇ ｃａｍ⁃ ｅｒａ⁃ｂａｓｅｄ ＳＬＡＭ［Ｃ］ ／ ／ Ｐｒｏｃｅｅｄｉｎｇｓ ｏｆ ｔｈｅ １８ｔｈ ＩＦＡＣ Ｗｏｒｌｄ Ｃｏｎｇｒｅｓｓ． Ｍｉｌａｎｏ， Ｉｔａｌｙ， ２０１１： ８１６５⁃８１７０． ［１０］ＺＨＡＮＧ Ｓ， ＡＤＡＭＳ Ｍ， ＴＡＮＧ Ｆ， ｅｔ ａｌ． Ｇｅｏｍｅｔｒｉｃａｌ ｆｅａ⁃ ｔｕｒｅ ｅｘｔｒａｃｔｉｏｎ ｕｓｉｎｇ ２Ｄ ｒａｎｇｅ ｓｃａｎｎｅｒ ［ Ｃ］ ／ ／ Ｔｈｅ Ｆｏｕｒｔｈ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｃｏｎｔｒｏｌ ａｎｄ Ａｕｔｏｍａｔｉｏｎ． Ｍｏｎｔ⁃ ｒｅａｌ， Ｃａｎａｄａ， ２００３： ９０１⁃９０５． ［１１］ＳＴＵＲＭ Ｊ， ＫＯＮＯＬＩＧＥ Ｋ， ＳＴＡＣＨＮＩＳＳ Ｃ， ｅｔ ａｌ． Ｖｉｓｉｏｎ⁃ ｂａｓｅｄ ｄｅｔｅｃｔｉｏｎ ｆｏｒ ｌｅａｒｎｉｎｇ ａｒｔｉｃｕｌａｔｉｏｎ ｍｏｄｅｌｓ ｏｆ ｃａｂｉｎｅｔ ｄｏｏｒｓ ａｎｄ ｄｒａｗｅｒｓ ｉｎ ｈｏｕｓｅｈｏｌｄ ｅｎｖｉｒｏｎｍｅｎｔｓ ［ Ｃ］ ／ ／ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｍａｔｉｏｎ （ＩＣＲＡ）． Ａｎｃｈｏｒａｇｅ， ＵＳＡ， ２０１０： ３６２⁃３６８． ［１２］ ＷＵ Ｚｈｅ， ＫＯＮＧ Ｑｉｎｊｉｅ， ＬＩＵ Ｊｉａｐｅｎｇ， ｅｔ ａｌ． Ａ ｒｅｃｔａｎｇｌｅ ｄｅｔｅｃｔｉｏｎ ｍｅｔｈｏｄ ｆｏｒ ｒｅａｌ⁃ｔｉｍｅ ｅｘｔｒａｃｔｉｏｎ ｏｆ ｌａｒｇｅ ｐａｎｅｌ ｅｄｇｅ ［Ｃ ］ ／ ／ Ｔｈｅ ６ｔｈ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｉｍａｇｅ ａｎｄ Ｇｒａｐｈｉｃｓ （ＩＣＩＧ）． Ｈｅｆｅｉ， Ｃｈｉｎａ， ２０１１： ３８２⁃３８７． ［１３］Ｄｅ Ｌａ ＰＵＥＮＴＥ Ｐ， ＲＯＤＲÍＧＵＥＺ⁃Ｌ Ｄ， ＶＡＬＥＲＯ Ａ， ｅｔ ａｌ． ３Ｄ ｆｅａｔｕｒｅ ｂａｓｅｄ ｍａｐｐｉｎｇ ｔｏｗａｒｄｓ ｍｏｂｉｌｅ ｒｏｂｏｔｓ’ ｅｎｈａｎｃｅｄ ｐｅｒｆｏｒｍａｎｃｅ ｉｎ ｒｅｓｃｕｅ ｍｉｓｓｉｏｎｓ ［ Ｃ］ ／ ／ ＩＥＥＥ／ ＲＳＪ Ｉｎｔｅｒｎａ⁃ ｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｉｎｔｅｌｌｉｇｅｎｔ Ｒｏｂｏｔｓ ａｎｄ Ｓｙｓｔｅｍｓ （ＩＲＯＳ）． Ｓｔ Ｌｏｕｉｓ， ＵＳＡ， ２００９： １１３８⁃１１４３． ［１４］ＫＨＡＮ Ｓ， ＤＯＭＥＴＩＯＳ Ａ， ＶＥＲＧＩＮＩＳ Ｃ， ｅｔ ａｌ． ＲＭＡＰ： ａ ｒｅｃｔａｎｇｕｌａｒ ｃｕｂｏｉｄ ａｐｐｒｏｘｉｍａｔｉｏｎ ｆｒａｍｅｗｏｒｋ ｆｏｒ ３Ｄ ｅｎｖｉｒｏｎ⁃ ｍｅｎｔ ｍａｐｐｉｎｇ ［ Ｊ］． Ａｕｔｏｎｏｍｏｕｓ Ｒｏｂｏｔｓ， ２０１４， ３７ （ ３）： ２６１⁃２７７． ［１５］ ＮＧＵＹＥＮ Ｖ， ＭＡＲＴＩＮＲＬＬＩ Ａ， ＴＯＭＡＴＩＳ Ｎ， ｅｔ ａｌ． Ａ ｃｏｍｐａｒｉｓｏｎ ｏｆ ｌｉｎｅ ｅｘｔｒａｃｔｉｏｎ ａｌｇｏｒｉｔｈｍｓ ｕｓｉｎｇ ２Ｄ ｒａｎｇｅ ｄａ⁃ ｔａ ｆｏｒ ｉｎｄｏｏｒ ｍｏｂｉｌｅ ｒｏｂｏｔｉｃｓ ［ Ｊ ］． Ａｕｔｏｎｏｍｏｕｓ Ｒｏｂｏｔｓ， ２００７， ２３（２）： ９７⁃１１１． ·６６０· 智 能 系 统 学 报 第 １０ 卷
第5期 刘建华，等：测距式传感器同时定位与地图创建综述 ·661. [16]满增光，叶文华，肖海宁，等.从激光扫描数据中提取 al-time hierarchical stereo Visual SLAM in large-scale envi- 角点特征的方法[J].南京航空航天大学学报，2012 ronments[J].Robotics and Autonomous Systems,2010. 44(3):379-383 58(8):991-1002. MAN Zengguang,YE Wenhua,XIAO Haining,et al. [26]IDRIS M Y I,AROF H,NOOR N M,et al.A co-proces- Method for corner feature extraction from laser scan data sor design to accelerate sequential monocular SLAM EKF [J].Journal of Nanjing University of Aeronautics Astro- process[J.Measurement,2012,45(8):2141-2152. nautics.2012,44(3):379-383. [27]LEONARD JJ,DURRANT-WHYTE H F,COX I J.Dy- [17]徐君，张国良，王俊龙.一种基于激光传感器的自适应 namic map building for an autonomous mobile robot[J. 直线提取算法[J].计算机工程与应用，2013,49(2)： The International Journal of Robotics Research,1992,11 43-47. (4):286-298. XU Jun,ZHANG Guoliang,WANG Junlong.Self-adaption [28]LEONARD JJ,JACOB H,FEDER S.A computationally segmentation algorithm for line extraction based on laser efficient method for large-scale concurrent mapping and lo- sensor[J].Computer Engineering and Applications,2013, calization[C]//Proceedings of the Ninth International 49(2):43-47. Symposium on Robotics Research.Snowbird,Utah,USA, [18]于金霞，蔡自兴，段琢华.基于激光面达的环境特征提 1999:169-176 取方法研究[J].计算机测量与控制，2007,15(11)： [29]PAGAC D,NEBOT E M,DURRANT-WHYTE H.An evi- 1550-1552. dential approach to map-building for autonomous vehicles YU Jinxia,CAI Zixing,DUAN Zhuohua.Research on en- [J ]IEEE Transactions on Robotics and Automation, vironmental features extraction with laser scanner[J].Com- 1998.14(4)：623-629. puter Measurement Control,2007,15(11):1550-1552. [30]CADENA C,NEIRA J.SLAM in O(logn)with the com- [19]LU Feng,MILIOS E.Globally consistent range scan align- bined Kalman-information filter[J].Robotics and Autono- ment for environment mapping[J].Autonomous Robots, mous Systems,2010,58(11):1207-1219. 1997,4(4):333-349. [31]MURPHY K P.Bayesian map learning in dynamic environ- [20]王路，蔡自兴.未知环境中移动机器人并发建图与定位 ments[C]//Proceedings of the Conference on Neural Infor- (CML)的研究进展[J].机器人，2004,24(4)：380-384. mation Processing System (NIPS).Denver,USA,1999: WANG Lu,CAI Zixing.Progress of CML for mobile robots 1015-1021. in unknown environments[J].Robot,2004,24(4):380- [32]宋宇，李庆玲，康轶非，等.平方根容积Rao-Blackwil- 384. lised粒子滤波SLAM算法[J].自动化学报，2014,40 [21]强敏利，张万绪.EKF滤波在移动机器人定位中的应 (2):357-367. 用[J].电子技术应用，2013,39(2)：74-77. SONG Yu,LI Qingling,KANG Yifei,et al.SLAM with QIANG Minli,ZHANG Wanxu.Application of iterated ex- square-root cubature Rao-Blackwillised particle filter[J]. tended Kalman filtering in mobile robot localization [J]. Acta Automatica Sinica,2014,40(2):357-367. Application of Electronic Technique,2013,39(2):74-77. [33]MONTEMERLO M,THRUN S.Simultaneous localization [22]王晓娟，王宜银.基于模糊卡尔曼滤波的移动机器人定 and mapping with unknown data association using 位研究[J].计算机工程与应用，2011,47(2)：204 FastSLAM[C]//IEEE International Conference on Robot- 206.216. ics and Automation.Taipei,China,2003:1985-1991. WANG Xiaojuan,WANG Xuanyin.Research on mobile ro- [34]康轶非，宋永端，宋宇，等.不依赖里程计的机器人定 bot localization based on fuzzy Kalman filtering[J].Com- 位与地图构建[J].浙江大学学报：工学版，2014,48 puter Engineering and Applications,2011,47(2):204- (3):414-422. 206,216. KANG Yifei,SONG Yongduan,SONG Yu,et al.Simulta- [23]邹卫军，薄煜明.差分线性化EKF滤波方法研究[J]. neous localization and mapping without relying on odometer 计算机工程与应用，2009,45(9)：64-66 [J.Journal of Zhejiang University:Engineering Science, ZOU Weijun,BO Yuming.Research of EKF based on dif- 2014.48(3):414-422. ferential linearization[].Computer Engineering and Appli- [35]LIU J S.Metropolized independent sampling with compari- cations,2009,45(9):64-66. sons to rejection sampling and importance sampling [J]. [24]BERGER C.Weak constraints network optimiser[C]//Pro- Statistics and Computing,1996,6(2):113-119. ceedings of the IEEE International Conference on Robotics [36]王宏健，王晶，刘振业.基于迭代扩展Kalman滤波建 and Automation (ICRA).Saint Paul,USA,2012:1270- 议分布和线性优化重采样的快速同步定位与构图[J] 1277. 电子与信息学报，2014,36(2)：318-324. [25]SCHLEICHER D,BERGASA L M,OCANA M,et al.Re- WANG Hongjian,WANG Jing,LIU Zhenye.Fast simulta-
［１６］满增光， 叶文华， 肖海宁， 等． 从激光扫描数据中提取 角点特征的方法［ Ｊ］． 南京航空航天大学学报， ２０１２， ４４（３）： ３７９⁃３８３． ＭＡＮ Ｚｅｎｇｇｕａｎｇ， ＹＥ Ｗｅｎｈｕａ， ＸＩＡＯ Ｈａｉｎｉｎｇ， ｅｔ ａｌ． Ｍｅｔｈｏｄ ｆｏｒ ｃｏｒｎｅｒ ｆｅａｔｕｒｅ ｅｘｔｒａｃｔｉｏｎ ｆｒｏｍ ｌａｓｅｒ ｓｃａｎ ｄａｔａ ［Ｊ］． Ｊｏｕｒｎａｌ ｏｆ Ｎａｎｊｉｎｇ Ｕｎｉｖｅｒｓｉｔｙ ｏｆ Ａｅｒｏｎａｕｔｉｃｓ ＆ Ａｓｔｒｏ⁃ ｎａｕｔｉｃｓ， ２０１２， ４４（３）： ３７９⁃３８３． ［１７］徐君， 张国良， 王俊龙． 一种基于激光传感器的自适应 直线提取算法［Ｊ］． 计算机工程与应用， ２０１３， ４９（２）： ４３⁃４７． ＸＵ Ｊｕｎ， ＺＨＡＮＧ Ｇｕｏｌｉａｎｇ， ＷＡＮＧ Ｊｕｎｌｏｎｇ． Ｓｅｌｆ⁃ａｄａｐｔｉｏｎ ｓｅｇｍｅｎｔａｔｉｏｎ ａｌｇｏｒｉｔｈｍ ｆｏｒ ｌｉｎｅ ｅｘｔｒａｃｔｉｏｎ ｂａｓｅｄ ｏｎ ｌａｓｅｒ ｓｅｎｓｏｒ［Ｊ］． Ｃｏｍｐｕｔｅｒ Ｅｎｇｉｎｅｅｒｉｎｇ ａｎｄ Ａｐｐｌｉｃａｔｉｏｎｓ， ２０１３， ４９（２）： ４３⁃４７． ［１８］于金霞， 蔡自兴， 段琢华． 基于激光雷达的环境特征提 取方法研究［ Ｊ］． 计算机测量与控制， ２００７， １５（ １１）： １５５０⁃１５５２． ＹＵ Ｊｉｎｘｉａ， ＣＡＩ Ｚｉｘｉｎｇ， ＤＵＡＮ Ｚｈｕｏｈｕａ． Ｒｅｓｅａｒｃｈ ｏｎ ｅｎ⁃ ｖｉｒｏｎｍｅｎｔａｌ ｆｅａｔｕｒｅｓ ｅｘｔｒａｃｔｉｏｎ ｗｉｔｈ ｌａｓｅｒ ｓｃａｎｎｅｒ［Ｊ］． Ｃｏｍ⁃ ｐｕｔｅｒ Ｍｅａｓｕｒｅｍｅｎｔ ＆ Ｃｏｎｔｒｏｌ， ２００７， １５（１１）： １５５０⁃１５５２． ［１９］ＬＵ Ｆｅｎｇ， ＭＩＬＩＯＳ Ｅ． Ｇｌｏｂａｌｌｙ ｃｏｎｓｉｓｔｅｎｔ ｒａｎｇｅ ｓｃａｎ ａｌｉｇｎ⁃ ｍｅｎｔ ｆｏｒ ｅｎｖｉｒｏｎｍｅｎｔ ｍａｐｐｉｎｇ ［ Ｊ］． Ａｕｔｏｎｏｍｏｕｓ Ｒｏｂｏｔｓ， １９９７， ４（４）： ３３３⁃３４９． ［２０］王璐， 蔡自兴． 未知环境中移动机器人并发建图与定位 （ＣＭＬ）的研究进展［Ｊ］． 机器人， ２００４， ２４（４）：３８０⁃３８４． ＷＡＮＧ Ｌｕ， ＣＡＩ Ｚｉｘｉｎｇ． Ｐｒｏｇｒｅｓｓ ｏｆ ＣＭＬ ｆｏｒ ｍｏｂｉｌｅ ｒｏｂｏｔｓ ｉｎ ｕｎｋｎｏｗｎ ｅｎｖｉｒｏｎｍｅｎｔｓ［Ｊ］． Ｒｏｂｏｔ， ２００４， ２４（４）： ３８０⁃ ３８４． ［２１］强敏利， 张万绪． ＩＥＫＦ 滤波在移动机器人定位中的应 用［Ｊ］． 电子技术应用， ２０１３， ３９（２）： ７４⁃７７． ＱＩＡＮＧ Ｍｉｎｌｉ， ＺＨＡＮＧ Ｗａｎｘｕ． Ａｐｐｌｉｃａｔｉｏｎ ｏｆ ｉｔｅｒａｔｅｄ ｅｘ⁃ ｔｅｎｄｅｄ Ｋａｌｍａｎ ｆｉｌｔｅｒｉｎｇ ｉｎ ｍｏｂｉｌｅ ｒｏｂｏｔ ｌｏｃａｌｉｚａｔｉｏｎ ［ Ｊ］． Ａｐｐｌｉｃａｔｉｏｎ ｏｆ Ｅｌｅｃｔｒｏｎｉｃ Ｔｅｃｈｎｉｑｕｅ， ２０１３， ３９（２）： ７４⁃７７． ［２２］王晓娟， 王宣银． 基于模糊卡尔曼滤波的移动机器人定 位研究［ Ｊ］． 计算机工程与应用， ２０１１， ４７ （ ２）： ２０４⁃ ２０６， ２１６． ＷＡＮＧ Ｘｉａｏｊｕａｎ， ＷＡＮＧ Ｘｕａｎｙｉｎ． Ｒｅｓｅａｒｃｈ ｏｎ ｍｏｂｉｌｅ ｒｏ⁃ ｂｏｔ ｌｏｃａｌｉｚａｔｉｏｎ ｂａｓｅｄ ｏｎ ｆｕｚｚｙ Ｋａｌｍａｎ ｆｉｌｔｅｒｉｎｇ［ Ｊ］． Ｃｏｍ⁃ ｐｕｔｅｒ Ｅｎｇｉｎｅｅｒｉｎｇ ａｎｄ Ａｐｐｌｉｃａｔｉｏｎｓ， ２０１１， ４７ （ ２）： ２０４⁃ ２０６， ２１６． ［２３］邹卫军， 薄煜明． 差分线性化 ＥＫＦ 滤波方法研究［ Ｊ］． 计算机工程与应用， ２００９， ４５（９）： ６４⁃６６． ＺＯＵ Ｗｅｉｊｕｎ， ＢＯ Ｙｕｍｉｎｇ． Ｒｅｓｅａｒｃｈ ｏｆ ＥＫＦ ｂａｓｅｄ ｏｎ ｄｉｆ⁃ ｆｅｒｅｎｔｉａｌ ｌｉｎｅａｒｉｚａｔｉｏｎ［Ｊ］． Ｃｏｍｐｕｔｅｒ Ｅｎｇｉｎｅｅｒｉｎｇ ａｎｄ Ａｐｐｌｉ⁃ ｃａｔｉｏｎｓ， ２００９， ４５（９）： ６４⁃６６． ［２４］ＢＥＲＧＥＲ Ｃ． Ｗｅａｋ ｃｏｎｓｔｒａｉｎｔｓ ｎｅｔｗｏｒｋ ｏｐｔｉｍｉｓｅｒ［Ｃ］ ／ ／ Ｐｒｏ⁃ ｃｅｅｄｉｎｇｓ ｏｆ ｔｈｅ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｍａｔｉｏｎ（ ＩＣＲＡ）． Ｓａｉｎｔ Ｐａｕｌ， ＵＳＡ， ２０１２： １２７０⁃ １２７７． ［２５］ＳＣＨＬＥＩＣＨＥＲ Ｄ， ＢＥＲＧＡＳＡ Ｌ Ｍ， ＯＣＡÑＡ Ｍ， ｅｔ ａｌ． Ｒｅ⁃ ａｌ⁃ｔｉｍｅ ｈｉｅｒａｒｃｈｉｃａｌ ｓｔｅｒｅｏ Ｖｉｓｕａｌ ＳＬＡＭ ｉｎ ｌａｒｇｅ⁃ｓｃａｌｅ ｅｎｖｉ⁃ ｒｏｎｍｅｎｔｓ［ Ｊ］． Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｎｏｍｏｕｓ Ｓｙｓｔｅｍｓ， ２０１０， ５８（８）： ９９１⁃１００２． ［２６］ＩＤＲＩＳ Ｍ Ｙ Ｉ， ＡＲＯＦ Ｈ， ＮＯＯＲ Ｎ Ｍ， ｅｔ ａｌ． Ａ ｃｏ⁃ｐｒｏｃｅｓ⁃ ｓｏｒ ｄｅｓｉｇｎ ｔｏ ａｃｃｅｌｅｒａｔｅ ｓｅｑｕｅｎｔｉａｌ ｍｏｎｏｃｕｌａｒ ＳＬＡＭ ＥＫＦ ｐｒｏｃｅｓｓ［Ｊ］． Ｍｅａｓｕｒｅｍｅｎｔ， ２０１２， ４５（８）： ２１４１⁃２１５２． ［２７］ＬＥＯＮＡＲＤ Ｊ Ｊ， ＤＵＲＲＡＮＴ⁃ＷＨＹＴＥ Ｈ Ｆ， ＣＯＸ Ｉ Ｊ． Ｄｙ⁃ ｎａｍｉｃ ｍａｐ ｂｕｉｌｄｉｎｇ ｆｏｒ ａｎ ａｕｔｏｎｏｍｏｕｓ ｍｏｂｉｌｅ ｒｏｂｏｔ ［ Ｊ］． Ｔｈｅ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｊｏｕｒｎａｌ ｏｆ Ｒｏｂｏｔｉｃｓ Ｒｅｓｅａｒｃｈ， １９９２， １１ （４）： ２８６⁃２９８． ［２８］ ＬＥＯＮＡＲＤ Ｊ Ｊ， ＪＡＣＯＢ Ｈ， ＦＥＤＥＲ Ｓ． Ａ ｃｏｍｐｕｔａｔｉｏｎａｌｌｙ ｅｆｆｉｃｉｅｎｔ ｍｅｔｈｏｄ ｆｏｒ ｌａｒｇｅ⁃ｓｃａｌｅ ｃｏｎｃｕｒｒｅｎｔ ｍａｐｐｉｎｇ ａｎｄ ｌｏ⁃ ｃａｌｉｚａｔｉｏｎ ［ Ｃ ］ ／ ／ Ｐｒｏｃｅｅｄｉｎｇｓ ｏｆ ｔｈｅ Ｎｉｎｔｈ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｓｙｍｐｏｓｉｕｍ ｏｎ Ｒｏｂｏｔｉｃｓ Ｒｅｓｅａｒｃｈ． Ｓｎｏｗｂｉｒｄ， Ｕｔａｈ，ＵＳＡ， １９９９： １６９⁃１７６． ［２９］ＰＡＧＡＣ Ｄ， ＮＥＢＯＴ Ｅ Ｍ， ＤＵＲＲＡＮＴ⁃ＷＨＹＴＥ Ｈ． Ａｎ ｅｖｉ⁃ ｄｅｎｔｉａｌ ａｐｐｒｏａｃｈ ｔｏ ｍａｐ⁃ｂｕｉｌｄｉｎｇ ｆｏｒ ａｕｔｏｎｏｍｏｕｓ ｖｅｈｉｃｌｅｓ ［ Ｊ ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｍａｔｉｏｎ， １９９８， １４（４）： ６２３⁃６２９． ［３０］ＣＡＤＥＮＡ Ｃ， ＮＥＩＲＡ Ｊ． ＳＬＡＭ ｉｎ Ｏ（ ｌｏｇｎ） ｗｉｔｈ ｔｈｅ ｃｏｍ⁃ ｂｉｎｅｄ Ｋａｌｍａｎ⁃ｉｎｆｏｒｍａｔｉｏｎ ｆｉｌｔｅｒ［ Ｊ］． Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｎｏ⁃ ｍｏｕｓ Ｓｙｓｔｅｍｓ， ２０１０， ５８（１１）： １２０７⁃１２１９． ［３１］ＭＵＲＰＨＹ Ｋ Ｐ． Ｂａｙｅｓｉａｎ ｍａｐ ｌｅａｒｎｉｎｇ ｉｎ ｄｙｎａｍｉｃ ｅｎｖｉｒｏｎ⁃ ｍｅｎｔｓ［Ｃ］ ／ ／ Ｐｒｏｃｅｅｄｉｎｇｓ ｏｆ ｔｈｅ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｎｅｕｒａｌ Ｉｎｆｏｒ⁃ ｍａｔｉｏｎ Ｐｒｏｃｅｓｓｉｎｇ Ｓｙｓｔｅｍ （ＮＩＰＳ）． Ｄｅｎｖｅｒ， ＵＳＡ， １９９９： １０１５⁃１０２１． ［３２］宋宇， 李庆玲， 康轶非， 等． 平方根容积 Ｒａｏ－Ｂｌａｃｋｗｉｌ⁃ ｌｉｓｅｄ 粒子滤波 ＳＬＡＭ 算法［ Ｊ］． 自动化学报， ２０１４， ４０ （２）： ３５７⁃３６７． ＳＯＮＧ Ｙｕ， ＬＩ Ｑｉｎｇｌｉｎｇ， ＫＡＮＧ Ｙｉｆｅｉ， ｅｔ ａｌ． ＳＬＡＭ ｗｉｔｈ ｓｑｕａｒｅ⁃ｒｏｏｔ ｃｕｂａｔｕｒｅ Ｒａｏ⁃Ｂｌａｃｋｗｉｌｌｉｓｅｄ ｐａｒｔｉｃｌｅ ｆｉｌｔｅｒ ［ Ｊ］． Ａｃｔａ Ａｕｔｏｍａｔｉｃａ Ｓｉｎｉｃａ， ２０１４， ４０（２）： ３５７⁃３６７． ［３３］ ＭＯＮＴＥＭＥＲＬＯ Ｍ， ＴＨＲＵＮ Ｓ． Ｓｉｍｕｌｔａｎｅｏｕｓ ｌｏｃａｌｉｚａｔｉｏｎ ａｎｄ ｍａｐｐｉｎｇ ｗｉｔｈ ｕｎｋｎｏｗｎ ｄａｔａ ａｓｓｏｃｉａｔｉｏｎ ｕｓｉｎｇ ＦａｓｔＳＬＡＭ［Ｃ］ ／ ／ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔ⁃ ｉｃｓ ａｎｄ Ａｕｔｏｍａｔｉｏｎ． Ｔａｉｐｅｉ， Ｃｈｉｎａ， ２００３： １９８５⁃１９９１． ［３４］康轶非， 宋永端， 宋宇， 等． 不依赖里程计的机器人定 位与地图构建［ Ｊ］． 浙江大学学报： 工学版， ２０１４， ４８ （３）： ４１４⁃４２２． ＫＡＮＧ Ｙｉｆｅｉ， ＳＯＮＧ Ｙｏｎｇｄｕａｎ， ＳＯＮＧ Ｙｕ， ｅｔ ａｌ． Ｓｉｍｕｌｔａ⁃ ｎｅｏｕｓ ｌｏｃａｌｉｚａｔｉｏｎ ａｎｄ ｍａｐｐｉｎｇ ｗｉｔｈｏｕｔ ｒｅｌｙｉｎｇ ｏｎ ｏｄｏｍｅｔｅｒ ［Ｊ］． Ｊｏｕｒｎａｌ ｏｆ Ｚｈｅｊｉａｎｇ Ｕｎｉｖｅｒｓｉｔｙ： Ｅｎｇｉｎｅｅｒｉｎｇ Ｓｃｉｅｎｃｅ， ２０１４， ４８（３）： ４１４⁃４２２． ［３５］ＬＩＵ Ｊ Ｓ． Ｍｅｔｒｏｐｏｌｉｚｅｄ ｉｎｄｅｐｅｎｄｅｎｔ ｓａｍｐｌｉｎｇ ｗｉｔｈ ｃｏｍｐａｒｉ⁃ ｓｏｎｓ ｔｏ ｒｅｊｅｃｔｉｏｎ ｓａｍｐｌｉｎｇ ａｎｄ ｉｍｐｏｒｔａｎｃｅ ｓａｍｐｌｉｎｇ ［ Ｊ］． Ｓｔａｔｉｓｔｉｃｓ ａｎｄ Ｃｏｍｐｕｔｉｎｇ， １９９６， ６（２）： １１３⁃１１９． ［３６］王宏健， 王晶， 刘振业． 基于迭代扩展 Ｋａｌｍａｎ 滤波建 议分布和线性优化重采样的快速同步定位与构图［ Ｊ］． 电子与信息学报， ２０１４， ３６（２）： ３１８⁃３２４． ＷＡＮＧ Ｈｏｎｇｊｉａｎ， ＷＡＮＧ Ｊｉｎｇ， ＬＩＵ Ｚｈｅｎｙｅ． Ｆａｓｔ ｓｉｍｕｌｔａ⁃ 第 ５ 期 刘建华，等：测距式传感器同时定位与地图创建综述 ·６６１·
662· 智能系统学报 第10卷 neous localization and mapping based on iterative extended [46 KURT-YAVUZ Z,YAVUZ S.A comparison of EKF, Kalman filter proposal distribution and linear optimization UKF,FastSLAM2.0,and UKF-based FastSLAM algo- resampling[J].Journal of Electronics Information Tech- rithms[C]//The 16th International Conference on Intelli- nology,2014,36(2):318-324. gent Engineering Systems.Lisbon,Portugal,2012:37- [37]张友民，焦凌云，陈洪亮，等.基于奇异值分解的固定 43. 区间平滑新方法[J].控制理论与应用，1997,14(4)： [47]张国良，汤文俊，敬斌，等.辅助粒子滤波算法改进的 579.583. UFastSLAM算法[J].哈尔滨工亚大学学报，2012,44 ZHANG Youmin,JIAO Lingyun,CHEN Hongliang,et al. (11):123-128. A new fixed-interval smoothing algorithm based on singular ZHANG Guoliang,TANG Wenjun,JING Bin,et al.Im- value decomposition[J].Control Theory Applications, proved UFastSLAM algorithm based on auxiliary particle fil- 1997,14(4):579-583 ter[J].Journal of Harbin Institute of Technology,2012, [38]曲从善，许化龙，谭营.一种基于奇异值分解的非线性 44(11):123-128. 滤波新算法[J].系统仿真学报，2009,21(9)：2650- [48]SONG Y,LI Q L,KANG Y F,et al.CFastSLAM:a new 2653. Jacobian free solution to SLAM problem[C]//IEEE Inter- QU Congshan,XU Hualong,TAN Ying.New nonlinear fil- national Conference on Robotics and Automation (ICRA). tering algorithm based on SVD[J].Journal of System Simu- Saint Paul,USA,2012:3063-3068. lation,2009,21(9):2650-2653 [49]穆静，蔡远利，张俊敏.容积粒子滤波算法及其应用 [39]丁帅华，陈雄，韩建达.基于局部子图匹配的SLAM方 [J].西安交通大学学报，2011,45(8)：13-17. 法[J].机器人，2009,31(4)：296-303 MU Jing,CAI Yuanli,ZHANG Junmin.Cubature particle DING Shuaihua,CHEN Xiong,HAN Jianda.A new solu- filter and its application[.Journal of Xi'an Jiaotong Uni- tion to SLAM problem based on local map matching[J]. versity,2011,45(8):13-17. Robot,2009,31(4):296-303. [50]于金霞，王璐，蔡自兴.未知环境中移动机器人自定位 [40]BOOTS B,GORDON G J.A spectral learning approach to 技术[M].北京：电子工业出版社，2011. range-only SLAM [C]//Proceedings of the 30th Interna- 作者简介： tional Conference on Machine Learning(ICML).Atlanta, 刘建华，男，1974年生，副教授，主 Georgia,USA,2013:19-26. 要研究方向为计算机控制与仿真、机器 [41]VAN DER MERWE R,WAN E A.The square-root un- 人路径规划、机器人定位。参与并完成 scented Kalman filter for state and parameter-estimation 省部级项目6项。发表学术论文30余 [C]//2001 IEEE International Conference on Acoustics, 篇，其中被EI检索7篇，STP收录6篇。 Speech and Signal Processing.Salt Lake,USA,2001: 3461-3464. [42]BHARANI CHANDRA K P,GU D W,POSTLETHWAITE 刘华平，男，1976年生，副教授，博 I.Cubature Kalman filter based localization and mapping 士，主要研究方向为智能控制与机器 [C]//18th IFAC World Congress.Milano,Italy,2011: 人、视频跟踪与检测、智能交通等。主 2121-2125. 持国家自然科学基金2项，发表学术论 [43]康轶非，宋永端，宋宇，等.平方根容积卡尔曼滤波在 文50余篇，其中被SC1EI收录10余 移动机器人SLAM中的应用[J].机器人，2013,35 篇。 (2):186-193. KANG Yifei,SONG Yongduan,SONG Yu,et al.Square- 杨建国，男，1951年生，教授，博士 root cubature Kalman filter and its application to SLAM of 生导师，主要研究方向为机电一体化、 an mobile robot[J].Robot,2013,35(2)186-193. 自动化。任中国自动化学会制造技术 [44]KIM C,SAKTHIVEL R,CHUNG W K.Unscented Fast- 专业委员会委员，中国机械工程学会高 SLAM:a robust and efficient solution to the SLAM problem 级会员，教育部《数字化纺织服装技术 [J].IEEE Transactions on Robotics,2008,24(4):808- 工程研究中心》常务副主任，上海市工 820. 程图学会理事等。主持并完成国家自然基金项目2项，国家 [45]KIM C,KIM H K,CHUNG W K.Exactly Rao-Black- “863”计划项目4项、国家技术创新项目1项及省部级科技 wellized unscented particle filters for SLAM C]//2011 攻关项目5项。获得发明专利3项，发表学术论文60余篇， IEEE International Conference on Robotics and Automa- 其中被EI、ISTP收录10余篇。 tion.Shanghai,China,2011:3589-3594
ｎｅｏｕｓ ｌｏｃａｌｉｚａｔｉｏｎ ａｎｄ ｍａｐｐｉｎｇ ｂａｓｅｄ ｏｎ ｉｔｅｒａｔｉｖｅ ｅｘｔｅｎｄｅｄ Ｋａｌｍａｎ ｆｉｌｔｅｒ ｐｒｏｐｏｓａｌ ｄｉｓｔｒｉｂｕｔｉｏｎ ａｎｄ ｌｉｎｅａｒ ｏｐｔｉｍｉｚａｔｉｏｎ ｒｅｓａｍｐｌｉｎｇ［Ｊ］． Ｊｏｕｒｎａｌ ｏｆ Ｅｌｅｃｔｒｏｎｉｃｓ ＆ Ｉｎｆｏｒｍａｔｉｏｎ Ｔｅｃｈ⁃ ｎｏｌｏｇｙ， ２０１４， ３６（２）： ３１８⁃３２４． ［３７］张友民， 焦凌云， 陈洪亮， 等． 基于奇异值分解的固定 区间平滑新方法［ Ｊ］． 控制理论与应用， １９９７， １４（４）： ５７９⁃５８３． ＺＨＡＮＧ Ｙｏｕｍｉｎ， ＪＩＡＯ Ｌｉｎｇｙｕｎ， ＣＨＥＮ Ｈｏｎｇｌｉａｎｇ， ｅｔ ａｌ． Ａ ｎｅｗ ｆｉｘｅｄ⁃ｉｎｔｅｒｖａｌ ｓｍｏｏｔｈｉｎｇ ａｌｇｏｒｉｔｈｍ ｂａｓｅｄ ｏｎ ｓｉｎｇｕｌａｒ ｖａｌｕｅ ｄｅｃｏｍｐｏｓｉｔｉｏｎ ［ Ｊ］． Ｃｏｎｔｒｏｌ Ｔｈｅｏｒｙ ＆ Ａｐｐｌｉｃａｔｉｏｎｓ， １９９７， １４（４）： ５７９⁃５８３． ［３８］曲从善， 许化龙， 谭营． 一种基于奇异值分解的非线性 滤波新算法［ Ｊ］． 系统仿真学报， ２００９， ２１（ ９）： ２６５０⁃ ２６５３． ＱＵ Ｃｏｎｇｓｈａｎ， ＸＵ Ｈｕａｌｏｎｇ， ＴＡＮ Ｙｉｎｇ． Ｎｅｗ ｎｏｎｌｉｎｅａｒ ｆｉｌ⁃ ｔｅｒｉｎｇ ａｌｇｏｒｉｔｈｍ ｂａｓｅｄ ｏｎ ＳＶＤ［Ｊ］． Ｊｏｕｒｎａｌ ｏｆ Ｓｙｓｔｅｍ Ｓｉｍｕ⁃ ｌａｔｉｏｎ， ２００９， ２１（９）： ２６５０⁃２６５３． ［３９］丁帅华， 陈雄， 韩建达． 基于局部子图匹配的 ＳＬＡＭ 方 法［Ｊ］． 机器人， ２００９， ３１（４）： ２９６⁃３０３． ＤＩＮＧ Ｓｈｕａｉｈｕａ， ＣＨＥＮ Ｘｉｏｎｇ， ＨＡＮ Ｊｉａｎｄａ． Ａ ｎｅｗ ｓｏｌｕ⁃ ｔｉｏｎ ｔｏ ＳＬＡＭ ｐｒｏｂｌｅｍ ｂａｓｅｄ ｏｎ ｌｏｃａｌ ｍａｐ ｍａｔｃｈｉｎｇ ［ Ｊ］． Ｒｏｂｏｔ， ２００９， ３１（４）： ２９６⁃３０３． ［４０］ＢＯＯＴＳ Ｂ， ＧＯＲＤＯＮ Ｇ Ｊ． Ａ ｓｐｅｃｔｒａｌ ｌｅａｒｎｉｎｇ ａｐｐｒｏａｃｈ ｔｏ ｒａｎｇｅ⁃ｏｎｌｙ ＳＬＡＭ ［ Ｃ］ ／ ／ Ｐｒｏｃｅｅｄｉｎｇｓ ｏｆ ｔｈｅ ３０ｔｈ Ｉｎｔｅｒｎａ⁃ ｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｍａｃｈｉｎｅ Ｌｅａｒｎｉｎｇ （ ＩＣＭＬ）． Ａｔｌａｎｔａ， Ｇｅｏｒｇｉａ， ＵＳＡ， ２０１３： １９⁃２６． ［４１］ ＶＡＮ ＤＥＲ ＭＥＲＷＥ Ｒ， ＷＡＮ Ｅ Ａ． Ｔｈｅ ｓｑｕａｒｅ⁃ｒｏｏｔ ｕｎ⁃ ｓｃｅｎｔｅｄ Ｋａｌｍａｎ ｆｉｌｔｅｒ ｆｏｒ ｓｔａｔｅ ａｎｄ ｐａｒａｍｅｔｅｒ⁃ｅｓｔｉｍａｔｉｏｎ ［Ｃ］ ／ ／ ２００１ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ａｃｏｕｓｔｉｃｓ， Ｓｐｅｅｃｈ ａｎｄ Ｓｉｇｎａｌ Ｐｒｏｃｅｓｓｉｎｇ． Ｓａｌｔ Ｌａｋｅ， ＵＳＡ， ２００１： ３４６１⁃３４６４． ［４２］ＢＨＡＲＡＮＩ ＣＨＡＮＤＲＡ Ｋ Ｐ， ＧＵ Ｄ Ｗ， ＰＯＳＴＬＥＴＨＷＡＩＴＥ Ｉ． Ｃｕｂａｔｕｒｅ Ｋａｌｍａｎ ｆｉｌｔｅｒ ｂａｓｅｄ ｌｏｃａｌｉｚａｔｉｏｎ ａｎｄ ｍａｐｐｉｎｇ ［Ｃ］ ／ ／ １８ｔｈ ＩＦＡＣ Ｗｏｒｌｄ Ｃｏｎｇｒｅｓｓ． Ｍｉｌａｎｏ， Ｉｔａｌｙ， ２０１１： ２１２１⁃２１２５． ［４３］康轶非， 宋永端， 宋宇， 等． 平方根容积卡尔曼滤波在 移动机器人 ＳＬＡＭ 中的应用［ Ｊ］． 机器人， ２０１３， ３５ （２）： １８６⁃１９３． ＫＡＮＧ Ｙｉｆｅｉ， ＳＯＮＧ Ｙｏｎｇｄｕａｎ， ＳＯＮＧ Ｙｕ， ｅｔ ａｌ． Ｓｑｕａｒｅ⁃ ｒｏｏｔ ｃｕｂａｔｕｒｅ Ｋａｌｍａｎ ｆｉｌｔｅｒ ａｎｄ ｉｔｓ ａｐｐｌｉｃａｔｉｏｎ ｔｏ ＳＬＡＭ ｏｆ ａｎ ｍｏｂｉｌｅ ｒｏｂｏｔ［Ｊ］． Ｒｏｂｏｔ， ２０１３， ３５（２）： １８６⁃１９３． ［４４］ ＫＩＭ Ｃ， ＳＡＫＴＨＩＶＥＬ Ｒ， ＣＨＵＮＧ Ｗ Ｋ． Ｕｎｓｃｅｎｔｅｄ Ｆａｓｔ⁃ ＳＬＡＭ： ａ ｒｏｂｕｓｔ ａｎｄ ｅｆｆｉｃｉｅｎｔ ｓｏｌｕｔｉｏｎ ｔｏ ｔｈｅ ＳＬＡＭ ｐｒｏｂｌｅｍ ［Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ， ２００８， ２４（４）： ８０８⁃ ８２０． ［４５］ ＫＩＭ Ｃ， ＫＩＭ Ｈ Ｋ， ＣＨＵＮＧ Ｗ Ｋ． Ｅｘａｃｔｌｙ Ｒａｏ⁃Ｂｌａｃｋ⁃ ｗｅｌｌｉｚｅｄ ｕｎｓｃｅｎｔｅｄ ｐａｒｔｉｃｌｅ ｆｉｌｔｅｒｓ ｆｏｒ ＳＬＡＭ ［ Ｃ］ ／ ／ ２０１１ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｍａ⁃ ｔｉｏｎ． Ｓｈａｎｇｈａｉ， Ｃｈｉｎａ， ２０１１： ３５８９⁃３５９４． ［ ４６ ］ ＫＵＲＴ⁃ＹＡＶＵＺ Ｚ， ＹＡＶＵＺ Ｓ． Ａ ｃｏｍｐａｒｉｓｏｎ ｏｆ ＥＫＦ， ＵＫＦ， ＦａｓｔＳＬＡＭ２． ０， ａｎｄ ＵＫＦ⁃ｂａｓｅｄ ＦａｓｔＳＬＡＭ ａｌｇｏ⁃ ｒｉｔｈｍｓ［Ｃ］ ／ ／ Ｔｈｅ １６ｔｈ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｉｎｔｅｌｌｉ⁃ ｇｅｎｔ Ｅｎｇｉｎｅｅｒｉｎｇ Ｓｙｓｔｅｍｓ． Ｌｉｓｂｏｎ， Ｐｏｒｔｕｇａｌ， ２０１２： ３７⁃ ４３． ［４７］张国良， 汤文俊， 敬斌， 等． 辅助粒子滤波算法改进的 ＵＦａｓｔＳＬＡＭ 算法［ Ｊ］． 哈尔滨工业大学学报， ２０１２， ４４ （１１）： １２３⁃１２８． ＺＨＡＮＧ Ｇｕｏｌｉａｎｇ， ＴＡＮＧ Ｗｅｎｊｕｎ， ＪＩＮＧ Ｂｉｎ， ｅｔ ａｌ． Ｉｍ⁃ ｐｒｏｖｅｄ ＵＦａｓｔＳＬＡＭ ａｌｇｏｒｉｔｈｍ ｂａｓｅｄ ｏｎ ａｕｘｉｌｉａｒｙ ｐａｒｔｉｃｌｅ ｆｉｌ⁃ ｔｅｒ［ Ｊ］． Ｊｏｕｒｎａｌ ｏｆ Ｈａｒｂｉｎ Ｉｎｓｔｉｔｕｔｅ ｏｆ Ｔｅｃｈｎｏｌｏｇｙ， ２０１２， ４４（１１）： １２３⁃１２８． ［４８］ＳＯＮＧ Ｙ， ＬＩ Ｑ Ｌ， ＫＡＮＧ Ｙ Ｆ， ｅｔ ａｌ． ＣＦａｓｔＳＬＡＭ： ａ ｎｅｗ Ｊａｃｏｂｉａｎ ｆｒｅｅ ｓｏｌｕｔｉｏｎ ｔｏ ＳＬＡＭ ｐｒｏｂｌｅｍ［Ｃ］ ／ ／ ＩＥＥＥ Ｉｎｔｅｒ⁃ ｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｍａｔｉｏｎ （ ＩＣＲＡ）． Ｓａｉｎｔ Ｐａｕｌ， ＵＳＡ， ２０１２： ３０６３⁃３０６８． ［４９］穆静， 蔡远利， 张俊敏． 容积粒子滤波算法及其应用 ［Ｊ］． 西安交通大学学报， ２０１１， ４５（８）： １３⁃１７． ＭＵ Ｊｉｎｇ， ＣＡＩ Ｙｕａｎｌｉ， ＺＨＡＮＧ Ｊｕｎｍｉｎ． Ｃｕｂａｔｕｒｅ ｐａｒｔｉｃｌｅ ｆｉｌｔｅｒ ａｎｄ ｉｔｓ ａｐｐｌｉｃａｔｉｏｎ［Ｊ］． Ｊｏｕｒｎａｌ ｏｆ Ｘｉ’ａｎ Ｊｉａｏｔｏｎｇ Ｕｎｉ⁃ ｖｅｒｓｉｔｙ， ２０１１， ４５（８）： １３⁃１７． ［５０］于金霞， 王璐， 蔡自兴． 未知环境中移动机器人自定位 技术［Ｍ］． 北京： 电子工业出版社， ２０１１． 作者简介： 刘建华，男，１９７４ 年生，副教授，主 要研究方向为计算机控制与仿真、机器 人路径规划、机器人定位。 参与并完成 省部级项目 ６ 项。 发表学术论文 ３０ 余 篇，其中被 ＥＩ 检索 ７ 篇，ＩＳＴＰ 收录 ６ 篇。 刘华平，男，１９７６ 年生，副教授，博 士，主要研究方向为智能控制与机器 人、视频跟踪与检测、智能交通等。 主 持国家自然科学基金 ２ 项，发表学术论 文 ５０ 余篇，其中被 ＳＣＩ、ＥＩ 收录 １０ 余 篇。 杨建国，男，１９５１ 年生，教授，博士 生导师，主要研究方向为机电一体化、 自动化。 任中国自动化学会制造技术 专业委员会委员，中国机械工程学会高 级会员，教育部《数字化纺织服装技术 工程研究中心》 常务副主任，上海市工 程图学会理事等。 主持并完成国家自然基金项目 ２ 项，国家 “８６３”计划项目 ４ 项、国家技术创新项目 １ 项及省部级科技 攻关项目 ５ 项。 获得发明专利 ３ 项，发表学术论文 ６０ 余篇， 其中被 ＥＩ、ＩＳＴＰ 收录 １０ 余篇。 ·６６２· 智 能 系 统 学 报 第 １０ 卷
