利索能及
我要发布
收藏
专利号: 2024104954440
申请人: 山东交通学院
专利类型:发明专利
专利状态:已下证
更新日期:2026-05-14
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种基于FHS‑LQR算法的智能车辆轨迹跟踪方法,其特征在于,包括如下步骤:S1.建立车辆跟踪误差动力学模型;步骤S1具体步骤如下:

S11.将整车进行等效简化,构建二自由度的车辆动力学模型;

S12.引入车辆运动中的横向误差和横摆角误差,并基于二自由度的车辆动力学模型构建车辆跟踪误差动力学模型;步骤S12中,根据车辆前后轮胎的横向偏刚度、车辆质量、车辆的纵向速度、车辆质心到投影点的速度、车辆横摆角误差及误差变化率、车辆质心到前轴的距离、车辆质心到后轴的距离构建以车辆质心到投影点的加速度为目标函数的车辆跟踪误差模型方程如下:其中, 为车辆质心到投影点的加速度, 为车辆质心到投影点的速度, 为车辆横摆角误差, 为车辆横摆角的误差变化率, 为车辆前轮胎的横向侧偏刚度, 车辆后轮胎的横向侧偏刚度,a为车辆质心到前轴的距离,b为车辆质心到前后轴的距离,m为车辆质量, 为车辆的纵向速度;

根据车辆质心到前轴的距离、车辆质心到后轴的距离、车辆前后轮胎的横向偏刚度转动惯量、车辆的纵向速度、车辆质心到投影点的速度、车辆横摆角误差变化率构建以车辆横摆角误差加速度为目标函数的车辆跟踪误差模型方程如下:其中, 为车辆横摆角误差变化率构, 为车辆质心到投影点的速度, 为车辆横摆角误差, 为车辆横摆角的误差变化率, 为车辆前轮胎的横向侧偏刚度, 车辆后轮胎的横向侧偏刚度,a为车辆质心到前轴的距离,b为车辆质心到前后轴的距离, 为车辆的纵向速度,I为车辆前后轮胎的横向偏刚度转动惯量;

S2.以转向机构扰动作为随机噪声构建FHS‑LQR控制器,根据Riccati‑ZXL方程计算FHS‑LQR控制器的最优控制率;步骤S2具体步骤如下:S21.引入均值和方差已知的转向机构扰动作为标量随机白噪声构建轨迹跟踪的FHS‑LQR控制器;

S22.基于成本函数,以轨迹跟踪成本最低为目标计算FHS‑LQR控制器的最优控制率;

S3.使用车辆跟踪误差动力模型对预测的车辆轨迹参数计算运行误差,基于运行误差和最优控制率生成车辆转角控制车辆运动;

S4.基于道路曲率构建速度规划模块,将速度规划模块添加到预测模型,控制车辆转向时的精度。

2.如权利要求1所述的基于FHS‑LQR算法的智能车辆轨迹跟踪方法,其特征在于,步骤S11具体步骤如下:S111.构建车辆动力学模型;

S112.设定车辆前后轮的侧偏刚度相同,省略车辆悬架,将整车等效简化为两个车轮;

S113.基于等效简化后的整车及基础车辆动力学模型构建二自由度的车辆动力学模型。

3.如权利要求2所述的基于FHS‑LQR算法的智能车辆轨迹跟踪方法,其特征在于,步骤S111中,根据车辆质量、车辆横向加速度、转动惯量、车辆横摆角、车辆前轮转角、车辆质心到前轴的距离、车辆质心到后轴的距离以及作用在车辆前后轮胎上的侧向力构建车辆动力学模型如下:其中, 为车辆质量, 为车辆横向加速度, 为转动惯量, 为车辆横摆角加速度,分别为车辆质心到前后轴的距离,为车辆前轮转角, 分别为作用在车辆前后轮胎上的侧向力;

步骤S113中,以等效简化后车辆及车辆动力学模型为基础,根据车辆质量、转动管理、车辆横摆加速度、车辆质心到前轴的距离、车辆质心到后轴的距离、车辆前轮转角、车辆前后轮胎的横向侧偏刚度、纵向速度及横向速度构建二自由度的车辆动力学模型如下:其中, 表示车辆质量,表示转动惯量,表示车辆横摆加速度,和 分别表示车辆质心到前后车轴的距离,表示车辆前轮转角,  和   分别是车辆前后轮胎的横向侧偏刚度,  和  分别为车辆的纵向速度和横向速度。

4.如权利要求3所述的基于FHS‑LQR算法的智能车辆轨迹跟踪方法,其特征在于,步骤S3具体步骤如下:S31.使用预测模型对车辆的横向位移、纵向位移、横摆角、横向速度、纵向速度及横摆角变化率进行预测;

S32.计算横向误差、横摆角误差、横向误差变化率及横摆角误差变化率;

S33.FHS‑LQR控制器基于最优控制率,并根据横向速度、横向误差、横摆角误差、横向误差变化率及横摆角误差变化率计算车辆车轮转角,并使用车辆车轮转角对车辆进行轨迹跟踪控制。

5.如权利要求4所述的基于FHS‑LQR算法的智能车辆轨迹跟踪方法,其特征在于,步骤S32具体步骤如下:S321.设定参考位置点,寻找与车辆实际位置距离最近的参考位置点,计算参考位置点的横向位置、纵向位置以及横摆角;

S322.根据参考位置点的横摆角、参考位置点的纵向位置、参考位置点的横向位置、预测横向位置、预测纵向位置计算横向误差、投影点与参考位置点的误差;

S323.根据横摆角及投影点横摆角计算横摆角误差;

S324.根据预测纵向速度、预测横向速度、横摆角、投影点横摆角计算横向误差变化率;

S325.根据横摆角变化率、投影点位置以及参考位置斜率计算横摆角误差变化率。

6.如权利要求4所述的基于FHS‑LQR算法的智能车辆轨迹跟踪方法,其特征在于,步骤S4具体步骤如下:S41.根据道路摩擦系数和道路曲率构建速度规划模块;

S42.以预测横向位置、预测纵向位置、预测横摆角、预测纵向速度、预测横向速度、预测横摆角加速度为目标函数构建预测模型;

S43.将速度规划模块添加到预测模型。

7.如权利要求6所述的基于FHS‑LQR算法的智能车辆轨迹跟踪方法,其特征在于,步骤S42具体步骤如下:S421.基于车辆横向速度得到预测横向速度,基于车辆纵向速度得到预测纵向速度,并使用速度规划模块的道路曲率对预测纵向速度进行修正,基于车辆横摆角速度得到预测横摆角速度;

S422.基于车辆横摆角、预测横摆角速度及预测时间计算预测横摆角;

S423.基于横向位置、预测横向速度、车辆纵向速度、车辆横摆角及预测时间计算预测横向位置;

S424.基于纵向位置、预测纵向速度、车辆横向速度、车辆横摆角及预测时间计算预测纵向位置。