车轮检测和其在物体跟踪以及传感器配准中的应用

摘要

公开了车轮检测和其在物体跟踪以及传感器配准中的应用，包括用于跟踪正在相对于主车辆横向的位置上驾驶的远程车辆的方法和系统。为物体检测融合系统提供来自两个雷达传感器的目标数据。远程车辆上的车轮被识别为基本上同一位置、但多普勒距变率值变化显著的雷达点群集。如果可识别远程车辆的近侧上的两个车轮，则使用通过两个雷达传感器测量的车轮位置进行融合计算，从而产生远程车辆位置、取向以及速度的准确估值。在横向碰撞预防（LCP）系统中使用远程车辆位置、取向以及速度来触发警示或闪避操作。还可通过基于同一车轮测量数据的另一融合计算来校准雷达传感器对准。

权利要求

1.一种用于跟踪正在接近主车辆的关注区域中移动的远程车辆的方法，所述方法包括：

提供来自主车辆车载的两个雷达传感器的数据，其中雷达传感器具有重叠的覆盖区，以使得当远程车辆处于关注区域中时，远程车辆的至少一部分由雷达传感器两者感测到，并且其中来自雷达传感器的数据包括识别远程车辆上的点的位置和多普勒距变率的雷达点；

由所述雷达点识别远程车辆上的两个或更多个车轮；

由两个雷达传感器提供两个或更多个车轮的车轮位置测量值，其中所述车轮位置测量值识别车轮中每一个的中心相对于雷达传感器中每一个的距离和方位角；

使用包括所述车轮位置测量值的融合计算，使用微处理器计算远程车辆相对于主车辆的位置、取向以及速度；以及使用包括所述车轮位置测量值的融合计算，校准雷达传感器中的一个的对准角度。

2.如权利要求1所述的方法，其中识别远程车辆上的两个或更多个车轮包括：基于位置接近性将所述雷达点群集成组，并且将包括广泛变化的多普勒距变率测量值的所述组中的任一者识别为车轮。

3. 如权利要求2所述的方法，其中基于位置接近性将所述雷达点群集成组包括：使用两个点的距离值差异和方位角值差异计算归一化函数，并且如果所述归一化函数具有不超过一的值，则在组中仅包括所述两个点 。

4.如权利要求2所述的方法，其中将包括广泛变化的多普勒距变率测量值的所述组中的任一者识别为车轮包括：相对于主车辆计算远程车辆上的车轮顶部点和车轮底部点的预期相对径向速度，并且将包括基本上匹配车轮顶部点和车轮底部点的预期相对径向速度的多普勒距变率测量值的所述组中的任一者识别为车轮。

5.如权利要求1所述的方法，其中计算远程车辆相对于主车辆的位置、取向以及速度包括：基于远程车辆最靠近主车辆的侧面上的两个车轮的车轮位置测量值计算远程车辆的取向。

6.如权利要求1所述的方法，其中计算远程车辆相对于主车辆的位置、取向以及速度包括：使用递归式预测远程车辆的与车轮测量位置相对应的状态的算法，其中远程车辆的状态包括二维位置和二维速度。

7.如权利要求6所述的方法，其中所述算法为卡尔曼滤波器算法。

8.如权利要求1所述的方法，其进一步包括：在横向碰撞预防系统中使用远程车辆的位置、取向以及速度，其中关注区域位于主车辆的一侧；并且如果远程车辆进入警示区，则所述横向碰撞预防系统发出警示，并且如果远程车辆进入即将碰撞包络，则应用主车辆制动和/或转向。

9.如权利要求1所述的方法，其进一步包括：提供来自主车辆车载的摄像机的图像，其中所述图像覆盖与雷达传感器的覆盖区重叠的视野，以使得远程车辆由摄像机和雷达传感器中的至少一个感测到，并且使用所述图像和所述雷达点执行融合计算，以确定远程车辆的位置、取向以及速度。

10.一种用于跟踪正在接近主车辆的关注区域中移动的远程车辆的方法，所述方法包括：

提供来自所述主车辆车载的两个雷达传感器的数据，其中雷达传感器具有重叠的覆盖区，以使得当远程车辆处于关注区域中时，远程车辆的至少一部分由雷达传感器两者感测到，并且其中来自雷达传感器的数据包括识别远程车辆上的点的位置和多普勒距变率的雷达点；

从所述雷达点识别远程车辆上的两个或更多个车轮，包括：基于位置接近性将所述雷达点群集成组，并且将包括广泛变化的多普勒距变率测量值的所述组中的任一者识别为车轮；

由两个雷达传感器提供两个或更多个车轮的车轮位置测量值，其中所述车轮位置测量值识别车轮中每一个的中心相对于雷达传感器中每一个的距离和方位角；

使用包括所述车轮位置测量值的融合计算，使用微处理器计算远程车辆相对于主车辆的位置、取向以及速度；

使用包括所述车轮位置测量值的融合计算，校准雷达传感器中的一个的对准角度；以及

在横向碰撞预防系统中使用远程车辆的位置、取向以及速度，其中关注区域位于主车辆的一侧；并且如果远程车辆进入警示区，则所述横向碰撞预防系统发出警示，并且如果远程车辆进入即将碰撞包络，则应用主车辆制动和/或转向。

11.如权利要求10所述的方法，其中基于位置接近性将所述雷达点群集成组包括：使用两个点的距离值差异和方位角值差异计算归一化函数，并且如果所述归一化函数具有不超过一的值，则在组中仅包括所述两个点。

12.如权利要求10所述的方法，其中将包括广泛变化的多普勒距变率测量值的所述组中的任一者识别为车轮包括：相对于主车辆计算远程车辆上的车轮顶部点和车轮底部点的预期相对径向速度，并且将包括基本上匹配车轮顶部点和车轮底部点的预期相对径向速度的多普勒距变率测量值的所述组中的任一者识别为车轮。

13.如权利要求10所述的方法，其中计算远程车辆相对于主车辆的位置、取向以及速度包括：基于远程车辆最靠近主车辆的侧面上的两个车轮的车轮位置测量值计算远程车辆的取向；并且进一步包括：使用递归式预测远程车辆的与车轮测量位置相对应的状态的算法，其中远程车辆的状态包括二维位置和二维速度。

14. 一种用于主车辆的物体检测系统，所述系统包括：

主车辆车载的两个雷达传感器，其中所述雷达传感器具有重叠的覆盖区，以使得当远程车辆处于关注区域中时，远程车辆的至少一部分由雷达传感器两者感测到，并且其中来自雷达传感器的数据包括识别远程车辆上的点的位置和多普勒距变率的雷达点；以及物体检测处理器，包括微处理器和存储模块，所述处理器被编程以：从所述雷达点识别远程车辆上的两个或更多个车轮，包括：基于位置接近性将雷达点群集成组，并且将包括广泛变化的多普勒距变率测量值的所述组中的任一者识别为车轮；

由两个雷达传感器提供两个或更多个车轮的车轮位置测量值，其中所述车轮位置测量值识别车轮中每一个的中心相对于雷达传感器中每一个的距离和方位角；

使用包括所述车轮位置测量值的融合计算，计算远程车辆相对于主车辆的位置、取向以及速度；以及使用包括所述车轮位置测量值的融合计算，校准雷达传感器中的一个的对准的角度。

15.如权利要求14所述的物体检测系统，其中基于位置接近性将所述雷达点群集成组包括：使用两个点的距离值差异和方位角值差异计算归一化函数，并且如果所述归一化函数具有不超过一的值，则在组中仅包括所述两个点。

16.如权利要求14所述的物体检测系统，其中将包括广泛变化的多普勒距变率测量值的所述组中的任一者识别为车轮包括：相对于主车辆计算远程车辆上的车轮顶部点和车轮底部点的预期相对径向速度，并且将包括基本上匹配车轮顶部点和车轮底部点的预期相对径向速度的多普勒距变率测量值的所述组中的任一者识别为车轮。

17.如权利要求14所述的物体检测系统，其中所述处理器基于远程车辆最靠近主车辆的侧面上的两个车轮的车轮位置测量值计算远程车辆的取向。

18.如权利要求14所述的物体检测系统，其中所述处理器使用递归式预测远程车辆的与车轮测量位置相对应的状态的算法，计算远程车辆相对于主车辆的位置、取向以及速度，其中远程车辆的状态包括二维位置和二维速度。

19.如权利要求14所述的物体检测系统，其中关注区域位于主车辆的一侧，物体检测系统将远程车辆的位置、取向以及速度数据提供给横向碰撞预防系统，并且如果远程车辆进入警示区，则所述横向碰撞预防系统发出警示，并且如果远程车辆进入即将碰撞包络，则应用主车辆制动和/或转向。

20.如权利要求14所述的物体检测系统，其进一步包括：主车辆车载的摄像机，其中摄像机提供覆盖与雷达传感器的覆盖区重叠的视野的图像，以使得远程车辆由摄像机和雷达传感器中的至少一个感测到，并且物体检测处理器使用所述图像和所述雷达点执行融合计算，以确定远程车辆的位置、取向以及速度。

说明书

车轮检测和其在物体跟踪以及传感器配准中的应用

技术领域

[0001] 本发明总体上涉及一种横向车辆物体检测系统，并且更具体来说涉及一种物体检测系统，其在雷达点数据中识别车轮的独特运动特征以定位远程车辆的车轮，并且使用远程车辆车轮位置来准确确定远程车辆的位置、取向以及速度，并且同时校准雷达传感器对准。

背景技术

[0002] 物体检测系统还称为物体感测系统，其在现代车辆中变得日臻普遍。物体检测系统可向驾驶员提供关于车辆路径上的物体的警示。物体检测系统还可为主动式车辆系统提供输入，所述主动式车辆系统诸如自适应巡航控制，其控制车辆速度以与前方车辆保持适当纵向间距；以及后方横越交通规避系统，其可提供警示与自动制动，以避免主车辆倒车时与主车辆后面的物体相撞。

[0003] 物体检测系统使用一个或多个传感器来检测主车辆路径上或附近物体的存在，所述传感器可为雷达、激光雷达、摄像机或其它技术。使用软件来跟踪物体随时间的相对运动，确定物体是移动的还是静止的，确定各物体可能是什么（另一车辆、行人、树木等等），并且确定各物体是否对主车辆造成碰撞威胁。

[0004] 然而，即使使用多物体感测输入，诸如雷达和摄像机，也不会总可能准确地评估远程车辆或物体的航向，尤其是如果远程车辆或物体正相对于主车辆在主要横向或切向方向上移动的话。此外，在一些情形下，难以将雷达点数据与摄像机图像数据准确地进行关联。需要使用来自摄像机和两个雷达传感器的物体数据来提供远程车辆和物体的准确二维速度的融合技术。

发明内容

[0005] 根据本发明的教导，公开了一种用于跟踪正在相对于主车辆横向的位置上驾驶的远程车辆的方法和系统。为物体检测融合系统提供来自两个雷达传感器的目标数据。远程车辆上的车轮被识别为基本上同一位置、但多普勒距变率值变化显著的雷达点群集。如果可识别远程车辆的近侧上的两个车轮，则使用通过两个雷达传感器测量的车轮位置执行融合计算，以产生远程车辆位置、取向以及速度的准确估值。在横向碰撞预防（LCP）系统中使用远程车辆位置、取向以及速度来触发警示或闪避操作。还可通过基于同一车轮测量数据的另一融合计算来校准雷达传感器对准。

[0006] 本发明可以包括以下方案：

[0007] 1. 一种用于跟踪正在接近主车辆的关注区域中移动的远程车辆的方法，所述方法包括：

[0008] 提供来自主车辆车载的两个雷达传感器的数据，其中雷达传感器具有重叠的覆盖区，以使得当远程车辆处于关注区域中时，远程车辆的至少一部分由雷达传感器两者感测到，并且其中来自雷达传感器的数据包括识别远程车辆上的点的位置和多普勒距变率的雷达点；

[0009] 由所述雷达点识别远程车辆上的两个或更多个车轮；

[0010] 由两个雷达传感器提供两个或更多个车轮的车轮位置测量值，其中所述车轮位置测量值识别车轮中每一个的中心相对于雷达传感器中每一个的距离和方位角；

[0011] 使用包括所述车轮位置测量值的融合计算，使用微处理器计算远程车辆相对于主车辆的位置、取向以及速度；以及

[0012] 使用包括所述车轮位置测量值的融合计算，计算雷达传感器中的一个的对准校准角度。

[0013] 2. 如方案1所述的方法，其中识别远程车辆上的两个或更多个车轮包括：基于位置接近性将所述雷达点群集成组，并且将包括广泛变化的多普勒距变率测量值的所述组中的任一者识别为车轮。

[0014] 3. 如方案2所述的方法，其中基于位置接近性将所述雷达点群集成组包括：使用两个点的距离值差异和方位角值差异计算归一化函数，并且如果所述归一化函数具有不超过一的值，则在组中仅包括所述两个点 。

[0015] 4. 如方案2所述的方法，其中将包括广泛变化的多普勒距变率测量值的所述组中的任一者识别为车轮包括：相对于主车辆计算远程车辆上的车轮顶部点和车轮底部点的预期相对径向速度，并且将包括基本上匹配车轮顶部点和车轮底部点的预期相对径向速度的多普勒距变率测量值的所述组中的任一者识别为车轮。

[0016] 5. 如方案1所述的方法，其中计算远程车辆相对于主车辆的位置、取向以及速度包括：基于远程车辆最靠近主车辆的侧面上的两个车轮的车轮位置测量值计算远程车辆的取向。

[0017] 6. 如方案1所述的方法，其中计算远程车辆相对于主车辆的位置、取向以及速度包括：使用递归式预测远程车辆的与车轮测量位置相对应的状态的算法，其中远程车辆的状态包括二维位置和二维速度。

[0018] 7. 如方案6所述的方法，其中所述算法为卡尔曼滤波器算法。

[0019] 8. 如方案1所述的方法，其进一步包括：在横向碰撞预防（LCP）系统中使用远程车辆的位置、取向以及速度，其中关注区域位于主车辆的一侧；并且如果远程车辆进入警示区，则所述LCP系统发出警示，并且如果远程车辆进入即将碰撞包络，则应用主车辆制动和/或转向。

[0020] 9. 如方案1所述的方法，其进一步包括：提供来自主车辆车载的摄像机的图像，其中所述图像覆盖与雷达传感器的覆盖区重叠的视野，以使得远程车辆由摄像机和雷达传感器中的至少一个感测到，并且使用所述图像和所述雷达点执行融合计算，以确定远程车辆的位置、取向以及速度。

[0021] 10. 一种用于跟踪正在接近主车辆的关注区域中移动的远程车辆的方法，所述方法包括：

[0022] 提供来自所述主车辆车载的两个雷达传感器的数据，其中雷达传感器具有重叠的覆盖区，以使得当远程车辆处于关注区域中时，远程车辆的至少一部分由雷达传感器两者感测到，并且其中来自雷达传感器的数据包括识别远程车辆上的点的位置和多普勒距变率的雷达点；

[0023] 从所述雷达点识别远程车辆上的两个或更多个车轮，包括：基于位置接近性将所述雷达点群集成组，并且将包括广泛变化的多普勒距变率测量值的所述组中的任一者识别为车轮；

[0024] 由两个雷达传感器提供两个或更多个车轮的车轮位置测量值，其中所述车轮位置测量值识别车轮中每一个的中心相对于雷达传感器中每一个的距离和方位角；

[0025] 使用包括所述车轮位置测量值的融合计算，使用微处理器计算远程车辆相对于主车辆的位置、取向以及速度；

[0026] 使用包括所述车轮位置测量值的融合计算，计算雷达传感器中的一个的对准校准角度；以及

[0027] 在横向碰撞预防（LCP）系统中使用远程车辆的位置、取向以及速度，其中关注区域位于主车辆的一侧；并且如果远程车辆进入警示区，则所述LCP系统发出警示，并且如果远程车辆进入即将碰撞包络，则应用主车辆制动和/或转向。

[0028] 11. 如方案10所述的方法，其中基于位置接近性将所述雷达点群集成组包括：使用两个点的距离值差异和方位角值差异计算归一化函数，并且如果所述归一化函数具有不超过一的值，则在组中仅包括所述两个点。

[0029] 12. 如方案10所述的方法，其中将包括广泛变化的多普勒距变率测量值的所述组中的任一者识别为车轮包括：相对于主车辆计算远程车辆上的车轮顶部点和车轮底部点的预期相对径向速度，并且将包括基本上匹配车轮顶部点和车轮底部点的预期相对径向速度的多普勒距变率测量值的所述组中的任一者识别为车轮。

[0030] 13. 如方案10所述的方法，其中计算远程车辆相对于主车辆的位置、取向以及速度包括：基于远程车辆最靠近主车辆的侧面上的两个车轮的车轮位置测量值计算远程车辆的取向；并且进一步包括：使用递归式预测远程车辆的与车轮测量位置相对应的状态的算法，其中远程车辆的状态包括二维位置和二维速度。

[0031] 14. 一种用于主车辆的物体检测系统，所述系统包括：

[0032] 主车辆车载的两个雷达传感器，其中所述雷达传感器具有重叠的覆盖区，以使得当远程车辆处于关注区域中时，远程车辆的至少一部分由雷达传感器两者感测到，并且其中来自雷达传感器的数据包括识别远程车辆上的点的位置和多普勒距变率的雷达点；以及[0033] 物体检测处理器，包括微处理器和存储模块，所述处理器被编程以：

[0034] 从所述雷达点识别远程车辆上的两个或更多个车轮，包括：基于位置接近性将雷达点群集成组，并且将包括广泛变化的多普勒距变率测量值的所述组中的任一者识别为车轮；

[0035] 由两个雷达传感器提供两个或更多个车轮的车轮位置测量值，其中所述车轮位置测量值识别车轮中每一个的中心相对于雷达传感器中每一个的距离和方位角；

[0036] 使用包括所述车轮位置测量值的融合计算，计算远程车辆相对于主车辆的位置、取向以及速度；以及

[0037] 使用包括所述车轮位置测量值的融合计算，计算雷达传感器中的一个的对准校准角度。

[0038] 15. 如方案14所述的物体检测系统，其中基于位置接近性将所述雷达点群集成组包括：使用两个点的距离值差异和方位角值差异计算归一化函数，并且如果所述归一化函数具有不超过一的值，则在组中仅包括所述两个点。

[0039] 16. 如方案14所述的物体检测系统，其中将包括广泛变化的多普勒距变率测量值的所述组中的任一者识别为车轮包括：相对于主车辆计算远程车辆上的车轮顶部点和车轮底部点的预期相对径向速度，并且将包括基本上匹配车轮顶部点和车轮底部点的预期相对径向速度的多普勒距变率测量值的所述组中的任一者识别为车轮。

[0040] 17. 如方案14所述的物体检测系统，其中所述处理器基于远程车辆最靠近主车辆的侧面上的两个车轮的车轮位置测量值计算远程车辆的取向。

[0041] 18. 如方案14所述的物体检测系统，其中所述处理器使用递归式预测远程车辆的与车轮测量位置相对应的状态的算法，计算远程车辆相对于主车辆的位置、取向以及速度，其中远程车辆的状态包括二维位置和二维速度。

[0042] 19. 如方案14所述的物体检测系统，其中关注区域位于主车辆的一侧，物体检测系统将远程车辆的位置、取向以及速度数据提供给横向碰撞预防（LCP）系统，并且如果远程车辆进入警示区，则所述LCP系统发出警示，并且如果远程车辆进入即将碰撞包络，则应用主车辆制动和/或转向。

[0043] 20. 如方案14所述的物体检测系统，其进一步包括：主车辆车载的摄像机，其中摄像机提供覆盖与雷达传感器的覆盖区重叠的视野的图像，以使得远程车辆由摄像机和雷达传感器中的至少一个感测到，并且物体检测处理器使用所述图像和所述雷达点执行融合计算，以确定远程车辆的位置、取向以及速度。

[0044] 结合附图，根据以下说明和随附权利要求，本发明的另外特征将变得显而易见。

附图说明

[0045] 图1是包括多个物体检测传感器的主车辆的示意图；

[0046] 图2是图1的主车辆连同远程车辆的图示，其示出远程车辆的速度矢量怎样影响其侵入主车辆的警示区或制动包络；

[0047] 图3是图2的主车辆和远程车辆的图示，其进一步示出获得远程车辆的准确2-D速度的困难性；

[0048] 图4是主车辆和远程车辆的另一图示，其示出由主车辆上的物体感测融合系统使用来确定远程车辆的速度的视觉凸点和雷达点；

[0049] 图5是一种用于使用视觉凸点与雷达点的融合来计算远程物体相对于主车辆的速度的方法的流程图；

[0050] 图6是一种用于跟踪来自摄像机图像的远程物体上的视觉凸点的方法的流程图；

[0051] 图7是一种用于在物体跟踪系统中将视觉凸点与雷达点相关联的方法的流程图；

[0052] 图8是包括多个呈侧视配置的物体检测传感器的主车辆的示意图；

[0053] 图9是如图8所绘示的主车辆、连同远程车辆的图示，其中远程车辆大体上与主车辆并排驾驶；

[0054] 图10是在地面上滚动的轮胎和车轮的侧视图示，其示出雷达传感器数据中可用于识别车轮的基本运动特性；

[0055] 图11和12是图9的主车辆和远程车辆的俯视图，其示出车轮检测、远程车辆跟踪和雷达传感器校准所基于的原理和几何关系；

[0056] 图13是一种用于基于图11和12所述并且示出的测量技术检测远程车辆的车轮的方法的流程图；以及

[0057] 图14是一种用于使用远程车辆车轮检测同时跟踪远程车辆并且校准雷达传感器的对准角度的方法的流程图。

具体实施方式

[0058] 对于针对通过在雷达传感器点数据中检测其车轮来跟踪远程车辆的方法和设备的本发明实施例的以下讨论实质上仅为示例性的，并且决不旨在限制本发明或其应用或用途。

[0059] 许多现代车辆都包括用于检测车辆路径上的物体的物体感测系统。所述物体感测系统可为驾驶员提供警示，或甚至触发其它系统来采取行动以避免车辆碰撞。一些车辆还包括物体感测融合系统，其在数值上“融合”来自两个或更多个物体检测传感器的数据，并且然后以所融合的物体数据作为其物体检测逻辑的基础。一种这样的系统描述在标题为“System and method of target tracking using sensor fusion（使用传感器融合进行目标跟踪的系统和方法）”的美国专利号7,460,951中，所述专利转让给本申请的受让人并且特此以引用方式全部并入。

[0060] 图1是包括多个物体检测传感器的主车辆10的示意图。主车辆10包括物体感测融合系统12，其接收来自摄像机20以及一对雷达传感器32和34的数据。融合系统12包含包括微处理器和存储模块的装置，所述装置配置有软件以执行物体感测融合，如以下所详述。除了物体感测融合以外，其它应用也可以与融合系统12相同的微处理器上运行。

[0061] 摄像机20将图像提供给融合系统12（或提供给专用视觉系统，其未单独示出），融合系统12中处理图像以检测、识别并且跟踪远程物体。类似地，雷达传感器32/34将其雷达返回数据提供给融合系统12（或提供给专用雷达跟踪系统，其未单独示出），在融合系统12中处理雷达点以检测、识别并且跟踪远程物体。摄像机20和雷达传感器32/34典型地通过经由车辆总线的有线连接与融合系统12通信并且将其数据提供给融合系统12，但这种通信可以是无线的。

[0062] 摄像机20具有视野22。雷达传感器32/34分别具有覆盖区36和38。在图1的图示中，摄像机20和雷达传感器32/34沿向后方向取向，并且以下讨论是针对后方横越交通检测应用。然而，该技术还可应用于前视或侧视取向和应用。应注意仅摄像机视野22与雷达覆盖区36或38重叠位置处存在的远程车辆或物体能够用于物体融合。摄像机20与雷达传感器32/
34中的一个可以检测目标的此重叠覆盖区在图1中以椭圆形40示出。如本领域技术人员会理解的，视野22、雷达覆盖区36/38以及重叠覆盖椭圆形40的大小和形状均概念性地示出在图1中。

[0063] 然而，即使使用两个或更多个物体传感器，传统的物体感测融合系统仍可能难以准确地确定远程车辆或物体的二维（2-D）速度，特别是如果远程车辆或物体正相对于主车辆在主要横向或切向方向上移动的话。这一问题的本质示出在图2和3中。

[0064] 图2是图1的主车辆10连同远程车辆50的图示。图2绘示出典型停车场场景，其中如速度箭头18所指示的主车辆10正在倒车，并且远程车辆 50正驾驶朝向主车辆10后面的位置，这可能导致冲突。在后方横越交通规避（RCTA）系统中，主车辆10可能具有围绕其所限定的制动包络14，其中主车辆10的制动可自动应用，如果主车辆10正移动并且物体进入制动包络14的话。主车辆10还可具有限定的警示区16，其中发出听觉和/或视觉警示给主车辆10的驾驶员，如果物体进入警示区16的话。

[0065] 远程车辆50的速度是RCTA系统待知的重要参数。这是因为RCTA系统需要远程车辆50的速度来确定所估算的警示区16和/或制动包络14的“进入时间”。另外，警示区16的位置可基于远程车辆50的速度。在图2中清楚可见，与如果远程车辆50具有第二速度54相比，如果远程车辆50具有第一速度52，则RCTA系统采取的警示和行动将是极其不同的。因此，显然需要远程车辆50的准确2-D速度。

[0066] 图3是主车辆10和远程车辆50的图示，其进一步示出获得远程车辆50的准确2-D速度的困难性。在图3中，远程车辆50具有 由箭头60指出的实际速度 。可认为实际速度 包括两个正交分量：由箭头62指出的径向速度和由箭头64指出的切向速度。雷达传感器32/34典型地包括多普勒性能，其中雷达返回不仅指示物体点的位置，而且指示点的径向速度 。因此，远程车辆50上点的径向速度 可由雷达传感器速度准确测定。然而，难以通过常规的目标跟踪估算切向速度。这是因为远程车辆50是不能认为是点目标的大物体。由于雷达传感器32/34将感测来自远程车辆50的许多雷达返回点，并且每次扫描可返回不同的点，因此方位角测量是不确定的。这进而导致切向速度不确定性。

[0067] 基于图像的物体检测系统通过计算目标在图像平面上在一段时间范围内的移动，较好地适用于估算目标的切向速度。然而，在诸如远程车辆50的车辆情况下，进行此举的传统技术经常无法令人满意；这是因为图像平面中目标的表观横向运动可受径向速度影响（其引起目标在随后的帧中看起来更大或更小），或受修剪车辆轮廓时帧与帧的差异影响。

[0068] 从以上讨论显然的是，需要可准确估算远程车辆50的2-D速度的改进的融合/跟踪技术。这种技术可通过融合摄像机图像数据（即视觉数据）与雷达返回数据来实现。在以下讨论的融合技术中，雷达返回数据提供如以上所述的准确的径向速度。同时，摄像机图像数据中的凸点（即突出点或显著点）可提供准确的横向或切向速度。即，代替仅仅将远程车辆50处理作为单一物体用于跟踪目的，在图像中单独跟踪来自远程车辆50的多个特征。为了提高结果的质量和可靠性，可在图像平面中使用位置近似并且使用先前估算的物体速度作为提示将视觉凸点与雷达点相关联。可从计算中去除基于当前和先前的测量具有与所预期不同的横向速度的视觉凸点。

[0069] 在此处所公开的技术中，远程车辆50上的视觉凸点可包括哈里斯（Harris）角点（局部最大强度变化位置，诸如车辆A柱满足罩线/门线的地方）、车轮、前灯、尾灯、门把手、外反射镜以及任何极大稳定极值区域（MSER）或其它突出特征。尺度不变特征变换（SIFT）技术也可用于检测和描述图像中的视觉凸点。来自加速分割检测（一种角检测法）（FAST）的特征可用于提取凸点并且之后用于跟踪和速度估算。二元稳健独立元素特征（Binary Robust Independent Elementary Features）（BRIEF）以及定向FAST与旋转BRIEF（ORB）可用于检测物体的特征点。

[0070] 图4是主车辆10和远程车辆50的另一图示，其示出使用在以下讨论中的视觉凸点和雷达点。在图4中，远程车辆50再次具有由箭头60表示的速度 。主车辆10车载的雷达传感器32/34检测示出为圆形80的许多雷达点，并且摄像机20检测示出为方形90的许多视觉凸点。如由小箭头所指示，雷达点将包括多普勒径向速度 （ ）数据，并且视觉凸点将具有与横向速度相关联的横越图像平面的表观运动流。以下详细讨论用于将视觉凸点与雷达点相关联并且融合数据以产生速度 的准确估值的技术。

[0071] 图5是一种用于使用视觉凸点与雷达点的融合来计算远程物体相对于主车辆的速度的整个方法的流程图100。在框102处，摄像机20和雷达传感器32/34提供数据。出于此讨论目的，将来自框102的数据提供给融合系统12，并且在融合系统12上执行所有后续计算，融合系统12包括微处理器和存储模块，如先前所述。在车辆上实际实施时，计算可在任何合适的控制器或处理器上执行，或可跨多于一个处理器分布。

[0072] 在框104处，使用雷达数据来提示或触发随后的计算。即，如果雷达传感器32/34在主车辆10后面的关注区域（ROI）中检测到物体，则此提示过程继续进行速度融合计算。在框106处，使用摄像机图像数据识别并且跟踪视觉凸点。图6是一种用于跟踪来自摄像机图像的远程物体上的凸点的方法的流程图140。图6的方法在图5的框106处实施。在框142处，从图像帧检测关注区域中的视觉凸点。如以上所讨论，视觉凸点是物体（在此情况下，远程车辆 50）的突出特征，诸如柱端、车轮、前灯等等。

[0073] 在框144处，建立两个时间上相邻的图像帧之间的对应性。即，标注出可在第一图像帧和下一个图像帧中识别的视觉凸点。当然，凸点将在图像平面上从一个图像移动到下一个，并且其出于许多原因将不会看起来是相同的（像素对像素），这些原因包括透视改变、光照/反射改变等等。在框146处，检测横跨图像帧稳定（即，以可预测方式移动）的视觉凸点。一种用于使用最小成本流网络检测空间-时间稳定的视觉凸点的方法描述在美国专利申请序号13/535,538 （代理人案号P019555-RD-SDJ）中，其标题为“使用最小成本流网络的宽基线双目物体匹配法（WIDE BASELINE BINOCULAR OBJECT MATCHING METHOD USING MINIMAL COST FLOW NETWORK）”，于2012年6月28日提交，转让给本发明的受让人，并且特此以参考方式并入。

[0074] 在框148处，确立各稳定凸点的运动流。运动流不是实际速度；而是，它是摄像机20的图像平面中的凸点从一个帧到下一个的移动。已知图像帧之间的逝去时间，因此例如可以每秒的像素为单位识别运动流。根据以下讨论，可变换凸点的运动流并且用在融合计算中，所述融合计算确实产生所检测物体的速度。

[0075] 返回图5，现在在框106处可获得来自流程图140的凸点运动流数据。在框108处，将来自框106的视觉凸点与雷达点相关联。图7是一种用于在物体跟踪系统中将视觉凸点与雷达点相关联的方法的流程图180。图7的方法在图5的框108处实施。在框182处，各雷达点被投射至图像平面。即， ，其中 为从x-y帧到图像平面的单应性变换，并且 为所投射的雷达点，假定这些雷达点位于地平面上。在框184处，预测的物体速度（来自前一时间步骤）作为运动流 投射到图像平面上。即， ，如果物体
处于x-y帧中的位置 处的话，则其中 是在位置 处计算的变换 的雅可比
（Jacobian）矩阵。在框186处，筛选出或从随后的计算去除运动流与所预期不同的视觉凸点。即，从计算去除第 个视觉点，如果 的话，其中 为第 个视觉点的
估算的运动流，并且 是运动流差异阈值，其中 可为固定值或 的百分比。

[0076] 在框188处，各其余视觉凸点 （未在框186处去除的那些）被分配给其最近的（变换至图像平面的）雷达点 ，其中在图像像素列中测量距离（用于最近性确定）。作为此分配的结果，x-y帧中的 ，其中  为使用单应性变换 ，视觉点 从图像平面到x-y帧的投射，并且 为最近的雷达点。

[0077] 返回图5，视觉凸点（编号 ）现在已在框108处与雷达点（编号 ）相关联。在框110处，使用视觉凸点和其运动流 以及识别的并且如上所述进行关联的雷达点和其径向速度 ，可通过使下式最小化来确定远程车辆50 （通过视觉凸点和雷达点测量的物体）的速度 ：

[0078] 　　　　（1）

[0079] 其中以上已定义并且讨论方程式（1）中的所有变量。

[0080] 在框112处，在诸如后方横越交通规避（RCTA）系统的驾驶员辅助应用中使用远程车辆50的速度 。如先前所讨论，远程车辆50的速度 可用于计算警示区16和/或制动包络14的“进入时间”，并且警示区16的位置可基于远程车辆50的速度 。流程图100的过程继续，并且远程车辆50的速度继续使用方程式（1）的融合计算进行更新，只要在主车辆10后面的关注区域中检测到物体。

[0081] 采用以上所述的视觉凸点与雷达点的融合进行的速度计算提供比传统的物体感测方法更准确的远程车辆速度估算。准确的远程车辆速度可有利地用于后方横越交通规避（RCTA）系统中。此同一融合技术还可用来跟踪其它类型的物体，诸如自行车和购物车，和在前视或侧视应用中、摄像机视野与雷达覆盖区重叠的任何地方跟踪物体。所有这些能力在不必需物体分类符的冗长训练情况下都是可能的。

[0082] 尽管以上所述的技术对于接近主车辆的任何一般物体的检测和跟踪、特别是在后方横越交通规避应用中是极其有效的，但确切地讲可采用其它技术来跟踪远程车辆。一种这样的技术利用远程车辆上的车轮的独特运动特征，并且提供对远程车辆位置、速度以及航向的加强计算。

[0083] 图8是包括多个呈侧视配置的物体检测传感器的主车辆300的示意图。主车辆300包括物体感测融合系统302，其接收来自摄像机304以及一对雷达传感器306和308的数据。融合系统302包含包括微处理器和存储模块的装置，所述装置配置有软件以进行物体感测融合，如以下所详述。除了物体感测融合以外，其它应用也可以在与融合系统302相同的微处理器上运行。

[0084] 摄像机304和雷达传感器306/308具有重叠的覆盖区，并且将其数据提供给融合系统302，其方式类似于先前关于图1的主车辆10所讨论。如同图1的情况，如本领域技术人员应理解的，摄像机视野314、雷达覆盖区316/318以及重叠覆盖椭圆形320（其中远程车辆可由摄像机304和雷达传感器306/308中的至少一个检测到）的大小和形状均在图8中概念性示出。

[0085] 如先前所讨论，即使使用两个或更多个物体传感器，传统的物体感测融合系统仍可能难以准确地确定远程车辆的二维（2-D）速度，特别是如果远程车辆正相对于主车辆300在主要横向（或切向方向上）移动的话。如侧视或横向碰撞预防情况中所显示，此问题的本质示出在图9中。

[0086] 图9是如图8所绘示的主车辆300连同远程车辆400的图示。图9示出典型多车道道路驾驶场景，其中如速度箭头330所指示的主车辆300正驾驶，并且远程车辆 400正大体上与主车辆300并排驾驶，但潜在地在可能引起冲突的方向上朝向主车辆300漂移。在横向碰撞预防（LCP）系统中，主车辆300可发出驾驶员警示，如果远程车辆400进入警示区的话；或采取闪避动作（制动和/或转向），如果确定远程车辆400造成即将的碰撞危险的话。

[0087] 远程车辆400的速度是LCP系统待知的重要参数。在图9中清楚可见，与如果远程车辆400具有第二速度404相比，如果远程车辆400具有第一速度402，则LCP系统采取的警示和/或动作将是极其不同的。因此，显然需要远程车辆400的准确2-D速度。在横向定位的远程车辆的情况下，有可能清楚地识别远程车辆的车轮，并且使用远程车辆车轮测量值来测定2-D远程车辆速度并且同时校准雷达传感器瞄准角度。

[0088] 图10是在地面上滚动的轮胎和车轮的侧视图示，其示出雷达传感器数据中可用于识别车轮的基本运动特性。在图10中，轮胎260与车轮270正在地面上滚动。车轮270具有半径  272，并且轮胎260具有厚度  262。轮胎的外径 被定义为 。车轮270上三个点（车轮底部点274、车轮中心点276以及车轮顶部点278）的分析示出了可如何在雷达返回数据中清楚地识别车轮。为相对于图9进行可视化，认为轮胎260和车轮270在远程车辆400的右手侧。

[0089] 当然，车轮中心点276正以与远程车辆400相同的速度  （以箭头286表示）移动。由于车轮转动，车轮顶部点278正以以下速度移动：

[0090] 　　　　　　　　　　（2）

[0091] 或者，换句话说，车轮顶部点278正以几乎是远程车辆速度 的两倍的速度（以箭头288表示）移动。

[0092] 类似地，由于车轮转动，车轮底部点274正以以下速度移动：

[0093] 　　　　　　　　　　（3）

[0094] 或者，换句话说，车轮底部点274正以稍大于零的绝对速度（以箭头284表示）移动。

[0095] 车轮是良好的雷达反射物，因此许多雷达点很可能从车轮270返回。假定车轮270并不完全垂直于雷达传感器306/308的视线，车轮上点（如由点274/276/278所示出）的不同速度将产生雷达传感器306/308的不同多普勒距变率测量值。因此，如果传感器306/308在基本上同一位置检测到其有显著不同距变率的多个雷达点，则这些点丛集可认为是远程车辆400上的车轮。

[0096] 为了使用远程车辆车轮位置来跟踪远程车辆400并且校准雷达传感器瞄准角度，必须首先在雷达数据中识别远程车辆400上车轮的位置。图11和12是主车辆300和远程车辆400的俯视图，其示出以下讨论和计算（描述车轮检测、远程车辆跟踪和雷达传感器校准）所基于的原理和几何关系。

[0097] 如所示，主车辆300具有用作X-Y坐标帧的原点的形心332。雷达传感器306和308各自定位在主车辆帧中的位置 处，其中 。因此，雷达传感器306可指出为位于位置  （由矢量342指出）的 ，并且雷达传感器308可指出为位于位置 （由矢量352指出）的 。类似地，雷达传感器306（ ）具有视线344，其与主车辆300的直前（X）方向成角度 （角度测量值346）定位，并且雷达传感器308（ ）具有视线354，其与主车辆300的直前（X）方向成角度 （角度测量值356）定位。

[0098] 远程车辆400具有形心406，正沿着矢量402以速度 移动，所述矢量402与主车辆300的直前（X）方向成角度（角度测量值408）。 远程车辆 400具有右侧车轮410和412。出于此讨论的目的，远程车辆400为四轮（每侧两个轮子）小汽车或卡车；然而，车轮检测方法同样适用于两轮远程车辆（摩托车）和多于四轮的远程车辆（卡车和公交车）。远程车辆400上的每个轮子在远程车辆帧中位于位置 （由矢量414指出），其中 。

[0099] 如以上所讨论，首要任务是检测远程车辆400上的车轮410和412，这通过以一系列多普勒（距变率）测量来识别同一位置处雷达点的丛集进行。对于图10的车轮270，车轮顶部点278关于主车辆300的相对速度 （其分量等于可通过雷达传感器306/308检测的点278的距变率）可定义为：

[0100] 　　　　　　　　　　（4）

[0101] 其中 为车轮半径，为轮胎半径，为远程车辆400的速度，为远程车辆400的航向角度，并且 为主车辆300的速度。

[0102] 类似地，车轮底部点274正关于主车辆300以可通过使用方程式（4）的其中因子由 替换的变型获得的相对速度移动。在大多数情况下，车轮底部点274将移动远离主车辆300。

[0103] 对于测量远程车辆400上的车轮之一的雷达传感器306（ ），如图11和12所示，径向线单位矢量 可定义为

[0104] 　　　　　　　　　　（5）

[0105] 其中 ，如图12所示，是远程车辆车轮相对于雷达传感器的视线344的方位测量角度（由角度测量值360表示并且示出为 ，因为其由视线344顺时针测量，其中 逆时针测量）。

[0106] （由方程式4）已知远程车辆的车轮上点的相对速度 ，并且（由方程式5）已知从雷达传感器到车轮的径向线单位矢量 ，远程车辆车轮上点的所预期多普勒测量值 可测定为：

[0107] 　　　　　　　　　　（6）。

[0108] 图13是一种用于如上所述的基于测量技术检测远程车辆的车轮的方法的流程图500。在框502处，获得雷达传感器306和308的传感器点。各传感器点 具有距离、多普勒和方位角。即，各传感器点包括 ， 。在框504处，基于位置接近
性（距离 和方位角 ）将雷达点丛集成组。用于将雷达点丛集成组的一种技术是将点 和分配给同一丛集，如果并且只有：

[0109] 　　　　　　　　　　（7）

[0110] 其中 和 是可调校准值，并且距离 和角度 如以上所述。

[0111] 在框506处，评估方程式（7）所识别的各丛集中所有雷达点的多普勒值。如果点的丛集具有距离如方程式（4）-（6）所述的多普勒值（包括朝向主车辆300移动的一些点和移动远离主车辆300的一些点），则所述丛集被识别为远程车辆400上的车轮。在框508处，计算远程车辆400的轴距 ，如果在远程车辆400检测到两个车轮，最有可能地，最接近主车辆300的那一侧上的两个车轮。轴距 计算为所检测到的两个车轮中心之间的距离。车轮中心可识别为最接近车轮丛集中所包括的点的几何中心的雷达点。从距离 和方位角 已知车轮中心点的位置，直接计算两个点之间的距离。在框510处，计算远程车辆400的取向角（角度测量值408），如果在远程车辆400上检测到两个车轮的话。给定两个车轮中心点的位置，取向角 的计算也是直接计算。

[0112] 图14是一种用于使用远程车辆车轮检测同时跟踪远程车辆400并且校准雷达传感器306/308的对准角度的方法的流程图540。流程图540的方法步骤可由主车辆300上的物体感测融合系统302执行。在框542处，由雷达传感器306/308提供雷达点数据。出于此讨论目的，将来自框542的数据提供给物体感测融合系统302，并且在物体感测融合系统302上执行所有后续计算，物体感测融合系统302包括微处理器和存储模块，如先前所述。在框544处，在来自传感器306/308的雷达点数据中识别远程车辆400上的车轮。如果识别出两个车轮，则还在框544处计算取向角 。识别远程车辆400的车轮和计算取向角 中所涉及步骤的细节提供在以上所讨论的图13中。

[0113] 在框546处，使用通过雷达传感器306和308检测的车轮跟踪远程车辆400的位置、取向和速度。远程车辆400的状态被建模为 ，表示远程车辆400的中心位置 和地面速度 。通过
将远程车辆400的航向角或取向角 与 和 速度相关联。

[0114] 如以上在图11和12的讨论中所述，可通过数 识别远程车辆400上的车轮，其中各车轮在远程车辆参考帧中处于位置 。还如以上所述，主车辆300上的雷达传感器306/308可通过数 来识别，其中各传感器在主车辆参考帧中处于位置，并且与主车辆300的直前（X）方向具有视线角度 。

[0115] 考虑到以上，可定义一般符号，其中通过第 个雷达传感器测量的第 个车轮的位置已知为 。

[0116] 接下来，定义旋转矩阵 ，其中 在必要时用于基于角度 和 使点坐标旋转。矩阵 定义为：

[0117] 　　　　　　　　　　（8）。

[0118] 用于基于远程车辆400的状态 ，由第 个雷达传感器测量的第 个车轮（对于和 ）的测量方程式于是定义为

[0119] 　　　（9）

[0120] 其中 为远程车辆状态 的函数，并且其它变量在以上讨论中描述。可对方程式（9）递归求解，以最佳地基于各新的车轮位置测量值 估算状态 。在一个非限制性实施例中，在卡尔曼滤波器例程中将方程式（9）编程以对状态 求解。

[0121] 通过使用所有可用的车轮测量值继续对方程式（9）求解，可在框546处通过主车辆300跟踪远程车辆400的状态（ ），只要远程车辆400保持在主车辆
300的关注区域内。

[0122] 在框548处，基于远程车辆400上车轮的所识别位置校准雷达传感器306/308的对准角度。如图11和12所示，远程车辆400上的车轮410可通过雷达传感器306与雷达传感器308来检测，因而提供冗余的测量数据。对于车轮412也可同样如此。此冗余的测量数据可有利地用于传感器对准校准。

[0123] 考虑到雷达传感器306和308的已知位置（分别为 和 ）和其相应的视线角（和 ），对于车轮410方程式（9）应产生同一位置 ，无论是通过雷达传感器306还是雷达传感器308来进行测量。然而，实际上车轮410的冗余测量可能并不一致，并且任何差异均可归因于传感器未对准。例如，如果假定传感器306的对准角 是准确的，则传感器308的对准角 可基于测量数据进行校准，以更接近地匹配远程车辆400的位置 和取向 以及车轮410的位置 。

[0124] 从以上方程式（9）提取第二因子，所计算表达式 可定义为：

[0125] 　　　　　　　　　　（10）

[0126] 其中 为时序识别符， ，并且所计算表达式 和雷达测量值的 个最新值存储在缓存中。

[0127] 旋转对准矩阵 可定义为 ，并且可通过将以下最小二乘函数最小化来求解：

[0128] 　　　　　　　　　　（11）。

[0129] 以下技术可用于对方程式（11）求解。假设矩阵 并且。通过 的奇异值分解得到矩阵 、 以及 。即，
。最小二乘方程式（11）的解为 ，其中

[0130] 　　　　　　　　　　（12）

[0131] 并且 是行列式算子。

[0132] 使用以上求解的矩阵 ，雷达传感器308的所估算对准角为 。可在图14的框548处继续校准雷达传感器306或308的对准角。对准角可用于调整来自雷达传感器306或308的将来测量读数。通过由主车辆300上的雷达传感器306/308对远程车辆
400上车轮的冗余和重复测量以及以上讨论的融合计算有可能进行远程车辆400的跟踪和雷达传感器对准的同时校准。

[0133] 物体感测融合系统302还可在以上讨论的融合计算中并入来自摄像机304的视觉数据，以进一步完善远程车辆400的跟踪和对雷达传感器对准的同时校准。这可通过在视觉数据中以凸点形式识别车轮并且将视觉凸点与对应雷达点融合来进行，如以上关于后方横越交通规避（RCTA）应用所讨论。

[0134] 以上所述的采用雷达车轮检测的远程车辆跟踪计算提供远程车辆位置、取向以及速度的比传统物体感测方法更准确的估算。准确远程跟踪可有利地用在横向碰撞预防（LCP）系统中，其中准确了解远程车辆的2-D速度是关键的。使用此同一融合技术来虚拟校准雷达传感器对准对车辆制造商和车主或驾驶员提供额外益处。

[0135] 以上讨论仅公开并且描述了本发明的示例性实施例。本领域技术人员从此讨论和附图以及权利要求将易于认识到可在不背离如以下权利要求所限定的本发明精神和范围情况下进行各种变化、修改以及变更。