基于小米扫地机器人自动充电座引发的激光雷达强度的考虑

2040阅读 0评论2020-05-07 iibull
分类:其他平台


基于激光雷达强度值的自动充电座特征提取.docx
lidar_autocharge_demo.zip


本来打算使用激光反射光强来进行物品定位, 例如自动充电座位置, 自己打印了黑白间隔纸进行测试, 发现光强不是那么稳定, 主要是环境光有一些影响, 例如光亮的地方比较采集数据相对比较正确, 背光就会差别很多.

1 引言

扫描激光雷达具有不受环境光影响、测距精度高、扫描范围广等优点, 被广泛应用于无人驾驶车辆以及移动机器人中探测障碍物、感知环境[]。无人驾驶和移动机器人系统中的一个重要任务就是对周围环境中的目标物进行正确的分类和识别, 从而针对不同类型目标作出相应决策[]。当前对于激光雷达数据的目标分类识别方法的研究主要利用的是点云坐标信息, 通过点云坐标信息计算目标的几何尺寸, 以实现对目标的分类识别。Korchev等[]将点云数据分割为独立目标, 通过提取每个目标的体积特征实现了对人、汽车、自行车和背景目标的分类。Kidono等[]将三维点云按高度进行分层切片, 提取每一层切片的长宽特征来实现对行人目标的检测。以上基于点云坐标数据提取目标几何特征的分类方法容易受到目标间相互遮挡的影响, 并且无法区分两类几何尺寸特征接近的目标(如电线杆和树干, 行人和指示牌)。

三维扫描激光雷达不仅可以准确地获取各个目标点的坐标信息, 还可以记录每个目标点的反射强度值。强度数据能在一定程度上反映目标反射能力, 在目标分类和识别中具有广阔的应用前景[]。但其不仅与目标反射能力有关, 还受到距离、入射方位角和大气状况等因素的影响[]。研究如何从激光雷达强度值中提取表征目标特征的参数对于加强强度数据的利用、拓宽目标分类方法具有重要意义。目前, 国内外已有不少学者对目标强度值的校正利用进行了研究, 以消除其他因素对强度值的影响, 使得强度值能直接反映目标的反射特征。如H?fle等[]通过数值驱动和模型驱动两种方法分别对机载激光雷达强度数据进行校正, 使实验区域整体强度更加均匀。程小龙等[]根据激光雷达测距方程, 采用分段多项式模型对同一目标的激光雷达强度值进行距离和角度修正, 使同一目标强度值趋于统一。李泉等[]提出了一种高斯混合模型的直方图匹配方法, 用以获得的多站点云强度值进行纠正。以上研究主要是针对机载和地面扫描雷达, 研究的目标主要是大立面的建筑物和地形等。而随着扫描激光雷达在无人车等领域中的广泛应用, 如何从点云强度值中提取目标的反射特征来实现对目标的分类, 具有重要的研究价值。本文依据激光雷达方程并考虑雷达的后续信号处理转换, 在实验基础上, 通过数据驱动的方式建立了激光雷达强度值与目标反射特征参数间的关系模型, 并设计了简单验证实验, 通过模拟雷达的直线运动获得同一目标在不同距离和入射角下的强度值, 将其代入模型中实现了对目标反射特征参数的反演。

2 激光雷达强度值理论分析

激光雷达的强度值可以看作激光雷达将接收的目标回波光功率, 经过光电信号转换和放大, 以及后续的修正处理及数字量化等一系列综合过程后返回给使用者的一个离散整数值[]。激光雷达的回波强度主要可以通过激光雷达方程来进行表征, 对于同轴扩展目标, 激光雷达方程可以表示为[]

Pr=PtηtηrD24?exp(?2αR)R2?ρcos2θ,(1)Pr=PtηtηrD24·exp(-2αR)R2·ρcos2θ,(1)

式中:Pr为接收到的目标回波功率; Pt为激光器发射功率; ηt为发射光学系统的光学效率; ηr为接收光学系统的光学效率; D为接收探测器的孔径; α为大气单程消光系数; R为激光雷达中心到目标点的距离; ρ为目标的反射率; θ为目标点相对雷达的入射角度。

用函数h来表征雷达后续的信号处理过程, 并称其为信号转换函数。将激光雷达强度返回值记为I, 则有

I=h(Pr)。(2)I=h(Pr)。(2)

(1)式的推导是将目标看成余弦朗伯体。但真实目标往往会偏离朗伯体[], 且扫描雷达对强度的校正过程中, 其距离也不一定严格遵循平方反比变化规律[], 故可将(1)式的激光雷达方程改写为

Pr=K?g(θ)?f(R),(3)Pr=K·g(θ)·f(R),(3)

式中:K为系统参数和目标反射系数的乘积, 表征特定系统目标反射能力的大小; g(θ)为角度因子, 表征目标反射能量的空间分布情况; f(R)为距离因子, 表征反射强度随距离的变化关系。

综合(2)式和(3)式, 激光雷达强度返回值可以表示为

I=h[K?f(R)?g(θ)]。(4)I=hK·f(R)·g(θ)。(4)

当通过实验确定了激光雷达的信号转换函数h、距离因子f(R)以及角度因子g(θ)的具体形式后, 便可建立起激光雷达强度值与目标反射特征参数间的关系, 从而可以基于强度值提取目标反射特征, 实现对目标的分类。

3 角度因子的实验研究

在(4)式所表征的激光雷达强度值理论模型中, 角度因子g(θ)主要表征目标反射能量的空间分布, 是与目标特征相关的参量。根据目标反射相关理论, 一束激光入射到目标表面, 发生的反射可以看作是镜面反射和漫反射的结合[]。同轴结构的激光雷达在非0°反射角下接收目标的漫反射能量。为了简单且较准确地描述目标漫反射光的空间分布, 引入了半椭圆、椭圆两种模型的角度因子[], 并与朗伯模型的角度因子进行对比。图1为3种角度因子模型的示意图, 目标中心在O点, 曲线上各点与点O连线的长度表示该方向上反射能量的相对大小。通过解析几何推导, 可得出同轴情况下朗伯、半椭圆和椭圆3种模型的角度因子。

gL(θ)=cos2θ,(5)gS(θ)=cosθ?1κ2sin2θ+cos2θ??????????√,(6)gE(θ)=cos2θκ2sin2θ+cos2θ,(7)gL(θ)=cos2θ,(5)gS(θ)=cosθ·1κ2sin2θ+cos2θ,(6)gE(θ)=cos2θκ2sin2θ+cos2θ,(7)

式中:κ为椭圆长短轴之比; gL(θ)、gS(θ)和gE(θ)分别为朗伯、半椭圆和椭圆3种模型的角度因子。

搭建了一套同轴激光测量系统来比较几种不同角度因子对目标漫反射功率随角度变化关系的匹配程度。选择了城市环境中常见且具有代表性的材料如铝、聚四氟乙烯、水泥块和白聚晶瓷砖作为实验目标, 设计的测量系统及测量目标如图2所示。


图1 3种角度因子模型的示意图。 (a)朗伯模型; (b)半椭圆模型; (c)椭圆模型Fig. 1 Schematic of three angle factor models. (a) Lambertian model; (b) semi-elliptical model; (c) elliptical model



图2 (a)实验系统设计图; (b)测量目标图Fig. 2 (a) Design diagram of experimental system; (b) diagram of measured target


激光器发出的光经过立方分光晶体后分为两束, 一束透射到达目标, 一束反射进入光电探头用于光源稳定性监测。到达目标的激光束经过目标反射后在分光晶体处再次被分为两束光, 一束反射进入另一端的光电探头用于记录反射光功率。实验过程中使用了分束镜, 以保证激光雷达的收发同轴。实验所用的激光器为半导体激光器, 可发射波长为905 nm的连续激光, 功率在0~160 mW范围内可调。光电探头探测波长范围为400~1100 nm, 探测功率范围为50 nW~50 mW。实验过程中, 分别测量了入射角在0~75°范围内每种目标的反射功率变化情况, 每隔5°测量一次数据; 初始目标到接收探测器的距离为150 mm, 随后增大两者之间的距离, 每隔50 mm测量了一组数据, 直到目标反射功率很微弱。每次测量前利用平面反射镜确定0°入射角的位置。

图3所示为测量距离为150 mm下几种目标的漫反射光功率随角度的变化关系。分别用3种角度因子模型对接收功率进行了拟合, 给出了几种角度因子模型拟合的相关系数。根据的数据, 朗伯模型的角度因子对于4种目标漫反射能量的拟合相关系数均最低, 且对于铝和瓷砖这2种镜面反射目标的漫反射能量的拟合系数远低于其他2种模型。半椭圆模型对聚四氟乙烯、水泥板和瓷砖3种目标漫反射能量的拟合系数均最高, 对于铝的漫反射能量的拟合相关系数低于椭圆模型, 但在数值上差距较小。

图4所示为不同距离下利用半椭圆模型拟合得到的目标漫反射强度值。中列出了4种目标在不同距离下半椭圆模型的角度因子中κ参数的值。从图4可以看出, 半椭圆模型的角度因子能较准确地描述目标漫反射能量的空间分布情况。根据的数据, 当用半椭圆模型的角度因子拟合目标漫反射强度值时, 同一目标的κ值在不同距离下较为接近, 而不同目标的κ值则有所差别。半椭圆模型中的κ值表征了目标漫反射光强空间分布上的差异, 是目标反射特征的重要表征参数之一。


图3 150 mm处4种目标的光功率拟合曲线。(a)聚四氟乙烯; (b)水泥; (c)铝; (d)瓷砖Fig. 3 Fitting curves of optical power for four targets at 150 mm. (a) PTFE; (b) cement; (c) aluminum; (d) glazed tile


 表1 4种目标各角度因子模型的光功率拟合相关系数      Table 1 Correlation coefficients of optical power of different angle factor models for four targets


图4 不同距离时4种目标反射强度及半椭圆拟合曲线。 (a)聚四氟乙烯; (b)水泥; (c)铝; (d)瓷砖Fig. 4 Reflection intensity and semi-elliptical fitting curves of four targets at difference distances. (a) PTFE; (b) cement; (c) aluminum; (d) glazed tile


 表2 4种目标不同距离下半椭圆模型拟合参数κ      Table 2 Fitting parameters of semi-elliptical for four targets at different distances
4 信号转换函数和距离因子实验研究

在激光雷达强度值理论模型中, 信号转换函数h及距离因子f(R)是与激光雷达后续信号处理修正相关的参量, 相应函数的具体形式与雷达本身相关。然而由于雷达厂商并不公开雷达后续的信号处理修正过程, 因此需要利用数据驱动的方式建立相应函数的形式。

利用目前广泛应用于无人驾驶和移动机器人系统中的三维激光扫描雷达VLP-16进行实验, 以研究信号转换函数以及距离因子的具体形式, 并验证半椭圆模型角度因子的适用性。VLP-16激光雷达强度值的量化等级为8 bit, 强度值范围为0~255。采用控制变量的方式, 分别获取不同入射方位角和距离下的目标点云强度值, 通过最小二乘拟合的方法确定相应函数的具体形式。在拟合信号转换函数的过程中, 主要考虑了线性、对数、多项式等函数形式。分别选用了负指数、平方反比等模型来研究距离因子。图5为实验示意图和现场图。实验场地为学校篮球场, VLP-16激光雷达通过三角架固定, 目标尺寸为200 mm×500 mm, 通过固定装置将旋转台和转接装置固定在三角架上。实验目标选择了聚四氟乙烯板、木板、水泥板、白色帆布料、瓷砖、铝板等生活和城市建筑中常见材料, 各种目标均匀性较好。白色帆布通过贴片胶水贴在相应尺寸透明亚克力板上。首先在目标距离雷达5, 10, 15 m处, 分别获取了水平扫描角为0°, 15°, 30°, 45°, 60°时的目标点云强度。接着固定目标相对y轴激光线入射角为0°, 沿y轴方向移动目标, 从10 m处开始, 每次移动5 m, 直到目标距离雷达40 m, 记录下相应位置下的点云强度值。数据处理时, 通过投影降维的方法来找到目标相关区域。通过对目标区域内点云强度值求取均值作为相应距离和入射角下目标的强度值, 在求平均值时剔除偏离整体均值较大的误差点。随着距离的增大, 垂直方向上打到目标上的激光数减少。为了对比各个距离下的数据, 取垂直扫描角为1°的激光雷达数据进行分析。


图5 (a)激光雷达外场实验示意图和(b)现场图Fig. 5 (a) Schematic and (b) scene of outdoor experiment of lidar


图6所示为各种目标的点云强度随入射角度的变化关系。在同一距离下, 距离因子f(R)可以看作固定值。选择将半椭圆模型的角度因子代入模型中, 以拟合相同距离下的强度值随入射角度的变化关系。经过比较发现, 当选用线性转换函数时, 拟合效果较好, 拟合相关性较高。图6的曲线为采用线性转换函数和半椭圆模型的角度因子时强度值随入射角度变化关系的拟合曲线。由图6可知, 5 m处6种目标点云强度整体小于10 m处, 表明该雷达并不是严格的同轴系统, 5~10 m的范围内存在一个盲区, 在该盲区范围内, 由于目标反射能量逐渐进入接收视场, 反射强度值随距离的增加而逐渐增大, 从而导致5 m处的目标强度值比10 m处小。


图6 目标点云强度值随入射角度的变化关系。(a)聚四氟乙烯; (b)水泥板; (c)木板; (d)白色帆布; (e)瓷砖; (f)铝Fig. 6 Relationship between point cloud intensities and incident angles. (a) PTFE; (b) cement; (c) wood; (d) white canvas; (e) glazed tile; (f) aluminum


图7所示为6种目标点云强度随距离的变化曲线, 聚四氟乙烯、水泥板、木板、白色帆布这4种漫反射目标的强度值随距离的变化关系如图7(a)所示。可以看出, 目标点云强度值随着距离增加而略有降低, 但是并不遵循平方反比的下降规律。经过曲线拟合, 发现负指数规律能较好地表示目标强度值随距离变化的趋势, 中列出了拟合的距离衰减因子σ的值。而铝和瓷砖这两种目标在0°入射角时发生镜面反射, 镜面反射强度随距离的变化关系如图7(b)所示, 可以看出, 镜面反射强度值几乎不随距离发生改变。


图7 0°入射角下强度值随距离的变化关系。(a) 4种漫反射目标; (b) 2种镜面反射目标Fig. 7 Relationship between intensity and distance at 0° incident angle. (a) Four diffuse targets (b) two mirror targets


综合以上实验规律, 该类型扫描激光雷达的目标强度值为

I={K1,K2?exp(2σR)?cosθ?1κ2sin2θ+cos2θ??????????√,I≥ITandθ≤θTI≤ITandθ≥θT,(8)I=K1,I≥ITandθ≤θTK2·exp(2σR)·cosθ·1κ2sin2θ+cos2θ,I≤ITandθ≥θT,(8)

式中:K1K2为特征参数, K1可表征强镜面反射目标的镜面反射能力的强弱, K2可表征目标漫反射能力的强弱; σ为距离衰减因子; κ为椭圆长短轴之比, 可表征漫反射能量的空间分布; ITθT为目标强度阈值和入射角度阈值。瓷砖, 铝等镜面反射目标在0°角附近发生的较强镜面反射, 其强度值不随距离发生显著变化; 但在非0°入射角下发生漫反射, 故将其在非0°入射角下的强度值归入目标的漫反射强度值。漫反射强度值的信号转换函数为线性转换函数, 随距离呈负指数规律变化, 半椭圆模型的角度因子可以描述目标漫反射强度值随角度的变化关系。列出了本次实验得到的2种镜面反射目标的K1κ, 以及4种漫反射目标的K2κσ值。

 表3 6种目标K1K2λσ      Table 3 Values of K1K2λ, and σ for six targets
5 目标反射特征提取实验的分析及讨论

根据实验得到的激光雷达强度值模型[(8)式], 共有3个表征目标反射特性的参数。其中对于镜面反射目标, 只需要目标在0°入射角附近的一个强度值便可反演得到表征目标镜面反射能力的特征参数K1; 而对于漫反射目标, 至少需要同一目标在3个不同距离和入射角下的强度值才能反演得到表征目标漫反射特性的参数K2κ。在真实应用场景中, 扫描激光雷达一般安装在无人车或者移动机器人上, 其在不同时刻会运动到不同位置, 对于同一目标, 便可获得不同距离和入射角下的强度值, 从而使强度值模型具有一定的实际应用价值。

为了简单地验证模型的准确性和实用性, 设计了如下实验:通过在一条直线上移动目标来模拟雷达的直线运动, 选取8个不同位置记录相应目标回波强度。每次选择其中5个不同位置下的强度值代入(8)式来反演相应目标特征参数K2κ。根据(8)式, 需要获得每个位置对应的目标强度值、距离值和入射角。强度值和距离值可以直接由雷达返回数据得到, 入射角可以根据点云坐标信息拟合目标直线和入射光线来计算。实验时选择了聚四氟乙烯、水泥板、木板和瓷砖4种材料。目标相对雷达摆放位置如图8(a)所示。4种材料在8个位置下的强度值如图8(b)所示。图8(c)和图8(d)分别为反演得到的不同目标的K2值和κ值的范围。

对比图8(c)、(d)和的数据, 可以发现:反演得到的聚四氟乙烯、水泥板、木板3种材料的K2值和κ值与中数据较为接近; 对于瓷砖, 由位置4下的强度值能得到瓷砖的K1值为100, 与中数据接近, 而反演得到的瓷砖κ值也与对应数据较为接近。由此可见, 将同一目标在不同距离和入射角下的强度值代入建立的模型中, 就能较好地反演得到目标反射特征参数。由图8(c)、(d)的数据还可以看出, 当只用单一K2值区分目标时, 目标的漫反射能力接近, 可能导致反演得到的K2值较为接近, 如图8(c)中聚四氟乙烯和木板, 而此时利用参数κ可以进一步区分反射能力接近的2种目标


上一篇:D435i 标定
下一篇:SLAM 中常用的相机模型&畸变模型总结