一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

用于自主导航期间对象避让的方法与流程

2022-12-09 19:51:03 来源:中国专利 TAG:

用于自主导航期间对象避让的方法
1.相关申请的交叉引用
2.本技术要求于2020年2月21日提交的美国临时专利申请第62/980,131号、于2020年2月21日提交的美国临时专利申请第62/980,132号和于2020年8月11日提交的美国临时专利申请第63/064,316号的优先权,其中每一个美国临时专利申请都通过此引用以其整体并入。
技术领域
3.本发明总体上涉及自主交通工具(autonomous vehicle)领域,更具体地说,涉及用于自主交通工具领域中的自主导航期间对象避让(object avoidance)的新的和有用的方法。
4.附图简述
5.图1是方法的流程图表示;
6.图2是该方法的一个变型的流程图表示;
7.图3a、图3b、图3c是该方法的一个变型的流程图表示;
8.图4是该方法的一个变型的流程图表示;
9.图5是该方法的一个变型的流程图表示;
10.图6是该方法的一个变型的流程图表示;以及
11.图7是该方法的一个变型的流程图表示。
具体实施方式
12.本发明的实施例的以下描述并非旨在将本发明限制于这些实施例,而是使本领域技术人员能够制造和使用本发明。本文描述的变型、配置、实施方式、示例实施方式和示例是可选的,并且不排除它们描述的变型、配置、实施方式、示例实施方式和示例。本文描述的发明可以包括这些变型、配置、实施方式、示例实施方式和示例的任何组合和所有组合。
13.1.方法
14.如图1所示,一种用于自主导航期间对象避让的方法s100包括:在块s110中,在第一时间在自主交通工具处,基于自主交通工具在第一时间的速度估计使该自主交通工具达到完全停止的停止持续时间;在块s112中,存储从第一时间偏移停止持续时间的临界时间;在块s120中,检测在大约第一时间捕获的、自主交通工具周围的场(field)的第一扫描图像中的对象;以及在块s122中,基于第一扫描图像,导出对象沿着从自主交通工具到对象的第一射线的第一位置和第一径向速度。方法s100还包括在块s130中基于以下项来计算表示对象从第一时间到临界时间可进入的地面区域的第一未来状态边界:对象在第一时间的第一位置;对象的第一径向速度;以及为自主交通工具的运行而定义的通用对象的最大假设角速度和最大假设加速度。方法s100还包括,在块s142中,响应于处于第一时间的自主交通工具与未来状态边界的周界之间的第一距离超过阈值距离,使对象消隐(mute)而不将其纳入自主交通工具处的下一个路径规划考虑中;以及在块s144中,响应于阈值距离超过第一距
离,计算在自主交通工具周围的不包括对象的未来状态边界的进入区(access zone),并在块s140中执行导航动作以从第一时间到临界时间保持在进入区中。
15.方法s100的一个变型包括:在块s110中,在第一时间在自主交通工具处,基于自主交通工具在第一时间的速度估计使自主交通工具达到完全停止的停止持续时间;在块s112中,计算从第一时间偏移停止持续时间的临界时间;在块s120中,检测在由自主交通工具上的传感器在大约第一时间捕获的、自主交通工具附近的场的第一扫描图像中的对象;在块s122中,基于第一扫描图像,导出第一对象的第一位置和第一运动;在块s130中,基于第一对象在第一时间的第一位置、第一对象的第一运动和针对公共道路附近的通用对象的预定义运动限制假设的集合,计算第一未来状态边界,该第一未来状态边界表示第一对象从第一时间到第一临界时间可进入的第一地面区域;以及在块s140中,选择第一导航动作以避免在第一临界时间之前进入第一未来状态边界。
16.方法s100的另一个变型包括:在块s102中,访问用于公共道路附近的通用对象的预定义运动限制假设的集合;在块s104中,访问包含由自主交通工具上的传感器在第一时间捕获的数据的扫描图像;在块s120中,识别扫描图像中表示自主交通工具附近的场中的对象的一组点,该组点中的每个点包括对象上的表面相对于自主交通工具的位置和对象的该表面相对于自主交通工具的径向速度;在块s122中,计算该组点中的点的径向速度和位置之间的相关性;在块s122中,基于该相关性,计算将在第一时间的对象的可能的切向速度和对象的可能的角速度关联起来的函数;在块s122中,基于该组点中的点的径向速度计算对象在第一时间的径向速度;在块s130中,基于由该函数定义的—在第一时间—对象的可能的切向速度和对象的可能的角速度、对象的径向速度和预定义运动限制假设的集合,计算未来状态边界,该未来状态边界表示对象在未来时间可进入的地面区域;以及在块s140中,选择导航动作以在未来临界时间之前避开未来状态边界。
17.方法s100的又一个变型包括在块s102中,访问针对公共道路附近的通用对象的预定义运动限制假设的集合。方法s100的该变型还包括,对于第一扫描周期:在块s104中,访问包含由自主交通工具上的传感器在第一时间捕获的数据的第一扫描图像;在块s120中,识别在第一扫描图像中表示自主交通工具附近的场中的第一对象的第一组点,该第一组点中的每个点包括从传感器到第一对象上的表面的第一测距值、第一对象上的表面相对于传感器的第一方位角位置和第一对象的表面相对于传感器的第一径向速度;在块s122中,计算第一点组中的点的第一径向速度和第一方位角位置之间的第一相关性;在块s122中,基于该第一相关性,计算将在第一时间的第一对象的可能的切向速度和第一对象的可能的角速度关联起来的第一函数;以及在块s122中,基于第一点组中的点的第一径向速度计算第一对象在第一时间的第一径向速度。方法s100的该变型还包括:在块s110中,基于自主交通工具在第一时间的第一速度,估计使自主交通工具达到完全停止的第一停止持续时间;在块s112中,计算从第一时间偏移停止持续时间的第一临界时间;在块s130中,基于由第一函数定义的——在第一时间——第一对象的可能的切向速度和第一对象的可能的角速度、第一径向速度和预定义运动限制假设的集合,计算表示第一对象在第一临界时间可进入的第一地面区域的第一未来状态边界;以及在块s140中,选择第一导航动作以避免在第一临界时间之前进入第一未来状态边界中。
18.2.应用
19.通常,方法s100可由自主交通工具(例如,自主公共汽车、自主客运交通工具)执行,以:检测其环境中的对象;基于预加载的通用对象的最大运动假设(或预加载的针对通用对抗性对象的对抗性运动限制),向对象分配最坏情况的速度和加速度值;估计对象从当前时间到自主交通工具在给定其当前速度的情况下可以制动到完全停止的时间可进入的最大地面区域;以及如果自主交通工具足够远离该最大可进入地面区域,则选择性地使该对象消隐,而不将其纳入路径规划考虑,或者考虑该对象并执行速度和/或转向角调整以避免未来进入到该最大可进入地面区域中。
20.更具体地说,在整个操作中,自主交通工具可以维持对其停止持续时间的估计,在给定自主交通工具的当前速度的情况下,自主交通工具可以在该停止持续时间内达到完全停止。当自主交通工具首次在其场中检测到对象时,自主交通工具可以:向该对象分配对抗性主体的预定义的、最坏情况的速度和加速度假设;并且计算在给定对象的当前位置的情况下,在自主交通工具的当前停止持续时间内,该对象在这些最坏情况的速度和加速度假设下可以进入的最大地面区域(下文中称为“未来状态边界”)。如果自主交通工具的当前位置充分偏离对象的该未来状态边界或以其他方式在对象的该未来状态边界之外,则自主交通工具:即使在对象的最坏情况的对抗性动作下,也可以预测自主交通工具在与该对象碰撞之前达到完全停止的能力;并且因此可以忽略对象或使对象消隐,而不将其纳入当前路径规划决策,并且代替地,等到稍后当自主交通工具接近对象的未来状态边界时,执行导航操作以避让对象。相反,如果自主交通工具的当前位置在对象的该未来状态边界附近,则自主交通工具可以减小它的速度(例如,减小与从自主交通工具到未来状态边界的周界的距离成反比的幅度),从而:减少自主交通工具的停止持续时间;缩小对象的未来状态边界(表示对象在自主交通工具的当前停止持续时间内可进入的最大地面区域);并使自主交通工具能够随着时间的推移保持在对象的该未来状态边界之外。因此,自主交通工具可以执行方法s100的块来通知所预测的导航动作(例如,速度和/或转向角调整),以维持与对象的空间和时间距离,以便即使在自主交通工具首次检测到其环境中的对象之后,对象立即在自主交通工具的方向上发起或继续对抗性动作,也能使自主交通工具在与对象碰撞之前达到完全停止。
21.此外,自主交通工具可以:在后续扫描图像上检测和跟踪该对象;从这些扫描图像导出对象的实际速度(例如,对象的绝对速度基于对象的位置在多个连续扫描图像上的变化和连续的径向速度测量值);并用对象的实际速度代替用于对象的速度的最坏情况的假设。然后,自主交通工具可以重复方法s100的块,以:基于对象的实际速度和用于通用对象的最坏情况的加速度假设,重新计算对象的未来状态边界;并基于自主交通工具相对于该修订的未来状态边界的位置,选择性地使对象消隐,而不将其纳入当前路径规划考虑。
22.例如,自主交通工具可以:存储高性能客运交通工具或高性能摩托车的最坏情况的速度和加速度(例如,50米/秒的最大速度,每秒9米/秒的最大加速度);并实现这些最坏情况的速度和加速度,以计算所有检测到的对象的未来状态边界,而不管这些对象的实际类型或类别如何。因此,自主交通工具可以减少或消除对用于识别对象的类型和将自主交通工具周围的场中的不可变对象(例如,路标、电线杆)与可变对象(例如,行人、交通工具)区分开来的对象识别和其他机器学习技术的依赖。更具体地说,不是基于根据所预测的对象类型而选择的动态模型来预测对象的未来状态,而是自主交通工具可以:基于对象的有
限运动数据、对象相对于自主交通工具的当前位置以及用于通用对象(例如,通用高性能客运交通工具)的最大速度和加速度假设来预测和界定对象的未来状态;并且随着时间的推移,当自主交通工具为该对象收集到额外的速度数据时,细化(例如,缩小)该对象的这些未来状态边界。
23.因此,通过执行方法s100的块来通知路径规划决策,自主交通工具可以:减少或消除精确识别其环境中的对象的类型或类别的需要;减少或消除在自主交通工具的自主操作中的这种可能的误差来源;以及增加自主交通工具的自主操作的鲁棒性,诸如对抗对抗性计算机视觉攻击、对抗性神经网络攻击的鲁棒性,或者在先验训练数据有限或没有先验训练数据的情况下的鲁棒性。
24.此外,自主交通工具可以针对可变和不可变的对象实现相同的检测、跟踪和运动规划决策路径,从而减少或消除在自主交通工具的环境中识别对象的类别(或将对象分类为可变或不可变)的需要,并减少在自主交通工具上执行的独特的计算机视觉、机器学习和路径规划流水线的数量。例如,自主交通工具可以执行相同的检测、跟踪和运动规划决策路径,以预测和处理:在自主交通工具的环境中但被其他检测到的对象遮挡的可能无法检测到的对象(例如,站在电线杆后面的行人;占据在自主交通工具的视场(field of view)中被拖拉机拖车遮挡的车道的客运交通工具);首次进入自主交通工具的视场的对象;以及在自主交通工具的视场中现存的对象。
25.3.自主交通工具
26.自主交通工具可以包括:一套传感器,该套传感器被配置成收集表示自主交通工具周围的场中的对象的数据;本地存储器,该本地存储器存储定义供自主交通工具执行的路线的导航地图,以及表示沿道路的不可变表面的位置的定位地图;以及控制器。该控制器可以:基于从该套传感器收集到的传感器数据和定位地图,计算自主交通工具在现实空间中的位置;根据方法s100的块计算在这些传感器数据中检测到的对象的未来状态边界;基于这些未来状态边界、自主交通工具的现实位置和导航地图选择未来导航动作;以及根据这些导航决策来控制交通工具内的致动器(例如,加速器、制动器和转向致动器)。
27.在一个实现中,自主交通工具包括布置在自主交通工具上的一组360
°
lidar传感器,诸如布置在自主交通工具前部处的一个lidar传感器和布置在自主交通工具后部处的第二lidar传感器,或者布置在自主交通工具顶部上的lidar传感器集群。每个lidar传感器可以在lidar传感器每旋转一次(即,每扫描周期旋转一次)时输出一个诸如以3d点云形式的三维距离图(或深度图像),该3d点云表示lidar传感器与lidar传感器视场内的外部表面之间距离。自主交通工具可以附加地或替代地包括:一组红外发射器,该组红外发射器被配置成将结构光投射到自主交通工具附近的场中;一组红外探测器(例如,红外相机);以及处理器,该处理器被配置成将红外探测器输出的图像变换为场的深度图。
28.自主交通工具可以附加地或替代地包括从自主交通工具的前部、后部和/或侧部面向外的一组彩色相机。例如,该组中的每个相机都可以以20hz的速率输出数字摄影图像(或“帧”)的视频馈送。自主交通工具还可以包括一组radar传感器,该组radar传感器从自主交通工具面向外,并被配置成检测自主交通工具附近的对象的存在和速度。因此,自主交通工具中的控制器可以每个扫描周期将来自lidar传感器、彩色相机和radar传感器等的数据流融合为一个扫描图像,该扫描图像诸如以3d彩色地图或3d点云的形式,该3d彩色地图
或3d点云包含表示自主交通工具周围的场中的道路、人行道、交通工具、行人等的点群(constellations of points)。
29.然而,自主交通工具可以包括任何其他传感器,并且可以实现任何其他扫描、信号处理和自主导航技术或模型,以确定其地理空间位置和取向,感知其附近的对象,并基于通过这些传感器收集的传感器数据来选择导航动作。
30.3.1对象位置 运动数据
31.在一个实现中,自主交通工具包括传感器,该传感器输出包含一群点(a constellation of points)的扫描图像,其中该扫描图像中的每个点:表示环境中的表面相对于传感器(或更一般地相对于自主交通工具)的位置;并指定该表面沿从传感器(或更一般地自主交通工具)延伸到该表面的射线的速度。
32.在一个示例中,自主交通工具包括3d扫描lidar传感器,该lidar传感器被配置成检测自主交通工具周围的场中的表面——沿从传感器(或更一般地自主交通工具)延伸到这些表面的射线——的距离和相对速度。在该示例中,3d扫描lidar传感器可以:在极坐标系中以球坐标表示场中的表面的位置,该极坐标系在3d扫描lidar传感器处(或在自主交通工具上的参考位置处)定义原点;并且在传感器的每个扫描周期(例如,每次旋转)将这些极坐标存储在一个扫描图像中。因此,在该示例中,自主交通工具可以访问包含由四维光检测和测距传感器捕获的数据的扫描图像,该四维光检测和测距传感器:被安装在自主交通工具上;并且被配置成生成表示位于场内的表面相对于传感器的位置和速度的扫描图像。
33.在该示例中,自主交通工具可以包括多个这样的3d扫描lidar传感器,每个lidar传感器被配置成每个扫描周期输出一个扫描图像。然后,自主交通工具可以将这些传感器输出的并发扫描图像融合为一个复合扫描图像用于该扫描周期。
34.替代地,自主交通工具可包括一套传感器,该套传感器捕获不同类型的数据,并可将这些传感器的输出融合为扫描图像,该扫描图像包含位于场中表面的位置处的点,并且这些点用这些表面沿在自主交通工具和这些表面之间延伸的射线的速度进行注释。例如,自主交通工具可以包括3d扫描lidar传感器,该3d扫描lidar传感器:定义lidar视场:并且被配置成在扫描周期期间生成包含一群点的3d点云,其中每个点定义表面上的区域在自主交通工具周围的环境中的位置。在该示例中,自主交通工具还可以包括固定或扫描radar传感器,该固定或扫描radar传感器:定义与lidar视场相交的radar视场;并且在扫描周期期间生成radar视场中的对象或表面的列表,其中用相对于radar传感器的速度来注释该列表中的每个对象或表面。然后,自主交通工具合并在扫描周期期间lidar和radar传感器的并发输出,以用radar传感器检测到的对应的对象或表面的速度注释3d点云中的点。
35.然而,自主交通工具可以包括任何其他类型或配置的传感器,并且可以访问或构建表示在扫描周期期间自主交通工具周围的场中的对象或表面的相对位置和相对速度的扫描图像。
36.4.预加载的规则/假设
37.自主交通工具还可以存储针对通用对象的预定义的最坏情况的运动假设。特别地,自主交通工具可以存储关于自主交通工具在运行过程中可能遇到的任何对象的最具侵略性的(或“最坏情况”的)运动和运动变化的假设,并应用这些最坏情况的运动假设来预测它在整个运行过程中遇到的所有对象(例如,行人、客运交通工具、卡车、拖车、rv、摩托车、
街道标志、灯柱、交通信号、电线杆、建筑物)的未来状态。
38.例如,自主交通工具可以存储:通用对象的最大可能速度(例如,每小时100英里;每秒55米);以及通用对象在任何方向上的最大可能线加速度(例如每秒9米/秒)。自主交通工具还可以存储通用对象在任何方向上的最大可能角速度,诸如作为对象的速度的反函数。例如,自主交通工具可以存储最大可能角速度函数,该函数输出通用对象—围绕其中心—的最大可能角速度,该最大可能角速度随着通用对象的线速度的增加而减小。因此,在该示例中,最大可能角速度函数可以预测当通用对象静止时通用对象的最大可能角速度。(例如,站着不动的行人可能比以每秒30米的速度行驶的跑车表现出更大的最大可能角速度。)
39.自主交通工具还可以存储对象避让规则,诸如在自主交通工具与自主交通工具附近的任何对象的未来状态边界之间的最小时间或空间裕度。
40.然而,自主交通工具可以存储和实现针对通用对象的任何其他预定义的最坏情况的运动假设和/或对象避让规则。
41.此外,自主交通工具可以检索这些预定义的最坏情况的运动假设和/或由附属于自主交通工具或自主交通工具运行地点的操作者或利益相关者设定的对象避让规则。例如,车队管理者或政府官员可以将这些值分配给自主交通工具车队,或者为直辖市、市、县、区、州、地区或国家等内的所有自主交通工具的运行指定这些值。
42.5.停止距离和停止持续时间
43.方法s100的块s110和s112叙述:在第一时间在自主交通工具处,基于自主交通工具在第一时间的速度,估计使自主交通工具达到完全停止的停止持续时间;以及存储从第一时间偏移停止持续时间的临界时间。通常,在块s110和s112中,自主交通工具基于其当前速度估计—如果自主交通工具立即启动紧急停止过程—自主交通工具可以达到完全停止的未来的时间和/或距离。例如,自主交通工具可以实现将交通工具速度直接转换为停止持续时间和/或停止距离的预加载功能。
44.在另一实现中,自主交通工具基于由自主交通工具中的各种传感器收集的数据来估计道路表面质量。例如,自主交通工具:实现计算机视觉和机器学习技术,以检测彩色图像中水坑或积水的存在;并基于这些水坑或积水的存在和分布来估计道路表面的潮湿度。在另一个示例中,自主交通工具:实现计算机视觉和机器学习技术,以从由自主交通工具上的相机捕获的彩色图像中提取颜色数据和纹理信息;并解释自主交通工具周围的道路表面的类型,诸如:养护沥青;年久失修的沥青(例如坑坑洼洼的)、光滑的混凝土;带有纹理的混凝土;砾石;污垢;草;或者积水。在该实现中,自主交通工具然后可以基于该估计的道路的潮湿度和表面类型来计算或检索用于道路表面的摩擦系数。自主交通工具可以附加地或替代地实现用于自主交通工具的制动效率模型,以基于以下项来计算制动效率系数:自自主交通工具上次的制动服务以来的里程;和/或自自主交通工具上次的轮胎更换以来的里程。自主交通工具然后可以实现制动模型,以基于以下项来估计停止距离和/或停止持续时间:当前交通工具速度;摩擦系数;和/或制动效率系数。
45.然而,自主交通工具可以实现任何其他方法或技术来估计自主交通工具的当前停止距离和/或当前停止持续时间。
46.自主交通工具还可以向这些停车距离和/或停止持续时间值添加安全裕度,诸如:
通过向停止距离添加三米;通过向停止持续时间增加两秒;或者通过将这些值乘以安全裕度(例如“1.2”)。
47.然后,自主交通工具可以通过将当前时间和停止持续时间相加来计算—表示自主交通工具可以制动到完全停止的最快时间的—临界时间。
48.6.扫描图像、对象检测和对象运动
49.方法s100的块s120和s122叙述:在大约第一时间捕获的自主交通工具周围的场的第一扫描图像中检测对象;并且基于第一扫描图像,导出对象的第一位置和沿着从自主交通工具到该对象的第一射线的第一径向速度。通常,在块s120和s122中,自主交通工具可以:如上所述访问由lidar传感器输出的新的扫描图像;在该新的扫描图像中检测在前面扫描图像中未检测到的对象;并从该新的扫描图像中提取该对象的高确定性运动特性的有限集合(例如,相对于自主交通工具的径向速度)。
50.在一个实现中,在接收(或生成)用于当前扫描周期的扫描图像之后,自主交通工具执行对象检测技术,以将扫描图像中的点组与自主交通工具周围的场中的离散对象相关联。例如,自主交通工具可以:聚合一组点,这些点聚集在距离自主交通工具的相似深度处,并且被标记有对于邻近的对象来说自洽(self-consistent)的速度(例如,距离变化率(range rate)、方位角速度);并将该组点与场中的一个对象相关联。
51.然后,自主交通工具可以从该扫描图像中提取对象沿着从自主交通工具延伸到对象的射线(在下文中称为“径向方向”)的径向速度(或“距离变化率”)和对象相对于自主交通工具的角速度。例如,自主交通工具可以:基于当前时间自主交通工具在绝对参考系中的位置和速度,将定义该对象的点的径向速度变换为绝对参考系中的绝对速度;并且基于包含在与该对象相关联的点组中的最左侧点和最右侧点的绝对径向速度之间的差,计算在当前扫描周期期间在绝对参考系中该对象围绕其中心的角速度(或“偏航”)。在该示例中,自主交通工具还可以:对在限定该对象的该点组的质心附近的点的子集中存储的径向速度进行平均;并将该平均径向速度存储为对象在沿从自主交通工具的中心到该点组的质心的射线的径向方向上—相对于自主交通工具—的径向速度。(自主交通工具还可以基于自主交通工具在该扫描周期期间的速度和角速度,将对象相对于自主交通工具的该径向速度变换为对象在径向方向上的绝对速度。)
52.自主交通工具可以—在该扫描图像中—对表示自主交通工具周围的场中的其他对象的其他点组重复该过程。
53.6.1对象跟踪
54.自主交通工具还可以实现对象跟踪技术以:将—表示当前扫描图像中的特定对象的—点组链接到在前面扫描图像中检测到的类似点组;并且跨这两个扫描图像将这些点组—以及它们所表示的对象—链接起来。然而,如果自主交通工具未能将在当前扫描图像中检测到的点组与前面扫描图像中—处于相似的位置和速度—的点组匹配,则自主交通工具可以将当前扫描图像中的该点组标记为新的对象(即,在当前扫描周期期间首次进入自主交通工具的视场的对象)。
55.7.有界未来状态:新对象
56.方法s100的块s130叙述基于以下项来计算表示对象从第一时间到临界时间可进入的地面区域的第一未来状态边界:对象在第一时间的第一位置;对象的第一径向速度;以
及为自主交通工具的运行而定义的通用对象的最大假设加速度、最大假设角速度和最大假设加速度。通常,在块s130中,自主交通工具可以将由此从其中首次检测到对象的当前扫描图像导出的对象的有限运动数据和对于对象做出对抗性动作的最坏情况假设进行合并,以计算从当前时间到临界时间(即,在随后的停止持续时间内)对象可进入的地面区域的范围,并将该可进入的地面区域存储为对象的未来状态边界。
57.更具体地说,当自主交通工具在扫描图像中首次检测到对象时,自主交通工具可以:估计对象的中心(在该扫描图像中的与该对象相关联的点的质心附近)相对于自主交通工具的位置;基于在扫描图像中与对象相关联的该点组中存储的速度值,导出该对象相对于自主交通工具的偏航率;并且如上所述导出对象在径向方向上(即,沿着从自主交通工具延伸到对象的射线)的速度。然而,自主交通工具在其中首次检测到对象的扫描图像可能没有包含充足的数据,以使自主交通工具能够导出对象的绝对速度或对象垂直于径向方向(在下文中称为方位角方向)的速度。因此,自主交通工具可以为对象的当前速度和对象的未来加速度实现最坏情况假设,以计算未来状态边界,该未来状态边界表示在最坏情况的场景中对象从当前时间到临界时间可进入的地面区域。
58.在一个实现中,计算机系统基于以下项来计算对象在围绕对象的中心径向偏移的许多方向(例如,径向偏移3.6
°
的一百个方向)中的每个方向上的最大可能速度:通用对象的假设的最大可能速度;以及对象在径向方向上的速度。对于该集合中的第一方向,计算机系统然后计算从当前时间到临界时间对象在该第一方向上的最大可能速度和对象的测量到的角速度随时间的第一积分。对于该第一方向,自主交通工具还:实现将角速度和径向方向上的速度与通用对象在该第一方向上的加速度的最大可能速率链接起来的加速度规则函数,以估计对象在该第一方向上的加速度的最大可能速率;并且计算从当前时间到临界时间对象在第一方向上的加速度的最大可能速率(受到通用对象的最大可能速度的限制)随时间的第二(二重)积分。然后,自主交通工具对第一积分和第二积分求和,以计算对象在第一方向上穿越的最大可能距离,并定位未来状态边界的第一顶点,该第一顶点在从对象的中心沿着第一方向延伸的射线上并偏离对象的中心该最大可能的穿越距离。自主交通工具:对集合中的每个其他方向重复该过程,以在这些方向中的每个方向上限定未来状态边界的顶点;计算穿过这些顶点中的每一个的样条;并将该样条所包含的区域存储为该对象的未来状态边界。
59.因此,因为自主交通工具具有在对象可见的该第一扫描周期期间与对象的速度相关的有限信息,所以自主交通工具可以:为对象的当前速度和未来加速度实现最坏情况假设,以便预测对象从当前时间到临界时间(即,自主交通工具可以制动到完全停止的最快时间)可进入的最坏情况的地面区域。然后,自主交通工具可以定义在对象的该未来状态边界之外的安全地面区域,并执行导航动作以保持在安全地面区域内,使得自主交通工具和对象之间的任何碰撞只可能发生在自主交通工具达到完全停止之后(并且使得与对象的碰撞可以完全是对象的责任而不是自主交通工具的责任)。特别地,如果自主交通工具的当前位置落在未来状态边界附近(例如,在未来状态边界的阈值距离内),则自主交通工具可以启动避让机动以避开对象的未来状态边界。以其他方式来说,自主交通工具可以:验证非常高的置信度,即,如果自主交通工具继续沿着其当前轨迹和以其当前速度运行,直到至少下一个扫描周期,那么—即使假定对象做出最具对抗性的动作—自主交通工具也将避免与对象
碰撞;并因此针对当前扫描周期使对象消隐,而不纳入路径规划决策。
60.例如,如果自主交通工具的当前位置离对象的未来状态边界非常远,自主交通工具可以针对当前扫描周期使对象消隐,而不纳入路径规划决策。然而,如果自主交通工具的当前位置位于距离对象的未来状态边界的阈值距离(例如,10米、4秒)内,则自主交通工具可以将对象包括在针对当前扫描周期的路径规划决策中,诸如通过:使自主交通工具以与自主交通工具到对象的未来状态边界的周界的接近度成反比的幅度和/或速率减速;和/或调整自主交通工具的转向角以将自主交通工具的轨迹移离对象的未来状态边界。
61.8.有界未来状态:现存对象
62.通常,自主交通工具可以在距离自主交通工具相对远的距离处捕获具有相对高的分辨率的图像,使得当自主交通工具首次在扫描图像中检测到对象时,自主交通工具通常落在明显超出由此为该对象计算的未来状态边界的距离处。因此,自主交通工具通常可以在自主交通工具首次检测到对象的扫描周期期间使对象消隐,而不纳入路径规划决策。然而,自主交通工具还可以在后续扫描图像上跟踪该对象,从这些扫描图像中导出该对象的附加运动特性,相应地更新该对象的未来状态边界,以及基于自主交通工具的并发位置和该对象的这些细化的未来状态边界,在这些后续扫描周期期间选择性地使该对象消隐或考虑该对象。
63.在一个实现中,自主交通工具在继自主交通工具首次检测到对象的第一扫描周期之后的第二扫描周期期间捕获第二扫描图像,如上所述。自主交通工具然后实现上述方法和技术以:从该第二扫描图像和第一扫描图像与第二扫描图像之间的差异导出对象的附加运动特性(例如,在方位角方向上的速度、角速度和绝对速度);用这些导出的运动数据来代替针对对对象的速度的最坏情况假设;并相应地为该对象重新计算未来状态边界。
64.在一个实现中,自主交通工具:访问在上述的第一扫描周期之后的第二扫描周期期间捕获的第二扫描图像;实现对象跟踪技术,以将第二扫描周期中的点组与在第一扫描图像中检测到的对象相关联;估计第一图像和第二图像中的对象的中心;从第一扫描图像中提取对象在第一扫描周期的第一时间的第一位置;从第二扫描图像中提取对象在第二扫描周期的第二时间的第二位置;计算第一和第二位置之间的空间距离;通过将空间距离除以第一和第二扫描周期之间的时间间隔来估计对象相对于自主交通工具的当前速度。
65.(然而,因为由第一图像和第二图像中的点组表示的对象的范围可能不同,并且因为第一和第二扫描周期之间的时间间隔可能很短(例如,10毫秒),所以从第一扫描周期到第二扫描周期的对象的位置的变化可能容易产生显著的误差。更具体地说,与从当前扫描图像中提取的对象的径向速度相比,该导出的对象速度的不确定性可能相对较高。因此,自主交通工具可以将该计算出的对象—相对于自主交通工具—的速度乘以误差裕度,诸如“1.5”。此外,随着自主交通工具在多个连续的扫描周期上跟踪该对象,自主交通工具可以计算这些导出的对象的速度的组合(例如,加权平均),以便减少该计算中的一些误差。)
66.在该实现中,自主交通工具还可以:基于在该时间间隔期间自主交通工具的速度,将对象相对于自主交通工具的当前速度(按误差裕度进行了调整)变换为对象的绝对速度;实现上述方法和技术,以基于在该组中的点中包含的速度值来计算对象在径向方向上的速度和对象的角速度;并基于对象的绝对速度和对象在径向方向上的速度,导出对象在—垂直于径向方向的—方位角方向上的速度。
67.因此,自主交通工具可以基于从第二扫描图像和前面扫描图像中提取的数据,导出对象在该第二扫描周期期间的更完整的运动简档(诸如包括真实的绝对速度)。
68.然后,自主交通工具可以实现上述方法和技术以:基于自主交通工具在该第二扫描周期期间的速度重新计算自主交通工具的临界时间;并且基于从当前时间到修订的临界时间的对象的真实(绝对或相对)速度(而不是通用对象的最坏情况速度)、对象的角速度和通用对象的最大可能加速度(受到通用对象的最大可能速度的限制),重新计算从当前时间到该修订的临界时间的对象的未来状态边界。
69.因此,因为对象的真实速度可能常常(显著)小于通用对象的最大假设速度,所以基于在该第二扫描周期期间收集的附加运动数据而由此重新计算的对象的该修订的未来状态边界可能显著小于由自主交通工具在首次检测到对象后计算出的对象的初始未来状态边界。
70.然后,自主交通工具可以实现上述方法和技术,以基于对象距该对象的该修订的未来状态边界的周界的距离,在该第二扫描周期期间选择性地使该对象消隐,而不纳入路径规划考虑。
71.自主交通工具可以对自主交通工具由此捕获的每个后续扫描图像重复该过程,以便细化和更新该对象的未来状态边界,诸如直到自主交通工具驶过该对象或者直到该对象移动到自主交通工具的视场之外。
72.9.有界未来状态:被遮挡的对象
73.在一个变型中,自主交通工具可以:在被检测到的对象(例如,客运交通工具、卡车、建筑物)遮挡的自主交通工具周围的场的区域中定义虚拟对象;实现类似于上述那些方法和技术的方法和技术,以将最坏情况的运动特性分配给该虚拟对象,并基于该最坏情况的运动特性为该虚拟对象定义虚拟未来状态边界;以及基于虚拟对象的可能的运动特性随时间的收缩范围和相应地重新计算的虚拟对象的虚拟未来状态边界来细化虚拟对象的这些最坏情况的运动特性。更具体地说,在该变型中,自主交通工具可以预料在检测到的对象后面存在未检测到的对象,并实现类似于上述那些方法和技术的方法和技术,以界定未检测到的对象的可能的未来状态,并且基于保持在该未检测到的对象无法进入的空间中的距离导航动作,选择性地使未检测到的对象在检测到的对象后面的可能性消隐。
74.在一个实现中,自主交通工具首先在第一扫描图像中检测跨越方位角距离的第一对象。然后,自主交通工具实现上述方法和技术,以基于从第一扫描图像中提取的运动数据来计算第一对象的未来状态边界,并基于从后续扫描图像中提取的运动数据来修订第一对象的该未来状态边界。
75.并发地,自主交通工具:定义紧跟在第一对象后面的虚拟对象(例如,在第一对象后面两米);向虚拟对象分配所有方向上的最坏情况的速度和所有方向上的—达到通用对象的最大可能速度的—最坏情况的加速度;并根据这些最坏情况的运动值为虚拟对象计算虚拟未来状态边界。例如,自主交通工具可以:假设虚拟对象在当前时间以通用对象的最大可能速度在所有方向(除了当前被第一对象遮挡的方向之外)上移动;以及基于所有方向(除了当前被第一对象遮挡的方向之外)上的该最大可能速度在自主交通工具的当前停止时间内的积分来为虚拟对象计算虚拟未来状态边界。自主交通工具然后可以实现上述方法和技术,以验证自主交通工具的当前位置在该虚拟未来状态边界之外,并相应地在当前扫
描周期期间选择性地使该虚拟对象的考虑消隐,而不纳入路径规划考虑。
76.在下一个扫描周期期间,自主交通工具可以类似地:访问下一个扫描图像;实现对象跟踪技术,以在该下一个扫描图像中检测第一对象,并将该下一个扫描图像中的该第一对象链接到在前面扫描图像中检测到的第一对象。然后,如果自主交通工具未能在该下一个扫描图像中检测到从第一对象后面出现的新的对象,则自主交通工具可以确认虚拟对象相对于第一对象的方位角速度不足以在从前面扫描周期到该下一个扫描周期的时间间隔内通过第一对象在自主交通工具的视场中的方位角长度。更具体地说,因为自主交通工具未能在该下一个扫描图像中检测到出现在第一对象后面的新的对象,所以自主交通工具可以预测虚拟对象—相对于第一对象以及沿着由自主交通工具定义的方位角方向—的速度没有超过第一对象的宽度除以前面扫描周期和当前扫描周期之间的时间间隔。因此,在该实现中,自主交通工具可以:从当前扫描图像中提取第一对象的方位角长度(或从前面扫描图像和当前扫描图像中提取的第一对象的平均长度);基于第一对象的位置在第一扫描图像和第二图像之间的变化,导出第一对象—相对于自主交通工具的—方位角速度;以及基于第一对象的方位角长度和第一扫描周期与第二扫描周期之间的时间间隔,假设虚拟对象是无限窄的,计算在第一扫描周期与第二扫描周期之间虚拟对象—相对于第一对象并沿着由自主交通工具定义的方位角方向—的最大可能方位角速度。然后,自主交通工具可以:通过对第一对象相对于自主交通工具的方位角速度和虚拟对象相对于第一对象的方位角速度进行求和来计算虚拟对象相对于自主交通工具的最大可能方位角速度;然后实现上述方法和技术(用于新的对象),以基于由此为虚拟对象估计的最大方位角速度来为虚拟对象计算虚拟未来状态边界。
77.自主交通工具可以对后续的扫描周期重复该过程,包括:基于第一对象的长度和在自主交通工具于其中检测到第一对象的一组扫描图像上的时间间隔,进一步修订虚拟对象—沿着相对于自主交通工具的方位角方向—的最大可能方位角速度;基于虚拟对象的该最大可能方位角速度,重新计算虚拟对象在各个方向上的最大可能速度和加速度;以及基于虚拟对象的这些最大可能速度、最大可能加速度和最大可能方位角速度来细化虚拟对象的虚拟未来状态边界。
78.自主交通工具还可以定义在第一对象后面的多个虚拟对象,并实现类似的方法和技术来为这些虚拟对象中的每一个(诸如:紧跟在第一对象后面的第一虚拟对象;在第一对象后面两米处的第二虚拟对象;在第一对象后面十米处的第三虚拟对象;以及在第一对象后面20米处的第四虚拟对象;等等)定义虚拟未来状态边界。
79.例如,在第一扫描图像中检测到电线杆时,自主交通工具可以执行前述方法和技术来为这些虚拟对象中的每一个计算虚拟未来状态边界。在该示例中,如果自主交通工具在多个连续扫描图像(例如,在一秒内被捕获)上跟踪该电线杆,并且未能检测到在电线杆后面进入视野的新的对象,则自主交通工具可以定义一组虚拟未来状态边界,这些虚拟未来状态边界指示:不存在紧跟在电线杆后面的、在方位角方向上以快于0.2米/秒的速度行走的行人(即,第一虚拟对象);不存在位于电线杆后面大约两米的区域中的、在方位角方向上以快于0.2米/秒的速度移动的摩托车(即第二虚拟对象);不存在位于电线杆后面大约十米的区域中的、在方位角方向上以快于1米/秒的速度移动的客运交通工具(即第三虚拟对象);以及不存在位于电线杆后面大约20米的区域中的、在方位角方向上以快于1米/秒的速
度移动的卡车交通工具(即,第三虚拟对象)。
80.此外,在该变型中,在检测到第二对象出现在第一对象后面并且位于距自主交通工具的特定径向距离处时,自主交通工具可以:将由此为在距自主交通工具的该特定径向距离附近的虚拟对象导出的运动特性转移到该第二对象上;然后实现从虚拟对象转移的这些运动特性,以计算该第二对象的未来状态边界。
81.10.其他对象
82.通常,自主交通工具可以并发执行前述过程的多个实例,来为在当前扫描图像中检测到的许多离散对象计算未来状态边界、定义在这些检测到的对象中的每一个后面的一个或更多个虚拟对象、为这些对象中的每一个定义虚拟未来状态边界、以及随着时间的推移细化未来状态边界。
83.11.进入区
84.然后,自主交通工具可以根据自主交通工具到这些检测到的对象和虚拟对象的未来状态边界的接近度,选择基于这些检测到的对象和虚拟对象的子集的下一导航动作。
85.在一个实现中,自主交通工具:聚合在当前扫描周期期间所计算的用于检测到的对象和虚拟对象的未来状态边界;并—基于这些未来状态边界的检测到的对象和虚拟对象在当前扫描周期期间相对于自主交通工具的位置—将这些未来状态边界组装成一个复合未来状态边界,该复合未来状态边界基于这些对象的最坏情况的对抗性运动特性,定义这些检测到的对象和虚拟对象从当前时间到临界时间可进入的所有位置。(在该变型中,为了减少该复合未来状态边界的复杂性,自主交通工具还可以:选择未来状态边界的子集,该子集定义落在自主交通工具当前位置的预设的最小时间或空间裕度内的周界。然后,自主交通工具可以将未来状态边界的该子集组装成一个复合未来状态边界。)
86.然后,自主交通工具可以将该复合未来状态边界的反面(converse)存储为用于自主交通工具的进入区。更具体地说,该进入区可以定义这样的地面区域:自主交通工具可以至少在从当前扫描周期到下一次扫描的时间间隔内在该地面区域内运行,同时维持非常高的置信度,即,自主交通工具可以在与任何检测到的对象碰撞之前制动到完全停止,即使这些对象中的一个(或许多个)在当前扫描周期期间发起对抗性动作(例如,快速加速到通用对象的最大可能速度)。自主交通工具还可以将地理参考的道路网络与该进入区对齐,并进一步移除进入区中的延伸到该道路网络中所定义的道路区域之外的区域。
87.然后,自主交通工具可以计算导航动作,当该导航动作由自主交通工具执行时,该导航动作将自主交通工具维持在进入区内,诸如:如果自主交通工具在进入区的边缘的时间或空间裕度内,则使自主交通工具减速以降低接近该边缘的速率;和/或通过调整自主交通工具的转向角,以便将自主交通工具重新引导向进入区中的从自主交通工具延伸得更远的区段。(自主交通工具还可以对这些导航动作进行权衡,以将自主交通工具维持在指定路线上或附近。)
88.因此,自主交通工具可以:利用用于新检测到的对象、现存检测到的对象和虚拟对象的未来状态边界来计算这样的地面区域——在有限的时间段(例如,两个连续扫描周期之间的时间间隔)内自主交通工具可以在该地面区域内运行,同时维持自主交通工具可以在与这些对象中的任何一个碰撞之前制动到完全停止的高置信度;然后定义并执行导航操作,以将自主交通工具维持在该进入区内。自主交通工具然后可以在运行期间对每个后续
扫描周期重复该过程。
89.12.改变对象和点
90.此外,因为自主交通工具可能不依赖于对象分类或识别来预测对象的类型并相应地预测对象的运动,所以自主交通工具可以定义跨越场中的多个真实对象(诸如,如果这些对象沿着相似的轨迹并以相似的速度移动)的点组。然而,自主交通工具可以实现前述方法和技术以计算、细化和避开针对该“分组对象”的未来状态边界,直到这些真实对象不再沿着相似的轨迹和/或以相似的速度移动,此时自主交通工具可以:在当前扫描周期中区分这些对象;从前面的分组对象将运动特性转移到这些不同对象中的每一个上;然后如上所述,为这些对象中的每一个计算未来状态边界。
91.类似地,自主交通工具可以区分表示单个真实对象的两个点集群,并实现上述方法和技术以计算、细化和避开针对这两个集群的未来状态边界,诸如直到自主交通工具确定这两个集群中的点的接近度和径向速度(或距离变化率)的自洽性指示单一对象的时间。
92.附加地或替代地,自主交通工具可以实现前述方法和技术,以计算、细化和避开针对表示自主交通工具周围的场中的对象的子区域的单独的点和较小的点集群的未来状态边界。
93.13.运动消歧
94.对于第一扫描周期,图2所示的方法s100的一个变型包括:在块s104中,访问包含由自主交通工具上的传感器在第一时间捕获的数据的第一扫描图像;在块s120中,在第一扫描图像中识别表示自主交通工具附近的场中的对象的第一点组,该第一点组中的每个点包括从传感器到对象上的表面的第一测距值、对象上的表面相对于传感器的第一方位角位置和对象的表面相对于传感器的第一径向速度;在块s122中,计算第一点组中的点的第一径向速度和第一方位角位置之间的第一相关性;以及在块s122中,基于第一相关性,计算将在第一时间处的对象的可能的切向速度和对象的可能的角速度关联起来的第一函数。对于第二扫描周期,方法s100的该变型类似地包括:在块s104中访问包含由传感器在第二时间捕获的数据的第二扫描图像;在块s120中,在第二扫描图像中识别表示场中的对象的第二点组;在块s122中,计算第二点组中的点的第二径向速度和第二方位角位置之间的第二相关性;以及在块s122中,基于第二相关性,计算将在第二时间处的对象的可能的切向速度和对象的可能的角速度关联起来的第二函数。方法s100的该变型还包括在块s124中,基于第一函数和第二函数的交集,估计在第二时间相对于自主交通工具的对象的第二切向速度和对象的第二角速度。
95.在该变型中,对于第一扫描周期,方法s100可以类似地包括:在块s104中,访问包含由自主交通工具上的传感器在第一时间捕获的数据的第一扫描图像;在块s120中,在第一扫描图像中识别表示自主交通工具附近的场中的对象的第一点组,该第一点组中的每个点包括从传感器到对象上的表面的第一测距值、对象上的表面相对于自主交通工具的第一位置和对象的表面相对于自主交通工具的第一径向速度;在块s122中,计算第一点组中的点的第一径向速度和第一位置之间的第一相关性;以及在块s122中,基于第一相关性,计算将在第一时间处的对象的可能的线性运动和对象的可能的角运动关联起来的第一函数。对于第二扫描周期,方法s100的该变型还可以包括:在块s104中访问包含由传感器在第二时间捕获的数据的第二扫描图像;在块s120中,在第二扫描图像中识别表示对象的第二点组;
在块s122中,计算第二点组中的点的第二径向速度和第二位置之间的第二相关性;以及在块s122中,基于第二相关性,计算将在第二时间处的对象的可能的线性运动和对象的可能的角运动关联起来的第二函数。方法s100的该变型还可以包括在块s126中,基于第一函数和第二函数的交集,估计在第二时间对象相对于自主交通工具的线性运动和对象相对于自主交通工具的角运动。
96.附加地或替代地,在该变型中,对于自主交通工具处的扫描周期序列中的每个扫描周期,方法s100可以包括:在块s104中,访问包含由自主交通工具上的传感器在扫描时间捕获的数据的扫描图像;在块s120中,在扫描图像中识别表示在自主交通工具附近的场中的对象的点组,该点组中的每个点包括对象上的表面相对于自主交通工具的位置和对象的表面相对于自主交通工具的径向速度;以及在块s122中,基于点组中的点的径向速度和位置之间的相关性来计算函数,该函数将在扫描时间的对象的可能的线性运动和对象的可能的角运动关联起来。方法s100的该变型还可以包括在块s126中,基于当前的函数和前面的函数的交集,估计在当前时间对象相对于自主交通工具的当前线性运动和对象相对于自主交通工具的当前角运动,当前的函数是从包含在当前时间捕获的数据的第一扫描图像中导出的,前面的函数是从包含在当前时间之前捕获的数据的第二扫描图像中导出的。
97.13.1三个自由度
98.通常,在该变型中,自主交通工具:基于在由自主交通工具上的传感器输出的扫描图像中表示对象的点组的特性,导出该对象在自主交通工具的场中的切向速度和角速度之间的关系;基于所测量的该对象的径向速度和所导出的该对象的切向速度和角速度之间的这种关系,进一步界定该对象的可能的当前运动;并基于该对象的可能的当前运动和基于地面的对象的运动限制假设,进一步细化为该对象所计算的未来状态边界。
99.特别地,在该变型中,自主交通工具可以利用对象的径向距离、径向速度、切向速度和角速度与限制数量(例如,少至两个)的距离、角度和距离变化率测量值之间的关系,计算对象的可能的切向速度和角速度的窄范围,并且因此计算对象在单一扫描周期期间的可能的总速度的窄范围。自主交通工具还可以:在传感器于下一个扫描周期期间输出的扫描图像中跟踪对象;基于该下一个扫描图像重复前述处理;以及合并当前和前面的扫描周期的结果以将对象的运动估计缩小到切向速度值、角速度值和总速度值的奇异集(singular set)(或其非常窄的范围)。然后,不是基于最大加速度假设以及对象的最大速度和可能速度的范围来计算对象的未来状态边界,而是基于最大加速度假设和由自主交通工具利用两次独立测量导出的对象的单一总速度来计算对象的更窄的未来状态边界。更具体地说,自主交通工具可以执行方法s100的块以将附近对象的二维运动可能性的集合压缩为针对该对象的一维运动可能性的集合。
100.通常,基于地面的对象(例如,交通工具、行人)的运动可以大致在水平面内(即,平行于地平面)发生,该运动包括沿x轴的线性运动、沿y轴的线性运动和绕垂直于水平面的z轴的旋转,其可以表示为水平面内的线速度和绕垂直于水平面的轴的角速度。因此,方法s100的该变型在下面被描述为由自主交通工具执行,以在给定对象上的点在水平面中的径向速度和位置(例如,测距值和角度)的情况下,导出对象在水平面内的切向速度、角速度和总速度。然而,自主交通工具可以实现类似的方法和技术来导出对象在3d空间中的线速度和角速度(即三个线速度和三个角速度)以及相应地导出对象在3d空间中的绝对或相对总
速度。
101.更具体地说,传感器可以被配置成在扫描周期期间,对于落在传感器视场内的场中的每个表面,返回沿着从场中的表面回到传感器的射线的测距值(即,距离)、方位角和速度(即,径向速度或“多普勒”)。表示扫描图像中的对象的一组表面的切向速度(例如,在垂直于径向速度的方向上并且在水平面中的线性运动)和角速度(例如,围绕自主交通工具的偏航轴的角运动)被包含在该扫描图像中的点的测距值、方位角和速度数据中。然而,从包含在该点组中的测距值、方位角和径向速度来看,对象的具体切向速度和角速度是不确定的。此外,在多个扫描图像上跟踪对象并从在多个扫描图像上描绘的对象的位置变化导出对象的切向速度引入了显著的误差:特别是如果对象在自主交通工具的视场中的视角从一个扫描周期到下一个扫描周期发生变化,因为对象在连续的扫描周期内在尺寸上将看起来有所变化,这将在所计算的对象的切向速度中被错误地表示;特别是如果对象的被遮挡而对传感器不可见的区域在连续的扫描周期内发生变化,因为在对象的可见区域上的可感知窗口的速度将在所计算的对象的切向速度中被错误地表示;以及特别是在如果对象在连续的扫描周期内相对于自主交通工具移动,两个连续扫描图像上的点不太可能表示对象上的相同表面的情况下。
102.然而,自主交通工具可以执行方法s100的块,以基于包含在第一扫描图像中表示对象的点组中的测距值、方位角和径向速度数据,导出在第一扫描周期期间对象的切向速度和角速度之间的第一关系(或“相关性”)。然后,自主交通工具可以:在第二扫描周期期间重复该过程,以基于包含在第二扫描图像中表示该对象的点组中的测距值、方位角和径向速度数据,计算在第二扫描周期期间该对象的切向速度和角速度之间的第二关系;并导出与第一关系和第二关系相一致的对象的具体切向速度和具体角速度(或其窄范围)。
103.13.2第一扫描周期
104.在图2所示的一个实现中,自主交通工具上的传感器在第一时间t0执行第一扫描周期并且返回第一扫描图像,该第一扫描图像包含在自主交通工具周围的整个场中的一群点(例如,小的表面、区域)的径向速度、距离和角位置。然后,自主交通工具:实现上述方法和技术以识别与场中的离散对象相对应的点组(或“点集群”);并基于该组中的点的径向速度的集中趋势的度量来计算对象在t0的径向速度v
rad,0
。例如,自主交通工具可以将该集中趋势的度量计算为该组中的点的径向速度的算数平均值。类似地,自主交通工具可以基于(例如,等于)该组中的点的最大和最小方位角位置之间的差(即该点组的径向长度)计算对象在t0的第一半径r0。
105.然后,自主交通工具:基于在t0的这些点的测距值和角位置,计算该组中的点相对于自主交通工具(例如,在极坐标系内)的位置;并计算出这些点的角位置和径向速度之间的相关性。在一个示例中,自主交通工具将这种相关性计算为通过这些径向速度除以点和该点组的平均位置之间的角度的余弦、以及除以点和该点组的平均位置之间的角度的正弦的最佳拟合(或“趋势”)线的斜率。
106.自主交通工具然后计算该最佳拟合线的第一斜率s0,其表示对象在t0的切向速度v
tan,0
和角速度ω0之间的关系。特别地,该斜率s0可以表示在时间t0,在传感器的视场中,v
tan,0
与ω0乘以对象的第一半径r0的乘积之间的差。因此,自主交通工具可以基于在时间t0的斜率s0和半径r0生成将对象的v
tan,0
和ω0关联起来的第一函数(例如,线性函数)f0。
107.基于函数f0,自主交通工具然后可以计算线l0,其表示在给定对象在t0的当前径向速度v
rad,0
的情况下,对象在时间t0的可能的v
tan,0
和ω0运动组合。
108.在类似的实现中,自主交通工具求解对象在三个自由度中的运动,其包括:沿着传感器和对象之间的射线在径向方向(即径向速度)上的线性运动;在与径向方向正交的切线方向上并且在水平面内的线性运动;以及围绕与径向和切向方向正交的轴在偏航方向上的角运动。在该实现中,自主交通工具可以:将表示对象的第一点组中的点的第一径向速度与第一方位角位置投射到水平面(即,大致平行于道路表面的2d空间)上;基于第一点组中的点的第一方位角位置的范围,计算对象在第一时间的第一半径;基于第一点组中的点的第一径向速度的集中趋势的第一度量(例如,平均值),计算对象在第一时间相对于自主交通工具的第一径向速度;计算通过第一点组中的点的第一径向速度与第一方位角位置的第一线性趋势线;以及基于第一线性趋势线的第一斜率计算第一相关性,该第一斜率表示在第一时间对象的第一切向速度和对象的第一角速度之间的关系。特别地,第一斜率可以表示以下两项之差:对象在第一时间的第一切向速度;和对象在第一时间的第一半径与对象在第一时间的第一角速度的乘积。然后,自主交通工具可以基于第一时间的第一斜率和第一半径计算第一线性函数,该第一线性函数将相对于自主交通工具的对象在第一时间的可能的切向速度和对象在第一时间的可能的角速度关联起来(例如,可能的切向速度和角速度满足关系式:s0=v
tan,0-r0ω0)。更具体地说,该第一函数可以将在大致平行于道路表面的水平面内的在第一时间的对象的可能的切向速度和对象的可能的角速度关联起来。
109.因此,自主交通工具可以将对象的可能的v
tan,0
和ω0运动组合的2d表面(先前仅由上述基于地面的对象的最大速度假设界定)压缩为对象在时间t0的可能的v
tan,0
和ω0运动组合的1d线。更具体地说,自主交通工具因此可以将在2d空间中移动的对象的三个未知特性(即v
rad,0
、v
tan,0
、ω0)减少到单一的未知特性——也就是说,由于l0上的v
tan,0
和ω0的所有组合解析在t0的所测量的对象的径向速度,所以沿着线l0的点表示对象在t0的真正的v
tan,0
和ω0。
110.13.3 界定
111.在该实现中,自主交通工具还可以:计算v
tan,0
和ω0值的范围,该范围与v
rad,0
组合产生等于或小于上述的最大对象速度假设的最大总速度;以及将线l0界定到v
tan,0
和ω0值的该范围。自主交通工具可以附加地或替代地将线l0界定到上述的基于地面的对象的最大切向速度和角速度假设,如图2所示。
112.然后,在给定对象在时间t0的v
rad,0
和在所界定的线l0上表示的v
tan,0
和ω0运动组合的范围的情况下,自主交通工具可以计算对象在t0处相对于自主交通工具的可能的总速度的范围。附加地或替代地,自主交通工具可以将其在t0的绝对速度与对象的v
rad,0
和在该所限定的线l0上表示的v
tan,0
和ω0运动组合的范围合并,以计算对象在t0的可能的绝对速度的范围。
113.13.4第一扫描周期后的未来状态边界
114.自主交通工具然后可以:实现上述方法和技术,以基于对象的这些可能的相对或绝对速度和最大对象加速度假设来计算对象的未来状态边界;并如上所述相应地选择性地修改其轨迹。
115.例如,在块s110和s112中,自主交通工具可以实现上述方法和技术,以:访问由布
置在自主交通工具上的第二传感器在大约第一时间捕获的场的第二图像;基于从第二图像中提取的特征集合来解释在第一时间由自主交通工具占用的道路表面的类型;基于该特征集合预测道路表面的质量;基于道路表面的类型和道路表面的质量,估计自主交通工具的轮胎在道路表面上作用的摩擦系数;基于自主交通工具在第一时间的自主交通工具速度、摩擦系数和所存储的用于自主交通工具的制动模型,估计自主交通工具在第一时间的停止持续时间;并计算从第一时间偏移停止持续时间的临界时间。
116.在该示例中,在块s102中,自主交通工具还可以访问预定义的运动限制假设的集合,诸如包括:通用的基于地面的对象的最大线加速度;通用的基于地面的对象的最大线速度;和/或通用的基于地面的对象的最大角速度。
117.此外,在块s122中,自主交通工具可以:基于第一点组中的点的第一测距值和第一方位角位置,导出对象在第一时间的第一位置;然后基于a)由第一函数定义的在第一时间对象的可能的切向速度和对象的可能的角速度;第一径向速度,b)第一位置,和c)预定义的运动限制假设的集合,来计算自主交通工具的第一未来状态边界。更具体地说,自主交通工具可以通过以下方式计算对象从第一时间到临界未来时间可进入的第一地面区域:从对象的第一位置在停止持续时间内将对象在第一时间的径向速度以及可能的切向速度和角速度对(或“第一运动”)进行积分——对象以高达最大角速度移动并根据由预定义的运动限制假设定义的最大线加速度而加速到最大线速度。自主交通工具然后可以将该第一地面区域存储为该对象针对第一时间的未来状态边界。
118.13.5第二扫描周期
119.然后,自主交通工具可以基于由传感器在下一扫描周期期间输出的点的径向速度、距离和角位置的下一集合来重复前述过程。
120.特别地,在第二时间t1,传感器执行第二扫描周期并返回第二扫描图像,该第二扫描图像包含在自主交通工具周围的整个场中的一群点的径向速度、距离和角位置。然后,自主交通工具实现上述方法和技术,以:识别与场中的离散对象相对应的点组;以及从第一扫描周期跟踪表示对象的点组到在该第二扫描周期中表示对象的对应的点组。
121.自主交通工具然后重复上述过程,以:计算该组中的点的径向速度的中心度量(central measure);将该中心度量存储为对象在时间t1的径向速度v
rad,1
;针对这些数据计算第二斜率s1,其表示对象在时间t1处的切向速度v
tan,1
和角速度ω1之间的关系。例如,该斜率s1可以表示以下两项之差:v
tan,1
;和对象在t1处的ω1乘以在时间t1处相对于自主交通工具的对象位置的第一半径r1的乘积。因此,自主交通工具可以计算在t1处表示对象的点组的位置的集中趋势的度量的半径r1,并且基于时间t1处的斜率s1和半径r1生成将v
tan,1
和ω1关联起来的第二函数(例如,线性函数)f1。
122.基于函数f1,然后自主交通工具可以计算线l1,其表示在给定对象在t1处的当前径向速度v
rad,1
的情况下,对象在时间t1处的可能的v
tan,1
和ω1运动组合。
123.随后,自主交通工具可以计算线l0和l1(或函数f0和f1)的交集,其表示对象在t1处的实际v
tan,1
和ω1(或其非常接近的值),如图2所示。因此,从t0处的第一扫描周期到随后的t1处的扫描周期,自主交通工具可以求出对象在t1处的所有三个未知运动特性——包括v
tan,1
、ω1和v
rad,1

124.然后,在给定在线l0和l1的交集处表示的v
rad,1
、v
tan,1
和w1的情况下,自主交通工具
可以计算对象在t1处相对于自主交通工具的总速度v
tot,rel,1
。附加地或替代地,自主交通工具可以将其在t1处的绝对速度与对象的v
rad,1
、v
tan,1
和w1合并,以计算对象在t1处的总绝对速度v
tot,abs,1

125.因此,在前述实现中,自主交通工具可以:将表示对象的第二点组中点的第二径向速度与第二方位角位置投射到水平面(即,大致平行于道路表面的2d空间)上;基于第二点组中的点的第二方位角位置的范围,计算对象在第二时间处的第二半径;基于第二点组中的点的第二径向速度的集中趋势的第二度量(例如,平均值),计算对象在第二时间相对于自主交通工具的第二径向速度;计算通过第二点组中的点的第二径向速度与第二方位角位置的第二线性趋势线;以及基于第二线性趋势线的第二斜率计算第二相关性,该第二斜率表示在第二时间对象的第二切向速度和对象的第二角速度之间的关系。特别地,第二斜率可以表示以下项之差:对象在第二时间处的第二切向速度;和对象在第二时间处的第二半径与对象在第二时间处的第二角速度的乘积。然后,自主交通工具可以基于第二时间处的第二斜率和第二半径计算第二线性函数,该第二线性函数将相对于自主交通工具的对象在第二时间处的可能的切向速度和对象在第二时间处的可能的角速度关联起来(例如,可能的切向速度和角速度满足关系式:s1=v
tan,1-r1ω1)。更具体地说,该第二函数可以将在大致平行于道路表面的水平面内的第二时间处的对象的可能的切向速度和对象的可能的角速度关联起来。
126.然后,自主交通工具可以基于在三个自由度的状态空间中的第一函数和第二函数的交集,估计第二时间处相对于自主交通工具的对象的具体第二切向速度和对象的具体第二角速度(或对象的可能的切向运动和角运动的窄的范围,如下所述)。此外,自主交通工具可以执行上述方法和技术,以在块s126中,基于第二时间处的对象的第二切向速度、对象的第二角速度、对象的第二径向速度和对象的绝对速度来计算对象在第二时间处相对于自主交通工具的总绝对速度。
127.自主交通工具然后可以:实现上述方法和技术,以基于对象的这些可能的相对或绝对速度和最大对象加速度假设来计算对象的未来状态边界;并如上所述相应地选择性地修改其轨迹。
128.13.6累积误差
129.在该变型中,对象相对于自主交通工具的切向速度v
tan
和角速度ω可以在t0处的第一扫描周期和t1处的第二扫描周期之间改变,到时间t1时,这可能会在线l0中产生(额外的)误差。该误差的大小可能与t0和t1之间的时间偏移有关,并且因此可以是传感器的采样率的函数。
130.因此,自主交通工具可以诸如基于上述对象的运动限制假设,在从t0到t1的时间偏移内将对象的切向速度v
tan
和角速度ω的最大和最小变化进行积分,以计算在线l0的每一侧的误差棒(例如,误差棒l
0,error,low
和l
0,error,high
)。然后,如图2所示,自主交通工具可以计算l1与误差棒l
0,error,low
和l
0,error,high
之间的区域的交集,从而缩小对象在t1处的可能的v
tan,1
和ω1值的范围,同时考虑由于从时间t0到时间t1对象相对于自主交通工具的运动而导致的可能的累积误差。
131.然后,在给定v
rad,1
以及被表示在由线l0的误差棒所界定的线l1上的v
tan,1
和ω1运动组合的范围的情况下,自主交通工具可以计算对象在t1处相对于自主交通工具的可能的
总速度的范围。附加地或替代地,自主交通工具可以将其在t1处的绝对速度与v
rad,1
和在该被界定的线l1上表示的v
tan,1
和ω1运动组合的范围合并,以计算对象在t1处的可能的绝对速度的范围。
132.例如,在块s126中,自主交通工具可以基于上述预定义的运动限制假设的集合在第一时间和第二时间之间的时间差上的积分来表征第一函数的第一误差——即,对象从第一时间到第二时间的最坏情况的运动变化。如上所述,自主交通工具可以:基于第一相关性计算第一线,该第一线将在第一时间处相对于自主交通工具的对象的可能的切向速度与对象的可能的角速度关联起来;基于第一误差计算第一线的第一宽度;并且在第一扫描周期期间的第一函数中表示第一线和第一线的第一宽度。因此,第一函数可以表示包含在第一时间处的对象的第一切向速度和对象的第一角速度的可能的组合的二维椭圆。
133.在第二扫描周期期间,自主交通工具可类似地基于第二相关性计算第二线,该第二线将在第二时间处相对于自主交通工具的对象的可能的切向速度和对象的可能的角速度关联起来。然后,自主交通工具可以基于第一宽度的第一线和第二线的交集,估计在第二时间相对于自主交通工具的对象的切向速度的第二范围和对象的角速度的第二范围。
134.13.7最佳拟合误差
135.在图5所示的类似实现中,自主交通工具可以:计算通过从第一扫描图像导出的第一点组中的点的第一径向速度与第一方位角位置的第一线性趋势线;基于该第一线性趋势线的第一斜率,计算第一时间处的对象的第一切向速度与对象的第一角速度之间的第一相关性;在块s126中,基于第一点组中的点的第一径向速度与第一线性趋势线的偏差来表征第一线性趋势线的第一误差;基于第一相关性计算第一线,该第一线将在第一时间处相对于自主交通工具的对象的可能切向速度和对象的可能角速度关联起来;基于第一误差计算第一线的第一宽度;以及在第一函数中表示第一线和第一线的第一宽度。例如,自主交通工具可以计算第一误差(以及因此计算第一线的宽度),该第一误差与从组中的每个点到第一线性趋势线的最小距离的平方和的平方根成比例。因此,第一函数可以表示包含在第一时间处的对象的第一切向速度和第一角速度的可能的组合的二维椭圆。
136.自主交通工具可以类似地:计算通过第二点组中的点的第二径向速度与第二方位角位置的第二线性趋势线;并基于该第二线性趋势线的第二斜率,计算第二时间处的对象的第二切向速度与对象的第二角速度之间的第二相关性;基于第二点组中的点的第二径向速度与第二线性趋势线的偏差来表征第二线性趋势线的第二误差;基于第二相关性计算第二线,该第二线将第二时间处相对于自主交通工具的对象的可能切向速度和对象的可能角速度关联起来;基于第一误差计算第一线的第一宽度;以及在第二函数中表示第二线和第二线的第二宽度。因此,第二函数可以表示包含在第二时间处的对象的第二切向速度和第二角速度的可能的组合的二维椭圆。
137.相应地,自主交通工具可以基于第一宽度的第一线与第二宽度的第二线的交集,估计在第二时间相对于自主交通工具的对象的切向速度的第二范围和对象的角速度的第二范围。尽管自主交通工具可能无法解析对象在第二时间处的具体切向速度和角速度,但自主交通工具可以基于第一函数和第二函数的交集计算对象在第二时间处的可能的切向速度和角速度的范围,该范围比从描述对象的单个扫描图像中导出的对象的可能的切向速度和角速度的范围窄得多。
138.13.8第二扫描周期后的未来状态边界
139.自主交通工具然后可以:实现上述方法和技术,以基于对象的这些可能的相对或绝对速度和预定义的运动限制假设来计算对象的未来状态边界;并如上所述相应地选择性地修改其轨迹。
140.例如,在块s112中计算临界时间之后,自主交通工具可以在停止持续时间内从对象的第二位置,对对象在第二时间处的第二运动——以高达最大角速度移动并根据预定义的运动限制假设规定的最大线加速度而加速到最大线速度——进行积分,以计算从第二时间到临界时间对象可进入的第二地面区域;并且将该第二地面区域存储为针对对象在第二时间处的第二未来状态边界,该第二未来状态边界的尺寸(例如,在大致平行于道路表面的水平面中的面积)(显著)小于对象的第一未来状态边界的尺寸。
141.特别地,因为自主交通工具将由第一函数表示的对象的宽范围的可能的切向速度和角速度组合(仅由预定义的运动限制假设界定)压缩为在第一函数和第二函数的交集处的对象的一个或小范围的可能的切向速度和角速度组合,所以自主交通工具还可以计算对象从第一扫描周期到第二扫描周期的较小的未来状态边界,并因此预测较大的进入区,自主交通工具可以在该进入区中操作直到临界时间,而不会牺牲在与附近的其他对象碰撞之前达到完全停止的能力。
142.13.9对象运动处理
143.然后,如上所述,在块s140中,自主交通工具可以选择第二导航动作以避免在临界时间之前进入到第二未来状态边界中。
144.例如,自主交通工具可以实现上述方法和技术,以:在块s144中,计算在自主交通工具周围的不包括对象的第一未来状态边界的进入区;然后响应于自主交通工具在第二时间处的位置落在对象的当前未来状态边界的周界的阈值距离(例如,两米;以自主交通工具的当前速度在500毫秒内穿越的距离)内,执行第一导航动作以朝向进入区导航(例如,以改变自主交通工具的轨迹)。附加地或替代地,自主交通工具可以响应于自主交通工具在第二时间处的位置落在对象的当前未来状态边界的周界的阈值内,自动执行制动动作以使自主交通工具减速。相反,如果自主交通工具的当前位置落在对象的第二未来状态边界之外,则自主交通工具可以维持其当前轨迹(例如,速度(velocity);速度(speed)和转向角),或者在第二扫描周期期间以其他方式使对象消隐而不纳入路径规划考虑。
145.13.10后续扫描周期
146.自主交通工具然后可以重复上述方法和技术以:基于在由传感器在第三时间t2输出的第三扫描图像中跟踪的点组(与同一对象相关联)的平均径向速度v
rad,2
、斜率s2和半径r2,计算第三函数f2;基于函数f2,计算第三线l2;然后计算第一线l0(具有基于从t0到t2的时间偏移的误差棒)、第二线l1(具有基于从t1到t2的时间偏移的误差棒)以及第三线l2的交集,其表示对象在t2处可能的v
tan,2
和ω2值。
147.替代地,在该第三扫描周期期间,自主交通工具可以:丢弃线l0;并计算第二线l1(具有基于从t1到t2的时间偏移的误差棒)与第三线l2的交集,其表示对象在t2处可能的v
tan,2
和ω2值。
148.如上所述,自主交通工具然后可以:基于该多路交集(例如双路、三路等交集)计算对象在t2处的可能的v
tan,2
和ω2值的范围;计算对象在t2处可能的相对或绝对速度;相应地
更新对象的未来状态边界;并如上所述相应地选择性地修改其轨迹。
149.13.11按对象进行点分组和解组(ungroup)
150.如上所述,自主交通工具可以按接近度对扫描图像中的点进行分组,诸如包括相似的测距值、方位角、仰角值以及相似的径向速度。对于在第一扫描图像中检测到的每一个点组,自主交通工具可以计算表示该点组所代表的对象的线性运动和角运动的函数。然后,自主交通工具可以:针对后续扫描图像重复该过程;实现对象跟踪技术,以将第一扫描图像中的点组与第二扫描图像中的点组链接起来;以及基于针对从第一和第二扫描图像导出的这些点组的第一函数和第二函数对的交集来细化针对每个对象的运动预测。
151.如果在第二扫描图像中检测到的两个对象的所导出的运动是一致的(例如,如果它们的径向速度、切向速度和角速度非常相似或相同),诸如如果它们的运动落在预定义的速度判别(discrimination)阈值内,则自主交通工具还可以将它们聚类成一个“复合对象”(或“刚体”)。然后,自主交通工具可以计算针对该复合对象的一个未来状态边界,并相应地相对于该复合对象进行选择性地导航。因此,自主交通工具可以将在一致运动内的多个点组解释并处理为单一对象,从而减少自主交通工具正在跟踪的离散对象的数量,并因此减少自主交通工具在运行期间的计算负荷。
152.类似地,所述自主交通工具可以:将第一扫描图像中被预测为表示在第一时间处的一个对象的第一点组的分离解释为第二扫描图像中被预测为表示在第二时间处的两个不同对象的第二点组和第三点组;为第二对象和第三对象生成唯一函数;以及基于在第一和第二扫描周期内所导出的函数来估计第二对象和第三对象的运动。
153.在一个示例实现中,自主交通工具实现上述方法和技术,以在第一时间捕获的第一扫描图像中识别第一点组,并导出表示对象在第一扫描周期期间的运动的第一函数。在第二扫描周期期间,自主交通工具可以:访问第二扫描图像,该第二扫描图像包含传感器在继第一时间之后的第二时间处捕获的数据;在第二扫描图像中识别表示场中的所述对象的第二点组;在第二扫描图像中识别表示场中的第二对象的第三点组,第二对象从第一时间到第二时间与所述对象分离;计算第二点组中的点的第二径向速度和第二方位角位置之间的第二相关性;计算第三点组中的点的第三径向速度和第三方位角位置之间的第三相关性;基于第二相关性,计算第二函数,该第二函数将第二时间处的对象的可能的切向速度和对象的可能的角速度关联起来;并且,基于第三相关性,计算第三函数,该第三函数将第二时间处的第二对象的可能的切向速度和第二对象的可能的角速度关联起来。因此,如上所述,自主交通工具可以基于第一函数和第二函数的交集估计在第二时间相对于自主交通工具的对象的第二切向速度和对象的第二角速度。然而,自主交通工具还可以:基于表示对象在第一时间处的运动的第一函数与表示第二对象在第二时间处的运动的第三函数的交集,估计在第二时间相对于自主交通工具的第二对象的第三切向速度和第二对象的第三角速度。
154.例如,自主交通工具可以实现前述过程以:在第一时间检测表示在与自主交通工具相邻的两条车道上以相同方向和速度行驶的两辆车的两个点组;表征这些对象的运动;并将这两个对象作为一个复合组进行跟踪和响应,该复合组反映这些对象在第一时间的一致运动。然后,自主交通工具可以:在第二时间检测相对于彼此移动的两个对象,诸如,如果这些交通工具中的一个相对于另一个制动并减速;将复合对象分离为两个对象;然后独立
地跟踪和响应这两个对象——它们现在呈现超过速度判别阈值的不同运动。
155.13.12来自多个传感器的并发数据
156.在一个变型中,自主交通工具包括多个偏移传感器,该多个偏移传感器在扫描周期期间输出并发点云,其以不同的视角表示在自主交通工具周围的场中的表面。在该变型中,自主交通工具可以执行前述方法和技术以:对于表示在一个扫描周期间由这些传感器输出的并发点云中的单一对象的同空间的对象组,计算一对函数和线;计算这些线的交集;并基于该交集估计对象的切向速度和角速度。
157.例如,自主交通工具可以:在由自主交通工具上的第一传感器在第一时间t0处输出的第一点云中识别表示离散对象的第一点组;计算该第一组中点的径向速度的平均值;将该平均值存储为对象在第一时间处的第一径向速度v
rad,1,0
;基于该第一点组在第一时间的径向速度v
rad,1,0
、斜率slope s
1,0
和半径r
1,0
,计算第一函数f
1,0
;以及基于函数f
1,0
,计算第一线l
1,0
。自主交通工具可以类似地:在由自主交通工具上的第二传感器在第一时间t0输出的第二点云中识别表示该相同对象的第二点组;计算该第二组中的点的径向速度的平均值;将该平均值存储为对象在第一时间的第二径向速度v
rad,2,0
;基于该第二点组在第一时间的径向速度v
rad,2,0
、斜率s
2,0
以及半径r
2,0
,计算第二函数f
2,0
;以及基于函数f
2,0
,计算第二线l
2,0

158.然后,自主交通工具可以计算第一线l
1,0
与第二线l
2,0
的交集,其表示对象在时间t0处的实际v
tan,0
和ω0(或其非常接近的值)。因此,自主交通工具可以基于由这两个传感器在单个扫描周期期间输出的数据求出对象在t0处的所有三个未知运动特性——包括v
tan,0
、ω0和v
rad,0

159.然后,在给定在线l
1,0
和l
2,0
的交集处表示的v
rad,0
、v
tan,0
和ω0的情况下,自主交通工具可以计算对象在t0处相对于自主交通工具的总速度v
tot,rel,0
。附加地或替代地,自主交通工具可以将其在t0处的绝对速度与对象的v
rad,0
、v
tan,0
和ω0合并,以计算对象在t0处的总绝对速度v
tot,abs,0

160.自主交通工具然后可以:实现上述方法和技术,以基于对象的这些可能的相对或绝对速度和最大对象加速度假设来计算对象的未来状态边界;并如上所述相应地选择性地修改其轨迹。
161.此外,所述自主交通工具可以:检测在由自主交通工具上的两个传感器在第一扫描周期期间捕获的两个并发扫描图像中所描绘的对象;从两个扫描图像中导出描述该对象的运动的第一函数和第二函数;以及将这些第一函数和第二函数融合成对象在该第一扫描周期期间的一个运动估计。并发地,自主交通工具可以:检测仅在这两个扫描图像中的第一扫描图像中描绘(例如,由于遮挡而对这些传感器中的一个的视场不可见;或者由于两个传感器的视场不同)的第二对象;以及从第一扫描图像导出描述该第二对象在第一扫描周期期间的运动的第三函数。然后,如上所述,在下一扫描周期期间,自主交通工具可以:检测仅在第三扫描图像中描绘的第二对象;从第三扫描图像导出描述该第二对象的运动的第四函数;以及将这些第三函数和第四函数融合成第二对象在第二扫描周期期间的一个运动估计。
162.因此,自主交通工具可以实现方法s100的前述块,以基于在单一扫描周期期间捕获的并发扫描图像和在多个扫描周期内捕获的扫描图像序列两者来表征一群对象的运动。
163.14.6dof
164.图3a、图3b和图3c所示的方法s100的一个变型包括:通过在第一时间捕获的第一扫描图像中表示对象的第一点组中的点的第一径向速度、第一方位角位置和第一仰角位置来计算第一最佳拟合平面;通过在第二时间捕获的第二扫描图像中表示该对象的第二点组中的点的第二径向速度、第二方位角位置和第二仰角位置来计算第二最佳拟合平面;以及通过在第三时间捕获的第三扫描图像中表示该对象的第三点组中的点的第三径向速度、第三方位角位置和第三仰角位置来计算第三最佳配合平面。
165.特别地,第一最佳拟合平面表示在第一时间对象的第一切向速度(例如,切向方位角速度和切向仰角速度的复合切向速度)、对象的第一偏航速度和对象的第一俯仰速度之间的关系。相应地,自主交通工具可以基于第一最佳拟合平面生成第一函数,该第一函数表示在第一时间可能的切向方位角速度与偏航速度之间的第一关系(例如,相关性)和可能的切向仰角速度与俯仰速度之间的第二关系。
166.类似地,第二最佳拟合平面表示在第二时间对象的第二切向速度、对象的第二偏航速度和对象的第二俯仰速度之间的关系。相应地,自主交通工具可以基于第二最佳拟合平面生成第二函数,该第二函数表示在第二时间可能的切向方位角速度与偏航速度之间的第一关系(例如,相关性)和可能的切向仰角速度与俯仰速度之间的第二关系。
167.类似地,第三最佳拟合平面表示在第一时间对象的第三切向速度、对象的第三偏航速度和对象的第三俯仰速度之间的关系。相应地,自主交通工具可以基于第一最佳拟合平面生成第三函数,该第三函数表示在第三时间可能的切向方位角速度与偏航速度之间的第一关系和可能的切向仰角速度与俯仰速度之间的第三关系。
168.在该变型中,方法s100还包括在块s124中基于第一函数、第二函数和第三函数的交集,计算在第三时间对象的第三切向速度(或单独的切向方位角速度和切向仰角速度)、对象的第三偏航速度和对象的第三俯仰速度。
169.14.1 3dof相对6dof
170.通常,上述方法s100可由自主交通工具执行,以表征对象在三个自由度(或“3dof”)中的运动。然而,在这种变型中,自主交通工具可以实现类似的方法和技术来表征对象在六个自由度(或“6dof”)中的运动。
171.特别地,当如上所述地表征对象在三个自由度中的运动时,自主交通工具可以解释:对象在水平平面内的径向方向和切向方向上的线性运动;以及仅围绕垂直于该水平面的偏航轴的旋转运动。相反,当如上所述地表征对象在六个自由度中的运动时,自主交通工具可以解释:对象在径向方向、切向方位角方向(例如,平行于传感器的扫描方向)和切向仰角方向(例如,正交于径向方向和切向方位角方向)上的线性运动;以及围绕沿切向方位角方向的俯仰轴的旋转运动和围绕沿切向仰角方向的偏航轴的旋转运动。
172.此外,对象围绕从传感器延伸到对象的射线的旋转(即,“横滚”运动)在单个扫描图像内可能不被传感器观察到。然而,如果对象的对象的横滚运动与该射线不是同轴的,则存储在由传感器捕获的连续扫描图像(或由两个偏移传感器捕获的并发扫描图像)中的点中的径向速度可以包含与对象的横滚速度相关的信息,并且自主交通工具因此可以融合多个扫描图像中表示图像的点组,以进一步对对象相对于自主交通工具的横滚速度进行消歧。
173.此外,许多(例如,大多数)基于地面的移动对象(诸如道路交通工具和行人的主体)可以呈现最小俯仰速度或没有俯仰速度,并且没有切向仰角速度(例如,可能不在水平道路表面上以外的任何方向上移动)。因此,对象的切向仰角速度和俯仰速度可以是(或可以接近)空(null)。因此,通过三维空间中的点组的最佳拟合平面坍缩为二维空间中的最佳拟合线,并且根据方法s100的这种变型对此类对象在六个自由度中的运动的推导坍缩为如上所述对对象在三个自由度中的运动的推导。
174.然而,在道路表面上和靠近道路表面的一些对象可能相对于自主交通工具呈现非零的切向仰角速度和俯仰速度,诸如车轮、混凝土搅拌机和街道清扫机。类似地,沿斜坡移动的交通工具可能相对于自主交通工具呈现非零的切向仰角速度和俯仰速度。这样的对象的切向仰角速度和俯仰速度被包含在扫描图像中表示该对象的点的径向速度数据中,但从被包含在单个扫描图像中的径向速度数据来看,它们是不确定的。因此,自主交通工具可以融合从以不同视角描绘对象的多个扫描图像(即,当自主交通工具和对象相对于彼此移动时)中导出的对象的切向方位角速度、切向仰角速度、偏航速度和俯仰速度之间的关系,以计算对象的可能的切向方位角速度、切向仰角速度、偏航速度和俯仰速度的特定范围或窄的范围。
175.14.2示例
176.例如,自主交通工具可以:实现上述方法和技术以在第一扫描图像中分离出表示对象的点组;并且基于在这些点中包含的速度(即径向速度)范围、方位角和仰角值,将这些点投射到三维空间(即径向速度、方位角和仰角空间)中。然后,自主交通工具可以:基于第一点组中的点的第一径向速度的集中趋势的第一度量(例如,平均值),计算在第一时间对象相对于自主交通工具的第一径向速度;基于第一点组中的点的第一方位角和仰角位置的集中趋势的第一度量(例如,平均值),计算在第一时间对象相对于自主交通工具的第一位置;以及计算从对象的第一位置返回到自主交通工具的第一径向矢量。
177.此外,自主交通工具可以:计算通过第一点组中的点的第一径向速度与第一方位角位置的第一线性方位角趋势线;以及基于该第一线性方位角趋势线的第一斜率计算第一相关性,该第一相关性表示在第一时间处对象的第一切向方位角速度与对象的第一偏航速度之间的关系。特别地,第一斜率可以表示以下项之间的第一差:对象在第一切向方向(例如,切向方位角方向)上的切向速度;以及对象的径向矢量和对象的偏航速度(例如,俯仰速度)之间的交叉乘积(cross product)在第一切向方向上的投影。
178.自主交通工具可以类似地计算通过第一点组中的点的第一径向速度与第一仰角位置的第一线性仰角趋势线;基于第二线性趋势线的第二斜率计算第二相关性,该第二相关性表示在第一时间处对象的第一切向仰角速度和对象的第一俯仰速度之间的关系。特别地,第二斜率可以表示以下项之间的第二差:对象在第二切向方向(例如,切向仰角方向)上的切向速度;以及对象的径向矢量和对象的偏航速度之间的交叉乘积在第一切向方向上的投影。
179.因此,第一线性方位角和仰角趋势线可以表示针对第一组中的点在三维径向速度、方位角和仰角空间中绘制的第一最佳拟合平面,如图3a所示。
180.自主交通工具然后可以基于第一斜率、第二斜率和表示对象在第一时间的相对位置的第一径向矢量来计算第一函数,该第一函数将对象在第一时间的可能的切向方位角速
度、切向仰角速度、偏航速度和俯仰速度关联起来。更具体地说,该第一函数可以在第一时间将对象的可能的切向方位角速度与对象的可能的偏航速度关联,并且将对象的可能的切向仰角速度与对象的可能的俯仰速度关联。
181.替代地,自主交通工具可以:直接计算针对第一组中的点的第一最佳拟合平面,而不是独立计算第一线性方位角和仰角趋势线;和/或基于任何其他方向上的切向速度导出第一函数。例如,自主交通工具可以执行图7所示的过程,以导出将对象的观测值(即,表示对象的点的方位角、仰角和测距值位置以及径向速度)与对象在六个自由度中的运动状态关联起来的函数。
182.然后,自主交通工具可以对随后的扫描图像重复该过程,以生成表示对象的切向运动和角运动的可能的组合的函数序列,如图3a所示。然后,自主交通工具可以计算从三个连续的扫描图像导出的三个函数在六个自由度状态空间中的交集,以计算对象的可能的径向速度、切向方位角速度、切向仰角速度、偏航速度、俯仰速度和横滚速度的特定范围或窄的范围。
183.因此,自主交通工具可以将对象的这些切向方位角速度、切向仰角速度、偏航速度和俯仰速度与从当前扫描图像导出的对象的径向速度融合,以计算对象相对于自主交通工具在所有六个自由度中的总速度,如图3c所示。
184.14.3最佳拟合误差
185.在该变型中,自主交通工具可以实现与上述的那些方法和技术类似的方法和技术,以计算最佳拟合平面的宽度(或“厚度”)。例如,自主交通工具可以针对扫描图像计算每个最佳拟合平面的误差,该误差与从组中的每个点到最佳拟合平面的最小距离(在三维中)的平方和的平方根成比例。自主交通工具然后可以基于该误差计算该平面的厚度,或者以其他方式在为该对象所计算的相应函数中表示该误差。因此,该函数可以表示三维椭圆体,该椭圆体包含对象在扫描周期期间的切向速度、偏航速度和俯仰速度的可能的组合。
186.在这个示例中,自主交通工具然后可以计算三个连续(加厚的)函数的交集,以计算对象在当前时间的可能的径向速度、切向方位角速度、切向仰角速度、偏航速度、俯仰速度和横滚速度的窄的范围。然后,自主交通工具可以实现上述方法和技术以:基于对象在六个自由度中的运动,计算对象的未来状态边界并选择性地对其做出反应——对象在六个自由度中的运动包括:该窄的范围的可能的切向方位角速度、切向仰角速度、偏航速度、俯仰速度和横滚速度;所测量的对象的径向速度。
187.14.4累积误差
188.附加地或替代地,在三个连续扫描周期上计算出第一函数、第二函数和第三函数之后,自主交通工具可以:计算在第一函数和第二函数的交集处表示的对象的可能的切向方位角速度、切向仰角速度、偏航速度、俯仰速度和横滚速度的第一集合;计算与这些可能的切向方位角速度、切向仰角速度、偏航速度、俯仰速度和横滚速度以及预定义的运动限制假设的集合相一致的对象的最坏情况的运动;在从第一扫描周期到第三扫描周期的一段时间内对对象的该最坏情况的运动进行积分;并将该值存储为第一最佳拟合平面的厚度以及由此作为由第一函数表示的误差。因此,第一函数可以表示三维椭圆体,该椭圆体包含对象在第一扫描周期期间的切向速度、偏航速度和俯仰速度的可能的组合。
189.类似地,自主交通工具可以:计算由第二函数表示的对象的可能的切向方位角速
度、切向仰角速度、偏航速度和俯仰速度的第二集合;计算与这些可能的切向方位角速度、切向仰角速度、偏航速度和俯仰速度以及预定义的运动限制假设的集合相一致的对象的最坏情况的运动;在从第二扫描周期到第三扫描周期的一段时间内对对象的该最坏情况的运动进行积分;并将该值存储为第二最佳拟合平面的厚度以及由此作为由第二函数表示的误差。因此,第二函数可以表示三维椭圆体,该椭圆体包含对象在第二扫描周期期间的切向速度、偏航速度和俯仰速度的可能的组合。
190.在该示例中,自主交通工具然后可以计算(厚度、最大误差的)第一函数、(加厚的)第二函数和第三函数的交集,以计算对象在第三时间的可能的切向方位角速度、切向仰角速度、偏航速度、俯仰速度和横滚速度的窄的范围,如图3c所示。然后,自主交通工具可以实现上述方法和技术以:基于对象在六个自由度中的运动,计算对象的未来状态边界并选择性地对其做出反应——对象在六个自由度中的运动包括:该窄的范围的可能的切向方位角速度、切向仰角速度、偏航速度、俯仰速度和横滚速度;所测量的对象的径向速度。
191.14.5多个传感器
192.如上所述,在包括输出并发扫描图像的多个偏移传感器的自主交通工具的变型中,自主交通工具可以执行前述方法和技术以:根据描绘对象的多个并发扫描图像,计算表示该对象在六个自由度中的运动的多个函数;然后基于这些函数的交集,导出对象在六个自由度中的运动。
193.例如,自主交通工具可以针对一个对象被描绘在由自主交通工具上的三个传感器捕获的三个并发扫描图像中,生成并融合三个函数。在另一示例中,自主交通工具可以针对一个对象被描绘在由自主交通工具上的两个传感器中的每一个在两个连续扫描周期内捕获的两对扫描图像中,生成并融合两对连续的两个函数。
194.因此,自主交通工具可以实现方法s100的前述块,以基于在单一扫描周期期间捕获的并发扫描图像和在多个扫描周期内捕获的扫描图像序列两者来表征一群对象的运动。
195.14.6多个对象
196.此外,自主交通工具可以并发地执行方法的该变型的多个实例,以根据由自主交通工具捕获的多个并发或连续的扫描图像,导出多个对象在六个自由度中的运动。
197.14.7对象分割
198.在该变型的一个示例中,自主交通工具捕获描绘道路交通工具(例如,客运交通工具、卡车)的一侧的扫描图像。自主交通工具实现上述方法和技术,以基于接近度,对扫描图像中描绘该道路交通工具的点进行分组。然而,如果道路交通工具正在移动(即,如果其车轮速度非零),则道路交通工具的主体可以相对于自主交通工具呈现最小或空的切向仰角速度和俯仰速度,但是道路交通工具的车轮可能呈现非零的切向仰角速度和俯仰速度。因此,由该组中对应于道路交通工具的主体的点的第一子集所描述的径向速度可能与由该组中对应于道路交通工具的车轮的点的第二子集所描述的径向速度不一致。
199.因此,在一个实现中,自主交通工具可以基于点组上的径向速度趋势的差异来区分和分隔开点的第一子组和第二子组,如图3b所示。例如,自主交通工具可以:实现上述方法和技术,以计算通过由点组表示的径向速度、方位角位置和仰角位置的初始最佳拟合平面;并表征初始最佳拟合平面与组中的点之间的误差(例如,离初始最佳拟合平面的距离)。如果该误差高(例如,超过预定义阈值),则自主交通工具可以:检测以最大误差(例如,离最
佳拟合平面的最大距离)为特征的组中的点的第一集群;将该组点分离成包含点的第一集群的第一子组和包含剩余点的第二子组;计算通过由点的第一子组表示的径向速度、方位角位置和仰角位置的第一最佳拟合平面;表征第一最佳拟合平面与第一子组中的点之间的第一误差;类似地,计算通过由点的第二子组表示的径向速度、方位角位置和仰角位置的第二最佳拟合平面;以及表征第二最佳拟合平面与第二子组中的点之间的第二误差。自主交通工具可以重复该过程以迭代地细化第一子组和第二子组,直到点的每个子组与其对应的最佳拟合平面之间的误差小于最大误差(例如,小于预定义阈值)。
200.在该实现中,自主交通工具还可以将初始点组分割成最大数量的子组,诸如最多四个子组,该四个子组可以共同表示:客运交通工具的主体和两个车轮;铰接式客车的两个车轮和前后主体部分;街道清扫车的两个车轮、主体和清扫机元件;或者水泥车的两个车轮、主体和混凝土搅拌机元件。附加地或替代地,自主交通工具可以将初始点组分割成子组,每个子组具有至少预定义的最小数量的点(例如,100个点)。
201.更一般地,一个道路交通工具的不同元件相对于自主交通工具的切向仰角速度和俯仰速度的差(其被表示在初始组中的点的径向速度中),将在这些点与针对整个组的最佳拟合平面之间产生误差,因为该最佳拟合平面描述了道路交通工具的所有这些元件在六个自由度中的一致的运动。因此,自主交通工具可以执行前述过程以:检测并分离出表示一个道路交通工具上的不同元件的点的子组,这些不同元件相对于自主交通工具呈现不同的运动;以及计算将道路交通工具的这些不同元件在扫描周期的时间处的切向方位角速度、切向仰角速度、偏航速度和俯仰速度关联起来的函数(例如,最佳拟合平面)的集合。
202.如上所述,然后,自主交通工具可以对多个扫描图像(诸如由多个传感器捕获的并发图像的集合或由一个传感器捕获的连续扫描图像)重复该过程以:分离出表示道路交通工具上的不同元件的点的子组;导出将道路交通工具的这些元件的切向方位角速度、切向仰角速度、偏航速度和俯仰速度关联起来的附加函数集合;然后,基于针对道路交通工具的每个元件的三个函数集合的交集,导出道路交通工具的每个元件相对于自主交通工具在六个自由度中的运动。如上所述,自主交通工具还可以基于这些相对运动和自主交通工具的并发运动来计算道路交通工具的每个元件的总绝对运动。
203.14.8链接对象
204.此外,一旦自主交通工具由此导出道路交通工具的多个元件在六个自由度中的相对或绝对运动,则如果这些不同元件的线性运动是一致的,诸如如果它们的绝对或相对总线性速度落在上述的预定义速度判别阈值内,自主交通工具就可以实现类似于上述那些方法和技术的方法和技术,以将这些不同元件重新组合成一个复合对象(例如,一个“刚体”)。
205.例如,在块s126中,自主交通工具可以基于从表示由传感器捕获的三个连续扫描图像中所描绘的第一对象的点的三个子组导出的(例如,三个)函数的集合的交集,估计在当前时间相对于自主交通工具的第一对象的第一线性运动和第一对象的第一角运动。并发地,在块s126中,自主交通工具可以基于从表示这三个连续扫描图像中所描绘的第二对象的点的三个子组导出的(例如,三个)函数的集合的交集,估计在当前时间相对于自主交通工具的第二对象的第二线性运动和第二对象的第二角运动。然后,在块s160中,自主交通工具可以响应于第一对象的第一线性运动和第二对象的第二线性运动之间的对准,诸如如果第一线性运动和第二线性运动之间的差落在上述的预定义速度判别阈值内,将第一对象和
第二对象识别为对应于公共刚体,如图3b所示。
206.更具体地说,由自主交通工具在多个扫描周期上检测和跟踪的、对应于同一道路交通工具的不同元件的两个对象可能相对于自主交通工具呈现不相似的俯仰和偏航速度,但将沿着相同的路径一起移动,并因此将呈现相同(或非常相似)的线性速度。因此,自主交通工具对非常接近并呈现相同(或非常相似)的线性速度——以及可能呈现不同的偏航速度和俯仰速度——的对象进行分组,以形成表示完整的道路交通工具的一个复合对象(或一个“刚体”)。
207.14.9对象分类
208.此外,自主交通工具可以基于单独的对象的运动特性,对对象的类型进行分类。
209.在图3b所示的一个示例中,自主交通工具可以通过以下方式将对象识别为车轮:基于在表示该对象的(子)组中的点所包含的方位角位置、仰角位置和测距值,将这些点投射到三维空间中;计算对象的绝对线速度的方向;计算通过点组并平行于(即包含)对象的运动方向的垂直平面;以及计算组中的点的径向速度在垂直平面内的线速度分量。然后,在块s162中,自主交通工具可以将对象识别为车轮:如果这些点(即,表示车轮或轮胎的当前顶部的点)在垂直平面内的最大线速度大约是对象的绝对线速度的两倍(并且平行于对象的绝对线速度的方向和/或在与对象的绝对线速度的方向相同的取向上);和/或如果这些点(即,表示车轮或轮胎的当前底部的点)在垂直平面内的最小线速度大约为空。
210.在类似的示例中,自主交通工具可以通过以下方式将对象识别为车轮:计算对象的绝对线速度的方向;以及计算组中的点的径向速度的与对象的绝对运动方向平行的线速度分量。然后,在块s162中,自主交通工具可以将对象识别为车轮:如果这些点(即,表示车轮或轮胎的当前顶部的点)的——平行于对象的绝对运动方向的——最大线速度大约是对象的绝对线速度的两倍(并且平行于对象的绝对线速度的方向和/或在与对象的绝对线速度的方向相同的取向上);如果这些点(即表示车轮或轮胎的当前底部的点)的——平行于对象的绝对运动方向的——最小线速度大约为空;和/或如果组中的点的平行于对象的绝对运动方向的线速度的梯度从接近地平面的近似空增加到在对象顶部处(例如,在对象上的一点处,该点在地平面上方的高度是点组的垂直中心在地平面上方的高度的两倍)的对象的绝对线速度的大约两倍。
211.然后,响应于将复合对象内的对象识别为车轮,自主交通工具可以将该复合对象分类为轮式交通工具,如图3b所示。更具体地说,自主交通工具可以——诸如,不是实现人工智能和计算机视觉技术以基于在彩色图像中检测到的复合对象的视觉特性或从复合对象的深度图像中导出的对象的几何特性来将复合对象分类而是、或除了所述操作之外还——基于包含在复合对象中的对象的运动特性和/或相对位置,将复合对象分类为轮式交通工具。因此,通过基于简单的、预定义的、规定性的规则根据包含在复合对象中的对象的运动,而不是基于复杂的人工智能和计算机视觉技术来将复合对象分类为轮式交通工具,自主交通工具可以在更少的时间内和/或利用更少的计算负荷准确地将复合对象分类。
212.此外,在将复合对象分类为轮式交通工具后,自主交通工具可以针对轮式交通工具——而不是针对通用对象(即,针对所有可能的对象类型)——检索预定义运动限制假设,并将这些细化的预定义运动限制假设分配或标记给复合对象,如图3b所示。例如,自主交通工具可以针对轮式交通工具检索预定义运动限制假设,这些假设指定:小于摩托车和
行人的最大角速度的最大角速度,并且该最大角速度随着交通工具的地面速度而变化且与地面速度成比例地减小;以及小于摩托车的最大线加速度的最大线加速度。
213.此外,在该变型中,如果在该复合对象内被识别为车轮的对象呈现平行于该对象的线性运动方向的最大线速度,该最大线速度(远远地)大于该对象的总的绝对线速度的两倍,则自主交通工具可以检测到该复合对象的敌对运动,因为这种特性可以指示轮式交通工具正在“剥落”、“烧毁”或以其他方式失去牵引力。因此,自主交通工具可以针对呈现失去牵引力的轮式交通工具检索预定义运动限制假设,并将这些细化的预定义运动限制假设分配或标记给复合对象。例如,自主交通工具可以针对呈现失去牵引力的轮式交通工具检索预定义运动限制假设,这些运动限制假设指定了比具有牵引力的轮式交通工具更低的最大线速度和更大的最大角速度。
214.15.对象运动的不确定性的方向
215.图4所示的方法s100的一个变型包括,对于第一扫描周期:在块s104中,访问包含由自主交通工具上的传感器在第一时间捕获的数据的第一扫描图像;在块s120中,识别第一扫描图像中表示自主交通工具附近的场中的对象的第一点组,该第一点组中的每个点包括对象上的表面相对于自主交通工具的第一位置和对象的表面相对于传感器的第一径向速度;在块s122中,基于第一点组中的点的第一径向速度的集中趋势的第一度量,计算在第一时间对象相对于自主交通工具的第一径向速度;以及在块s170中,沿垂直于对象的第一径向速度的第一切线方向表征在第一时间的对象运动的不确定性的第一方向。方法s100的该变型还包括:在块s172中,基于自主交通工具在第一时间的运动,计算对象在继第一时间之后的第二时间处的运动的不确定性的所预测的第二方向;并且响应于不确定性的第二方向不同于不确定性的第一方向,在块s142中,在第二时间使对象消隐,而不纳入用于使自主交通工具避让对象的制动考虑。
216.15.1基于未来数据质量延迟碰撞避免动作
217.通常,在前述变型中,自主交通工具可能需要多个扫描周期以导出对象的特定的绝对或相对总运动,诸如两个扫描周期以导出对象在三个自由度中的总运动,或者三个扫描周期以导出对象在六个自由度中的总运动。此外,如果对象相对于自主交通工具的径向位置在这些扫描周期内保持相对一致,则由自主交通工具计算的对象在这些扫描周期内的可能的绝对或相对运动的范围可能较高,从而产生对象的真实运动的较少确定性;反之亦然。
218.因此,在该变型中,自主交通工具可以:表征对象在当前扫描周期期间的运动的不确定性的当前方向(例如,在切向方位角方向和/或切向仰角方向上);预测对象在未来(例如,下一个)扫描周期期间的运动不确定性的未来方向(例如,基于自主交通工具与对象的相对运动和通用对象的预定义运动限制假设);并比较对象的运动不确定性的当前方向和预测的未来方向,以预测自主交通工具是否将在未来改善它对对象的运动的确定性——诸如,如果对象的运动不确定性的当前方向和未来方向不平行——这可以通知用于在未来避免与对象碰撞的更准确的响应(例如,制动、转向或不采取动作)。因此,如果自主交通工具验证其当前位于如上所述的对象的未来状态边界之外,则自主交通工具可以选择在当前扫描周期期间延迟对对象的响应,因为自主交通工具预测在未来对象的运动确定性更大。
219.更具体地说,尽管当对象首次进入自主交通工具上的传感器的视野时,自主交通
工具可能具有对象的不完整运动信息,但自主交通工具可以选择延迟用于避免与对象碰撞的动作(例如,制动、改变方向),因为自主交通工具预测在未来能访问更多或更好的信息,这将减少对象的运动的不确定性。因此,自主交通工具可以执行方法s100的该变型,以改善乘坐质量并避免不必要的制动和转向动作,否则这些不必要的制动和转向动作:可能给乘坐者带来身体和情感上的不适;并且可能增加自主交通工具针对对附近的人类驾驶员和行人的动作的不确定性。
220.15.2对象运动的不确定性
221.通常,在当前扫描周期期间被对象首次检测到的对象可以以满足由自主交通工具在当前扫描周期期间计算出的函数的切向速度和角速度的任何组合移动,并且该切向速度和角速度的任何组合落在由预定义运动限制假设规定的最大切向速度和角速度假设内。例如,诸如当自主交通工具和对象都接近交集时,对象可以非常快速地移动到自主交通工具的路径中,或者可以制动以避让自主交通工具。在当前扫描图像中表示该对象的点中包含的径向速度近似于单一的测量方向(例如,大约由于角度小),并且因此可能包含不充分的信息来解析对象的具体切向速度和角速度。
222.然而,在下一个扫描周期期间,自主交通工具可以访问表示对象运动的更多数据,然后自主交通工具可以将这些数据与对象在前面的扫描周期期间的运动描述(例如,第一径向速度和将对象的切向速度与角速度关联起来的第一函数)融合,以计算对象的可能切向速度和角速度组合的窄的(更窄的)范围。
223.利用在下一扫描周期期间捕获的数据对对象运动的这种细化可以与将对象在当前扫描周期期间的切向速度和角速度关联起来的函数的正交性成比例。特别地,如果这两个函数呈现低正交性(即,高平行性),则这两个函数的交集可以是相对较大的区域,并因此可以通知对象的可能的切向速度和角速度的宽的范围;反之亦然。更具体地说,如果这两个函数呈现低正交性,则第一函数和第二函数的交集除以第一函数和第二函数的并集可能相对较大,这可以对应于对象的运动的低确定性。
224.15.3不确定性方向推导
225.在一个实现中,自主交通工具实现上述方法和技术以:访问第一扫描图像;在第一扫描图像中检测第一时间的对象;计算在第一扫描周期期间的第一径向速度和将对象的切向速度和角速度关联起来的第一函数;以及计算对象的第一未来状态边界。
226.然后,如果自主交通工具离未来状态边界很远,则自主交通工具可以使对象消隐,而不纳入路径规划考虑。例如,如果自主交通工具在当前时间的位置落在对象的第一未来状态边界之外大于阈值距离(诸如,50米的阈值距离,或在给定自主交通工具的当前速度的情况下自主交通工具在5秒的阈值时间内穿越的距离)处,则自主交通工具可以从当前时间直到至少下一个扫描周期使对象消隐,而不纳入为避让对象进行的制动考虑。
227.相反,如果自主交通工具位于该未来状态边界内,则自主交通工具可以自动执行制动动作,从而使自主交通工具减速,以便在未来(例如,下一个)扫描周期期间将自主交通工具的位置移动到未来状态边界之外。
228.然而,如果自主交通工具靠近对象的未来状态边界(例如,在未来状态边界之外但与其相距在阈值距离内),则自主交通工具可以执行方法s100的该变型的块,以表征对象的运动的不确定性方向。如果对象的运动的不确定性方向与自主交通工具的轨迹之间的角度
大于阈值角度(例如,如果对象正在穿过十字路口并接近与自主交通工具相同的路口),则自主交通工具当前可以访问不充分的信息来辨别对象是正在非常快速地朝向自主交通工具移动还是处于要与自主交通工具碰撞的过程中。然而,因为自主交通工具的当前位置落在自主交通工具的未来状态边界之外,所以即使自主交通工具将动作延迟至少再一个扫描周期,并且即使对象正以预定义的运动限制假设内的最坏情况的切向速度和角速度移动,自主交通工具也可以确认在自主交通工具能够制动到完全停止之前对象不会与自主交通工具碰撞。因此,自主交通工具可以暂缓(withhold)执行避让对象的动作,直到(至少)下一个扫描周期当关于对象的附加运动数据对自主交通工具变得可用的时候。
229.此外,如果自主交通工具非常靠近对象(例如,与对象相距在两米或200毫秒内)和/或非常靠近对象的未来状态边界(例如,与对象的未来状态边界相距在十米或一秒内),则自主交通工具可以执行方法s100的该变型以预测对象的下一个不确定性方向。例如,自主交通工具可以:为当前时间的对象选择标称角速度假设(例如,0弧度/秒);以及基于第一函数和标称角速度计算对象的第一切向速度。替代地,自主交通工具可以:计算对象朝向自主交通工具的最大切向速度,该最大切向速度与预定义的运动限制假设的集合和第一函数相一致(并且因此基于当前扫描图像中表示对象的点的径向速度和对象的径向长度);将该最大切向速度存储为对象的所预测的第一切向速度;以及基于第一函数和对象的所预测的第一切向速度计算对象的对应的所预测的第一角速度。自主交通工具然后可以基于第一径向速度、该预测的第一切向速度和所预测的标称角速度来预测对象的总相对运动;通过在从当前扫描周期到下一扫描周期的时间内(例如,传感器的采样间隔)对对象的总相对运动进行积分,计算对象在下一扫描周期期间相对于自主交通工具的下一个相对位置;然后计算对象在下一个扫描周期期间的运动的不确定性的所预测的第二方向,该第二方向垂直于对象在下一个扫描周期期间相对于自主交通工具的径向位置,并且落在水平面内。(更具体地说,自主交通工具可以计算对象运动的不确定性的所预测的第二方向,该第二方向落在沿针对下一个扫描周期所预测的切向方位角方向。)
230.因此,自主交通工具可以基于自主交通工具在当前时间的运动以及对象在当前时间的第一径向速度、所预测的第一切向速度和所预测的第一角速度,计算对象在下一扫描周期期间的运动的不确定性的所预测的第二方向。
231.15.4确定性改善预测
232.然后,如果所预测的第二不确定性方向与用于当前扫描周期的第一不确定性方向不同,则自主交通工具可以预测对象在下一扫描周期期间的运动的不确定性降低,并且确认自主交通工具的运动没有改变。自主交通工具还可以基于对象的运动的不确定性的第一方向和所预测的第二方向之间的角度(或与该角度成比例地),表征在对象在下一扫描周期时的运动的确定性上的所预测的改善的幅度。
233.然而,如果所预测的第二不确定性方向平行于或几乎平行于(例如,相差在5
°
内)用于当前扫描周期的第一不确定性方向,则在给定自主交通工具在当前扫描周期和下一个扫描周期之间的运动变化(诸如转向角变化、制动输入或加速度输入)的情况下,自主交通工具可以重复前述过程来为对象重新计算所预测的第二不确定性方向(同时保持在为场中的许多或所有对象计算的进入区中,并满足预定义的平稳自主导航要求)。例如,自主交通工具可以通过自主交通工具对可以在下一个扫描周期在对象的不确定性方向上产生变化
的导航动作进行建模,从而改善对象的运动的确定性。
234.然后,如果这些导航动作中的一个在不确定性方向上产生所预测的变化(即,不确定性方向增加所预测的第二不确定性方向和第一不确定性方向之间的角度),则自主交通工具可以执行该导航动作以修改在下一扫描周期期间自主交通工具相对于对象的运动。特别地,自主交通工具可以专门执行该导航动作,以改善获取信息的机会,该信息可以更好地通知对象的真实运动,而不是必须避免与对象碰撞,因为自主交通工具已经确认,即使在给定对象的最坏情况的运动的情况下,自主交通工具也有时间在与对象碰撞之前达到完全停止。
235.15.5侧翼(flanking)对象
236.如果第一不确定性方向与自主交通工具的当前轨迹相交,诸如在自主交通工具的当前位置前方阈值距离(例如,30米、3秒或自主交通工具的停止持续时间)内相交,则自主交通工具可以附加地或替代地执行该过程以计算对象在下一扫描周期期间的运动的所预测的第二不确定性方向。
237.然而,如果对象在下一扫描周期期间的运动的所预测的第二不确定性方向与自主交通工具的当前轨迹在该阈值距离之外相交,或者如果对象在下一扫描周期期间的运动的所预测的第二不确定性方向大致平行于自主交通工具的当前轨迹(例如与自主交通工具的当前轨迹相差20
°
),则自主交通工具可以对于对象朝向自主交通工具的运动具有高确定性。
238.例如,如果对象和自主交通工具在两个紧邻且平行的车道上彼此位于侧翼,则由自主交通工具从第一扫描图像导出的对象的第一径向速度可以以非常高的确定性指示对象朝向自主交通工具的运动(即,最高风险方向),即使对象的真实切向速度从该第一扫描图像来看是未知的。在该示例中,对象的运动的不确定性的方向(例如,在对象的切向速度的方向上)大致平行于自主交通工具和对象的运动的方向,因此不通知对象朝向自主交通工具的运动。此外,自主交通工具的轨迹与对象的运动的不确定性的方向之间的角度近似为0
°
。相应地,自主交通工具可以基于对象的未来状态边界来选择避免与对象碰撞的导航动作;而不是基于对象的运动的不确定性来选择避免与对象碰撞的导航动作,因为(主要地)影响与对象碰撞的风险的运动分量是已知的。
239.15.6未来扫描周期
240.自主交通工具还可以执行前述过程,以预测对象在多个未来扫描周期内(诸如在后续的十个扫描周期内或在自主交通工具操作的后续两秒钟内)的运动的不确定性的方向,并因此预测对象的运动的确定性的改善。相应地,自主交通工具可以选择在多个后续扫描周期内使对象消隐而不纳入对象避让考虑,因为自主交通工具预测对象在这些多个后续扫描周期内的运动的不确定性的方向的变化,并因此预测对象的运动的确定性的改善。附加地或替代地,自主交通工具可以:预测(或“建模”)由自主交通工具执行的导航动作,这些导航动作将在多个后续扫描周期内产生对象的运动的不确定性的方向的变化,并因此产生对象的运动的确定性的改善;然后在这些扫描周期内执行这样的导航动作,以改善它对对象的运动的确定性。
241.16.对象运动的不确定性
242.对于自主交通工具处的第一扫描周期,图5所示的方法s100的类似变型包括:在块
s104中,访问包含由自主交通工具上的传感器在第一时间捕获的数据的第一扫描图像;在块s120中,在第一扫描图像中识别第一点组,该第一点组表示在自主交通工具附近的场中的对象;以及在块s126中基于第一点组来表征对象在第一时间的第一运动。对于自主交通工具处的第二扫描周期,方法s100的该变型还包括:在块s104中访问包含由传感器在继第一时间之后的第二时间处捕获的数据的第二扫描图像;在块s120中在第二扫描图像中识别表示对象的第二点组;以及在块s126中基于第二点组和第一运动来表征对象在第二时间的第二运动。方法s100的该变型还包括:在块s180中,表征对象在第二时间的第二运动的第二不确定性;在块s182中,基于对象在第二时间的第二运动和自主交通工具在第二时间的运动,计算对象在继第二时间之后的第三时间处的第三运动的所预测的第三不确定性;并且在块s142中,响应于所预测的第三不确定性低于第二不确定性,在第二时间使对象消隐,而不纳入用于使自主交通工具避让对象的制动考虑。
243.类似地,对于自主交通工具处的第一扫描周期,方法s100的该变型可包括:在块s104中,访问包含由自主交通工具上的传感器在第一时间捕获的数据的第一扫描图像;在块s120中,在第一扫描图像中识别第一点组,该第一点组表示在自主交通工具附近的场中的对象;以及在块s126中基于第一点组来表征对象在第一时间处的第一运动。方法s100的该变型还可以包括:在块s180中,表征对象在第二时间的第一运动的第一不确定性;在块s182中,基于对象在第一时间的第一运动和自主交通工具在第一时间的运动,计算对象在继第一时间之后的第二时间处的第二运动的所预测的第二不确定性;并且在块s142中,响应于所预测的第二不确定性低于第一不确定性,在第二时间处使对象消隐,而不纳入用于使自主交通工具避让对象的制动考虑。
244.16.1对象运动的不确定性
245.通常,在该变型中,自主交通工具可以实现类似于上述的那些方法和技术的方法和技术,以:计算对象在下一扫描周期期间的运动的不确定性的所预测的下一方向;比较对象的运动的不确定性的当前方向和所预测的下一个方向,以预测在未来对象的运动的确定性的改善幅度(例如,与对象的运动的不确定性的当前方向和所预测的下一个方向的正交性成比例);然后,如果自主交通工具预测在未来对象的运动的确定性的(有意义的、显著的)改善,则响应于对象的运动的确定性低,在当前时间选择性地延迟避让对象的导航动作,从而减少自主交通工具的运动变化并改善乘客的乘坐质量,如上所述。
246.16.2不确定性表征:3dof
247.更具体地说,在上面描述的自主交通工具以三个自由度表征对象的运动的变型中,自主交通工具可以实现上面描述的方法和技术以:基于在第一扫描图像中表示对象的点的径向速度来计算表示该对象的运动的第一函数;在第一扫描周期期间捕获的第一扫描图像中首次检测到对象时,计算对象的第一未来状态边界;并验证自主交通工具当前位于对象的第一未来状态边界之外。自主交通工具然后可以实现上述方法和技术,以预测表示对象在下一扫描周期期间的运动的第二函数。例如,自主交通工具可以基于以下项来预测对象在第二扫描周期期间的(绝对或相对)运动:第一径向速度和描述对象在第一扫描周期期间的运动的第一函数;通用对象的预定义运动限制假设;以及在从第一扫描周期到下一扫描周期的时间差上进行积分。然后,自主交通工具可以:预测在下一个扫描图像中表示对象的点的径向速度和方位角位置的梯度;基于径向速度在这些方位角位置上的该梯度,计
算表示对象在下一扫描周期期间的可能的切向速度和角速度的所预测的第二函数;并计算第一函数和所预测的第二函数的交集除以并集。然后,自主交通工具可以预测信息增益——并因此预测对象的运动的确定性的改善——该信息增益与该第一函数和所预测的第二函数的交集除以并集成反比。
248.因此,在上面描述的自主交通工具以三个自由度表征对象的运动的变型中,在块s180中,自主交通工具可以表征对象在第二时间处的运动的第二不确定性,该第二不确定性正比于第一函数和第二函数的交集与第一函数和第二函数的并集之比。
249.16.2不确定性表征:6dof
250.在上面描述的自主交通工具以六个自由度表征对象的运动的变型中,自主交通工具可以实现类似的方法和技术来表征对象在下一扫描周期期间的运动的不确定性。
251.例如,自主交通工具可以:计算表示对象在当前(即,第一)扫描周期期间的可能的切向运动、角运动和俯仰运动的第一函数;实现上述方法和技术以预测在第二扫描周期期间对象在六个自由度中的(绝对或相对)运动;预测在下一(即,第二)扫描图像中表示对象的点的径向速度、方位角位置和仰角位置的第一梯度;以及基于径向速度在这些方位角位置和仰角位置上的该第一梯度,计算所预测的第二函数,该第二函数表示对象在第二扫描周期期间的可能的切向速度、角速度和俯仰速度。自主交通工具然后可以计算第一函数(例如,三维椭圆体)和所预测的第二函数(例如,三维椭圆体)的交集除以并集。
252.然后,自主交通工具可以预测信息增益——并因此预测对象在第二扫描周期期间的运动的确定性的改善——该信息增益与第一函数和所预测的第二函数的该交集除以并集成反比。
253.然后,在第二扫描周期期间,自主交通工具可以:计算表示对象在第二扫描周期期间的可能的切向运动、角运动和俯仰运动的第二函数;以及表征该第二函数与所预测的第二函数之间的差。然后,自主交通工具可以实现上述方法和技术,以基于在第一函数和第二函数的交集处表示的、在从第二扫描周期到下一个(即,第三)扫描周期的时间差上进行积分并根据第二函数和所预测的第二函数之间的差进行校正(或“调整”)的运动,来预测在第三扫描周期期间对象在六个自由度中的(绝对或相对)运动。然后,所述自主交通工具可以:预测在第三扫描图像中表示对象的点的径向速度、方位角位置和仰角位置的第二梯度;并且基于在这些方位角位置和仰角位置上的径向速度的该第二梯度,计算表示对象在下一个(即,第三)扫描周期期间的可能的切向速度、角速度和俯仰速度的所预测的第三函数。然后,自主交通工具可以计算第一函数、第二函数和所预测的第三函数的交集除以并集。
254.因此,自主交通工具可以预测信息增益——并因此预测对象在第三扫描周期期间的运动的确定性的改善——该信息增益与第一函数、第二函数和所预测的第三函数的该交集除以并集成反比。
255.16.3对象消隐
256.然后,如上所述,如果自主交通工具的当前位置落在为对象计算的当前未来状态边界之外的大于阈值距离处,以及如果自主交通工具预测对象的运动不确定性的改善(诸如具体在自主交通工具的当前轨迹的方向上),则自主交通工具可以使对象消隐至少直到下一个扫描周期,而不纳入用于使自主交通工具避让对象的制动考虑(或更一般地,而没有反应性导航动作)。
257.16.4减少不确定性的动作
258.替代地,在该变型中,自主交通工具可以选择导航动作来改变其轨迹,以便捕获对象的运动数据,这可以改进(即,减少)对象在未来扫描周期期间的运动的不确定性,如上所述。
259.16.5未来扫描周期
260.自主交通工具还可以执行前述过程,以预测对象在多个未来扫描周期内(诸如,在后续十个扫描周期内,或在自主交通工具操作的后续两秒钟内)的运动的不确定性。相应地,自主交通工具可以选择在多个后续扫描周期内使对象消隐而不纳入对象避让考虑,因为自主交通工具预测在这些多个后续扫描周期内对象的运动的不确定性的改善不充分。附加地或替代地,自主交通工具可以:预测(或“建模”)由自主交通工具执行的导航动作,这些导航动作将在多个后续扫描周期内产生对象的运动不确定性的改善;然后在这些扫描周期内执行这样的导航动作,以改善它对对象的运动的确定性。
261.17.不确定性边界
262.在图6所示的类似的变型中,自主交通工具执行方法s100的块,以:在自主交通工具周围的场的扫描图像(例如,3d速度注释的点云)中检测对象;从该扫描图像中提取针对该对象的低不确定性的运动数据(例如,相对于自主交通工具的径向速度);识别对象的临界运动数据,该临界运动数据当前对自主交通工具不可用,但可以使自主交通工具能够验证可能产生自主交通工具与对象之间的未来碰撞的最坏情况的对象运动;并在给定自主交通工具的当前速度和对象的这种最坏情况的运动的情况下,预测自主交通工具会在何时访问这些临界运动数据。然后,自主交通工具可以响应于预测到自主交通工具会在未来时间访问对象的这些临界运动数据,选择性地延迟执行针对该对象的碰撞避免动作(例如,减速、停止),这仍然使自主交通工具能够在与该对象碰撞之前制动到完全停止(例如,使得任何这样的碰撞可以完全是对象的责任而不是自主交通工具的责任)。
263.例如,当自主交通工具在它附近检测到对象时,自主交通工具可以执行方法s100的块,以估计对象相对于自主交通工具的位置将充分改变为使得自主交通工具能够捕获附加的对象运动数据的临界未来时间,该附加的对象运动数据减少对象运动的不确定性,并因此使得自主交通工具能够验证与对象碰撞的可能性。然后,自主交通工具可以确认,即使在给定对象的最坏情况的运动(诸如由针对通用对象的最大速度的预定义假设界定)的情况下,如果自主交通工具将紧急停止延迟到该临界未来时间之后,自主交通工具仍然可以在与对象碰撞之前制动到完全停止;如果是这样,则自主交通工具可以延迟对对象执行抢先的碰撞避免动作,这可以改善自主交通工具的运动对于附近其他交通工具、驾驶员和行人而言的可预测性,并使自主交通工具在操作期间的运动平滑。因此,自主交通工具可以延迟对对象执行抢先的碰撞避免动作,这可以改善自主交通工具的运动对于附近其他交通工具、驾驶员和行人而言的可预测性,并使自主交通工具在操作期间的运动平滑。
264.类似地,在给定对象的最坏情况的运动的情况下,则自主交通工具可以计算自主交通工具在临界未来时间的最大临界速度,该最大临界速度使得如果自主交通工具将紧急停止延迟到该临界未来时间之后,自主交通工具能够在与对象碰撞之前制动到完全停止。然后,如果自主交通工具的当前速度小于该最大临界速度,自主交通工具可以将其最大速度限定到该最大临界速度,直至临界未来时间;或者如果自主交通工具的当前速度大于该
最大临界速度,自主交通工具可以自动滑行或制动,以便到临界未来时间时将其速度降低到该最大临界速度。
265.例如,自主交通工具可以:存储高性能客运交通工具或高性能摩托车的最坏情况的速度和加速度(例如,最大速度50米/秒,最大加速度每秒9米/秒);基于这些最坏情况的速度和加速度,界定对象在自主交通工具无法测量的方向上的可能运动;并验证在给定该界限内的速度的情况下,对象是否可能到达并与自主交通工具碰撞;然后执行方法s100的后续块,以选择性地延迟对该对象的避让,以便收集附加运动数据并进一步验证对象的运动。因此,自主交通工具可以减少或消除对对象识别和其他机器学习技术的依赖,来:识别对象的类型;将自主交通工具周围的场中的不可变对象(例如路标、电线杆)和可变对象(例如行人、交通工具)区分开;并基于他们的类型选择动力学模型或预测对象的未来运动。更具体地说,不是基于根据对象的所预测的类型所选择的动力学模型来预测对象的未来运动,而是自主交通工具可以:基于在当前扫描周期期间收集的有限运动数据、对象相对于自主交通工具的当前位置以及针对通用对象(例如,通用的高性能客运交通工具)的最大速度和加速度假设来预测和界定对象的当前和未来运动;并验证该对象在界限内的运动是否能使对象与自主交通工具发生碰撞。
266.因此,通过执行方法s100的块来通知路径规划决策,自主交通工具可以:减少或消除对在其环境中准确识别对象的类型或类别的需要;减少或消除在自主交通工具的自主操作中的这种可能的误差来源;以及增加自主交通工具的自主操作的鲁棒性,诸如对抗对抗性计算机视觉攻击、对抗性神经网络攻击的鲁棒性,或者在先验训练数据有限或没有先验训练数据的情况下的鲁棒性。
267.此外,自主交通工具可以对可变和不可变的对象实现相同的检测、跟踪和运动规划决策路径,从而减少或消除对在自主交通工具的环境中识别对象的类别(或将对象分类为可变的或不可变的)的需要,并减少在自主交通工具上执行唯一的计算机视觉、机器学习和路径规划流水线的数量。例如,自主交通工具可以执行相同的检测、跟踪和运动规划决策路径,以预测和处理:在自主交通工具的环境中、但被其他检测到的对象遮挡的可能无法检测到的对象(例如,站在电线杆后面的行人;占据在自主交通工具的视场中被拖拉机拖车遮挡的车道的客运交通工具);首次进入自主交通工具的视场的对象;以及在自主交通工具的视场中现存的对象。
268.17.1对象运动测量限制和不确定性
269.通常,自主交通工具能够表征在其场中检测到的对象在三个自由度中的运动,该三个自由度诸如为:在从自主交通工具延伸到对象的径向方向上的平移;在垂直于径向方向的水平切线方向上平移;以及围绕对象的偏航轴旋转。然而,上述扫描图像中的点可以包含场中的对象的1d运动观测值(即,沿径向轴的距离变化率)。如上所述,自主交通工具可以:分离出在扫描图像中距自主交通工具相似距离处表示的点的集群;内插2d运动(例如,相对于自主交通工具的径向速度和关于对象的偏航速率),该2d运动与在该扫描图像中的点上的1d运动观测值一致;以及因此将该点的集群与场中的一个对象相关联。因此,自主交通工具可以从扫描图像导出对象的径向速度(即,沿着从自主交通工具延伸通过对象的射线的对象的速度)和对象的偏航速率。
270.然而,扫描图像可能不包含与对象的切向速度(即,垂直于从自主交通工具延伸到
对象的射线的运动)相关的信息。因此,与由自主交通工具中的传感器直接测量并被存储在当前扫描图像中的对象的径向速度的不确定性相比,对象在当前扫描周期期间的切向速度的不确定性可能相对较高。
271.然而,如果自主交通工具正相对于对象移动,则自主交通工具对对象的视角可以从当前扫描周期到稍后的扫描周期发生改变,使得对象在该稍后的扫描周期期间落在自主交通工具的视场中的不同方位角位置处。因此,从自主交通工具在该稍后的扫描周期期间捕获的稍后扫描图像中由此导出的对象的径向速度可以对应于对象在绝对参考系中的方向上的速度,该方向与在当前扫描周期期间捕获的扫描图像中所表示的对象的径向方向不同。
272.因此,随着自主交通工具和对象在后续扫描周期内继续相对于彼此移动,自主交通工具:可以预期访问对象在切向方向范围内的径向速度的集合;可以选择性地选择延迟碰撞避免动作,以便访问对象在这些切向方向上的径向速度,并且减少对象运动的不确定性;以及可以将未来的路径规划决策建立对象运动的更高确定性的知识上,从而提高自主交通工具的效率并使自主交通工具的运动平滑。
273.17.2速度不确定性边界
274.通常,自主交通工具可以实现上述方法和技术,以将对象的所测量的径向速度和由预定义的运动限制假设规定的通用对象的最大速度融合成速度不确定性边界,该速度不确定性边界表示对象在当前时间的许多(或所有)可能的速度的集合。
275.例如,自主交通工具可以:在以自主交通工具的中心为原点的(极)坐标系中初始化矢量集合,其中每个矢量表示在当前扫描周期期间在该坐标系中对象相对于自主交通工具的可能的速度;将每个矢量在径向方向上的分量长度设置为等于对象的当前所测量的径向速度;将跨越通用对象的负最大速度至通用对象的正最大速度的总长度的范围分配给矢量集合;在坐标系中定位从对象的中心延伸的矢量集合;并计算包含这些矢量的椭圆或椭圆体,以定义在当前扫描周期期间对象的速度不确定性边界。
276.在该示例中,自主交通工具可以类似地计算在径向方向上具有分量长度的矢量的范围,该分量长度跨越当前扫描图像中与对象相关联的点的径向速度的范围和/或跨越生成扫描图像的传感器的径向速度测量值的误差范围。然后,自主交通工具可以计算通过这些矢量的椭圆或椭圆体,以定义在当前扫描周期期间对象的速度不确定性边界。
277.然而,自主交通工具可以以任何其他方式为对象计算速度不确定性边界。
278.17.3碰撞速度、碰撞持续时间和临界时间
279.通常,如果自主交通工具沿其当前轨迹继续行驶,自主交通工具可以预测在对象的速度不确定性边界中所包含的对象的特定速度将导致与自主交通工具发生碰撞的未来时间。
280.更具体地说,自主交通工具可以:基于自主交通工具的当前速度、其规划路线和/或自主交通工具周围的已知车道网络来预测自主交通工具的即将到来的路径;扫描对象的速度不确定性边界以获取特定速度,该特定速度可以使对象在与自主交通工具大致相同的时间到达沿自主交通工具的即将到来的路径(诸如根据已知车道网络或不管已知车道网络如何)的特定位置;估计以该特定速度移动的对象和沿该路径移动的自主交通工具将到达该特定位置的碰撞时间;并通过自主交通工具的当前停止持续时间计算在碰撞时间之前的
临界时间。
281.17.4临界时间处的对象运动不确定性预测
282.通常,自主交通工具可以:预测自主交通工具在当前时间和临界时间之间可访问的对象运动数据;并预测这些附加的对象运动数据可以如何减少对象运动的不确定性。
283.17.4.1在临界时间的第二径向方向
284.在一个实现中,自主交通工具:基于自主交通工具的当前路径和速度估计自主交通工具在临界时间处的位置;基于对象的当前位置和因此计算出的在当前扫描周期期间自主交通工具的最坏情况的速度,估计对象在临界时间处的位置;以及基于自主交通工具和对象在临界时间处的这些所估计的位置,计算在临界时间处从自主交通工具到对象的第二径向方向(或方位角)。自主交通工具可以实现类似的方法和技术,以基于自主交通工具的当前路径和速度、基于对象的当前位置并假设对象在该时间段内的最坏情况的速度,来估计从当前时间到临界时间从自主交通工具到对象的径向方向的范围。
285.17.4.2在临界时间的未来速度不确定性边界
286.然后,自主交通工具:实现上述方法和技术,以基于自主交通工具到临界时间时可以收集到的对象运动数据(假设自主交通工具和对象在临界时间到达这些所估计的位置)来计算对象的未来速度不确定性边界。
287.17.4.3在临界时间的不确定性
288.然后,自主交通工具可以表征在临界时间处对象运动的不确定性,诸如与临界时间处对象在相对于自主交通工具的切线方向(即,垂直于径向方向)上的可能速度的范围成比例。然后,如果在临界时间对象的速度的该所预测的不确定性低于阈值不确定性(例如,如果对象的可能切向速度的范围小于4米/秒),则在块s142中,自主交通工具可以在当前扫描周期期间使对象消隐而不纳入路径规划决策,或者以其他方式选择将响应于对象的任何碰撞避免动作延迟到未来时间。
289.相反,如果对象在临界时间的速度的所预测的不确定性超过该阈值不确定性(例如,如果对象的可能切向速度的范围大于4米/秒),则自主交通工具可以降低其速度,诸如与该不确定性成比例地降低,以便将临界时间进一步延长到未来,从而使得自主交通工具能够在可能与对象碰撞之前捕获对象的附加运动数据,并因此在该延迟后的临界时间之前减少对象的运动不确定性。
290.17.5改变对象和点
291.此外,因为自主交通工具可以不依赖于对象分类或识别来预测对象的类型并相应地预测对象的运动,所以自主交通工具可以定义跨越场中的多个真实对象的点组,诸如,如果这些对象沿着相似的轨迹并以相似的速度移动。然而,自主交通工具可以实现前述方法和技术以计算、细化和避开针对该“分组对象”的未来状态边界,直到这些真实对象不再沿着相似的轨迹和/或以相似的速度移动的时间,此时自主交通工具可以:在当前扫描周期中区分这些对象;从前面的分组对象将运动特性转移到这些不同对象中的每一个上;然后如上所述,为这些对象中的每一个计算未来状态边界。
292.类似地,自主交通工具可以区分表示单个真实对象的两个点集群,并实现上述方法和技术以计算、细化和避开针对这两个集群的未来状态边界,诸如直到自主交通工具确定这两个集群中的点的径向速度(或距离变化率)的接近度和自一致性指示单一对象的时
间。
293.附加地或替代地,自主交通工具可以实现前述方法和技术,以计算、细化和避开针对表示自主交通工具周围的场中的对象的子区域的单独的点和较小的点集群的未来状态边界。
294.本文描述的系统和方法可以至少部分地体现和/或实施为被配置成接收存储计算机可读指令的计算机可读介质的机器。指令可以由与应用、小程序、主机、服务器、网络、网站、通信服务、通信接口、用户计算机或移动设备的硬件/固件/软件元素、腕带、智能电话或它们的任何合适的组合集成的计算机可执行部件来执行。实施例的其他系统和方法可以至少部分地体现和/或实施为被配置成接收存储计算机可读指令的计算机可读介质的机器。指令可以由通过与上述类型的装置和网络集成的计算机可执行部件集成的计算机可执行部件执行。可以将计算机可读介质存储在任何合适的计算机可读介质上,诸如存储在ram、rom、闪存、eeprom、光学装置(cd或dvd)、硬盘驱动器、软盘驱动器或任何合适的设备上。计算机可执行部件可以是处理器,但是任何合适的专用硬件设备都可以(替代地或另外)执行指令。
295.如本领域技术人员将从先前的详细描述以及从附图和权利要求书中认识到的,可以在不脱离如所附权利要求书中限定的本发明的范围的情况下,对本发明的实施例进行修改和改变。
再多了解一些

本文用于创业者技术爱好者查询,仅供学习研究,如用于商业用途,请联系技术所有人。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献