CN105022987A - 用于车道感测传感器的偏差纠正和诊断功能的方法 - Google Patents

Abstract

本发明涉及用于车道感测传感器的偏差纠正和诊断功能的方法。一种诊断基于视觉的车道传感系统的健康状态的方法。计算作为车辆侧向偏移和车辆航向的函数的第一偏差因子。计算作为车辆速度、预计行驶路径的估计曲率、车道曲率和车辆航向的函数的第二偏差因子。生成用于第一和第二偏差因子的直方图。确定健康状态的概率。判断健康状态的概率是否在预定的阈值内。估计视觉系统的角偏差。响应于健康状态的概率在预定阈值内的判断，纠正视觉系统的角偏差；否则启动故障的车道传感系统的报警。

Description

用于车道感测传感器的偏差纠正和诊断功能的方法

技术领域

本发明的实施例涉及用于车道传感系统的视觉传感器的车道传感校准。

车道偏离警告系统和车道居中系统是被设计用于当车辆开始无意地移出其车道时警告驾驶员或者用于将车辆保持在其车道中的车辆系统的两个实例。视觉系统是通常用于感测行驶道路的车道的装置中的一种装置。视觉传感器要求正确的对准，否则会使来自车道传感系统的结果发生偏移。例如，前向的图像捕获装置在前进方向上采集车辆外部的场景。通常，如果被安装在车辆的中心线上，那么前向的采集装置将会与车辆中心线对准。视觉图像装置中的任何角偏差将会导致车辆在车道中的不准确定位，这最终将会阻碍车辆正确地检测车道的偏离从而阻碍将车辆保持在车道中心的尝试。

存在其中通过将车辆带入维修站而手动地纠正车辆视觉捕获装置的系统，在所述维修站中维修人员判断是否存在角偏差并且维修人员手动地纠正该偏差。将会有利的是具有一种自主地检测偏差并且可以自主地纠正偏差的自动化系统。

发明内容

本发明实施例的优点是对车道传感系统中的图像捕获装置的偏差的自主检测、以及对角偏差（angle misalignment）的自主纠正。所述系统利用有关于车辆和道路的参数，诸如车辆横摆角速度、车辆侧向偏移、车辆航向、车辆速度、车道曲率和预计行驶路径的估计曲率,用于检测角偏差。基于所确定的概率而确定角偏差，如果偏差在各自的公差内，那么自主地纠正该角偏差。如果偏差在各自的公差之外，那么启动报警以使车道传感系统进行维修。

本发明的实施例构想一种对车辆的基于视觉的车道传感系统的健康状态进行诊断的方法。计算作为车辆侧向偏移和车辆航向的函数的第一偏差因子。计算作为车辆速度、预计车辆行驶路径的估计曲率、行驶道路的车道曲率和车辆航向的函数的第二偏差因子。生成用于第一偏差因子的直方图和用于第二偏差因子的直方图。基于第一偏差因子的直方图和第二偏差因子的直方图，确定健康状态的概率。判断健康状态的概率是否在预定的阈值内。估计视觉系统的角偏差。响应于健康状态的概率是在预定阈值内的判断而纠正视觉系统的角偏差，否则启动有故障的车道传感系统的报警。

本发明提供以下技术方案：

1. 一种对车辆的基于视觉的车道传感系统的健康状态进行诊断的方法，所述方法包括以下步骤：

计算作为车辆侧向偏移和车辆航向的函数的第一偏差因子；

计算作为车辆速度、车辆的预计行驶路径的估计曲率、行驶道路的车道曲率和车辆航向的函数的第二偏差因子；

生成用于所述第一偏差因子的直方图和用于所述第二偏差因子的直方图；

基于所述第一偏差因子的直方图和所述第二偏差因子的直方图，确定健康状态的概率；

确定所述健康状态的概率是否在预定阈值内；

估计所述视觉系统的角偏差；和

响应于所述健康状态的概率在所述预定阈值内的确定，纠正所述视觉系统的角偏差；否则启动有故障的车道传感系统的报警。

2. 如方案1所述的方法，其中确定健康状态的概率包括以下步骤：

确定所述第一偏差因子的概率；

判断所述第一偏差因子的概率是否小于第一分布阈值；

确定所述第二偏差因子的概率；

判断所述第二偏差因子的概率是否小于第二分布阈值；

确定作为所述第一偏差因子的概率小于所述第一分布阈值和所述第二偏差因子的概率小于所述第二分布阈值的函数的所述健康状态的概率。

3. 如方案1所述的方法，其中用以下公式来确定所述第一偏差因子：

其中是车辆侧向偏移的导数，是车辆速度，是关于行驶车道的车辆航向。

4. 如方案3所述的方法，其中所述第一偏差因子基本上等于零表明没有视觉系统的角偏差。

5. 如方案3所述的方法，其中用以下公式来确定所述第二偏差因子：

其中是关于行驶车道的车辆航向的导数，是车辆的预计行驶路径的估计曲率，是行驶道路的车道曲率，是车辆速度。

6. 如方案5所述的方法，其中所述第一偏差因子和所述第二偏差因子存储在缓冲器中。

7. 如方案5所述的方法，其中所述第二偏差因子基本上等于零表明没有视觉系统的角偏差。

8. 如方案5所述的方法，还包括以下步骤：递归地估计用于所述第一偏差因子和所述第二偏差因子的各自直方图。

9. 如方案1所述的方法，其中判断所述健康状态的概率是否在预定阈值内包括判断所述健康状态的概率是否在0.8内。

10. 如方案1所述的方法，还包括以下步骤：

响应于对所述视觉系统的角偏差的纠正，获得新的传感器数据。

11. 如方案1所述的方法，其中仅响应于意外车道变化运动的确定，确定所述第一偏差因子和所述第二偏差因子。

12. 如方案11所述的方法，其中至少基于所述车辆速度大于预定速度，确定所述意外车道变化运动。

13. 如方案11所述的方法，其中至少基于转向信号不被启动，确定所述意外车道变化运动。

14. 如方案9所述的方法，其中至少基于检测到在预定量的时间内没有车道穿越，确定所述意外车道变化运动。

附图说明

图1是视角偏差系统的方框图。

图2是示出侧向偏移和车辆航向的图示说明。

图3是检测作为侧向偏移和车辆航向的函数的角偏差的数学函数的方框图。

图4是示出估计的路径曲率、车道曲率和车辆航向的图示说明。

图5是用于检测作为车道曲率、横摆角速度和车辆速度的函数的角偏差的数学函数的方框图。

图6是利用所确定的偏差数据而生成的示例性直方图。

图7是用于确定车道传感系统中的角偏差的流程图。

具体实施方式

图1中示出了用于检测基于视觉的车道传感系统的健康状态的视角偏差系统10。车辆系统10对车辆所使用的视觉系统（例如但不限于车道偏离警告系统或者车道居中系统）进行分析，以便判断关于视觉系统是否出现了任何偏差。车辆系统10包括用于捕获车辆外部图像的基于视觉的捕获装置12。处理器14接收由基于视觉的捕获装置12所获得的数据，并且对数据进行分析以便确定车道传感系统中的任何重大的违背。基于视觉的捕获装置12可用于检测车辆航向、车辆侧向偏移y、预计车辆行驶路径的估计曲率、行驶道路的车道曲率。

横摆角速度传感器16或者类似装置可用于确定车辆的横摆角速度。包括、但不限于车轮速度传感器、PCM、节气门传感器、加速踏板传感器的车辆速度传感器18可用于确定车辆的速度。缓冲器20，优选为环形缓冲器，可用于存储包含可用于确定基于视觉的捕获装置12中的偏差的历史数据在内的数据。

处理器14对来自各种装置的数据进行分析以判断是否存在相当大的误差，该相当大的误差表明基于视觉的车道传感系统中的异常。如果确定角偏差没有从标准值的相当大的变化，那么可以通过校准模块22自动地校准参数以便纠正较小的偏差。校准模块22可以是独立的单元或者可以合并成为处理器或基于视觉的捕获装置的一部分。如果确定存在从标准值的相当大的变化，那么启动报警装置24从而告知驾驶员有故障并且需将车辆带到车辆维修站。

图2是车辆侧向偏移与车辆航向之间的相互关系的图示说明，用于检测基于视觉的成像装置的角偏差。图中显示车辆30正在以一车辆速度沿行驶道路32行驶。用车辆航向标示车辆10正在驾驶的方向。图中示出了车辆侧向偏移y，该车辆侧向偏移y是从车辆到行驶道路的车道边缘的距离。

图3中示出了说明被应用于各种输入数据的数学函数的方框图，用于检测车道传感系统中的角度测量。将侧向偏移、车辆速度、和车辆航向各自作为输入参数而应用于模型。在方框40中获得车辆侧向偏移y的导数。将车辆侧向偏移y的导数和主车辆速度数据作为输入应用于除法数学函数42，其中将车辆侧向偏移y除以主车辆速度数据。用于除法函数的数学模型被表示为。

然后将该结果输入到通常在44处所表示的减法数学函数。基于减法数学函数的数学模型被表示为 。

在方框46中，可以确定航向测量偏差，并且该航向测量偏差被表示为相对于车道的车辆航向中的变化。

在方框48中，也将航向测量偏差应用于分布估计器，其中对异常的检测统计进行分析以便确定车道传感系统中的重大的违背。这可用概率来表示，其中是从均值的分布极限并且表示角偏差是否在极限内的概率。

图4是车辆航向、车辆横摆角速度和车道曲率之间的相互关系的图示说明，用于检测车道传感系统中的角偏差。图中显示车辆30正沿着具有车道曲率的行驶道路32行驶。车辆正在以车辆速度和车辆航向行驶。图中示出了车辆侧向偏移y，并且该车辆侧向偏移y是从车辆到行驶道路的车道边缘的距离。

图5示出了应用于各种输入数据的数学函数的方框图。将车辆航向、车辆速度、横摆角速度和车道曲率各自作为输入参数应用于模型。

将车辆横摆角速度和车辆速度数据作为输入应用于除法数学函数50，其中将横摆角速度除以主车辆速度数据，用于生成由所代表的预计车辆行驶路径的估计曲率。用于预计行驶路径的估计曲率的数学模型被表示为。

将来自方框50的结果连同车道曲率应用于通常在52处所示的减法数学函数。用于差值数学函数52的数学模型被表示为（）。

在数学函数54中确定曲率差值（）与车辆速度的乘积。然后，将该乘积的结果连同车辆航向的导数应用于减法数学函数56。用以下公式表示所得到的数学函数：

其中是相对于行驶车道的车辆航向的导数，是车辆的预计行驶路径的估计曲率，是行驶道路的车道曲率，是车辆速度。

在方框58中，确定航向测量偏差。将分布估计器用于判断是否存在异常检测统计。这可用概率来表示，其中是从平均值的确定的分布极限并且表示角偏差是否在极限内的概率。

图6表示为各组数据而生成的直方图，用于判断角偏差数据是否在可纠正的极限内。在图6中，水平轴线表示各自的角度测量，而垂直轴线表示各个角度的计数数量。将极限（阈值）标示为和，其中代表分布极限并且代表从直方图数据的均值偏移的角度偏差。基于直方图，可以确定概率和。

图7示出了用于确定车道传感系统中的角偏差的流程图。

在方框60中，开始例行程序。在方框61中，判断是否获得新的传感器数据。如果获得新的传感器数据，那么例行程序进入方框62; 否则，例行程序等待新的数据。

在方框62中，判断是否检测到车道穿越事件。可通过监测车辆速度以判断车辆速度是否大于预定速度、转向信号是否没被启动、以及在预定量的时间内是否没有车道穿越事件发生，由视觉车道传感系统，判断车道穿越事件。

如果判断出现了预期的车道变化，那么例行程序返回到步骤61以等待新的传感器数据。如果出现意外的车道变化，那么例行程序进入步骤63。

在步骤63，确定视觉未对准中的偏差。如果将视觉传感器正确地对准，那么并且。如果比较不是相等的，那么由来确定第一偏差因子并且由来确定第二偏差因子。

在方框64中，对于和递归地估算直方图。

在方框65中，判断各组数据的概率是否在偏差阈值内。这些概率由和来表示。

在方框66中，确定视觉车道传感系统的健康状态的概率。可用以下公式来确定健康状态的概率：

在方框67中，判断健康状态（SOH）是否小于预定的SOH阈值（例如，0.8）。如果确定SOH的概率小于预定的阈值，那么例行程序前进到方框68，其中启动故障从而向车辆驾驶员指出有故障的车道传感系统；否则例行程序前进到方框69。SOH意味着概率越大则仅需要较小的对准即可将传感器正确地对准的可能性越高。因此，当SOH小于阈值时，将报告传感系统故障。

在方框69中，确定偏差估计。该偏差估计被车辆用于纠正角偏差。然后例行程序进入方框61并等待下一组的数据。

虽然已详细描述了本发明的某些实施例，但本发明相关领域的技术人员将认识到由所附权利要求所限定的用于实施本发明的各种替代的设计和实施例。

Claims (10)

1. 一种对车辆的基于视觉的车道传感系统的健康状态进行诊断的方法，所述方法包括以下步骤：

计算作为车辆侧向偏移和车辆航向的函数的第一偏差因子；

计算作为车辆速度、车辆的预计行驶路径的估计曲率、行驶道路的车道曲率和车辆航向的函数的第二偏差因子；

生成用于所述第一偏差因子的直方图和用于所述第二偏差因子的直方图；

基于所述第一偏差因子的直方图和所述第二偏差因子的直方图，确定健康状态的概率；

确定所述健康状态的概率是否在预定阈值内；

估计所述视觉系统的角偏差；和

响应于所述健康状态的概率在所述预定阈值内的确定，纠正所述视觉系统的角偏差；否则启动有故障的车道传感系统的报警。

2. 如权利要求1所述的方法，其中确定健康状态的概率包括以下步骤：

确定所述第一偏差因子的概率；

判断所述第一偏差因子的概率是否小于第一分布阈值；

确定所述第二偏差因子的概率；

判断所述第二偏差因子的概率是否小于第二分布阈值；

确定作为所述第一偏差因子的概率小于所述第一分布阈值和所述第二偏差因子的概率小于所述第二分布阈值的函数的所述健康状态的概率。

3. 如权利要求1所述的方法，其中用以下公式来确定所述第一偏差因子：

其中是车辆侧向偏移的导数，是车辆速度，是关于行驶车道的车辆航向。

4. 如权利要求3所述的方法，其中所述第一偏差因子基本上等于零表明没有视觉系统的角偏差。

5. 如权利要求3所述的方法，其中用以下公式来确定所述第二偏差因子：

其中是关于行驶车道的车辆航向的导数，是车辆的预计行驶路径的估计曲率，是行驶道路的车道曲率，是车辆速度。

6. 如权利要求5所述的方法，其中所述第二偏差因子基本上等于零表明没有视觉系统的角偏差。

7. 如权利要求5所述的方法，还包括以下步骤：递归地估计用于所述第一偏差因子和所述第二偏差因子的各自直方图。

8. 如权利要求1所述的方法，其中判断所述健康状态的概率是否在预定阈值内包括判断所述健康状态的概率是否在0.8内。

9. 如权利要求1所述的方法，还包括以下步骤：

响应于对所述视觉系统的角偏差的纠正，获得新的传感器数据。

10. 如权利要求1所述的方法，其中仅响应于意外车道变化运动的确定，确定所述第一偏差因子和所述第二偏差因子。