一种智能车避障轨迹规划方法及装置

摘要

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