CN112764415B - 一种生成自动驾驶规划轨迹的方法、装置及汽车 - Google Patents
一种生成自动驾驶规划轨迹的方法、装置及汽车 Download PDFInfo
- Publication number
- CN112764415B CN112764415B CN201911071230.6A CN201911071230A CN112764415B CN 112764415 B CN112764415 B CN 112764415B CN 201911071230 A CN201911071230 A CN 201911071230A CN 112764415 B CN112764415 B CN 112764415B
- Authority
- CN
- China
- Prior art keywords
- determining
- aiming point
- automobile
- information
- point
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 24
- 238000012790 confirmation Methods 0.000 claims description 10
- 238000012508 change request Methods 0.000 claims description 8
- 238000001514 detection method Methods 0.000 claims description 3
- 230000008569 process Effects 0.000 abstract description 6
- 230000001788 irregular Effects 0.000 abstract description 5
- 230000008859 change Effects 0.000 description 10
- 238000004590 computer program Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 239000011159 matrix material Substances 0.000 description 3
- 230000009466 transformation Effects 0.000 description 3
- 230000006978 adaptation Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 235000007297 Gaultheria procumbens Nutrition 0.000 description 1
- 241000333569 Pyrola minor Species 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- OSWPMRLSEDHDFF-UHFFFAOYSA-N methyl salicylate Chemical compound COC(=O)C1=CC=CC=C1O OSWPMRLSEDHDFF-UHFFFAOYSA-N 0.000 description 1
- 230000035772 mutation Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明提供一种生成自动驾驶规划轨迹的方法、装置及汽车，涉及自动驾驶技术领域，所述方法包括：确定汽车当前的预瞄点信息；根据所述预瞄点信息和所述汽车的当前位置信息，确定多个关键点信息；根据多个所述关键点信息、所述预瞄点信息和所述当前位置信息，生成规划轨迹。本发明的方案避免了在自动驾驶过程中由于障碍物不规则或跳变导致规划轨迹跳变，使得车辆剧烈抖动的现象，提高了乘车舒适性。
Description
技术领域
本发明涉及自动驾驶技术领域，尤其是涉及一种生成自动驾驶规划轨迹的方法、装置及汽车。
背景技术
对于城市道路自动驾驶场景下，当前方有障碍物影响到本车正常行驶时，自动驾驶汽车需要换道来绕开前方障碍物。城市道路自动驾驶的驾驶速度较高，通常在20-60km/h，所以需要汽车每帧(一帧50ms)就生成一条新的规划轨迹，每次生成轨迹需要预瞄前方障碍物作为换道点。然而城市道路存在冬青墙、栅栏等不规则障碍物和高速移动的障碍物，导致感知输出的目标障碍物列表不稳定，进而导致规划换道轨迹时预瞄的障碍物不稳定，造成生成的换道轨迹不稳定，带来汽车剧烈抖动。
发明内容
本发明的目的在于提供一种生成自动驾驶规划轨迹的方法、装置及汽车，从而解决现有技术中自动驾驶时，在检测到不规则障碍物时，造成生成的换道轨迹不稳定导致车辆剧烈抖动的问题。
为了达到上述目的，本发明提供一种生成自动驾驶规划轨迹的方法，包括：
确定汽车当前的预瞄点信息；
根据所述预瞄点信息和所述汽车的当前位置信息，确定多个关键点信息；
根据多个所述关键点信息、所述预瞄点信息和所述当前位置信息，生成规划轨迹。
可选的，确定汽车当前的预瞄点信息的步骤包括：
检测在当前行驶车道上，所述汽车的前方是否存在障碍物；
若检测到所述汽车的前方存在障碍物，则根据所述障碍物所在的位置确定所述预瞄点信息；
若未检测到所述障碍物，则在接收到换道请求指令后，根据所述换道请求指令确定所述预瞄点信息。
可选的，根据所述障碍物所在的位置确定所述预瞄点信息的步骤包括：
根据所述障碍物所在的位置确定预瞄点的位置，其中，所述预瞄点的位置为目标车道的车道中心线上与所述障碍物的中心点横向对应的位置；
根据所述预瞄点的位置，确定所述预瞄点信息。
可选的，根据所述换道请求指令确定所述预瞄点信息的步骤包括：
根据所述换道请求指令确定目标车道；
根据所述汽车的前方的第一预设距离的位置，在所述目标车道上确定所述预瞄点的位置；其中，所述前方为所述汽车的行驶方向，所述预瞄点的位置为所述目标车道的车道中心线上与所述第一预设距离的位置横向对应的位置；
根据所述预瞄点的位置，确定所述预瞄点信息。
可选的，根据所述预瞄点的位置，确定所述预瞄点信息的步骤包括：
根据所述预瞄点的位置，在全球定位***中确定所述预瞄点的经度和纬度；
根据所述预瞄点的经度和纬度和所述汽车的当前位置信息，在所述汽车的车辆坐标系中确定所述预瞄点信息。
可选的，根据所述预瞄点信息和所述汽车的当前位置信息，确定多个关键点信息的步骤包括：
确定所述汽车的当前位置的前方的第二预设距离处为第一关键点；
确定所述预瞄点的后方的第三预设距离处为第二关键点；其中，所述前方为所述汽车的行驶方向，所述后方为与所述前方相反的方向。
可选的，根据多个所述关键点信息、所述预瞄点信息和所述当前位置信息，生成规划轨迹的步骤包括：
采用三阶贝塞尔曲线，根据所述当前位置信息、所述预瞄点信息、所述第一关键点的位置信息和所述第二关键点的信息，对所述当前位置、所述预瞄点、所述第一关键点和所述第二关键点进行拟合，生成所述规划轨迹；其中，所述当前位置为所述三阶贝塞尔曲线的起点，所述预瞄点为所述三阶贝塞尔曲线的终点。
可选的，采用三阶贝塞尔曲线，根据所述当前位置信息、所述预瞄点信息、所述第一关键点的位置信息和所述第二关键点的信息，对所述当前位置、所述预瞄点、所述第一关键点和所述第二关键点进行拟合，生成所述规划轨迹的步骤包括：
在拟合后的所述三阶贝塞尔曲线上，间隔第四预设距离确定一确认点，根据多个所述确认点生成的点序列，确定所述规划轨迹。
本发明实施例还提供一种生成自动驾驶规划轨迹的装置，包括：
第一确定模块，用于确定汽车当前的预瞄点信息；
第二确定模块，用于根据所述预瞄点信息和所述汽车的当前位置信息，确定多个关键点信息；
生成模块，用于根据多个所述关键点信息、所述预瞄点信息和所述当前位置信息，生成规划轨迹。
可选的，所述第一确定模块包括：
检测子模块，用于检测在当前行驶车道上，所述汽车的前方是否存在障碍物；
第一确定子模块，用于若检测到所述汽车的前方存在障碍物，则根据所述障碍物所在的位置确定所述预瞄点信息；
第二确定子模块，用于若未检测到所述障碍物，则在接收到换道请求指令后，根据所述换道请求指令确定所述预瞄点信息。
可选的，所述第一确定子模块包括：
第一确定单元，用于根据所述障碍物所在的位置确定预瞄点的位置，其中，所述预瞄点的位置为目标车道的车道中心线上与所述障碍物的中心点横向对应的位置；
第二确定单元，用于根据所述预瞄点的位置，确定所述预瞄点信息。
可选的，所述第二确定子模块包括：
第三确定单元，用于根据所述换道请求指令确定目标车道；
第四确定单元，用于根据所述汽车的前方的第一预设距离的位置，在所述目标车道上确定所述预瞄点的位置；其中，所述前方为所述汽车的行驶方向，所述预瞄点的位置为所述目标车道的车道中心线上与所述第一预设距离的位置横向对应的位置；
第五确定单元，用于根据所述预瞄点的位置，确定所述预瞄点信息。
可选的，所述第二确定单元包括：
第一确定子单元，用于根据所述预瞄点的位置，在全球定位***中确定所述预瞄点的经度和纬度；
第二确定子单元，用于根据所述预瞄点的经度和纬度和所述汽车的当前位置信息，在所述汽车的车辆坐标系中确定所述预瞄点信息。
可选的，所述第五确定单元包括：
第三确定子单元，用于根据所述预瞄点的位置，在全球定位***中确定所述预瞄点的经度和纬度；
第四确定子单元，用于根据所述预瞄点的经度和纬度和所述汽车的当前位置信息，在所述汽车的车辆坐标系中确定所述预瞄点信息。
可选的，所述第二确定模块包括：
第三确定子模块，用于确定所述汽车的当前位置的前方的第二预设距离处为第一关键点；
第四确定子模块，用于确定所述预瞄点的后方的第三预设距离处为第二关键点；其中，所述前方为所述汽车的行驶方向，所述后方为与所述前方相反的方向。
可选的，所述生成模块包括：
生成子模块，用于采用三阶贝塞尔曲线，根据所述当前位置信息、所述预瞄点信息、所述第一关键点的位置信息和所述第二关键点的信息，对所述当前位置、所述预瞄点、所述第一关键点和所述第二关键点进行拟合，生成所述规划轨迹；其中，所述当前位置为所述三阶贝塞尔曲线的起点，所述预瞄点为所述三阶贝塞尔曲线的终点。
可选的，所述生成子模块具体用于：
在拟合后的所述三阶贝塞尔曲线上，间隔第四预设距离确定一确认点，根据多个所述确认点生成的点序列，确定所述规划轨迹。
本发明实施例还提供一种汽车，包括如上所述的生成自动驾驶规划轨迹的装置。
本发明实施例还提供一种汽车，包括：处理器，存储器及存储在所述存储器上并可在所述处理器上运行的计算机程序，所述计算机程序被所述处理器执行时实现如上所述的生成自动驾驶规划轨迹的方法的步骤。
本发明实施例还提供一种计算机可读存储介质，所述计算机可读存储介质上存储有计算机程序，所述计算机程序被处理器执行时实现如上所述的生成自动驾驶规划轨迹的方法的步骤。
本发明的上述技术方案至少具有如下有益效果：
本发明实施例的生成自动驾驶规划轨迹的方法，首先确定汽车当前的预瞄点信息，进而根据所述预瞄点信息和所述汽车的当前位置信息确定多个关键点信息，最后根据多个所述关键点信息、所述预瞄点信息和所述当前位置信息，生成规划轨迹；避免了在规划轨迹的过程中由于汽车的移动导致预瞄点跳变，造成不同帧的换道轨迹跳变，导致车辆剧烈抖动的现象，提高了乘车舒适性。
附图说明
图1为本发明实施例的生成自动驾驶规划轨迹的方法的基本步骤示意图；
图2为本发明实施例的生成自动驾驶规划轨迹的装置的基本构成示意图；
图3为本发明实施例的自动驾驶规划轨迹的示意图。
附图标记说明：
1-汽车，2-预瞄点，3-障碍物，4-第一关键点，5-第二关键点。
具体实施方式
为使本发明要解决的技术问题、技术方案和优点更加清楚，下面将结合附图及具体实施例进行详细描述。
本发明针对现有技术中车辆在自动驾驶过程中由于障碍物不稳定或不规则导致规划轨迹不稳定，使得车辆剧烈抖动的问题，提供了一种生成自动驾驶规划轨迹的方法、装置及汽车，避免了由于规划轨迹的跳变导致车辆抖动的现象，提高了乘车的舒适性。
请参阅图1，为本发明实施例的生成自动驾驶规划轨迹的方法的基本步骤示意图，所述方法包括：
步骤S101，确定汽车当前的预瞄点信息；
步骤S102，根据所述预瞄点信息和所述汽车的当前位置信息，确定多个关键点信息；
步骤S103，根据多个所述关键点信息、所述预瞄点信息和所述当前位置信息，生成规划轨迹。
本发明实施例的生成自动驾驶规划轨迹的方法，在进行轨迹规划时，尤其是在进行换道轨迹规划时，首先确定一个预瞄点，然后根据所述预瞄点的预瞄点信息和所述汽车的当前位置信息，确定多个关键点信息；根据多个所述关键点信息、所述预瞄点信息和所述当前位置信息，生成规划轨迹，实现了在一次换道的多次规划轨迹过程中均采用同一预瞄点规划轨迹，避免了在一次换道过程中，由于障碍物的不规则或高速移动，导致规划轨迹的突变，使得车辆发生剧烈抖动的现象，提高了乘车舒适性。
优选地，确定汽车当前的预瞄点信息的步骤包括：
检测在当前行驶车道上，所述汽车的前方是否存在障碍物；可选的，可以为所述汽车上的雷达等感知模块实时检测汽车的前方是否存在障碍物。
若检测到所述汽车的前方存在障碍物，则根据所述障碍物所在的位置确定所述预瞄点信息；
需要说明的是，如图3所示，若所述汽车1的前方存在障碍物3，则确定所述汽车无法继续在当前车道上行驶，必须进行换道，因而需要规划换道轨迹。由于所述汽车每帧生成一条新的换道轨迹，为了避免换道轨迹的突变，需要在本次换道过程中，确定唯一的一个预瞄点，因此，在本步骤中，检测到所述汽车的前方存在障碍物，则根据所述障碍物所在的位置确定唯一的所述预瞄点信息。
若未检测到所述障碍物，则在接收到换道请求指令后，根据所述换道请求指令确定所述预瞄点信息。
本步骤中，所述汽车在根据用户预先确定的行车路线行驶过程中，若确定当前需要转弯，即：接收到换道请求指令，则确定所述汽车当前需要进行换道操作。因此，在换道前，需要先根据所述换道请求指令确定所述预瞄点信息。
具体的，根据所述障碍物所在的位置确定所述预瞄点信息的步骤包括：
首先，根据所述障碍物所在的位置确定预瞄点的位置，其中，所述预瞄点的位置为目标车道的车道中心线上与所述障碍物的中心点横向对应的位置；
本步骤中，在检测到所述汽车的前方存在障碍物时，首先确定所述障碍物的中心点在全球定位***(Global Positioning System，简称：GPS)中的第一坐标，然后，确定目标车道在所述GPS中的第二坐标，最后，在所述目标车道的中心线上确定与所述障碍物的中心点平行的位置，即：根据所述第一坐标和所述第二坐标确定所述预瞄点的位置。其中，所述第一坐标可以为所述障碍物的中心点的经度和纬度，所述第二坐标可以为所述目标车道的经度和纬度。
其次，根据所述预瞄点的位置，确定所述预瞄点信息。
具体的，根据所述换道请求指令确定所述预瞄点信息的步骤包括：
首先，根据所述换道请求指令确定目标车道；所述目标车道为与所述当前车道相邻的车道。
其次，根据所述汽车的前方的第一预设距离的位置，在所述目标车道上确定所述预瞄点的位置；其中，所述前方为所述汽车的行驶方向，所述预瞄点的位置为所述目标车道的车道中心线上与所述第一预设距离的位置横向对应的位置；具体的，所述第一预设距离的位置与所述预瞄点平行。可选的，所述第一预设距离为10m。
本步骤中，首先确定所述第一预设距离的位置在GPS中的第四坐标；然后确定所述目标车道的中心线在GPS中的第五坐标，最后，根据所述第四坐标和所述第五坐标确定所述预瞄点在所述GPS中的位置。其中，所述第四坐标可以为所属第一预设距离的位置的经度和纬度，所述第五坐标可以为所述目标车道的经度和纬度。
最后，根据所述预瞄点的位置，确定所述预瞄点信息。
优选地，根据所述预瞄点的位置，确定所述预瞄点信息的步骤包括：
根据所述预瞄点的位置，在全球定位***中确定所述预瞄点的经度和纬度；
根据所述预瞄点的经度和纬度和所述汽车的当前位置信息，在所述汽车的车辆坐标系中确定所述预瞄点信息。亦即，所述预瞄点信息为所述预瞄点在所述车辆坐标系中的坐标信息。
本步骤中，在确定所述预瞄点的经度和纬度之后，进一步确定所述汽车的当前位置在GPS中的经度和纬度，然后，以所述汽车的当前位置为原点，建立一车辆坐标系，从而确定GPS中的坐标系与所述车辆坐标系的变换矩阵，最后，根据所述预瞄点的经度和纬度，以及所述变换矩阵确定所述预瞄点在所述车辆坐标系中的坐标信息。
需要说明的是，由于所述汽车为一实时移动的物体，因此，相邻两次规划换道轨迹时，所述汽车在GPS中的坐标均不相同，导致所述变换矩阵也不相同，因而，所述预瞄点在所述车辆坐标系中的坐标信息也在实时变化，所以，在每次规划轨迹前，均应首先确定所述预瞄点信息。
优选地，步骤S102，根据所述预瞄点信息和所述汽车的当前位置信息，确定多个关键点信息的步骤包括：
首先，如图3所示，确定所述汽车1的当前位置的前方的第二预设距离处为第一关键点4；优选地，所述第一预设距离为1m。
其次，确定所述预瞄点2的后方的第三预设距离处为第二关键点5；其中，所述前方为所述汽车的行驶方向，所述后方为与所述前方相反的方向。优选地，所述预设距离为1m。
由上述内容可知，所述第一关键点4和所述第二关键点5均位于所述汽车的当前位置与所述预瞄点之间，且所述第一关键点4位于当前行驶的车道上，所述第二关键点5位于所述目标车道上。
需要说明的是，本发明实施例确定所述第一关键点4和所述第二关键点5目的为，与所述当前位置和所述预瞄点共同生成平滑的轨迹，便于所述汽车根据规划的轨迹行驶，如换车道。
优选地，步骤S103，根据多个所述关键点信息、所述预瞄点信息和所述当前位置信息，生成规划轨迹，包括：
采用三阶贝塞尔曲线，根据所述当前位置信息、所述预瞄点信息、所述第一关键点的位置信息和所述第二关键点的信息，对所述当前位置、所述预瞄点、所述第一关键点和所述第二关键点进行拟合，生成所述规划轨迹；其中，所述当前位置为所述三阶贝塞尔曲线的起点，所述预瞄点为所述三阶贝塞尔曲线的终点。
具体的，根据多个所述关键点信息、所述预瞄点信息和所述当前位置信息，生成规划轨迹的步骤包括：
在拟合后的所述三阶贝塞尔曲线上，间隔第四预设距离确定一确认点，根据多个所述确认点生成的点序列，确定所述规划轨迹。优选地，所述第一预设距离为10cm。
本发明实施例的生成自动驾驶规划轨迹的方法，在检测到车辆前方存在障碍物或者接收到换道请求指令后，首先确定一预瞄点，然后，根据所述汽车的当前位置和所述预瞄点实时生成规划轨迹，确保规划轨迹是稳定的，避免了因实时采集障碍物信息确定预瞄点导致规划轨迹跳变和车辆抖动的问题；另外，本发明实施例通过采用三阶贝塞尔曲线平滑拟合所述规划轨迹，使得横向所度、纵向速度和加速度都是平滑的，提高了自动驾驶的舒适感。
请参阅图2，为本发明实施例的生成自动驾驶规划轨迹的装置的示意图，所述装置包括：
第一确定模块201，用于确定汽车当前的预瞄点信息；
第二确定模块202，用于根据所述预瞄点信息和所述汽车的当前位置信息，确定多个关键点信息；
生成模块203，用于根据多个所述关键点信息、所述预瞄点信息和所述当前位置信息，生成规划轨迹。
本发明实施例的生成自动驾驶规划轨迹的装置中，所述第一确定模块201包括：
检测子模块，用于检测在当前行驶车道上，所述汽车的前方是否存在障碍物；
第一确定子模块，用于若检测到所述汽车的前方存在障碍物，则根据所述障碍物所在的位置确定所述预瞄点信息；
第二确定子模块，用于若未检测到所述障碍物，则在接收到换道请求指令后，根据所述换道请求指令确定所述预瞄点信息。
本发明实施例的生成自动驾驶规划轨迹的装置中，所述第一确定子模块包括：
第一确定单元，用于根据所述障碍物所在的位置确定预瞄点的位置，其中，所述预瞄点的位置为目标车道的车道中心线上与所述障碍物的中心点横向对应的位置；
第二确定单元，用于根据所述预瞄点的位置，确定所述预瞄点信息。
本发明实施例的生成自动驾驶规划轨迹的装置中，所述第二确定子模块包括：
第三确定单元，用于根据所述换道请求指令确定目标车道；
第四确定单元，用于根据所述汽车的前方的第一预设距离的位置，在所述目标车道上确定所述预瞄点的位置；其中，所述前方为所述汽车的行驶方向，所述预瞄点的位置为所述目标车道的车道中心线上与所述第一预设距离的位置横向对应的位置；
第五确定单元，用于根据所述预瞄点的位置，确定所述预瞄点信息。
本发明实施例的生成自动驾驶规划轨迹的装置中，所述第二确定单元包括：
第一确定子单元，用于根据所述预瞄点的位置，在全球定位***中确定所述预瞄点的经度和纬度；
第二确定子单元，用于根据所述预瞄点的经度和纬度和所述汽车的当前位置信息，在所述汽车的车辆坐标系中确定所述预瞄点信息。
本发明实施例的生成自动驾驶规划轨迹的装置中，所述第五确定单元包括：
第三确定子单元，用于根据所述预瞄点的位置，在全球定位***中确定所述预瞄点的经度和纬度；
第四确定子单元，用于根据所述预瞄点的经度和纬度和所述汽车的当前位置信息，在所述汽车的车辆坐标系中确定所述预瞄点信息。
本发明实施例中的生成自动驾驶规划轨迹的装置中，所述第二确定模块包括：
第三确定子模块，用于确定所述汽车的当前位置的前方的第二预设距离处为第一关键点；
第四确定子模块，用于确定所述预瞄点的后方的第三预设距离处为第二关键点；其中，所述前方为所述汽车的行驶方向，所述后方为与所述前方相反的方向。
本发明实施例的生成自动驾驶规划轨迹的装置中，所述生成模块包括：
生成子模块，用于采用三阶贝塞尔曲线，根据所述当前位置信息、所述预瞄点信息、所述第一关键点的位置信息和所述第二关键点的信息，对所述当前位置、所述预瞄点、所述第一关键点和所述第二关键点进行拟合，生成所述规划轨迹；其中，所述当前位置为所述三阶贝塞尔曲线的起点，所述预瞄点为所述三阶贝塞尔曲线的终点。
本发明实施例的生成自动驾驶规划轨迹的装置中，所述生成子模块具体用于：
在拟合后的所述三阶贝塞尔曲线上，间隔第四预设距离确定一确认点，根据多个所述确认点生成的点序列，确定所述规划轨迹。
本发明实施例还提供一种汽车，包括如上所述的生成自动驾驶规划轨迹的装置。
本发明实施例还提供一种汽车，包括：处理器，存储器及存储在所述存储器上并可在所述处理器上运行的计算机程序，所述计算机程序被所述处理器执行时实现如上所述的生成自动驾驶规划轨迹的方法的步骤。
本发明实施例还提供一种计算机可读存储介质，所述计算机可读存储介质上存储有计算机程序，所述计算机程序被处理器执行时实现如上所述的生成自动驾驶规划轨迹的方法的步骤。
以上所述是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明所述原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。
Claims (4)
1.一种生成自动驾驶规划轨迹的方法，其特征在于，包括：
确定汽车当前的预瞄点信息；
根据所述预瞄点信息和所述汽车的当前位置信息，确定多个关键点信息；
根据多个所述关键点信息、所述预瞄点信息和所述当前位置信息，生成规划轨迹；
确定汽车当前的预瞄点信息的步骤包括：
检测在当前行驶车道上，所述汽车的前方是否存在障碍物；
若检测到所述汽车的前方存在障碍物，则根据所述障碍物所在的位置确定所述预瞄点信息；
若未检测到所述障碍物，则在接收到换道请求指令后，根据所述换道请求指令确定所述预瞄点信息；
根据所述障碍物所在的位置确定所述预瞄点信息的步骤包括：
根据所述障碍物所在的位置确定预瞄点的位置，其中，所述预瞄点的位置为目标车道的车道中心线上与所述障碍物的中心点横向对应的位置；
根据所述预瞄点的位置，确定所述预瞄点信息；
根据所述换道请求指令确定所述预瞄点信息的步骤包括：
根据所述换道请求指令确定目标车道；
根据所述汽车的前方的第一预设距离的位置，在所述目标车道上确定所述预瞄点的位置；其中，所述前方为所述汽车的行驶方向，所述预瞄点的位置为所述目标车道的车道中心线上与所述第一预设距离的位置横向对应的位置；
根据所述预瞄点的位置，确定所述预瞄点信息；
根据所述预瞄点的位置，确定所述预瞄点信息的步骤包括：
根据所述预瞄点的位置，在全球定位***中确定所述预瞄点的经度和纬度；
根据所述预瞄点的经度和纬度和所述汽车的当前位置信息，在所述汽车的车辆坐标系中确定所述预瞄点信息；
根据所述预瞄点信息和所述汽车的当前位置信息，确定多个关键点信息的步骤包括：
确定所述汽车的当前位置的前方的第二预设距离处为第一关键点；
确定所述预瞄点的后方的第三预设距离处为第二关键点；其中，所述前方为所述汽车的行驶方向，所述后方为与所述前方相反的方向；
根据多个所述关键点信息、所述预瞄点信息和所述当前位置信息，生成规划轨迹的步骤包括：
采用三阶贝塞尔曲线，根据所述当前位置信息、所述预瞄点信息、所述第一关键点的位置信息和所述第二关键点的信息，对所述当前位置、所述预瞄点、所述第一关键点和所述第二关键点进行拟合，生成所述规划轨迹；其中，所述当前位置为所述三阶贝塞尔曲线的起点，所述预瞄点为所述三阶贝塞尔曲线的终点。
2.根据权利要求1所述的生成自动驾驶规划轨迹的方法，其特征在于，采用三阶贝塞尔曲线，根据所述当前位置信息、所述预瞄点信息、所述第一关键点的位置信息和所述第二关键点的信息，对所述当前位置、所述预瞄点、所述第一关键点和所述第二关键点进行拟合，生成所述规划轨迹的步骤包括：
在拟合后的所述三阶贝塞尔曲线上，间隔第四预设距离确定一确认点，根据多个所述确认点生成的点序列，确定所述规划轨迹。
3.一种生成自动驾驶规划轨迹的装置，其特征在于，包括：
第一确定模块，用于确定汽车当前的预瞄点信息；
第二确定模块，用于根据所述预瞄点信息和所述汽车的当前位置信息，确定多个关键点信息；
生成模块，用于根据多个所述关键点信息、所述预瞄点信息和所述当前位置信息，生成规划轨迹；
所述第一确定模块包括：
检测子模块，用于检测在当前行驶车道上，所述汽车的前方是否存在障碍物；
第一确定子模块，用于若检测到所述汽车的前方存在障碍物，则根据所述障碍物所在的位置确定所述预瞄点信息；
第二确定子模块，用于若未检测到所述障碍物，则在接收到换道请求指令后，根据所述换道请求指令确定所述预瞄点信息；
所述第一确定子模块包括：
第一确定单元，用于根据所述障碍物所在的位置确定预瞄点的位置，其中，所述预瞄点的位置为目标车道的车道中心线上与所述障碍物的中心点横向对应的位置；
第二确定单元，用于根据所述预瞄点的位置，确定所述预瞄点信息；
所述第二确定子模块包括：
第三确定单元，用于根据所述换道请求指令确定目标车道；
第四确定单元，用于根据所述汽车的前方的第一预设距离的位置，在所述目标车道上确定所述预瞄点的位置；其中，所述前方为所述汽车的行驶方向，所述预瞄点的位置为所述目标车道的车道中心线上与所述第一预设距离的位置横向对应的位置；
第五确定单元，用于根据所述预瞄点的位置，确定所述预瞄点信息；
所述第二确定单元包括：
第一确定子单元，用于根据所述预瞄点的位置，在全球定位***中确定所述预瞄点的经度和纬度；
第二确定子单元，用于根据所述预瞄点的经度和纬度和所述汽车的当前位置信息，在所述汽车的车辆坐标系中确定所述预瞄点信息；
所述第五确定单元包括：
第三确定子单元，用于根据所述预瞄点的位置，在全球定位***中确定所述预瞄点的经度和纬度；
第四确定子单元，用于根据所述预瞄点的经度和纬度和所述汽车的当前位置信息，在所述汽车的车辆坐标系中确定所述预瞄点信息；
所述第二确定模块包括：
第三确定子模块，用于确定所述汽车的当前位置的前方的第二预设距离处为第一关键点；
第四确定子模块，用于确定所述预瞄点的后方的第三预设距离处为第二关键点；其中，所述前方为所述汽车的行驶方向，所述后方为与所述前方相反的方向；
所述生成模块包括：
生成子模块，用于采用三阶贝塞尔曲线，根据所述当前位置信息、所述预瞄点信息、所述第一关键点的位置信息和所述第二关键点的信息，对所述当前位置、所述预瞄点、所述第一关键点和所述第二关键点进行拟合，生成所述规划轨迹；其中，所述当前位置为所述三阶贝塞尔曲线的起点，所述预瞄点为所述三阶贝塞尔曲线的终点。
4.一种汽车，其特征在于，包括如权利要求3所述的生成自动驾驶规划轨迹的装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911071230.6A CN112764415B (zh) | 2019-11-05 | 2019-11-05 | 一种生成自动驾驶规划轨迹的方法、装置及汽车 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911071230.6A CN112764415B (zh) | 2019-11-05 | 2019-11-05 | 一种生成自动驾驶规划轨迹的方法、装置及汽车 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN112764415A CN112764415A (zh) | 2021-05-07 |
| CN112764415B true CN112764415B (zh) | 2024-01-26 |
Family
ID=75692571
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201911071230.6A Active CN112764415B (zh) | 2019-11-05 | 2019-11-05 | 一种生成自动驾驶规划轨迹的方法、装置及汽车 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112764415B (zh) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113324554B (zh) * | 2021-05-28 | 2023-12-29 | 江铃汽车股份有限公司 | 自动驾驶路线规划方法、装置、可读存储介质及电子设备 |
| CN113538674A (zh) * | 2021-06-29 | 2021-10-22 | 深圳一清创新科技有限公司 | 一种基于自主建图的路线检测方法、装置以及电子设备 |
| CN115230719B (zh) * | 2021-12-01 | 2023-09-26 | 上海仙途智能科技有限公司 | 一种行驶轨迹规划方法和装置 |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103158703A (zh) * | 2013-03-26 | 2013-06-19 | 北京经纬恒润科技有限公司 | 一种平行泊车的控制方法 |
| CN106527452A (zh) * | 2016-12-30 | 2017-03-22 | 广州汽车集团股份有限公司 | 一种无人驾驶汽车遇障时运动路径规划方法及*** |
| CN107264531A (zh) * | 2017-06-08 | 2017-10-20 | 中南大学 | 一种半结构化环境中智能车辆自主换道超车运动规划方法 |
| CN107323450A (zh) * | 2017-06-08 | 2017-11-07 | 广州汽车集团股份有限公司 | 车辆变道的控制方法及装置、存储介质 |
| CN109855637A (zh) * | 2018-12-24 | 2019-06-07 | 北京新能源汽车股份有限公司 | 一种车辆的自动驾驶路径规划方法、装置及设备 |
| CN110254422A (zh) * | 2019-06-19 | 2019-09-20 | 中汽研（天津）汽车工程研究院有限公司 | 一种基于多目标增强学习及贝塞尔曲线的汽车避障方法 |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US10427676B2 (en) * | 2017-05-31 | 2019-10-01 | GM Global Technology Operations LLC | Trajectory planner for autonomous driving using bézier curves |
| CN106114507B (zh) * | 2016-06-21 | 2018-04-03 | 百度在线网络技术（北京）有限公司 | 用于智能车辆的局部轨迹规划方法和装置 |
-
2019
- 2019-11-05 CN CN201911071230.6A patent/CN112764415B/zh active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103158703A (zh) * | 2013-03-26 | 2013-06-19 | 北京经纬恒润科技有限公司 | 一种平行泊车的控制方法 |
| CN106527452A (zh) * | 2016-12-30 | 2017-03-22 | 广州汽车集团股份有限公司 | 一种无人驾驶汽车遇障时运动路径规划方法及*** |
| CN107264531A (zh) * | 2017-06-08 | 2017-10-20 | 中南大学 | 一种半结构化环境中智能车辆自主换道超车运动规划方法 |
| CN107323450A (zh) * | 2017-06-08 | 2017-11-07 | 广州汽车集团股份有限公司 | 车辆变道的控制方法及装置、存储介质 |
| CN109855637A (zh) * | 2018-12-24 | 2019-06-07 | 北京新能源汽车股份有限公司 | 一种车辆的自动驾驶路径规划方法、装置及设备 |
| CN110254422A (zh) * | 2019-06-19 | 2019-09-20 | 中汽研（天津）汽车工程研究院有限公司 | 一种基于多目标增强学习及贝塞尔曲线的汽车避障方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN112764415A (zh) | 2021-05-07 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP3572896B1 (en) | Automatic driving method and device | |
| US20200269873A1 (en) | Method and apparatus for planning speed of autonomous vehicle, and storage medium | |
| CN112764415B (zh) | 一种生成自动驾驶规划轨迹的方法、装置及汽车 | |
| US11767011B2 (en) | Autonomous vehicle maneuvering based upon risk associated with occluded regions | |
| JP6269552B2 (ja) | 車両走行制御装置 | |
| JP5056613B2 (ja) | 運転支援システム | |
| RU2671602C1 (ru) | Устройство формирования целевого маршрута и устройство управления приведением в движение | |
| US20180143641A1 (en) | Motion controlling method for an autonomous vehicle and a computer device | |
| US11685398B2 (en) | Lane based routing system for autonomous driving vehicles | |
| JP2019148964A (ja) | 自動運転システム | |
| JP7186241B2 (ja) | 車両の走行支援方法、車両走行支援装置及び自動運転システム | |
| US11365977B2 (en) | Route generation device, route generation method and travel control device | |
| WO2015040992A1 (ja) | 走行情報記録システム、方法およびプログラム | |
| Wang et al. | Early findings from field trials of heavy-duty truck connected eco-driving system | |
| CN109855641B (zh) | 预测运动轨迹的方法、装置、存储介质和终端设备 | |
| US11518404B2 (en) | Static-state curvature error compensation control logic for autonomous driving vehicles | |
| JP2010140265A (ja) | 走行支援装置、方法およびプログラム | |
| JP2010190832A (ja) | 合流退出判定装置及び合流退出判定プログラム | |
| JP2009058285A (ja) | 道路情報取得装置、運転支援装置、道路情報取得方法および道路情報取得プログラム | |
| CN110440818B (zh) | 车道矩阵模型及其构建方法、读取方法和装置 | |
| JP2008249401A (ja) | ナビゲーションシステム及び方法 | |
| CN117622227B (zh) | 一种车辆换道避障控制方法及装置 | |
| CN112765191B (zh) | Adas数据增量发送方法、***、电子设备及存储介质 | |
| US20230080630A1 (en) | Traveling lane planning device, storage medium storing computer program for traveling lane planning, and traveling lane planning method | |
| JP7269162B2 (ja) | 情報処理装置、情報処理方法及び情報処理プログラム |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |