预览加载中,请您耐心等待几秒...
1/10
2/10
3/10
4/10
5/10
6/10
7/10
8/10
9/10
10/10

亲,该文档总共13页,到这已经超出免费预览范围,如果喜欢就直接下载吧~

如果您无法下载资料,请参考说明:

1、部分资料下载需要金币,请确保您的账户上有足够的金币

2、已购买过的文档,再次下载不重复扣费

3、资料包下载后请先用软件解压,在使用对应软件打开

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN110789530A(43)申请公布日2020.02.14(21)申请号201911134776.1(22)申请日2019.11.19(71)申请人中国科学院深圳先进技术研究院地址518055广东省深圳市南山区深圳大学城学苑大道1068号(72)发明人徐坤肖卫星李慧云(74)专利代理机构北京市诚辉律师事务所11430代理人耿慧敏(51)Int.Cl.B60W40/10(2012.01)B60W50/00(2006.01)权利要求书2页说明书7页附图3页(54)发明名称一种四轮独立转向-独立驱动车辆轨迹跟踪方法和系统(57)摘要本发明提供一种四轮独立转向-独立驱动车辆轨迹跟踪方法和系统。该方法包括:在目标轨迹上选择同时满足前探距离约束和径向距离约束的点作为前探点,其中,所述径向距离约束是径向距离系数和横向误差之间的乘积,所述横向误差是所述目标轨迹上与车身基准点之间的最短距离;根据所述前探点和车身当前的位置关系,拟合出一条经过所述前探点和车身基准点的圆弧轨迹并计算圆弧轨迹的半径;根据设定车速和所述圆弧轨迹半径计算出车身基准点处的角速度;根据车身基准点处的角速度和线速度获得车轮的转速控制量和转角控制量以控制车辆沿所述目标轨迹行进。本发明的方法和系统改善了轨迹跟踪精度、误差收敛速度以及跟踪过程中车身的平顺性。CN110789530ACN110789530A权利要求书1/2页1.一种四轮独立转向-独立驱动车辆轨迹跟踪方法,包括:在目标轨迹上选择同时满足前探距离约束和径向距离约束的点作为前探点,其中,所述径向距离约束是径向距离系数和横向误差之间的乘积,所述横向误差是所述目标轨迹与车身基准点之间的最短距离;根据所述前探点和车身当前的位置关系,拟合出一条经过所述前探点和车身基准点的圆弧轨迹并计算圆弧轨迹的半径;根据设定车速和所述圆弧轨迹半径计算出车身基准点处的角速度;根据车身基准点处的角速度和线速度获得车轮的转速控制量和转角控制量以控制车辆沿所述目标轨迹行进。2.根据权利要求1所述的四轮独立转向-独立驱动车辆轨迹跟踪方法,其中,适应于所述目标轨迹的曲率信息动态地调整所述前探距离约束。3.根据权利要求2所述的四轮独立转向-独立驱动车辆轨迹跟踪方法,其中,根据以下步骤设置所述前探距离约束:在所述目标轨迹上,选择与车身基准点距离最短的车身最近路径点,并在所述车身最近路径点的前方选择多个路径点;计算所述车身最近路径点的曲率信息和所述多个路径点的曲率信息;根据所述多个路径点的曲率信息和所述车身最近路径点的曲率信息动态调整所述前探距离约束。4.根据权利要求3所述的四轮独立转向-独立驱动车辆轨迹跟踪方法,其中,所述多个路径点包括所述车身最近路径点前方1.5m处的路径点和所述车身最近路径点前方3m处的路径点。5.根据权利要求3所述的四轮独立转向-独立驱动车辆轨迹跟踪方法,其中,根据所述多个路径点的曲率信息和所述车身最近路径点的曲率信息动态调整所述前探距离约束包括:利用模糊控制器构建所述多个路径点的曲率信息、所述车身最近路径点的曲率信息与所述前探距离约束之间的关联关系;利用所述关联关系通过反模糊方式输出所述前探距离约束,作为选择前探点的依据。6.根据权利要求1所述的四轮独立转向-独立驱动车辆轨迹跟踪方法,其中,所述径向距离系数预先设置为0.6或0.9或1.2。7.一种四轮独立转向-独立驱动车辆轨迹跟踪系统,包括:前探点选择模块:用于在目标轨迹上选择同时满足前探距离约束和径向距离约束的点作为前探点,其中,所述径向距离约束是径向距离系数和横向误差之间的乘积;圆弧轨迹计算模块:用于根据所述前探点和车身当前的位置关系,拟合出一条经过所述前探点和车身基准点的圆弧轨迹并计算圆弧轨迹的半径;角速度计算模块:用于根据设定车速和所述圆弧轨迹半径计算出车身基准点处的角速度;转向控制模块:用于根据车身基准点处的角速度和线速度获得车轮的转速控制量和转角控制量以控制车辆沿所述目标轨迹行进。8.根据权利要求7所述的四轮独立转向-独立驱动车辆轨迹跟踪系统,其中,所述前探2CN110789530A权利要求书2/2页点选择模块还用于执行:在所述目标轨迹上,选择与车身基准点距离最短的车身最近路径点,并在所述车身最近路径点的前方选择多个路径点;计算所述车身最近路径点的曲率信息和所述多个路径点的曲率信息;根据所述多个路径点的曲率信息和所述车身最近路径点的曲率信息动态调整所述前探距离约束。9.一种计算机可读存储介质,其上存储有计算机程序,其中,该程序被处理器执行时实现根据权利要求1至7中任一项所述方法的步骤。10.一种计算机设备,包括存储器和处理器,在所述存储器上存储有能够在处理器上运行的计算机程序,其特征在于,所述处理器执