公开(公告)号：CN110703783B

公开(公告)日：2021-07-27

申请号：CN201911095004.1

申请日：2019-11-11

Applicant: 上海交通大学

Inventor： 李梦扬 ,  王亚飞 ,  高瑞金 ,  周志松 ,  殷承良

IPC: G05D1/02

Abstract: 本发明公开了一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法，首先从参考轨迹的出发点开始，在每三个连续的参考轨迹点中的第二个参考轨迹点处，取前两个参考轨迹点所连成的直线与后两个参考轨迹点所连成直线的角平分线，并得到角平分线在全局坐标系下的直线表达式；然后通过实时位置的结果值和第三个参考轨迹点的结果值乘积来判断车辆是否通过第二个参考轨迹点，实时地得到车辆当前经过的参考轨迹点，直到到达最后一个参考轨迹点为止。本发明能实时地判别车辆当前经过的参考轨迹点，并对后一个参考轨迹点进行跟踪的功能，从而使得车辆可以得到当前的预瞄点及预瞄点的语意信息，进行局部轨迹规划、轨迹跟踪和避开障碍物的控制。

公开(公告)号：CN110703783A

公开(公告)日：2020-01-17

申请号：CN201911095004.1

申请日：2019-11-11

Applicant: 上海交通大学

Inventor： 李梦扬 ,  王亚飞 ,  高瑞金 ,  周志松 ,  殷承良

IPC: G05D1/02

Abstract: 本发明公开了一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法，首先从参考轨迹的出发点开始，在每三个连续的参考轨迹点中的第二个参考轨迹点处，取前两个参考轨迹点所连成的直线与后两个参考轨迹点所连成直线的角平分线，并得到角平分线在全局坐标下的直线表达式；然后通过实时位置的结果值和第三个参考轨迹点的结果值乘积来判断车辆是否通过第二个参考轨迹点，实时地得到车辆当前经过的参考轨迹点，直到到达最后一个参考轨迹点为止。本发明能实时地判别车辆当前经过的参考轨迹点，并对后一个参考轨迹点进行跟踪的功能，从而使得车辆可以得到当前的预瞄点及预瞄点的语意信息，进行局部轨迹规划、轨迹跟踪和避开障碍物的控制。