基于车辆行驶状态的路面坡度估算方法及系统技术方案

本发明专利技术公开了一种基于车辆行驶状态的路面坡度估算方法，包括：获取车辆状态信息，所述状态信息包括驱动力矩、制动力矩、方向盘转向角度、纵向加速度、横向加速度和横摆角速度；获取车辆至少两个时刻的纵向加速度和车速，标定构建的车辆纵向动力学模型的参数；获取实时的纵向加速度和车速，得到当前的纵向坡度；通过构建的车辆横向运动状态模型，得到横向坡度，得到实际路面坡度。利用现有传感器获取相关输入信号，同时考虑车辆横向和纵向运动状态，结合车辆运动学和动力学的方法，对路面坡度状态进行实时估算，解决了以往坡度估算严重依赖车辆模型的缺点，提高了路面坡度的估算精度和准确性。

【技术实现步骤摘要】
基于车辆行驶状态的路面坡度估算方法及系统
本专利技术涉及车辆路面坡度处理
，具体地涉及一种基于车辆行驶状态的路面坡度估算方法及系统。
技术介绍
路面坡度影响着行驶车辆的载荷分布，不同的载荷分布会对轮胎抓地力产生很大的影响，同时坡度信息也为自动变速箱的升降挡判断、电子驻车系统的有效实施提供极为重要的状态输入。实时、准确、有效的坡度估算是实现车辆理想的横、纵向动力学控制的关键。目前市面上对路面坡度的估算通常是利用坡度传感器或者叠加加速度传感器来实现的，该种方法在使用过程中很容易受到车辆运动状态的干扰。例如，当车辆在坡度不变的坡道上加减速时，坡度传感器的输出信号会实时变化，偏离真实值；同样车辆匀速行驶，但坡度发生连续变化也会引起加速度传感器输出值的变化。因此，在车身状态或者外部环境不断变化的情况下，通过传感器得到的信号会存在一定的偏差，最终对估算的坡度信息产生影响。更先进的是综合利用车载GPS(全球定位系统)和GIS(地理信息系统)的坡度估算。其中GPS系统可以获得车辆行进时刻的实时位置信息，车载计算机系统计算当前的位置距离采样点的水平距离，利用GIS地图进行匹配，得到采样点的路面标高与当前位置的标高，对其进行比较，最终计算出未来时刻在视距范围内的行驶路径道路坡道。该方法的软硬件费用成本更高，一般只应用于航空航天控制领域或专用特种车辆，同时容易受到天气、隧道、遮蔽物等因素的影响，另外对于路况极为复杂的非铺装越野路面，往往在一小段长度的路面会经历不断交替的上坡和下坡，该种方法对于此类多变的路况显然不具备优势。其次相对车载传感器而言GPS系统的刷新频率较低，也会造成较大的估计误差。现有技术中一般是利用纵向加速度对坡度进行估算，例如公告号为CN102700551A的专利公开了一种车辆行驶过程中路面坡度的实时估计方法，整车控制器控制驱动力传感器、车速传感器和加速度传感器将信号分别发送到坡度估算系统；车辆加速度计算模块计算车辆加速度，并将其发送到坡度估算系统；基于纵向动力学坡度估计模块计算路面坡度估计值，并将其发送到多方法融合坡度估计模块；基于加速度偏差坡度估计模块计算路面坡度估计值，并将其发送到多方法融合坡度估计模块；多方法融合坡度估计模块分别对两个路面坡度估计值进行滤波处理，得到路面坡度的实时估计值；完成路面坡度值估计后，重复上述步骤对各采样时刻的路面坡度进行实时估算。但是实际情况下车辆上下坡过程中会伴随着转向，或者车辆行进方向并不是正好沿着坡面方向，而是斜侧着行进，此时车辆纵向方向上也会产生加速度，如果只考虑纵向加速度会使估算得到的坡度不准确。本专利技术因而来。
技术实现思路
为了解决上述存在的技术问题，本专利技术提供了一种基于车辆行驶状态的路面坡度估算方法及系统，利用现有传感器获取相关输入信号，同时考虑车辆横向和纵向运动状态，结合车辆运动学和动力学的方法，对路面坡度状态进行实时估算，解决了以往坡度估算严重依赖车辆模型的缺点，提高了路面坡度的估算精度和准确性。本专利技术的技术方案是：一种基于车辆行驶状态的路面坡度估算方法，包括以下步骤：S01：获取车辆状态信息，所述状态信息包括驱动力矩、制动力矩、方向盘转向角度、纵向加速度、横向加速度和横摆角速度；S02：获取车辆至少两个时刻的纵向加速度ax_sensor和车速vx，标定构建的车辆纵向动力学模型的参数；S03：获取实时的纵向加速度和车速，得到当前的纵向坡度αx；S04：通过构建的车辆横向运动状态模型，得到横向坡度αy，得到实际路面坡度优选的技术方案中，所述步骤S04中所述构建的车辆横向运动状态模型包括传感器输入的横向加速度信号和车辆转向产生的横向加速度值，通过引入向盘转向角的符号函数对转向方向进行判断。优选的技术方案中，所述步骤S02中构建的车辆纵向动力学模型为：式中，ax_sensor为纵向加速度信号，m为车辆当前质量，g为重力加速度，αx为路面纵向坡度，Fdrv为总驱动力矩，Fbrk为总制动力矩，Fresis为总阻力矩，Fdrv和Fbrk信号均能从CAN网络直接获取。优选的技术方案中，所述总阻力矩Fresis包括风阻和滚阻，表示为：式中，ρ为空气密度，Cd为风阻系数，A为迎风面积，vx为车辆纵向速度；f路面滚阻系数。优选的技术方案中，所述步骤S04构建的车辆横向运动状态模型为：ay_act＝gsinαyay_act＝ay_sensor+sgn(δ)|ay_yaw|式中，为横摆角速度信号；δ为方向盘转向角度信号；ay_yaw为由转向产生的横向加速度；ay_sensor为传感器输入的横向加速度信号；ay_act为经过修正的实际横向加速度；αy为车辆横向坡度。优选的技术方案中，采集一段时间T内的mk进行概率统计，得到概率密度函数：其中，μ是mk服从随机变量的均值，σ为此随机变量的方差；找出置信度最高的mtr＝μ作为整车质量参数。本专利技术还公开了一种基于车辆行驶状态的路面坡度估算系统，包括：车辆状态信息获取模块，获取车辆状态信息，所述状态信息包括驱动力矩、制动力矩、方向盘转向角度、纵向加速度、横向加速度和横摆角速度；参数标定模块，获取车辆至少两个时刻的纵向加速度ax_sensor和车速vx，标定构建的车辆纵向动力学模型的参数；纵向坡度计算模块，获取实时的纵向加速度和车速，得到当前的纵向坡度αx；路面坡度估算模块，通过构建的车辆横向运动状态模型，得到横向坡度αy，得到实际路面坡度优选的技术方案中，所述参数标定模块中还包括车辆纵向动力学模型构建模块，用于构建车辆纵向动力学模型，为：式中，ax_sensor为纵向加速度信号，m为车辆当前质量，g为重力加速度，αx为路面纵向坡度，Fdrv为总驱动力矩，Fbrk为总制动力矩，Fresis为总阻力矩，Fdrv和Fbrk信号均能从CAN网络直接获取。优选的技术方案中，所述路面坡度估算模块包括车辆横向运动状态模型构建模块，用于构建的车辆横向运动状态模型，为：ay_act＝gsinαyay_act＝ay_sensor+sgn(δ)|ay_yaw|式中，为横摆角速度信号；δ为方向盘转向角度信号；ay_yaw为由转向产生的横向加速度；ay_sensor为传感器输入的横向加速度信号；ay_act为经过修正的实际横向加速度；αy为车辆横向坡度。优选的技术方案中，还包括质量参数获取模块，用于采集一段时间T内的mk进行概率统计，得到概率密度函数：其中，μ是mk服从随机变量的均值，σ为此随机变量的方差；找出置信度最高的mtr＝μ作为整车质量参数。与现有技术相比，本专利技术的优点是：1.利用现有传感器获取相关输入信号，不增加额外硬件成本。均为常用CAN协议信号，无需新增通讯报文，不增加总线网络负载率。结合车辆运动学和动力学的方法，对路面坡度本文档来自技高网...

【技术保护点】
1.一种基于车辆行驶状态的路面坡度估算方法，其特征在于，包括以下步骤：/nS01：获取车辆状态信息，所述状态信息包括驱动力矩、制动力矩、方向盘转向角度、纵向加速度、横向加速度和横摆角速度；/nS02：获取车辆至少两个时刻的纵向加速度a

【技术特征摘要】
1.一种基于车辆行驶状态的路面坡度估算方法，其特征在于，包括以下步骤：
S01：获取车辆状态信息，所述状态信息包括驱动力矩、制动力矩、方向盘转向角度、纵向加速度、横向加速度和横摆角速度；
S02：获取车辆至少两个时刻的纵向加速度ax_sensor和车速vx，标定构建的车辆纵向动力学模型的参数；
S03：获取实时的纵向加速度和车速，得到当前的纵向坡度αx；
S04：通过构建的车辆横向运动状态模型，得到横向坡度αy，得到实际路面坡度


2.根据权利要求1所述的基于车辆行驶状态的路面坡度估算方法，其特征在于，所述步骤S04中所述构建的车辆横向运动状态模型包括传感器输入的横向加速度信号和车辆转向产生的横向加速度值，通过引入向盘转向角的符号函数对转向方向进行判断。


3.根据权利要求1所述的基于车辆行驶状态的路面坡度估算方法，其特征在于，所述步骤S02中构建的车辆纵向动力学模型为：



式中，ax_sensor为纵向加速度信号，m为车辆当前质量，g为重力加速度，αx为路面纵向坡度，Fdrv为总驱动力矩，Fbrk为总制动力矩，Fresis为总阻力矩，Fdrv和Fbrk信号均能从CAN网络直接获取。


4.根据权利要求3所述的基于车辆行驶状态的路面坡度估算方法，其特征在于，所述总阻力矩Fresis包括风阻和滚阻，表示为：



式中，ρ为空气密度，Cd为风阻系数，A为迎风面积，vx为车辆纵向速度；f路面滚阻系数。


5.根据权利要求1所述的基于车辆行驶状态的路面坡度估算方法，其特征在于，所述步骤S04构建的车辆横向运动状态模型为：



ay_act＝gsinαy
ay_act＝ay_sensor+sgn(δ)|ay_yaw|
式中，为横摆角速度信号；δ为方向盘转向角度信号；ay_yaw为由转向产生的横向加速度；ay_sensor为传感器输入的横向加速度信号；ay_act为经过修正的实际横向加速度；αy为车辆横向坡度。


6.根据权利要求3所述的基于车辆行驶状态的路面坡度估算方法，其特征在于，采集一段时间T内的mk进...

【专利技术属性】
技术研发人员：马孜立，朱江，赵峰，
申请(专利权)人：清华大学苏州汽车研究院吴江，清华大学，
类型：发明
国别省市：江苏;32