[发明专利]一种多传感器融合的倒车雷达盲区测距方法

权利要求书

1.一种多传感器融合的倒车雷达盲区测距方法，其特征在于：包括如下具体步骤：

步骤1，当车辆开始倒车时，车辆的MCU通过CAN总线获取超声波雷达测距数据，根据起始的距离长度，构建车辆倒车距离Y与时间的数据集，记录的Y值小于等于25cm；

步骤2，所述MCU通过CAN总线从车辆ESP系统中获取惯性元件数据及轮速传感器脉冲数据，对两个信号进行处理后获得纵向加速度与车速；

步骤3，对所述步骤2中获取的纵向加速度与车速进行卡尔曼滤波获得车辆行驶距离X，构建车辆行驶距离X与时间的数据集；

步骤4，采集到m组数据后MCU构建车辆倒车距离Y与车辆行驶距离X的函数拟合，通过递归最小二乘法对拟合参数进行更新，当步骤1中记录的倒车距离Y超过25cm后，重置两组数据集，保留拟合函数参数和协方差矩阵，并重复上述步骤更新拟合函数的参数；

步骤5，当通过超声波传感器获得的测距大小下降至25cm时，拟合函数参数更新完毕，将步骤3中的方法生成的车辆行驶距离X代入拟合函数，由此获得补偿后的车辆行驶距离X_p，最终获得在超声波传感器盲区下物流车辆距离终点的距离观测值D＝25-X_p。

2.根据权利要求1所述的多传感器融合的倒车雷达盲区测距方法，其特征在于：所述步骤2中，对惯性元件的输出进行限幅滤波，获得车辆的纵向加速度a_o，滤波阈值为1.4m/s²；根据轮速传感器的标定数据将脉冲值转为一次脉冲过程中车辆的位移距离，并对数据进行滑动平均滤波，计算车辆行驶的速度v_o。

3.根据权利要求1所述的多传感器融合的倒车雷达盲区测距方法，其特征在于：所述步骤3中，卡尔曼滤波状态量为位移x、车速v、纵向加速度a，观测量为车速v_o、纵向加速度a_o，观测噪声大小依照传感器的标定值。

4.根据权利要求3所述的多传感器融合的倒车雷达盲区测距方法，其特征在于：所述步骤3中，使用的卡尔曼滤波公式如下：

状态量观测量Z＝[v_o a_o]^T；

计算先验估计值

其中状态转移矩阵控制矩阵B为0；

计算先验误差协方差

其中Q为模型的过程噪声协方差矩阵；

计算卡尔曼增益K_k：

其中观测矩阵R为观测噪声，依照传感器的标定值；

更新误差协方差P_k：

计算后验估计值

后验估计矩阵中的位移x值即为车辆行驶距离X。

5.根据权利要求1所述的多传感器融合的倒车雷达盲区测距方法，其特征在于：所述步骤4中，每采集m＝16组倒车距离Y与车辆行驶距离X数据后使用递归最小二乘法更新一次拟合函数参数，所述拟合函数为三次函数；记录的倒车距离Y超过25cm后，清空当前Y、X数据数组，将倒车距离Y、行驶距离X重置为0后继续采集数据，保留拟合函数参数和协方差矩阵。