基于卡尔曼滤波的车辆纵向阻力获取方法、装置及车辆.pdf

(19)国家知识产权局(12)发明专利申请(10)申请公布号CN115959140A(43)申请公布日2023.04.14(21)申请号202310254848.6(22)申请日2023.03.16(71)申请人安徽蔚来智驾科技有限公司地址230601安徽省合肥市经济技术开发区宿松路3963号恒创智能科技园F幢(72)发明人施雅风(74)专利代理机构北京瀚仁知识产权代理事务所(普通合伙)11482专利代理师陈敏(51)Int.Cl.B60W40/10(2012.01)权利要求书2页说明书8页附图1页(54)发明名称基于卡尔曼滤波的车辆纵向阻力获取方法、装置及车辆(57)摘要本发明涉及自动驾驶技术领域，具体提供一种基于卡尔曼滤波的车辆纵向阻力获取方法、装置、介质及车辆，旨在解决如何对自动驾驶车辆的整车纵向阻力进行精确估计的问题。为此目的，本发明在预测阶段构建车辆整车纵向阻力的状态表示，根据状态表示相关的动力学模型构建过程模型，基于过程模型获取当前时刻的整车纵向阻力的状态表示的预测值；在更新阶段根据预设条件，选择性地将预测值和当前时刻整车纵向阻力的状态表示的观测值进行融合，更新整车纵向阻力的状态表示的预测值，获得当前时刻的整车纵向阻力，为辅助驾驶系统提供纵向动力学的重要参考信息，辅助自动驾驶的决策和控制过程。CN115959140ACN115959140A权利要求书1/2页1.一种基于卡尔曼滤波的车辆纵向阻力获取方法，其特征在于，所述方法包括：预测阶段：构建车辆的整车纵向阻力的状态表示；基于所述状态表示相关的动力学模型构建过程模型；基于所述过程模型获取当前时刻的整车纵向阻力的状态表示的预测值；更新阶段：基于预设条件，选择性地将所述预测值和获取的当前时刻的整车纵向阻力的状态表示的观测值融合，更新所述整车纵向阻力的状态表示的预测值，以得到当前时刻的整车纵向阻力。2.根据权利要求1所述的方法，其特征在于，所述状态表示包括整车纵向阻力和质心纵向速度；所述动力学模型为车辆纵向动力学模型。3.根据权利要求2所述的方法，其特征在于，所述状态表示还包括主减速器的输出轴转速和轮胎纵向力；所述动力学模型还包括电轴纵向动力学模型。4.根据权利要求3所述的方法，其特征在于，所述过程模型中的控制变量为车辆的主减速器的输出轴转矩。5.根据权利要求1所述的方法，其特征在于，所述观测值包括主减速器的输出轴转速和质心纵向速度。6.根据权利要求5所述的方法，其特征在于，所述方法还包括：分别获取输出轴转矩、所述输出轴转速和所述质心纵向速度的变化梯度；将所述输出轴转矩、所述输出轴转速和所述质心纵向速度的变化梯度分别与对应的梯度阈值进行比较；当所述输出轴转矩、所述输出轴转速和所述质心纵向速度的变化梯度均大于对应的梯度阈值时，将获取的当前时刻的整车纵向阻力的状态表示的观测值以较低的滤波截至频率进行低通滤波处理，以降低所述更新的速度，否则以较高的滤波截至频率进行低通滤波处理，以提高所述更新的速度。7.根据权利要求1‑6中任一项所述的方法，其特征在于，所述基于预设条件，选择性地将所述预测值和获取的当前时刻的整车纵向阻力的状态表示的观测值融合，更新所述整车纵向阻力的状态表示的预测值，以得到当前时刻的整车纵向阻力，包括：判断所述车辆的机械制动是否介入；若是，使用上一时刻更新后的预测值作为当前时刻更新后的预测值，以得到当前时刻的整车纵向阻力；和/或若否，使用融合后的结果更新所述整车纵向阻力的状态表示的预测值，以得到当前时刻的整车纵向阻力。8.根据权利要求7所述的方法，其特征在于，所述机械制动介入的判断条件为：所述车辆的制动踏板开度大于预设开度；或，所述车辆的制动压力大于预设压力值；或，所述车辆的底盘制动系统自动介入。2CN115959140A权利要求书2/2页9.根据权利要求8所述的方法，其特征在于，所述方法还包括：获取所述机械制动介入后的制动距离；当所述制动距离大于预设距离时，将所述当前时刻更新后的预测值清零。10.根据权利要求1所述的方法，其特征在于，所述获取的当前时刻的整车纵向阻力的状态表示的观测值是通过对输入的整车纵向阻力状态表示的观测值进行低通滤波以使得所述观测值相位对齐后得到的。11.一种控制装置，包括至少一个处理器和至少一个存储装置，所述存储装置适于存储多条程序代码，其特征在于，所述程序代码适于由所述处理器加载并运行以执行权利要求1至10中任一项所述的方法。12.一种计算机可读存储介质，其中存储有多条程序代码，其特征在于，所述程序代码适于由处理器加载并运行以执行权利要求1至10中任一项所述的方法。13.一种车辆，其特征在于，所述车辆包括权利要求11所述的控制装置。3CN115959140A说明书1/8页基于卡尔曼滤波的车辆纵向阻力获取方法、装置及车辆技术领域[0001]