论文部分内容阅读
智能车是结合人工智能、机器人学、控制规划等多门学科的综合应用研究。涉及到目标检测、场景理解、高精度定位、路径规划、运动控制等众多关键技术。在支撑智能车的众多技术中,高精度定位是其中最为基础且关键的。智能车所行驶的环境大多为已知环境,因此基于点云匹配的定位成为目前主流的定位方法。基于点云匹配的定位中最常用的两种传感器包括视觉传感器与激光雷达,由于视觉传感器对于光线变化、天气变化等状况的鲁棒性较差,基于激光雷达的定位方案越来越受到青睐。但基于激光雷达的定位方法由于地图存储量大、环境表示效率低、地图管理难度大、地图匹配算法鲁棒性差等缺点使得其应用受到制约。为解决以上问题,本文提出了一种基于点云匹配的定位框架。为解决点云匹配中的精度与鲁棒性问题,本文提出了鲁棒的点集配准算法。具体工作如下:针对点云地图数据存储量大,不适用于大范围定位的问题。本文对拼接点云进行三维栅格化与平面压缩处理生成感知地图。首先将点云转换成三维占据栅格图,并采用八叉树的格式进行存储。这不仅可以降低存储量、抽取有用信息,还可以通过多分辨率格式,提高定位的鲁棒性与实时性。在道路两侧结构特征明显的区域,进一步压缩八叉树地图,得到街景压缩地图。街景压缩地图的存储量可降低到原始点云存储量的千分之一。本文给出了基于点云匹配的智能车定位算法框架。并且将地图匹配作为观测,融合车辆运动数据,增强定位的鲁棒性。针对对应点选取对初始值依赖较大的问题,本文提出基于图同构的对应点选取算法。首先根据点与点之间的几何关系构建图,并得到相应的邻接矩阵。由此构建的两个点集的邻接矩阵为同构矩阵,通过寻找一个置换矩阵建立二者的同构关系,进而得到对应点关系。为此本文构建了一个优化问题,并通过蒙特卡洛方法求解。采用交替方向乘子算法在蒙特卡洛优化的观测更新中对粒子权重进行更新。实验结果表明当初始值、噪声等干扰逐步增大时,该算法的对应点选择正确率相比于传统算法可提高50%以上。针对点云匹配容易受噪声、外点等干扰问题,本文提出了基于容积卡尔曼滤波的点集配准算法。首先,本文将点集配准问题用状态空间模型表示,由此将点集配准问题转换为滤波问题。由于该问题是高度非线性的,常规的滤波方法精度难以满足要求。因此本文采用容积卡尔曼滤波方法,利用数值方法近似滤波中非线性部分。相比于扩展卡尔曼滤波和无迹卡尔曼滤波,容积卡尔曼滤波可将非线性近似到三阶。实验结果表明,该方法对于噪声、外点、初始值都具有较强的鲁棒性。相比于当前广泛应用的点集配准算法,当噪声大小达到30%时,该方法匹配成功率可提高20%以上;当外点数量达到50%时,该方法匹配成功率可提高30%以上;当结构性缺失大小达到50%时,该方法匹配成功率可提高30%以上。采用容积卡尔曼滤波求解点集配准问题,提高了算法对于单一误差源的鲁棒性与精度。但卡尔曼滤波没有考虑两个数据之间的关联性,多种相关联的误差源同时存在时,算法精度有所降低。为此本文提出了容积分离协方差交集滤波算法求解点集配准问题。该方法将滤波中的方差分为两部分:独立方差与非独立方差,并分别进行处理。这对于处理点集配准中常见两类误差(独立误差与非独立误差)具有较强的鲁棒性。当同时存在多种误差源时,相比于容积卡尔曼滤波的点集配准方法,容积分离协方差交集方法的鲁棒性表现得更好。实验结果表明,当两种误差源同时存在且误差较大时,基于容积分离协方差交集滤波的点集配准比基于容积卡尔曼滤波的点集配准的匹配误差降低40%以上。针对点集配准高度依赖对应点选择正确率的问题,本文提出了一种直接匹配算法。该算法不建立两个点集中的对应点关系,而是将两个点集都表示成高斯混合模型,通过优化两个高斯混合模型的相似度来达到点集配准的目的。为此本文提出了签名二次距离来衡量高斯混合模型相似度,并将其用于点集配准算法。相比于欧式距离、相对熵、核相关函数等,签名二次距离计算相似度函数在输入的两个高斯核上的期望,因此能更好地衡量高斯混合模型间的相似度。对于签名二次距离的优化,采用最大期望算法进行迭代优化,保证算法的收敛性。实验表明该算法准确度相比于对应点算法有所提升,但算法复杂度更高,因此适用于地图创建等离线应用。