server 2008 网站部署,mvc 网站 只列出目录,北京建设工程有限公司,做公司网站要那些资料在第18讲 《Coursera自动驾驶课程第18讲#xff1a;The Planning Problem》 我们对自动驾驶中的规划问题有了一个全面的了解#xff0c;理解了规划问题中的约束和目标#xff1b;同时我们还讨论了如何分层如解决规划问题#xff08;任务规划、行为规划、路径规划和速度曲线…在第18讲 《Coursera自动驾驶课程第18讲The Planning Problem》 我们对自动驾驶中的规划问题有了一个全面的了解理解了规划问题中的约束和目标同时我们还讨论了如何分层如解决规划问题任务规划、行为规划、路径规划和速度曲线生成。
在本讲中我们将学习两种环境建图方法占用网格图occupancy grid map 和 高清地图high-definition road map这两种地图在运动规划任务中都发挥着关键作用。 文章目录19.1 Occupancy Grids19.1.1 Overview19.1.2 LiDAR Data Filtering and Noise19.1.3 Bayesian Update of the Occupancy Grid19.2 Populating Occupancy Grids from LiDAR Scan Data (Part 1)19.2.1 Issue with Bayesian Probability Update19.2.2 Bayesian log odds Update19.3 Populating Occupancy Grids from LiDAR Scan Data (Part 2)19.3.1 Inverse Measurement Model19.3.2 Bresenham Line Algorithm19.4 Occupancy Grid Updates for Self-Driving Cars19.4.1 Filtering of 3D LiDAR19.4.2 Projection of LiDAR Onto a 2D Plane19.5 High Definition Road Maps19.5.1 Overview19.5.2 Lanelet Map19.1 Occupancy Grids
19.1.1 Overview
占用网格是围绕当前自车位置的离散化网格这种离散化可以在两维或三维上完成。在本讲中我们只讨论 2D 版本。占用网格的每个网格方块用以表示该网格位置中是否存在静态物体。如果是的话则该网格位置被归类为已占用。可以被分类为占用网格单元的静态物体的示例可以包括树木、建筑物、路标和灯杆。
在自动驾驶汽车领域其它一些静态物体也应归类为占用空间包括所有不可驾驶的表面例如草坪或人行道。占用网格的每个方块可以使用 mim^{i}mi 来表示是否被占用其中 1 表示该方块被静态物体占用而 0 表示没有。在下面这张地图中我们可以看到有树木和草地的正方形被标记为 1而道路被标记为 0。网格中所有占据的方块都是紫色的对应于可驾驶表面的方块为透明。 我们现在讨论为创建准确的占用网格而做出的假设
首先当前创建占用网格时的环境仅对应于静态物体。这意味着在将传感器数据用于占用网格映射之前必须从传感器数据中删除所有动态物体。其次每个网格单元都独立于所有其它网格单元。做出这个假设是为了简化创建占用网格所需的更新函数。最后当前车辆状态与每个时间步的占用图有关。 19.1.2 LiDAR Data Filtering and Noise
在自动驾驶汽车领域激光雷达是目前最常用的距离传感器。快速提醒一下激光雷达传感器使用激光脉冲来测量汽车与周围所有物体的距离并在整个视野范围内返回测量点云。在下图中我们可以看到激光雷达传感器的输出。在使用点云数据构建占用网格之前需要过滤掉一部分 LiDAR 数据。
第一步是过滤构成地平面的所有激光雷达点。在这种情况下地面是自动驾驶汽车可以安全行驶的路面。接下来所有出现在车辆最高点之上的点也被过滤掉。这组激光雷达点可以忽略不计因为它们不会阻碍自动驾驶汽车的前进。最后需要移除激光雷达捕获的所有非静态物体。这包括所有车辆、行人、自行车和动物。
激光雷达数据过滤完成后需要将 3D 激光雷达数据投影到 2D 平面以用于构建我们的占用网格。激光雷达数据的过滤和压缩我们会在后面部分进行介绍。 现在经过过滤和压缩的 LIiDAR 数据类似于来自高清 2D 距离传感器的数据该传感器可以准确地测量到车辆周围所有静态物体的距离。
但是仍然存在一个问题在完成所有过滤后由于过滤方法、数据的复杂性以及环境和传感器噪声仍然存在地图的不确定性。 19.1.3 Bayesian Update of the Occupancy Grid
为了处理这种噪音占用网格将被修改为概率性的。每个方块不再存储表示占用的二进制值而是存储一个介于 0 和 1 之间的概率值。概率值越高给定方格被占用的概率就越高。
因此占用网格现在可以表示为由术语 bel 表示的置信图。为简单起见mim^imi 表示占用网格的单个方块其中 iii 可以由测量值 YYY 和车辆位置 XXX 构成。mim^imi 的置信度等于在给定传感器测量值的情况下当前单元格 mim^imi 被占用的概率。
为了转换回二进值地图可以建立一个阈值当置信度大于阈值则表示该单元格被占用。任何置信度低于设定阈值的单元格都将被设置为空闲。举个例子下图中被占据的方块的概率为 0.94方块分类为被占据。另一方面在街道上找到的广场只有 0.12 的概率表示被占用因此将被归类为空闲位置。 为了实现更准确的占用置信度通常会对多个时间的测量进行组合。在时间 ttt 对地图单元 mim^imi 的置信度定义为在给定所有测量值和从时间 111 到 ttt 的车辆位置的情况下 mim^imi 被占用的概率。 belt(mi)p(mi∣(y,x)1:t)(19.1)\operatorname{bel}_{t}\left(m^{i}\right)p\left(m^{i} \mid(y, x)_{1: t}\right) \tag{19.1} belt(mi)p(mi∣(y,x)1:t)(19.1)
要将多个测量值组合成单个置信度图可以使用贝叶斯公式。对于占用网格我们得到一个以下形式的贝叶斯更新公式。 belt(mi)ηp(yt∣mi)belt−1(mi)(19.2)\operatorname{bel}_{t}\left(m^{i}\right)\eta p\left(y_{t} \mid m^{i}\right) \operatorname{bel}_{t-1}\left(m^{i}\right) \tag{19.2} belt(mi)ηp(yt∣mi)belt−1(mi)(19.2)
其中 η\etaη 是一个归一化常数以确保最终结果仍然是概率分布。
让我们看看实际使用中的占用网格。在这段视频中我们将跟随自动驾驶汽车驶出车道并沿着道路行驶同时占用网格会实时更新。较浅的网格单元代表自由正方形而黑色网格单元代表占用的正方形。我们还可以看到红色的原始激光雷达数据以及橙色的过滤输出。请注意地图如何跟随车辆运动这是使用我们在状态估计中介绍的技术进行估计的。在此视频中将物体归类为障碍物所需的置信阈值设置为非常高因此只有大型静态物体被识别为被占用。降低此阈值将导致更多单元格被标记为已占用但也会导致地图更加嘈杂。 让我们总结一下我们刚刚学到的东西
我们了解了占用网格地图的基本定义并了解了如何过滤和压缩 LiDAR 传感器数据以创建占用网格。然后我们学习了如何将占用网格表示为置信度图并应用贝叶斯公式将新测量值合并到占用网格中。 19.2 Populating Occupancy Grids from LiDAR Scan Data (Part 1)
19.2.1 Issue with Bayesian Probability Update
在本小节中我们会先讨论在上一小节中看到的贝叶斯概率更新的问题。然后我们将使用对数几率表示来解决此问题。
正如我们在上一小节中看到的我们可以应用贝叶斯定理将前一时刻的置信图与当前的测量相结合从而在每个时间步创建一个高度准确的占用网格。这是通过以下函数实现的 belt(mi)ηp(yt∣mi)belt−1(mi)(19.3)\operatorname{bel}_{t}\left(m^{i}\right)\eta p\left(y_{t} \mid m^{i}\right) \operatorname{bel}_{t-1}\left(m^{i}\right) \tag{19.3} belt(mi)ηp(yt∣mi)belt−1(mi)(19.3)
其中 η\etaη 是一个归一化常数p(yt∣mi)p\left(y_{t} \mid m^{i}\right)p(yt∣mi) 是在给定 mim^imi 下接收到的当前测量值 yty_tyt 的概率belt−1(mi)\operatorname{bel}_{t-1}\left(m^{i}\right)belt−1(mi) 是 t−1t-1t−1 时刻的置信图。
然而使用这个贝叶斯更新存在一个问题。为了说明这个问题我们来看一个示例。假设我们有一个低置信度的占用方块 belt−1(mi)\operatorname{bel}_{t-1}\left(m^{i}\right)belt−1(mi) 置信度为0.000638此时观察到的测量值的概率也很低p(yt∣mi)p\left(y_{t} \mid m^{i}\right)p(yt∣mi) 为0.000012二者相乘将会得到一个非常小的置信值 belt(m)np(yt∣m)belt−1(m)0.0000000080.0000120.000638(19.4)\begin{array}{ccc} b e l_{t}(m) n p\left(y_{t} \mid m\right) b e l_{t-1}(m) \\ \\ 0.000000008 0.000012 0.000638 \end{array} \tag{19.4} belt(m)0.000000008np(yt∣m)0.000012belt−1(m)0.000638(19.4)
可以看到置信值接近于零。在计算机上对浮点数进行乘法运算会在乘以小数时导致显着的近似误差进而导致概率估计的不稳定。此外概率相乘也被证明是执行置信更新的一种低效方式。
所以我们应用贝叶斯公式来更新占用单元的置信度看起来并不合适。 但是有一个解决方案。 我们可以使用对数函数将我们的置信度转换为对数概率而不是存储值范围为 0-1 的置信图。这导致单元格值从负无穷大到正无穷大 belt(m)→(−∞,∞)\operatorname{bel}_{t}(m) \rightarrow(-\infty, \infty)belt(m)→(−∞,∞)避免了数字接近零的问题。对数函数取概率 ppp 和 1−p1-p1−p 之比的自然对数。因此它可以将用 0-1 的概率值映射到整个实轴对数概率公式为 logit(p)log(p1−p)(19.5)logit(p)\log \left(\frac{p}{1-p}\right) \tag{19.5} logit(p)log(1−pp)(19.5)
也可以将对数概率 logit(p)logit(p)logit(p) 转换回概率 ppp可以通过如下公式转换 pelogit(p)1elogit(p)(19.6)p\frac{e^{\operatorname{logit}(p)}}{1e^{\operatorname{logit}(p)}} \tag{19.6} p1elogit(p)elogit(p)(19.6) 19.2.2 Bayesian log odds Update
现在我们有了对数概率表示那么让我们看看对数概率如何影响我们的贝叶斯更新方程。根据贝叶斯公式有 p(mi∣y1:t)p(yt∣y1:t−1,mi)p(mi∣y1:t−1)p(yt∣y1:t−1)(19.7)p\left(m^{i} \mid y_{1: t}\right)\frac{p\left(y_{t} \mid y_{1: t-1}, m^{i}\right) p\left(m^{i} \mid y_{1: t-1}\right)}{p\left(y_{t} \mid y_{1: t-1}\right)} \tag{19.7} p(mi∣y1:t)p(yt∣y1:t−1)p(yt∣y1:t−1,mi)p(mi∣y1:t−1)(19.7)
其中 mim^imi 是当前占用网格位置 iii 处的方块y1:ty_{1:t}y1:t 是从时刻 1 到 ttt 的测量值。接下来我们将应用马尔可夫假设如果当前地图方块 mim^imi 状态已知则该假设可以确保当前测量值独立于先前的测量值我们可以得到下面的方程 p(mi∣y1:t)p(yt∣mi)p(mi∣y1:t−1)p(yt∣y1:t−1)(19.8)p\left(m^{i} \mid y_{1: t}\right)\frac{p\left(y_{t} \mid m^{i}\right) p\left(m^{i} \mid y_{1: t-1}\right)}{p\left(y_{t} \mid y_{1: t-1}\right)} \tag{19.8} p(mi∣y1:t)p(yt∣y1:t−1)p(yt∣mi)p(mi∣y1:t−1)(19.8)
同样根据贝叶斯公式我们可以得到当前测量 yty_tyt 和地图方块 mim^imi 之间的关系 p(yt∣mi)p(mi∣yt)p(yt)p(mi)(19.9)p\left(y_{t} \mid m^{i}\right)\frac{p\left(m^{i} \mid y_{t}\right) p\left(y_{t}\right)}{p\left(m^{i}\right)} \tag{19.9} p(yt∣mi)p(mi)p(mi∣yt)p(yt)(19.9)
公式 19.8 和 19.9结合可以得到 p(mi∣y1:t)p(mi∣yt)p(yt)p(mi∣y1:t−1)p(mi)p(yt∣y1:t−1)(19.10)p\left(m^{i} \mid y_{1: t}\right)\frac{p\left(m^{i} \mid y_{t}\right) p\left(y_{t}\right) p\left(m^{i} \mid y_{1: t-1}\right)}{p\left(m^{i}\right) p\left(y_{t} \mid y_{1: t-1}\right)} \tag{19.10} p(mi∣y1:t)p(mi)p(yt∣y1:t−1)p(mi∣yt)p(yt)p(mi∣y1:t−1)(19.10)
我们使用对数概率对公式19.10进行简化。在此之前我们先讨论 1−p1-p1−p 的表达式其概率为 p(¬mi∣y1:t)1−p(mi∣y1:t)p(¬mi∣yt)p(yt)p(mi∣y1:t−1)p(¬mi)p(yt∣y1:t−1)(19.11)p\left(\neg m^{i} \mid y_{1: t}\right)1-p\left(m^{i} \mid y_{1: t}\right)\frac{p\left(\neg m^{i} \mid y_{t}\right) p\left(y_{t}\right) p\left(m^{i} \mid y_{1: t-1}\right)}{p\left(\neg m^{i}\right) p\left(y_{t} \mid y_{1: t-1}\right)} \tag{19.11} p(¬mi∣y1:t)1−p(mi∣y1:t)p(¬mi)p(yt∣y1:t−1)p(¬mi∣yt)p(yt)p(mi∣y1:t−1)(19.11)
这表示的是占用网格中方块未被占用的概率。下面我们求概率比即占用概率与未占用概率之比 p(mi∣y1:t)p(¬mi∣y1:t)p(mi∣yt)p(¬mi)p(mi∣y1:t−1)p(¬mi∣yt)p(mi)p(¬mi∣y1:t−1)(19.12)\frac{p\left(m^{i} \mid y_{1: t}\right)}{p\left(\neg m^{i} \mid y_{1: t}\right)}\frac{p\left(m^{i} \mid y_{t}\right) p\left(\neg m^{i}\right) p\left(m^{i} \mid y_{1: t-1}\right)}{p\left(\neg m^{i} \mid y_{t}\right) p\left(m^{i}\right) p\left(\neg m^{i} \mid y_{1: t-1}\right)} \tag{19.12} p(¬mi∣y1:t)p(mi∣y1:t)p(¬mi∣yt)p(mi)p(¬mi∣y1:t−1)p(mi∣yt)p(¬mi)p(mi∣y1:t−1)(19.12)
我们使用 1−p1-p1−p 代替 ¬p\neg p¬p得到 p(mi∣y1:t)p(¬mi∣y1:t)p(mi∣yt)(1−p(mi))p(mi∣y1:t−1)(1−p(mi∣yt))p(mi)(1−p(mi∣y1:t−1))(19.13)\frac{p\left(m^{i} \mid y_{1: t}\right)}{p\left(\neg m^{i} \mid y_{1: t}\right)}\frac{p\left(m^{i} \mid y_{t}\right)\left(1-p\left(m^{i}\right)\right) p\left(m^{i} \mid y_{1: t-1}\right)}{\left(1-p\left(m^{i} \mid y_{t}\right)\right) p\left(m^{i}\right)\left(1-p\left(m^{i} \mid y_{1: t-1}\right)\right)} \tag{19.13} p(¬mi∣y1:t)p(mi∣y1:t)(1−p(mi∣yt))p(mi)(1−p(mi∣y1:t−1))p(mi∣yt)(1−p(mi))p(mi∣y1:t−1)(19.13)
最后我们使用对数概率得到 logit(p(mi∣y1:t))logit(p(mi∣yt))logit(p(mi∣y1:t−1))−logit(p(mi))(19.14)\operatorname{logit}\left(p\left(m^{i} \mid y_{1: t}\right)\right)\operatorname{logit}\left(p\left(m^{i} \mid y_{t}\right)\right)\operatorname{logit}\left(p\left(m^{i} \mid y_{1: t-1}\right)\right)-\operatorname{logit}\left(p\left(m^{i}\right)\right) \tag{19.14} logit(p(mi∣y1:t))logit(p(mi∣yt))logit(p(mi∣y1:t−1))−logit(p(mi))(19.14)
上式可以用一种方便的简写形式来写 lt,ilogit(p(mi∣yt))lt−1,i−l0,i(19.15)l_{t, i}\operatorname{logit}\left(p\left(m^{i} \mid y_{t}\right)\right)l_{t-1, i}-l_{0, i} \tag{19.15} lt,ilogit(p(mi∣yt))lt−1,i−l0,i(19.15)
我们现在得出了对数概率的贝叶斯更新公式用于在占用网格地图上进行更新。它由三项组成
logit(p(mi∣yt))\operatorname{logit}\left(p\left(m^{i} \mid y_{t}\right)\right)logit(p(mi∣yt))lt−1,il_{t-1, i}lt−1,i l0,il_{0,i}l0,i初始置信度通常为0.5
可以看到初始置信度在每个时间步都出现了这有点令人惊讶但这只是我们在本小节中的推导的结果并调整了前两项的相加以确保更新后的置信度与对数概率形式一致。与直接更新概率相比贝叶斯对数概率有两个强大的优势。
由于对数概率是整个实轴上的映射数值更新是稳定的并且在计算上它也显着提高了效率因为它完全依赖于加法来完成占用网格的更新。
总结一下我们在本小节中学到的东西
我们首先通过简单的贝叶斯概率更新确定了存储和更新占用网格的一些问题。然后我们看到了如何通过使用概率空间的对数概率表示来解决这个问题。最后我们看到了贝叶斯对数概率更新是如何从贝叶斯公式推导出来的。 19.3 Populating Occupancy Grids from LiDAR Scan Data (Part 2)
19.3.1 Inverse Measurement Model
在本小节中我们将讨论逆测量模型并了解如何为激光雷达传感器构建简单的逆测量模型。我们还将描射线追踪这将有助于降低逆测量模型的计算需求。
回想一下上一小节为了对我们的占用网格进行贝叶斯更新我们得到了贝叶斯对数概率更新公式。 lt,ilogit(p(mi∣yt))lt−1,i−l0,i(19.16)l_{t, i}\operatorname{logit}\left(p\left(m^{i} \mid y_{t}\right)\right)l_{t-1, i}-l_{0, i} \tag{19.16} lt,ilogit(p(mi∣yt))lt−1,i−l0,i(19.16)
我们需要计算 p(mi∣yt)p\left(m^{i} \mid y_{t}\right)p(mi∣yt)这表示在当前测量 yty_tyt 下网格 mim^imi 不为空的概率。然而到目前为止我们只看到了测量模型 p(yt∣mi)p\left(y_t \mid m^{i}\right)p(yt∣mi)它表示在占用网格中的一个单元被占用的情况下获得测量值的概率。因此对于占用网格更新我们需要对测量模型进行逆操作。
也就是说我们必须构建一个逆测量模型该模型在给定测量 yty_tyt 的情况下求 mim^imi 不为空的概率 。为简单起见我们将激光雷达视为2D距离传感器。设得到的方位角和距离测量值为 ϕs[−ϕmaxs…ϕmaxS]ϕjs∈ϕs(19.17)\phi^{s}\left[\begin{array}{lll} -\phi_{\max }^{s} \ldots \phi_{\max }^{S} \end{array}\right] \quad \phi_{j}^{s} \in \phi^{s} \tag{19.17} ϕs[−ϕmaxs…ϕmaxS]ϕjs∈ϕs(19.17)
rS[r1S…rjS]rjS∈[0,rmaxS](19.18)r^{S}\left[\begin{array}{lll} r_{1}^{S} \ldots r_{j}^{S} \end{array}\right] \quad r_{j}^{S} \in\left[0, r_{\max }^{S}\right] \tag{19.18} rS[r1S…rjS]rjS∈[0,rmaxS](19.18)
每个光束对应的视角在最大视角范围内 ϕmax\phi_{\max}ϕmax 是均匀分布同时每个光束得到的距离信息不超过最大距离 rmaxr_{max}rmax。今天的大多数激光雷达也会返回无回波信号如果特定波束没有返回回波则表明该方向范围内不存在任何物体。 我们假设单次旋转的整个激光雷达扫描测量值是在同一时刻测量的。对于使用旋转激光雷达头高速移动的车辆来说这不是一个准确的模型因为我们必须校正车辆的运动可以使用状态估计来完成校正。假设下图是带有激光雷达传感器的车辆它在环境中收集不同方位的距离测量值。 我们构建了一个临时占用网格其中包含所有方向上的最大光束范围。
该测量网格的坐标系使用占用网格地图坐标因此我们在占用网格坐标中可以定义传感器的位置 (x1,t,x2,t)(x_{1,t}, x_{2,t})(x1,t,x2,t) 以及方向 θ1,t\theta_{1,t}θ1,t这里以左下角为坐标原点。 但是在实际中常常选择车辆坐标原点为占用网格地图坐标原点占用网格地图在每一步都会根据我们的状态估计进行转换。我们现在使用占用概率填充占用网格。根据当前的激光雷达数据我们可以定义占用网格的三个不同区域
首先有一个激光雷达光束无法到达的无信息区域。当前的激光雷达扫描没有提供有关该区域环境的信息。然后是一个物体概率低的区域因为所有的光束都通过了这个区域而没有遇到任何东西。最后存在一个物体概率较高的区域在该区域中激光雷达已经接触到物体并返回了一个测量值。 为了将这些区域转换到测量网格上每个网格方块将被分配一个相对于车辆当前位置的方位和距离。每个单元格的相对距离就是传感器到单元格的欧几里得距离。 令 rir_iri 是网格方块 iii 的相对距离其计算公式为 ri(mxi−x1,t)2(myi−x2,t)2(19.19)r^{i}\sqrt{\left(m_{x}^{i}-x_{1, t}\right)^{2}\left(m_{y}^{i}-x_{2, t}\right)^{2}} \tag{19.19} ri(mxi−x1,t)2(myi−x2,t)2(19.19) (x,y)(x,y)(x,y) 是网格方块中心的坐标(x1,t,x2,t)(x_{1,t},x_{2,t})(x1,t,x2,t) 是传感器当前位置可以得到方位角 ϕi\phi^iϕi ϕitan−1(myi−x2,tmxi−x1,t)(19.20)\phi^{i}\tan ^{-1}\left(\frac{m_{y}^{i}-x_{2, t}}{m_{x}^{i}-x_{1, t}}\right) \tag{19.20} ϕitan−1(mxi−x1,tmyi−x2,t)(19.20)
对于每个网格方块我们通过激光雷达光束角和单元方位角之间误差最小的测量值来找到最相关的激光雷达光束 kargmin(∣ϕi−ϕjs∣)(19.21)k\operatorname{argmin}\left(\left|\phi^{i}-\phi_{j}^{s}\right|\right) \tag{19.21} kargmin(∣∣ϕi−ϕjs∣∣)(19.21) 然后我们定义了两个参数 α\alphaα 和 β\betaβ它们定义了每个光束能覆盖的一个区域该区域将被分配特定光束的测量信息。α\alphaα 控制光束的距离在距离范围内将被标记为高概率β\betaβ 控制光束的角度单元格将被标记为低概率或高概率。 基于上面三种类型接收到的激光雷达测量值我们现在可以求得任一单元格被占用的概率。
无信息区域对应于所有大于最大光束测量范围的单元格或处于它所关联的光束对应覆盖角度 β\betaβ 之外这里是大于 β/2\beta/2β/2 rimin(rmaxs)or ∣ϕi−ϕks∣β/2(19.22)r^{i}\min \left(r_{\max }^{s}\right) \text { or }\left|\phi^{i}-\phi_{k}^{s}\right|\beta / 2 \tag{19.22} rimin(rmaxs) or ∣∣ϕi−ϕks∣∣β/2(19.22)高信息区域对应单元格为距离与关联光束之差小于 α/2\alpha/2α/2落在关联光束覆盖角度 β\betaβ 之内我们令其概率大于0.5。 rksrmaxsand ∣ri−rks∣α/2and ∣ϕi−ϕks∣β/2(19.23)r_{k}^{s}r_{\max }^{s} \text { and }\left|r^{i}-r_{k}^{s}\right|\alpha / 2 \text{ and } \left|\phi^{i}-\phi_{k}^{s}\right|\beta / 2 \tag{19.23} rksrmaxs and ∣∣ri−rks∣∣α/2 and ∣∣ϕi−ϕks∣∣β/2(19.23)低信息区域对应单元格距离小于光束测量值且落在关联光束覆盖角度 β\betaβ 之内令这些单元格占用概率小于0.5。 rirksand ∣ϕi−ϕks∣β/2(19.24)r^{i}r_{k}^{s} \text{ and } \left|\phi^{i}-\phi_{k}^{s}\right|\beta / 2 \tag{19.24} rirks and ∣∣ϕi−ϕks∣∣β/2(19.24)
来看一个示例假设激光雷达光束在红色 XXX 标记的位置返回测量值红色区域被标记为高概率。增加 α\alphaα 的值会增加受影响区域的范围增加 β\betaβ 的值会影响受影响区域的角度。 19.3.2 Bresenham Line Algorithm
我们现在可以构建完整的逆测量模型用于我们的对数概率更新。然而这种简单的逆测量模型在计算上可能很昂贵。它需要对测量图中的每个单元格进行全面更新并依赖多个浮点运算来识别哪些测量值对应于哪些单元格。
另一种方法是使用光线追踪算法例如计算机科学经典的 Bresenham 算法。 Bresenham 的线条算法最初是在 1960 年代初设计的目的是有效解决当时可用硬件上的显示器和打印的线条绘制问题。通过沿着激光雷达扫描的光束进行光线追踪我们减少了需要处理的单元的数量并依靠整数加减法和位移来更快地识别它们从而沿着激光雷达光束穿过网格。有趣的是许多光束通过汽车附近的相同单元大大增加了测量的可信度。
让我们总结一下
我们为对数概率更新步骤所需的激光雷达数据构建了一个简单的逆测量模型。我们还简要介绍了通过使用光线追踪来加速计算的潜在改进。 19.4 Occupancy Grid Updates for Self-Driving Cars
19.4.1 Filtering of 3D LiDAR
在本小节我们将了解自动驾驶汽车的特定要求将激光雷达数据转换为可用于创建占用网格的表示滤波后。我们首先学习几种常见的 3D 数据滤波方法。如下图所示我们有激光雷达扫描后的数据它是自动驾驶汽车在当地道路上行驶时获得的常见的滤波处理有 下采样为了可以实时更新通常希望将激光雷达扫描的点数下采样到更小的数量。 移除汽车上方的点过滤掉自动驾驶汽车上方的所有激光雷达点。 移除属于地面的点在创建占用网格时我们不需要考虑驾驶地面因此会删除所有地面反射的激光雷达点。 移除所有动态物体例如运动中的汽车或行人。 下采样是通过删除或忽略冗余激光雷达点来减少激光雷达点数量的过程。自动驾驶中使用的激光雷达每秒可产生 120 万个点左右为车辆周围的所有物体提供丰富的几何描述。 这些生成的点实际上是多余的其中的许多点捕获了相同的物体信息。在下图中我们可以看到一个路标该路标被激光雷达点密集覆盖其中一小部分点足以表示占用网格地图中障碍物位置。 最重要的是处理这 120 万个点在计算上是不切实际的。 第二必须删除一些点以满足后续操作所需要的计算。
可以以多种方式执行下采样其中最简单的方法是在等间距采样在激光雷达每条扫描环上每隔 nnn 个点保留一个点 还可以在距离图像中应用图像下采样技术并在 3D 网格中进行空间搜索用单个占用测量替换点集。 在每种情况下这些方法都可以在开源点云库如 PCL或计算机视觉库如 OpenCV中轻松获得。 我们的第二个过滤器是一个非常简单的过滤器它只是删除了车辆高度以上的点。如下图所示激光雷达安装高度为 2.4 米。 然而这个滤波器通常假定汽车行驶在一个平坦的地平面上有时候很难满足这一假设。 这种方法会帮助我们删除树木、电线、桥梁和高空标志等物体。 第三个过滤器是删除落在可驾驶表面上的点。由于激光雷达自身扫描的性质在下图中可以看到许多同心圆这是由于激光雷达光束撞击可驱动表面造成的。这些点不应与占用网格图中的占用单元相混淆。这是非常有挑战性的问题
首先所有道路都有不同的道路几何形状包括可变的排水凹度、不同的坡度和曲率等等。这种变化也很难预测。但是如果不移除地面则占用网格可能会出现伪影从而导致汽车无法继续行驶因为它认为道路被阻塞了。第二个问题是路沿在不同的位置有不同的高度并且道路边界在激光雷达数据中并不总是明确定义的。这些变化可能导致部分路沿或不可驾驶区域作为地平面的一部分被移除。最后需要检测道路上的小物体例如足球或小动物这意味着在处理点云的简单几何方法很难获得前方道路的真实状态。
处理此类问题的最佳方法是使用图像语义分割方法。在下图中可以看到其中地面分割为深紫色。然后该任务变成了将视觉中检测到的可驾驶表面映射到激光雷达点云然后进行移除最后保留来自非驾驶表面的点。 最后一种过滤方法是移除所有动态物体例如移动的汽车或行人。这可以通过感知方法来检测和追踪场景中所有的动态物体。检测到的动态物体的 3D 边界框用于移除受影响区域中的所有点。
然而很多时候这并不令人满意原因有两个
首先并非所有检测到的动态物体实际上都在移动。一些车辆可能停在路边因此可以被视为占用网格的一部分因为它们确实是静止的。为了处理这个问题感知需要使用动态物体轨迹来识别当前哪些物体是静态的。其次由于感知处理通常需要一定的计算时间动态物体只有在延迟一段时间后才会被检测到。这会导致使用历史的物体位置更新占用网格从而导致边界框丢失动态车辆上大部分激光雷达点。我们可以使用运动物体轨迹预测。边界框沿预测路径向前移动最终从最近的激光雷达扫描中删除更多动态属于物体的点。 19.4.2 Projection of LiDAR Onto a 2D Plane
在讨论完所有这些滤波方法之后我们将激光雷达数据从 3D 投影到 2D处理方法很简单
首先将激光雷达点高度值 ZZZ 设为零这会将激光雷达网格折叠为平面。二维扫描平面被划分为与占用网格相同的网格图案。对于占用网格的每个单元格所有落入其中的激光雷达点都会被计算在内。单元格中的点越多在占用网格中该单元格中包含静态物体的机率就越大。
简单总结以下
我们掌握了制作适合用作占用网格的激光雷达点云所需的过滤方法。包括下采样、去除汽车上方的激光雷达点、去除地平面最后去除动态物体。然后我们看到了一种简单而有效的方法可以将 3D 激光雷达数据转换为 2D 置信图。 19.5 High Definition Road Maps
19.5.1 Overview
在本小节我们将学习另一种地图高清道路地图HD Map。 我们将通过查看称为 lanelet Map 的数据类型来了解如何有效地存储此地图。然后我们将了解 lanelet 地图的两个主要元素 lanelets 和 intersection并讨论它们是如何连接的。 紧接着我们看看可以对 lanelet 元素执行的不同操作。最后我们将探索记录和创建 lanelet 地图的不同方法。
高清道路地图类似于传统的纸质地图或在线地图。但是高清地图中包含的信息要详细得多。传统地图存储道路的大致位置而高清道路地图存储精确的道路位置包括精确到厘米级的车道除此之外高清道路地图还存储了可能影响自动驾驶汽车的所有道路标志和信号的位置。
由于数据的详细和相互关联的性质需要一种有效的方法来存储地图中包含的所有信息。Lanelet 是在2014年由 Philip Bender、Julius Ziegler 和 Christoph Stiller 提出由于这种方法在存储和传输高清地图所需的复杂信息方面的有效性因此得到了广泛的应用。我们会在课程的其余部分进一步研究特别是它在我们的行为规划中发挥着关键作用。 19.5.2 Lanelet Map
Lanelet 地图有两个主要组成部分。Lanelet Element 存储与它所代表的道路上的一小段纵向车道相关的所有信息。Intersection Element 存储单个交叉路口一部分的所有Lanelet Element以便在运动规划任务期间进行简单检索此外还包含二者是如何连接的。 一个 Lanelet Element 包含有几组信息这些信息存储了它所代表的路段信息有
lanelet 存储了给定车道的左右边界。lanelet 存储可能存在于 lanelet 元素末端的任何监管元素例如停车标志线或静态标志线。这里我们只为任何监管元素存储一条线因为这是自动驾驶汽车视为该监管元素的活动位置的点。lanelet 存储可能影响该路段的所有监管属性例如速度限制。lanelet 存储自身与周围其他 lanelet 元素的连接性。这允许通过由高清地图中的一组 lanelets 创建的图轻松遍历和计算。
每个 lanelet 以监管元素或遇到监管属性的变化而结束。这意味着对于作为交叉路口一部分的 lanelet可以短至只有几米对于高速公路路段则可以长达数百米。 lanelet 的边界表示为 lanelet 的边缘。这些边界捕获标记的车道边界或禁止驾驶的曲线。车道边界存储为连续曲线的一组点。每个点都存储其 x、yx、yx、y 和 zzz 坐标。点之间的距离可以细至几厘米也可以粗至几米具体取决于所讨论的折线的平滑度。使用这种多项式曲线结构可以执行许多有用的操作来收集用于运动规划任务的数据。点的顺序定义了 lanelet 的行进方向和航向。lanelet 任何部分的道路曲率也可以从该 lanelet 预先计算。可以对两个边界之间进行插值得到中心线将其作为自动驾驶车辆在该车道上的所需行驶路径。 有两种类型的 lanelet 监管规则监管元素位于 lanelet 的末尾监管属性影响整个lanelet。
监管元素表示为由一组共线点定义的线。监管元素通常需要自动驾驶汽车采取行动或做出决定例如在红绿灯的情况下继续进行的决定必须基于该红绿灯的当前状态。lanelet 的监管属性在整个 lanelet 一直存在。例如速度限制或者该 lanelet 是否与另一个 lanelet 交叉如在交叉路口或合并中。 每个 lanelet 存在四种连接形式向前、向后、向左、向右。整个 lanelet 结构连接在一个有向图上这是高清地图的基础结构。应该注意在当前 lanelet 之前可能有多个 lanelet或者在交叉路口的情况下可能有多个后续 lanelet。
为了更好地理解这个概念让我们看一个简单的例子下图所示。一些 lanelet 被编号并表示为图上的节点因此这些 lanelet 仅代表具有此交叉点的完整 lanelet 的一部分。节点或顶点在该图的车道上标记为 1-5并形成车道图的顶点。该图的所有边都是有向的并被标记以表示边连接的两个顶点之间的关系。标记为 0 的边表示指向下一个lanelet1 表示与左侧 lanelet 的连接。标记为 2 的边表示与右侧 lanelet 的连接而标记为 3 的边表示与之前的 lanelet 相连。
Lanelet element 5 和 lanelet element 2 是离开 lanelet element 1 后可以继续行驶的两个可能的下一个lanelet因为它们是通过这个路口的两条路。类似地lanelet element 4 通过一条边连接到 lanelet 1因为 lanelet 4 位于 lanelet 1 的左侧。 Intersection Element 只包含一个指向所有监管元素的指针这些元素构成了感兴趣的交集。作为 Intersection 一部分的所有 lanelet 也指向该交叉点元素。这种结构很像一个容器并在分配行为时简化了整个 lanelet 结构的查找。
Lanelet 数据结构的一大优势是它使部分运动规划过程更简单计算效率更高。穿过复杂的多车道道路网络进行路径规划的过程需要在转弯之前进行多次连接更改这种数据结构使得每个车道都被视为一个单独的顶点成为可能。我们将在21讲看到将动态物体定位到已知地图可以改进路径预测。我们将在22讲看到这种定位能力还通过提供一种简单的方法来规划自动驾驶汽车在繁忙十字路口的行为从而改善与动态物体的交互。 可以通过三种方式创建高清地图
首先是驾驶车辆多次穿过路网收集信息来离线创建地图然后融合分割和定位信息以提高地图的准确性。在这种方法中如果从算法中发现任何错误也可以进行人工校正。第二种方法是在第一次驾驶路网时在线创建地图。通过使用现有的传统地图并依赖分割和物体检测可以在自动驾驶汽车首次通过路网时创建地图。这种方法在运动规划任务和感知任务方面都非常昂贵。更不用说高度容易出错因此很少部署。创建高清地图的第三种方法是离线创建地图然后在检测到更改时在线更新它们。一个这样的变化可能是一个新的建设区域导致出现一个新的监管元素这是在地图创建过程中无法预测的。
事实上所有这些方法都使用相同的计算来识别 lanelet element、属性和 intersection。在实践中具有实时确认和更新功能的离线地图构建可以两全其美确保对不经常变化的静态元素具有高精度同时仍能捕捉环境中的新事物并让车辆适应它。
