基于非线性优化的单目视觉与IMU融合的SLAM算法研究

来源 :哈尔滨工业大学 | 被引量 : 0次 | 上传用户:snowshine1116131
下载到本地 , 更方便阅读
声明 : 本文档内容版权归属内容提供方 , 如果您对本文有版权争议 , 可与客服联系进行内容授权或下架
论文部分内容阅读
移动机器人已经成为了当前研究的焦点,尤其最近增强现实、虚拟现实与无人驾驶的火热进一步推动了移动机器人技术的发展。其中即时定位与建图(SLAM)是移动机器人技术的核心,而单一的传感器的SLAM算法无论是在精度还是鲁棒性上都不能满足一些应用的要求。本文提出一种基于特征点法的实时紧耦合的单目视觉与IMU融合SLAM算法,该算法可以应用于室内外和大尺度环境。整个SLAM系统可以实现全自动初始化,不需要预先知道任何先验信息。该系统由三大部分组成:初始化、追踪、局部优化和闭环检测。在初始化部分本文采用单目视觉与IMU的松耦合来估计初始化参数:每一帧图像所对应的IMU相对世界坐标的变换关系WBT,当地的重力矢量wg,真实尺度s,每一帧图像所对应的IMU的速度BV,加速度偏差ba和陀螺仪偏差gb。在追踪过程中,本文分为初始化成功前的仅视觉追踪和初始化成功后的视觉与IMU融合的追踪,在后者追踪的过程中本文又根据当前帧是否为关键帧而采用两种不同的目标方程。为了减少误差的累计和增强系统的鲁棒性,本文引入了局部地图。为了让局部地图在不丢失信息的同时计算量有界,本文引入了边缘化和稀疏化。为了避免引入错误信息,在边缘化中,本文采用固定求导线性点的方式求优化过程中雅可比矩阵。最后,为了减少SLAM过程中的累计误差,本文引入了闭环检测。由于每帧图像姿态的仰角和滚动角在IMU与相机的融合系统是可观的,因此,在闭环检测中本文优化的是4自由度的变量。本文提出的SLAM系统在EuRoC数据集测试,初始化精度十分高,可以得到尺度s的误差小于5%,重力矢量wg的大小收敛在9.8 m/s2左右,加速度偏差收敛在0左右,陀螺仪偏差收敛在10-3?/t左右。在整个SLAM过程中,定位精度也是十分具有竞争力,其中平均误差在8cm左右,最大误差也在10 cm以内。在实物测试中,本文的算法表现也十分出色,在小范围内,定位精度可以达到10cm左右。
其他文献
房地产企业的发展促进推动着项目成本控制理论的发展,项目成本控制理论的发展、改善、创新也为房地产企业项目成本的控制提供更为有效的方法和途径。本文从对房地产行业发展的
近几年来,财务报表重述现象频繁涌现,愈来愈多的上市公司在财务报告披露后一年或更长的时间内,又对早期发布的报告中的差错进行更正。频繁发生的财务报表重述降低了资源配置效率
在2010年,中国颁布了《关于推进光纤宽带网络建设的意见》、《三网融合试点城市方案》、《关于推进第三代移动通信网络建设的意见》等等重要的文件,在光纤建设、3G、4G发展、三
目的观察百乐眠联合伊托必利治疗功能性消化不良(FD)的疗效。方法将符合罗马III诊断标准的功能性消化不良患者146例随机分为两组,两组均使用伊托必利治疗,观察组加用百乐眠,
研究背景胰腺癌恶性程度高,预后差,5年生存率低于5%,是恶性程度最高和预后最差的肿瘤之一。80%胰腺癌患者在诊断时已经处于晚期,肿瘤已包绕血管或者发生远处转移。同时由于其
介绍了恩施州珙桐资源的分布及保护现状,并对目前珙桐资源的开发利用和保护提出了建议.
渴症并非一个单纯的疾病,而是某一个疾病某个阶段的伴随症状,虽然症状简单,但其病因病机,却很复杂,是反应疾病内在本质十分可靠的外部表现依据,古代医家特别重视渴症,在辨证
目的:对中医综合疗法和经皮椎体后凸成形术两种方法治疗骨质疏松性椎体压缩骨折的综合疗效进行对比观察,为骨质疏松性椎体压缩骨折治疗方法的选择提供理论性依据。方法:选取我
<正>从我国的司法实践来看,现阶段我国公诉人的素质尚不适应现代刑事诉讼的客观需要.研究和分析公诉人的素质,探讨增强公诉人素质的途径,对于充分发挥公诉人的职能,进一步提
萨尔浒战役是1619年(明万历四十七年,后金天命四年)二三月间,在明朝与后金的战争中,努尔哈赤在萨尔浒(今辽宁抚顺新宾满族自治县南杂木乡高力营子村一带),以及萨尔浒附近地区