[发明专利]泊车路径设置方法及系统

说明书

本发明公开了一种泊车路径设置方法及系统，其中方法包括：确定目标泊车位信息；获取待泊车辆的泊车初始位姿信息；根据所述目标泊车位信息和所述泊车初始位姿信息，生成包含至少两个中间参考点的泊车路径；在泊车过程中，根据待泊车辆的实时位姿信息以及与所述中间参考点相关的预设标准，更新所述泊车路径。本发明不仅能实现实际泊车环境中无需每次在同一泊车起始位姿情况下进行泊车，并且在泊车过程中即使出现扰动偏差，本发明也可以通过更新泊车路径进行有效处置。

技术领域

本发明涉及自动泊车技术领域，尤其涉及一种泊车路径设置方法及系统。

背景技术

当前，汽车已经成为人们日常生活中便捷的交通工具。然而，对于很多驾驶员特别是新手来说，安全泊车依然具有很大挑战，特别是遇到两侧有障碍物的垂直车位或者侧方车位，泊车过程中极易发生碰撞、刮蹭等事故。目前，自动泊车技术可以大幅度提高泊车的入库率及安全性，其中包括起到辅助人工泊车的半自动泊车系统，或者无人参与的全自动泊车系统。

现有的半自动/全自动泊车系统通常分为三大模块，定位感知模块、运动规划和控制模块、人机交互模块。其中定位感知模块包括超声波模组等，运动规划和控制模块包括线控执行机构等，人机交互模块包括语音和图像界面提示等。但现有技术大多采用依据局部2D信息来定位车位，进而使用固定程式的双圆弧拼接法进行车辆运动规划。

但基于圆弧拼接的路径规划方案只适用于固定起止位置且车辆轨迹控制完全无误差的理想情况下的泊车操作，但实际使用过程中，难以确保每次泊车都是同一初始位置的条件约束，并且导致泊车偏向的因素繁多，而现有技术规划出的路径在车辆泊车过程中出现偏差时则较难调整回来。

发明内容

本发明提供了一种泊车路径设置方法及系统，用以克服上述问题。

本发明采用的技术方案如下：

一种泊车路径设置方法，包括：

确定目标泊车位信息；

获取待泊车辆的泊车初始位姿信息；

根据所述目标泊车位信息和所述泊车初始位姿信息，生成包含至少两个中间参考点的泊车路径；

在泊车过程中，根据待泊车辆的实时位姿信息以及与所述中间参考点相关的预设标准，更新所述泊车路径。

可选地，所述在泊车过程中，根据待泊车辆的实时位姿信息以及与所述中间参考点相关的预设标准，更新所述泊车路径包括：

根据专家经验，为所述泊车路径中的各所述中间参考点预设浮动区域坐标及相应的航向角度阈值；

实时检测待泊车辆的当前坐标及当前航向角度；

根据所述当前坐标与所述浮动区域坐标的关系以及所述当前航向角度与所述航向角度阈值的关系，更新所述泊车路径。

可选地，所述根据所述当前坐标与所述浮动区域坐标的关系以及所述当前航向角度与所述航向角度阈值的关系，更新所述泊车路径包括：

根据所述当前坐标及所述浮动区域坐标，判断待泊车辆是否进入所述中间参考点的浮动区域；

若否，则确定所述泊车路径无效；若是，则判断所述当前航向角度是否小于或等于所述航向角度阈值；

若否，则确定所述泊车路径无效；若是，则根据所述当前坐标、所述当前航向角度以及所述目标泊车位信息，调整后续所述中间参考点的位置；

利用所述实时位姿信息、所述目标泊车位信息以及调整位置后的所述中间参考点，拟合出新的后续泊车路径。

可选地，

所述目标泊车位信息包括：有效泊车位的目标坐标；

所述确定目标泊车位信息包括：