一种基于激光雷达的路面附着系数估计方法及系统转让专利

申请号 : CN202111345929.4

文献号 : CN114235679B

文献日 :

基本信息:

PDF:

法律信息:

相似专利:

发明人 : 侯欣辰冷搏熊璐田成曾德全

申请人 : 同济大学

摘要 :

本发明涉及一种基于激光雷达的路面附着系数估计方法及系统,所述方法包括:S1:获取不同光照条件、不同路面类型上车辆行驶中车载激光雷达采集的点云信息;S2:提取点云信息中的路面区域点云;S3:基于路面区域点云的反射强度概率分布模型参数,建立路面反射强度分布模型参数数据库;S4:获取实测路面点云数据,利用分布相似度进行路面类型辨识和附着系数估计。与现有技术相比,本发明具有估计精度高、鲁棒性强等优点。

权利要求 :

1.一种基于激光雷达的路面附着系数估计方法,其特征在于,包括以下步骤:S1:获取不同光照条件、不同路面类型上车辆行驶中车载激光雷达采集的点云信息;

S2:提取点云信息中的路面区域点云;

S3:基于路面区域点云的反射强度概率分布模型参数,建立路面反射强度分布模型参数数据库;

S4:获取实测路面点云数据,利用分布相似度进行路面类型辨识和附着系数估计;

所述的步骤S2包括:

S21:结合激光雷达的安装高度设置高程阈值zp,min和zp,max,并在车辆行驶方向上纵向设置一个矩形感兴趣区域,遍历原始点云中各点P0,i的三维坐标(x0,i,y0,i,z0,i),考察其是否满足几何约束条件:式中,Ld表示感兴趣区域与激光雷达的最近距离,La表示感兴趣区域的纵向长度,Lb表示感兴趣区域的侧向长度;

保留满足几何约束条件的点,形成第一路面区域点云;

S22:计算第一路面区域点云中各点P1,i的俯仰角α1,i和航向角θ1,i,将俯仰角α1,i相同的点归类为同一束激光的扫描点;对于每一束激光点,按照航向角θ1,i升序排序,然后计算各点的几何特征G1,i,具体为:式中,下标i表示当前计算的点,下标i+1表示序列中的下一个点,x1,i、y1,i、z1,i为第一路面区域点云中各点P1,i的三维坐标;

S23:对于每一束激光点的序列,在航向角θ1,i=0处设置一个数据长度为Nw的数据观测窗口W,并将其分别向θ1,i>0和θ1,i<0两个方向滑动,并在每次滑动后根据窗口中各点的几何特征G1,i计算该窗口的统计特征T1,i,具体为:式中,G表示在当前数据观测窗口中各点几何特征G1,i的集合;若该统计特征T1,i超过了设定的阈值Tthreshold或窗口滑动至序列末尾,则将该窗口所在位置作为几何特征G1,i的突变位置,即路面和路沿的分界位置,保留每一束激光两个滑动方向上分界位置之间的点云,形成第二路面区域点云;

S24:计算第二路面区域点云三维坐标(x2,i,y2,i,z2,i)的协方差矩阵C及其特征值和特征向量,并将最小特征值对应的特征向量归一化作为拟合道路平面的单位法向量n=[n1,Tn2,n3],n1,n2,n3为对应三维坐标轴的分量,然后计算各点到拟合平面的距离d2,i:式中,N2表示第二路面区域点云中点的数量;设置距离阈值dthreshold,保留距离不超过阈值的点形成第三路面区域点云。

2.根据权利要求1所述的一种基于激光雷达的路面附着系数估计方法,其特征在于,所述的步骤S3包括:S31:建立路面反射强度分布与噪声分布共同形成的混合高斯分布模型:其中,I表示反射强度,Θ表示混合高斯模型分布参数,φ表示高斯分布概率密度函数,ak表示第k个高斯分模型在混合时的权值,μk和σk分别表示第k个高斯分模型的均值和标准差;

T

S32:结合观测到的反射强度数据I=(I1,I2,...,Ij) 定义隐变量:并将Ij与βjk合并为完全数据X=(Ij,βjk);

S33:设置模型参数ak,μk和σk的初始值、混合权值阈值和最大迭代次数,利用X的对数似然函数在给定I和当前混合高斯模型分布参数估计值 时对βjk的条件概率分布的期望 与模型参数的关系式:式中,N3表示第三路面区域点云中点的数量,分别对ak,μk和σk求偏导数并令之为0,得到其极大值点,作为模型参数的更新值;

S34:重复S33直至其中一个混合权值超过阈值或次数达到最大迭代次数,将最终得到的模型参数中混合权值ak较大的一组参数(ak,μk,σk)作为路面点云反射强度分布模型的参数;

S35:对求解出的路面区域点云的反射强度概率分布模型参数标注采集场景和路面类型,形成第一路面反射强度数据库;

S36:分别求取第一路面反射强度数据库中各类模型两两之间的KLD,以表征模型之间的差异性:式中,DKL(φa,φb)表示高斯分布模型φa到φb的KLD,μa和μb分别表示高斯分布模型φa和φb的均值,σa和σb分别表示高斯分布模型φa和φb的标准差;

S37:设定KLD阈值DKL,threshold,考察第一路面反射强度数据库中同种路面类型不同采集场景的模型之间的KLD,将小于阈值的各类模型合并为一类,对其再次进行S31‑S34更新反射强度分布模型参数,并与第一路面反射强度数据库中未进行合并更新的模型共同形成第二路面反射强度数据库。

3.根据权利要求2所述的一种基于激光雷达的路面附着系数估计方法,其特征在于,所述的步骤S4具体包括:S41:获取待估计路面的实测路面点云数据,利用S31‑S34计算实测路面反射强度高斯分布模型φtest(I)的模型参数;

S42:计算实测路面反射强度分布模型φtest(I)和第二路面反射强度数据库中各类模型φl(I)之间的相似度S(φtest,φl):式中,μl和σl分别表示第l个高斯模型φl(I)的均值和方差;

S43:计算实测模型φtest(I)属于第二路面反射强度数据库中各类模型φl(I)的概率P(cl):式中,λ表示平滑算子,Nm表示第二路面反射强度数据库中的模型类别总数;

S44:取最大概率值P(cl)对应的第二路面反射强度数据库中的模型类别作为当前实测路面的反射强度分布类别;

S45:获取第二路面反射强度数据库中的模型类别与附着系数先验值的映射关系,根据前实测路面的反射强度分布类别得到实测路面的附着系数估计值。

4.根据权利要求1所述的一种基于激光雷达的路面附着系数估计方法,其特征在于,所述步骤S1中的点云信息包括不同光照强度下不同驾驶环境的点云信息。

5.根据权利要求1所述的一种基于激光雷达的路面附着系数估计方法,其特征在于,所‑4 5述的光照强度的范围为1×10 ~1×10Lx。

6.根据权利要求4所述的一种基于激光雷达的路面附着系数估计方法,其特征在于,所述的驾驶环境包括晴朗的白天、黄昏、有路灯照明的夜晚、无路灯照明的夜晚。

7.根据权利要求1所述的一种基于激光雷达的路面附着系数估计方法,其特征在于,所述的车载激光雷达采集的点云信息包括三维坐标(x,y,z)以及激光反射强度I。

8.一种基于激光雷达的路面附着系数估计系统,其特征在于,包括信息获取模块(1)、点云提取模块(2)、数据库构建模块(3)、系数估计模块(4),所述的信息获取模块(1)用于获取不同光照条件、不同路面类型上车辆行驶中车载激光雷达采集的点云信息;

所述的点云提取模块(2)用于提取点云信息中的路面区域点云;

所述的数据库构建模块(3)用于基于路面区域点云的反射强度概率分布模型参数,建立路面反射强度分布模型参数数据库;

所述的系数估计模块(4)用于获取实测路面点云数据,利用分布相似度进行路面类型辨识和附着系数估计;

所述的信息获取模块(1)获取点云信息的步骤包括:

S21:结合激光雷达的安装高度设置高程阈值zp,min和zp,max,并在车辆行驶方向上纵向设置一个矩形感兴趣区域,遍历原始点云中各点P0,i的三维坐标(x0,i,y0,i,z0,i),考察其是否满足几何约束条件:式中,Ld表示感兴趣区域与激光雷达的最近距离,La表示感兴趣区域的纵向长度,Lb表示感兴趣区域的侧向长度;

保留满足几何约束条件的点,形成第一路面区域点云;

S22:计算第一路面区域点云中各点P1,i的俯仰角α1,i和航向角θ1,i,将俯仰角α1,i相同的点归类为同一束激光的扫描点;对于每一束激光点,按照航向角θ1,i升序排序,然后计算各点的几何特征G1,i,具体为:式中,下标i表示当前计算的点,下标i+1表示序列中的下一个点,x1,i、y1,i、z1,i为第一路面区域点云中各点P1,i的三维坐标;

S23:对于每一束激光点的序列,在航向角θ1,i=0处设置一个数据长度为Nw的数据观测窗口W,并将其分别向θ1,i>0和θ1,i<0两个方向滑动,并在每次滑动后根据窗口中各点的几何特征G1,i计算该窗口的统计特征T1,i,具体为:式中,G表示在当前数据观测窗口中各点几何特征G1,i的集合;若该统计特征T1,i超过了设定的阈值Tthreshold或窗口滑动至序列末尾,则将该窗口所在位置作为几何特征G1,i的突变位置,即路面和路沿的分界位置,保留每一束激光两个滑动方向上分界位置之间的点云,形成第二路面区域点云;

S24:计算第二路面区域点云三维坐标(x2,i,y2,i,z2,i)的协方差矩阵C及其特征值和特征向量,并将最小特征值对应的特征向量归一化作为拟合道路平面的单位法向量n=[n1,Tn2,n3],n1,n2,n3为对应三维坐标轴的分量,然后计算各点到拟合平面的距离d2,i:式中,N2表示第二路面区域点云中点的数量;设置距离阈值dthreshold,保留距离不超过阈值的点形成第三路面区域点云。

9.根据权利要求8所述的一种基于激光雷达的路面附着系数估计系统,其特征在于,所述的点云信息包括不同光照强度下不同驾驶环境的点云信息。

说明书 :

一种基于激光雷达的路面附着系数估计方法及系统

技术领域

[0001] 本发明涉及智能汽车环境感知及运动控制领域,尤其是涉及一种基于激光雷达的路面附着系数估计方法及系统。

背景技术

[0002] 路面附着系数是车辆主动安全控制过程中的重要参数,其估计的准确性将极大地影响控制效果,如果能够准确地获得当前的路面附着系数,则可以有效提升车辆的主动安全性。
[0003] 目前主要的研究方法大致可分为两类:一类是基于轮胎动力学响应估计路面附着系数。这种方法的优点是所需的硬件条件相对容易满足。然而,该方法获得准确估计结果的前提是存在足够大的路面激励,但此时车轮滑动率较高,车辆可能已经处于不稳定状态;此外,该方法只能估计轮胎已行驶过路面的附着系数,不能预测前方路面的情况,对控制系统的参考价值不够大。另一种方法是利用车载摄像头获取路面图像,进行分类后映射出对应的路面附着系数估计值。这种方法的优点是估计结果具有预测性。但是,摄像头获取的图像质量极易受到环境光照条件的影响。

发明内容

[0004] 本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种基于激光雷达的路面附着系数估计方法及系统。
[0005] 本发明的目的可以通过以下技术方案来实现:
[0006] 一种基于激光雷达的路面附着系数估计方法,包括以下步骤:
[0007] S1:获取不同光照条件、不同路面类型上车辆行驶中车载激光雷达采集的点云信息;
[0008] S2:提取点云信息中的路面区域点云;
[0009] S3:基于路面区域点云的反射强度概率分布模型参数,建立路面反射强度分布模型参数数据库;
[0010] S4:获取实测路面点云数据,利用分布相似度进行路面类型辨识和附着系数估计。
[0011] 优选地,所述的步骤S2包括:
[0012] S21:结合激光雷达的安装高度设置高程阈值zp,min和zp,max,并在车辆行驶方向上纵向设置一个矩形感兴趣区域,遍历原始点云中各点P0,i的三维坐标(x0,i,y0,i,z0,i),考察其是否满足几何约束条件:
[0013]
[0014] 式中,Ld表示感兴趣区域与激光雷达的最近距离,La表示感兴趣区域的纵向长度,Lb表示感兴趣区域的侧向长度;
[0015] 保留满足几何约束条件的点,形成第一路面区域点云;
[0016] S22:计算第一路面区域点云中各点P1,i的俯仰角α1,i和航向角θ1,i,将俯仰角α1,i相同的点归类为同一束激光的扫描点;对于每一束激光点,按照航向角θ1,i升序排序,然后计算各点的几何特征G1,i,具体为:
[0017]
[0018] 式中,下标i表示当前计算的点,下标i+1表示序列中的下一个点,x1,i、y1,i、z1,i为第一路面区域点云中各点P1,i的三维坐标;
[0019] S23:对于每一束激光点的序列,在航向角θ1,i=0处设置一个数据长度为Nw的数据观测窗口W,并将其分别向θ1,i>0和θ1,i<0两个方向滑动,并在每次滑动后根据窗口中各点的几何特征G1,i计算该窗口的统计特征T1,i,具体为:
[0020]
[0021] 式中,G表示在当前数据观测窗口中各点几何特征G1,i的集合;若该统计特征T1,i超过了设定的阈值Tthreshold或窗口滑动至序列末尾,则将该窗口所在位置作为几何特征G1,i的突变位置,即路面和路沿的分界位置,保留每一束激光两个滑动方向上分界位置之间的点云,形成第二路面区域点云;
[0022] S24:计算第二路面区域点云三维坐标(x2,i,y2,i,z2,i)的协方差矩阵C及其特征值和特征向量,并将最小特征值对应的特征向量归一化作为拟合道路平面的单位法向量n=T[n1,n2,n3],n1,n2,n3为对应三维坐标轴的分量,然后计算各点到拟合平面的距离d2,i:
[0023]
[0024] 式中,N2表示第二路面区域点云中点的数量;设置距离阈值dthreshold,保留距离不超过阈值的点形成第三路面区域点云。
[0025] 优选地,所述的步骤S3包括:
[0026] S31:建立路面反射强度分布与噪声分布共同形成的混合高斯分布模型:
[0027]
[0028] 其中,I表示反射强度,Θ表示混合高斯模型分布参数,φ表示高斯分布概率密度函数,ak表示第k个高斯分模型在混合时的权值,μk和σk分别表示第k个高斯分模型的均值和标准差。
[0029] S32:结合观测到的反射强度数据I=(I1,I2,...,Ij)T定义隐变量:
[0030]
[0031] 并将Ij与βjk合并为完全数据X=(Ij,βjk);
[0032] S33:设置模型参数ak,μk和σk的初始值、混合权值阈值和最大迭代次数,利用X的对数似然函数在给定I和当前混合高斯模型分布参数估计值 时对βjk的条件概率分布的期望 与模型参数的关系式:
[0033]
[0034] 式中,N3表示第三路面区域点云中点的数量,分别对ak,μk和σk求偏导数并令之为0,得到其极大值点,作为模型参数的更新值;
[0035] S34:重复S33直至其中一个混合权值超过阈值或次数达到最大迭代次数,将最终得到的模型参数中混合权值ak较大的一组参数(ak,μk,σk)作为路面点云反射强度分布模型的参数;
[0036] S35:对求解出的路面区域点云的反射强度概率分布模型参数标注采集场景和路面类型,形成第一路面反射强度数据库;
[0037] S36:分别求取第一路面反射强度数据库中各类模型两两之间的KLD,以表征模型之间的差异性:
[0038]
[0039] 式中,DKL(φa,φb)表示高斯分布模型φa到φb的KLD,μa和μb分别表示高斯分布模型φa和φb的均值,σa和σb分别表示高斯分布模型φa和φb的标准差;
[0040] S37:设定KLD阈值DKL,threshold,考察第一路面反射强度数据库中同种路面类型不同采集场景的模型之间的KLD,将小于阈值的各类模型合并为一类,对其再次进行S31‑S34更新反射强度分布模型参数,并与第一路面反射强度数据库中未进行合并更新的模型共同形成第二路面反射强度数据库。
[0041] 优选地,所述的步骤S4具体包括:
[0042] S41:获取待估计路面的实测路面点云数据,利用S31‑S34计算实测路面反射强度高斯分布模型φtest(I)的模型参数;
[0043] S42:计算实测路面反射强度分布模型φtest(I)和第二路面反射强度数据库中各类模型φl(I)之间的相似度S(φtest,φl):
[0044]
[0045] 式中,μl和σl分别表示第l个高斯模型φl(I)的均值和方差;
[0046] S43:计算实测模型φtest(I)属于第二路面反射强度数据库中各类模型φl(I)的概率P(cl):
[0047]
[0048] 式中,λ表示平滑算子,Nm表示第二路面反射强度数据库中的模型类别总数;
[0049] S44:取最大概率值P(cl)对应的第二路面反射强度数据库中的模型类别作为当前实测路面的反射强度分布类别;
[0050] S45:获取第二路面反射强度数据库中的模型类别与附着系数先验值的映射关系,根据前实测路面的反射强度分布类别得到实测路面的附着系数估计值。
[0051] 优选地,所述步骤S1中的点云信息包括不同光照强度下不同驾驶环境的点云信息。
[0052] 优选地,所述的光照强度的范围为1×10‑4~1×105Lx。
[0053] 优选地,所述的驾驶环境包括晴朗的白天、黄昏、有路灯照明的夜晚、无路灯照明的夜晚。
[0054] 优选地,所述的车载激光雷达采集的点云信息包括三维坐标(x,y,z)以及激光反射强度I。
[0055] 一种基于激光雷达的路面附着系数估计系统,包括信息获取模块、点云提取模块、数据库构建模块、系数估计模块,
[0056] 所述的信息获取模块用于获取不同光照条件、不同路面类型上车辆行驶中车载激光雷达采集的点云信息;
[0057] 所述的点云提取模块用于提取点云信息中的路面区域点云;
[0058] 所述的数据库构建模块用于基于路面区域点云的反射强度概率分布模型参数,建立路面反射强度分布模型参数数据库;
[0059] 所述的系数估计模块用于获取实测路面点云数据,利用分布相似度进行路面类型辨识和附着系数估计。
[0060] 优选地,所述的点云信息包括不同光照强度下不同驾驶环境的点云信息。
[0061] 与现有技术相比,本发明具有如下优点:
[0062] 1)本发明通过分析激光雷达收集到的路面点云反射强度分布来进行路面类别辨识和附着系数估计,相比现有的动力学估计方法而言,具有预测性且不需要车辆处于大滑动率状态,其估计结果对车辆运动控制系统的参考意义更大,适用工况更广泛;
[0063] 2)本发明的路面附着系数估计方法基于激光雷达采集的点云数据,由于激光雷达本身对光照变化不敏感的特性,以及采集了不同光照条件下的数据形成数据集,相比现有的基于车载摄像头的路面辨识方法而言,对环境光照条件变化的鲁棒性更强;
[0064] 3)本发明中对采集激光雷达点云中的路面区域进行逐级提取的方式,能够精确提取车辆前方路面区域,使后续对路面区域反射强度的分析可靠性更高,提高路面附着系数估计的准确性。
[0065] 4)本发明采用考察实测路面和数据库中的反射强度分布模型相似度的方式来进行路面类别辨识,计算过程简便,更容易实施,且适用范围更广。

附图说明

[0066] 图1为本发明的流程图;
[0067] 图2为本发明的具体流程示意图;
[0068] 图3为本发明的一种基于激光雷达的路面附着系数估计系统的结构示意图。
[0069] 其中,1、信息获取模块,2、点云提取模块,3、数据库构建模块,4、系数估计模块。

具体实施方式

[0070] 下面结合附图和具体实施例对本发明进行详细说明。注意,以下的实施方式的说明只是实质上的例示,本发明并不意在对其适用物或其用途进行限定,且本发明并不限定于以下的实施方式。
[0071] 实施例
[0072] 一种基于激光雷达的路面附着系数估计方法,如图1、2所示,包括以下步骤:
[0073] S1:获取不同光照条件、不同路面类型上车辆行驶中车载激光雷达采集的点云信息。
[0074] 本实施例中,S1获取点云信息的车载激光雷达安装在车辆顶部支架,其技术参数要求为:线数不低于32,测距精度不低于3cm,水平分辨率不低于0.2°,帧率不低于10Hz。采集场景包括但不限于:晴朗的白天、黄昏、有/无路灯照明的夜晚等,光照强度的范围为1×‑4 510 ~1×10Lx;采集的路面类型包括但不限于:干燥沥青、干燥混凝土、潮湿沥青和潮湿混凝土路面;采集的样本数量要求为:各采集场景中各类路面的点云帧数分别不低于500帧。
车载激光雷达采集的点云信息包括三维坐标(x,y,z)以及激光反射强度I。
[0075] S2:提取点云信息中的路面区域点云。
[0076] 步骤S2具体包括:
[0077] (1)结合激光雷达的安装高度,设置高程阈值zp,min和zp,max,并在车辆行驶方向上纵向设置一个矩形感兴趣区域。遍历原始点云中各点P0,i的三维坐标(x0,i,y0,i,z0,i),考察其是否满足几何约束条件:
[0078]
[0079] 式中,Ld表示感兴趣区域与激光雷达的最近距离,La表示感兴趣区域的纵向长度,Lb表示感兴趣区域的侧向长度,保留满足几何约束条件的点,形成第一路面区域点云;
[0080] (2)计算第一路面区域点云中各点P1,i的俯仰角α1,i和航向角θ1,i,将俯仰角α1,i相同的点归类为同一束激光的扫描点;对于每一束激光点,按照航向角θ1,i升序排序,然后计算各点的几何特征G1,i,具体为:
[0081]
[0082] 式中,下标i表示当前计算的点,下标i+1表示序列中的下一个点,x1,i、y1,i、z1,i为第一路面区域点云中各点P1,i的三维坐标。
[0083] 对于每一束激光点的序列,在航向角θ1,i=0处设置一个数据长度为Nw的数据观测窗口W,并将其分别向θ1,i>0和θ1,i<0两个方向滑动,并在每次滑动后根据窗口中各点的几何特征G1,i计算该窗口的统计特征T1,i,具体为:
[0084]
[0085] 式中,G表示在当前数据观测窗口中各点几何特征G1,i的集合;若该统计特征T1,i超过了设定的阈值Tthreshold或窗口滑动至序列末尾,则将该窗口所在位置作为几何特征G1,i的突变位置,即路面和路沿的分界位置,保留每一束激光两个滑动方向上分界位置之间的点云,形成第二路面区域点云;
[0086] (4)计算第二路面区域点云三维坐标(x2,i,y2,i,z2,i)的协方差矩阵C及其特征值和特征向量,并将最小特征值对应的特征向量归一化作为拟合道路平面的单位法向量n=T[n1,n2,n3],n1,n2,n3为对应三维坐标轴的分量,然后计算各点到拟合平面的距离d2,i:
[0087]
[0088] 式中,N2表示第二路面区域点云中点的数量;设置距离阈值dthreshold,保留距离不超过阈值的点形成第三路面区域点云,即最终提取的路面区域点云。
[0089] S3:基于路面区域点云的反射强度概率分布模型参数,建立路面反射强度分布模型参数数据库。
[0090] 具体包括,
[0091] (1)建立路面反射强度分布与噪声分布共同形成的混合高斯分布模型其中,I表示反射强度,Θ表示混合高斯模型分布参数,φ表示高斯分布概率密度函数,ak表示第k个高斯分模型在混合时的权值,μk和σk分别表示第k个高斯分模型的均值和标准差。
[0092] (2)结合观测到的反射强度数据I=(I1,I2,...,Ij)T定义隐变量:
[0093]
[0094] 并将Ij与βjk合并为完全数据X=(Ij,βjk);
[0095] (3)设置模型参数ak,μk和σk的初始值、混合权值阈值和最大迭代次数,利用X的对数似然函数在给定I和当前混合高斯模型分布参数估计值 时对βjk的条件概率分布的期望 与模型参数的关系式:
[0096]
[0097] 式中,N3表示第三路面区域点云中点的数量,分别对ak,μk和σk求偏导数并令之为0,得到其极大值点,作为模型参数的更新值;
[0098] (4)重复(3)直至其中一个混合权值超过阈值或次数达到最大迭代次数,将最终得到的模型参数中混合权值ak较大的一组参数(ak,μk,σk)作为路面点云反射强度分布模型的参数;
[0099] (5)对求解出的路面区域点云的反射强度概率分布模型参数标注采集场景和路面类型,形成第一路面反射强度数据库;
[0100] (6)分别求取第一路面反射强度数据库中各类模型两两之间的KLD,以表征模型之间的差异性,具体为:
[0101]
[0102] 式中,DKL(φa,φb)表示高斯分布模型φa到φb的KLD,μa和μb分别表示高斯分布模型φa和φb的均值,σa和σb分别表示高斯分布模型φa和φb的标准差;
[0103] (7)设定KLD阈值DKL,threshold,考察第一路面反射强度数据库中同种路面类型不同采集场景的模型之间的KLD,将小于阈值的各类模型合并为一类,对其再次进行(1)到(4)更新反射强度分布模型参数,并与第一路面反射强度数据库中未进行合并更新的模型共同形成第二路面反射强度数据库,作为最终的反射强度数据库。
[0104] S4:获取实测路面点云数据,利用分布相似度进行路面类型辨识和附着系数估计。
[0105] 具体包括,(1)计算实测路面反射强度高斯分布模型φtest(I)的模型参数(均值μtest和方差σtest);
[0106] (2)计算实测路面反射强度分布模型φtest(I)和第二路面反射强度数据库中各类模型φl(I)之间的相似度S(φtest,φl):
[0107]
[0108] 式中,μl和σl分别表示第l个高斯模型φl(I)的均值和方差;
[0109] (3)计算实测模型φtest(I)属于第二路面反射强度数据库中各类模型φl(I)的概率P(cl):
[0110]
[0111] 式中,λ表示平滑算子,Nm表示第二路面反射强度数据库中的模型类别总数;
[0112] (4)取最大概率值P(cl)对应的第二路面反射强度数据库中的模型类别作为当前实测路面的反射强度分布类别;
[0113] (5)获取第二路面反射强度数据库中的模型类别与附着系数先验值的映射关系,根据前实测路面的反射强度分布类别得到实测路面的附着系数估计值。本实施例中具体映射关系为:
[0114] 干燥沥青路面的路面附着系数为1.0;
[0115] 干燥混凝土路面的路面附着系数为0.9;
[0116] 潮湿沥青路面的路面附着系数为0.7;
[0117] 潮湿混凝土路面的路面附着系数为0.6。
[0118] 本实施例中,系统的硬件设置包括车载激光雷达和工控机。激光雷达通过以太网线与工控机实现点云数据的传输,工控机用于处理点云数据。
[0119] 一种基于激光雷达的路面附着系数估计系统,采用上述估计方法获取路面附着系数,如图3所示,包括信息获取模块1、点云提取模块2、数据库构建模块3、系数估计模块4,信息获取模块1用于获取不同光照条件、不同路面类型上车辆行驶中车载激光雷达采集的点云信息;点云提取模块2用于提取点云信息中的路面区域点云;数据库构建模块3用于基于路面区域点云的反射强度概率分布模型参数,建立路面反射强度分布模型参数数据库;系数估计模块4用于获取实测路面点云数据,利用分布相似度进行路面类型辨识和附着系数估计。
[0120] 上述实施方式仅为例举,不表示对本发明范围的限定。这些实施方式还能以其它各种方式来实施,且能在不脱离本发明技术思想的范围内作各种省略、置换、变更。