近日,智行者团队发布的两篇论文被顶级国际会议ICRA 2023接收,分别为《Faster-LIO: Lightweight Tightly Coupled Lidar-inertial Odometry using Parallel Sparse Incremental Voxels》和《Anderson Acceleration for on-Manifold Iterated Error State Kalman Filters》。两篇论文针对自动驾驶落地中的难点问题,分别提出了一种基于增量体素的高效率激光雷达惯导里程计和一种基于Anderson加速的迭代扩展卡尔曼滤波。
IEEE国际机器人与自动化协会每年主办一次IEEE世界机器人与自动化大会(IEEE InternationalConference on Robotics and Automation,简称IEEE ICRA)。IEEE ICRA是机器人领域规模(千人以上)和影响力均排名第一的顶级国际会议,是机器人领域权威研究人员介绍其研究成果的首要国际论坛。
本文提出了一种基于增量体素的激光雷达惯导里程计(LIO)方法,用于快速跟踪旋转和固态激光雷达扫描点云,为了获得较高的跟踪速度,本文既不使用复杂的基于树的结构来划分空间点云,也不使用严格的k近邻(k-NN)查询来计算点匹配。
使用增量体素(iVox)作为点云空间数据结构,它是从传统体素修改而来的,支持增量插入和并行近似k-NN查询,本文在算法中提出了线性iVox和PHC(伪希尔伯特曲线)iVox作为两种可选的底层结构。
实验表明,在固态激光雷达中,iVox的每次扫描速度达到1000-2000HZ,而在32线激光雷达中,iVox的速度超过200赫兹(仅使用现代CPU),同时仍保持相同的精度水平!
本文指出,迭代扩展卡尔曼滤波器(Iterated Extended Kalman Filter)是一种被广泛应用于实时定位应用中的估计器,它通过多次迭代观测方程,以找到更好的线性化点,每次只进行当前时间点的状态估计,从而节省计算资源。
受最近迭代最近点算法(iterative closest point algorithm)的启发,本文提出一种加速迭代误差状态卡尔曼滤波器(IESKFs)的方法。
研究结果表明,IESKF可以转换为一个迭代不动点问题,从而使得Anderson加速(AA)可以直接应用于IESKF的迭代,因为IESKF的误差状态自然存在于切空间中,而不需要额外的变换。
但在迭代期间,当前估计的切空间可能会发生变化,因此本文应该将切空间转换到起始点来执行Anderson加速。文章提出了AA-IEKF,并将其应用于激光雷达惯性惯性里程计(LIO)系统来估计激光雷达的本体运动。实验表明,Anderson加速可以有效减少ESKF的迭代次数,并降低总计算量。
智行者成立于2015年,聚焦无人驾驶汽车大脑的研发,致力于成为高阶自动驾驶解决方案提供商。公司已有员工500余人,核心团队均来自清华大学汽车系,技术优势显著。公司已申请专利1000余件,并成功入选国家级专精特新小巨人企业。公司已获得厚安(厚朴/Arm)、百度、顺为、京东等多家知名机构的投资。