用于加速曲线投影的系统和方法与流程
本公开的实施方式总体涉及操作自动驾驶车辆。更具体地，本公开的实施方式涉及确定障碍物轨迹在自动驾驶车辆(adv)的参考线路上的投影。
背景技术：
以自动驾驶模式运行(例如，无人驾驶)的车辆可以将乘客、尤其是驾驶员从一些驾驶相关的职责中解放出来。当以自动驾驶模式运行时，车辆可以使用车载传感器导航到各个位置，从而允许车辆在最少人机交互的情况下或在没有任何乘客的一些情况下行驶。
车辆可使用参考线路进行导航。参考线路是自动驾驶车辆在周围没有障碍物时应沿着其行驶的路径。在车行道上的一个或多个障碍物均可具有轨迹。对于每个障碍物，adv可以确定障碍物的轨迹在adv的参考线路上的投影，以基于障碍物在沿着障碍物的轨迹的多个点处与adv参考线路的接近度来做出驾驶决策。计算从障碍物的轨迹上的点(x，y)投影到adv的参考线路上的点的时间成本是o(n)的量级，其中，n是在障碍物的轨迹上的点的数量。adv的规划模块需要将每个障碍物的轨迹投影至adv的参考线路上，以确保adv保持与车行道上的每个障碍物的安全行驶距离。确定诸如汽车的障碍物在adv的参考线路上的投影从计算方面而言是昂贵的并且可限制对每个障碍物执行投影的频率。当在adv的附近存在大量障碍物(诸如，汽车、行人和其它障碍物)时，计算复杂性被进一步复杂化。
技术实现要素：
本申请的一方面提供了一种确定自动驾驶车辆的障碍物的轨迹是否要求所述自动驾驶车辆调整导航的计算机实施方法，所述方法包括：确定自动驾驶车辆的障碍物的轨迹，所述轨迹通过多个第一有序的点{p0..pm}表示；确定所述自动驾驶车辆的导航的参考线路，所述参考线路通过多个第二有序的点{r0..rn}表示；响应于确定所述障碍物和所述自动驾驶车辆在相同的方向上行进：找出点s0∈{r0..rn}，以使得从p0到s0的距离是从p0到{r0..rn}中的任一点的最小距离；对于每个点pi∈{p1..pm}，其中i＝1至m，找出点si∈{si-1..rn}，以使得从pi到si的距离是从pi到{si-1..rn}中的任一点的最小距离；响应于确定对于任何i∈{0..m}的pi与si之间的距离小于阈值距离值，调整所述自动驾驶车辆的导航。
根据本申请的实施方式，所述方法还包括：响应于确定所述障碍物和所述自动驾驶车辆在相反的方向上行进：找出点sm∈{r0..rn}，以使得从pm到sm的距离是从pm到{r0..rn}中的任一点的最小距离；对于每个点pi∈{p0..pm-1}，其中i＝m-1至0，在{r0..si+1}中找出点si，以使得从pi到si的距离是从pi到{r0..si+1}中的任一点的最小距离。
根据本申请的实施方式，所述障碍物相对于所述自动驾驶车辆行进的方向通过以下项中的至少一项确定：使用高清晰度地图确定所述障碍物的车行道的方向和所述自动驾驶车辆的车行道的方向；或者使用所述自动驾驶车辆的感知模块确定所述障碍物的行进方向θobs、所述自动驾驶车辆的行进方向θadv，并进一步确定：如果θadv-θobs的绝对值小于阈值行进方向值，则所述障碍物和所述自动驾驶车辆在相同方向上行进；以及如果θadv-θobs-180°的绝对值小于所述阈值行进方向值，则所述障碍物和所述自动驾驶车辆在相反方向上行进。
根据本申请的实施方式，所述阈值行进方向值处于30°至40°之间。
根据本申请的实施方式，m＝100且n＝1000。
根据本申请的实施方式，所述方法还包括：对于i＝1至m-1，在{p0..pm}中的每个pi与pi+1之间插入
本申请的另一方面提供了一种存储有指令的非暂时性机器可读介质，所述指令在由处理器运行时致使所述处理器执行以下操作，所述操作包括：确定自动驾驶车辆的障碍物的轨迹，所述轨迹通过多个第一有序的点{p0..pm}表示；确定所述自动驾驶车辆的导航的参考线路，所述参考线路通过多个第二有序的点{r0..rn}表示；响应于确定所述障碍物和所述自动驾驶车辆在相同的方向上行进：找出点s0∈{r0..rn}，以使得从p0到s0的距离是从p0到{r0..rn}中的任一点的最小距离；对于每个点pi∈{p1..pm}，其中i＝1至m，找出点si∈{si-1..rn}，以使得从pi到si的距离是从pi到{si-1..rn}中的任一点的最小距离；响应于确定对于任何i∈{0..m}的pi与si之间的距离小于阈值距离值，调整所述自动驾驶车辆的导航。
本申请的又一方面提供了一种数据处理系统，包括：处理器；以及存储器，所述存储器联接到所述处理器以存储指令，所述指令在由所述处理器运行时致使所述处理器执行以下操作，所述操作包括：确定自动驾驶车辆的障碍物的轨迹，所述轨迹通过多个第一有序的点{p0..pm}表示；确定所述自动驾驶车辆的导航的参考线路，所述参考线路通过多个第二有序的点{r0..rn}表示；响应于确定所述障碍物和所述自动驾驶车辆在相同的方向上行进：找出点s0∈{r0..rn}，以使得从p0到s0的距离是从p0到{r0..rn}中的任一点的最小距离；对于每个点pi∈{p1..pm}，其中i＝1至m，找出点si∈{si-1..rn}，以使得从pi到si的距离是从pi到{si-1..rn}中的任一点的最小距离；响应于确定对于任何i∈{0..m}的pi与si之间的距离小于阈值距离值，调整所述自动驾驶车辆的导航。
附图说明
本公开的实施方式以示例而非限制的方式示出在附图的各图中，附图中相似的附图标记指示相似的元件。
图1是示出根据一个实施方式的网络化系统的框图。
图2是示出根据一个实施方式的自动驾驶车辆的示例的框图。
图3a至图3b是示出根据一些实施方式的自动驾驶车辆所使用的感知与规划系统的示例的框图。
图4是示出根据一个实施方式的决策和规划过程的示例的框图。
图5a是示出根据一个实施方式的决策模块的示例的框图。
图5b是示出根据一个实施方式的规划模块的示例的框图。
图6a至图6c示出了根据一个实施方式的确定adv的障碍物的轨迹是否要求adv调整导航的示例。
图7a至图7c示出了根据一个实施方式的确定adv的障碍物的轨迹是否要求adv调整导航的示例。
图8是示出根据一个实施方式的确定adv的障碍物的轨迹是否要求adv调整导航的方法的流程图。
图9a和图9b是示出根据一个实施方式的确定adv的障碍物的轨迹是否要求adv调整导航的方法的流程图。
图10是示出根据一个实施方式的数据处理系统的框图。
具体实施方式
将参考以下所讨论的细节来描述本公开的各种实施方式和方面，附图将示出所述各种实施方式。下列描述和附图是对本公开的说明，而不应当解释为限制本公开。描述了许多特定细节以提供对本公开各种实施方式的全面理解。然而，在某些情况下，并未描述众所周知的或常规的细节以提供对本公开的实施方式的简洁讨论。
本说明书中对“一个实施方式”或“实施方式”的引述意味着结合该实施方式所描述的特定特征、结构或特性可以包括在本公开的至少一个实施方式中。短语“在一个实施方式中”在本说明书中各处的记载不必全部指同一实施方式。
根据一些实施方式，adv包括障碍物处理模块以确定障碍物的轨迹是否要求对adv的导航作出调整。障碍物是在为adv导航时adv感知与规划模块需要考虑的物体(通常是移动的物体)。障碍物处理模块可为单个adv处理多个障碍物。adv的感知与规划模块跟踪障碍物并确定每个障碍物轨迹线路到adv的距离。障碍物轨迹线路可以由例如100个点表示。adv感知与规划模块还可为adv生成导航参考线路，该导航参考线路表示为adv规划的路线。adv参考线路可以由例如1000个点表示。针对障碍物轨迹的每个点，感知与规划模块可以确定到adv参考线路最近的点，其表示从障碍物轨迹点到adv参考线路的最小距离。以数学术语来讲，障碍物轨迹线路的每个点被投影至adv参考线路的点上。对于障碍物轨迹线路的每个点，确定障碍物轨迹线路点与该点在adv参考线路的点上的投影之间的距离。假设障碍物遵循其轨迹线路并且adv遵循其导航参考线路，则障碍物轨迹点与障碍物轨迹点在adv参考线路的点上的投影之间的距离的最小值对应于障碍物可能最接近于adv的情况。如果障碍物可能出现在adv的最小阈值距离内，则可能需要调整adv导航以避开障碍物。
根据一方面，一种方法可确定障碍物是否在与adv大致相同的方向上行进，或者确定障碍物是否在与adv大致相反的方向上行进。在任一种情况下，adv的感知与规划模块可确定障碍物的轨迹、adv的导航参考线路，并且高效地确定在障碍物遵循其轨迹线路且adv遵循其导航参考线路的情况下障碍物与adv可能间隔开的最小距离。如果障碍物和adv不在相同方向或相反方向上行进，则感知与规划系统可执行除了本文中描述的避障处理之外的其它避障处理。
在实施方式中，非暂时性计算机可读介质存储可运行的指令，这些指令当被处理系统运行时可执行任何上述功能。
在又一实施方式中，联接至利用可运行指令编程的存储器的处理系统可在这些指令被处理系统运行时执行任何上述功能。在实施方式中，处理系统包括至少一个硬件处理器。
图1是示出根据本公开的一个实施方式的自动驾驶车辆网络配置的框图。参考图1，网络配置100包括可以通过网络102通信地联接到一个或多个服务器103至104的自动驾驶车辆101。尽管示出一个自动驾驶车辆，但多个自动驾驶车辆可以通过网络102联接到彼此和/或联接到服务器103至104。网络102可以是任何类型的网络，例如，有线或无线的局域网(lan)、诸如互联网的广域网(wan)、蜂窝网络、卫星网络或其组合。服务器103至104可以是任何类型的服务器或服务器群集，诸如，网络或云服务器、应用服务器、后端服务器或其组合。服务器103至104可以是数据分析服务器、内容服务器、交通信息服务器、地图和兴趣点(mpoi)服务器或者位置服务器等。
自动驾驶车辆是指可以被配置成在自动驾驶模式下操作的车辆，在所述自动驾驶模式下车辆在极少或没有来自驾驶员的输入的情况下导航通过环境。这种自动驾驶车辆可以包括传感器系统，所述传感器系统具有被配置成检测与车辆运行环境有关的信息的一个或多个传感器。所述车辆和其相关联的控制器使用所检测的信息来导航通过所述环境。自动驾驶车辆101可以在手动模式下、在全自动驾驶模式下或者在部分自动驾驶模式下运行。
在一个实施方式中，自动驾驶车辆101包括，但不限于，感知与规划系统110、车辆控制系统111、无线通信系统112、用户接口系统113和传感器系统115。自动驾驶车辆101还可以包括普通车辆中包括的某些常用部件，诸如：发动机、车轮、方向盘、变速器等，所述部件可以由车辆控制系统111和/或感知与规划系统110使用多种通信信号和/或命令进行控制，该多种通信信号和/或命令例如，加速信号或命令、减速信号或命令、转向信号或命令、制动信号或命令等。
部件110至115可以经由互连件、总线、网络或其组合通信地联接到彼此。例如，部件110至115可以经由控制器局域网(can)总线通信地联接到彼此。can总线是被设计成允许微控制器和装置在没有主机的应用中与彼此通信的车辆总线标准。它是最初是为汽车内的复用电气布线设计的基于消息的协议，但也用于许多其它环境。
现在参考图2，在一个实施方式中，传感器系统115包括但不限于一个或多个相机211、全球定位系统(gps)单元212、惯性测量单元(imu)213、雷达单元214以及光探测和测距(lidar)单元215。gps系统212可以包括收发器，所述收发器可操作以提供关于自动驾驶车辆的位置的信息。imu单元213可以基于惯性加速度来感测自动驾驶车辆的位置和定向变化。雷达单元214可以表示利用无线电信号来感测自动驾驶车辆的本地环境内的对象的系统。在一些实施方式中，除感测对象之外，雷达单元214可以另外感测对象的速度和/或前进方向。lidar单元215可以使用激光来感测自动驾驶车辆所处环境中的对象。除其它系统部件之外，lidar单元215还可以包括一个或多个激光源、激光扫描器以及一个或多个检测器。相机211可以包括用来采集自动驾驶车辆周围环境的图像的一个或多个装置。相机211可以是静物相机和/或视频相机。相机可以是可机械地移动的，例如，通过将相机安装在旋转和/或倾斜平台上。
传感器系统115还可以包括其它传感器，诸如：声纳传感器、红外传感器、转向传感器、油门传感器、制动传感器以及音频传感器(例如，麦克风)。音频传感器可以被配置成从自动驾驶车辆周围的环境中采集声音。转向传感器可以被配置成感测方向盘、车辆的车轮或其组合的转向角度。油门传感器和制动传感器分别感测车辆的油门位置和制动位置。在一些情形下，油门传感器和制动传感器可以集成为集成式油门/制动传感器。
在一个实施方式中，车辆控制系统111包括但不限于转向单元201、油门单元202(也被称为加速单元)和制动单元203。转向单元201用来调整车辆的方向或前进方向。油门单元202用来控制电动机或发动机的速度，电动机或发动机的速度进而控制车辆的速度和加速度。制动单元203通过提供摩擦使车辆的车轮或轮胎减速而使车辆减速。应注意，如图2所示的部件可以以硬件、软件或其组合实施。
回到图1，无线通信系统112允许自动驾驶车辆101与诸如装置、传感器、其它车辆等外部系统之间的通信。例如，无线通信系统112可以与一个或多个装置直接无线通信，或者经由通信网络进行无线通信，诸如，通过网络102与服务器103至104通信。无线通信系统112可以使用任何蜂窝通信网络或无线局域网(wlan)，例如，使用wifi，以与另一部件或系统通信。无线通信系统112可以例如使用红外链路、蓝牙等与装置(例如，乘客的移动装置、显示装置、车辆101内的扬声器)直接通信。用户接口系统113可以是在车辆101内实施的外围装置的部分，包括例如键盘、触摸屏显示装置、麦克风和扬声器等。
自动驾驶车辆101的功能中的一些或全部可以由感知与规划系统110控制或管理，尤其当在自动驾驶模式下操作时。感知与规划系统110包括必要的硬件(例如，处理器、存储器、存储设备)和软件(例如，操作系统、规划和路线安排程序)，以从传感器系统115、控制系统111、无线通信系统112和/或用户接口系统113接收信息，处理所接收的信息，规划从起始点到目的地点的路线或路径，随后基于规划和控制信息来驾驶车辆101。替代地，感知与规划系统110可以与车辆控制系统111集成在一起。
例如，作为乘客的用户可以例如经由用户接口来指定行程的起始位置和目的地。感知与规划系统110获得行程相关数据。例如，感知与规划系统110可以从mpoi服务器中获得位置和路线信息，所述mpoi服务器可以是服务器103至104的一部分。所述路线可包括自动驾驶车辆将遵循的导航线路。位置服务器提供位置服务，并且mpoi服务器提供地图服务和某些位置的poi。替代地，此类位置和mpoi信息可以本地高速缓存在感知与规划系统110的永久性存储装置中。
当自动驾驶车辆101沿着路线移动时，感知与规划系统110也可以从交通信息系统或服务器(tis)获得实时交通信息。应注意，服务器103至104可以由第三方实体进行操作。替代地，服务器103至104的功能可以与感知与规划系统110集成在一起。基于实时交通信息、mpoi信息和位置信息以及由传感器系统115检测或感测的实时本地环境数据(例如，障碍物、对象、附近车辆)，感知与规划系统110可以规划最佳路线并且根据所规划的路线例如经由控制系统111来驾驶车辆101，以安全且高效到达指定目的地。所规划的路线可包括导航参考线路。
服务器103可以是为多种客户端执行数据分析服务的数据分析系统。在一个实施方式中，数据分析系统103包括数据收集器121和机器学习引擎122。数据收集器121从各种车辆(自动驾驶车辆或由人类驾驶员所驾驶的常规车辆)收集驾驶统计数据123。驾驶统计数据123包括表明发出的驾驶命令(例如，油门命令、制动命令、转向命令)以及在不同的时间点车辆的传感器所捕获的车辆的响应(例如速度、加速、减速、方向)的信息。驾驶统计数据123还可包括描述在不同的时间点的驾驶环境的信息，诸如，例如路线(包括起始位置和目的地位置)、mpoi、道路条件、天气条件等。
基于驾驶统计数据123，机器学习引擎122出于多种目的而生成或训练规则集、算法和/或预测模型124。在一个实施方式中，例如，算法124可包括优化路径规划和速度规划的优化方法。优化方法可包括表示路径段或时间段的成本函数和多项式函数的集合。这些功能可被上传至自动驾驶车辆上，以用于实时生成平滑路径。
图3a和图3b是示出根据一个实施方式的与自动驾驶车辆一起使用的感知与规划系统的示例的框图。系统300可以被实施为图1的自动驾驶车辆101的一部分，包括但不限于感知与规划系统110、控制系统111和传感器系统115。参考图3a至图3b，感知与规划系统110包括但不限于定位模块301、感知模块302、预测模块303、决策模块304、规划模块305、控制模块306、路线安排模块307和障碍物处理模块308。
模块301至308中的一些或全部可以以软件、硬件或其组合实施。例如，这些模块可以安装在永久性存储装置352中、加载到存储器351中，并且由一个或多个处理器(未示出)执行。应注意，这些模块中的一些或全部可以通信地联接到图2的车辆控制系统111的一些或全部模块或者与它们集成在一起。模块301至308中的一些可以一起集成为集成模块。例如，决策模块304和规划模块305可集成为单个模块，并且路线安排模块307和障碍物处理模块308可集成为单个模块。
定位模块301(例如，利用gps单元212)确定自动驾驶车辆300的当前位置，并管理与用户的行程或路线相关的任何数据。定位模块301(也被称为地图与路线模块)管理与用户的行程或路线相关的任何数据。用户可以例如经由用户接口登录并且指定行程的起始位置和目的地。定位模块301与自动驾驶车辆300的诸如地图和路线信息311的其它部件通信，以获得行程相关数据。例如，定位模块301可以从位置服务器和地图与poi(mpoi)服务器获得位置和路线信息。位置服务器提供位置服务，并且mpoi服务器提供地图服务和某些位置的poi，从而可以作为地图和路线信息311的一部分高速缓存。当自动驾驶车辆300沿着路线移动时，定位模块301也可以从交通信息系统或服务器获得实时交通信息。
基于由传感器系统115提供的传感器数据和由定位模块301获得的定位信息，感知模块302确定对周围环境的感知。感知信息可以表示普通驾驶员在驾驶员正驾驶的车辆周围将感知到的东西。感知可以包括例如采用对象形式的车道配置(例如，直线车道或弯曲车道)、交通灯信号、另一车辆的相对位置、行人、建筑物、人行横道或其它交通相关标志(例如，停止标志、让行标志)等。对象可以是相对于adv101的导航路径的障碍物。
感知模块302可以包括计算机视觉系统或计算机视觉系统的功能，以处理并分析由一个或多个相机采集的图像，从而识别自动驾驶车辆环境中的对象和/或特征。所述对象可以包括交通信号、道路边界、其它车辆、行人和/或障碍物等。计算机视觉系统可以使用对象识别算法、视频跟踪以及其它计算机视觉技术。在一些实施方式中，计算机视觉系统可以绘制环境地图，跟踪对象，以及估算对象的速度等。感知模块302也可以基于由诸如雷达和/或lidar的其它传感器提供的其它传感器数据来检测对象。
针对每个对象，预测模块303预测所述对象在所述情况下的行为。基于在某时间点感知的驾驶环境的感知数据根据地图/路线信息311与交通规则312的集合来执行所述预测。例如，如果对象是相反方向处的车辆且当前驾驶环境包括十字路口，预测模块303则将预测该车辆是可能向前直行还是可能转弯。如果感知数据表明十字路口没有交通灯，则预测模块303可预测该车辆可能在进入十字路口之前必须完全停下。如果感知数据表明该车辆当前处于左转专用车道或右转专用车道，则预测模块303可分别预测该车辆更可能进行左转或右转。
针对每个对象，决策模块304作出关于如何处置对象的决定。例如，针对特定对象(例如，交叉路线中的另一车辆)以及描述对象的元数据(例如，速度、方向、转弯角度)，决策模块304决定如何与所述对象相遇(例如，超车、让行、停止、经过)。决策模块304可以根据诸如交通规则或驾驶规则312的规则集来作出此类决定，所述规则集可以存储在永久性存储装置352中。
基于针对所感知到的每个对象的决定，规划模块305为自动驾驶车辆规划导航路径或路线以及驾驶参数(例如，距离、速度和/或转弯角度)。感知与规划系统110可基于导航路径或路线为自动驾驶车辆生成导航参考线路。即，针对给定的对象，决策模块304决定对该对象做什么，而规划模块305确定如何去做。例如，针对给定的对象，决策模块304可以决定经过所述对象，而规划模块305可以确定在所述对象的左侧还是右侧经过。规划和控制数据由规划模块305生成，包括描述车辆300在下一移动周期(例如，下一路线/路径段)中将如何移动的信息。例如，规划和控制数据可以指示车辆300以30英里每小时(mph)的速度移动10米，随后以25mph的速度变到右侧车道。
基于规划和控制数据，控制模块306根据由规划和控制数据限定的路线或路径通过将适当的命令或信号发送到车辆控制系统111来控制并驾驶自动驾驶车辆。所述规划和控制数据包括足够的信息，以沿着路径或路线在不同的时间点使用适当的车辆设置或驾驶参数(例如，油门、制动和转弯命令)将车辆从路线或路径的第一点驾驶到第二点。
在一个实施方式中，规划阶段在多个规划周期(也称为命令周期)中执行，诸如，以例如每100毫秒(ms)的时间间隔执行。针对每个规划周期或命令周期，将基于规划和控制数据发出一个或多个控制命令。即，对于每100ms，规划模块305规划下一路线段或路径段，例如，包括目标位置和adv到达该目标位置所需的时间。替代地，规划模块305还可指定具体速度、方向和/或转向角度等。在一个实施方式中，规划模块305为下一预定的时间段(诸如5秒)规划路线段或路径段。对于每个规划周期，规划模块305基于先前周期中所规划的目标位置为当前周期(例如，下个5秒)规划目标位置。控制模块306随后基于当前周期的规划和控制数据生成一个或多个控制命令(例如，油门控制命令、制动控制命令、转向控制命令)。
应注意，决策模块304和规划模块305可以集成为集成模块。决策模块304/规划模块305可以包括导航系统或导航系统的功能，以确定自动驾驶车辆的驾驶路径。例如，导航系统可以确定用于实现自动驾驶车辆沿着以下路径移动的一系列速度和前进方向：所述路径在使自动驾驶车辆沿着通往最终目的地的基于车行道的路径前进的同时，基本上避免感知到的障碍物。目的地可以根据经由用户接口系统113进行的用户输入来设定。导航系统可以在自动驾驶车辆正在运行的同时动态地更新驾驶路径。导航系统可以将来自gps系统和一个或多个地图的数据合并，以确定用于自动驾驶车辆的驾驶路径。
决策模块304/规划模块305还可以包括防撞系统或防撞系统的功能，以识别、评估并且避免或以其它方式越过自动驾驶车辆的环境中的潜在障碍物。例如，防撞系统可以通过以下方式实现自动驾驶车辆的导航中的变化：操作控制系统111中的一个或多个子系统来采取变向操纵、转弯操纵、制动操纵等。防撞系统可以基于周围的交通模式、道路状况等自动确定可行的障碍物回避操纵。防撞系统可以被配置成使得当其它传感器系统检测到位于自动驾驶车辆将变向进入的相邻区域中的车辆、建筑障碍物等时不采取变向操纵。防撞系统可以自动选择既可使用又使得自动驾驶车辆乘客的安全性最大化的操纵。防撞系统可以选择预测使得自动驾驶车辆的乘客舱中出现最小量的加速度的避让操纵。
路线安排模块307可例如从地图信息(诸如路段、路段的车道和从车道到路缘的距离的信息)生成参考路线。例如，道路可划分成{a、b和c}节或段来表示三个路段。路段a的三个车道可列举为{a1、a2和a3}。导航参考线路或导航参考路线通过沿着参考路线生成参考点而生成。例如，对于车道，路线安排模块307可连接由地图数据提供的车道的两个相对的路缘或路沿的中点。基于表示所收集的曾经车辆在不同的时间点在该车道上驾驶数据点的机器学习数据和上述中点，路线安排模块307可通过在车道的预定邻近范围内选择所收集的数据点的子集并根据收集到的数据点的子集对所述中点应用平滑函数，从而计算参考点。
基于参考点或车道参考点，路线安排模块307可通过对参考点插值来生成参考线路，以使得所生成的参考线路被用作用于控制所述车道上的adv的参考线路。在一些实施方式中，代表参考线路的参考点表和路段表可被实时下载到adv，以使得adv可基于adv的地理位置和驾驶方向生成参考线路。例如，在一个实施方式中，adv可通过利用表示前方即将到来的路段的路径段标识符和/或基于adv的gps位置来请求用于路径段的路线安排服务，从而生成参考线路。基于路径段标识符，路线安排服务可返回到adv参考点表，所述adv参考点表包含用于关注路段的所有车道的参考点。adv可查阅路径段的车道的参考点，以生成用于控制车道上的adv的参考线路。
障碍物处理模块308可确定自动驾驶车辆的导航路径的障碍物是否要求调整自动驾驶车辆的导航。如果需要，则感知与规划系统110可确定适当的导航变化。障碍物处理模块308可为感知与规划系统110所感知的每个物体或障碍物生成轨迹线路。在实施方式中，障碍物轨迹线路可以由点的集合(例如，100个点)表示。如上所述，规划模块305可为自动驾驶车辆生成导航参考线路。导航参考线路可以由点的集合(例如，1000个点)表示。障碍物处理模块308可针对障碍物轨迹线路中的每个点确定导航参考线路上具有距障碍物轨迹的点的最小距离的点。以数学术语来讲，障碍物处理模块308近似于将障碍物轨迹线路的每个点投影至自动驾驶车辆导航线路上。之所以称为近似于投影，是因为导航线路不连续；导航线路由点的集合表示。因此，障碍物轨迹上的具有到导航参考线路点集合上的单个点的最小距离的点近似于障碍物轨迹的点到导航参考线路上的投影。障碍物可能最接近于自动驾驶车辆时即障碍物轨迹点投影至导航参考线路点上的距离的值最小时。如果该最小值比阈值小，则规划模块305可能需要调整自动驾驶车辆的导航以避开障碍物。
如上所述，路线或路线安排模块307管理与用户的行程或路线相关的任何数据。adv的用户指定起始位置和目的地位置以获取行程相关数据。行程相关数据包括路线段和路线段的参考线路或参考点。例如，基于路线地图信息311，路线模块307生成路线或路段表和参考点表。参考点与路段表中的路段和/或车道有关。参考点可被插值以形成用于控制adv的一个或多个参考线路。参考点可以仅限于路段和/或路段的具体车道。
例如，路段表可以是名称-值对，以包括路段a至d的先前车道和下一车道。例如，对于具有车道1的路段a至d，路段表可以是：{(a1，b1)，(b1，c1)，(c1，d1)}。参考点表可包括用于路段车道的x-y坐标形式的参考点，例如{(a1，(x1，y1))，(b1，(x2，y2))，(c1，(x3，y3))，(d1，(x4，y4))}，其中a1至d1表示路段a至d的车道1，并且(x1，y1)至(x4，y4)为相应的真实世界的坐标。在一个实施方式中，路段和/或车道被划分成预定长度，诸如大概200米的路段/车道。在另一实施方式中，根据诸如道路的曲率的道路条件，路段和/或车道被划分成可变长度段/车道。在一些实施方式中，每个路段和/或车道可包括若干参考点。在一些实施方式中，参考点可转变成其它的坐标系，例如，纬度-经度。
在一些实施方式中，参考点可转变至相对坐标系中，诸如基点-侧移(sl)坐标。基点-侧移坐标系是参考固定参考点来跟随参考线路的坐标系。例如，(s，l)＝(1，0)坐标可表示具有0米侧向偏移的参考线路上的基点(即，参考点)之前1米。(s，l)＝(2，1)参考点可表示沿着参考线路在固定参考点之前2米，且从参考线路侧向偏移1米，例如，向左偏移1米。
在一个实施方式中，决策模块304基于由路线安排模块307提供的参考线路并基于adv感知的adv周围的障碍物和/或交通信息来生成原始路径配置文件。原始路径配置文件可以是路径/速度配置文件313的一部分，所述原始路径配置文件可被存储在永久性存储装置352中。原始路径配置文件通过沿着参考线路选择点而生成。针对每个点，在其余点保持稳定的情况下，决策模块304基于关于如何与所述对象相遇的一个或多个障碍物决策来将该点移动到参考线路的左侧或右侧(例如，候选移动)。所述候选移动通过对候选路径使用动态规划而被迭代地执行，其中，使用作为图3a的成本函数315的一部分的成本函数来寻找具有最小路径成本的候选路径，从而生成原始路径配置文件。成本函数的示例包括基于以下项的成本：路线路径的曲率、从adv到感知到的障碍物的距离和adv到参考线路的距离。在一个实施方式中，所生成的原始路径配置文件包括基点-侧移图，所述基点-侧移图可被存储在永久性存储装置352中以作为sl图/st图314的一部分。
在一个实施方式中，决策模块304基于生成的原始路径配置文件来生成原始速度配置文件(作为路径/速度配置文件313的一部分)。原始速度配置文件表明在特定的时间点控制adv的最佳速度。类似于原始路径配置文件，使用动态规划来迭代不同时间点的候选速度，其中，根据adv所感知的障碍物基于成本函数(作为图3a的成本函数315的一部分)来寻找具有最小速度成本的候选速度(例如，加速或减速)。原始速度配置文件决定adv是否应超过或避开障碍物，以及驶向障碍物的左侧或右侧。在一个实施方式中，原始速度配置文件包括基点-时间(st)图(作为sl图/st图314的一部分)。基点-时间图表明行驶的距离与时间的关系。
在一个实施方式中，规划模块305根据障碍物决策和/或人为障碍来重新计算原始路径配置文件，以禁止规划模块305搜索所述障碍的几何空间。例如，如果原始速度配置文件确定从左侧掠过障碍物，则规划模块305可在障碍物的右侧设置障碍(以障碍物的形式)，以防止对adv从右侧掠过障碍物的计算。在一个实施方式中，通过使用二次规划(qp)优化路径成本函数(作为成本函数315的一部分)来重新计算原始路径配置文件。在一个实施方式中，重新计算的原始路径配置文件包括基点-侧移图(作为sl图/st图314的一部分)。
在一个实施方式中，规划模块305使用二次规划(qp)重新计算原始速度配置文件，从而优化速度成本函数(作为成本函数315的一部分)。可增加类似的速度障碍约束以禁止qp求解器搜索一些受禁的速度。在一个实施方式中，重新计算的原始速度配置文件包括基点-时间图(作为sl图/st图314的一部分)。
应注意，如上文示出和描述的部件中的一些或全部可以在软件、硬件或其组合中实施。例如，此类部件可以实施为安装并存储在永久性存储装置中的软件，所述软件可以加载在存储器中并通过处理器(未示出)在存储器中执行以实施本申请全文中所述的过程或操作。替代地，此类部件可以实施为编程或嵌入到专用硬件(诸如，集成电路(例如，专用集成电路或asic)、数字信号处理器(dsp)或现场可编程门阵列(fpga))中的可执行代码，所述可执行代码可以经由来自应用的相应驱动程序和/或操作系统来访问。此外，此类部件可以实施为处理器或处理器内核中的特定硬件逻辑，作为可由软件部件通过一个或多个特定指令访问的指令集的一部分。
图4是示出根据一个实施方式的决策和规划过程的示例的框图。图5a是示出根据一个实施方式的决策模块的示例的框图。图5b是示出根据一个实施方式的规划模块的示例的框图。参考图4，决策和规划过程400包括路线安排模块307、障碍物处理模块308(可与路线安排模块307集成在一起)、定位/感知数据401、路径决策过程403、速度决策过程405、路径规划过程407、速度规划过程409、聚合器411和轨迹计算器413。
路径决策过程403和速度决策过程405可分别通过图5a中的决策模块304的路径决策模块501和速度决策模块503来执行。参考图4和图5a，路径决策过程403或路径决策模块501包括路径状态机505、路径交通规则507和基点-侧移图生成器509。路径决策过程403或路径决策模块501可使用动态规划生成原始路径配置文件作为路径规划过程407和速度规划过程409的初始约束。在一个实施方式中，路径状态机505包括至少三种状态：巡航状态、变道状态和闲置状态。路径状态机505提供先前的规划结果和重要信息，诸如adv是在巡航还是在变道。作为图3a的驾驶/交通规则312的一部分的路径交通规则507包括能够影响路径决策模块的结果的交通规则。例如，路径交通规则507可包括诸如施工交通标志的交通信息，adv从而可避开具有这种施工标志的车道。通过状态、交通规则、由路线安排模块307提供的参考线路以及由adv感知的障碍物，路径决策过程403可决定如何处理所感知的障碍物(即，忽视、超过、让行、停止、经过)，所述决定作为原始路径配置文件的一部分。
例如，在一个实施方式中，原始路径配置文件通过成本函数生成，所述成本函数包括：基于路径的曲率的成本；以及基于从参考线路和/或参考点到障碍物的距离的成本。选择参考线路上的点并将参考线路上的点移动到参考线路的左侧或右侧以作为表示候选路径的候选移动。每一个候选移动均具有相关成本。参考线路上的一个或多个点的候选移动的相关成本可使用动态规划顺序地(一次一个点)求解以获得最佳成本。在一个实施方式中，sl图生成器509生成基点-侧移图作为原始路径配置文件的一部分。所述基点-侧移图是包括由adv感知的障碍物信息的二维几何地图(类似于x-y坐标平面)。从sl图，路径决策过程403可安排遵循障碍物决策的adv路径。动态规划(或动态优化)是数学优化方法，该方法将待求解的问题分解成一系列价值函数，一次仅解决这些价值函数中的一个函数并存储其答案。下一次出现相同的价值函数时，仅需查找先前计算的答案而不是重新计算答案，从而节省了计算时间。
速度决策过程405或速度决策模块503包括速度状态机511、速度交通规则513和基点-时间图生成器515。速度决策过程405或速度决策模块503可使用动态规划生成原始速度配置文件作为路径规划过程407和速度规划过程409的初始约束。在一个实施方式中，速度状态机511包括至少两种状态：加速状态和减速状态。作为图3a的驾驶/交通规则312的一部分的速度交通规则513包括能够影响速度决策模块的结果的交通规则。例如，速度交通规则513可包括诸如红/绿交通灯、十字路口路线中的另一车辆等交通信息。通过速度状态机的状态、速度交通规则、由决策过程403生成的原始路径配置文件/sl图以及感知的障碍物，速度决策过程405可生成原始速度配置文件来控制adv何时加速和/或减速。基点-时间图生成器515可生成基点-时间图以作为原始速度配置文件的一部分。
参考图4和图5b，路径规划过程407或路径规划模块521包括基点-侧移图525、几何平滑器527和路径成本模块529。基点-侧移图525可包括由路径决策过程403的sl图生成器509生成的基点-侧移图。路径规划过程407或路径规划模块521可使用原始路径配置文件(例如，基点-侧移图)作为初始约束，以使用二次规划重新计算最佳参考线路。二次规划涉及在边界、线性等式和/或不等式约束的限制下使目标函数(例如，具有若干变量的二次函数)最小化或最大化。动态规划与二次规划之间的一个不同之处在于，二次规划一次性优化用于参考线路上的所有点的所有候选移动。几何平滑器527可对输出基点-侧移图应用平滑算法(诸如b-spline或回归)。路径成本模块529可利用路径成本函数(作为图3a的成本函数315的一部分)重新计算参考线路，以例如使用由qp模块540执行的qp优化来对参考点的候选移动的总成本进行优化。
速度规划过程409或速度规划模块523包括基点-时间图531、时序平滑器533和速度成本模块535。基点-时间图531可包括由速度决策过程405的st图生成器515生成的基点-时间(st)图。速度规划过程409或速度规划模块523可使用原始速度配置文件(例如，基点-时间图)和路径规划过程407的结果作为初始约束，以计算最佳基点-时间曲线。时序平滑器533可向点的时间序列应用平滑算法(诸如b-spline或回归)。速度成本模块535可利用速度成本函数(作为图3a的成本函数315的一部分)重新计算st图，以优化不同的时间点的候选移动(例如，加速/减速)的总成本。
聚合器411执行将路径规划结果和速度规划结果聚合的功能。例如，在一个实施方式中，聚合器411可将二维的st图和sl图组合成三维的slt图。在另一实施方式中，聚合器411可基于sl参考线路或st曲线上的2个连续点来内插(或填充附加点)。在另一实施方式中，聚合器411可将参考点从(s，l)坐标转化成(x，y)坐标。轨迹生成器413可计算用于控制adv的最终轨迹。例如，基于由聚合器411提供的slt图，轨迹生成器413计算一列(x，y，t)点，所述(x，y，t)点表明adv应在何时经过特定的(x，y)坐标。
因此，返回参考图4，路径决策过程403和速度决策过程405将在考虑到障碍物和/或交通状况的情况下生成原始路径配置文件和原始速度配置文件。基于与障碍物有关的所有路径决策和速度决策，路径规划过程407和速度规划过程409将根据所述障碍物使用qp规划来优化原始路径配置文件和速度配置文件，以生成具有最小路径成本和/或速度成本的最佳轨迹。
图6a至图6c示出了根据一个实施方式的确定adv的障碍物的轨迹是否要求adv调整导航的示例。在图6a至图6c的示例中，障碍物的行进方向612与adv的行进方向607大致相同。下文将参照图9a对根据图6a至图6c的描述的方法进行描述。
参考图6a，adv605可以是上文参考图1描述的adv101。诸如车辆610的障碍物具有由点p0、p1、p2、p3...pm表示的障碍物轨迹615。在实施方式中，m可以是100。在实施方式中，障碍物轨迹615的点p0...pm可以形成有序集合{p0..pm}。adv感知与规划系统110可确定障碍物610的轨迹。adv605可使用adv感知与规划系统110来确定adv605的参考导航线路620。adv参考线路620可以由点r0..rn表示。在实施方式中，n可以是1000。在实施方式中，adv参考线路620的点r0..rn可以形成有序集合{r0..rn}。
为了确定adv是否需要调整导航以避开障碍物610，感知与规划模块110的障碍物处理模块308确定障碍物610可以有多接近于adv605，假设障碍物610继续在轨迹615上行进并且adv605继续在参考线路620上行进。对于障碍物轨迹615的{p0..pm}中的每个点pi(i＝0至m)，障碍物处理模块308可确定{r0..rn}中的点si，该点si具有从pi到adv参考线路620的{r0..rn}中的任一点si的最小距离。对于障碍物轨迹615的点p0，计算从p0到{r0..rn}中的每个点的距离。adv参考线路的点s0是{r0..rn}中到p0的距离最小的点。因此，为了找出距p0距离最短的s0，可搜索{r0..rn}中的所有点。为找出adv参考线路620的后续点si(i＝1至m)，可如下文参考图6b所描述地在adv参考线路620的{r0..rn}中搜索较少的点。假设{p0..pm}中的每个点pi表示为(x，y)坐标对，并且{r0..rn}中的每个点si也表示为(x，y)坐标对，pi与si之间的距离可表示为
现在参考图6b，对于障碍物轨迹615的{p1..pm}中的后续点pi(i＝1至m)，对{r0..rn}中的点si到障碍物轨迹的点pi的搜索不需要从r0处开始。相反地，对后续点si的搜索可从最后确定的si(即，si-1)处开始。例如，对于障碍物轨迹线路615的点p1，对adv参考线路620上到障碍物轨迹615的p1的距离最短的点s1的搜索可以从最后确定的si开始(即，s0)，而不是在r0处从adv参考线路620的起始进行搜索。因此，对于i＝1且pi＝p1，对si＝s1的搜索可从adv参考线路620上的点si-1＝s0开始。可对索引变量“i”的每个值重复该过程以确定从障碍物轨迹615的{p1..pm}中的每个pi到adv参考线路620上的点si的最短距离。
如上所述，当adv605的行进方向607与障碍物610的行进方向612是大致相同的方向时，使用图6a和图6b中描述的过程。如果障碍物610的行进方向θobs减去adv605的行进方向θadv的绝对值小于阈值：|θobs-θadv|＜阈值，则adv605和障碍物610在大致相同的方向上行进。在实施方式中，阈值可以处于30°和40°之间。在实施方式中，如果adv605和障碍物610二者的高密度(hd)地图中的位置表明adv605和障碍物610处于车行道的同一侧的相同或者不同的车道中并且hd地图表明车道在相同方向上执行交通，则可确定adv605和障碍物610在相同方向上行进。下文将参考图7a和图7c描述adv605和障碍物610在大致相反的方向上行进的实施方式。
图6c示出了在adv参考线路620上找出点的集合{s0..sm}的过程的完整迭代，其中，对于i＝0至m，{s0..sm}中的每个si到{p0..pm}中的pi的距离最短。
图7a至图7c示出了根据一个实施方式的确定adv的障碍物的轨迹是否要求adv调整导航的示例。在图7a至图7c的示例中，障碍物710的行进方向712与adv705的行进方向707大致相反。下文参考图9b对根据图7a至图7c的描述的方法进行描述。
参考图7a，adv705可以是上文参考图1描述的adv101。诸如车辆710的障碍物具有由点p0、p1、p2、p3...pm表示的障碍物轨迹715。adv感知与规划系统110可以确定障碍物710的轨迹。adv705可使用adv感知与规划系统110来确定adv705的参考导航线路720。在实施方式中，障碍物轨迹715可以是由点p0...pm表示的线。在实施方式中，m可以是100。在实施方式中，障碍物轨迹715的点p0...pm可形成有序集合{p0...pm}。adv参考线路720可以由点r0..rn表示。在实施方式中，n可以是1000。在实施方式中，adv参考线路720的点r0..rn可以形成有序集合{r0..rn}。
为了确定adv是否需要调整导航以避开障碍物710，感知与规划模块110的障碍物处理模块308可确定：如果障碍物710继续在轨迹715上行进且adv705继续在参考线路720上行进，障碍物710可以有多接近于adv705。对于障碍物轨迹715的{p0..pm}中的每个点pi(i＝0至m)，障碍物处理模块308可确定{r0..rn}中的点si，该点si具有从pi到adv参考线路720的{r0..rn}中的任一点si的最小距离。对于障碍物轨迹715的点pm，计算从pm到{r0..rn}中的每个点的距离。adv参考线路点sm是{r0..rn}中到pm的距离最小的点。因此，为了找出距pm的距离最短的sm，可搜索{r0..rn}中的所有点。对于{p0..pm-1}中的后续点pi，为了找出adv参考线路720的后续点si(i＝m-1至0)，可在adv参考线路720的{r0..rn}中搜索较少的点。
现在参考图7b，对于障碍物轨迹715的{p0..pm-1}中的后续点pi(i＝m-1至0)，对{r0..rn}中的最近点si的搜索不需要从rn处开始。相反地，对后续点si的搜索可从最后确定的si(即，si+1)处开始。例如，对于障碍物轨迹线路715的点pi＝pm-1(其中，i＝m-1)，对adv参考线路720上到障碍物轨迹715的pm-1的距离最短的点si＝sm-1的搜索可以从最后确定的si+1＝sm开始，而不是在rn处从adv参考线路720的起始进行搜索。因此，对于i＝m-1且pi＝pm-1，对si＝sm-1的搜索可以从adv参考线路720上的点si+1＝sm开始。可对索引变量“i”的每个值重复该过程以在adv参考线路720上找出距障碍物轨迹715的{p0..pm-1}中的每个pi(其中，i＝m-1至0)的距离最短的点si。
当adv705和障碍物710在大致相反的方向上行进时，使用图7a和图7b中描述的过程。在实施方式中，如果θobs减去θadv再减去180°的绝对值小于阈值：|θobs-θadv-180°|＜阈值，则障碍物710和adv705在大致相反的方向上行进。在实施方式中，如果adv705和障碍物710二者的hd地图中的位置表明adv705处于沿着第一方向行进的车道中的第一侧车行道的车道中，而障碍物710处于沿着与adv705大致相反的方向行驶的车道中的第二侧车行道上，则可确定adv705和障碍物710在相反方向上行进。
adv705和障碍物710在大致相反的方向上行进的实施方式与上文在图7a和图7b中描述的过程类似。下文参考图9a对图6a至图6c的过程进行描述。下文参考图9b对adv和障碍物在相反方向上行进时的过程进行描述。
图7c示出了在adv参考线路720上找出表示到障碍物轨迹线路715的点的集合{p0..pm}中的每个点的距离最短的点的集合{s0..sm}的过程的完整迭代。
图8是示出根据一个实施方式的确定adv的障碍物的轨迹是否要求adv调整导航的方法800的流程图。可对相同的障碍物610或710多次执行方法800。也可对adv605或705的多个障碍物610或710中的每个执行方法800一次或多次。
在操作805中，感知与规划模块110可确定adv的障碍物的轨迹。轨迹可由m个离散点的集合{p0..pm}表示。在实施方式中，m＝100。在实施方式中，m个离散点的集合形成点的有序集合。
在操作810中，感知与规划模块110可确定adv的导航参考线路。导航参考线路可由n个离散点的集合{r0..rn}表示。在实施方式中，n＝1000。在实施方式中，n个离散点的集合可以是有序集合。
在操作815中，感知与规划模块110可以确定障碍物相对于adv的相对方向。如以上参考图6a至图6c和图7a至图7c所描述的，障碍物和adv的相对方向可以以多种方式确定。
在操作815中，可确定adv和障碍物是在大致相同的方向、大致相反的方向上行进、还是在既不相同也不相反的方向上行进。如果adv的行进方向θadv与障碍物的行进方向θobs之间的差值的绝对值小于阈值量，则adv和障碍物在大致相同的方向上行进。在实施方式中，如果由adv检索的高清晰度(hd)地图表明adv和障碍物二者都在表示相同方向的车道中行进，则adv和障碍物在相同方向上行进。在实施方式中，如果θadv-θobs-180°的绝对值小于阈值，则adv和障碍物在大致相反的方向上行进。在实施方式中，阈值可处于30°与40°之间。在实施方式中，如果由adv检索的hd地图表明adv和障碍物占据具有相反方向的车道，则adv和障碍物可在大致相反的方向上行进。
在操作820中，可确定adv和障碍物是否在相同或大致相同的方向上行进。如果是，则方法800在操作900处继续，否则方法800在操作825处继续。
在操作825中，可确定adv和障碍物是否在相反或大致相反的方向上行进。如果是，则方法800在操作950处继续，否则方法800在操作830处继续。
在操作830中，已经确定adv和障碍物不在相同方向或相反方向上行进。因此，将通过感知与规划模块110的其它处理(方法800未描述这一处理)来确定障碍物是否要求adv来调整导航，并且方法800结束。
在操作900中，根据下文参考图9a描述的方法900确定adv参考线路上分别距障碍物的相应点{p0..pm}的距离最短的点的集合{s0..sm}。方法800在操作835处继续。
在操作950中，根据下文参考图9b描述的方法950确定adv参考线路上分别距障碍物的相应点{p0..pm}的距离最短的点的集合{s0..sm}。方法800在操作835处继续。
在操作835中，确定所有pi与si(其中，i＝0..m)之间的距离的最小值。假设障碍物维持其轨迹且adv根据adv参考线路维持导航，该最小距离对应于障碍物可能最接近于adv的情况。在实施方式中，可将在操作835中确定的该最小值确定为操作900或操作950的一部分。
在操作840中，可确定障碍物到adv的最小距离是否小于阈值安全量。如果是，则感知与规划模块110确定对adv的导航进行调整。方法800结束。
图9a和图9b是示出了根据一个实施方式的确定adv的障碍物的轨迹是否要求adv调整导航的方法的流程图。
图9a示出了在障碍物和adv在大致相同的方向上行进时确定adv导航线路的{s0..sm}中的点si的方法900，其中，对于i＝0..m的每个，{s0..sm}中的任一点si均具有到{p0..pm}中的pi的最短距离。
在操作905中，对于{p0..pm}中的第一点p0，搜索参考线路{r0..rn}中的所有点以在{r0..rn}中找出距p0的距离最小的点s0。
在操作910中，对于每个i＝1至m，可以执行操作915。在循环结束时，当i＞m时，方法900返回到方法800的操作835处。
在操作915中，对于循环计数器i的值和障碍物轨迹点pi，搜索导航参考线路的一部分以找出从参考线路被搜索的部分中的任一点到pi的距离最小的si。参考线路被搜索的部分可以是从最新找出的si(即，si-1)到参考线路的末端rn处。因此，参考线路的对si进行搜索的部分是{si-1..rn}。
图9b示出了在障碍物和adv在大致相反的方向上行进时确定adv导航线路的{sm..s0}中的点si的方法950，其中，对于i＝m..0的每个，每个si具有从{r0..rn}中的任一点到{pm..p0}中的pi的最短距离。
在操作955中，对于{pm..p0}中的第一点pm，搜索参考线路{r0..rn}中的所有点以在{r0..rn}中找出距pm的距离最小的点sm。
在操作960中，对于每个i＝m-1至0，可以执行操作965。在循环结束时，当i＜0时，方法900返回至方法800的操作835处。
在操作965中，对于循环计数器i的值和障碍物轨迹点pi，搜索导航参考线路的一部分以找出参考线路被搜索的部分中的任一点到pi的距离最小的si。参考线路被搜索的部分可以是从最新找出的si(即，si+1)到参考线路的末端r0处。因此，参考线路的对si进行搜索的部分是{r0..si+1}。
图10是示出可以与本公开的一个实施方式一起使用的数据处理系统的示例的框图。例如，系统1000可以表示以上所述的执行上述过程或方法中的任一个的任何数据处理系统，例如，图1的感知与规划系统110或者服务器103至104中的任一个。系统1000可以包括许多不同的部件。这些部件可以实施为集成电路(ic)、集成电路的部分、分立电子装置或适用于电路板(诸如，计算机系统的主板或插入卡)的其它模块或者实施为以其它方式并入计算机系统的机架内的部件。
还应注意，系统1000旨在示出计算机系统的许多部件的高阶视图。然而，应当理解的是，某些实施例中可以具有附加的部件，此外，其它实施例中可以具有所示部件的不同布置。系统1000可以表示台式计算机、膝上型计算机、平板计算机、服务器、移动电话、媒体播放器、个人数字助理(pda)、智能手表、个人通信器、游戏装置、网络路由器或集线器、无线接入点(ap)或中继器、机顶盒或其组合。此外，虽然仅示出了单个机器或系统，但是术语“机器”或“系统”还应当被理解为包括单独地或共同地执行一个(或多个)指令集以执行本文所讨论的任何一种或多种方法的机器或系统的任何集合。
在一个实施方式中，系统1000包括通过总线或互连件1010连接的处理器1001、存储器1003以及装置1005至1008。处理器1001可以表示其中包括单个处理器内核或多个处理器内核的单个处理器或多个处理器。处理器1001可以表示一个或多个通用处理器，诸如，微处理器、中央处理单元(cpu)等。更具体地，处理器1001可以是复杂指令集计算(cisc)微处理器、精简指令集计算(risc)微处理器、超长指令字(vliw)微处理器、或实施其它指令集的处理器、或实施指令集组合的处理器。处理器1001还可以是一个或多个专用处理器，诸如，专用集成电路(asic)、蜂窝或基带处理器、现场可编程门阵列(fpga)、数字信号处理器(dsp)、网络处理器、图形处理器、通信处理器、加密处理器、协处理器、嵌入式处理器、或者能够处理指令的任何其它类型的逻辑。
处理器1001(其可以是低功率多核处理器套接口，诸如超低电压处理器)可以用作用于与所述系统的各种部件通信的主处理单元和中央集线器。这种处理器可以实施为片上系统(soc)。处理器1001被配置成执行用于执行本文所讨论的操作和步骤的指令。系统1000还可以包括与可选的图形子系统1004通信的图形接口，图形子系统1004可以包括显示控制器、图形处理器和/或显示装置。
处理器1001可以与存储器1003通信，存储器1003在一个实施方式中可以经由多个存储器装置实施以提供给定量的系统存储。存储器1003可以包括一个或多个易失性存储(或存储器)装置，诸如，随机存取存储器(ram)、动态ram(dram)、同步dram(sdram)、静态ram(sram)或者其它类型的存储装置。存储器1003可以存储包括由处理器1001或任何其它装置执行的指令序列的信息。例如，各种操作系统、装置驱动程序、固件(例如，输入输出基本系统或bios)和/或应用的可执行代码和/或数据可以加载到存储器1003中并由处理器1001执行。操作系统可以是任何类型的操作系统，例如，机器人操作系统(ros)、来自
系统1000还可以包括io(输入/输出)装置，诸如装置1005至1008，包括网络接口装置1005、可选的输入装置1006，以及其它可选的io装置1007。网络接口装置1005可以包括无线收发器和/或网络接口卡(nic)。所述无线收发器可以是wifi收发器、红外收发器、蓝牙收发器、wimax收发器、无线蜂窝电话收发器、卫星收发器(例如，全球定位系统(gps)收发器)或其它射频(rf)收发器或者它们的组合。nic可以是以太网卡。
输入装置1006可以包括鼠标、触摸板、触敏屏幕(其可以与显示装置1004集成在一起)、指针装置(诸如，手写笔)和/或键盘(例如，物理键盘或作为触敏屏幕的一部分显示的虚拟键盘)。例如，输入装置1006可以包括联接到触摸屏的触摸屏控制器。触摸屏和触摸屏控制器例如可以使用多种触敏技术(包括但不限于电容、电阻、红外和表面声波技术)中的任一种，以及其它接近传感器阵列或用于确定与触摸屏接触的一个或多个点的其它元件来检测其接触和移动或间断。
io装置1007可以包括音频装置。音频装置可以包括扬声器和/或麦克风，以促进支持语音的功能，诸如语音识别、语音复制、数字记录和/或电话功能。其它io装置1007还可以包括通用串行总线(usb)端口、并行端口、串行端口、打印机、网络接口、总线桥(例如，pci-pci桥)、传感器(例如，诸如加速度计运动传感器、陀螺仪、磁强计、光传感器、罗盘、接近传感器等)或者它们的组合。装置1007还可以包括成像处理子系统(例如，相机)，所述成像处理子系统可以包括用于促进相机功能(诸如，记录照片和视频片段)的光学传感器，诸如电荷耦合装置(ccd)或互补金属氧化物半导体(cmos)光学传感器。某些传感器可以经由传感器集线器(未示出)联接到互连件1010，而诸如键盘或热传感器的其它装置可以根据系统1000的具体配置或设计由嵌入式控制器(未示出)控制。
为了提供对诸如数据、应用、一个或多个操作系统等信息的永久性存储，大容量存储设备(未示出)也可以联接到处理器1001。在各种实施方式中，为了实现更薄且更轻的系统设计并且改进系统响应性，这种大容量存储设备可以经由固态装置(ssd)来实施。然而，在其它实施方式中，大容量存储设备可以主要使用硬盘驱动器(hdd)来实施，其中较小量的ssd存储设备充当ssd高速缓存以在断电事件期间实现上下文状态以及其它此类信息的非易失性存储，从而使得在系统活动重新启动时能够实现快速通电。另外，闪存装置可以例如经由串行外围接口(spi)联接到处理器1001。这种闪存装置可以提供系统软件的非易失性存储，所述系统软件包括所述系统的bios以及其它固件。
存储装置1008可以包括计算机可访问的存储介质1009(也被称为机器可读存储介质或计算机可读介质)，其上存储有体现本文所述的任何一种或多种方法或功能的一个或多个指令集或软件(例如，模块、单元和/或逻辑1028)。处理模块/单元/逻辑1028可以表示上述部件中的任一个，例如图3b的障碍物处理模块308、图5b的路径规划模块521、速度规划模块523。处理模块/单元/逻辑1028还可以在其由数据处理系统1000、存储器1003和处理器1001执行期间完全地或至少部分地驻留在存储器1003内和/或处理器1001内，数据处理系统1000、存储器1003和处理器1001也构成机器可访问的存储介质。处理模块/单元/逻辑1028还可以通过网络经由网络接口装置1005进行传输或接收。
计算机可读存储介质1009也可以用来永久性地存储以上描述的一些软件功能。虽然计算机可读存储介质1009在示例性实施方式中被示为单个介质，但是术语“计算机可读存储介质”应当被认为包括存储所述一个或多个指令集的单个介质或多个介质(例如，集中式或分布式数据库和/或相关联的高速缓存和服务器)。术语“计算机可读存储介质”还应当被认为包括能够存储或编码指令集的任何介质，所述指令集用于由机器执行并且使得所述机器执行本公开的任何一种或多种方法。因此，术语“计算机可读存储介质”应当被认为包括但不限于固态存储器以及光学介质和磁性介质，或者任何其它非暂时性机器可读介质。
本文所述的处理模块/单元/逻辑1028、部件以及其它特征可以实施为分立硬件部件或集成在硬件部件(诸如，asics、fpga、dsp或类似装置)的功能中。此外，处理模块/单元/逻辑1028可以实施为硬件装置内的固件或功能电路。此外，处理模块/单元/逻辑1028可以以硬件装置和软件部件的任何组合来实施。
应注意，虽然系统1000被示出为具有数据处理系统的各种部件，但是并不旨在表示使部件互连的任何特定架构或方式；因为此类细节和本公开的实施方式没有密切关系。还应当认识到，具有更少部件或可能具有更多部件的网络计算机、手持计算机、移动电话、服务器和/或其它数据处理系统也可以与本公开的实施方式一起使用。
前述详细描述中的一些部分已经根据在计算机存储器内对数据位的运算的算法和符号表示而呈现。这些算法描述和表示是数据处理领域中的技术人员所使用的方式，以将他们的工作实质最有效地传达给本领域中的其他技术人员。本文中，算法通常被认为是导致所期望结果的自洽操作序列。这些操作是指需要对物理量进行物理操控的操作。
然而，应当牢记，所有这些和类似的术语均旨在与适当的物理量关联，并且仅仅是应用于这些量的方便标记。除非在以上讨论中以其它方式明确地指出，否则应当了解，在整个说明书中，利用术语(诸如所附权利要求书中所阐述的术语)进行的讨论是指计算机系统或类似电子计算装置的动作和处理，所述计算机系统或电子计算装置操控计算机系统的寄存器和存储器内的表示为物理(电子)量的数据，并将所述数据变换成计算机系统存储器或寄存器或者其它此类信息存储设备、传输或显示装置内类似地表示为物理量的其它数据。
本公开的实施方式还涉及用于执行本文中的操作的设备。这种计算机程序被存储在非暂时性计算机可读介质中。机器可读介质包括用于以机器(例如，计算机)可读的形式存储信息的任何机构。例如，机器可读(例如，计算机可读)介质包括机器(例如，计算机)可读存储介质(例如，只读存储器(“rom”)、随机存取存储器(“ram”)、磁盘存储介质、光存储介质、闪存存储器装置)。
前述附图中所描绘的过程或方法可以由处理逻辑来执行，所述处理逻辑包括硬件(例如，电路、专用逻辑等)、软件(例如，体现在非暂时性计算机可读介质上)或两者的组合。尽管所述过程或方法在上文是依据一些顺序操作来描述的，但是应当了解，所述操作中的一些可以按不同的顺序执行。此外，一些操作可以并行地执行而不是顺序地执行。
本公开的实施方式并未参考任何特定的编程语言进行描述。应认识到，可以使用多种编程语言来实施如本文描述的本公开的实施方式的教导。
在以上的说明书中，已经参考本公开的具体示例性实施方式对本发明的实施方式进行了描述。将显而易见的是，在不脱离所附权利要求书中阐述的本发明的更宽泛精神和范围的情况下，可以对本公开作出各种修改。因此，应当在说明性意义而不是限制性意义上来理解本说明书和附图。
- 还没有人留言评论。精彩留言会获得点赞！