一种路径跟踪与车身姿态协同控制方法技术

本发明专利技术公开了一种路径跟踪与车身姿态协同控制方法，包括以下步骤：步骤1、基于传感器获取的道路信息实时规划出期望路径；步骤2、基于车辆逆动力学模型对车辆进行前馈控制，优先满足路径跟踪精度和抗侧翻性能两个对行驶安全影响较大的控制目标；步骤3、设置综合评价模块用于评价前一个控制周期的前馈控制效果，得到各项性能分配权重，步骤4、在一个控制周期内不断重复由前馈控制模块中的传感器到反馈调节模块的闭环控制，直到周期结束从前馈控制模块进入下一周期。有益效果：使用逆动力学模型，克服了正向动力学模型阶数高、系统参数难确定、底盘执行系统非线性强等缺点，提高了系统反应速度和初始输出精度，降低了输出量的抖振。振。振。

【技术实现步骤摘要】
一种路径跟踪与车身姿态协同控制方法


[0001]本专利技术涉及一种路径跟踪控制方法，特别提供了一种路径跟踪与车身姿态协同控制方法。

技术介绍

[0002]近年来，随着人工智能、芯片和传感器的飞速发展，智能化、网联化成为了汽车行业的研究热点，为汽车产业的持续升级注入了强大动力。智能汽车在具有驾驶行为可预测、减少交通事故发生率、提高通勤效率等诸多优点的同时，也对道德伦理和法律法规的稳定和发展提出了挑战，固公众对智能驾驶汽车安全性的要求要显著高于传统汽车。
[0003]在运动控制层面，智能汽车的行驶安全性主要包括如下两方面：准确地沿着期望路径行驶，避免碰撞与超出车道线；改变行驶方向时不侧翻，不侧滑，即在一定范围内保持车身姿态和操纵稳定性。
[0004]现阶段大多数智能汽车的运动控制是在不考虑车身姿态控制和操纵稳定性的情况下保证路径跟踪精度，即仅满足行驶安全性的第一点。但在实际路径跟踪过程中，车身姿态和路径跟踪精度之间相互耦合制约，在保持和提高路径跟踪精度的同时可能伴随着车身姿态和操纵稳定性的急剧恶化，增加了侧翻和侧滑的概率。
本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种路径跟踪与车身姿态协同控制方法，其特征在于，包括以下步骤：步骤1、开启路径跟踪与车身姿态协同控制器，基于传感器获取的道路信息实时规划出期望路径；步骤2、车载计算机根据行驶需求、道路条件，基于车辆逆动力学模型对车辆进行前馈控制，优先满足路径跟踪精度和抗侧翻性能两个对行驶安全影响较大的控制目标；步骤3、设置综合评价模块用于评价前一个控制周期的前馈控制效果，首先使用熵权融合的方法实时得到路径跟踪精度、车身姿态保持性能、振动舒适度、抗侧翻性能、防侧滑性能的权重，其方法是：对传感器数据进行处理从而获取对路径跟踪精度、车身姿态保持性能、振动舒适度、抗侧翻性能、防侧滑性能等量化评价并进行归一化处理；基于每个指标所对应的传感器数据，包括：路径跟踪精度对应横向位移偏差y
e
阈值、横向方位偏差e阈值、横摆角速度阈值w
e
，得到该项指标的熵值，进而得到各指标权值；根据驾驶员对行驶性能偏向的选择将路径跟踪精度和振动舒适度指标权重乘以系数k1和k2得到综合评价指标H，其中k1+k2＝2，若驾驶性能偏向运动则k1取2，若偏向舒适则k1＝0，其他情况在0和2之间线性调整；若熵权融合后的综合指标H小于0.8，则允许进入下一周期的前馈控制；若H大于0.8小于1，则暂停前馈控制只保留反馈控制模块；若H大于1，则提醒驾驶员介入；步骤4、在一个控制周期内以前馈控制模块中的传感器最慢工作步长为负反馈控制步长，不断重复由前馈控制模块中的传感器到反馈调节模块的闭环控制，直到周期结束从前馈控制模块进入下一周期；若行驶状态参数超出预警值，则预警并提示驾驶员介入，并直接跳出该控制周期进入下一周期。2.根据权利要求1所述的路径跟踪与车身姿态协同控制方法，其特征在于：所述步骤2具体操作流程如下：根据驾驶员对驾驶风格的选择，确立驾驶过程中对路径跟踪精度、车身姿态保持性能、振动舒适度、抗侧翻性能、防侧滑性能性能指标的偏向性；车载计算机则根据传感器获取的道路、车流密度等情况结合驾驶风格确定性能需求，以及当前工况下路径跟踪系统和车身姿态系统控制参数的分配权重；以路径跟踪精度、抗侧翻性能为约束条件，基于上述对各项性能的权重分配，求解表征约束条件的横向位移偏差y
e
阈值、横向方位偏差e阈值、横摆角速度阈值w
e
；通过对激光雷达获取的点云图和车载摄像头所获取图像进行噪点滤除、多帧融合、主要特征聚类的方式得到当前位移偏差和道路曲率，将当前位移偏差和前方x米的道路曲率和横向位移偏差ye阈值、横向方位偏差e阈值、横摆角速度阈值输入横向逆动力学模型，得到满足跟踪精度要求的车速v
x
和预瞄距离x
e
；其中x米的取值为过去2s的平均车速的数值乘以5；通过车载三轴加速度计实时测得侧倾角和侧倾角速度，通过动平衡分析得到侧倾阈值TTR值并输入垂向逆动力学模型，得到满足抗侧翻性能的车速v
x
和预瞄距离x
e
；当满足路径跟踪精度和抗侧翻性能的车速v
x
和预瞄距离x
e
有交集时，根据驾驶员所选取的驾驶风格选取车速v
x
和预瞄距离x
e
，并通过纵向逆动力学模型控制油门开度、档位和刹
车以控制车速；若满足路径跟踪精度需求和抗侧翻性能的车速v
x
和预瞄距离x
e
没有交集，则向驾驶员发出警示并直接进入反馈调节系统。3.根据权利要求1所述的路径跟踪与车身姿态协同控制方法，其特征在于：所述步骤3具体控制逻辑如下：当路径跟踪精度、操纵稳定性和舒适度均满足要求，以前馈+反馈正常进行路径跟踪；当路径跟踪精度低于阈值，但操稳性和车身姿态均满足要求时，降低预瞄距离进行跟踪精度补偿；当路径跟踪精度不满足要求且有换道条件、无侧翻危险时，对操稳性和舒适度进行姿态补偿；当路径跟踪精度不满足要求、有换道条件但换道有侧翻危险时，对车辆减速纠正并进行姿态补偿；当跟踪精度不满足且没有换道条件，对车辆进行跟踪精度补偿，若操稳性恶化则进行姿态补偿；当车身姿态补偿和路径跟踪精度补偿都无法达到广义控制目标时，预警、制动减速并提示驾驶员介入。4.根据权利要求1所述的路径跟踪与车身姿态协同控制方法，其特征在于：以路径跟踪精度、操纵稳定性和侧倾安全性为约束条件，基于道路条件、行驶状态和性能需求偏向算出侧倾时限TTR值、横向位移偏差y
e
阈值、横向方位偏差e阈值，将侧倾时限TTR值代入垂向逆动力学模型，将横向位移偏差y
e
阈值、横向方位偏差e阈值带入横向逆动力学模型，分别求解满足实时约束条件的车速v
x
和预瞄距离x
e
；由两个逆动力学模型求解出的车速v
x
及预瞄距离x
e
在二维平面上分别构成闭合的平面，根据实时性能需求偏向在两封闭平面的重合区域内选择合适的车速v
x
和预瞄距离x
e
输出至执行机构。5.根据权利要求4所述的路径跟踪与车身姿态协同控制方法，其特征在于：以道路参数、行驶状态参数和协同控制约束条件为输入，具体包括：前方道路曲率、当前车辆方位偏差y
e
、位移偏差e、横摆角速度、最大位移偏差阈值、最大方位偏差阈值，输出为满足路径跟踪精度和操纵稳定性要求的车速v
x
和预瞄距离x
e
；垂向逆动力学模型输入为车身侧倾角速度、侧倾TTR时限阈值，输出为满足侧倾安全性的车速v
x
和预瞄距离x
e
。6.根据权利要求4或5所述的路径跟踪与车身姿态协同控制方法，其特征在于：所述逆动力学模型获取方法如下：根据二自由度汽车开环系统模型和预瞄跟踪模型的运动微分方程，进行正向动力学模型求解，获取不同道路曲率、不同工况、不同预瞄距离下表述路径跟踪精度的输入输出数据集，得到路径跟踪系统输入输出的显式表达；在此基础上，将广义回归神经网络应用到自动驾驶汽车横向逆动力学建模中，以车辆正常行驶即：不与道路边界碰撞、不侧翻为约束条件选取输入输出集，提取车辆侧倾角、侧倾角速度、横向位移偏差y
e
、横向方位偏差e，构建自动驾驶汽车正常路径跟踪系统多输入多输出数据集，对于广义回归神经网络求和层神经元数据加权求和进行匹配设计，最终得到准确反映车辆横向动力学和预瞄跟踪特性的逆动力学模型。
7.根据权利要求6所述的路径跟踪与车身姿态协同控制方法，其特征在于：基于车辆二自由度模型和预瞄跟踪模型得到输入输出集，并通过以下步骤实现：基于二自由度车辆动力学方程，建立二自由度车辆动力学模型；根据轮胎的侧偏角与车辆质心侧偏角、横摆角速度及质心距前后...

【专利技术属性】
技术研发人员：汪若尘，张凯峰，叶青，丁仁凯，
申请(专利权)人：江苏大学，
类型：发明
国别省市：