1.一种基于车路作用机理的越野环境中车辆行驶风险预测方法,其特征在于:其方法如下所述:
第一步、数据预处理;
第二步、对车辆运动状态进行估计;
第三步、对环境状态与环境参数进行估计;
第四步、对行驶风险进行预测。
2.根据权利要求1所述的一种基于车路作用机理的越野环境中车辆行驶风险预测方法,其特征在于:所述的第一步中数据预处理的过程如下:步骤一、进行数据采集:采集智能车辆上搭载的车载CAN总线、卫星-惯导组合定位系统、相机、激光雷达和毫米波雷达的传感器信号,按照固定采集周期对所有传感器数据进行采集,所采集的传感器数据形式包括:彩色相机产生的以帧为单位的彩色图像,激光雷达产生的以帧为单位的空间三维点云,毫米波雷达产生的以帧为单位的障碍物状态列表,车载CAN总线上产生的以时间序列表示的车辆操纵与运动状态数据,卫星-惯导组合定位系统产生的以时间序列表示的定位与姿态数据;
步骤二、对数据进行校验和对齐,具体内容包括:传感器数据的时间对齐;传感器数据的空间对齐;传感器数据的有效性校验;生成带有有效性标记、经过时间和空间对齐的车载总线对齐信号,车辆状态测量对齐信号和多模态环境传感器对齐信号,供后续步骤使用。
3.根据权利要求1所述的一种基于车路作用机理的越野环境中车辆行驶风险预测方法,其特征在于:所述的第二步中对车辆运动状态进行估计的过程如下:步骤一、进行卫星-惯导组合定位系统估计:利用车辆状态测量对齐信号,根据车辆动力学,对包括车辆的纵侧向速度、车辆的纵侧向加速度、垂向加速度和车轮载荷的车辆动力学状态进行估计;利用车辆状态测量对齐信号,对包括俯仰角和侧倾角在内的车辆姿态进行估计;利用车辆状态测量对齐信号,对车辆的位置进行估计;
步骤二、进行动力学状态估计:通过读取车载总线对齐信号并进行滤波处理得到包括车辆的操纵状态,包括踏板开度、方向盘转角和车辆是否处于静止状态的车辆的操纵状态;
通过读取车载总线对齐信号结合车辆动力学,估计包括车辆纵向速度、侧向速度、车辆纵向加速度、侧向加速度、垂向加速度和车轮载荷在内的车辆动力学状态;通过读取车载总线对齐信号,通过滤波估计包括制动压力、挡位和ABS触发状态在内的车辆部件状态;读取车载总线对齐信号和车辆状态测量对齐信号,根据车辆动力学计算车轮滑转率这一车辆动力学信号;
步骤三、进行同时建图与定位:通过同时建图与定位方法根据多模态环境传感器对齐信号,估计包括车辆纵向速度、侧向速度、车辆纵向加速度、侧向加速度、垂向加速度和车轮载荷在内的车辆动力学信号;通过同时建图与定位方法根据多模态环境传感器对齐信号,估计包括车辆俯仰角和侧倾角在内的车辆姿态;通过同时建图与定位方法根据多模态环境传感器对齐信号,对车辆的位置进行估计;
步骤四、状态估计融合:评估卫星-惯导组合定位系统估计、动力学状态估计和同时建图与定位各自的可靠程度,将由不同步骤,即不同估计原理得到的相同物理意义的估计结果进行融合;对分别由卫星-惯导组合定位系统估计、动力学状态估计和同时建图与定位得到的车辆动力学状态进行融合;对分别由卫星-惯导组合定位系统估计和同时建图与定位得到的车辆姿态进行融合;对分别由卫星-惯导组合定位系统估计和同时建图与定位得到的车辆位置进行融合;融合方法包括但不限于:卡尔曼滤波法或线性加权法。
4.根据权利要求1所述的一种基于车路作用机理的越野环境中车辆行驶风险预测方法,其特征在于:所述的第三步中对环境状态与环境参数进行估计的过程如下:步骤一、进行运动障碍物检测:将多模态环境传感器对齐信号中的前方障碍物运动信息利用车辆运动状态估计结果进行坐标系转换;提取其中的运动障碍物并进行运动跟踪,输出包括障碍物的位置、障碍物的速度、障碍物的加速度、障碍物的三维尺寸、障碍物的动/静状态的运动障碍物信息列表信号传至第四步;
步骤二、进行地面提取:将多模态环境传感器对齐信号中的彩色图像和三维点云进行地面数据提取,生成多模态环境传感地面信号;
步骤三、进行地面几何特征估计:对地面三维点云数据进行直角坐标栅格化,将车辆前方视野一相同大小的矩形栅格描述,之后以最小二乘法进行平面拟合计算栅格平面法向量,利用法向量估计栅格内的地面纵向和侧向坡角的地面几何特征并用0和1之间的数值表示该计算结果的可信程度即置信度,利用车辆运动状态估计结果将坡角估计值转换到大地坐标系下,生成以栅格为单位的地面几何参数信号并传至第四步;
步骤四、进行地面类别识别:利用地面的彩色图像数据和车辆运动状态估计信号对地面类别进行识别和识别置信度的评价,对地面类别识别结果进行融合,融合手段包括利用基于规则和基于概率推理的方式,对识别结果进行决策融合;融合手段还包括使用基于车辆动力学的识别结果对基于图像的识别结果进行自监督学习,即不断利用动力学识别结果生成新采集的图像数据的标签,并用新采集的图像及标签重新训练基于图像识别的算法,利用重新训练的算法进行地面类别识别,地面类别识别结果最终使用与地面几何参数信号一致的栅格格式表示为地面类别信号并传至第四步;
步骤五、进行地面力学特征估计:利用车辆状态估计信号和地面类别信号进行地面力学参数的识别,识别的地面力学参数包括硬路面的路面附着系数,以及软路面的地面剪切特性参数土壤粘聚力、土壤摩擦角和剪切力-变形曲线模量,接着对连续识别的地面力学参数进行高斯混合模型描述,最终生成地面力学参数信号并传至第四步。
5.根据权利要求1所述的一种基于车路作用机理的越野环境中车辆行驶风险预测方法,其特征在于:所述的第四步中对行驶风险进行预测的过程如下:步骤一、进行运动障碍物风险评估:利用车辆运动状态估计信号来预测本车运动轨迹并根据运动障碍物信息列表信号来预测动态障碍物的运动轨迹,通过计算本车与动态障碍物在预测运动轨迹上的碰撞时间来表征主车与动态障碍物碰撞风险的风险定量信号;
步骤二、进行地面风险评估,步骤二由四个环节完成,具体如下:
环节一、进行静态行驶风险评估,根据地面几何参数信号、地面力学参数信号进行静态行驶风险评估,判断主车行驶路径是否存在无法跨越障碍物并计算车辆静态可行驶概率;
环节二、运算触发计算,判断静态可行驶概率是否达到触发条件,根据静态可行驶概率和触发条件的关系得到计算触发标志;
环节三、进行动态行驶风险评估:若静态可行使概率达到触发标志,则根据地面类别信号采取软、硬路面计算模式对车辆运动状态估计信号、地面几何参数信号和地面力学参数信号进行动态行驶风险评估;定义由于车辆动力不足引起的爬坡失效、因地面力学特性引起的爬坡失效以及车辆倾覆的量化危险判别指标,并根据评价指标量化动态可行驶概率;
环节四、进行概率整合:对静态可行驶概率和动态可行驶概率进行概率整合来得到唯一的、用于表征主车在地面上行驶失效风险的风险概率信号。