[发明专利]一种智能车避障轨迹规划方法及装置

摘要

本发明实施例提供了一种智能车避障轨迹规划方法，根据每个障碍物的位置得到所有的避障格的位置；根据自车的位置、自车的速度、障碍物的速度和所有避障格的位置，得到至少一个避障格路径；将避障格代价最小的避障格路径作为目标避障格路径；根据自车的位置、自车的速度和第一个目标避障格的位置，得到第一个目标避障格的避障轨迹；根据任一个目标避障格的位置、在任一个目标避障格之前自车经过的上一个目标避障格的位置和自车的速度，得到任一个目标避障格的避障轨迹；根据目标避障格路径中所有目标避障格对应的避障轨迹，得到目标避障格路径对应的目标避障轨迹。本发明实施例根据障碍物的速度规划路径，提高了避障的准确性。

主权项

1.一种智能车避障轨迹规划方法，其特征在于，方法包括：获取自车的位置、所述自车的速度、所述自车周围相关的障碍物的位置和每个所述障碍物的速度；根据每个所述障碍物的位置得到所有的避障格的位置，每个所述避障格为与相对应的所述障碍物的一侧相距预设距离且无障碍物的预设大小的格子；根据所述自车的位置、所述自车的速度、所述障碍物的速度和所述所有避障格的位置，得到至少一个避障格路径，每个所述避障格路径包括：从所述自车的当前位置起避过所有相关的所述障碍物所依次经过的每个所述避障格的顺序以及对应的所述避障格；计算每个所述避障格路径的避障格代价，将避障格代价最小的避障格路径作为目标避障格路径；对于所述目标避障格路径中所述自车经过的第一个目标避障格，根据所述自车的位置、所述自车的速度和所述第一个目标避障格的位置，得到所述第一个目标避障格的避障轨迹；对于所述目标避障格路径中所述自车经过的第一个目标避障格之外的任一个目标避障格，根据该任一个目标避障格的位置、在该任一个目标避障格之前所述自车经过的上一个目标避障格的位置和所述自车的速度，得到该任一个目标避障格的避障轨迹；根据所述目标避障格路径中所有目标避障格对应的避障轨迹，得到所述目标避障格路径对应的目标避障轨迹。