CN113247023B - 一种行驶规划方法、装置、计算机设备及存储介质 - Google Patents

Abstract

本公开提供了一种行驶规划方法、装置、计算机设备及存储介质，其中，该方法包括：基于目标道路的参考轨迹信息、以及自动驾驶车辆的车辆参数，确定自动驾驶车辆在当前控制周期中的运动状态参量关系信息；基于运动状态参量关系信息，确定自动驾驶车辆的横向运动状态参量关系信息、以及纵向运动状态参量关系信息；基于预设的约束条件、横向运动状态参量关系信息以及纵向运动状态参量关系信息，确定自动驾驶车辆在未来至少一个控制周期的目标运动状态。这种方法可以更为准确地对自动驾驶车辆进行实际行驶规划，从而能够对自动驾驶车辆进行更为准确的控制。

Description

一种行驶规划方法、装置、计算机设备及存储介质

技术领域

本公开涉及自动驾驶技术领域，具体而言，涉及一种行驶规划方法、装置、计算机设备及存储介质。

背景技术

随着人工智能(Artificial Intelligence，AI)的发展，自动驾驶汽车(Autonomous Vehicles)应运而生。自动驾驶汽车在实际生活中使用时，规划(Planning)和控制(Control)是自动驾驶最底层的部分，决定自动驾驶车辆在道路上如何行驶。

当前，在对自动驾驶车辆的行驶进行规划时，效率较低。

发明内容

本公开实施例至少提供一种行驶规划方法、装置、计算机设备及存储介质。

第一方面，本公开实施例提供了一种行驶规划方法，包括：基于目标道路的参考轨迹信息、以及自动驾驶车辆的车辆参数，确定所述自动驾驶车辆在当前控制周期中的运动状态参量关系信息；基于运动状态参量关系信息，确定所述自动驾驶车辆的横向运动状态参量关系信息、以及纵向运动状态参量关系信息；基于预设的约束条件、所述横向运动状态参量关系信息以及所述纵向运动状态参量关系信息，确定所述自动驾驶车辆在未来至少一个控制周期的目标运动状态。

这样，可以更为准确地对自动驾驶车辆进行实际行驶规划，从而能够对自动驾驶车辆进行更为准确的控制。

一种可选的实施方式中，所述预设约束条件包括：横向约束条件和/或纵向约束条件。

一种可选的实施方式中，所述纵向约束条件包括：所述自动驾驶车辆的纵向位移与时间的第一变化关系信息；其中，所述第一变化关系信息用于表征所述自动驾驶车辆在未来多个时刻的纵向位移边界。

一种可选的实施方式中，采用以下步骤确定所述自动驾驶车辆的纵向位移与时间的第一变化关系信息：获取障碍物在笛卡尔坐标系下的障碍物轨迹信息；将所述障碍物轨迹信息投影至弗莱纳坐标系下；基于所述障碍物轨迹信息在弗莱纳坐标系下的投影结果，确定所述自动驾驶车辆的纵向位移与时间的第一变化关系信息。

这样，利用弗莱纳坐标系可以较为容易的表征目标道路的信息，还可以将地图数据降维处理，计算量减小，提高效率，以满足行驶规划的实时性要求。

一种可选的实施方式中，所述横向约束条件包括：所述自动驾驶车辆的横向位移与时间的第二变化关系信息；其中，所述第二变换关系信息用于表征所述自动驾驶车辆在未来多个时刻的横向位移边界。

一种可选的实施方式中，采用以下步骤确定所述自动驾驶车辆的横向位移与时间的第二变化关系信息：获取障碍物在笛卡尔坐标系下的障碍物轨迹信息；将所述障碍物轨迹信息投影至弗莱纳坐标系下；基于所述障碍物轨迹信息在弗莱纳坐标系下的投影结果，确定所述自动驾驶车辆的横向位移与时间的第二变化关系信息。

一种可选的实施方式中，所述纵向约束条件还包括下述至少一种：纵向速度阈值、相邻控制周期对应的纵向位移变化量阈值、相邻控制周期对应的纵向速度变化量阈值、相邻控制周期对应的加速度变化量阈值、相邻控制周期对应的纵向变加速度变化量阈值；所述横向约束条件还包括下述至少一种：相邻控制周期的横向位移变化量阈值、相邻控制周期的横向角度变化量阈值、相邻控制周期的横向角速度变化量阈值、相邻控制周期的横向角加速度变化量阈值。

这样，通过设置多个不同的约束条件，可以在保证自动驾驶车辆安全性的同时，有针对性的对自动驾驶车辆行驶的稳定性提出更高的要求，使得自动驾驶车辆不会发生位移、速度、加速度等的突变，减少急刹车、猛冲等行为的发生，从而保证乘坐自动驾驶车辆的用户，可以在安全行驶的前提下，有更舒适的乘车体验。

一种可选的实施方式中，所述自动驾驶车辆在未来至少一个控制周期的目标运动状态，包括：所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态、以及纵向运动状态；所述基于预设的约束条件、所述横向运动状态参量关系信息以及所述纵向运动状态参量关系信息，确定所述自动驾驶车辆在未来至少一个控制周期的目标运动状态，包括：基于纵向约束条件、以及所述纵向运动状态参量关系信息、以及纵向行驶策略，确定所述自动驾驶车辆在所述未来至少一个控制周期的纵向运动状态；基于所述横向约束条件、所述横向运动状态参量关系信息、横向行驶策略、以及所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态，确定所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态。

一种可选的实施方式中，所述基于纵向约束条件、以及所述纵向运动状态参量关系信息、以及行驶策略，确定所述自动驾驶车辆在所述未来至少一个控制周期的纵向运动状态，包括：基于所述纵向约束条件、预设的优化步长、优化时间域、道路限速、车辆性能参数、以及所述纵向行驶策略，生成第一目标函数；所述第一目标函数以每个优化时间点的纵向运动状态、与目标纵向状态的第一距离为优化目标；基于所述纵向运动状态参量关系信息、以及所述纵向约束条件，在所述优化时间域内的每个优化时间点上，对第一目标函数进行最优变量序列寻优，得到由多个优化时间点的纵向车辆状态变量构成的第一变量序列；基于所述第一变量序列，确定所述自动驾驶车辆在所述未来至少一个控制周期的纵向运动状态。

这样，可以对自动驾驶车辆状态的横向、纵向进行解耦，更有针对性的进行横向、纵向的规划，使得规划的行驶策略更加细致，从而保证获得较优的自动驾驶车辆的行驶规划。

一种可选的实施方式中，基于所述横向约束条件、所述横向运动状态参量关系信息、横向行驶策略、以及所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态，确定所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态，包括：基于所述横向运动状态、所述横向行驶策略、所述预设的优化步长、优化时间域、以及所述横向约束条件，生成第二目标函数，所述第二目标函数以每个优化时间点的横向运动状态、与目标横向状态的第二距离为优化目标；基于所述横向运动状态参量关系信息、以及所述横向约束条件，在所述优化时间域内的每个优化时间点上，对第二目标函数进行最优变量序列寻优，得到由多个优化时间点的横向车辆状态变量构成的第二变量序列；基于所述第二变量序列，确定所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态。

一种可选的实施方式中，所述方法还包括：按照多个优化时间点，将该优化时间点的纵向运动状态、和该优化时间点的横向运动状态进行合并，生成优化轨迹；所述优化轨迹包括：横向运动轨迹、以及纵向速度规划曲线。

一种可选的实施方式中，运动状态参量包括：所述横向运动状态参量以及纵向运动状态参量；所述纵向运动状态参量，包括：纵向位置，纵向速度，纵向加速度及纵向变加速度中至少一种；所述横向运动状态参量包括：横向位置，横向角度，横向角速度，横向角加速度中至少一种；所述运动状态参量关系信息表征各个运动状态参量之间的关系，所述横向运动状态参量关系信息表征各个横向运动状态参量之间的关系，所述纵向运动状态参量关系信息表征各个纵向运动状态参量之间的关系。

这样，由于不同的运动状态参量可以表征不同的运动情况，因此设置较多种类的运动状态参量，可以更好的对自动驾驶车辆的行驶做出规划。

一种可选的实施方式中，所述参考轨迹信息包括：所述目标道路的中心线上的多个位置点，以及所述多个位置点分别在笛卡尔坐标系下的坐标值。

一种可选的实施方式中，所述基于目标道路的参考轨迹、以及自动驾驶车辆的车辆参数，确定所述自动驾驶车辆在当前控制周期中的运动状态参量关系信息，包括：基于所述目标道路的参考轨迹信息、以及所述自动驾驶车辆的当前位置，建立弗莱纳坐标系；在所述弗莱纳坐标系下，基于所述自动驾驶车辆的车辆参数，确定所述自动驾驶车辆在当前控制周期中的运动状态参量关系信息。

一种可选的实施方式中，所述基于运动状态参量关系信息，确定所述自动驾驶车辆的横向运动状态参量关系信息、以及纵向运动状态参量关系信息，包括：对所述运动状态参量关系信息进行横向与纵向的解耦，得到所述横向运动状态参量关系信息和/或纵向运动状态参量关系信息。

一种可选的实施方式中，所述对所述运动状态参量关系信息进行横向与纵向的解耦，包括：将所述横向状态参量的数值设置为预设数值后，基于所述运动状态参量关系信息，得到所述纵向运动状态参量关系信息；基于所述纵向运动状态参量关系信息、以及所述运动状态参量关系信息，得到所述横向运动状态参量关系信息。

这样，通过纵向运动状态参量关系信息，可以较为便利快捷地获取较优的纵向运动状态；同样的，由于自动驾驶车辆的部分横向运动状态与纵向运动状态相关，因此利用得到的较优的纵向运动状态、以及横向运动状态参量关系信息，可以较为便利快捷地获取较优的横向运动状态。

一种可选的实施方式中，所述未来至少一个控制周期的目标运动状态包括：所述至少一个控制周期的纵向变加速度以及横向变加速度。

一种可选的实施方式中，所述方法还包括：利用所述未来至少一个控制周期中的至少部分目标控制周期的目标运动状态，确定所述自动驾驶车辆在目标控制周期输出的动力参数。

这样，利用确定的目标运动状态，可以解算得到自动驾驶车辆在目标控制周期输出的动力参数，从而可以利用该动力参数更直接的对自动驾驶车辆的行驶进行控制。

第二方面，本公开实施例还提供一种行驶规划装置，包括：第一确定模块，用于基于目标道路的参考轨迹信息、以及自动驾驶车辆的车辆参数，确定所述自动驾驶车辆在当前控制周期中的运动状态参量关系信息；第二确定模块，用于基于运动状态参量关系信息，确定所述自动驾驶车辆的横向运动状态参量关系信息、以及纵向运动状态参量关系信息；第三确定模块，用于基于预设的约束条件、所述横向运动状态参量关系信息以及所述纵向运动状态参量关系信息，确定所述自动驾驶车辆在未来至少一个控制周期的目标运动状态。

第三方面，本公开可选实现方式还提供一种计算机设备，处理器、存储器，所述存储器存储有所述处理器可执行的机器可读指令，所述处理器用于执行所述存储器中存储的机器可读指令，所述机器可读指令被所述处理器执行时，所述机器可读指令被所述处理器执行时执行上述第一方面，或第一方面中任一种可能的实施方式中的步骤。

第四方面，本公开可选实现方式还提供一种计算机可读存储介质，该计算机可读存储介质上存储有计算机程序，该计算机程序被运行时执行上述第一方面，或第一方面中任一种可能的实施方式中的步骤。

关于上述行驶规划装置、计算机设备、及计算机可读存储介质的效果描述参见上述行驶规划方法的说明，这里不再赘述。

为使本公开的上述目的、特征和优点能更明显易懂，下文特举较佳实施例，并配合所附附图，作详细说明如下。

附图说明

为了更清楚地说明本公开实施例的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，此处的附图被并入说明书中并构成本说明书中的一部分，这些附图示出了符合本公开的实施例，并与说明书一起用于说明本公开的技术方案。应当理解，以下附图仅示出了本公开的某些实施例，因此不应被看作是对范围的限定，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他相关的附图。

图1示出了本公开实施例所提供的一种行驶规划方法的流程图；

图2示出了本公开实施例所提供的一种弗莱纳坐标系的示意图；

图3示出了本公开实施例所提供的一种利用自动驾驶车辆的纵向位移与时间的第一变化关系信息，确定的S-T坐标系的示意图；

图4示出了本公开实施例所提供的一种利用自动驾驶车辆的纵向位移与时间的第一变化关系信息，确定的D-T坐标系的示意图；

图5示出了本公开实施例所提供的一种行驶规划装置的示意图；

图6示出了本公开实施例所提供的一种计算机设备的示意图。

具体实施方式

为使本公开实施例的目的、技术方案和优点更加清楚，下面将结合本公开实施例中附图，对本公开实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本公开一部分实施例，而不是全部的实施例。通常在此处描述和示出的本公开实施例的组件可以以各种不同的配置来布置和设计。因此，以下对本公开的实施例的详细描述并非旨在限制要求保护的本公开的范围，而是仅仅表示本公开的选定实施例。基于本公开的实施例，本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例，都属于本公开保护的范围。

经研究发现，在控制自动驾驶车辆行驶时，通常通过对自动驾驶车辆所处的道路进行周期性的图像检测，然后依据检测得到的图像进行行驶的规划。通常，在进行行驶规划时，会采用二次规划(Quadratic Programming，QP)的方式进行。但由于二次规划方法在处理自动驾驶车辆的行驶规划的动态问题时，通常是通过拟合的方式确定横向和纵向分别对应的运动参量，而确定的运动参量并不能很好的适应于实际的运动学模型，导致利用这样的运动参量对自动驾驶车辆不能进行准确地控制，也即容易出现行驶规划的准确性较大的问题。

另外，由于在时间较短的检测周期中，二次规划方法仅能解决自动驾驶车辆在首要的安全性上的规划(也即完成避让车辆等基本操作)，但不能适时的保证稳定性(例如在避让车辆时，在控制周期中，时间仅能允许确定规划路径以保证避让的操作，而不能避免急转、突进的情况发生)，使得用户在乘坐自动驾驶车辆时，舒适性较低。

基于上述研究，本公开提供了一种行驶规划方法，利用目标道路的参考轨迹信息以及自动驾驶车辆的车辆参数，确定自动驾驶车辆在当前控制周期中的运动参量关系信息，并由此得到自动驾驶车辆在横向和纵向分别对应的运动状态参量关系信息，从而基于预设的约束条件，确定自动驾驶车辆在未来至少一个控制周期的目标运动状态，利用可以较为准确获取的运动状态参量关系信息进行实际地行驶规划，从而能够对自动驾驶车辆进行更为准确地控制。

另外，由于在行驶规划时的效率较高，数据量较少，因此可以利用能够保证稳定性的约束条件，确定更为稳定的行驶规划，以提高用户在驾驶或者乘坐自动驾驶车辆时的舒适性。

针对以上方案所存在的缺陷，均是发明人在经过实践并仔细研究后得出的结果，因此，上述问题的发现过程以及下文中本公开针对上述问题所提出的解决方案，都应该是发明人在本公开过程中对本公开做出的贡献。

应注意到：相似的标号和字母在下面的附图中表示类似项，因此，一旦某一项在一个附图中被定义，则在随后的附图中不需要对其进行进一步定义和解释。

为便于对本实施例进行理解，首先对本公开实施例所公开的一种行驶规划方法进行详细介绍，本公开实施例所提供的行驶规划方法的执行主体一般为自动驾驶控制设备。自动驾驶控制设备安装在自动驾驶车辆中，能够基于本公开实施例提供的行驶规划方法对自动驾驶的过程进行规划。在一些可能的实现方式中，该行驶规划方法可以通过处理器调用存储器中存储的计算机可读指令的方式来实现。

下面对本公开实施例提供的行驶规划方法加以说明。

参见图1所示，为本公开实施例提供的行驶规划方法的流程图，所述方法包括步骤S101～S103，其中：

S101：基于目标道路的参考轨迹信息、以及自动驾驶车辆的车辆参数，确定所述自动驾驶车辆在当前控制周期中的运动状态参量关系信息；

S102：基于运动状态参量关系信息，确定所述自动驾驶车辆的横向运动状态参量关系信息、以及纵向运动状态参量关系信息；

S103：基于预设的约束条件、所述横向运动状态参量关系信息以及所述纵向运动状态参量关系信息，确定所述自动驾驶车辆在未来至少一个控制周期的目标运动状态。

本公开实施例通过基于目标道路的参考轨迹信息、以及自动驾驶车辆的车辆参数，确定自动驾驶车辆在当前控制周期中的运动状态参量关系信息，然后依据利用运动参量关系信息确定的自动驾驶车辆的横向运动状态参量关系信息、纵向运动状态参量关系信息、以及预设的约束条件，确定自动驾驶车辆在未来至少一个控制周期的目标运动状态。这种方式与现有的方式相比，可以更为准确地对自动驾驶车辆进行实际行驶规划。此外，还可以在保证安全性的基础上，提供更稳定的行驶规划，以提高用户乘坐自动驾驶车辆时的舒适性。

下面对上述S101～S103加以详细说明。

针对上述S101，自动驾驶车辆(Autonomous vehicles)例如可以包括全自动无人驾驶汽车、半自动无人驾驶汽车等智能驾驶汽车，或者轮式移动机器人、以及履带式移动机器人等智能机器人。在不同的行驶场景中，自动驾驶车辆不同，自动驾驶车辆行驶时所处的目标道路也不同。

示例性的，在道路行驶场景中，自动驾驶车辆可以包括全自动、或半自动无人驾驶汽车。自动驾驶车辆在道路行驶场景中行驶时，对应的目标道路例如可以包括公路、桥梁道路中的行驶车道。在智能仓储场景中，自动驾驶车辆可以包括轮式移动机器人、或者履带式机器人。自动驾驶车辆在仓库中行驶时，对应的目标道路例如可以包括在在货架间预留的机器人行驶车道。

本实施例以自动驾驶车辆为智能驾驶汽车，且在道路行驶场景中行驶为例进行说明。

自动驾驶车辆在目标道路上行进时，主要通过在控制周期对自动驾驶车辆所处的目标道路进行周期性的检测，然后基于检测的结果进行行驶规划，确定在下一时刻到达的位置、速度、加速度等运动状态参量。根据这些运动状态参量，可以反解得到相应时刻，自动驾驶车辆的动力输出装置输出的力矩、以及行驶转动的角度，从而控制自动驾驶车辆行进。

其中，为了保证自动驾驶车辆在行驶时的实时性，例如可以将一个控制周期的时间设置为2s，或者为了保证自动驾驶车辆的安全性，将一个控制周期的时间缩短至1s或者1.5s。

在具体实施中，目标道路的参考轨迹信息包括目标道路的中心线上的多个位置点，以及多个位置点在笛卡尔坐标系下的坐标值。

其中，参考轨迹信息可以利用搭载在自动驾驶车辆上的其他装置获得，例如高精地图模块。具体地，高精地图模块，例如可以包括深度相机设备。高精地图模块可以利用下述至少一种方案对目标道路进行图像采集：结构光(Structured-light)、双目视觉(Stereo)、以及光飞行时间法(Time of Flight，TOF)。在高精地图模块采集到目标道路的道路图像后，还可以通过对道路图像进行检测，确定道路图像中的中心线，并确定中心线上的多个位置点。其中，中心线上的多个位置点例如可以包括中心线两端分别对应的位置点，以较为简单地确定中心线的位置；或者，可以包括中心线两端分别对应的位置点、以及在道路图像显示出的中心线中两个端点之间的至少一个点，以更加准确地表征中心线的位置。

在确定目标道路的中心线上的多个位置点后，还可以获取多个位置点在笛卡尔坐标系下的坐标值。其中，由于确定的多个位置点可以是利用搭载在自动驾驶车辆上的高精地图模块得到的，因此可以先确定多个位置点在高精地图模块采集得到的道路图像对应的图像坐标系中的位置信息，然后再利用图像坐标系、与目标道路对应的场景坐标系之间的坐标系转换关系，确定多个位置点在场景坐标系下的位置信息。由于在确定目标道路时，可以较为容易地根据全球定位系统(Global Positioning System，GPS)确定二维位置信息，因此可以依据自动驾驶车辆的所在位置作为坐标原点建立目标道路的场景坐标系，该场景坐标系即为为目标道路确定的笛卡尔坐标系。然后，利用建立得到的该笛卡尔坐标系，确定中心线上的多个位置分别对应的坐标值。

另外，还可以确定自动驾驶车辆的车辆参数。具体地，自动驾驶车辆的车辆参数可以包括动力性能参数、以及车身参数。其中，动力性能参数例如可以包括汽车满载、发动机最大扭矩、起步换挡加速度、制动性能等可以直接控制车辆行驶的参数。车身参数例如可以包括车体长度、车体宽度等可以确定车辆的行驶占据区域空间大小的参数。

在确定目标道路的参考轨迹信息、以及自动驾驶车辆的车辆参数后，即可以确定自动驾驶车辆在当前控制周期中的运动状态参量关系信息。

此处，可以根据下述方式确定自动驾驶车辆在当前控制周期中的运动状态参量关系信息：基于目标道路的参考轨迹信息、以及自动驾驶车辆的当前位置，建立弗莱纳坐标系(Frenet–Serret frame)；在弗莱纳坐标系下，基于自动驾驶车辆的车辆参数，确定自动驾驶车辆在当前控制周期中的运动状态参量关系信息。

示例性的，运动状态参量关系信息可以利用变加速度与位置、速度、以及加速度之间的相互关系公式，例如用运动学方程来表示。

具体地，由于对自动驾驶车辆的行驶规划是一个具有多个非线性约束的高维优化问题，进行处理的数据量较大，且场景较为复杂，同时出于安全性的考虑，需要保证实时性。因此在进行自动驾驶车辆的行驶规划时，选用弗莱纳坐标系，以在适应直行道路规划的同时，适应自动驾驶弯道的路线规划。同时，利用弗莱纳坐标系还可以将地图数据降维处理，计算量减小，提高效率，以满足行驶规划的实时性要求。

在具体实施中，可以根据自动驾驶车辆的当前位置确定弗莱纳坐标系的坐标原点，然后根据确定的目标道路的参考轨迹确定弗莱纳坐标系。具体地，可以以确定的坐标原点作为切点，沿着参考线的方向确定切线，作为弗莱纳坐标系的S轴，将在切点处与确定的切线垂直的法线确定为弗莱纳坐标系的D轴。

在建立弗莱纳坐标系后，基于参考线的位置，即可以简单的使用纵向距离(即沿着中心线方向的距离)、以及横向距离(即偏离中心线的距离)确定自动驾驶车辆的位置。自动驾驶车辆在纵向以及横向两个方向上的速度、加速度、变加速度等的计算也更为简单。

参见图2所示，为本公开实施例提供的一种弗莱纳坐标系的示意图；其中，包括自动驾驶车辆21、行驶道路22，在行驶道路22中包含中心线23，以及对应的弗莱纳坐标系24。

在确定运动状态参量关系信息时，由于对于自动驾驶的实际行驶场景而言，较少的存在翻滚、漂移等具有危险性和专业性的行驶需求，更多在保证交通行驶安全的前提下正常行驶，因此自动驾驶车辆的行驶动作可以简单的拆解为横向、以及纵向的不同行驶策略，也即运动状态参量可以包括横向运动状态参量以及纵向运动状态参量信息。其中，纵向运动状态参量，包括：纵向位置，纵向速度，纵向加速度及纵向变加速度中至少一种；横向运动状态参量包括：横向位置，横向角度，横向角速度，横向角加速度中至少一种。所述运动状态参量关系信息表征各个运动状态参量之间的关系，所述横向运动状态参量关系信息表征各个横向运动状态参量之间的关系，所述纵向运动状态参量关系信息表征各个纵向运动状态参量之间的关系。

其中，自动驾驶车辆在当前控制周期中的运动状态参量关系信息，例如可以根据下述至少一种模型确定：单车模型(Bicycle Model)以及四轮模型确定。具体的，在使用单车模型时，还可以细分为以后轴为原点的车辆运动模型、以质心为中心的车辆运动学模型、阿克曼转向几何模型(Ackerman Turning Geometry)。

此外，由于在利用此关系信息进行行驶规划时，最核心的部分是规划在一个控制周期中的起始点、以及结束点的位置、速度、加速度，因此在利用模型确定自动驾驶车辆在当前控制周期中的运动状态参量关系信息时，以变加速度为输入的状态量，可以确定与输出的控制量，包括位置、速度、加速度中至少一种分别对应的关系信息。此时，由于是直接利用自动驾驶车辆的变加速度作为输入确定表征其运动状态的运动状态参量关系信息的，因此得到的运动状态参量关系信息中既包含了自动驾驶车辆在纵向上的运动状态参量的相关信息，也包含了自动驾驶车辆在纵向上的运动状态参量的相关信息。

针对上述S102，在确定运动状态参量信息后，可以对运动状态参量关系信息进行横向与纵向的解耦，得到横向运动状态参量关系信息和/或纵向运动状态参量关系信息。

其中，在对运动状态参量关系信息进行横向与纵向的解耦时，例如可以采用下述方式：将横向状态参量的数值设置为预设数值后，基于运动状态参量关系信息，得到纵向运动状态参量关系信息；基于纵向运动状态参量关系信息、以及运动状态参量关系信息，得到横向运动状态参量关系信息。

具体地，在确定纵向运动状态参量关系信息时，可以将可以表征横向状态的数值，例如横向角加速度，设置为预设数值，例如为0，以消除横向的移动对纵向可能造成的影响。然后，在状态参量关系信息中带入横向角加速度的数值0，即可得到纵向运动状态参量关系信息。此时，即可以确定自动驾驶车辆的在纵向上的运动状态参量的相关信息，利用得到的此在纵向上的运动状态参量的相关信息、以及运动状态参量信息，即可以确定在横向上的运动状态参量的相关信息，完成对自动驾驶车辆横向、纵向上运动状态参量信息的解耦。

针对上述S103，预设的约束条件例如可以包括横向约束条件、以及纵向约束条件。其中，纵向约束条件例如可以包括所述自动驾驶车辆的纵向位移与时间的第一变化关系信息；其中，所述第一变化关系信息用于表征所述自动驾驶车辆在未来多个时刻的纵向位移边界。

另外，纵向约束条件还包括下述至少一种：自动驾驶车辆的纵向位移与时间的第一变化关系信息、纵向速度阈值、相邻控制周期对应的纵向位移变化量阈值、相邻控制周期对应的纵向速度变化量阈值、相邻控制周期对应的加速度变化量阈值、相邻控制周期对应的纵向变加速度变化量阈值。

纵向约束条件的说明，如下述(1a)～(1d)：

(1a)、自动驾驶车辆的纵向位移与时间的第一变化关系信息。

具体地，例如可以利用下述方式确定第一变化关系信息：获取障碍物在笛卡尔坐标系下的障碍物轨迹信息；将所述障碍物轨迹信息投影至弗莱纳坐标系下；基于所述障碍物轨迹信息在弗莱纳坐标系下的投影结果，确定所述自动驾驶车辆的纵向位移与时间的第一变化关系信息。

其中，障碍物预测轨迹信息例如可以是在自动驾驶车辆上搭载的预测模块、或者其他感知模块输出的轨迹信息。具体地，预测模块例如可以包括能够实时获取障碍物轨迹信息的激光雷达设备。

此时，得到的障碍物预测轨迹，与上述S101中确定的多个位置点分别在笛卡尔坐标系下的坐标值相似，均为在笛卡尔坐标系下的坐标值。然后，利用与上述S101中使用的图像坐标系、与目标道路对应的场景坐标系之间的坐标系转换关系，即可以将障碍物轨迹信息投影在弗莱纳坐标系下，并基于障碍物轨迹信息在弗莱纳坐标系下的投影结果，确定自动驾驶车辆的纵向位移与时间的第一变化关系信息。

参见图3所示，为本公开实施例提供的一种利用自动驾驶车辆的纵向位移与时间的第一变化关系信息，确定的S-T坐标系的示意图。其中，S-T坐标系的横坐标31，表征时间t；S-T坐标系的纵坐标32，表征自动驾驶车辆的纵向位移距离s。

在t0～t1时间段，自动驾驶车辆的前方存在车辆A，车辆A的轨迹33限制自动驾驶车辆在此时段的任意时刻向前行驶的最大距离为s1，若自动驾驶车辆向前行驶距离超过s1，则有较大的可能性与车辆A相撞。在t1～t2时间段，车辆A的行驶轨迹33发生变化，变化为行驶轨迹34，存在加速远离自动驾驶车辆的行驶行为，因此自动驾驶车辆可以向前行驶的最大距离，随着车辆A的快速驶离，自动驾驶车辆在从t1～t2最大能够行驶的距离变化至s2。

在t2时刻，车辆B对自动驾驶车辆进行超车，为了可以避免与该车辆B碰撞，自动驾驶车辆在t2时刻的向前行驶距离不应低于s3，否则将与车辆B相撞。在t2～t3时间段，由于车辆A与自动驾驶车辆行驶距离较远，不构成安全性威胁，但是由于车辆自身速度限制、以及道路限速规则的限制，存在可向前行驶的最大距离s4。

此外，由于在纵向，自动驾驶车辆的行进路线一般为前进向，因此车辆的投影轨迹仅在s轴的正半轴出现。当自动驾驶车辆的行进路线为后退方向时，例如倒车的场景，存在向车辆方向靠近的障碍物时，需要紧急制动，因此不在该示例中。

(1b)、纵向速度阈值。

纵向速度阈值，例如可以仅包括速度的上界，例如速度最高不得超过80公里/小时；或者仅包括速度的下界，例如速度最低不得低于5公里/小时；或者既包括速度的上界，又包括速度的下界，例如速度限制在5公里/小时与80公里/小时之间。具体地，可以根据实际的道路限速规则制定，例如在学校附近区域行驶时，规定限速30公里/小时，因此可以设置纵向速度阈值包括速度的上界30公里/小时；在高速路段行驶时，规定最低速度不得低于60公里/小时，且不得超过120公里/小时，因此可以设置纵向速度阈值包括速度的上界120公里/小时，以及速度的下界60公里/小时。

此外，在设置纵向速度阈值时，还可以在满足安全性的前提下，基于预设的驾驶策略进行设置，以提高在使用该自动驾驶车辆时的舒适度。示例性的，在高速路段行驶时，由于在刚进入高速路段时，需要有加速的过程，而在行驶一段距离，例如500米后，车辆即可以进入高速行驶的状态，因此可以在不得低于60公里/小时，且不得超过120公里/小时的规定限速内，设置不得低于80公里/小时，且不得超过100公里/小时的更小范围的限速的驾驶策略，以使自动驾驶车辆能够在保证安全行驶的前提下，较为匀速的行驶，可以使自动驾驶车辆在行驶时保持稳定，较少的出现由于速度变化过大，导致的人体猛冲或者后仰的行为，有助于提高用户在乘坐自动驾驶汽车时的舒适度。

(1c)、相邻控制周期对应的纵向位移变化量阈值。

其中，通过相邻控制周期对应的纵向位移变化量阈值，可以设置在较长一段时间内自动驾驶车辆保持较为匀速的行驶，并且，还可以保证在存在需要避让或者超车的车辆出现时，自动驾驶车辆实现较为平缓的变速。

示例性的，由于在速度保持不变时，相邻控制周期对应的纵向位移变化量应当保持不变；在速度仅有较小程度的变化时，相邻控制周期对应的纵向位移变化量对应的会有较小程度的变化，因此可以根据实际情况设置相邻控制周期对应的纵向位移变化量阈值例如包括不超过100米，或者不超过200米，以保证自动驾驶车辆可以在较小幅度的速度变化下行驶，减少速度突变的情况。

(1d)、相邻控制周期对应的纵向速度变化量阈值、相邻控制周期对应的加速度变化量阈值、相邻控制周期对应的纵向变加速度变化量阈值。

其中，由于(1d)中的任一纵向变化量阈值的设置方式与(1c)中相邻控制周期对应的纵向位移变化量阈值的设置的方式相似，因此此处不再进行赘述。

类似的，横向约束条件例如可以包括所述自动驾驶车辆的横向位移与时间的第二变化关系信息；其中，所述第二变换关系信息用于表征所述自动驾驶车辆在未来多个时刻的横向位移边界。

另外，横向约束条件还包括下述至少一种：自动驾驶车辆的横向位移与时间的第二变化关系信息、相邻控制周期对应的横向位移变化量阈值、相邻控制周期对应的横向角度变化量阈值、相邻控制周期对应的横向角速度变化量阈值、相邻控制周期对应的横向角加速度变化量阈值。

横向约束条件的说明，如下述(2a)～(2c)：

(2a)、自动驾驶车辆的横向位移与时间的第二变化关系信息。

具体地，例如可以利用下述方式确定第二变化关系信息：获取障碍物在笛卡尔坐标系下的障碍物轨迹信息；将所述障碍物轨迹信息投影至弗莱纳坐标系下；基于所述障碍物轨迹信息在弗莱纳坐标系下的投影结果，确定所述自动驾驶车辆的横向位移与时间的第二变化关系信息。

其中，确定第二变化关系信息的方式，与上述(1a)中确定第一变化关系信息的方式相似，在此不再赘述。

参见图4所示，为本公开实施例提供的一种利用自动驾驶车辆的纵向位移与时间的第一变化关系信息，确定的D-T坐标系的示意图。其中，d-t坐标系的横坐标41，表征时间t；D-T坐标系的纵坐标42，表征自动驾驶车辆的横向位移距离d。图中，以D轴的负半轴表征自动驾驶车辆与右侧的道路边线之间的距离；以D轴的负半轴表征自动驾驶车辆与左侧的道路边线之间的距离。

此处，为了便于理解，认为该自动驾驶车辆沿目标道路的中心线为基准行驶，因此，为了躲避左右两个车道上并入中心线的车辆，该自动驾驶车辆可以沿中心线向两侧偏离。并且，自动驾驶车辆左侧、右侧的道路边线，与中心线的距离分别为s1、s2。

在t0～t1时间段，自动驾驶车辆右侧存在车辆C，车辆C的行驶轨迹43使得自动驾驶车辆向右行驶受限，且向右行驶的距离根据车辆C的行驶轨迹43限制在s3内。在t1～t2时间段，车辆C驶出，自动驾驶车辆可向右行驶的距离恢复至最大距离s2。同时，在t0～t2时间段，由于自动驾驶车辆的左侧没有并入的车辆，因此可以向左行驶的距离为最大的向左行驶距离s1。

在t2～t3时间段，自动驾驶车辆右侧存在车辆D，车辆D的行驶轨迹44使得自动驾驶车辆向右行驶受限，且向右行驶的距离根据车辆D的行驶轨迹44限制在s4内。同样的，在t3时刻，车辆D驶离自动驾驶车辆，自动驾驶车辆可向左行驶的距离恢复至最大距离s1。同时，在t2时刻以后，由于自动驾驶车辆的右侧没有并入的车辆，因此可以向右行驶的距离为最大的向右行驶距离s2。

(2b)、相邻控制周期对应的横向位移变化量阈值。

此处，相邻控制周期对应的横向位移变化量阈值的确定方式，与上述(1c)中确定相邻控制周期对应的纵向位移变化量阈值的方式相似，再次不再赘述。

(2c)、相邻控制周期对应的横向角度变化量阈值、相邻控制周期对应的横向角速度变化量阈值、相邻控制周期对应的横向角加速度变化量阈值。

其中，由于(2c)中的任一横向的变化量阈值的设置方式与(2b)中相邻控制周期对应的横向位移变化量阈值的设置的方式相似，因此此处不再进行赘述。

此时，在基于预设的约束条件、横向运动状态参量关系信息以及纵向运动状态参量关系信息，确定自动驾驶车辆在未来至少一个控制周期分别对应的目标运动状态时，例如可以采用下述方式：基于纵向约束条件、以及所述纵向运动状态参量关系信息、以及纵向行驶策略，确定所述自动驾驶车辆在所述未来至少一个控制周期的纵向运动状态；基于所述横向约束条件、所述横向运动状态参量关系信息、横向行驶策略、以及所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态，确定所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态。

其中，未来至少一个控制周期分别对应的目标运动状态包括：所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态、以及纵向运动状态。具体地，至少一个控制周期分别对应的纵向变加速度以及横向变加速度例如可以作为表征所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态、以及纵向运动状态的一个运行参量。

在具体实施中，在基于纵向约束条件、以及所述纵向运动状态参量关系信息、以及行驶策略，确定所述自动驾驶车辆在所述未来至少一个控制周期的纵向运动状态时，例如可以采用下述方式：基于所述纵向约束条件、预设的优化步长、优化时间域、道路限速、车辆性能参数、以及所述纵向行驶策略，生成第一目标函数；所述第一目标函数以每个优化时间点的纵向运动状态、与目标纵向状态的第一距离为优化目标；基于所述纵向运动状态参量关系信息、以及所述纵向约束条件，在所述优化时间域内的每个优化时间点上，对第一目标函数进行最优变量序列寻优，得到由多个优化时间点的纵向车辆状态变量构成的第一变量序列；基于所述第一变量序列，确定所述自动驾驶车辆在所述未来至少一个控制周期的纵向运动状态。

其中，纵向约束条件可以参见上述对纵向约束条件的说明，这里不再赘述。预设的优化步长例如可以根据自动驾驶系统的可选步长、或者根据实际的驾驶需求确定，具体可以包括0.1秒或0.2秒，以保证自动驾驶车辆能够迅速对不断变化的行驶环境做出反应。另外，还可以设置优化时间域，在一次行驶规划中，能够得到该优化时间域内多个优化时间点分别对应的运动状态。随着自动驾驶车辆的驾驶，可以按照控制周期，实时进行运动状态的优化，以提升控制精度。

对于道路限速、车辆性能参数而言，由于对应于不同的道路，其对应的道路限速是确定的，因此可以根据实际行驶的路段相应的确定对应时刻的道路限速；而对于车辆性能参数，不同的自动驾驶车辆由与其相对应的车辆参数，具体可以参见上述S101对应的实施例中对自动驾驶车辆的车辆参数的说明，在此不再赘述。

另外，纵向形式策略例如可以包括自动驾驶车辆在纵向行驶时的行为策略，例如可以包括在纵向上的超车、避让等的行为策略。

利用上述说明的纵向对应的相关信息可以确定第一目标函数，第一目标函数例如可以包括以优化时间点为自变量，并利用上述说明的纵向对应的相关信息作为映射关系信息，将目标纵向状态的第一距离作为因变量，也即优化目标。

在利用纵向运动状态参量关系信息、以及所述纵向约束条件，在所述优化时间域内的每个优化时间点上，对第一目标函数进行最优变量序列寻优时，例如可以利用第一目标函数建立纵向优化模型，然后，将纵向约束条件作为纵向优化模型的约束条件，确定未来至少一个控制周期分别对应的最优的一个或者多个第一变量序列。然后，在根据所述第一变量序列，确定所述自动驾驶车辆在所述未来至少一个控制周期的纵向运动状态。

另外，在利用纵向优化模型确定纵向运动状态时，为了保证得到的纵向运动状态在应用于实际的控制周期时保证稳定性，以使乘坐的用户能更加舒适的行车环境，还可以引入惩罚方法，例如可以通过确定相邻控制周期对应的纵向运动状态中的纵向位移变化量、相邻控制周期对应的纵向速度变化量、相邻控制周期对应的加速度变化量、相邻控制周期对应的纵向变加速度变化量，设定惩罚。

具体地，在设定惩罚时，例如可以直接依据各个变化量作为惩罚，在变化量较大时，训练模型向变化量较小的方向输出纵向运动状态。此外，在希望获得更为稳定的纵向运动状态时，还可以将对变化量进行平方、三次方等运算处理，并将运算处理后的结果作为惩罚，以加大对纵向优化模型的调整力度，输出在相邻控制周期之间变化量更小的纵向运动状态，以使自动驾驶车辆在行驶过程中在保证安全性的同时，更加稳定舒适。

同样的，在确定自动驾驶车辆在未来至少一个控制周期分别对应的横向运动状态时，由于自动驾驶车辆的横向运动状态会受到纵向运动状态的影响，例如在纵向行驶过程较快时，若有并道的车辆出现，需要更早的进行横向移动，以保证可以安全的避让，并且以较为缓和的方式偏转行进。因此，在具体确定自动驾驶车辆在未来至少一个控制周期分别对应的横向运动状态的方式时，还需要考虑自动驾驶车辆在未来至少一个控制周期分别对应的纵向运动状态，例如将确定的纵向运动状态作为确定横向运动状态时的约束条件。

具体地，在确定自动驾驶车辆在未来至少一个控制周期分别对应的横向运动状态时，例如可以采用下述方法：基于所述横向运动状态、所述横向行驶策略、所述预设的优化步长、优化时间域、以及所述横向约束条件，生成第二目标函数，所述第二目标函数以每个优化时间点的横向运动状态、与目标横向状态的第二距离为优化目标；基于所述横向运动状态参量关系信息、以及所述横向约束条件，在所述优化时间域内的每个优化时间点上，对第二目标函数进行最优变量序列寻优，得到由多个优化时间点的横向车辆状态变量构成的第二变量序列；基于所述第二变量序列，确定所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态。

此处，确定自动驾驶车辆在未来至少一个控制周期分别对应的横向运动状态的方式，与上述确定自动驾驶车辆在未来至少一个控制周期分别对应的纵向运动状态的方式相似，在此不再赘述。

在确定未来至少一个控制周期的横向运动状态、以及未来至少一个控制周期的纵向运动状态后，还可以按照多个优化时间点，将该优化时间点的纵向运动状态、和该优化时间点的横向运动状态进行合并，生成优化轨迹；所述优化轨迹包括：横向运动轨迹、以及纵向速度规划曲线。

其中，由于各优化时间点对应的横向运动状态、以及纵向运动状态均已经确定，因此可以按照相同的优化时间点对横向运动状态以及纵向运动状态进行合并，从而得到一条包含横、纵向位置，并且考虑到安全性和舒适性的三维优化轨迹。

在本公开另一实施例中，在确定自动驾驶车辆在未来至少一个控制周期分别对应的纵向运动状态、以及确定自动驾驶车辆在未来至少一个控制周期分别对应的横向运动状态后，还包括：利用未来至少一个控制周期中的至少部分目标控制周期分别对应的目标运动状态，确定自动驾驶车辆在目标控制周期输出的动力参数。

具体地，目标控制周期例如可以包括可以确定纵向运动状态、以及横向运动状态的至少一个控制周期。

在确定自动驾驶车辆在未来至少一个控制周期分别对应的纵向运动状态、以及确定自动驾驶车辆在未来至少一个控制周期分别对应的横向运动状态后，由于对于未来至少一个控制周期，均确定了对应的纵向运动状态以及横向运动状态，因此，可以在未来至少一个控制周期将纵向运动状态以及横向运动状态按照控制周期中相同的时间点进行合并，以完成对自动驾驶车辆的行驶规划。在确定自动驾驶车辆的行驶规划后，利用规划的结果，可以确定自动驾驶车辆在未来至少一个控制周期中任一时刻的运动状态，作为目标运动状态，并根据自动驾驶车辆的动力参数与行驶行为的对应关系，确定在目标控制周期输出的动力参数。

本领域技术人员可以理解，在具体实施方式的上述方法中，各步骤的撰写顺序并不意味着严格的执行顺序而对实施过程构成任何限定，各步骤的具体执行顺序应当以其功能和可能的内在逻辑确定。

基于同一发明构思，本公开实施例中还提供了与行驶规划方法对应的行驶规划装置，由于本公开实施例中的装置解决问题的原理与本公开实施例上述行驶规划方法相似，因此装置的实施可以参见方法的实施，重复之处不再赘述。

参照图5所示，为本公开实施例提供的一种行驶规划装置的示意图，所述装置包括：第一确定模块51、第二确定模块52、第三确定模块53；其中，

第一确定模块51，用于基于目标道路的参考轨迹信息、以及自动驾驶车辆的车辆参数，确定所述自动驾驶车辆在当前控制周期中的运动状态参量关系信息；第二确定模块52，用于基于运动状态参量关系信息，确定所述自动驾驶车辆的横向运动状态参量关系信息、以及纵向运动状态参量关系信息；第三确定模块53，用于基于预设的约束条件、所述横向运动状态参量关系信息以及所述纵向运动状态参量关系信息，确定所述自动驾驶车辆在未来至少一个控制周期的目标运动状态。

一种可选的实施方式中，所述预设约束条件包括：横向约束条件和/或纵向约束条件。

一种可选的实施方式中，所述纵向约束条件包括：所述自动驾驶车辆的纵向位移与时间的第一变化关系信息；其中，所述第一变化关系信息用于表征所述自动驾驶车辆在未来多个时刻的纵向位移边界。

一种可选的实施方式中，所述第三确定模块53采用以下步骤确定所述自动驾驶车辆的纵向位移与时间的第一变化关系信息：获取障碍物在笛卡尔坐标系下的障碍物轨迹信息；将所述障碍物轨迹信息投影至弗莱纳坐标系下；基于所述障碍物轨迹信息在弗莱纳坐标系下的投影结果，确定所述自动驾驶车辆的纵向位移与时间的第一变化关系信息。

一种可选的实施方式中，所述横向约束条件包括：所述自动驾驶车辆的横向位移与时间的第二变化关系信息；其中，所述第二变换关系信息用于表征所述自动驾驶车辆在未来多个时刻的横向位移边界。

一种可选的实施方式中，所述第三确定模块53采用以下步骤确定所述自动驾驶车辆的横向位移与时间的第二变化关系信息：获取障碍物在笛卡尔坐标系下的障碍物轨迹信息；将所述障碍物轨迹信息投影至弗莱纳坐标系下；基于所述障碍物轨迹信息在弗莱纳坐标系下的投影结果，确定所述自动驾驶车辆的横向位移与时间的第二变化关系信息。

一种可选的实施方式中，所述纵向约束条件还包括下述至少一种：纵向速度阈值、相邻控制周期对应的纵向位移变化量阈值、相邻控制周期对应的纵向速度变化量阈值、相邻控制周期对应的加速度变化量阈值、相邻控制周期对应的纵向变加速度变化量阈值；所述横向约束条件还包括下述至少一种：相邻控制周期的横向位移变化量阈值、相邻控制周期的横向角度变化量阈值、相邻控制周期的横向角速度变化量阈值、相邻控制周期的横向角加速度变化量阈值。

一种可选的实施方式中，所述自动驾驶车辆在未来至少一个控制周期的目标运动状态，包括：所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态、以及纵向运动状态；所述第三确定模块53在基于预设的约束条件、所述横向运动状态参量关系信息以及所述纵向运动状态参量关系信息，确定所述自动驾驶车辆在未来至少一个控制周期的目标运动状态时，用于：基于纵向约束条件、以及所述纵向运动状态参量关系信息、以及纵向行驶策略，确定所述自动驾驶车辆在所述未来至少一个控制周期的纵向运动状态；基于所述横向约束条件、所述横向运动状态参量关系信息、横向行驶策略、以及所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态，确定所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态。

一种可选的实施方式中，所述第三确定模块53在基于纵向约束条件、以及所述纵向运动状态参量关系信息、以及行驶策略，确定所述自动驾驶车辆在所述未来至少一个控制周期的纵向运动状态时，用于：基于所述纵向约束条件、预设的优化步长、优化时间域、道路限速、车辆性能参数、以及所述纵向行驶策略，生成第一目标函数；所述第一目标函数以每个优化时间点的纵向运动状态、与目标纵向状态的第一距离为优化目标；基于所述纵向运动状态参量关系信息、以及所述纵向约束条件，在所述优化时间域内的每个优化时间点上，对第一目标函数进行最优变量序列寻优，得到由多个优化时间点的纵向车辆状态变量构成的第一变量序列；基于所述第一变量序列，确定所述自动驾驶车辆在所述未来至少一个控制周期的纵向运动状态。

一种可选的实施方式中，所述第三确定模块53在基于所述横向约束条件、所述横向运动状态参量关系信息、横向行驶策略、以及所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态，确定所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态时，用于：基于所述横向运动状态、所述横向行驶策略、所述预设的优化步长、优化时间域、以及所述横向约束条件，生成第二目标函数，所述第二目标函数以每个优化时间点的横向运动状态、与目标横向状态的第二距离为优化目标；基于所述横向运动状态参量关系信息、以及所述横向约束条件，在所述优化时间域内的每个优化时间点上，对第二目标函数进行最优变量序列寻优，得到由多个优化时间点的横向车辆状态变量构成的第二变量序列；基于所述第二变量序列，确定所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态。

一种可选的实施方式中，所述行驶规划装置还包括轨迹生成模块54，用于：按照多个优化时间点，将该优化时间点的纵向运动状态、和该优化时间点的横向运动状态进行合并，生成优化轨迹；所述优化轨迹包括：横向运动轨迹、以及纵向速度规划曲线。

一种可选的实施方式中，运动状态参量包括：所述横向运动状态参量以及纵向运动状态参量；所述纵向运动状态参量，包括：纵向位置，纵向速度，纵向加速度及纵向变加速度中至少一种；所述横向运动状态参量包括：横向位置，横向角度，横向角速度，横向角加速度中至少一种；所述运动状态参量关系信息表征各个运动状态参量之间的关系，所述横向运动状态参量关系信息表征各个横向运动状态参量之间的关系，所述纵向运动状态参量关系信息表征各个纵向运动状态参量之间的关系。

一种可选的实施方式中，所述参考轨迹信息包括：所述目标道路的中心线上的多个位置点，以及所述多个位置点分别在笛卡尔坐标系下的坐标值。

一种可选的实施方式中，所述第一确定模块51在基于目标道路的参考轨迹、以及自动驾驶车辆的车辆参数，确定所述自动驾驶车辆在当前控制周期中的运动状态参量关系信息时，用于：基于所述目标道路的参考轨迹信息、以及所述自动驾驶车辆的当前位置，建立弗莱纳坐标系；在所述弗莱纳坐标系下，基于所述自动驾驶车辆的车辆参数，确定所述自动驾驶车辆在当前控制周期中的运动状态参量关系信息。

一种可选的实施方式中，所述第二确定模块52在基于运动状态参量关系信息，确定所述自动驾驶车辆的横向运动状态参量关系信息、以及纵向运动状态参量关系信息时，用于：对所述运动状态参量关系信息进行横向与纵向的解耦，得到所述横向运动状态参量关系信息和/或纵向运动状态参量关系信息。

一种可选的实施方式中，所述第二确定模块52在对所述运动状态参量关系信息进行横向与纵向的解耦时，用于：将所述横向状态参量的数值设置为预设数值后，基于所述运动状态参量关系信息，得到所述纵向运动状态参量关系信息；基于所述纵向运动状态参量关系信息、以及所述运动状态参量关系信息，得到所述横向运动状态参量关系信息。

一种可选的实施方式中，所述未来至少一个控制周期的目标运动状态包括：所述至少一个控制周期的纵向变加速度以及横向变加速度。

一种可选的实施方式中，所述行驶规划装置还包括，第四确定模块55，用于：利用所述未来至少一个控制周期中的至少部分目标控制周期的目标运动状态，确定所述自动驾驶车辆在目标控制周期输出的动力参数。

关于装置中的各模块的处理流程、以及各模块之间的交互流程的描述可以参照上述方法实施例中的相关说明，这里不再详述。

本公开实施例还提供了一种计算机设备，如图6所示，为本公开实施例提供的计算机设备结构示意图，包括：

处理器10和存储器20；所述存储器20存储有处理器10可执行的机器可读指令，处理器10用于执行存储器20中存储的机器可读指令，所述机器可读指令被处理器10执行时，处理器10执行下述步骤：

基于目标道路的参考轨迹信息、以及自动驾驶车辆的车辆参数，确定所述自动驾驶车辆在当前控制周期中的运动状态参量关系信息；基于运动状态参量关系信息，确定所述自动驾驶车辆的横向运动状态参量关系信息、以及纵向运动状态参量关系信息；基于预设的约束条件、所述横向运动状态参量关系信息以及所述纵向运动状态参量关系信息，确定所述自动驾驶车辆在未来至少一个控制周期的目标运动状态。

上述存储器20包括内存210和外部存储器220；这里的内存210也称内存储器，用于暂时存放处理器10中的运算数据，以及与硬盘等外部存储器220交换的数据，处理器10通过内存210与外部存储器220进行数据交换。

上述指令的具体执行过程可以参考本公开实施例中所述的行驶规划方法的步骤，此处不再赘述。

本公开实施例还提供一种计算机可读存储介质，该计算机可读存储介质上存储有计算机程序，该计算机程序被处理器运行时执行上述方法实施例中所述的行驶规划方法的步骤。其中，该存储介质可以是易失性或非易失的计算机可读取存储介质。

本公开实施例还提供一种计算机程序产品，该计算机程序产品承载有程序代码，所述程序代码包括的指令可用于执行上述方法实施例中所述的行驶规划方法的步骤，具体可参见上述方法实施例，在此不再赘述。

其中，上述计算机程序产品可以具体通过硬件、软件或其结合的方式实现。在一个可选实施例中，所述计算机程序产品具体体现为计算机存储介质，在另一个可选实施例中，计算机程序产品具体体现为软件产品，例如软件开发包(Software Development Kit，SDK)等等。

所属领域的技术人员可以清楚地了解到，为描述的方便和简洁，上述描述的系统和装置的具体工作过程，可以参考前述方法实施例中的对应过程，在此不再赘述。在本公开所提供的几个实施例中，应该理解到，所揭露的系统、装置和方法，可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的，例如，所述单元的划分，仅仅为一种逻辑功能划分，实际实现时可以有另外的划分方式，又例如，多个单元或组件可以结合或者可以集成到另一个系统，或一些特征可以忽略，或不执行。另一点，所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些通信接口，装置或单元的间接耦合或通信连接，可以是电性，机械或其它的形式。

所述作为分离部件说明的单元可以是或者也可以不是物理上分开的，作为单元显示的部件可以是或者也可以不是物理单元，即可以位于一个地方，或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。

另外，在本公开各个实施例中的各功能单元可以集成在一个处理单元中，也可以是各个单元单独物理存在，也可以两个或两个以上单元集成在一个单元中。

所述功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时，可以存储在一个处理器可执行的非易失的计算机可读取存储介质中。基于这样的理解，本公开的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来，该计算机软件产品存储在一个存储介质中，包括若干指令用以使得一台计算机设备(可以是个人计算机，服务器，或者网络设备等)执行本公开各个实施例所述方法的全部或部分步骤。而前述的存储介质包括：U盘、移动硬盘、只读存储器(Read-OnlyMemory，ROM)、随机存取存储器(Random Access Memory，RAM)、磁碟或者光盘等各种可以存储程序代码的介质。

最后应说明的是：以上所述实施例，仅为本公开的具体实施方式，用以说明本公开的技术方案，而非对其限制，本公开的保护范围并不局限于此，尽管参照前述实施例对本公开进行了详细的说明，本领域的普通技术人员应当理解：任何熟悉本技术领域的技术人员在本公开揭露的技术范围内，其依然可以对前述实施例所记载的技术方案进行修改或可轻易想到变化，或者对其中部分技术特征进行等同替换；而这些修改、变化或者替换，并不使相应技术方案的本质脱离本公开实施例技术方案的精神和范围，都应涵盖在本公开的保护范围之内。因此，本公开的保护范围应所述以权利要求的保护范围为准。

Claims (19)

1.一种行驶规划方法，其特征在于，包括：

基于目标道路的参考轨迹信息、以及自动驾驶车辆的车辆参数，确定所述自动驾驶车辆在当前控制周期中的运动状态参量关系信息；所述目标道路的参考轨迹信息包括目标道路的中心线上的多个位置点；

基于运动状态参量关系信息，确定所述自动驾驶车辆的横向运动状态参量关系信息、以及纵向运动状态参量关系信息；

基于预设的约束条件、所述横向运动状态参量关系信息以及所述纵向运动状态参量关系信息，确定所述自动驾驶车辆在未来至少一个控制周期的目标运动状态；所述目标运动状态用于生成优化轨迹，所述优化轨迹包括：横向运动轨迹、以及纵向速度规划曲线。

2.根据权利要求1所述的行驶规划方法，其特征在于，所述预设约束条件包括：横向约束条件和/或纵向约束条件。

3.根据权利要求2所述的行驶规划方法，其特征在于，所述纵向约束条件包括：

所述自动驾驶车辆的纵向位移与时间的第一变化关系信息；

其中，所述第一变化关系信息用于表征所述自动驾驶车辆在未来多个时刻的纵向位移边界。

4.根据权利要求3所述的行驶规划方法，其特征在于，采用以下步骤确定所述自动驾驶车辆的纵向位移与时间的第一变化关系信息：

获取障碍物在笛卡尔坐标系下的障碍物轨迹信息；

将所述障碍物轨迹信息投影至弗莱纳坐标系下；

基于所述障碍物轨迹信息在弗莱纳坐标系下的投影结果，确定所述自动驾驶车辆的纵向位移与时间的第一变化关系信息。

5.根据权利要求2-4任一项所述的行驶规划方法，其特征在于，所述横向约束条件包括：

所述自动驾驶车辆的横向位移与时间的第二变化关系信息；

其中，所述第二变换关系信息用于表征所述自动驾驶车辆在未来多个时刻的横向位移边界。

6.根据权利要求5所述的行驶规划方法，其特征在于，采用以下步骤确定所述自动驾驶车辆的横向位移与时间的第二变化关系信息：

获取障碍物在笛卡尔坐标系下的障碍物轨迹信息；

将所述障碍物轨迹信息投影至弗莱纳坐标系下；

基于所述障碍物轨迹信息在弗莱纳坐标系下的投影结果，确定所述自动驾驶车辆的横向位移与时间的第二变化关系信息。

7.根据权利要求2-6任一项所述的行驶规划方法，其特征在于，所述纵向约束条件还包括下述至少一种：

纵向速度阈值、相邻控制周期对应的纵向位移变化量阈值、相邻控制周期对应的纵向速度变化量阈值、相邻控制周期对应的加速度变化量阈值、相邻控制周期对应的纵向变加速度变化量阈值；

所述横向约束条件还包括下述至少一种：

相邻控制周期的横向位移变化量阈值、相邻控制周期的横向角度变化量阈值、相邻控制周期的横向角速度变化量阈值、相邻控制周期的横向角加速度变化量阈值。

8.根据权利要求1-7任一项所述的行驶规划方法，其特征在于，所述自动驾驶车辆在未来至少一个控制周期的目标运动状态，包括：所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态、以及纵向运动状态；

所述基于预设的约束条件、所述横向运动状态参量关系信息以及所述纵向运动状态参量关系信息，确定所述自动驾驶车辆在未来至少一个控制周期的目标运动状态，包括：

基于纵向约束条件、以及所述纵向运动状态参量关系信息、以及纵向行驶策略，确定所述自动驾驶车辆在所述未来至少一个控制周期的纵向运动状态；

基于所述横向约束条件、所述横向运动状态参量关系信息、横向行驶策略、以及所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态，确定所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态。

9.根据权利要求8所述的行驶规划方法，其特征在于，所述基于纵向约束条件、以及所述纵向运动状态参量关系信息、以及纵向行驶策略，确定所述自动驾驶车辆在所述未来至少一个控制周期的纵向运动状态，包括：

基于所述纵向约束条件、预设的优化步长、优化时间域、道路限速、车辆性能参数、以及所述纵向行驶策略，生成第一目标函数；所述第一目标函数以每个优化时间点的纵向运动状态、与目标纵向状态的第一距离为优化目标；

基于所述纵向运动状态参量关系信息、以及所述纵向约束条件，在所述优化时间域内的每个优化时间点上，对第一目标函数进行最优变量序列寻优，得到由多个优化时间点的纵向车辆状态变量构成的第一变量序列；

基于所述第一变量序列，确定所述自动驾驶车辆在所述未来至少一个控制周期的纵向运动状态。

10.根据权利要求8或9所述的行驶规划方法，其特征在于，基于所述横向约束条件、所述横向运动状态参量关系信息、横向行驶策略、以及所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态，确定所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态，包括：

基于所述横向运动状态、所述横向行驶策略、所述预设的优化步长、优化时间域、以及所述横向约束条件，生成第二目标函数，所述第二目标函数以每个优化时间点的横向运动状态、与目标横向状态的第二距离为优化目标；

基于所述横向运动状态参量关系信息、以及所述横向约束条件，在所述优化时间域内的每个优化时间点上，对第二目标函数进行最优变量序列寻优，得到由多个优化时间点的横向车辆状态变量构成的第二变量序列；

基于所述第二变量序列，确定所述自动驾驶车辆在所述未来至少一个控制周期的横向运动状态。

11.根据权利要求1-10任一项所述的行驶规划方法，其特征在于，所述优化轨迹采用下述方式生成：按照多个优化时间点，将该优化时间点的纵向运动状态、和该优化时间点的横向运动状态进行合并，生成优化轨迹。

12.根据权利要求1-11任一项所述的行驶规划方法，其特征在于，运动状态参量包括：所述横向运动状态参量以及纵向运动状态参量；

所述纵向运动状态参量，包括：纵向位置，纵向速度，纵向加速度及纵向变加速度中至少一种；

所述横向运动状态参量包括：横向位置，横向角度，横向角速度，横向角加速度中至少一种；

所述运动状态参量关系信息表征各个运动状态参量之间的关系，所述横向运动状态参量关系信息表征各个横向运动状态参量之间的关系，所述纵向运动状态参量关系信息表征各个纵向运动状态参量之间的关系。

13.根据权利要求1-12任一项所述的行驶规划方法，其特征在于，所述基于目标道路的参考轨迹、以及自动驾驶车辆的车辆参数，确定所述自动驾驶车辆在当前控制周期中的运动状态参量关系信息，包括：

基于所述目标道路的参考轨迹信息、以及所述自动驾驶车辆的当前位置，建立弗莱纳坐标系；

在所述弗莱纳坐标系下，基于所述自动驾驶车辆的车辆参数，确定所述自动驾驶车辆在当前控制周期中的运动状态参量关系信息。

14.根据权利要求1-13任一项所述的行驶规划方法，其特征在于，所述基于运动状态参量关系信息，确定所述自动驾驶车辆的横向运动状态参量关系信息、以及纵向运动状态参量关系信息，包括：

对所述运动状态参量关系信息进行横向与纵向的解耦，得到所述横向运动状态参量关系信息和/或纵向运动状态参量关系信息。

15.根据权利要求14所述的行驶规划方法，其特征在于，所述对所述运动状态参量关系信息进行横向与纵向的解耦，包括：

将所述横向状态参量的数值设置为预设数值后，基于所述运动状态参量关系信息，得到所述纵向运动状态参量关系信息；

基于所述纵向运动状态参量关系信息、以及所述运动状态参量关系信息，得到所述横向运动状态参量关系信息。

16.根据权利要求1-15任一项所述的行驶规划方法，其特征在于，所述方法还包括：利用所述未来至少一个控制周期中的至少部分目标控制周期的目标运动状态，确定所述自动驾驶车辆在目标控制周期输出的动力参数。

17.一种行驶规划装置，其特征在于，包括：

第一确定模块，用于基于目标道路的参考轨迹信息、以及自动驾驶车辆的车辆参数，确定所述自动驾驶车辆在当前控制周期中的运动状态参量关系信息；所述目标道路的参考轨迹信息包括目标道路的中心线上的多个位置点；

第二确定模块，用于基于运动状态参量关系信息，确定所述自动驾驶车辆的横向运动状态参量关系信息、以及纵向运动状态参量关系信息；

第三确定模块，用于基于预设的约束条件、所述横向运动状态参量关系信息以及所述纵向运动状态参量关系信息，确定所述自动驾驶车辆在未来至少一个控制周期的目标运动状态；所述目标运动状态用于生成优化轨迹，所述优化轨迹包括：横向运动轨迹、以及纵向速度规划曲线。

18.一种计算机设备，其特征在于，包括：处理器、存储器，所述存储器存储有所述处理器可执行的机器可读指令，所述处理器用于执行所述存储器中存储的机器可读指令，所述机器可读指令被所述处理器执行时，所述处理器执行如权利要求1至16任一项所述的行驶规划方法的步骤。

19.一种计算机可读存储介质，其特征在于，所述计算机可读存储介质上存储有计算机程序，所述计算机程序被计算机设备运行时，所述计算机设备执行如权利要求1至16任一项所述的行驶规划方法的步骤。

Images