[发明专利]自动驾驶充电车精准泊车的横向控制方法

权利要求书

1.一种自动驾驶充电车精准泊车的横向控制方法，其特征在于，所述方法包括：

自动驾驶充电车获取路径规划信息，所述路径规划信息包括车辆行驶路径的路径起点位置、路径终点位置以及路径起点和路径终点之间的多个路点位置；

根据所述自动驾驶充电车的行驶速度实时获取车辆行驶过程中的预瞄距离；

根据所述路径起点位置和路径终点位置计算行驶路径的剩余距离；

当所述剩余距离小于所述预瞄距离时，计算所述预瞄距离和所述剩余距离的距离差值；

根据多个所述路点位置与所述路径终点位置计算路径航向角；

根据所述距离差值和所述路径航向角对所述行驶路径进行延长处理，得到延长路径；

根据所述路径起点位置和所述延长路径的终点位置计算车辆转弯半径；

根据所述车辆转弯半径和所述车辆前后轮轴距计算所述车轮转角；

根据所述车轮转角生成横向控制信号，根据所述横向控制信号控制所述自动驾驶充电车在所述路径终点位置停车。

2.根据权利要求1所述的方法，其特征在于，所述自动驾驶充电车获取路径规划信息具体包括：

所述自动驾驶充电车向服务器发送地图数据获取请求，所述地图数据获取请求中包含行驶区域标识信息；

所述服务器根据所述行驶区域标识信息在地图数据库中调用行驶区域地图发送至所述自动驾驶充电车；

所述自动驾驶充电车对所述行驶区域地图进行解析，提取道路信息；

根据所述道路信息进行路径规划，得到路径起点位置、路径终点位置以及路径起点和路径终点之间的多个路点位置。

3.根据权利要求1-2任一项所述的方法，其特征在于，所述根据所述自动驾驶充电车的行驶速度实时获取车辆行驶过程中的预瞄距离具体包括：

根据所述自动驾驶充电车的车体上安装的传感器获取行驶速度；

根据公式d＝k·v+a计算所述预瞄距离，其中，v为行驶速度，k为比例系数，a为修正值。

4.根据权利要求1-3任一项所述的方法，其特征在于，所述路径起点位置具体为所述自动驾驶充电车的后轴中点对应到所述行驶路径上的位置坐标；所述根据所述路径起点位置和路径终点位置计算行驶路径的剩余距离具体包括：

计算所述后轴中点对应到所述行驶路径上的位置坐标和所述路径终点位置坐标之间的距离，得到所述剩余距离。

5.根据权利要求1-4任一项所述的方法，其特征在于，所述根据多个所述路点位置与所述路径终点位置计算路径航向角具体包括：

分别计算多个路点位置与所述路径终点位置连线的纵向航向角；

将多个所述纵向航向角计算平均值，得到所述路径航向角。

6.根据权利要求1-5任一项所述的方法，其特征在于，所述根据所述路径起点位置和所述延长路径的终点位置计算车辆转弯半径具体包括：

根据所述路径起点位置和所述延长路径的终点位置之间的距离和所述路径航向角计算所述路径起点位置和所述延长路径的终点位置之间的圆弧曲率；

根据所述圆弧曲率确定所述车辆转弯半径。

7.根据权利要求1-6任一项所述的方法，其特征在于，所述根据所述车辆转弯半径和所述车辆前后轮轴距计算所述车轮转角具体包括：

根据公式计算所述车轮转角，其中，θ为车轮转角，L为车辆前后轮轴距，R为车辆转弯半径。

8.根据权利要求1-7任一项所述的方法，其特征在于，在根据所述横向控制信号控制所述自动驾驶充电车在所述路径终点位置停车之后，所述方法还包括：

所述自动驾驶充电车向所述服务器发送停车完成信息；

所述服务器根据所述停车完成信息获取所述自动驾驶充电车的ID信息和剩余电量信息；

将所述ID信息、剩余电量信息以及停车位置信息生成自动驾驶充电车信息列表。