一种无人赛车路径规划方法、系统、装置及存储介质与流程

文档序号:30270499发布日期:2022-06-02 08:23阅读:来源:国知局

技术特征:
1.一种无人赛车路径规划方法,其特征在于,包括以下步骤:获取赛车状态信息,并根据所述状态信息初始化状态向量和控制向量;建立赛车动力学模型,对所述赛车动力学模型进行处理得到赛车预测模型,并利用所述状态向量和所述控制向量对所述赛车预测模型进行参数更新;确定所述赛车预测模型的系统输出量为等效横纵向误差;根据所述等效横纵向误差确定所述赛车预测模型的目标函数,所述目标函数包括控制变量的惩罚和角速度惩罚;建立道路边界约束和行驶稳定性约束;根据所述目标函数、所述道路边界约束和所述行驶稳定性约束,得到局部规划路径。2.根据权利要求1所述的一种无人赛车路径规划方法,其特征在于,所述无人赛车路径规划方法还包括以下步骤:将所述局部规划路径拼接到半局部规划路径上得到全局路径,其中,所述半局部规划路径包含若干个局部规划路径的轨迹线。3.根据权利要求2所述的一种无人赛车路径规划方法,其特征在于,所述局部规划路径包括第一路径和第二路径,所述将所述局部规划路径拼接到半局部规划路径上得到全局路径这一步骤,包括以下步骤:将所述第一路径拼接到所述半局部规划路径中;通过所述第二路径确定所述状态向量和所述控制向量。4.根据权利要求1所述的一种无人赛车路径规划方法,其特征在于,所述赛车动力学模型的表达式为:其中,m为赛车的质量,i
z
为赛车绕z轴的转动惯量,l
f
为赛车质心到赛车前轴的距离,l
r
为赛车质心到后轴的距离,x为惯性坐标系下赛车质心的横坐标,y为惯性坐标系下赛车质心的纵坐标,为所述横坐标对时间变量的一阶导数,为纵坐标对时间变量的一阶导数,为赛车质心的航偏角,v
x
为赛车质心的纵向速度,为所述纵向速度对时间变量的一阶导数,v
y
为赛车质心的横向速度,为所述横向速度对时间变量的一阶导数,ω为赛车的角速度,为所述角速度对时间变量的一阶导数,δ为赛车前轮转角,τ
tv
为附加扭矩,f
x
为赛车所受纵向力,f
f,y
为赛车的前轮的侧向力,f
r,y
为后轮的侧向力。5.根据权利要求1所述的一种无人赛车路径规划方法,其特征在于,所述对所述赛车动力学模型进行处理得到赛车预测模型这一步骤,包括以下步骤:
对所述赛车动力学模型进行线性处理得到线性动力学模型;对所述线性动力学模型进行离散处理得到离散动力学模型;将所述离散动力学模型的控制量替换为控制增量得到所述赛车预测模型。6.根据权利要求4所述的一种无人赛车路径规划方法,其特征在于,所述道路边界约束的表达式如下:其中,f
k
是边界约束的线性化矩阵,表示t时刻,预测时域内第k个状态向量,分别是根据左右边界点计算得到的约束上下界,ε
b
是边界约束对应的松弛因子。7.根据权利要求1所述的一种无人赛车路径规划方法,其特征在于,所述对所述目标函数和所述道路边界约束和所述行驶稳定性约束,得到局部规划路径这一步骤,包括以下步骤:对所述目标函数、所述道路边界约束和所述行驶稳定性约束进行向量化处理,根据向量化处理得到的结果进行矩阵化处理,得到二次规划表达式;对所述二次规划表达式进行求解得到最优解,所述最优解中包含有所述局部规划路径的规划信息。8.一种无人赛车路径规划系统,其特征在于,所述对接系统包括:信息获取模块,用于获取赛车状态信息,并根据所述状态信息初始化状态向量和控制向量;模型建立模块,用于建立赛车动力学模型,对所述赛车动力学模型进行处理得到赛车预测模型,并利用所述状态向量和所述控制向量对所述赛车预测模型进行参数更新;误差确定模块,用于确定所述赛车预测模型的系统输出量为等效横纵向误差;函数确定模块,用于根据所述等效横纵向误差确定所述赛车预测模型的目标函数,所述目标函数内包括有控制变量的惩罚和角速度惩罚;约束建立模块,用于建立道路边界约束和行驶稳定性约束;路径规划模块,用于根据所述目标函数和所述道路边界约束和所述行驶稳定性约束,得到局部规划路径。9.一种无人赛车路径规划装置,其特征在于,包括:至少一个处理器;至少一个存储器,用于存储至少一个程序;当所述至少一个程序被所述至少一个处理器执行,使得所述至少一个处理器实现如权利要求1-7任一项所述的一种无人赛车路径规划方法。10.一种存储介质,其中存储有处理器可执行的指令,其特征在于,所述处理器可执行的指令在由处理器执行时用于执行如权利要求1-7任一项所述的一种无人赛车路径规划方法。

技术总结
本发明公开了一种无人赛车路径规划方法、系统、装置及存储介质,方法包括:获取赛车状态信息,并根据状态信息初始化状态向量和控制向量;建立赛车动力学模型,对赛车动力学模型进行处理得到赛车预测模型;确定赛车预测模型的系统输出量为等效横纵向误差;根据等效横纵向误差确定目标函数;建立道路边界约束和行驶稳定性约束;根据目标函数和道路边界约束和行驶稳定性约束,得到局部规划路径。本发明通过综合考虑边界约束和行驶稳定性约束,使赛车轮胎侧向力位于线性区域内,增强赛车的操纵稳定性;在目标函数中加入控制变量的惩罚和角速度惩罚,在保证路径动力学可执行性的同时提升赛车的圈速成绩。本发明可广泛应用于路径规划技术领域。术领域。术领域。


技术研发人员:李巍华 龚国铮 郑少武 陈少豪 叶鸣 黎杰 于善虎 卢仲康
受保护的技术使用者:广州华工机动车检测技术有限公司
技术研发日:2022.02.16
技术公布日:2022/6/1
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1