[发明专利]横向控制方法及装置

权利要求书

1.一种横向控制方法，其特征在于，所述方法包括：

获取第一标志位的位置信息；

根据车辆的第一位置信息和第一标志位的位置信息，确定车辆的第一横向偏差；

根据所述第一横向偏差，规划车辆的第一航向角或者第一横向偏差收敛速度的变化过程；根据规划的所述第一航向角或者所述第一横向偏差收敛速度的变化过程，控制车辆的前轮转角，以切入路边沿；

当车辆贴着路边沿行驶时，分别确定与车辆的第一车轴的中点距离最近的第一路点和与车辆的第二车轴的中点距离最近的第二路点；

计算所述第一路点与所述第一车轴的中点的第一距离，得到第一偏差数据，以及计算所述第二路点与所述第二车轴的中点的第二距离，得到第二偏差数据；

根据所述第一偏差数据和车辆的第一车速，计算预瞄距离；

根据所述第一偏差数据、所述车辆的第一车速和所述第一车轴的中点与第二车轴的中点的距离、所述预瞄距离，计算第一转角；

根据所述第二偏差数据，计算第二转角；

根据所述第一转角和所述第二转角，计算车辆贴着路边沿行驶的目标转角；

获取第二标志位的位置信息；

根据车辆当前的第二位置信息和所述第二标志位的位置信息，确定车辆的第二横向偏差；

根据所述第二横向偏差，规划车辆的第二航向角或者第二横向偏差收敛速度的变化过程；

根据规划的所述第二航向角或者所述第二横向偏差收敛速度的变化过程，控制车的前轮转角，切出路边沿。

2.根据权利要求1所述的方法，其特征在于，所述获取第一标志位的位置信息具体包括：

通过第一传感器获取第一标志位的第一原始位置信息；

通过第二传感器获取第一标志位的第二原始位置信息；

通过第三传感器获取第一标志位的第三原始位置信息；

对所述第一原始位置信息、所述第二原始位置信息和所述第三原始位置信息进行融合处理，得到车辆坐标系下，第一标志位的位置信息。

3.根据权利要求1所述的方法，其特征在于，所述根据车辆的第一位置信息和第一标志位的位置信息，确定车辆的第一横向偏差，具体包括：

根据e_y＝y-y_d计算车辆的第一横向偏差；

其中，y为车辆的位置信息中的横向坐标信息，y_d为第一标志位的横向坐标信息。

4.根据权利要求1所述的方法，其特征在于，根据所述第一横向偏差，控制车辆的第一航向角和第一横向偏差收敛速度，具体包括:

根据公式得到车辆的第一航向角和第一横向偏差收敛速度关系，从而规划合适的航向角或者横向速度的变化过程；

其中，ψ为航向角，V为第一车速、V_x为纵向速度、V_y为第一横向偏差收敛速度。

5.根据权利要求1所述的方法，其特征在于，根据所述第一偏差数据和车辆的第一车速，计算预瞄距离，具体包括：

根据公式l_d＝k1*v+x^|error1|计算预瞄距离；

其中，l_d为预瞄距离，k1为常数，v为车辆的当前的第一车速，error1为第一偏差数据。

6.根据权利要求1所述的方法，其特征在于，所述根据所述第一偏差数据、所述车辆的第一车速和所述第一车轴的中点与第二车轴的中点的距离、所述预瞄距离，计算第一转角，具体包括：

根据公式计算第一转角；

其中，δ_purepursuit为第一转角，L为第一车轴的中点与第二车轴的中点的距离，l_d为预瞄距离，α为第一车轴中点至预瞄点的圆弧的切线的夹角。

7.根据权利要求1所述的方法，其特征在于，所述根据所述第二偏差数据，计算第二转角，具体包括：

根据公式计算第二转角；

其中，δ_前轴反馈为第二转角，error2为第二偏差数据，kp，ki，kd为PID的三个的参数。