单目视觉信息和轮速信息融合的定位方法及系统技术方案

本发明专利技术实施例提供一种单目视觉信息和轮速信息融合的定位方法及系统，该方法包括：在滑窗操作中，将窗口中最老帧从窗口中滑出，作为优化结果；将最新帧加入滑窗，以计算所述最新帧对应轮速累计的轮速信息及其协方差；将所述轮速信息和所述协方差加入到滑窗优化器中，为视觉约束提供尺度约束。本发明专利技术实施例能解决车辆单目视觉和轮速融合定位中减小参数漂移的问题，且场景依赖较小，传感器简单，不需要特定的初始化条件，普遍适用于车辆能够正常运行的场景，特别是GPS信号不良，视觉信息丰富的城市道路场景。市道路场景。市道路场景。

【技术实现步骤摘要】
单目视觉信息和轮速信息融合的定位方法及系统


[0001]本专利技术涉及车辆
，更具体地，涉及一种单目视觉信息和轮速信息融合的定位方法及系统。

技术介绍

[0002]单目视觉和轮速融合定位是指利用车辆上安装的单目相机，结合载体轮速提供的尺度信息进行相对定位。但传统技术中存在单目视觉和轮速各自存在参数漂移的问题。

技术实现思路

[0003]为了解决上述问题，本专利技术实施例提供一种克服上述问题或者至少部分地解决上述问题的单目视觉信息和轮速信息融合的定位方法及系统。
[0004]根据本专利技术实施例的第一方面，提供一种单目视觉信息和轮速信息融合的定位方法，该方法包括：在滑窗操作中，将窗口中最老帧从窗口中滑出，作为优化结果；将最新帧加入滑窗，以计算所述最新帧对应轮速累计的轮速信息及其协方差；将所述轮速信息和所述协方差加入到滑窗优化器中，为视觉约束提供尺度约束。
[0005]根据本专利技术实施例第二方面，提供了一种单目视觉信息和轮速信息融合的定位系统，该系统包括：优化模块，用于在滑窗操作中，将窗口中最老帧从窗口中滑出，作为优化结果；加入模块，用于将最新帧加入滑窗，以计算所述最新帧对应轮速累计的轮速信息及其协方差；约束模块，用于将所述轮速信息和所述协方差加入到滑窗优化器中，为视觉约束提供尺度约束。
[0006]根据本专利技术实施例的第三方面，提供了一种电子设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，处理器执行程序时实现如第一方面的各种可能的实现方式中任一种可能的实现方式所提供的单目视觉信息和轮速信息融合的定位方法。
[0007]根据本专利技术实施例的第四方面，提供了一种非暂态计算机可读存储介质，其上存储有计算机程序，该计算机程序被处理器执行时实现如第一方面的各种可能的实现方式中任一种可能的实现方式所提供的单目视觉信息和轮速信息融合的定位方法。
[0008]本专利技术实施例提供的单目视觉信息和轮速信息融合的定位方法及系统，能解决车辆单目视觉和轮速融合定位中减小参数漂移的问题，且场景依赖较小，传感器简单，不需要特定的初始化条件，普遍适用于车辆能够正常运行的场景，特别是GPS信号不良，视觉信息丰富的城市道路场景。
附图说明
[0009]为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍。显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以
根据这些图获得其他的附图。
[0010]图1为本专利技术实施例提供的单目视觉信息和轮速信息融合的定位方法的流程示意图；
[0011]图2为本专利技术另一实施例提供的单目视觉信息和轮速信息融合的定位方法的流程示意图；
[0012]图3为本专利技术实施例提供的算法示意图；
[0013]图4为本专利技术实施例提供的单目视觉信息和轮速信息融合的定位系统的结构示意图；
[0014]图5为本专利技术实施例提供的电子设备的实体结构示意图。
具体实施方式
[0015]为使本专利技术实施例的目的、技术方案和优点更加清楚，下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚地描述，显然，所描述的实施例是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。
[0016]单目视觉和轮速融合定位是指利用车辆上安装的单目相机，结合载体轮速提供的尺度信息进行相对定位。目前，传统技术中存在单目视觉和轮速各自存在参数漂移的问题。因此，本专利技术实施例提供一种单目视觉信息和轮速信息融合的定位方法，参见附图1，该方法包括但不限于如下步骤：
[0017]步骤101、在滑窗操作中，将窗口中最老帧从窗口中滑出，作为优化结果；
[0018]步骤102、将最新帧加入滑窗，以计算所述最新帧对应轮速累计的轮速信息及其协方差；
[0019]步骤103、将所述轮速信息和所述协方差加入到滑窗优化器中，为视觉约束提供尺度约束。
[0020]具体地，单目视觉和轮速融合定位是指利用车辆上安装的单目相机，结合载体轮速提供的尺度信息进行相对定位。相对于其他的车辆定位方法有以下方面的优势：(1)不依赖绝对定位信息，在不利于绝对定位的场景(GPS信号不好或者缺失等条件下)也能实现较为稳定的相对位置的推算；(2)单目视觉普遍存在尺度漂移的问题，如果不进行尺度矫正，其定位及测量结果会随着时间发生偏移，但单目视觉在角度保持上较为稳定，特别是在特征点丰富的城市道路场景；使用轮速进行推算在尺度上较为稳定(不考虑车辆打滑、漂移)，但在方向上发散较快；所以结合单目视觉和轮速能够提升总体的定位精度及稳定性。
[0021]作为一种可选的实施方式，在步骤101之前，该方法还包括：使用优化后的单目视觉轨迹的尺度，恢复单目视觉轨迹traj_v，以完成视觉轨迹的初始化。
[0022]作为一种可选的实施方式，使用优化后的单目视觉轨迹的尺度，恢复单目视觉里程计轨迹traj_v之前，该方法还包括：对齐单目视觉轨迹traj_v和轮速轨迹traj_o，使得两条轨迹重合误差最小。
[0023]作为一种可选的实施方式，对齐单目视觉轨迹traj_v和轮速轨迹traj_o之前，还包括：使用滑窗内的视觉特征点初始化所述单目视觉轨迹traj_v；累计滑窗内的轮速信息，得到一段相对的轮速轨迹traj_o。
[0024]作为一种可选的实施方式，在步骤103将所述轮速信息和所述协方差加入到滑窗优化器中，为视觉约束提供尺度约束之后，该方法还包括：重复所述将最新帧加入滑窗的步骤，持续优化新的视觉和轮速约束，同时获得优化后的位姿结果。
[0025]基于上述实施例的内容，该方法具体可包括以下步骤：第一步，使用滑窗的方法初始化单目视觉里程计，得到一段尺度未知的相对运动轨迹traj_v；第二步，累计滑窗内的里程计数据，得到一段里程计相对运动轨迹traj_o；第三步，优化单目视觉轨迹的尺度s，并对齐traj_v和traj_o，使得两条轨迹重合误差最小；第四步，使用优化后的s恢复单目视觉里程计轨迹，至此完成融合的初始化；第五步，初始化完成后，继续视觉的滑窗过程，同时对每个窗口之间轮速记进行位置积分并按照轮速误差计算斜方差；第六步，将每个窗口中的轮速位置以及协方差作为约束加入到视觉滑窗优化中，实现单目视觉及轮速的融合定位。
[0026]为使上述实施例得到更为清楚的说明，参见图2
‑
3，该方法包括如下步骤：
[0027]步骤1：使用滑窗内的视觉特征点初始化单目视觉轨迹traj_v。
[0028]步骤2：累计滑窗内的轮速信息，得到一段相对的轮速轨迹traj_o。
[0029]步骤3：对齐tran_v及traj_o并优化尺度s，保证2跳轨迹能够最大程度重合。
[0030]步骤4：使用优化后的尺度本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种单目视觉信息和轮速信息融合的定位方法，其特征在于，包括：101，在滑窗操作中，将窗口中最老帧从窗口中滑出，作为优化结果；102，将最新帧加入滑窗，以计算所述最新帧对应轮速累计的轮速信息及其协方差；103，将所述轮速信息和所述协方差加入到滑窗优化器中，为视觉约束提供尺度约束。2.根据权利要求1所述的方法，其特征在于，在步骤101之前，所述方法还包括：使用优化后的单目视觉轨迹的尺度，恢复单目视觉轨迹traj_v，以完成视觉轨迹的初始化。3.根据权利要求2所述的方法，其特征在于，在使用优化后的单目视觉轨迹的尺度，恢复单目视觉里程计轨迹traj_v之前，所述方法还包括：对齐单目视觉轨迹traj_v和轮速轨迹traj_o，使得两条轨迹重合误差最小。4.根据权利要求3所述的方法，其特征在于，在对齐单目视觉轨迹traj_v和轮速轨迹traj_o之前，所述方法还包括：使用滑窗内的视觉特征点初始化所述单目视觉轨迹traj_v；累计滑窗内的轮速信息，得到一段相对的轮速轨迹traj_o。5.根据权利要求1所述的方法，其特征在于，在步骤103之后，所述方法还包括：重复所述将最新帧加入滑窗的步骤，持续优化新的...

【专利技术属性】
技术研发人员：辛梓，王小亮，刘奋，
申请(专利权)人：武汉中海庭数据技术有限公司，
类型：发明
国别省市：