一种基于轨迹跟踪的倒车循迹控制方法及系统与流程

文档序号:37215962发布日期:2024-03-05 15:05阅读:来源:国知局

技术特征:

1.一种基于轨迹跟踪的倒车循迹控制方法,其特征在于,包括:正向轨迹存储阶段和倒车循迹阶段;其中:

2.根据权利要求1所述的基于轨迹跟踪的倒车循迹控制方法,其特征在于,在所述正向轨迹存储阶段之前,还包括:

3.根据权利要求1所述的基于轨迹跟踪的倒车循迹控制方法,其特征在于,存储所述车辆位置坐标前,判断存储空间是否已满,若已满,根据先入先出策略,将第一个地址内存储的所述车辆位置坐标移除,并将要存储的所述车辆位置坐标存入末位地址内;否则将存储地址加1,并存入要存储的所述车辆位置坐标。

4.根据权利要求1所述的基于轨迹跟踪的倒车循迹控制方法,其特征在于,所述根据存储的所述车辆位置坐标、当前车辆位置坐标,计算循迹总里程,具体为:

5.根据权利要求1所述的基于轨迹跟踪的倒车循迹控制方法,其特征在于,所述获取初始目标轨迹点,计算当前车辆位置坐标与所述初始目标轨迹点之间的距离,具体为:

6.根据权利要求5所述的基于轨迹跟踪的倒车循迹控制方法,其特征在于,所述更新初始目标轨迹点,具体为:

7.根据权利要求6所述的基于轨迹跟踪的倒车循迹控制方法,其特征在于,在车辆坐标系下,车辆后轴中心坐标为所述车辆位置坐标;所述根据所述最终目标轨迹点计算方向盘转角控制值,具体为:

8.一种基于轨迹跟踪的倒车循迹控制系统,其特征在于,包括:

9.根据权利要求8述的基于轨迹跟踪的倒车循迹控制系统,其特征在于,还包括:

10.根据权利要求8述的基于轨迹跟踪的倒车循迹控制系统,其特征在于,所述判断模块还用于判断存储空间是否已满,若已满,根据先入先出策略将首个存储的车辆位置坐标移除,并将要存储的车辆位置坐标存入末位地址内;否则将存储地址加1,并存入要存储的车辆位置坐标。


技术总结
本发明公开一种基于轨迹跟踪的倒车循迹控制方法及系统,包括:正向轨迹存储阶段和倒车循迹阶段;正向轨迹存储阶段包括:实时获取车辆姿态坐标和行驶里程;存储车辆位置坐标;倒车循迹阶段包括:计算循迹总里程;确定最终循迹里程;循迹剩余行驶里程;获取初始目标轨迹点;确定最终目标轨迹点;计算方向盘转角控制值;判断剩余行驶里程是否小于预设距离,若是,结束倒车循迹;若否,实时获取车辆姿态坐标和行驶里程,根据行驶里程和最终循迹里程计算剩余行驶里程,并循迹剩余行驶里程。本发明通过存储正向行驶的车辆姿态坐标即可实现倒车循迹时的闭环轨迹跟踪,可以避免倒车时与正向行驶的轨迹发生偏差的问题。

技术研发人员:吕英超,吕荣华
受保护的技术使用者:苏州优达斯汽车科技有限公司
技术研发日:
技术公布日:2024/3/4
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1