[发明专利]一种倒车轨迹追踪方法、装置、电子设备及存储介质

权利要求书

1.一种倒车轨迹追踪方法，包括：

获取车辆的定位信息及参考轨迹；

根据所述车辆的定位信息及所述参考轨迹，确定所述车辆相对于所述参考轨迹的航向误差和横向误差；

根据所述航向误差、所述横向误差及所述车辆的速度，确定所述车辆的期望前轮转角；

利用所述车辆的期望前轮转角，调整所述车辆的实际前轮转角。

2.根据权利要求1所述的方法，其中，所述车辆的定位信息包括所述车辆的前轴中心点位置及车身朝向；

根据所述车辆的定位信息及所述参考轨迹，确定所述车辆相对于所述参考轨迹的航向误差，包括：

确定所述参考轨迹上与所述车辆的前轴中心点距离最近的点；

以所述距离最近的点作为切点，确定所述参考轨迹的切线；

根据所述车辆的车身朝向及所述参考轨迹的切线的方向，确定所述车辆相对于所述参考轨迹的航向误差。

3.根据权利要求1所述的方法，其中，所述车辆的定位信息包括所述车辆的前轴中心点位置；

根据所述车辆的定位信息及所述参考轨迹，确定所述车辆相对于所述参考轨迹的横向误差，包括：

确定所述车辆的前轴中心点位置与所述参考轨迹之间的最短距离，将所述最短距离作为所述车辆相对于所述参考轨迹的横向误差。

4.根据权利要求1至3任一所述的方法，其中，所述根据所述航向误差、所述横向误差及所述车辆的速度，确定所述车辆的期望前轮转角，包括：

采用下式确定所述车辆的期望前轮转角：

其中，

所述β为所述车辆的期望前轮转角；

所述θ_e为所述航向误差；

所述cte为所述横向误差；

所述v为所述车辆的速度；

所述k为预先设置的系数。

5.根据权利要求1至3任一所述的方法，还包括，根据所述车辆的定位信息确定所述车辆的自行车模型；

确定所述车辆相对于所述参考轨迹的航向误差和横向误差及所述车辆的期望前轮转角包括：利用所述车辆的自行车模型及所述参考轨迹进行确定。

6.一种倒车轨迹追踪装置，包括：

获取模块，用于获取车辆的定位信息及参考轨迹；

误差确定模块，用于根据所述车辆的定位信息及所述参考轨迹，确定所述和横向误差；

前轮转角确定模块，用于根据所述航向误差、所述横向误差及所述车辆的速度，确定所述车辆的期望前轮转角；

调整模块，用于利用所述车辆的期望前轮转角，调整所述车辆的实际前轮转角。

7.根据权利要求6所述的装置，其中，所述车辆的定位信息包括所述车辆的前轴中心点位置及车身朝向；

所述误差确定模块包括：

航向误差确定子模块，用于确定所述参考轨迹上与所述车辆的前轴中心点距离最近的点，以所述距离最近的点作为切点，确定所述参考轨迹的切线，根据所述车辆的车身朝向及所述参考轨迹的切线的方向，确定所述车辆相对于所述参考轨迹的航向误差。

8.根据权利要求6所述的装置，其中，所述车辆的定位信息包括所述车辆的前轴中心点位置；

所述误差确定模块包括：

横向误差确定子模块，用于确定所述车辆的前轴中心点位置与所述参考轨迹之间的最短距离，将所述最短距离作为所述车辆相对于所述参考轨迹的横向误差。

9.根据权利要求6至8任一所述的装置，其中，所述前轮转角确定模块，用于采用下式确定所述车辆的期望前轮转角：

其中，

所述β为所述车辆的期望前轮转角；

所述θ_e为所述航向误差；

所述cte为所述横向误差；

所述v为所述车辆的速度；

所述k为预先设置的系数。