欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2025111205662
申请人: 吉林大学
专利类型:发明专利
专利状态:已下证
专利领域: 一般车辆
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种考虑驾驶模式的智能汽车预瞄跟踪方法,其特征在于,包括以下步骤:步骤1:离线设计;

步骤1.1:设计驾驶模板;

将驾驶任务分解为个曲率运动基元和个速度运动基元,生成位姿驾驶模板和车速驾驶模板;

步骤1.2:构建优化问题;

以曲率增量、加速度增量、曲率段弧长增量和加速度段弧长增量为优化参数,构建包含位姿方案和速度方案的优化问题;

步骤1.3:设计价值函数子模块,所述价值函数子模块具体包括舒适性价值函数子模块、节能性价值函数子模块、运动性价值函数子模块和精准性价值函数子模块;

步骤1.4:交通规则及机动能力约束模块设计;设置约束条件包括交通规则约束、汽车机动能力约束和驾驶任务目标点约束;

步骤2:在线预瞄;

步骤2.1:驾驶模式权重分配;

根据驾驶模式指令或驾驶员偏好,选择驾驶模式,即权重分配为精准性、舒适性、节能型、运动性模式;

步骤2.2:驾驶任务获取及驾驶模板确定;

将期望行驶轨迹作为Frenet坐标系的参考曲线,并根据左右边界道路速度上下限生成偏差曲线和速度曲线;结合车辆状态生成带初始优化参数的驾驶模板;

步骤2.3:运动预瞄;

输入驾驶任务,采用SQP优化方法求解优化问题,输出预瞄位姿方案、预瞄车速方案、预瞄转弯强度以及预瞄变速强度;

步骤2.4:重预瞄判断;

若预瞄结果的位姿或车速偏差超过容差,则重复步骤2.1和步骤2.2;否则根据新任务决定是否重启预瞄;

所述步骤1.4包括以下具体步骤:

交通规则约束包括汽车车速上限、汽车车速下限、左边界和右边界;汽车机动能力约束包括汽车随车速而变化的加速度上限、侧向加速度上限;驾驶任务目标点约束包括位姿要求及速度要求;

考虑交通规则及汽车的机动能力作为约束,同时将驾驶任务的目标点要求作为约束;考虑汽车在不同空间位置的交通规则约束,交通规则约束包括汽车车速上限、汽车车速下限、左边界和右边界;

(13);

式中,为车速,和表示左边界和右边界在以期望行驶轨迹为参考线的Frenet坐标系下的偏移量,和为交通规则允许最小车速和最大车速;

汽车机动能力约束包括汽车随车速而变化的加速度上限、侧向加速度上限;

(14);

式中,为当前汽车侧向加速度,为汽车当前加速度;

驾驶任务目标点要求包括位姿要求及速度要求,采用期望终点里程和推测终点里程的偏差,期望终点偏距和推测终点偏距的偏差,期望终点角和推测终点角的偏差,期望终点速度和推测终点速度的偏差分别满足各自容差作为约束:(15);

综上所示,目标函数以四种驾驶模式总和组成,对各价值函数赋予不同的权重代表对不同驾驶模式的偏爱程度,得出优化问题如下式:(16);

式中,为优化目标,分别为对精准性、舒适性、节能性和运动性的权重,为精准性价值函数,为舒适性价值函数,为节能性价值函数,为运动性的价值函数。

2.根据权利要求1所述的考虑驾驶模式的智能汽车预瞄跟踪方法,其特征在于,在所述步骤1.1中,驾驶任务的分段包括沿道行驶、左转、右转、左换道、右换道、左超车、右超车及掉头;

曲率运动基元由直行和转向两种运动形式构成,速度运动基元由稳速和变速两种形式构成;

所述位姿驾驶模板通过圆弧或直线拟合期望行驶轨迹,以拟合轨迹与期望轨迹偏差小于阈值为目标,利用二分法求取初始曲率和初始弧长;

所述车速驾驶模板通过匀加速运动拟合期望车速,以拟合车速与期望车速偏差小于阈值为目标,利用二分法求取初始加速度和初始段长。

3.根据权利要求1所述的考虑驾驶模式的智能汽车预瞄跟踪方法,其特征在于,所述步骤1.2包括以下具体步骤:根据驾驶模板,位姿方案选取段圆弧或直线跟随汽车期望行驶轨迹,圆弧由曲率与曲率段弧长两个变量所确定;速度方案选取段匀速运动及匀变速运动拟合,由加速度与加速度段长度两个变量确定;采用曲率增量、加速度增量、曲率段弧长增量和加速度段弧长增量作为优化参数,优化参数个数为;优化参数可行域范围由汽车机动能力与驾驶模板组成,具体如式(1):(1);

式中,表示转弯段的门槛值,表示变速段的门槛值,表示驾驶任务总长度,为每段最小段长;位姿曲线由段圆弧或直线拼接而成,每段曲率一致;位姿推测方程采用圆弧推测公式(2)和直线推测公式(3):(2);

(3);

上式中,表示圆弧半径,表示转过的角度,为汽车初始航向角,为汽车当前纵向位置,为汽车初始纵向位置,为汽车当前横向位置,为汽车初始横向位置;当一段位姿曲线推测完成后,将该段终点视为下段起点再次推测,循环次;同理,车速曲线由段匀变速或匀速运动组成,每段加速度一致,车速V的推测方程采用匀变速推测公式:(4);

其中,为汽车初始车速,为汽车当前加速度,为变速段的段长;推测方程依靠优化参数输入,输出期望位姿方案、期望速度方案、转弯强度方案以及变速强度方案。

4.根据权利要求3所述的考虑驾驶模式的智能汽车预瞄跟踪方法,其特征在于,在所述步骤1.3中,舒适性价值函数子模块的具体设计如下:舒适性是预瞄的汽车加速度是否使得驾驶员和乘客感到舒适;采用时域的均方根加速度作为舒适性评价指标;

等空间离散采样预瞄结果的汽车加速度与汽车向心加速度,将其转换到驾驶员头部加速度,利用离散求和的方法近似计算定积分;加速度转换公式如式(5)所示:(5);

式中,表示驾驶员头部的加速度,表示驾驶员头部的向心加速度,表示汽车加速度,表示汽车向心加速度,表示驾驶员头部位置矢量,表示侧倾角速度,表示纵倾角速度,表示横摆角速度;

加权均方根公式如式(6)所示:

(6);

式中,表示加权均方根,表示第个采样点与第个采样点的间隔时间,表示第个采样点的加速度,表示采样点的数量;

针对舒适性评价指标,只考虑转弯段与变速段,不考虑沿道段与稳速段,即舒适性价值函数取个转弯段的均方根侧向加速度平方和和个变速段的均方根纵向加速度平方和;舒适性价值函数如公式(7)所示:(7);

式中,表示第段驾驶员头部的向心加速度,表示第段驾驶员头部的加速度。

5.根据权利要求4所述的考虑驾驶模式的智能汽车预瞄跟踪方法,其特征在于,在所述步骤1.3中,节能性价值函数子模块的具体设计如下:假设汽车行驶过程中汽车质量不变,记功除以质量为比功;采用汽车每段所消耗的总比功平方和作为节能性价值函数:(8);

式中,为节能性价值函数,表示第段的汽车行驶比合力,表示第个采样点与第个采样点的间隔距离,具体表现为相等的距离;在汽车行驶过程中,汽车行驶合力考虑克服加速的加速阻力、轮胎滚动产生的滚阻、与空气相互作用产生的风阻以及克服道路坡度的坡阻,故合力f计算公式如下:(9)。

6.根据权利要求5所述的考虑驾驶模式的智能汽车预瞄跟踪方法,其特征在于,在所述步骤1.3中,运动性价值函数子模块的具体设计如下:采用每段所消耗的时间平方和作为运动性的价值函数:(10);

式中,为运动性的价值函数,表示第段的行驶时间,由下式计算:(11)。

7.根据权利要求6所述的考虑驾驶模式的智能汽车预瞄跟踪方法,其特征在于,在所述步骤1.3中,精准性价值函数子模块的具体设计如下:建立预瞄结果与期望的横向偏差作为精准性价值函数:(12);

式中,为精准性价值函数,表示第段中在以期望行驶轨迹为参考线的Frenet坐标系下的最大偏移量,为表示第段中最大的车速偏差。

8.根据权利要求1所述的考虑驾驶模式的智能汽车预瞄跟踪方法,其特征在于,在所述步骤2.3中,预瞄转弯强度以及预瞄变速强度的计算公式如下:(17);

其中,为重力加速度,为汽车行驶曲率。