CN105324275A - 移动轨迹预测装置和移动轨迹预测方法 - Google Patents

Abstract

本发明的课题在于，即使在车辆产生了摇晃、偏转的情况下，也能根据对象物的位置的历史记录来高精度地预测对象物的移动轨迹。为解决该课题，本发明中，获取车辆周边的对象物的位置(S1)，获取对象物的对地速度(S3)，使用车辆的速度和对象物的对地速度来算出对象物的对于车辆的轨迹预测矢量(相对移动矢量)的倾斜度θ(S7)，用该轨迹预测矢量的倾斜度θ的直线对对象物的位置的历史记录进行拟合(记录的对象物的移动轨迹中的位置的分类)(S8)，将最适合倾斜度θ的直线的位置的倾斜度θ的直线(由通过拟合而分类的组所包含的多个位置决定的直线)预测为对象物的移动轨迹(S9)。

Description

移动轨迹预测装置和移动轨迹预测方法

技术领域

本发明涉及搭载在车辆中并预测车辆周边的对象物的移动轨迹的移动轨迹预测装置和移动轨迹预测方法。

背景技术

在进行车辆与车辆周边的对象物(例如行人、其他车辆)的碰撞判定等的情况下，需要从行驶的车辆高精度地预测对象物的移动轨迹。在专利文献1所记载的装置中，根据存在于车辆周围的移动体的位置和移动速度来预测移动体的行进路线，根据车辆的位置和移动速度来预测车辆的行进路线，基于移动体的行进路线和车辆的行进路线来判断移动体与车辆是否有可能碰撞，在有可能碰撞的情况下产生警报。

现有技术文献

专利文献

专利文献1：日本特开2003-81037号公报

发明内容

本发明欲解决的问题

在车辆行驶时，有时车辆会产生摇晃、偏转。如图12(a)所示，在车辆C向逆时针方向偏转时，在车辆C的前方物体看起来会向横向右侧方向(与偏转的方向相反的方向)运动。例如，在车辆偏转了1度的情况下，在车辆C的30m前方，物体会看起来在横向运动了50cm。

在专利文献1中根据对象物(移动体)的位置和移动速度来预测移动轨迹，但存在根据对象物的所见的检测位置(对于车辆的相对检测位置)的历史记录来预测对于车辆的相对移动轨迹的方法。在利用该方法来预测移动轨迹的情况下，在车辆存在摇晃、偏转时，在对象物的检测位置的历史记录中会产生横向位置跳跃，移动轨迹的预测精度有可能下降。例如，在图12(b)所示的例子的情况下，行人W在车辆C的前方向右方行走，行人P的检测位置的历史记录是D1～D6。在这个例子中，由于车辆C的逆时针方向的偏转，而在以椭圆形示出的部位A会产生检测位置的横向位置跳跃，位置会在检测位置D3与检测位置D4之间向右方跳跃。因此，根据包含该横向位置跳跃的检测位置的历史记录D1～D6来预测行人P的移动轨迹时，会得到附图标记L’所示的移动轨迹。由于该移动轨迹L’是受到与行人P的移动无关的横向位置跳跃分量的影响而预测的，所以与行人P的实际移动轨迹不同。这样，车辆产生摇晃、偏转时，对象物的移动轨迹的预测精度有可能下降。

因此，本发明的目的在于提供一种移动轨迹预测装置和移动轨迹预测方法，即使在车辆产生摇晃、偏转的情况下，也能根据对象物的位置的历史记录来高精度地预测对象物的移动轨迹。

用于解决问题的方案

本发明所涉及的移动轨迹预测装置是一种预测车辆周边的对象物的移动轨迹的移动轨迹预测装置，其特征在于，包括：对象物检测部，其获取车辆周边的对象物的位置；速度获取部，其获取对象物的对地速度；相对移动矢量算出部，其使用车辆的速度信息、和速度获取部所获取的对象物的对地速度，算出对象物的对于车辆的相对移动矢量；分类部，其记录对象物检测部所获取的对象物的移动轨迹中的位置，基于由相对移动矢量算出部算出的相对移动矢量将记录的该位置分类为多个组；及移动轨迹预测部，其基于分类部所分类的组中的至少1个组所包含的对象物的多个位置，预测该对象物的移动轨迹。

在该移动轨迹预测装置中，用对象物检测部进行对象物检测，获取对象物的位置(对于车辆的相对位置)。将对每个该对象物获取的从当前到过去的预定个数的位置(对象物的位置的历史记录)用于预测对象物的将来的移动轨迹。因此，对象物检测部所获取的对象物的位置被记录。在移动轨迹预测装置中，用速度获取部获取对象物的对地速度，用相对移动矢量算出部使用该对象物的对地速度和车辆的速度信息来算出对象物的对于车辆的相对移动矢量。该相对移动矢量为示出对象物的将来的移动轨迹的移动方向的矢量。另外，相对移动矢量中，由于作为对象物的速度不是使用对于车辆的相对速度，而是使用对地速度来算出的，所以，即使在由于车辆的摇晃、偏转而对象物的相对位置产生了横向位置跳跃的情况下，相对移动矢量也是不受到其影响的矢量。因此，在移动轨迹预测装置中，基于相对移动矢量将由分类部记录的对象物的位置(对象物的位置的历史记录)分类为多个组。由于以相对移动矢量作为基准来进行分类，所以即使在记录的对象物的位置中包含横向位置跳跃的位置的情况下，也能够将该横向位置跳跃的位置除外来将对象物的位置分类。例如，能够分类为由横向位置跳跃之后的多个对象物的位置构成的组、和由横向位置跳跃之前的多个对象物的位置构成的组。而且，在移动轨迹预测装置中，用移动轨迹预测部基于分类的该组中的至少1个组所包含的对象物的多个位置来预测对象物的移动轨迹。这样，移动轨迹预测装置使用基于对象物的对地速度的相对移动矢量将对象物的位置的历史记录分类并预测对象物的移动轨迹，从而即使在由于车辆的摇晃、偏转而在对象物的位置的历史记录中产生了横向位置跳跃的情况下，也能够根据对象物的位置的历史记录来高精度地预测对象物的移动轨迹。

在本发明的移动轨迹预测装置中，优选的是，对象物检测部利用对照相机所拍摄的图像的边缘处理来进行对象物的检测，分类部在所记录的对象物的位置的分类中，在越是图像的纵向边缘强度强的位置的情况下，越促进利用该位置作为对象物的位置。

在该移动轨迹预测装置的对象物检测部中，利用对照相机所拍摄的图像的边缘处理来进行对象物的检测。在对象物是如行人等那样形状在移动中会变化的情况下，对象物的检测范围会变化，其检测范围的中心位置会有偏差。将其中心位置作为对象物的检测位置时，移动轨迹的预测所使用的对象物的位置的历史记录所包含的各位置会有偏差。其结果是，移动轨迹的预测精度会下降。因此，在分类部中，在进行分类时，在越是图像的纵向边缘强度强的位置的情况下，越促进将该位置利用为对象物的位置。越是图像中检测到对象物的范围中纵向边缘强度强的位置，越是在检测范围的横向中表现出强的对象物的存在的部位(存在的比例大于其他部位的部位)，因此适于作为对象物的位置。这样，在移动轨迹预测装置中，越是纵向边缘强度强的位置，越促进将该位置利用为对象物的位置，从而能够抑制对象物的位置的历史记录的偏差，能够更高精度地预测对象物的移动轨迹。

在本发明所述的移动轨迹预测装置中，优选的是，在车辆的转向量为预定量以上的情况下，分类部不进行分类。

在车辆具有定量以上的转向的转向增加、转向复原的情况下，车辆由于其转向增加、转向复原而转弯，行进方向变化。因此，对象物的相对位置也相应地变化。此时，有可能对象物的所见的形状变化从而对象物的对地速度的检测精度也下降。因此，在移动轨迹预测装置中，在车辆的转向量为预定量以上的情况下，分类部不进行分类。该预定量设定有转向量，用于判定与车辆的摇晃、偏转显然不同的车辆的转向。

在本发明所述的移动轨迹预测装置中，优选的是，分类部在越是所记录的对象物的位置中的时间上与当前近的位置的情况下，越增大该位置的权重来进行分类。

在对象物改变了移动方向或者速度的情况下，更好的是，在对象物的将来的移动轨迹的预测中反映出改变了对象物的移动方向或者速度后的对象物的位置。所以，更好的是，越是在所记录的对象物的位置(对象物的位置的历史记录)中的与当前较近的位置，在对象物的将来的移动轨迹的预测中越重视该位置。因此，在分类部中，越是所记录的对象物的位置中的时间上与当前较近的位置，越增大该位置的权重来进行分类。由此，使用包含时间上与当前较近的位置的组来预测移动轨迹的倾向提高，易于在预测的移动轨迹中反映与当前近的位置的信息。这样，移动轨迹预测装置越是在对象物的位置的历史记录中的时间上与当前较近的位置，越增大该位置的权重地进行分类，从而能够更高精度地预测对象物的移动轨迹。

在本发明所述的移动轨迹预测装置中，优选的是，相对移动矢量算出部在相对移动矢量的算出中不使用如下的对象物的对地速度：该对象物的对地速度与对地速度的上次值之差为第1阈值以上，且与根据对象物的位置的差值求出的速度之差为第2阈值以上。

在对象物的对地速度为异常值(误检测值)的情况下，相对移动矢量成为示出弄错的移动方向的矢量，移动轨迹的预测精度会下降。因此，判定对象物的对地速度是否是与上次值大幅偏离的跳跃值。并且，即使在对地速度从上次值成为跳跃值的情况下，此时，也有可能对象物是急加速或者急减速而对地速度发生了急剧变化。因此，根据对象物的前后位置的差值求出此时的移动速度，判定对象物的对地速度是否是与该求出的移动速度大幅偏离的值。利用这2个判定，能够判断对象物的对地速度是否是异常值。因此，在相对移动矢量算出部中，在相对移动矢量的算出中不使用如下的对象物的对地速度：该对象物的对地速度与对地速度的上次值之差为第1阈值以上，且与根据对象物的位置的差值求出的速度之差为第2阈值以上。第1阈值是用于判定对象物的对地速度是否从上次值成为跳跃值的阈值。第2阈值是用于判定对象物的对地速度是否是与根据对象物的位置的差值求出的速度偏离的值的阈值。这样，移动轨迹预测装置在对象物的对地速度为异常值的情况下，不将该对地速度用于算出相对移动矢量，因此，能够抑制相对移动矢量的精度下降，能够抑制移动轨迹的预测精度的下降。

本发明所涉及的移动轨迹预测方法是一种预测车辆周边的对象物的移动轨迹的移动轨迹预测方法，其特征在于，包括：对象物检测步骤，获取车辆周边的对象物的位置；速度获取步骤，获取对象物的对地速度；相对移动矢量算出步骤，使用车辆的速度信息、和速度获取步骤中获取的对象物的对地速度，算出对象物的对于车辆的相对移动矢量；分类步骤，记录对象物检测步骤中获取的对象物的移动轨迹中的位置，基于在相对移动矢量算出步骤中算出的相对移动矢量将记录的该位置分类为多个组；及移动轨迹预测步骤，基于分类步骤中分类的组中的至少1个组所包含的对象物的多个位置，预测该对象物的移动轨迹。该移动轨迹预测方法与上述移动轨迹预测装置同样起作用，具有同样的效果。

发明的效果

根据本发明，使用基于对象物的对地速度的相对移动矢量，将对象物的位置的历史记录分类并预测对象物的移动轨迹，从而即使在由于车辆的摇晃、偏转而在对象物的位置的历史记录中产生了横向位置跳跃的情况下，也能够根据对象物的位置的历史记录来高精度地预测对象物的移动轨迹。

附图说明

图1是本实施方式的碰撞预测装置的构成图。

图2是轨迹预测矢量的说明图。

图3是使用了轨迹预测矢量的倾斜度的、对于对象物的检测位置的历史记录的拟合的说明图。

图4是拟合所使用的对象物的检测位置的说明图，(a)是行人的摆臂大的情况和小的情况，(b)是检测的对象物的横向宽度的中心位置和纵向边缘为最强的位置。

图5是对象物的对地速度的异常值去除的说明图。

图6是图1的系统ECU进行的轨迹预测矢量算出处理的说明图。

图7是图1的系统ECU进行的拟合处理的说明图。

图8是图1的系统ECU所使用的对象物的各检测位置的权重的一个例子。

图9是示出本实施方式的碰撞预测装置的动作的流程的流程图。

图10是示出图9的流程图中的异常值去除处理的流程的流程图。

图11是示出图9的流程图中的拟合处理、直行时对象物轨迹预测处理的流程的流程图。

图12是本车偏转的情况下的一个例子，(a)是示出本车偏转的情况下的前方的所见的横向移动的图，(b)是示出本车偏转前和后的行人的检测位置和移动轨迹的图。

附图标记的说明

1…碰撞预测装置、10…立体相机、11…转向角传感器、12…偏航角速度传感器、13…车轮速度传感器、20…警报装置、21…碰撞避免辅助装置、22…安全带控制装置、23…座椅控制装置、24…制动控制装置、30…系统ECU

具体实施方式

下面，参照附图，说明本发明的移动轨迹预测装置和移动轨迹预测方法的实施方式。此外，在各图中，对相同或者相当的要素标注同一附图标记，省略重复的说明。

在本实施方式中，将本发明的移动轨迹预测适用于搭载在车辆中的碰撞预测装置的对象物的移动轨迹预测功能。本实施方式的碰撞预测装置利用立体相机检测本车周边(特别是前方)的对象物，根据其检测的对象物的相对检测位置的历史记录来预测移动轨迹。然后，本实施方式的碰撞预测装置使用对象物的预测移动轨迹来进行与本车的碰撞判定，在有可能碰撞的情况下进行为了碰撞避让、碰撞损害减轻的辅助。

此外，对象物包含移动物和静止物。移动物例如有行人、自行车、车辆。静止物例如有电线杆、交通标识。另外，移动轨迹的预测所使用的对象物的检测位置的历史记录包括从当前到过去的任意个数的检测位置。关于该个数，可以考虑检测位置的更新周期等而适当地设定。

参照图1～图8，说明本实施方式的碰撞预测装置1。图1是本实施方式的碰撞预测装置的构成图。图2是轨迹预测矢量的说明图。图3是使用了轨迹预测矢量的倾斜度的、对于对象物的检测位置的历史记录的拟合的说明图。图4是拟合所使用的对象物的检测位置的说明图。图5是对象物的对地速度的异常值去除的说明图。图6是系统ECU进行的轨迹预测矢量算出处理的说明图。图7是系统ECU进行的拟合处理的说明图。图8是系统ECU所使用的对象物的各检测位置的权重的一个例子。

碰撞预测装置1为了在本车即使产生摇晃、偏转的情况下也高精度地预测对象物的移动轨迹，使用对象物的对地速度和本车的车速来求出对象物的对于本车的相对移动矢量(该矢量称为“轨迹预测矢量”)，将该轨迹预测矢量的倾斜度(对象物的移动方向)的直线，对于对象物的检测位置的历史记录(记录的对象物的移动轨迹中的检测位置)进行拟合，预测对象物的移动轨迹。在拟合时，作为对象物的检测位置，使用纵向边缘的强度强的位置，在对象物的检测位置的历史记录中时间上越新的检测位置越加大权重来进行拟合。另外，对于对象物的对地速度去除异常值。另外，在本车的转向量大的情况(本车没有直行行驶的情况)下，用以往的方法来预测对象物的移动轨迹。

在具体说明碰撞预测装置1的构成前，首先，说明对象物的对地速度。在使用对于本车的相对速度作为对象物的速度的情况下，在本车产生摇晃、偏转时，其相对速度包含本车的摇晃、偏转所导致的横向位置跳跃所导致的变化量。因此，作为对象物的速度，使用对地速度(绝对速度)，作为不受到本车的摇晃、偏转所导致的横向位置跳跃所导致的影响的速度。作为获取该对地速度的方法，例如有根据外界传感器所检测的固定物与对象物的位置的差值进行检测的方法、利用与对象物之间的通信来接收对象物所检测出的速度的方法、利用路车间通信来接收路侧的基础设施所检测出的对象物的速度的方法。此外，作为用于求出轨迹预测矢量的对地速度，可以只使用最新的对地速度、或者也可以使用从当前到过去的多个对地速度的平均对地速度。

接下来，参照图2，说明轨迹预测矢量(特别是倾斜度)。轨迹预测矢量PV作为本车的车速Vc与对象物的对地速度Vp的相对矢量来得到。该轨迹预测矢量PV的倾斜度θ作为对象物的移动相对于本车的行进方向(基本上为直行方向)的倾斜度(角度)来得到。在对象物的纵深方向的速度相对于本车的车速小到可以忽视的程度的情况(例如对象物是行人，在本车前方横向行走的情况)下，关于对象物的对地速度Vp只使用横向的速度分量来求出轨迹预测矢量PV即可。另外，如果能得到本车所行进的行进方向(相对于直行方向的角度)，也可以考虑该行进方向来求出轨迹预测矢量PV、倾斜度θ，但由于将本车正在直行时作为典型的辅助对象，所以也可以不考虑。因此，作为所需的最小限度的信息，可以根据对象物的横向的对地速度和本车的车速来求出轨迹预测矢量PV、其倾斜度θ。

轨迹预测矢量PV为示出对象物的将来移动轨迹的移动方向的矢量。因此，轨迹预测矢量PV的倾斜度θ示出相对于本车的行进方向的、对象物的将来的移动轨迹的移动方向。另外，轨迹预测矢量PV是如下矢量：由于作为对象物的速度不是使用对于本车的相对速度，而是使用对地速度算出的，所以，即使在由于本车的摇晃、偏转而使对象物的相对位置产生横向位置跳跃的情况下，也不会受到其影响。

接下来，参照图3，说明使用了轨迹预测矢量PV的倾斜度θ的拟合。拟合是，将倾斜度θ的直线分别拟合到对象物的检测位置的历史记录所包含的各检测位置，判断该直线在哪个位置最匹配(适合)。特别是，在该拟合中，能够在由于本车的摇晃、偏转而产生了横向位置跳跃的情况下，将该跳跃前或者跳跃后的检测位置除外，将检测位置分类。作为该拟合方法，例如有基于被决定在以各检测位置为基准的直线作为中心的范围内的检测位置的多数决定的方法、基于最小二乘法的方法。

在图3所示的例子中，是对于对象物即行人P的6个检测位置D1～D6，使用轨迹预测矢量PV的倾斜度θ来进行拟合的例子，由于本车C的偏转而在检测位置D3与检测位置D4之间产生了横向位置跳跃。例如，在对于检测位置D3以倾斜度θ的直线进行了拟合的情况下，横向位置跳跃后的检测位置D4、D5、D6被除去，被分类成检测位置D1、D2、D3的组。另外，在对于检测位置D6以倾斜度θ的直线进行了拟合的情况下，横向位置跳跃前的检测位置D1、D2、D3被除去，被分类成检测位置D4、D5、D6的组。然后，在关于这样分类的各检测位置的组中，判断基于哪个组的直线是最适合倾斜度θ的直线的组。此外，在图3等中，示出检测位置D1……的大致H状的标记也以横向的长度也示出了检测范围(横向宽度)。

对象物有的情况下在恒定的移动方向以恒定的速度移动，也有的情况下改变移动方向或者速度。在对象物改变移动方向或者速度的情况下，更好的是，在对象物的将来的移动轨迹的预测中反映出对象物的移动方向或者速度改变后的检测位置。因此，更好的是，在对象物的检测位置的历史记录中，越是与当前较近的检测位置，在对象物的将来的移动轨迹的预测中越重视。因此，在进行拟合的情况下，在对象物的检测位置的历史记录中越是在时间上与当前较近的检测位置(最新的检测位置)越增大权重地进行拟合。例如，在基于多数决定的拟合方法的情况下，采用对各检测位置添加了权重的决定；在基于最小二乘法的拟合方法的情况下，采用添加权重的最小平方法。

接下来，参照图4，说明作为对象物的检测位置，使用纵向边缘的强度强的位置的原因。在对象物如行人那样形状在移动中会变化的情况下，对象物的被检测的范围会变化，其检测范围的中心位置会有偏差。例如，如图4(a)所示，在横穿本车前方的行人P的情况下，前后摇摆着手臂时的行人P的横向宽度(检测范围)W1、与不前后摇摆手臂时的行人P的横向宽度(检测范围)W2不同。因此，在为横向宽度W1时其中心位置在行人P的身体的前端附近，在为横向宽度W2时其中心位置在行人P的身体的中心附近。因此，如图4(b)所示，黑三角标记所示的行人P的横向宽度的中心位置P1、P2……会有偏差。将该横向宽度的中心位置(或者横向宽度的端部)用作对象物的检测位置时，就成为用有偏差的检测位置的历史记录来进行拟合、移动轨迹的预测。其结果是，不能高精度地进行拟合，移动轨迹的预测精度下降。

在用边缘处理从图像检测到对象物的情况下，在从图像检测到对象物的范围中，纵向边缘强度强的位置由于是在检测范围中在横向对象物的存在强烈显现的部位(存在的比例大于其他部位的部位)，所以适于作为对象物的位置。因此，在拟合等中使用对象物的检测位置的情况下，作为对象物的检测位置，使用在对象物的检测范围(特别是横向宽度)中纵向边缘强度最强的位置。在图4(a)所示的例子的情况下，前后摇摆手臂时的行人P的纵向边缘强度最强的位置E1在行人P的身体的中心附近，不前后摇摆手臂时的行人P的纵向边缘强度最强的位置E2也在行人P的身体的中心附近。另外，如图4(b)所示，白圆圈标记所示的行人P的纵向边缘强度最强的位置E1、E2……没有偏差。此外，关于对该检测位置的处理，在对象物的检测中不使用边缘处理的情况下不适用。

接下来，参照图5，说明对象物的对地速度的异常值去除。在对象物的对地速度为异常值(误检测值)的情况下，根据该对地速度求出的轨迹预测矢量PV是包含误差的矢量，成为使用包含误差的倾斜度θ来进行拟合。在对象物的对地速度成为与上次值大幅偏离的跳跃值的情况下，其对地速度有可能是异常值。但是，即使在对地速度是从上次值成为跳跃值的情况下，此时，也有可能是对象物实际上在急加速或者急减速而对地速度发生了急剧变化。因此，在对象物的对地速度从上次值成为跳跃值，且与根据对象物的检测位置的差值求出的移动速度大幅偏离的情况下，该对象物的对地速度被判断为异常值，不用于算出轨迹预测矢量。例如，在图5所示的例子的情况下，行人P的对地速度Vp1、Vp2……中对地速度Vp6从上次值Vp5成为跳跃值，而且，行人P的检测位置的本次值D6也没有从上次值D5急剧变化(本次值D6和上次值D5的差值不大)。因此，对地速度Vp6被判断为异常值而不被使用。

此外，说明作为对地速度被判断为异常值的情况下的处理。例如，在求出轨迹预测矢量PV时只使用最新的对地速度的情况下，使用对地速度的上次值、或者根据对象物的检测位置的本次值与上次值的差值求出的速度。在求出轨迹预测矢量PV时使用过去的任意个数的对地速度的平均值的情况下，不使用最新的对地速度，来算出对地速度的平均值。

接下来，说明本车的转向量大的情况(本车没有直行行驶的情况)。在本车具有定量以上的转向增加、转向复原的情况下，本车由于其转向增加、转向复原而转弯，行进方向变化。因此，对象物的相对检测位置也相应地大幅变化。此时，有可能对象物的所见的形状变化从而对象物的对地速度的检测精度也下降。因此，在本车的转向量为预定量以上的情况下，不进行轨迹预测矢量PV(特别是倾斜度θ)的算出、拟合。而且，使用对象物的检测位置的历史记录的所有检测位置，用以往的方法来预测对象物的将来的移动轨迹。作为该以往的方法，例如使用检测位置的历史记录所包含的检测位置间的差值来预测移动轨迹，或者对于检测位置的历史记录进行线性回归来预测移动轨迹。

那么，说明碰撞预测装置1的具体构成。碰撞预测装置1包括：立体相机10、转向角传感器11、偏航角速度传感器12、车轮速度传感器13、警报装置20、碰撞避免辅助装置21、安全带控制装置22、座椅控制装置23、制动控制装置24和系统ECU[ElectronicControlUnit，电子控制单元]30。此外，在本实施方式中，立体相机10相当于权利要求书所记载的对象物检测部，立体相机10和系统ECU30的处理相当于权利要求书所记载的速度获取部，系统ECU30中的各个处理相当于权利要求书所记载的相对移动矢量算出部、分类部、移动轨迹预测部。

立体相机10包括拍摄本车前方的左右一对照相机和图像处理装置。在立体相机10的左右一对各照相机中，每隔一定时间(例如每1/30秒)分别拍摄，获取左图像和右图像。然后，在立体相机10的图像处理装置中，使用左右的图像(立体图像)来进行物体检测处理，在能够检测到物体(物标)的情况下，获取物体的信息(例如从立体相机10(本车)到物体的相对纵深方向的距离、横向的横向位置、物体的横向宽度、高度、物体的形状)。在使用了该立体图像的物体检测方法中适用以往的已知技术，例如有：在立体图像间进行相关运算，并使用根据该相关计算结果得到的视差来进行检测的方法；对于图像进行边缘处理(纵向边缘、横向边缘)来进行检测的方法。然后，在立体相机10中，每隔一定时间，将该物体的有无信息、能够检测到物体的情况下的每个物体(每个物标)的信息等作为立体相机信号发送至系统ECU30。此外，在进行边缘处理的情况下，还发送每个物体的检测的范围内的纵向边缘强度、横向边缘强度的信息。

此外，立体相机10所检测的对象的物体是具有某一程度的大小、高度的上述的行人、自行车、车辆、电线杆、交通标识等。另外，在在立体相机10所进行的图像处理中，在照相机所拍摄的图像的水平方向/垂直方向的像素单位的坐标系中进行处理，物体的信息是像素单位的数据。另外，对检测到的物标付与识别号码，在不同的时间检测到相同物标的情况下付与相同的识别号码，并对检测次数进行计数。这些识别号码、检测次数的信息也被作为每个物标的信息，由立体相机信号发送。

转向角传感器11是检测由驾驶者输入至方向盘的转向角的传感器。在转向角传感器11中，每隔一定时间检测转向角，将该检测的转向角作为转向角信号发送至系统ECU30。

偏航角速度传感器12是检测作用在本车上的偏航角速度的传感器。在偏航角速度传感器12中，每隔一定时间检测偏航角速度，将该检测到的偏航角速度作为偏航角速度信号发送至系统ECU30。

车轮速度传感器13是分别设在车辆的4个轮子上，并检测车轮的转速(与车轮的旋转相应的脉冲数)的传感器。在车轮速度传感器13中，每隔一定时间检测车轮的旋转脉冲数，将该检测到的车轮旋转脉冲数作为车轮速度信号发送至系统ECU30。此外，在系统ECU30中，根据各车轮的旋转脉冲数来分别算出车轮速度，根据各轮的车轮速度算出车身速度(车速)。

警报装置20是用于向本车的驾驶者进行警报的装置。作为警报，有蜂鸣器(警报音)输出、警报消息的声音输出、显示等。在警报装置20中，从系统ECU30接收到警报控制信号时，基于该警报控制信号来输出警报。

碰撞避免辅助装置21是用于利用转向控制(自动转向、转向辅助等)来避免碰撞、缓解碰撞所导致的冲击的装置。在碰撞避免辅助装置21中，从系统ECU30接收到碰撞避免控制信号时，基于该碰撞避免控制信号来进行转向控制。

安全带控制装置22是用于控制安全带的紧固力来减轻碰撞损害的装置。安全带控制装置22从系统ECU30接收到安全带控制信号时，基于该安全带控制信号来控制安全带的紧固力。

座椅控制装置23是用于控制座椅的位置、姿势来减轻碰撞损害的装置。在座椅控制装置23中，从系统ECU30接收到座椅控制信号时，基于该座椅控制信号来控制座椅的位置、姿势。

制动控制装置24是用于利用制动控制(自动停止、自动减速、制动器辅助等)来避免碰撞、缓解碰撞所导致的冲击的装置。在制动控制装置24中，从系统ECU30接收到制动控制信号时，基于该制动控制信号来进行制动控制。

系统ECU30包括CPU[CentralProcessingUnit，中央处理单元]、ROM[ReadOnlyMemory，只读存储器]、RAM[RandomAccessMemory，随机存取存储器]等，是综合控制碰撞预测装置1的电子控制单元。在系统ECU30中，每隔一定时间从立体相机10接收立体相机信号。另外，在系统ECU30中，从各传感器11、12、13接收检测信号。而且，在系统ECU30中，通过使用这些立体相机信号和各检测信号，将储存在ROM中的应用程序载入到RAM并由CPU执行，从而进行各个处理(本车轨迹预测处理、对地速度检测处理、转向判定处理、转向时对象物轨迹预测处理、异常值去除处理、轨迹预测矢量算出处理、拟合处理、直行时对象物轨迹预测处理、碰撞位置预测处理、碰撞概率累计处理、碰撞判定处理、设备控制处理)，在本车有可能与对象物碰撞的情况下，为了避免碰撞、减轻碰撞损害，向必要的装置(设备)发送控制信号。此外，系统ECU30中的轨迹预测矢量算出处理相当于权利要求书所记载的相对移动矢量算出部，拟合处理相当于权利要求书所记载的分类部，直行时对象物预测处理相当于权利要求书所记载的移动轨迹预测部。另外，立体相机10和系统ECU30中的对地速度检测处理相当于权利要求书所记载的速度获取部。

此外，在系统ECU30中，在由立体相机10至少连续2次检测到相同的物标(对象物)的情况下，预测该对象物的移动轨迹，进行该对象物与本车的碰撞判定。为了预测对象物的移动轨迹，在系统ECU30中，在由立体相机10检测到物标(对象物)的情况下，对每个对象物将预测所需的充分个数的位置信息等保持(记录)在RAM中。另外，在系统ECU30中，在由立体相机10检测到物标(对象物)的情况下，对每个对象物进行处理。另外，在系统ECU30中，在横向(x方向)/距离方向(y方向)的长度单位(例如数10cm单位、数cm单位)的坐标系中进行处理，将从立体相机10得到的图像的水平方向/铅垂方向的像素单位的数据转换为横向/距离方向的长度单位的数据。也可以不进行这样的转换，而在图像的水平方向/铅垂方向的像素单位的坐标系中进行处理。另外，在系统ECU30中，在对象物的距离方向的移动量、速度与本车的距离方向的移动量、速度相比小到能忽视的程度的情况下，也可以在处理对象物的检测位置、速度时只使用检测位置、速度的横向分量。

说明本车轨迹预测处理。在系统ECU30中，根据本车的车速、偏航角速度和转向角的各历史记录来预测本车的将来的移动轨迹。作为该移动轨迹的预测方法，适用以往已知的预测方法。

说明对地速度检测处理。在由立体相机10检测到对象物的情况下，在系统ECU30中，算出该对象物的检测位置的本次值与路上的固定物的位置的差值(以固定物为基准的检测位置的本次值的相对矢量)，并且算出对象物的检测位置的上次值与路上的相同固定物的位置的差值(以固定物为基准的检测位置的上次值的相对矢量)。作为该固定物，例如是在本车周边的图像的边缘处理中得到的亮度梯度大的点(路面上描绘的白线的边界、道路的连接点等)、路侧物(电线杆、交通标识等)。由立体相机10来检测这些固定物。而且，在系统ECU30中，使用检测位置的本次值与路上的固定物的位置的差值(检测位置的本次值的相对矢量)、以及检测位置的上次值与路上的固定物的位置的差值(检测位置的上次值的相对矢量)，算出从检测位置的上次值向检测位置的本次值的移动矢量。该移动矢量的大小是1步的更新时间内的移动量，移动矢量的方向是1步的更新时间内的移动方向。而且，在系统ECU30中，将移动矢量的移动量除以更新时间，算出对象物的对地速度。

说明转向判定处理。在系统ECU30中，算出转向角的预定时间的变化量(转向量)，判定该转向量是否在转向阈值以上。预定时间是根据适合来预先设定的，例如1步的更新时间。转向阈值是用于判定与本车的摇晃、偏转显然不同的本车的转向(本车没有直行行驶的情况)的转向量，是根据适合来预先设定的。在系统ECU30中，在转向量为转向阈值以上的情况(本车没有直行行驶的情况)下，转移至转向时对象物轨迹预测处理；在转向量小于转向阈值的情况(本车直行行驶的情况)下，转移至异常值去除处理。

说明转向时对象物轨迹预测处理。在系统ECU30中，利用以往的预测方法，使用对象物的检测位置的历史记录来预测对象物的将来的移动轨迹。

说明异常值去除处理(滤除处理)。在系统ECU30中，判定对地速度检测处理中是否只有1次检测到对象物的对地速度。在只有1次检测到对地速度的情况下，在系统ECU30中，将该对地速度在以下的处理中使用。在2次以上检测到对地速度的情况下，在系统ECU30中，判定对地速度的本次值与上次值之差的绝对值是否在第1阈值以上。第1阈值是用于判定对象物的对地速度是否从上次值成为了跳跃值的阈值，是根据适合预先设定的。在该判定中为第1阈值以上的情况(对地速度的本次值为跳跃值的情况)下，在系统ECU30中，将对象物的检测位置的本次值与上次值的差值除以更新时间来算出速度，并判定该速度与对地速度的本次值之差的绝对值是否在第2阈值以上。第2阈值是用于判定对象物的对地速度是否是与根据对象物的检测位置的差值求出的速度偏离的值的阈值，是根据适合来预先设定的。在该判定中为第2阈值以上的情况(对地速度的本次值为与根据检测位置的差值得到的速度偏离的值的情况)下，在系统ECU30中，在以下的处理中不将对地速度的本次值用作对地速度。此时，例如将对地速度的上次值用作对地速度。在上述各判定中，在小于第1阈值的情况或者小于第2阈值的情况下，在系统ECU30中，在以下的处理中将对地速度的本次值用作对地速度。此外，第1阈值与第2阈值可以是相同的值，或者也可以是不同的值。

说明轨迹预测矢量算出处理。在系统ECU30中，如图6所示，使用本车的车速Vc和对象物的对地速度Vp(横向分量(x轴分量)：Vpx、距离方向分量(y轴分量)：Vpy)，算出轨迹预测矢量PV的倾斜度θ。在该算出中，使用θ＝arctan(Vpx/(Vc+Vpy))这一算出式。此处，直接算出拟合处理中需要的轨迹预测矢量PV的倾斜度θ，但也可以在求出轨迹预测矢量PV之后算出倾斜度θ。此外，如果与本车的车速Vc相比对象物的距离方向的速度Vpy小到能够忽视的程度，那么也可以将Vpy除外来进行算出。另外，根据需要来转换单位、符号的方向。

说明拟合处理。在该拟合处理中，使用多数决定的方法。此处，如图7和图8所示，说明作为对象物的检测位置的历史记录，对于10点的检测位置D1～D10进行拟合的例子。检测位置D1～D10中检测位置D10为最新的检测位置，检测位置D1为最早的检测位置。如图8所示，对检测位置D1～D10分别设定权重，对最新的检测位置D10设定最大的7作为权重，越早的检测位置权重设定为越小的值。在这个例子中，在检测位置D3与检测位置D4之间，本车偏转，产生了横向位置跳跃。另外，检测位置D6为传感器噪声所导致的离群值(Outlier)。

在系统ECU30中，从保持(记录)在RAM中的检测位置D1～D10中依次选择检测位置Di，对所有的检测位置D1～D10进行以下的相同处理。在系统ECU30中，算出通过检测位置Di的倾斜度θ的直线。然后，在系统ECU30中，以该直线作为中心算出在左右两侧隔开预定间隔的各平行线，设定由该左右平行线构成的决定范围。该预定间隔是在产生了本车的摇晃、偏转所导致的横向位置跳跃的情况下能够将该横向位置跳跃的检测位置除外的间隔，且是能够将立体相机10所得到的对象物检测中的检测位置的噪声值(离群值)除外的间隔。预定间隔是根据适合来预先设定的。而且，在系统ECU30中，从检测位置D1～D10中提取进入决定范围内的检测位置。并且，在系统ECU30中，将提取的检测位置的权重累计，将该累计值作为决定分数。

对所有检测位置D1～D10进行了以上的处理后，在系统ECU30中，比较所有检测位置D1～D10的决定分数，并选择最大决定分数的检测位置的直线。此处，在选择了多个检测位置的直线的情况下，设想所选择的多个直线为大致相同的直线，但作为最终的直线，例如可以是最新的检测位置的直线，也可以是所选择的多个检测位置的直线的平均直线。

图7示出对于检测位置D1的例子，算出通过检测位置D1的倾斜度θ的直线L1及其左右两侧的平行线L2、L3，设定了由该平行线L2和平行线L3构成的决定范围。作为进入该决定范围内的检测位置，提取检测位置D1、检测位置D2、检测位置D3，作为决定分数，算出4分。在这个例子中，作为进入以通过检测位置D10(同样，检测位置D4、检测位置D5、检测位置D7、检测位置D8、检测位置D9)的倾斜度θ的直线为中心的决定范围的检测位置，提取检测位置D4、检测位置D5、检测位置D7、检测位置D8、检测位置D9、检测位置D10，作为决定分数，算出27分，这成为最大的决定分数。所以，例如通过检测位置D10的倾斜度θ的直线被选择为最终的直线。

在该拟合处理中，按照每个检测位置Di，分类为由进入检测位置Di的决定范围的多个检测位置构成的各组。在由于本车的摇晃、偏转而在检测位置的历史记录中产生了横向位置跳跃的情况下，在该各组中几乎不(或者完全不)包含该横向位置跳跃之前的检测位置和之后的检测位置这两者。另外，在没有本车的摇晃、偏转的情况下，在该各组中，除了离群值，包含检测位置的历史记录的所有检测位置的可能性高。决定分数最大的组是与倾斜度θ的直线最匹配(适合)的组，有的情况下多个组成为最匹配的组。

说明直行时对象物轨迹预测处理。在系统ECU30中，将通过在拟合处理中最终选择的检测位置的倾斜度θ的直线预测为对象物的移动轨迹。该移动轨迹相当于根据与倾斜度θ的直线最匹配的组所包含的多个检测位置来预测的轨迹。

说明碰撞位置预测处理。作为本车的碰撞位置，对于本车的各面(前表面、后表面、右侧面、左侧面)以预定间隔隔开为多个区划。该区划分割是根据适合来预先设定的。在预测碰撞位置的情况下，预测对象物会碰撞到车辆的各面的哪个区划。在系统ECU30中，利用本车轨迹预测处理中预测的本车的移动轨迹、和转向时对象物轨迹预测处理或者直行时对象物轨迹预测处理中预测的对象物的移动轨迹，在本车的移动轨迹与对象物的移动轨迹交叉的情况下，预测对象物碰撞到本车的位置(本车的哪个面的哪个区划)。

说明碰撞概率累计处理。在碰撞位置预测处理中预测到本车的碰撞位置的情况下，在系统ECU30中，算出该碰撞预测位置周边的各区划的碰撞概率。例如，以碰撞预测位置为中心以正态分布状算出碰撞概率，或者只在碰撞预测位置算出高的碰撞概率。并且，在系统ECU30中，在碰撞预测位置的每个区划，将算出的碰撞概率与上次累计值相加，将碰撞概率累计。

说明碰撞判定处理。在系统ECU30中，对于本车的各面的各碰撞位置的区间(也可以是在碰撞概率累计处理中更新了累计值的区划)，判定碰撞概率的累计值是否在设定的碰撞判定阈值以上。碰撞判定阈值是用于利用每个碰撞预测位置的碰撞概率的累计值来判定本车是否有可能与对象物碰撞的阈值，是利用基于实验、仿真等的适合来预先设定的。而且，在系统ECU30中，在碰撞概率的累计值为碰撞判定阈值以上的情况下，判定为有可能碰撞(可能性高)；在碰撞概率的累计值小于碰撞判定阈值的情况下，判定为没有可能碰撞(可能性低)。

说明设备控制处理。在碰撞判定处理中判定为有可能碰撞的情况下，在系统ECU30中，算出相对于该对象物的碰撞余量时间TTC[TimeToCollision，碰撞时间]＝(相对距离/相对速度)。然后，在系统ECU30中，基于对于该对象物的TTC、碰撞预测位置和碰撞概率的累计值，判断使警报、转向、安全带、座椅、制动器中的哪个设备(1个以上)工作。然后，在系统ECU30中，对每个工作的设备，基于TTC、碰撞预测位置和碰撞概率的累计值，设定控制量或者输出指令等，向警报装置20、碰撞避免辅助装置21、安全带控制装置22、座椅控制装置23、制动控制装置24中的相应的装置发送控制信号。

参照图1，根据图9的流程图来说明碰撞预测装置1的动作。特别是，根据图10的流程图来说明异常值去除处理，根据图11的流程图来说明拟合处理和直行时对象物轨迹预测处理。图9是示出本实施方式所涉及的碰撞预测装置的动作的流程的流程图。图10是示出图9的流程图中的异常值去除处理的流程的流程图。图11是示出9的流程图中的拟合处理、直行时对象物轨迹预测处理的流程的流程图。在碰撞预测装置1中，每隔一定时间反复进行以下的动作。

在立体相机10中，用左右一对照相机分别拍摄，使用其左右的各图像(立体图像)来进行物体检测处理，在能够检测到对象物(物标)的情况下，获取对象物的位置信息(距离、横向位置)、横向宽度等(S1)。然后，在立体相机10中，将该对象物的有无信息、能够检测到对象物的情况下的由每个对象物的位置信息等构成的立体相机信号发送至系统ECU30。在系统ECU30中，接收该立体相机信号，在存在对象物的情况下，对每个对象物获取位置信息等，将其位置信息等保持(记录)在RAM中。此外，在不存在对象物的情况下，本次的处理结束。

在转向角传感器11中，检测转向角，将转向角信号发送至系统ECU30。在系统ECU30中，接收该转向角信号，获取转向角。在偏航角速度传感器12中，检测偏航角速度，将偏航角速度信号发送至系统ECU30。在系统ECU30中，接收该偏航角速度信号，获取偏航角速度。在各车轮的车轮速度传感器13中，检测车轮的旋转脉冲数，将车轮速度信号发送至系统ECU30。在系统ECU30中，对每个车轮接收车轮速度信号，根据各车轮的旋转脉冲数分别算出车轮速度，根据各轮的车轮速度算出车身速度(本车车速)。

在存在对象物的情况下，在系统ECU30中，根据本车的车速、偏航角速度和转向角的各历史记录来预测本车的移动轨迹(S2)。另外，在系统ECU30中，对每个对象物算出以固定物为基准的对象物的检测位置的本次值的相对矢量、和以相同固定物为基准的检测位置的上次值的相对矢量，根据这2个相对矢量算出从检测位置的上次值向本次值的移动矢量，根据该移动矢量来算出(检测)对象物的对地速度(S3)。

在系统ECU30中判定本车的转向量(转向增加量、转向复原量)是否是转向阈值以上(S4)。在S4中判定为转向量在转向阈值以上的情况(本车转弯中)下，在系统ECU30中，对每个对象物利用以往的轨迹预测方法，根据对象物的检测位置的历史记录来预测对象物的移动轨迹(S5)。

在S4中判定为转向量小于转向阈值的情况(本车直行中)下，在系统ECU30中，对每个对象物进行对于S3中检测的对地速度的异常值去除(滤除)(S6)。具体而言，如图10的流程图所示，在系统ECU30中，判定该对地速度的检测次数是否是1次(S20)。在S20中判定为是1次的情况下，在系统ECU30中，将本次检测的对地速度在以下的处理中用作对地速度(S21)。在S20中判定为2次以上的情况下，在系统ECU30中，判定本次检测的对地速度与对地速度的上次值之差的绝对值是否在第1阈值以上(S22)。在S22中判定为小于第1阈值的情况下，在系统ECU30中，将本次检测的对地速度在以下的处理中用作对地速度(S25)。在S22中判定为第1阈值以上的情况下，在系统ECU30中，判定本次检测的对地速度、与将对象物的检测位置(特别是横向位置)的本次值和上次值之差除以更新时间而求出的速度之差的绝对值是否在第2阈值以上(S23)。在S24中判定为是第2阈值以上的情况下，在系统ECU30中，将对地速度的上次值在以下的处理中用作对地速度(S24)。在S23中判定为小于第2阈值的情况下，在系统ECU30中，将本次检测的对地速度在以下的处理中用作对地速度(S25)。然后，在系统ECU30中，将对象物的本次的检测位置和对地速度作为上次值保持(S26)。

接下来，在系统ECU30中，对每个对象物，使用本车的车速和对象物的对地速度来算出轨迹预测矢量的倾斜度θ(S7)。然后，在系统ECU30中，对每个对象物，对于保持在RAM中的对象物的检测位置的历史记录用倾斜度θ的直线进行拟合(S8)，将最匹配的直线预测为对象物的移动轨迹(S9)。具体而言，如图11的流程图所示，在系统ECU30中，从对象物的检测位置的历史记录中依次选择检测位置Di(S30)。然后，在系统ECU30中，算出以倾斜度θ通过检测位置Di的直线，设定以该直线为中心的决定范围(S31)。并且，在系统ECU30中，从对象物的检测位置的历史记录中提取进入检测位置Di的决定范围的检测位置，将该提取的检测位置的权重累计，算出检测位置Di的决定分数(S32)。在系统ECU30中，判定对于对象物的检测位置的历史记录所包含的所有检测位置的处理是否结束(S33)。在S33中判定为对于所有检测位置的处理没有结束的情况下，在系统ECU30中，返回到S30的处理，选择接下来的检测位置。在S33中判定为对于所有检测位置的处理结束的情况下，在系统ECU30中，比较所有检测位置的决定分数，选择最大决定分数的检测位置的直线(S34)。然后，在系统ECU30中，将通过该选择的检测位置的倾斜度θ的直线预测为对象物的移动轨迹(S35)。

在系统ECU30中，对每个对象物，根据本车的移动轨迹和对象物的移动轨迹来预测与本车碰撞的位置(S10)。然后，在系统ECU30中，对每个对象物，对预测的碰撞位置的相应区划累计碰撞概率(S11)。此外，在本车的移动轨迹与对象物的移动轨迹不交叉的情况下，不预测碰撞位置，也不进行S11的处理。

然后，在系统ECU30中，对每个对象物根据各碰撞预测位置的碰撞概率的累计值是否是碰撞判定阈值以上，判定本车是否有可能与对象物碰撞(S12)。在S12中判定为小于碰撞判定阈值(没有可能碰撞)的情况下，在系统ECU30中结束本次的处理。另一方面，在S12中判定为碰撞判定阈值以上(有可能碰撞)的情况下，在系统ECU30中，对每个对象物，为了避免碰撞/减轻碰撞所导致的损害，基于碰撞余量时间(TTC)、碰撞预测位置和碰撞概率的累计值，判断使警报、转向、安全带、座椅、制动器中的哪个设备工作，设定判断为使其工作的设备的控制量等，向警报装置20、碰撞避免辅助装置21、安全带控制装置22、座椅控制装置23、制动控制装置24中的相应的装置发送控制信号(S13)。在警报装置20中，在从系统ECU30接收到警报控制信号的情况下，基于该警报控制信号来输出警报。在碰撞避免辅助装置21中，在从系统ECU30接收碰撞避免控制信号的情况下，基于该碰撞避免控制信号来进行转向控制。在安全带控制装置22中，在从系统ECU30接收到安全带控制信号的情况下，基于该安全带控制信号来控制安全带的紧固力。在座椅控制装置23中，在从系统ECU30接收到座椅控制信号的情况下，基于该座椅控制信号来控制座椅的位置、姿势。在制动控制装置24中，在从系统ECU30接收到制动控制信号的情况下，基于该制动控制信号来进行制动控制。

根据碰撞预测装置1，通过用基于对象物的对地速度的轨迹预测矢量的倾斜度的直线，对于对象物的相对检测位置的历史记录进行拟合，预测对象物的移动轨迹，从而即使在由于本车的摇晃、偏转而在对象物的检测位置的历史记录中产生了横向位置跳跃的情况下，也能够根据对象物的检测位置的历史记录高精度地预测对象物的移动轨迹。

另外，根据碰撞预测装置1，通过使用纵向边缘强度最强的位置来作为对象物的检测位置，从而能够抑制对象物的检测位置的历史记录的偏差，能以更高精度预测对象物的移动轨迹。特别是，对于如行人那样形状变化的对象物是有效的。另外，根据碰撞预测装置1，对象物的检测位置的历史记录中时间上越靠近当前的位置越增大该位置的权重来进行拟合，从而能以更高精度预测对象物的移动轨迹。另外，根据碰撞预测装置1，在对象物的对地速度为异常值的情况下，由于不将其对地速度用于算出轨迹预测矢量(特别是倾斜度)，所以能够抑制轨迹预测矢量的精度下降，能够抑制移动轨迹的预测精度的下降。

以上，说明了本发明所涉及的实施方式，但本发明不限于上述实施方式，能够以各种形态实施。

例如，在本实施方式中适用于如下装置：预测对象物的移动轨迹，使用对象物的移动轨迹来判定与本车碰撞的可能性，在有可能的情况下进行避免碰撞、减轻碰撞损害的辅助，但也可以适用于使用预测的对象物的移动轨迹来进行其他辅助的其他驾驶辅助装置、或者只进行对象物的移动轨迹的预测的移动轨迹预测装置。另外，在本实施方式中，适用于预先搭载在车辆中的装置，但也可以适用于带入到车辆内的装置。

另外，在本实施方式中，作为检测本车周边的对象物的外界传感器适用了立体相机，但也可以是基于单眼相机的图像传感器(能用单眼来检测对象物的距离、横向位置)、激光雷达、毫米波雷达等雷达传感器等其他外界传感器。另外，对于作为外界传感器的立体相机，作为设备的工作条件，也可以与雷达传感器等融合。

另外，在本实施方式中的构成是：为了获取对象物的对地速度而使用作为外界传感器的立体相机来从本车进行检测，但构成也可以是：使用雷达传感器等其他外界传感器来从本车进行检测，构成也可以是：使用对象物所保持的设备(移动电话、智能电话等)来进行检测并由对象物之间的通信来进行接收(例如在对象物是行人的情况下，用路车间通信来接收行人所携带的设备所检测到的速度)，构成还可以是：由路侧的基础设施(定点照相机、雷达等)进行检测并在与路侧的基础设施之间由路车间通信来进行接收。此外，用于检测对象物的构成和用于获取对象物的对地速度的构成也可以不是同一传感器、不是同一ECU，关于其构成没有限定。

另外，在本实施方式中，作为在有可能碰撞的情况下工作的设备，示出了警报、转向、安全带、座椅、制动器的各设备，但只要有这其中的一个以上的设备即可。或者，也可以是其他设备(执行器)。

另外，在本实施方式中，示出了使用对象物的移动轨迹和本车的移动轨迹进行的碰撞位置预测、使用各碰撞预测位置的碰撞概率的累计进行的碰撞判定的一个例子，但对于这些与碰撞相关的处理可以适用以往的公知技术。

另外，在本实施方式中的构成是：设定了以通过检测位置的倾斜度θ的直线为中心的决定范围，利用由进入决定范围的检测位置所得到的决定分数的多数决定来进行拟合，但也可以用最小二乘法等其他方法进行拟合。在设想为对象物的检测位置的检测精度良好且检测位置没有离群值的情况下，在拟合时也可以不进行对于离群值的处理。

另外，在本实施方式中的构成是：对于对象物的检测位置分别设定权重来进行拟合，但也可以不设定权重来进行拟合。

另外，在本实施方式中的构成是：作为对象物的检测位置使用纵向边缘强度最强的位置，但构成也可以是：不使用纵向边缘强度，而使用检测到的对象物的检测范围的中心位置等其他位置。特别是，在对象物是车辆等的情况下，由于在移动中形状不会特别变化，所以也可以不使用纵向边缘强度。另外，作为使用了纵向边缘强度的其他方法，例如在纵向边缘强度超过基准阈值的情况下用作对象物的检测位置的方法；纵向边缘强度越大，进行越大的加权，从而使得易于利用为对象物的检测位置的方法。

另外，在本实施方式中的构成是：去除对地速度的异常值，但在设想为对地速度的检测精度良好且对地速度没有异常值的情况下，也可以不去除异常值。

工业上的实用性

本发明可以利用于搭载在车辆中，并根据车辆周边的对象物的检测位置的历史记录来预测对象物的移动轨迹的移动轨迹预测。

Claims (6)

1.一种移动轨迹预测装置，预测车辆周边的对象物的移动轨迹，其特征在于，包括：

对象物检测部，其获取车辆周边的对象物的位置；

速度获取部，其获取所述对象物的对地速度；

相对移动矢量算出部，其使用所述车辆的速度信息、和所述速度获取部所获取的所述对象物的对地速度，算出所述对象物的对于所述车辆的相对移动矢量；

分类部，其记录所述对象物检测部所获取的所述对象物的移动轨迹中的位置，基于由所述相对移动矢量算出部算出的相对移动矢量将记录的该位置分类为多个组；及

移动轨迹预测部，其基于所述分类部所分类的组中的至少1个组所包含的所述对象物的多个位置，预测该对象物的移动轨迹。

2.如权利要求1所述的移动轨迹预测装置，其特征在于，

所述对象物检测部利用对照相机所拍摄的图像的边缘处理来进行所述对象物的检测，

所述分类部在所记录的所述对象物的位置的分类中，在越是所述图像的纵向边缘强度强的位置的情况下，越促进利用该位置作为所述对象物的位置。

3.如权利要求1或2所述的移动轨迹预测装置，其特征在于，

在所述车辆的转向量为预定量以上的情况下，所述分类部不进行分类。

4.如权利要求1～3的任一项所述的移动轨迹预测装置，其特征在于，

所述分类部在越是所记录的对象物的位置中的时间上接近当前的位置的情况下，越增大该位置的权重来进行分类。

5.如权利要求1～4的任一项所述的移动轨迹预测装置，其特征在于，

所述相对移动矢量算出部在相对移动矢量的算出中不使用如下的所述对象物的对地速度：所述对象物的对地速度与对地速度的上次值之差为第1阈值以上，且与根据所述对象物的位置的差值求出的速度之差为第2阈值以上。

6.一种移动轨迹预测方法，预测车辆周边的对象物的移动轨迹，其特征在于，包括：

对象物检测步骤，获取车辆周边的对象物的位置；

速度获取步骤，获取所述对象物的对地速度；

相对移动矢量算出步骤，使用所述车辆的速度信息、和所述速度获取步骤中获取的所述对象物的对地速度，算出所述对象物的对于所述车辆的相对移动矢量；

分类步骤，记录所述对象物检测步骤中获取的所述对象物的移动轨迹中的位置，基于在所述相对移动矢量算出步骤中算出的相对移动矢量将记录的该位置分类为多个组；及

移动轨迹预测步骤，基于所述分类步骤中分类的组中的至少1个组所包含的所述对象物的多个位置，预测该对象物的移动轨迹。