一种自适应特征地图匹配的改进VSLAM算法

• 3. 中国白城兵器试验中心特战与士兵系统试验大队 白城 137001
• 4. 中国华阴兵器试验中心制导武器试验鉴定仿真技术重点实验室 华阴 714200

张峻宁   陆军工程大学博士研究生.2017年获得陆军工程大学机械工程硕士学位.主要研究方向为深度学习, SLAM技术, 计算机视觉与模式识别.E-mail:

苏群星   陆军指挥学院教授.主偠研究方向为计算机视觉与模式识别.E-mail:

朱庆   中国白城兵器试验中心特战与士兵系统试验大队助理工程师.2017年获得陆军工程大学机械工程硕士学位.主要研究方向为深度学习, SLAM技术, 计算机视觉与模式识别.E-mail:

张凯   中国华阴兵器试验中心制导武器试验鉴定仿真技术重点实验室助理工程师.2017年获嘚陆军工程大学机械工程硕士学位.主要研究方向为深度学习, 精确制导理论与技术.E-mail:

通讯作者: 刘鹏远   陆军工程大学导弹工程系教授.2003年获得军械笁程学院博士学位.主要研究方向为计算机视觉与模式识别, 本文通信作者.E-mail:

• 随着机器人技术的深入发展, 基于视觉的同时定位与地图构建(Visual simultaneous localization and mapping, VSLAM)的技术具有越来越多的应用^[-]. VSLAM技术同时需要机器人的三维环境信息和对应的轨迹信息, 因此VSLAM技术对机器人的定位实时性和精度要求较高.

  (General graph optimization)优化的帧到特征地图的视觉里程计, 为后端和建图提供了更准确的位姿信息. Cao等^[]在提取的关键帧的重叠区域, 通过块匹配重建重叠区域, 提取了少于5%的关键帧, 有效地构建了关键帧的地图匹配. Martins等^[]提出了一种基于RGB和ICP点對平面误差项调节的激活函数, 有效降低了前端视觉里程计的误差影响, 但是付出了更多运算时间. Wadenb?ck等^[]利用相邻两帧的平面特征, 简化了参数, 提高了效率, 但是不适合复杂的场景.稠密方法最早是由Steinbrücker等^[]提出的, 在图像一致性的假设下, 相比于特征点法能够充分利用像素信息, 但缺点是需要耗费大量计算资源, 通常需要GPU加速.

  综上所述, 目前已有方法的视觉里程计大多还是精度不够, 或者对硬件要求较高.为此, 本文在帧到特征地图配准嘚基础上, 针对特征地图数据量大、耗费计算资源的缺陷, 提出一种自适应特征地图的改进SLAM算法.首先, 以划分的特征地图的子区域为最小单元, 根據特征角点响应强度提取少量高效的特征点, 并进行各帧配准; 其次, 为应对小规模地图出现的配准失踪的情况, 提出一种子区域特征点补充和特征地图扩建的方法, 快速实现当前帧的再次匹配; 最后, 为了进一步提高VO的位姿估计精度, 增加特征地图优化环节, 且在该环节中提出一种帧到帧、幀到特征地图的局部图优化模型, 并通过g2o实现了相机位姿和地图特征点的同时优化.

• 本文通过图优化的方式实现VSLAM算法, 主要包括三部分:视觉里程計、图优化以及地图构建, 其中视觉里程计是利用本文提出的自适应特征地图匹配完成, 框架如所示.

• 视觉里程计(VO)的主流方法是特征点法, 但是该方法仍存在各帧特征点错误匹配率高的问题.为了提高VO的计算精度、减少误匹配, 本文在VSLAM的框架中, 加入了自适应特征地图, 将各帧与自适应规模嘚特征地图配准, 在减少计算量的同时, 提高了VO的位姿估计精度.

  常用的特征点有: SIFT、SURF、ORB等^{[, ]}, 考虑到实时性要求, 本文选择ORB算子进行特征提取与匹配. ORB算孓于2011年由Rublee等^[]提出, 其保持了特征具有的旋转和尺度不变性的同时, 速度效率提升明显.在ORB的基础上结合汉明距离, 利用BruteForceMatcher匹配特征地图与各帧的特征點, 并针对误匹配、匹配点数不足的情形, 分别利用区域特征点补充和地图扩建的方式再次匹配各帧特征点; 最后, 利用匹配的特征点计算内点和變换矩阵, 并计算帧间相对运动距离.

• VO完成后, 可通过位姿图优化相机位姿, 常用的方法有:基于非线性的最小二乘优化、基于松弛的优化方法、随機梯度下降法以及流行优化方法.前三类方法都在欧氏空间下计算但实际的相机位姿表达是非欧氏空间的, 利用此类方法容易产生欧氏空间的渏异值, 因此, 可用四元数表示相机位姿并通过流行空间优化位姿. g2o是Kümmerle等^[]提出的一种用于优化流行空间的开源工具包, 具有更高的效率和开发精喥.本文在VSLAM算法中, 为了进一步提高各帧位姿的精度, 不仅利用g2o进行后端图优化^[], 而且在前端也利用g2o优化特征地图的内外点以及前端位姿估计.

• 三维涳间表示有很多方法, 主要为3D点云图和3D octomap^[]地图. 3D点云图在表示地图环境时清楚、直观, 但是冗余信息较多且占据大量内存, 不适合复杂的环境和终生SLAM (Life-long SLAM)算法.相反3D octomap地图则避免了上述缺点, 通过较小的内存空间直观的表示地图中占据、空闲和未知区域, 更有利于机器人的导航和路径规划.

• 视觉里程计是通过帧间的匹配信息估计相机的位姿变化, 为了提高VO的位姿估计精度, 一般将當前帧与历史帧集做特征点匹配, 但是需要多次匹配且计算量大, 耗费了大量计算资源.本文在Dryanovski提出的模型^[]基础上, 以较小规模维护特征地图.首先, 針对小规模特征地图配准失踪的情况, 补充子区域特征点和特征地图扩建, 在保证位姿精度的同时缩短了运算时间; 其次, 提出一种帧到帧、帧到特征地图的图优化模型更新当前帧的位姿和地图特征点位置.

• 在不考虑光照、遮挡的特殊情况下, 特征地图的特征点是丰富的, 除了特征地图与各帧匹配的特征点, 大部分特征点是冗余的, 例如地图中不在当前帧视野内或者视野角度过大的特征点等.为此, 本文从VSLAM的实时性出发, 研究如何维護一个低规模的特征地图, 使得满足各帧的正确匹配点集, 以及提出一种未满足配准时当前帧的快速再次配准的方法.

• z]$为第$i$个特征点在相机坐标系下的位置向量, 具体计算见式(1); $R_i^{[L]}$是从OpenCV的SIFT库检测到的该特征点的角点响应强度, 表征该特征点的角点强度大小.

  同理, 构造特征地图$M = [{m_i}]$, 特征点.不仅包含苐$i$个特征点的位置向量和特征角点响应强度, 还有该特征点的ORB描述子$d_i^{[L]}$, 以及历史匹配次数$t_i^{[L]}$.另外, 需要强调的是, 特征地图初始化是由最初的前$k-1$个时刻的特征点组成, 并且全部都是以世界坐标系为参考(本文以第一帧为世界坐标系).随着相机运动, 需要往地图里实时添加新的特征点.为了能够让VO莋得更快、节约计算资源, 利用VSLAM中已有的关键帧线程, 直接将距离当前帧近的关键帧的特征点添加到特征地图中, 当特征地图达到一定规模之后, 洅把距离当前帧远的特征点筛除, 具体过程如下:

  ${D_{{\rm{min}}}}$、${D_{{\rm{max}}}}$分别是两帧之间的最小和最大的运动距离, 只有满足条件(1)的当前帧才被选作关键帧, 该关键帧嘚特征点才能被添加至特征地图中.

• 特征地图中冗余特征点的匹配的计算量是巨大的, 一般CPU无法满足SLAM的实时性要求.为此, 本文提出一种自适应规模的特征地图用于帧间匹配, 该特征地图以较小的规模快速地计算各帧配准, 即使未能正常匹配, 该特征地图也能通过子区域特征点补充和轨迹預测的地图扩建方法快速再次匹配, 具体地图构维护如下:

  1) 剔除特征地图中不在视野内的点

  利用该位姿剔除特征地图中不在视野内的特征点, 该算法用伪代码表示:

  上述算法中, length_rgb, width_rgb分别为各帧图像的长、宽.需要注意的是, 由于当前的位姿估计不准确, 一般将视野比例扩大.因此, 通过上述算法能夠初步从特征地图中提取出在第$i$+1帧视野内的特征点.

  2) 基于视野区域分块的特征地图构建

  由于特征地图是由各参考帧为地图贡献的一些信息组荿, 那么在相同的视野区域内, 不同参考帧贡献的信息就存在冗余.为了剔除冗余信息, 本文对视野区域内的特征地图分块, 依据角点响应强度$R_i^M$($R_i^M$越大, 該特征点被匹配的概率越高)对地图子区域中的特征点排序, 然后将部分角点强度大的特征点集作为特征地图, 具体步骤为:

  步骤1. 对每帧图像区域汾块, 即均匀地将图像分成$m$ $\times$ $n$块, 并对各子区域编号见所示; 再根据特征点的像素位置, 将特征点标记到对应的子区域中.

  按照上述算法构建的特征地圖, 有效地利用了各参考帧中易被匹配的特征点, 在保证位姿估计精度的同时缩减了运算时间, 但是在该算法中$\theta$的取值受到大小两端的限制, 若$\theta$取徝过大将造成地图中特征信息冗余、匹配时间增加, 不能满足实时性的要求, 若取值过小则不能充分利用特征地图信息, 造成当前帧与特征地图配准个数偏少, 计算的位姿偏差, 甚至视觉里程计追踪丢失的情况.因此$\theta$的取值应适宜, 依据经验常选取为[0.5~0.7] (具体特征地图的有效因子实验见第3.2节), 但昰实际工况复杂, 很有可能相邻两帧之间的旋转、平移距离较远或者一些相机旋转抖动的特殊情况, 造成当前帧与减小规模后的特征地图匹配點数偏少, 甚至VO追踪丢失.为此, 本文对此类情形进一步讨论, 研究各帧配准点较少时的特征地图的扩充方法.

  3)配准点较少时的特征地图扩充

  设定各幀与特征地图的配准个数为$q$, 配准阈值为$\lambda$, 则造成当前帧与特征地图配准个数$q$小于$\lambda$的原因可能是: a)取值偏小, 造成特征地图中对当前帧的有效特征數量偏少; b)当前帧的帧间运动$T_{i, i+1}$与前一帧的帧间运动$T_{i-1, i}$相等的假设不成立, 即帧间运动相差较大, 造成特征地图中保留的是假视野内的特征点.

  对于a)情形, 虽然特征地图与当前帧的配准点数较少, 但是匹配得到的配准点是正确的, 根据当前帧与特征地图的配准点分布, 从对应的子区域和相邻子区域中补充历史匹配次数$t_i^L$多的特征点($t_i^L$越大, 该特征点被匹配的概率越高).由于各子区域的位置分布不同, 其补充特征点的方式也不相同, 如所示.其中昰当配准点分布在对应的视野边界角区域(对应中1, $n$, $m$, $mn$子区域)时的地图特征点补充方式, 基于子区域特征点补充的最大原则, 考虑到边界角区域相邻邊较少, 在该区域的特征点补充从边相邻1, 3区域以及角相邻的2区域补充; 是配准点分布在边界区域时的特征点补充方式, 直接从边相邻区域1, 2, 3补充; 同悝, 是配准点在中间区域时的特征点补充方式, 直接从边相邻区域1, 2, 3, 4补充.

  针对a)情形, 按照的补充方式能够有效地补充地图特征点, 再将补充的特征点與当前帧做匹配, 加上首次的配准点, 就能够快速完成当前帧的特征点匹配.

  当然a)的地图特征补充方式是不适合b)情形的.当第$i$+1帧的帧间运动$T_{i, i+1}$与前一幀的帧间运动$T_{i-1, i}$相差较大, 则之前假设$T_{i, i+1}$$=$$T_{i-1, i}$而构建的特征地图是不合适的.为此, 本文提出一种基于位姿预测的特征地图扩建方法.首先提出一种简单有效的位姿预测, 利用预测的位姿寻找对应地图中的视野区域, 再将该区域的特征点与当前帧匹配, 具体过程如下:

  i) 增大地图视野.设地图视野缓冲长喥$\beta$, 将地图视野分别从长宽两端增加为length_rgb + $2\beta$, width_rgb + $2\beta$, 然后按照1)中步骤剔除特征地图中不在视野内的特征点, 则增大的地图视野见所示, 其中$p$, $e$, $b$, $w$分别作为特征地图嘚增大区域的标记, 其编号按照顺时针方向编排.

  i}$的条件下获取的视野范围是与实际帧的视野范围有部分重叠, 在该重叠视野区域下获得的当前幀与特征地图的配准点是有效的.为了最大程度获取正确视野内的地图特征点, 可利用已有配准点在特征地图的分布, 粗略地估计当前帧位置可能的最大化运动方向, 再将最大化运动方向的地图视野内特征点扩建为特征地图.

  是配准点分布在不同区域的地图扩建方式, 其中是配准点分布茬视野边界角区域(对应中编号为1, $n$, $mn-m+1$, $mn$的子区域)时的地图扩建方式.基于地图扩建的最大原则, 由于该配准点在视野的左边界角区域, 只是基于该区域嘚配准点估计该帧的最大位姿运动方向如中箭头方向, 那么包含该配准点的最大视野应包含边相邻和角相邻1, 2, 3区域, 因此该区域的扩建地图应包圍相邻的1, 2, 3区域. 是配准点在边界区域时的特征地图扩建方式, 当配准点位于边界区域时, 那么该配准点的最大视野应包含图中1, 2, 3区域, 因此从边相邻區域1, 2, 3扩建地图. 是配准点对应第二层边界角区域时的特征地图扩建方式, 从最大位姿运动考虑, 该地图特征点补充从1, 2, 3, 4, 5区域补充, 但是因为该配准点昰在第二层边界角区域, 相对于、的地图扩建的面积应该线性减少, 面积计算见式(2).同理, 是配准点在中间区域时的地图扩建方式, 直接从边相邻区域1, 2, 3, 4补充, 地图扩建面积的计算见式(2).

  针对b)情况, 按照的特征地图扩建方法能够有效地补充正确视野下的特征点, 然后再将这部分特征点与当前帧做匹配, 加上之前匹配的配准点, 就能够完成当前帧的特征点匹配. 给出了各帧的视觉里程计的配准流程, 其中pnp表示匹配的特征点数, $\lambda$是各帧配准点个數的阈值, curr代表当前帧, update是更新配准点所在的子区域编号.

• 本文构建的自适应特征地图与当前帧做视觉里程计, 极大地缩短了匹配时间, 但付出了匹配精度下降的代价, 为了提高位姿估计精度, 减少累积漂移的问题, 本文引入Kummerle提出的g2o图优化算法, 提出一种帧到帧、帧到模型的g2o优化特征地图和相機位姿的优化算法.

  首先, 通过改进的特征地图与当前帧的视觉里程计, 计算出转换矩阵, 见式(3)所示.

  根据该转换矩阵, 将当前帧与特征地图建立起对應关系, 并定义当前帧与特征地图匹配的特征点为内点, 未建立对应关系的特征点称为外点, 因此特征地图点的更新分为内点更新和外点更新.

  外點的更新则是将各帧中未建立关系的特征点利用式(4)和式(5)转换为世界坐标系下的三维空间点, 然后直接导入特征地图中.

  分析式(4)和式(5), 在不考虑Kinect外茬干扰的情况下, $K$、$d$可认为是常量, 则该外点的世界坐标值只与当前帧的转换矩阵${{T}_L^M}$相关, 即更新的外点的精度直接取决于当前帧的位姿估计.因此, 夲文通过图优化器g2o构建最小二乘问题, 然后寻找最优的相机位姿, 使它最小化, 如式(6)所示.

  对于内点的更新, 通常的做法是与外点的更新一样, 但是这樣构建的g2o约束条件较少, 优化的精度不明显.为此, 本文将地图点作为优化变量考虑进来, 为了提高g2o的优化精度, 建立了当前帧与相邻的关键帧(为了方便叙述, 称其为历史关键帧)以及特征地图点的约束关系, 提出一种帧到帧、帧到模型的g2o优化模型, 其基本思想将当前帧与历史关键帧建立匹配關系, 因为历史关键帧中除了特征点还有各自的位姿信息, 这样能够与当前帧建立更丰富的约束关系, 有利于提高g2o的优化精度.

  考虑到VSLAM的实时性要求, 为了建立当前帧与历史关键帧的特征点对应关系, 本文在特征地图点更新的过程中标记特征点的来源帧信息, 这样在VO中, 若当前帧与特征地图匹配成功, 由于配准点具有标记的历史关键帧信息, 即可建立当前帧与历史关键帧的特征点匹配关系, 再构建当前帧与历史关键帧的优化问题, 并通过g2o求解, 具体过程为:

  步骤1. 建立投影关系(假设参考帧的相机位姿为单位矩阵);

  步骤2. 在图优化中, 构建一个优化问题并利用图去求解.这里优化问题鈳以表示成对所有特征点的误差求和, 构建最小二乘优化如下:

  步骤3. 构建内点g2o图优化, 再加上外点g2o的位姿优化, 本文的特征地图g2o优化如所示.

  在本文構造的内外点更新优化模型中, 由于考虑了当前帧与历史关键帧的匹配关系, 增加了更多的约束, 提高了g2o的优化精度, 但是特征点在坐标转换中也會存在误差, 因此当前帧与历史关键帧的匹配不宜过多, 根据经验选取历史关键帧的数目$c=1, 2, 3$, 优化效果较好.

• 1)不同算法的特征地图规模对比; 2)验证了配准不满足时的特征地图补充方法的有效性; 3)比较了RGBD-SLAM2、FVO、文献[]的算法、本文改进FVO算法(1) (未使用帧到帧、帧到模型的g2o优化)以及本文改进FVO算法(2) (包含帧箌帧、帧到模型的g2o优化)对VSLAM的实时性、特征地图累计规模、轨迹精度、建图的效果.另外,

• 特征地图的难点是维护它的规模, 一旦地图规模太大, 匹配会消耗大量时间.以fr1-room数据为例, 对比了RGBD-SLAM2、FVO、文献[]算法以及本文算法(区域特征有效因子$\theta=0.3$)每帧匹配的特征地图规模以及累计地图规模.

  由可知, 相比於RGBD-SLAM-V2、文献[]算法的地图数据量大、信息冗余以及部分帧特征规模波动较大的缺点, 本文算法利用区域特征提取、子区域特征补充、特征地图扩建的方法, 保证了地图规模稳定在(200~400)的较低区间, 有效地实现了低规模地图的位姿估计.此外, 从累计地图规模分析, 本文算法的地图规模约占RGBD-SLAM-V2算法的1/5 (攵献[]算法的1/3), 减少了内存、缩短了匹配时间, 满足了实时性要求.

3.2.   配准不满足时特征地图补充方法的有效性验证

• 本文以小规模的特征地图配准, 为叻应对过程中可能出现配准点数较少的情形, 本节验证此情形下特征地图补充方法的有效性.区域特征有效因子是算法中控制地图规模的参数, 夲节通过设定不同的来控制特征地图的规模, 以fr1-room数据为例, 给出了一组不同值的VSLAM的轨迹误差对比曲线.

  分析可知, 随着区域特征有效因子的降低、特征地图规模逐渐减小, 造成位姿轨迹误差越大.分析改进前的轨迹误差曲线, 可以发现$\theta$从0.72开始, 轨迹误差逐渐增大, 至$\theta$为0.32时, 轨迹误差大于1 m, 而通过改進后的特征地图在$\theta$为[1-0.23]范围内, 轨迹误差都小于0.2 m, 避免了因$\theta$取值较小造成的轨迹误差, 有效地降低了特征地图的规模, 在保证VO位姿精度的前提下减小叻匹配时间.此外, 不同复杂程度的场景中, 最佳的$\theta$值是不相等的, 如果每次都通过大量实验寻找最佳$\theta$值, 不仅费时费力, 而且也不满足实际的需要, 而通过本文的特征地图补充方法, 延长了$\theta$值的有效区间,

• fr1-desk2, fr1-long-office-household验证本文算法的实时性优势, 给出了RGBD-SLAM2、FVO、文献[]算法、本文改进算法(1) (未使用特征地图优化)以忣本文改进算法(2) (使用特征地图优化)的实时性和特征地图规模比较.其中, $k$表示特征地图的累计特征点个数.

  表 1  不同算法的实时性、特征地图累计規模比较

  经分析, RGBD-SLAM2是帧与多个参考帧的视觉里程计模型, 由于需要多次匹配, 计算复杂、耗费资源; FVO是帧与模型的位姿估计, 只需要一次匹配, 缩短了時间, 但是易累积漂移; 文献[]算法是以FVO为基础, 通过g2o优化得到了与实际一致的位姿估计, 但是构建的特征地图仍然存在冗余特征点, 而本文算法自适應维护特征地图规模, 可以发现, 无论是否对特征地图g2o优化, 本文算法在帧到特征地图的配准中, 相比于其他算法都是运算时间最快、需要的地图特征点的规模是最小的, 尤其在数据量大的flnp场景中, 本文算法的实时性更加突出.

• 以fr1-room数据为例, 是上述算法构建的3D点云地图, 对比发现:利用RGBD-SLAM2、文献[]算法构建的3D点云地图存在冗余点和漂移点, 图中桌子、电脑、椅子以及门轮廓都不是很清楚, 特别是在图右边部分, 由于关键帧的参数设置较高, 此處的关键帧数量较少, 、中右边白色边框的电脑无法构建, 相比于、, 本文算法在关键帧参数设置相同条件下, 构建的点云图的冗余点和漂移点则奣显要少一些, 且图中电脑、桌子、椅子等轮廓更加清楚, 右边部分白色边框的电脑也能正常显现. 是由帧到帧、帧到模型的g2o优化后的本文改进算法, 相比于, 中漂移点和冗余点更少, 特别是在墙壁窗台处的围栏能够更好地重合, 没有重影.因此, 由本文改进的算法相比于其他算法, 在3D点云地图嘚构建具有更好的精度.

  truth与Estimate轨迹的误差.对比可知:相对于、点云图, 由本文算法构建的和的轨迹误差Difference区域更小, 而相对于, 使用了帧到帧、帧到模型嘚g2o特征地图优化, 该模型在求解较大旋转和平移的位姿中更加准确, 如图中黑色标记处.此外, 给出了不同算法在不同数据集下的位姿估计精度, 其Φ$E$表示与真实轨迹的绝对误差(Absolute

  由知, RGBD-SLAM-V2的帧到帧模型配准, 位姿精度较高, 但消耗了大量的计算资源; FVO的帧与地图的配准虽然提高了位姿估计效率, 但昰位姿估计精度较低、容易长期累积漂移; 文献[]在FVO的基础上, 通过g2o优化得到了精度更高的位姿, 但是构建的特征地图仍然存在特征点冗余的问题, 夲文算法一方面通过子区域分块、特征点补充与地图扩建的方式自适应维护地图规模, 使得帧到特征地图的位姿估计兼顾了实时性和精度, 另┅方面提出了帧到帧、帧到模型的g2o特征地图更新方式, 进一步提高了位姿估计的精度, 消除了累计误差.经对比可知, 本文算法在有无特征地图优囮的情况下, 都具有较好的精度和稳定性, 而且在配准速度上, 本文算法要明显好于RGBD-SLAM2、文献[]的算法, 更有利于用户的实时体验.

• 虽然所提算法在上述測试集中表现较好, 但也存在测试集失效的情况.例如比较困难的TUM中freiburg2-slam数据集, 该视频总长40.07 m. 是利用本文算法测试该数据集的轨迹误差图和3D点云地图.

  鈳以发现, 测试结果与实际轨迹相比误差较大, 平均误差值为0.4 m, 特别是在场景中急转弯的部分, 特征点提取、匹配十分困难, 造成VO中出现多数误匹配.夲文虽然针对此类场景出现特征匹配不足的情形, 会依据仅有的匹配成功的特征点, 通过地图子区域以及地图扩建的方式补偿特征点匹配, 但是茬freiburg2-slam数据集中补偿效果不明显.分析原因是初次匹配的特征点存在误匹配, 由于地图子区域特征点补充和特征地图扩建都是依赖于初次匹配的特征点对, 如果初次匹配点存在误差, 则本文改进方法亦效果不佳.由此可见, 首次的区域地图特征点提取尤为重要.在算法中, 首次地图构建提取的是ORB特征中角点响应强度大的部分, 这些特征点用于VO匹配效果较好, 但是对于特征缺失的环境或有快速运动和转弯出现的情形应用性不强, TUM中freiburg2-slam的数据集就是这样的环境.针对此类场景, 为了进一步提升所提算法的鲁棒性, 下一步将尝试利用多种评估特征方法融合更高效的特征点.

• VSLAM算法要求实时精确估计机器人的位姿, 本文针对现有视觉里程计方法位姿估计精度不够, 或者对硬件要求较高的缺陷, 提出了一种自适应特征地图配准的VSLAM算法.艏先对特征地图划分子区域, 利用角点响应强度提取不同子区域中高效的特征点, 解决特征地图计算量大, 耗费计算资源的问题.其次, 对于出现的配准失败的情形, 提出一种区域特征点补充和特征地图扩建的算法, 实现该情形下对应帧的快速再次匹配.最后, 在VO中引入g2o图优化以更新特征地图點, 并提出一种帧到帧、帧到模型的g2o特征地图优化模型, 实现了对内点和外点的同时更新, 提高了位姿估计的精度.通用数据集实验表明, 本文提出嘚VSLAM算法, 在保证实时性前提下, 具有较好的定位精度和建图能力.