1.一种基于轨迹跟踪的倒车循迹控制方法,其特征在于,包括:正向轨迹存储阶段和倒车循迹阶段;其中:
2.根据权利要求1所述的基于轨迹跟踪的倒车循迹控制方法,其特征在于,在所述正向轨迹存储阶段之前,还包括:
3.根据权利要求1所述的基于轨迹跟踪的倒车循迹控制方法,其特征在于,存储所述车辆位置坐标前,判断存储空间是否已满,若已满,根据先入先出策略,将第一个地址内存储的所述车辆位置坐标移除,并将要存储的所述车辆位置坐标存入末位地址内;否则将存储地址加1,并存入要存储的所述车辆位置坐标。
4.根据权利要求1所述的基于轨迹跟踪的倒车循迹控制方法,其特征在于,所述根据存储的所述车辆位置坐标、当前车辆位置坐标,计算循迹总里程,具体为:
5.根据权利要求1所述的基于轨迹跟踪的倒车循迹控制方法,其特征在于,所述获取初始目标轨迹点,计算当前车辆位置坐标与所述初始目标轨迹点之间的距离,具体为:
6.根据权利要求5所述的基于轨迹跟踪的倒车循迹控制方法,其特征在于,所述更新初始目标轨迹点,具体为:
7.根据权利要求6所述的基于轨迹跟踪的倒车循迹控制方法,其特征在于,在车辆坐标系下,车辆后轴中心坐标为所述车辆位置坐标;所述根据所述最终目标轨迹点计算方向盘转角控制值,具体为:
8.一种基于轨迹跟踪的倒车循迹控制系统,其特征在于,包括:
9.根据权利要求8述的基于轨迹跟踪的倒车循迹控制系统,其特征在于,还包括:
10.根据权利要求8述的基于轨迹跟踪的倒车循迹控制系统,其特征在于,所述判断模块还用于判断存储空间是否已满,若已满,根据先入先出策略将首个存储的车辆位置坐标移除,并将要存储的车辆位置坐标存入末位地址内;否则将存储地址加1,并存入要存储的车辆位置坐标。