首页 / 专利库 / 图形技术 / / 一种基于图像中边沿点信息的单目视觉测程方法

一种基于图像中边沿点信息的单目视觉测程方法

阅读:149发布:2024-02-10

专利汇可以提供一种基于图像中边沿点信息的单目视觉测程方法专利检索,专利查询,专利分析的服务。并且本 发明 涉及一种基于图像中边沿点信息的无人机单目视觉测程的方法,属于无人机导航 定位 技术领域,该方法包括:从与无人机固连的下视单目相机捕获的 图像序列 中选择两 帧 构建初始地图和初始 深度图 ,将第一帧取作地图中的第一个关键帧,并将第一帧对应的相机 坐标系 取为世界坐标系,完成初始化;再并行进行 运动估计 、地图构建和深度图估计三个线程:运动估计线程利用已知的地图和深度图信息,与当前帧进行对齐得到测程结果,并根据测程结果对已有的地图信息进行优化,地图构建和深度图估计线程同时运行以维护地图和深度图信息。本发明充分利用现代处理器的多核架构,能有效地利用图像中的边沿点信息,结合 角 点信息,提高了 算法 效率,具有更强的适应性。,下面是一种基于图像中边沿点信息的单目视觉测程方法专利的具体信息内容。

1.一种基于图像中边沿点信息的无人机单目视觉测程的方法,其特征在于,该方法包括初始化以及并行处理的运动估计、地图构建和深度图估计;具体包括以下步骤:
1)初始化:从与无人机固连的下视单目相机捕获的图像序列中选择两构建初始地图和初始深度图,地图用一组关键帧集合{rm}和一组三维特征点集合{pi}表示,其中rm表示第m个关键帧,m为正整数,pi表示第i个三维特征点,i为正整数,三维特征点与图像中的二维点特征一一对应,二维角点集合记为 其中 表示第i个角点,i为正整数;深度图由边沿点坐标、边沿点深度值及深度倒数的不确定度构成,深度图与关键帧一一对应,深度图用 表示,其中Dm表示第m个关键帧对应的深度图, 表示第i个边沿点,
表示第i个边沿点的深度值, 表示第i个边沿点深度倒数的不确定度;
其中,将第一帧取作地图中的第一个关键帧,并将所述第一帧对应的相机坐标系取为世界坐标系,完成初始化;
2)初始化地图和深度图信息后,并行进行运动估计、地图构建和深度图估计三个线程:
其中,运动估计线程利用已知的地图和深度图信息,与相机新获取的当前帧进行对齐得到测程结果,并根据测程结果对已有的地图信息进行优化,地图构建和深度图估计线程同时运行以维护地图和深度图信息。
2.如权利要求1所述方法,其特征在于,所述步骤2)并行进行运动估计、地图构建和深度图估计三个线程中的运动估计线程具体步骤如下:
对相机新获取的当前帧图像,利用当前关键帧中的边沿点深度信息,进行基于运动模型的图像对齐,得到当前帧Ik在世界坐标系中的位姿Tk,w的初始估计 其中Ik表示相机获取的第k帧图像,即当前帧,k为正整数,Tk,w表示当前帧在世界坐标系中的位姿, 中的上标-表示初始估计,利用初始估计,将地图中已有的三维特征点投射在当前图像中得到能被当前帧观测到的三维特征点集合{pi},并通过匹配得到与{pi}对应的二维角点集合以 为观测值, 为初值,先后对当前帧在世界坐标系w中的位姿Tk,w和地图中相关的三维特征点位置进行优化;
S11:记当前帧图像为Ik,首先将无人机当前位姿初始化为前一时刻的位姿,即以当前关键帧rm作为参考帧,用高斯-迭代算法最小化Ik和rm之间的加权灰度残差如式(1-1):
得到当前帧Ik相对于参考帧rm的位姿Tk,m,其中 表示参考帧rm中深度倒数不确定度小于设定的不确定度阈值、并且在当前帧可见的边沿点集合, 表示第i个可见边沿点,表示 的权值,取为 表示第i个边沿点的深度倒数的不确定度,边沿点
的灰度残差 为式(1-2):
-1
其中π为投影函数,将相机坐标系中的三维点投影到二维图像坐标系中,π 为逆投影函数, 和 分别表示像素点*在帧Ik和帧rm中的灰度值,结合参考帧rm相对于世界坐标系的位姿Tm,w,则可计算当前帧位姿的初始估计 为式(1-3):
若参与加权的边沿点数量小于设定的边沿点阈值,转步骤S12,否则直接进入步骤S13;
S12:以步骤S11中得到的位姿估计为初值,将前一帧Ik-1作为当前帧的参考帧进行图像对齐,用高斯-牛顿迭代优化算法最小化Ik和Ik-1之间的灰度残差得到当前帧相对于前一帧的位姿Tk,k-1,如式(1-4):
其中 表示帧k-1中深度已知,并且在当前帧可见的角点集合, 表示 中第i个点;结合前一帧相对于世界坐标系的位姿Tk-1,w,则计算当前帧位姿的初始估计 为式(1-5):
此时,将当前帧Ik选为新的关键帧作为后续一段图像的参考帧;同时作为地图构建和深度图估计线程的输入信息;
S13:根据初始估计 判断地图中能被当前帧观测到的三维特征点集合{pi},得到其在参考帧rm中对应的角点坐标估计 以 为初值,用图像跟踪算法KLT计算{pi}在当前帧的真实成像位置,以此更新二维角点集合
其中,Ai表示将参考图块变换到当前图像的变换矩阵; 表示参考图块和当前图像中的匹配图块的平均灰度差,用于消除光照影响;
S14:经步骤S13得到的二维坐标与当前帧的初始位姿估计 不再满足式(1-7):
以 为初值,通过最小化重投影误差对Tk,w进行更新得到的当前帧位姿Tk,w即是运动估计的最终结果,如式(1-8):
Tk,w即为测程得到的最终结果;之后转步骤S15,同时将步骤S14得到的当前帧位姿Tk,w作为地图构建线程和深度图估计线程的输入信息计算角点深度值和计算边沿点深度值;
S15:利用步骤S14得到的当前帧位姿Tk,w,对当前帧能够观测到的地图中的每一个三维特征点分别进行优化,使该三维特征点在所有能观测到它的关键帧中的投影和真实成像位置的误差平方和最小即如式(1-9):
上式中,上标j表示能观测到三维特征点pi的第j个关键帧。
3.如权利要求2所述方法,其特征在于,所述步骤2)并行进行运动估计、地图构建和深度图估计三个线程中的地图构建线程具体步骤如下:
所述地图构建线程分两种情况处理:若新获取的图像在运动估计线程步骤S12被选为新的关键帧,执行步骤S21,否则利用运动估计线程步骤S14得到的当前帧的位姿,执行步骤S22-S24;具体步骤如下:
S21:当一帧图像被选定为关键帧时,使用FAST算法提取该关键帧角点特征;先用等间距的网格将图像均匀划分,每个网格中只提取一个角点,使角点均匀地分布在图像中,总数不超过网格数;为每一个新的角点 创建一个概率深度滤波器,并将其深度的倒数 和有效观测的出现概率ρi的联合后验分布定义如式(2-1):
其中:Beta和N分别表示Beta分布和正态分布,下标n表示对当前概率深度滤波器已经进行了n次参数更新,n为正整数,参数an和bn是递推更新过程中有效观测和无效观测分别发生的次数,μn和 则是深度倒数高斯分布的均值和方差;对式(2-1)中的参数进行初始化时,将an和bn的初值置为10,μn初始化为所在图像的平均深度的倒数, 初始化为最大值;
S22:使用步骤S14得到的相机位姿已知的图像Ik,对角点特征的深度估计进行更新;记被更新的角点 所在的关键帧为rc,根据当前帧Ik和rc的相对位姿,在Ik中确定一条直线,并保证Ik中与 对应的像素点 出现在这条直线上;在这条直线上进行极线搜索,经亚像素精度块匹配得到 的坐标后,用三角测量计算出所述角点 的深度
S23:将步骤S22得到的深度 取倒数为 其中,上标n表示这是对当前角点深度滤波器的第n次观测更新,对深度的倒数 的概率分布建模如式(2-2):
上式的含义为:关键帧rc中第i个角点经图像Ik的三角测量,如果为有效测量,那么测量结果的倒数 满足正态分布 其中 为图像平面一个像素误差引起的深度倒数计算方差,如果为无效测量,则 满足均匀分布 其中 为根据当前场
景的先验信息设定的深度倒数的最小值和最大值;经过 的观测更新,深度倒数 的后验概率分布如式(2-3):
其中,C为保证概率分布归一化的常数,通过矩匹配方法,计算出an,bn,μn,S24:剔除有效测量概率 小于0.1的角点,将不确定度σn满足要求的点添加到地图中。
4.如权利要求3所述方法,其特征在于,所述步骤2)并行进行运动估计、地图构建和深度图估计三个线程的深度图估计线程具体步骤如下:
若新获取的图像在运动估计线程步骤S12被选为新的关键帧,从新加入的关键帧中提取出边沿点,执行步骤S31~S33;否则利用运动估计线程步骤S14得到的当前帧的位姿,执行步骤S34~S36,用新图像信息更新边沿点的概率深度滤波器,并剔除有效观测概率过低的边沿点;具体步骤如下:
S31:在新加入的关键帧中,提取边沿点,即利用Sobel算子计算图像横向和纵向的灰度梯度Gx和Gy,灰度梯度图用 近似;从图像中选出灰度梯度最大的2500到4000个像素点,当梯度显著的像素点数目小于2500时,将梯度阈值450减小为原来的0.95倍,当数目大于4000时,增大阈值为原来的1.05倍;
S32:记新的关键帧为rv,前一关键帧为rv-1,将帧rv-1的深度图Dv-1传播到新的关键帧深度图Dv;rv-1中,边沿点 的深度倒数的均值为 深度倒数的方差为 其中;rv-1到rv的相对位姿为Tv,v-1,边沿点 在帧rv中对应边沿点的位置 可由投影关系计算得到如式(3-
1):
记 的深度倒数为 深度倒数的方差记为 则:
其中,tz表示相机在光轴上的平移;由此推导出 的深度倒数的方差 为:
其中 表示预测不确定性,将 绑定到rv中最近的整数像素点
S33:为步骤S31中提取的每一个边沿点创建概率深度滤波器,如果某一个边沿点附近
3x3像素范围内存在先验估计 则其深度 的均值 初始化如式(3-4):
则边沿点的概率深度滤波器的参数深度倒数的不确定度 初始化为先验估计中最小不确定度;若不存在先验估计,则边沿点的概率深度滤波器初始化为平均深度和最大不确定度;取 则对于每一个边沿点按照式(2-1)构造边沿点的概率深度滤波器如式(3-5):
其中,式(3-5)各参数定义与式(2-1)中相同,对应边沿点的概率深度滤波器的各个参数,an和bn的初值置为10,μn,σn初始化为 和
v
S34:将新的关键帧rv设为后续图像的参考帧,利用后续的图像对帧rv中的深度图D 进行观测更新;用图像Ik对Dv更新时,记被更新的边沿点为 根据Ik和rv的相对位姿,在Ik中确定一条直线,保证Ik中与 对应的像素点 出现在这条直线上;如果边沿点灰度梯度方向与所述直线方向夹角小于阈值,经亚像素精度的块匹配得到 的坐标后,用三角测量计算出所述边沿点的深度 执行步骤S35;如果所述夹角大于该阈值,则不做搜索,返回步骤S34检查下一个边沿点;
S35:将步骤S34得到的深度 取倒数为 对深度的倒数 的概率分布建模
如式(3-6):
上式的含义为:关键帧rv中第i个边沿点经图像Ik的三角测量,如果为有效测量,那么测量结果的倒数 满足正态分布 如果为无效测量,则 满足均匀分布
其中 为根据当前场景的先验信息设定的深度倒数的最小值和最
大值;经过 的观测更新,深度倒数 的后验概率分布如式(2-3):
通过矩匹配方法计算出an,bn,μn,
S36:剔除有效测量概率 小于0.1的边沿点。

说明书全文

一种基于图像中边沿点信息的单目视觉测程方法

技术领域

[0001] 本发明属于无人机导航定位技术领域,特别涉及一种利用了图像中边沿点信息的单目视觉测程方法。

背景技术

[0002] 在许多应用场景中人们没办法依靠GPS进行准确定位,如室内、城市楼宇之间或者是丛林、山谷地带乃至于外星球。利用视觉进行导航是非常符合直觉的:自然界中所有有眼睛的动物都利用视觉进行某种形式的导航,苍蝇、蜜蜂等昆虫通过光流判断自身与目标之间的相对运动,大部分时间里人通过看到的景物判断身处的位置
[0003] 在不使用GPS的前提下,出于成本和重量的考虑,微小无人机多数采用惯性测量单元和单摄像头组合的导航方案,也可以配备声波传感器和气压传感器以获取绝对高度信息。这种配置的无人机可以实现完全自主的航路点跟踪
[0004] 携带单个或多个摄像头的载体,仅利用其图像输入,对自身运动进行估计的过程叫做视觉测程VO(Visual Odometry)。应用领域包括机器人增强现实和自动驾驶等。该过程与传统的轮测程法存在相似之处。轮测程通过累计车轮的转动计算里程,视觉测程通过感知输入图像的变化,增量地估计载体位姿。视觉测程算法的有效运行要求环境中光照充足,场景纹理足够丰富。
[0005] 单目视觉测程仅利用单个摄像头作为输入,系统配置简单,适应环境尺度变化的能强于多目视觉系统。现有的单目视觉测程方法,一般利用图像中的点特征进行与帧之间的匹配,无法适应缺少角点特征的场景(角点特征是图像的重要特征,代表图像中在某些属性方面突出的像素点。在图1中的场景中,角点特征多出现在直线的交点处,数量稀少且结构上存在重复性,现有的基于角点特征的单目视觉测程算法将很有可能失效)。此外,这些角点特征只占图像全部像素点的一小部分,从图像信息的利用率来看,单目视觉测程的性能还能提高。
[0006] 本发明涉及的术语说明如下:
[0007] 帧:在视觉测程领域,习惯称获得的一幅图像为一帧,比如,相机前一时刻获得的图像称作前一帧,相机当前时刻获得的图像称作当前帧,相机获得的连续两幅图像称作相邻帧等;
[0008] 关键帧:由于当前相机的帧率较高,相邻帧之间的位姿变化往往比较小,为了增强运动估计的准确性,一般采取关键帧的策略,即在一定的位姿变化范围内,新得到的图像只与某一特定的帧进行对齐以估计当前的位姿,而只有当超出了一定的范围后,我们才采取新的特定的帧进行下一阶段的图像对齐,即称这些用来进行图像对齐的特定帧为关键帧;
[0009] 参考帧:用来对齐当前图像的帧称为当前图像的参考帧;
[0010] 地图:在视觉测程领域,将已知的环境信息(比如已经计算得到的点的位置、已获取的图像等)保存起来,称为地图。地图可以作为后续图像匹配、运动估计的先验信息以增加测程的精度

发明内容

[0011] 本发明针对已有技术的不足,提出一种基于图像中边沿点信息的单目视觉测程方法,能有效地利用图像中的边沿点信息,结合角点信息(作为辅助),对缺乏角点特征的场景具有更强的适应性。
[0012] 本发明提出的一种基于图像中边沿点信息的无人机单目视觉测程的方法,其特征在于,该方法包括初始化以及并行处理的运动估计、地图构建和深度图估计;具体包括以下步骤:
[0013] 1)初始化:从与无人机固连的下视单目相机捕获的图像序列中选择两帧构建初始地图和初始深度图,地图用一组关键帧集合{rm}和一组三维特征点集合{pi}表示,其中r表示关键帧,下标m表示第m个关键帧,m为正整数,p表示三维特征点,下标i表示第i个三维特征点,i为正整数,三维特征点对应于图像中的角点特征,将其对应的二维角点集合记为其中uc表示角点,下标i表示第i个角点,i为正整数;深度图由边沿点坐标、边沿点深度值及深度值的不确定度构成,深度图与关键帧一一对应,深度图用 表示,其中D表示边沿点对应的深度图,上标m表示第m幅深度图,为正整数,ue表示边沿点,de表示边沿点的深度值,σe表示边沿点深度倒数的不确定度,下标i表示第i个边沿点,为正整数;
[0014] 其中,将第一帧取作地图中的第一个关键帧,并将第一帧对应的相机坐标系取为世界坐标系,完成初始化;
[0015] 2)初始化地图和深度图信息后,并行进行运动估计、地图构建和深度图估计三个线程:其中,运动估计线程利用已知的地图和深度图信息,与当前帧进行对齐得到测程结果,并根据测程结果对已有的地图信息进行优化,地图构建和深度图估计线程同时运行以维护地图和深度图信息。
[0016] 本发明的特点及有益效果:
[0017] 本发明提出的基于图像中边沿点信息的单目视觉测程方法,将与无人机固连的下视单目相机捕获的图像作为输入,经过机载计算机运算,输出的结果为无人机的测程结果;该方法通过运动估计线程、地图构建线程和深度图估计线程三个并行的线程来实现;其中运动估计线程利用地图和深度图中的已有信息与当前帧做对齐估计当前运动的位姿,它是测程算法的核心,必须保证强实时性;地图构建线程用于维护关键帧信息以及图像角点特征所对应的三维特征地图;深度图估计线程用来维护关键帧中边沿点信息的深度估计。
[0018] 本发明将运动估计、地图构建和深度图估计分别运行在三个线程中,充分利用现代处理器的多核架构,提高了算法效率。运动估计算法中没有特征提取和匹配的过程,地图构建时采用快速的特征点提取算法,深度图估计中直接提取亮度梯度较大的像素点,这都有效降低了计算量。同时在运动估计算法的初始估计过程中,利用了图像中的边沿点信息,并相应的设计了边沿点的深度图传播方法。图像中的边沿点是比角点丰富很多的图像特征,算法在初始估计中采用边沿点信息可以降低算法对角点特征的依赖,增强算法的环境适应能力。附图说明
[0019] 图1为基于角点特征的单目视觉测程方法可能失效的场景;
[0020] 图2为本发明提出的基于边沿点的改进单目视觉测程方法的总体流程图
[0021] 图3为本发明实施例的运动估计线程流程图;
[0022] 图4为本发明实施例的地图构建线程流程图;
[0023] 图5为本发明实施例的深度图估计线程流程图;

具体实施方式

[0024] 下面结合附图及实施例对本发明进行详细说明。
[0025] 本发明提出的一种基于图像中边沿点信息的无人机单目视觉测程的方法的总体流程如图2所示,其特征在于,包括初始化以及并行处理的运动估计、地图构建和深度图估计;具体包括以下步骤:
[0026] 1)初始化:从与无人机固连的下视单目相机捕获的图像序列中选择两帧构建初始地图和初始深度图,本实施例中,地图用一组关键帧集合{rm}和一组三维特征点集合{pi}表示,其中r表示关键帧,下标m表示第m个关键帧,为正整数,p表示三维特征点,下标i表示第i个三维特征点,为正整数,三维特征点对应于图像中的角点特征,一般将其对应的二维角点集合记为 其中uc表示角点,下标i表示第i个角点,为正整数;
[0027] 本实施例中,对地图中的每一幅关键帧计算其对应的深度图,深度图由边沿点坐标、边沿点深度值及深度值的不确定度构成,即深度图用 表示,其中D表示边沿点对应的深度图,上标m表示第m幅深度图,为正整数(深度图与关键帧一一对应),ue表示边沿点,de表示边沿点的深度值,σe表示边沿点深度倒数的不确定度,下标i表示第i个边沿点,为正整数。
[0028] 其中,将第一帧取作地图中的第一个关键帧,并将第一帧对应的相机坐标系取为世界坐标系(世界坐标系是指相对真实世界的坐标系比如北东地坐标系有确定变换关系的一个坐标系,本实施例为了方便计算选为第一帧对应的相机坐标系为世界坐标系),完成初始化;
[0029] 2)初始化地图和深度图信息后,并行进行运动估计、地图构建和深度图估计三个线程:其中,运动估计线程利用已知的地图和深度图信息,与当前帧进行对齐得到测程结果,并根据测程结果对已有的地图信息进行优化,地图构建和深度图估计线程同时运行以维护地图和深度图信息;三个线程具体描述如下:
[0030] 21)运动估计线程:对于相机新获取的当前帧图像,利用当前关键帧中的边沿点深度信息,进行基于运动模型的图像对齐,得到当前帧在世界坐标系中的位姿Tk,w的初始估计其中T代表位姿,下标k表示当前帧为相机获得的第k帧图像,为正整数,下标w表示世界坐标系,上标-表示初始估计,利用初始估计,可以将地图中已有的三维特征点{pi}投射在当前图像中,并通过匹配得到与{pi}对应的二维角点 以 为量测值, 为初值,先后对当前帧在世界坐标系w中的位姿Tk,w和地图中相关的三维特征点位置进行优化。该运动估计具体实施例如图3所示,包括:
[0031] S11:记当前帧图像为Ik,其中I表示相机获取的图像,首先将无人机当前位姿初始化为前一时刻的位姿,即 以当前关键帧rm作为参考帧,用高斯-迭代算法最小化Ik和rm之间的加权灰度残差如式(1-1):
[0032]
[0033] 得到当前帧Ik相对于参考帧rm的位姿Tk,m,其中 表示参考帧rm中深度倒数不确定度小于设定的不确定度阈值(深度倒数最大估计值的1/200)、并且在当前帧可见的边沿点集合,ui表示图像中的像素点,其中u表示像素点,下标i表示第i个像素点,为正整数,wi(ui)表示像素点ui的权值,取为 σi表示第i个像素点的深度的不确定度,像素点ui的灰度残差δR(Tk,m,ui)为式(1-2):
[0034]
[0035] 其中π为投影函数,将相机坐标系中的三维点投影到二维图像坐标系中,π-1为逆投影函数, 和 分别表示像素点*在帧Ik和帧rm中的灰度值,结合参考帧rm相对于世界坐标系的位姿Tm,w,则可计算当前帧位姿的初始估计 为式(1-3):
[0036]
[0037] 若参与加权的边沿点数量小于设定的边沿点阈值(本实施例取值为300),转步骤S12,否则直接进入步骤S13;
[0038] S12:以步骤S11中得到的位姿估计为初值,将前一帧Ik-1作为当前帧的参考帧进行图像对齐,用高斯-牛顿迭代优化算法最小化Ik和Ik-1之间的灰度残差得到当前帧相对于前一帧的位姿Tk,k-1,如式(1-4):
[0039]
[0040] 其中 表示帧k-1中深度已知,并且在当前帧可见的角点集合(由地图中的三维特征点投射得到)。结合前一帧相对于世界坐标系的位姿Tk-1,w,则可计算当前帧位姿的初始估计 为式(1-5):
[0041]
[0042] 此时,将当前帧Ik选为新的关键帧作为后续一段图像的参考帧;同时作为地图构建和深度图估计线程的输入信息;
[0043] S13:(利用当前帧位姿的初始估计 可以将地图中的三维特征点投影到当前帧,得到一组二维坐标,但由于 存在误差,这些二维坐标不一定是三维特征点在当前帧成像的真实位置。)根据初始估计 判断地图中能被当前帧观测到的三维特征点集合{pi},得到其在参考帧rm中对应的角点坐标估计 以 为初值,用图像跟踪算法KLT(Kanade-Lucas-Tomasi Feature Tracker,为常用的公开算法)计算{pi}在当前帧的真实成像位置
[0044]
[0045] 其中,Ai表示将参考图块变换到当前图像的变换矩阵。 表示参考图块和当前图像中的匹配图块的平均灰度差,用于消除光照影响(该步骤建立了地图中的三维特征点{pi}和图像中二维角点 的亚像素精度的对应关系);
[0046] S14:经步骤S13得到的二维坐标与当前帧的初始位姿估计 不再满足几何投影约束,即式(1-7):
[0047]
[0048] 以 为初值,通过最小化重投影误差对Tk,w进行更新得到的当前帧位姿Tk,w即是运动估计的最终结果,如式(1-8):
[0049]
[0050] Tk,w即为测程得到的最终结果。之后转步骤S15,同时将步骤S14得到的当前帧位姿Tk,w分别转地图构建线程和深度图估计线程计算角点深度值和计算边沿点深度值;
[0051] S15:利用步骤S14得到的当前帧位姿Tk,w,对当前帧能够观测到的地图中的每一个三维特征点分别进行优化,使该三维特征点在所有能观测到它的关键帧中的投影和真实成像位置的误差平方和最小即如式(1-9):
[0052]
[0053] 上式中,上标j表示能观测到三维特征点pi的第j个关键帧;
[0054] 22)地图构建线程,分两种情况处理:若新获取的图像在运动估计线程步骤S12被选为新的关键帧,执行步骤S21,从新加入的关键帧中提取角点特征,算法为每一个新提取的角点创建一个基于概率的深度滤波器(即角点的深度由深度值和不确定度构成,每一次新的观测都通过深度滤波器更新角点的深度值及其不确定度);当新获取的图像不被选作关键帧时,利用运动估计线程步骤S14得到的当前帧的位姿执行步骤S22~S24,利用新图像的信息更新角点特征的概率深度滤波器,当某一角点的深度不确定度小于设定的不确定度阈值时,将其对应的三维特征点加入到地图中,该线程实施例如图4所示,具体步骤描述如下:首先判断新图像是否为关键帧,若是执行步骤S21,否则执行步骤S22-S24;
[0055] S21:当一帧图像被选定为关键帧时,使用FAST算法(Features from Accelerated Segment Test,常用的快速角点提取算法)提取该关键帧角点特征;先用等间距的网格(例如30x30像素)将图像均匀划分,每个网格中只提取一个角点,使角点均匀地分布在图像中,总数不超过网格数;为每一个新的角点 创建一个概率深度滤波器,并将其深度的倒数(其中 表示角点的深度的倒数,下标i表示当前关键帧中的第i个角点,为正整数),和该角点有效观测的出现概率ρi(其中ρ表示角点的有效观测概率,下标i表示当前关键帧中的第i个角点,为正整数)的联合后验分布定义如式(2-1):
[0056]
[0057] 其中Beta和N分别表示Beta分布和正态分布,下标n表示对当前概率深度滤波器已经进行了n次参数更新,为正整数,参数an和bn是递推更新过程中有效观测和无效观测分别发生的次数,μn和 则是深度倒数高斯分布的均值和方差;对式(2-1)中的参数进行初始化时,将an和bn的初值置为10,μn初始化为所在图像的平均深度的倒数, 初始化为最大值。
[0058] S22:使用步骤S14得到的相机位姿已知的图像Ik,对角点特征的深度估计进行更新;记被更新的角点 所在的关键帧为rm,根据当前帧Ik和rm的相对位姿,在Ik中确定一条直线,并保证Ik中与 对应的像素点 出现在这条直线上;在这条直线上进行搜索(该过程通常称为极线搜索),经亚像素精度的块匹配得到 的坐标后,用三角测量(立体视觉中的标准计算方法)计算出所述角点 的深度
[0059] S23:将步骤S22得到的深度 取倒数为 其中,下标i表示是当前关键帧中的第i个角点,为正整数,上标n表示这是对当前角点深度滤波器的第n次量测更新,为正整数,对深度的倒数 的概率分布建模如式(2-2):
[0060]
[0061] 上式的含义为:关键帧rm中第i个角点经图像Ik的三角测量,如果为有效测量,那么测量结果的倒数 满足正态分布 其中 为图像平面一个像素误差引起的深度倒数计算方差,如果为无效测量,则 满足均匀分布 其中 为根据当前场景的先验信息设定的深度倒数的最小值和最大值;经过 的量测更新,深度倒数的后验概率分布如式(2-3):
[0062]
[0063] 其中,C为保证概率分布归一化的常数。通过矩匹配方法(统计学方法,用一种分布近似另一种分布)可以计算出
[0064] S24:剔除有效测量概率 过低(小于0.1)的角点,将不确定度σn满足要求(σn小于角点深度倒数的最大估计值的1/200)的点添加到地图中;
[0065] 23)深度图估计线程,分两种情况处理:若新获取的图像在运动估计线程步骤S12被选为新的关键帧,从新加入的关键帧中提取出边沿点,执行步骤S31~S33;当新输入的图像不被选作关键帧时,利用运动估计线程步骤S14得到的当前帧的位姿,执行步骤S34~S36,用新图像信息更新边沿点的概率深度滤波器,并剔除有效观测概率过低的边沿点;执行步骤如图5所示,具体描述如下:首先判断新图像是否为关键帧,若是执行步骤S31-S33,否则执行步骤S34-S36;
[0066] S31:在新加入的关键帧中,利用Sobel算子(一种进行边沿点检测的通用方法)计算图像横向和纵向的灰度梯度Gx和Gy,灰度梯度图用 近似。从图像中选出灰度梯度最大的2500到4000个像素点,当梯度显著的像素点数目小于2500时,将梯度阈值450减小为原来的0.95倍,当数目大于4000时,增大阈值为原来的1.05倍;
[0067] S32:记新的关键帧为rm,前一关键帧为rm-1,本步骤将帧rm-1的深度图Dm-1传播到新的关键帧深度图Dm;rm-1中,边沿点 的深度倒数的均值为 深度倒数的方差为 其中, 表示边沿点的深度倒数的均值, 表示深度倒数的方差,下标i表示帧rm-1中的第i个边沿点。rm-1到rm的相对位姿为Tm,m-1,边沿点 在帧rm中对应边沿点的位置 可由投影关系计算得到如式(3-1):
[0068]
[0069] 记 的深度倒数为 深度倒数的方差记为 那么:
[0070]
[0071] 其中,tz表示相机在光轴上的平移。由此可以推导出 的深度倒数的方差 为:
[0072]
[0073] 其中 表示预测不确定性,根据经验设置。由于投影误差, 的坐标可能不是整数,将 绑定到rm中最近的像素点
[0074] S33:为步骤S31中提取的每一个边沿点创建概率深度滤波器,如果某一个边沿点附近3x3像素范围内存在先验估计 则其深度 的均值 初始化如式(3-4):
[0075]
[0076] 概率深度滤波器的参数深度倒数的不确定度 则初始化为先验估计中最小不确定度,即 如果不存在先验估计,则概率深度滤波器初始化为平均深度和最大不确定度;取 则对于每一个边沿点可按照式(2-1)构造概率深度滤波器如式(3-5):
[0077]
[0078] 其中,(3-5)式各参数定义与(2-1)式中类似,在这里对应边沿点的概率深度滤波器的各个参数,an和bn的初值置为10,μn,σn初始化为 和
[0079] S34:将新的关键帧rm设为后续图像的参考帧,利用后续的图像对帧rm中的深度图Dm进行量测更新;用图像Ik对Dm更新时,记被更新的边沿点为 根据Ik和rm的相对位姿,在Ik中确定一条直线,保证Ik中与 对应的像素点 出现在这条直线上;如果边沿点灰度梯度方向与所述直线方向夹角小于阈值(本实施例设定阈值为25度),经亚像素精度的块匹配得到 的坐标后,用三角测量计算出所述边沿点的深度 执行步骤35);如果所述夹角大于该阈值,则不做搜索,返回步骤S34检查下一个边沿点。
[0080] S35:将步骤S34得到的深度 取倒数为 其中,下标i表示是当前关键帧中的第i个边沿点,为正整数,上标n表示这是对当前边沿点点深度滤波器的第n次量测更新,为正整数,对深度的倒数 的概率分布建模如式(3-6):
[0081]
[0082] 上式的含义为:关键帧rm中第i个边沿点点经图像Ik的三角测量,如果为有效测量,那么测量结果的倒数 满足正态分布 如果为无效测量,则 满足均匀分布其中 为根据当前场景的先验信息设定的深度倒数的最小值和最
大值;经过 的量测更新,深度倒数 的后验概率分布如式(3-6):
[0083]
[0084] 通过矩匹配方法计算出
[0085] S36:剔除有效测量概率过低( 小于0.1)的边沿点。
[0086] 以上仅为本发明的较佳实施例,仅用于解释本发明,而并非对本发明的限制。且本发明的保护范围并不局限于此,任何熟悉本领域的技术人员,在不脱离本发明的精神、原理和范围的情况下,还可以对这些实施例进行多种变化、变型、修改和替换,因此所有等同的技术方法都应属于本发明的范畴,本发明的保护范围应由所附权利要求及其等同限。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈