【技术实现步骤摘要】
一种自动驾驶汽车的运动目标跟踪方法
本专利技术涉及自动驾驶汽车轨迹跟踪控制
，尤其涉及一种自动驾驶汽车的运动目标跟踪方法。
技术介绍
自动驾驶汽车可以有效提升车辆的行驶安全性，实现更好的道路利用率，并大大降低移动成本，为从根本上改变传统的交通方式提供了可能性，因而，成为近几年新兴的研究热点。作为自动驾驶汽车的关键技术之一，车辆的轨迹跟踪控制目标是获取目标的位置并驱动发动机实现自动汽车快速平稳地达到我们指定的位置。在现有目标位置获取技术中，有使用基于视觉和超声定位目标的跟踪系统，也有使用图像传感器和激光传感器检测特定的目标与测距。在已知自动驾驶汽车与目标的相对位置关系后，需要设计一种跟踪策略，使自动驾驶汽车能够不断地调整前进速度和转角速度，平稳且快速地到达指定位置。在自动驾驶过程中，轨迹跟踪的准确率将会直接影响车辆的行驶轨迹，继而影响自动驾驶系统的整体性能和行车安全。然而现有的目标跟踪控制方法难以适应车辆实际的运行状态，且存在对于实际自动驾驶汽车执行能力不足的问题，影响了系统的稳定性，且目标丢失率较高。<...
【技术保护点】
1.一种自动驾驶汽车的运动目标跟踪方法，其特征在于，包括以下步骤：/nS1.建立自动驾驶汽车的目标跟踪模型；/nS2.基于自动驾驶汽车的实际行驶状态分析所述自动驾驶汽车的目标跟踪模型，得到自动驾驶汽车的目标跟踪模型的离散化模型；/nS3.对于所述自动驾驶汽车的目标跟踪模型的离散化模型，确定其控制目标为(r,φ)，控制量为对自动驾驶汽车的前进速度和偏转角速度的控制，在控制过程中采用优先调整偏转角速度策略；其中r为自动驾驶汽车到目标位置的距离，φ为自动驾驶汽车当前前进方向与自动驾驶汽车到目标位置中心连线的夹角。/n
【技术特征摘要】 【专利技术属性】
1.一种自动驾驶汽车的运动目标跟踪方法，其特征在于，包括以下步骤：
S1.建立自动驾驶汽车的目标跟踪模型；
S2.基于自动驾驶汽车的实际行驶状态分析所述自动驾驶汽车的目标跟踪模型，得到自动驾驶汽车的目标跟踪模型的离散化模型；
S3.对于所述自动驾驶汽车的目标跟踪模型的离散化模型，确定其控制目标为(r,φ)，控制量为对自动驾驶汽车的前进速度和偏转角速度的控制，在控制过程中采用优先调整偏转角速度策略；其中r为自动驾驶汽车到目标位置的距离，φ为自动驾驶汽车当前前进方向与自动驾驶汽车到目标位置中心连线的夹角。
2.根据权利要求1所述的自动驾驶汽车的运动目标跟踪方法，其特征在于，所述步骤S1具体为：
定义M为跟踪目标的所在位置，N为当前自动驾驶汽车的位置，P为自动驾驶汽车的理想跟踪位置；
则自动驾驶汽车的目标跟踪的理想情况为：
r＝d,φ＝0
其中r为自动驾驶汽车N到目标位置M的距离，φ为自动驾驶汽车当前前进方向与自动驾驶汽车到目标位置M中心连线的夹角,r＝d表示自动驾驶汽车的位置N距离目标位置M的距离为设定距离d，φ＝0表示自动驾驶汽车前进方向指向跟踪目标，r和φ的值即为自动驾驶汽车的理想控制状态。
3.根据权利要求2所述的自动驾驶汽车的运动目标跟踪方法，其特征在于，所述步骤S2具体为：
S21.经过时间Δt后，自动驾驶汽车的理想跟踪位置P变化为新的位置P'，P'即为t+Δt时刻自动驾驶汽车的理想跟踪位置，则自动驾驶汽车的目标跟踪情况为：
r＝d,φ＝0
其中r为自动驾驶汽车N到自动驾驶汽车的理想跟踪位置P'的距离，φ为自动驾驶汽车当前时刻前进方向与自动驾驶汽车的理想跟踪位置P'的前进方向偏转夹角；
S22.定义v为自动驾驶汽车前进方向的速度绝对值，y为垂直于自动驾驶汽车前进方向的轴，自动驾驶汽车的左轮和右轮沿前进方向的角速度绝对值大小分别为wr,wl，D为自动驾驶汽车横向车轴距离，w表示自动驾驶汽车沿逆时针方向偏转角速度，自动驾驶汽车左轮和右轮的半径均为c；
得到所述自动驾驶汽车的动态模型为：
自动驾驶汽车当前位置与理想跟踪位置的关系如下：
由所述自动驾驶汽车的动态模型及自动驾驶汽车当前位置与理想跟踪位置的关系得到下式：
技术研发人员：吴宗泽，陆贵家，李建中，梁泽逍，
申请(专利权)人：广东工业大学，
类型：发明
国别省市：广东;44
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。