JP3065821B2 - Object detection device - Google Patents
Object detection deviceInfo
- Publication number
- JP3065821B2 JP3065821B2 JP4294471A JP29447192A JP3065821B2 JP 3065821 B2 JP3065821 B2 JP 3065821B2 JP 4294471 A JP4294471 A JP 4294471A JP 29447192 A JP29447192 A JP 29447192A JP 3065821 B2 JP3065821 B2 JP 3065821B2
- Authority
- JP
- Japan
- Prior art keywords
- storage
- detected
- stored
- determined
- detection
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Landscapes
- Radar Systems Or Details Thereof (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Traffic Control Systems (AREA)
Description
【0001】[0001]
【産業上の利用分野】本発明は物体検出装置に係り、よ
り詳しくは、走行している車両等の移動物体を検出する
物体検出装置に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to an object detecting device, and more particularly, to an object detecting device for detecting a moving object such as a running vehicle.
【0002】[0002]
【従来の技術】従来より、レーダ類を用いて先行車を認
識し、追従走行する装置が知られている。これらの装置
での先行車認識においては、センサの不確実性による一
時的な先行車の検出ミスやノイズの混入による先行車の
誤認等が問題となっている。2. Description of the Related Art Conventionally, there has been known an apparatus which recognizes a preceding vehicle using radars and travels following the preceding vehicle. In recognition of the preceding vehicle by these devices, there are problems such as a temporary detection error of the preceding vehicle due to uncertainty of the sensor, and a false recognition of the preceding vehicle due to mixing of noise.
【0003】特開平2−36500号公報、特開平1−
213593号公報、特開昭61−20877号公報、
特開昭61−145474号公報、特開昭61−278
775号公報、特開昭62−36581号公報、特開平
2−40800号公報には先行車を認識する技術が開示
されているが、これらの技術では、先行車の見失いに対
する対策は行われていない。[0003] JP-A-2-36500, JP-A-1-36500
No. 213593, JP-A-61-20877,
JP-A-61-145474, JP-A-61-278
Japanese Patent Application Laid-Open No. 775, Japanese Patent Application Laid-Open No. 62-36581 and Japanese Patent Application Laid-Open No. 2-40800 disclose techniques for recognizing a preceding vehicle. However, in these techniques, measures are taken to prevent the preceding vehicle from being lost. Absent.
【0004】また、特開平1−114550号公報にお
いては、先行車をカーブの出入口等で見失った場合、一
定時間w1だけ自車の制御車速を保持することで見失い
対策としている。これに類するものとして、一定時間先
行車データを保持する方式や一定時間車間距離を保持す
る方式が考えられるが、次のような問題がある。In Japanese Patent Application Laid-Open No. 1-114550, when a preceding vehicle is lost at an entrance or exit of a curve or the like, a countermeasure is taken to maintain the control vehicle speed of the own vehicle for a fixed time w1. As a similar method, a method of holding the preceding vehicle data for a certain time or a method of holding the inter-vehicle distance for a certain time can be considered, but has the following problems.
【0005】先行車の長い見失い(数秒程度)に対応す
るため、上記保持時間を長めに設定すると、ノイズ等で
先行車を誤認した場合にこの保持時間だけ制御が遅れ
る。ノイズの原因としては、先行車以外の障害物を先行
車と誤認した場合やセンサ系への雑音の混入等がある。[0005] In order to cope with a long loss of the preceding vehicle (about several seconds), if the holding time is set to be longer, control is delayed by the holding time when the preceding vehicle is erroneously recognized due to noise or the like. Causes of the noise include a case where an obstacle other than the preceding vehicle is erroneously recognized as the preceding vehicle, noise mixing into the sensor system, and the like.
【0006】上記とは逆に保持する時間を短くすると、
長い見失いに対応できない。長い見失いの原因として
は、カーブの出入口、坂道の上下、雨天等の悪環境、レ
ーダの不調等での運転がある。[0006] Conversely, if the holding time is shortened,
Can't cope with a long loss. Causes of long sight loss include driving in and out of curves, up and down hills, bad environment such as rainy weather, radar malfunction, and the like.
【0007】また、特開昭61−272673号公報に
おいては、複数回の観測結果をメモリに積算すること
で、レーダ信号のS/N比を上げようとする技術が開示
されている。しかしながら、レーダ装置の機構によって
は、車のノーズがバウンドした時や、坂道の変曲点を跨
いだ時等、先行車がレーダの測定範囲外に一時的に出る
ことがあり得る。この場合にはレーダ信号自体が得られ
ないので、この方式でS/N比を上げても見失いは解決
できない。Japanese Patent Application Laid-Open No. 61-272673 discloses a technique for increasing the S / N ratio of a radar signal by accumulating a plurality of observation results in a memory. However, depending on the mechanism of the radar device, the preceding vehicle may temporarily go out of the radar measurement range when the nose of the vehicle bounces or crosses an inflection point on a slope. In this case, since the radar signal itself cannot be obtained, even if the S / N ratio is increased by this method, the loss cannot be solved.
【0008】[0008]
【発明が解決しようとする課題】本発明は上記問題点を
解決すべく成されたもので、先行車や他レーンを走行し
ている車等の移動している物体に対しては見失い時の保
持時間を長く、雑音等を先行車と誤認した場合はその誤
認の影響が少なくなるようにすると共に、検出物体が、
レーザ等の測定域から一時的にはずれた場合の見失いに
も対応できる物体検出装置を提供することを目的とす
る。SUMMARY OF THE INVENTION The present invention has been made in order to solve the above-mentioned problems, and is intended to solve the problem when a moving object such as a preceding vehicle or a vehicle running on another lane is lost. The holding time is long, and when noise or the like is mistaken for the preceding vehicle, the influence of the misidentification is reduced, and the detected object is
It is an object of the present invention to provide an object detection device capable of coping with a loss when the light beam temporarily deviates from a measurement area such as a laser.
【0009】[0009]
【課題を解決するための手段】上記目的を達成するため
に本発明は、物体の現在位置を検出する物体検出手段
と、物体検出手段で検出された検出物体の過去の位置を
記憶する記憶手段と、検出物体の現在位置と記憶手段に
記憶されている記憶物体の位置とに基づいて現在位置が
検出された検出物体と記憶手段に位置が記憶されている
記憶物体とが対応しているか否かを判断する判断手段
と、前記判断手段によって検出物体と記憶物体とが対応
していると判断されたときには前回の値より大きくな
り、検出物体と記憶物体とが対応していないと判断され
たときには前回の値より小さくなる確信度を演算する演
算手段と、確信度が所定値以上の記憶物体に対する記憶
内容を検出された現在位置に基づいて変更すると共に確
信度が所定値未満の記憶物体に対する記憶内容を消去
し、かつ判断手段によって記憶物体と対応していないと
判断された検出物体に対する位置を記憶させる記憶内容
変更手段と、を含んで構成されている。To achieve the above object, the present invention provides an object detecting means for detecting a current position of an object, and a storing means for storing a past position of the detected object detected by the object detecting means. And whether the detected object whose current position is detected based on the current position of the detected object and the position of the storage object stored in the storage means corresponds to the storage object whose position is stored in the storage means Determining means for determining whether the detected object and the stored object correspond to each other.
If it is determined that the
Detected object and the memory object do not correspond
Calculating means for calculating a certainty factor that is smaller than the previous value, and changing the storage content of the storage object having the certainty factor equal to or greater than the predetermined value based on the detected current position and storing the memory object having the certainty factor less than the predetermined value. And a storage content changing means for erasing the storage content of the detected object and storing the position with respect to the detected object determined not to correspond to the storage object by the determination means.
【0010】[0010]
【作用】本発明の物体検出手段は、走行車両等の移動し
ている物体や停止車両等の停止している物体の現在位置
を検出し、記憶手段は、物体検出手段で検出された検出
物体の過去の位置を記憶する。判断手段は、物体の現在
位置と記憶手段に記憶されている記憶物体の位置とに基
づいて現在位置が検出された検出物体と記憶手段に位置
が記憶されている記憶物体とが対応しているか否かを判
断する。例えば、記憶されている過去の位置を含む所定
範囲内の領域に現在位置が検出された検出物体が存在し
ていれば、現在位置が検出された検出物体と記憶手段に
位置が記憶されている記憶物体とが対応していると判断
することができる。演算手段は、判断手段の判断結果に
基づいて、記憶物体が存在している度合いを表す確信度
を演算する。このとき、判断手段で検出物体と対応して
いると判断された記憶物体については確信度が大きくな
るように演算され、判断手段で検出物体と対応していな
いと判断された記憶物体については確信度が小さくなる
ように演算される。The object detecting means of the present invention detects the current position of a moving object such as a traveling vehicle or a stopped object such as a stopped vehicle, and the storage means stores the detected object detected by the object detecting means. Of the past is stored. The determination means determines whether the detected object whose current position is detected based on the current position of the object and the position of the storage object stored in the storage means corresponds to the storage object whose position is stored in the storage means Determine whether or not. For example, if the detected object whose current position is detected exists in an area within a predetermined range including the stored past position, the detected object whose current position is detected and the position are stored in the storage unit. It can be determined that the storage object corresponds. The calculating means calculates a certainty factor indicating the degree of existence of the storage object based on the determination result of the determining means. At this time, calculation is performed so that the certainty factor is increased for the storage object determined to correspond to the detected object by the determination means, and the reliability is determined for the storage object determined to not correspond to the detected object by the determination means. The calculation is performed so that the degree becomes small.
【0011】そして、記憶内容変更手段は、確信度が所
定値以上の記憶物体に対する記憶内容を検出された現在
位置に基づいて変更する。これによって、確信度が所定
値以上の記憶物体、すなわち見失いがなかった物体や見
失いが所定時間以内であった物体に対しては記憶手段の
記憶内容が最新の内容に変更されるので、短い見失いに
対処することができる。また、記憶内容変更手段は、確
信度が所定値未満の記憶物体に対する記憶内容を消去す
る。これによって、確信度が所定値未満の物体、すなわ
ち見失いが所定時間を越える物体に対しては記憶手段の
記憶内容が消去される。さらに、記憶内容変更手段は、
検出手段によって検出されたが、判断手段の記憶物体と
対応していないと判断された検出物体に対する位置を記
憶手段に記憶させる。これによって、長い見失い後に見
失った物体を再検出した場合等に対処することができ
る。The storage content changing means changes the storage content of the storage object having the certainty factor equal to or higher than the predetermined value based on the detected current position. As a result, the stored content of the storage means is changed to the latest content for a stored object having a certainty factor equal to or higher than a predetermined value, that is, an object that has not been lost or has been lost within a predetermined time, so that a short lost Can be dealt with. Further, the storage content changing means deletes the storage content of the storage object having the certainty factor less than the predetermined value. As a result, for an object whose certainty factor is less than the predetermined value, that is, for an object whose misplacement exceeds a predetermined time, the storage content of the storage unit is deleted. Further, the storage content changing means includes:
The position with respect to the detected object, which is detected by the detection means but is determined not to correspond to the storage object of the determination means, is stored in the storage means. This makes it possible to cope with a case where a lost object is detected again after a long loss.
【0012】[0012]
【実施例】以下本発明の実施例を説明する。まず、本実
施例を機能ブロックで表すと図1のようになる。図に示
すように、本実施例は、移動している物体の現在位置を
検出する物体検出手段10と、物体検出手段10で検出
された検出物体の過去の位置を記憶する記憶手段12と
を備えている。物体検出手段10と記憶手段12とは、
検出物体の現在位置と記憶手段12に記憶されている記
憶物体の過去の位置とに基づいて現在位置が検出された
検出物体と記憶手段12に位置が記憶されている記憶物
体とが対応しているか否かを判断する判断手段14に接
続されている。判断手段14は、判断手段14の判断結
果に基づいて、記憶物体が存在している度合いを表す確
信度を演算する演算手段16に接続されている。演算手
段16は、確信度が所定値以上の記憶物体に対する記憶
内容を検出された現在位置に基づいて変更すると共に、
確信度が所定値未満の記憶物体に対する記憶内容を消去
し、かつ判断手段14によって記憶物体と対応していな
いと判断された検出物体に対する位置を記憶させる記憶
内容変更手段18に接続されている。Embodiments of the present invention will be described below. First, this embodiment is represented by functional blocks as shown in FIG. As shown in the figure, the present embodiment includes an object detection unit 10 for detecting the current position of a moving object, and a storage unit 12 for storing a past position of the detected object detected by the object detection unit 10. Have. The object detection means 10 and the storage means 12
The detected object whose current position is detected based on the current position of the detected object and the past position of the storage object stored in the storage unit 12 corresponds to the storage object whose position is stored in the storage unit 12. It is connected to the judging means 14 for judging whether or not there is. The judging means 14 is connected to a calculating means 16 for calculating a certainty factor indicating the degree of existence of the storage object based on the judgment result of the judging means 14. The calculating means 16 changes the storage content of the storage object having the certainty factor equal to or more than the predetermined value based on the detected current position,
It is connected to storage content changing means 18 for erasing the storage content of the storage object having a certainty factor less than a predetermined value and storing the position of the detected object determined by the determination means 14 not to correspond to the storage object.
【0013】物体位置検出手段10は、移動している物
体の位置を検出できるセンサであって、複数の物体を区
別できるセンサ、例えば、スキャン型レーザ、画像式等
の2次元の座標が得られるセンサ、マイクロ波等を用い
て1次元の座標が得られるセンサ等を用いることができ
る。他に、位置と同時に相対速度が得られるセンサでも
良く、これらのセンサを選択することにより選択したセ
ンサの性能に応じた効果が期待できる。以下では、2次
元の座標が求められるセンサを用いて説明する。The object position detecting means 10 is a sensor capable of detecting the position of a moving object, and is capable of distinguishing a plurality of objects, for example, two-dimensional coordinates such as a scanning laser and an image type. A sensor or a sensor that can obtain one-dimensional coordinates using a microwave or the like can be used. Alternatively, sensors that can obtain relative speed at the same time as the position may be used. By selecting these sensors, an effect corresponding to the performance of the selected sensor can be expected. Hereinafter, a description will be given using a sensor that can obtain two-dimensional coordinates.
【0014】物体情報記憶手段12は、例えばRAMを
用い、検出物体(先行車)の位置(センサに応じた2次
元情報)、確信度、その他の情報(例えば、速度等)
を、例えば各検出物体毎にまとめて記憶物体として記憶
する。The object information storage means 12 uses, for example, a RAM, and detects the position of the detected object (preceding vehicle) (two-dimensional information corresponding to the sensor), certainty factor, and other information (for example, speed).
Are collectively stored for each detected object as a storage object, for example.
【0015】記憶方法は下記の例1のように記憶物体毎
に情報をまとめて記憶しても良いし、例2のように各情
報を配列の形で記憶しても良い。一般的な追従走行時に
は検出すべき物体、すなわち先行車の数は5台程度なの
で、記憶領域は余裕を見て10〜20台分程度記憶可能
な領域を確保すれば十分である。As a storage method, information may be collectively stored for each storage object as in Example 1 below, or each information may be stored in an array form as in Example 2. Since the number of objects to be detected, that is, the number of preceding vehicles, is about five at the time of general follow-up traveling, it is sufficient to secure an area capable of storing about 10 to 20 vehicles with a margin.
【0016】記憶方法の例1 記憶物体1:前回計測時のx座標 前回計測時のy座標 前回計測時の確信度 前回計測時のx方向速度 前回計測時のy方向速度 記憶物体2:前回計測時のx座標 前回計測時のy座標 前回計測時の確信度 前回計測時のx方向速度 前回計測時のy方向速度 ・ ・ ・ 記憶方法の例2 記憶物体1のx座標 記憶物体2のx座標 記憶物体1のy座標 記憶物体2のy座標 記憶物体1の確信度 記憶物体2の確信度 ・ ・ ・ 判断手段14は、例えば、次のようにして検出物体(例
えば、車)と情報が記憶されている記憶物体(例えば、
車)とが対応しているか否かを判断する。まず、記憶手
段12に図2のような記憶物体1〜3の位置が記憶され
ていたと仮定する。扇型20はセンサの計測範囲であ
り、扇型の角である左端に自車が存在している。そし
て、次の測定で図3のような位置に検出物体1〜3が検
出されたと仮定する。検出物体1〜3と記憶物体1〜3
とが対応しているか否か判断するときには、図4のよう
に各記憶物体毎に対応付けを行う範囲1〜3を定める。
これらの範囲1〜3内で、記憶物体に最も近い検出物体
をこの範囲内に存在する記憶物体に対応づける。この例
では、範囲1内に記憶物体1と検出物体1とが存在して
いるため記憶物体1と検出物体1とが対応し、範囲2内
に記憶物体2と検出物体2とが存在しているため記憶物
体2と検出物体2とが対応し、範囲3内には検出物体が
存在していないため記憶物体3に対応する検出物体は存
在しない、すなわち検出物体3に対応する記憶物体は存
在しないことになる。なお、この対応する記憶物体が存
在しない検出物体に対しては記憶手段に記憶領域が設け
られることになる。Example 1 of storage method Storage object 1: x coordinate at previous measurement y coordinate at previous measurement Confidence at previous measurement x speed at previous measurement y direction speed at previous measurement Storage object 2: previous measurement X-coordinate at the time y-coordinate at the previous measurement y-coordinate at the previous measurement x-speed at the previous measurement y-direction speed at the last measurement ・ ・ ・ Example 2 of storage method x-coordinate of storage object 1 x-coordinate of storage object 2 The y-coordinate of the storage object 1 The y-coordinate of the storage object 2 The certainty of the storage object 1 The certainty of the storage object 2 The determination unit 14 stores the detected object (for example, a car) and information as follows. Memory objects (for example,
) Is determined. First, it is assumed that the positions of the storage objects 1 to 3 as shown in FIG. The fan shape 20 is the measurement range of the sensor, and the vehicle is located at the left end, which is the corner of the fan shape. Then, it is assumed that the detected objects 1 to 3 are detected at the positions shown in FIG. 3 in the next measurement. Detected objects 1-3 and memory objects 1-3
When it is determined whether or not they correspond to each other, ranges 1 to 3 to be associated with each storage object are determined as shown in FIG.
In these ranges 1 to 3, the detected object closest to the storage object is associated with the storage object existing in this range. In this example, since the storage object 1 and the detection object 1 exist in the range 1, the storage object 1 and the detection object 1 correspond to each other, and the storage object 2 and the detection object 2 exist in the range 2. Therefore, the storage object 2 and the detection object 2 correspond to each other, and no detection object exists in the range 3 so that no detection object corresponding to the storage object 3 exists. That is, the storage object corresponding to the detection object 3 exists. Will not do. It should be noted that a storage area is provided in the storage means for a detected object having no corresponding storage object.
【0017】対応付けを行う範囲は、1回の計測周期内
で物体が相対的に移動する可能性のある距離、得られる
計測結果に含まれる誤差の大きさ及び存在の確信度等を
考慮して決定する。もちろん、他の要素を考慮すること
も可能であるし、対応付けを行う範囲を恣意的に定める
こともできる。対応付けを行う範囲の形状も実際に行う
方法に応じて選べば良い。The range to be associated is determined in consideration of the distance that the object may relatively move within one measurement cycle, the magnitude of an error included in the obtained measurement result, the certainty of existence, and the like. To decide. Of course, other factors can be considered, and the range to be associated can be arbitrarily determined. The shape of the range to be associated may be selected according to the method of actually performing the association.
【0018】また、物体検出手段10で相対速度の計算
を行う場合には、今回の計測で得られる位置を予測し、
予測した位置と検出した位置との差を求め、この差に応
じて相対速度を補正することで、信頼性を上げることが
可能である。さらに、相対速度が得られるセンサを使用
すれば、位置の他に相対速度を用いて検出物体と記憶物
体とが対応しているか否かを判断することが可能であ
る。また、今回の計測で得られる位置を、相対速度と計
算した相対加速度とから予測することもできる。When the relative speed is calculated by the object detecting means 10 , the position obtained by the current measurement is predicted,
By obtaining the difference between the predicted position and the detected position and correcting the relative speed according to the difference, it is possible to increase the reliability. Furthermore, if a sensor capable of obtaining a relative speed is used, it is possible to determine whether or not the detected object corresponds to the stored object using the relative speed in addition to the position. Further, the position obtained by the current measurement can be predicted from the relative speed and the calculated relative acceleration.
【0019】物体の存在の確信度を演算する演算手段1
6では、判断手段14で判断された対応結果に基づいて
記憶物体が存在している度合いを表す確信度を演算す
る。具体的には、以下のようにして確信度を増減する。Calculation means 1 for calculating the certainty of the existence of an object
In step 6, based on the correspondence result determined by the determination means 14, a certainty factor indicating the degree of existence of the storage object is calculated. Specifically, the degree of certainty is increased or decreased as follows.
【0020】すなわち、検出物体と対応している記憶物
体に対しては、記憶情報中の確信度の値を増加する。一
方、検出物体と対応していない記憶物体に対しては、記
憶情報中の確信度の値を減少させる。なお、「確信度」
の代わりに、例えば確信度の増減を逆転させた「不確か
さ」を用いることも可能である。That is, for the stored object corresponding to the detected object, the value of the certainty factor in the stored information is increased. On the other hand, for a storage object that does not correspond to the detected object, the value of the certainty factor in the stored information is reduced. In addition, "confidence"
Instead of, for example, it is also possible to use “uncertainty” in which the increase / decrease of the certainty factor is reversed.
【0021】確信度の値を増減する方法としては、例え
ば、センサが物体を検出する確率を実験的に求め、この
確率を利用する方法(方法1)、対応させる見失い時間
や期間を設定し、設定された見失い時間や期間から確信
度の増減量を求める方法(方法2)等がある。As a method of increasing or decreasing the value of the certainty factor, for example, a probability that the sensor detects an object is experimentally obtained, a method using this probability (method 1), a missing time and a period to be associated are set, There is a method (method 2) for obtaining the increase / decrease amount of the certainty factor from the set missing time or period.
【0022】方法1における確信度P(k+1)は次の
計算式(1)、(2)によって増減することができる。The certainty factor P (k + 1) in the method 1 can be increased or decreased by the following equations (1) and (2).
【0023】記憶物体に対応する検出物体が存在する場
合 P(k+1)=P(k)+(1−P(k))・α ・・・(1) 記憶物体に対応する検出物体が存在しない場合 P(k+1)=P(k)−P(k)・(1−α) =P(k)・α ・・・(2) ただし、P(k)は時刻kにおいてある地点に記憶物体
が存在するときの確信度、α(0<<α<1)はその地
点でセンサが物体を検出する確率、P(k+1)は時刻
k+1においてその地点に記憶物体が存在するときの確
信度である。When there is a detected object corresponding to the stored object P (k + 1) = P (k) + (1−P (k)) · α (1) There is no detected object corresponding to the stored object Case P (k + 1) = P (k) −P (k) · (1−α) = P (k) · α (2) where P (k) is a memory object at a certain point at time k. Α (0 << α <1) is the probability that the sensor will detect an object at that point, and P (k + 1) is the degree of certainty when a stored object exists at that point at time k + 1. .
【0024】方法1の確信度について具体例で説明す
る。図5に示すように各範囲毎に確率αが設定されてい
るものとする(ここでは、距離で区切った範囲毎に確率
αを設定しているが、センサの検知特性に応じて区切っ
た範囲毎に確率αを設定したり、確率αを位置の関数と
して表現すること等も可能である)。また、各記憶物体
1〜3の時刻kでの確信度P1(k)、P2(k)、P
3(k)をそれぞれ、 記憶物体1:確信度P1(k)=0.95 記憶物体2:確信度P2(k)=0.80 記憶物体3:確信度P3(k)=0.60 とし、記憶物体の記憶内容を削除する確信度の閾値をθ
=0.5とすると、上記で説明した図4の対応結果よ
り、時刻k+1での確信度P1(k+1)、P2(k+
1)、P3(k+1)は次のように更新される。The certainty factor of the method 1 will be described with a specific example. It is assumed that the probability α is set for each range as shown in FIG. 5 (here, the probability α is set for each range divided by distance, but the range α is set according to the detection characteristics of the sensor. It is also possible to set the probability α for each time, to express the probability α as a function of the position, etc.). Also, certainty factors P1 (k), P2 (k), P
3 (k) are respectively stored object 1: certainty P1 (k) = 0.95 storage object 2: certainty P2 (k) = 0.80 storage object 3: certainty P3 (k) = 0.60 , The threshold value of the certainty factor for deleting the storage content of the storage object is θ
= 0.5, the confidence levels P1 (k + 1), P2 (k +
1), P3 (k + 1) is updated as follows.
【0025】 記憶物体1:確信度P1(k+1)=P1(k)+(1
−P1(k))・α1=0.95+(1−0.95)・
0.95=0.9975 記憶物体2:確信度P2(k+1)=P2(k)+(1
−P1(k))・α2=0.80+(1−0.80)・
0.90=0.98 記憶物体3:確信度P3(k+1)=P3(k)・α3
=0.60・0.80=0.48 方法2における確信度P(k+1)は、見失い期間とし
て、例えば、確信度1の物体は少なくともn回までの見
失いの間は存在しているものとして扱いたい、という要
求がある場合には、上記(1)、(2)式のαをn √
(1−θ)として求めることができる。ここで、θは記
憶物体を削除する基準となる確信度の閾値である。Storage object 1: confidence factor P1 (k + 1) = P1 (k) + (1
−P1 (k)) · α1 = 0.95 + (1−0.95) ·
0.95 = 0.9975 Storage object 2: certainty factor P2 (k + 1) = P2 (k) + (1
−P1 (k)) · α2 = 0.80 + (1−0.80) ·
0.90 = 0.98 Memory object 3: Confidence P3 (k + 1) = P3 (k) · α3
= 0.60 · 0.80 = 0.48 The degree of certainty P (k + 1) in the method 2 is defined as a blind period, for example, assuming that an object having a certainty of 1 exists at least during n times of missing. If there is a request to handle, α in the above equations (1) and (2) is replaced by n √
(1−θ). Here, θ is a threshold of certainty as a reference for deleting the storage object.
【0026】なお、この場合は、検出結果に確率的な意
味は無いので、以下に示す式(3)、(4)において単
にα=(1−θ)/n(≒n √(1−θ))とした簡略
化した計算でも、期待した効果が得られる。In this case, since the detection result has no probabilistic meaning, in the following equations (3) and (4), simply α = (1−θ) / n ( n n √ (1−θ) The expected effect can be obtained even with the simplified calculation of)).
【0027】記憶物体に対応する検出物体があった場合 P(k+1)=P(k)+α ・・・(3) 記憶物体に対応する検出物体が無かった場合 P(k+1)=P(k)−α ・・・(4) 記憶内容変更手段18では、次の処理を行う。まず、記
憶物体の存在の確信度を演算する演算手段16で確信度
を変更した結果、確信度が閾値より小さくなった記憶物
体に対しては記憶手段12に記憶されている記憶内容を
消去する。例えば、上記の具体例では、記憶物体3の確
信度P3(k+1)=0.48となり、閾値θ=0.5
以下になるため、記憶物体3についての記憶内容を消去
する。When there is a detected object corresponding to the stored object P (k + 1) = P (k) + α (3) When there is no detected object corresponding to the stored object P (k + 1) = P (k) -Α (4) The storage content changing means 18 performs the following processing. First, as a result of changing the certainty by the calculating means 16 for calculating the certainty of the existence of the storage object, the storage contents stored in the storage means 12 are erased for the storage object whose certainty is smaller than the threshold. . For example, in the above specific example, the certainty factor P3 (k + 1) = 0.48 of the storage object 3 and the threshold value θ = 0.5
Because of the following, the storage contents of the storage object 3 are deleted.
【0028】次に、確信度が閾値以上の記憶物体に対し
ては、記憶物体の位置座標、相対速度等の記憶内容を更
新する。最後に、記憶物体と対応が取れなかった検出物
体に対しては、新たな記憶物体の情報を記憶するエリア
を記憶手段12中に作成し、このエリアに確信度の初期
値、位置座標、相対速度等の初期値を記憶する。Next, for a storage object having a certainty factor equal to or higher than the threshold, the storage contents such as the position coordinates and the relative speed of the storage object are updated. Lastly, for a detected object that does not correspond to a storage object, an area for storing information of a new storage object is created in the storage unit 12, and an initial value of the certainty factor, position coordinates, relative The initial values such as the speed are stored.
【0029】次に、本実施例の作用について説明する。
図6は実際に物体が存在する状況下で、物体の見失いが
起きた場合の確信度の変化の様子を示す。物体を正しく
認識する確率は、見失いの確率よりはるかに大きいた
め、長い観測の間に確信度は1に近い値を取るようにな
る。その状態で見失いが起こり物体が検出できなくなっ
た場合は、確信度は低下するが、物体を正しく認識する
確率は、見失いの確率よりはるかに大きいため、閾値以
下になる以前に物体を再度検出し、確信度は再び上昇す
る。一方、図7に示すようにノイズによって物体を誤認
した場合には、誤認する期間は一時的であるので、確信
度はそれほど大きくならず、確信度は速やかに閾値以下
になるため、記憶手段12から記憶内容が速やかに消去
される。Next, the operation of this embodiment will be described.
FIG. 6 shows how the certainty factor changes when an object is lost in a situation where an object actually exists. The probability of correctly recognizing an object is much greater than the probability of missing, so that the confidence will take a value close to 1 during long observations. If the object is lost and the object cannot be detected in this state, the confidence decreases, but the probability of correctly recognizing the object is much larger than the probability of missing, and the object is detected again before the threshold is reduced. , Confidence increases again. On the other hand, when an object is erroneously recognized due to noise as shown in FIG. 7, since the period of erroneous recognition is temporary, the certainty does not increase so much, and the certainty quickly falls below the threshold. Immediately erases the stored content.
【0030】このように、何度も観測されている車は、
ある程度の時間(回数)見失っても、その存在が判断で
き、また、ノイズ等による誤認に対しては、その誤認時
間は短くなる。さらに、図6で既に示したように見失い
が起こった場合は確信度が大きく変動し、正しく検出さ
れている場合は確信度は略1になり一定の値をもつた
め、確信度の変動の様子から、センサ系が物体を検出で
きている割合が確認できる。Thus, a car that has been observed many times is
Even if a certain amount of time (the number of times) is lost, its existence can be determined, and the erroneous recognition time becomes shorter for erroneous recognition due to noise or the like. Further, as already shown in FIG. 6, the degree of certainty fluctuates greatly when a loss of sight occurs, and when correctly detected, the certainty level becomes approximately 1 and has a constant value. From this, the rate at which the sensor system can detect the object can be confirmed.
【0031】以下本発明の実施例を実現する具体例につ
いて図面に従って説明する。図8は、本実施例の物体検
出装置をコンピュータを用いて実現した車両検出装置を
示すブロック図である。図8に示すように、車両検出装
置は、自車を基準とした他車の距離情報、角度情報等を
検出する検出装置21と、検出装置21の出力信号をデ
ータ処理するコンピュータ3とから構成されている。検
出装置21は、例えば、特開平1−213593号公報
の実施例に記載されている、スキャン型のレーザレーダ
を用いることができる。この検出装置21からは、距離
信号、スキャン信号及び角度信号からなる検出信号が出
力される。A specific example for realizing an embodiment of the present invention will be described below with reference to the drawings. FIG. 8 is a block diagram illustrating a vehicle detection device in which the object detection device according to the present embodiment is implemented using a computer. As shown in FIG. 8, the vehicle detection device includes a detection device 21 that detects distance information, angle information, and the like of another vehicle with respect to the own vehicle, and a computer 3 that performs data processing on an output signal of the detection device 21. Have been. As the detection device 21, for example, a scan-type laser radar described in the embodiment of Japanese Patent Application Laid-Open No. 1-213593 can be used. The detection device 21 outputs a detection signal including a distance signal, a scan signal, and an angle signal.
【0032】コンピュータ3は、検出装置21から出力
される検出信号を取り入れて、他車に対する距離等の情
報を演算する。コンピュータ3は、演算処理を行うCP
U31と、外部からの信号を内部で処理可能なディジタ
ル信号に変換し、また、内部のディジタル信号を外部へ
の信号に変換する入出力インターフェース33と、一時
的な記憶手段としてのRAM35と、各種の制御プログ
ラムやデータを格納しているROM37と、これらを接
続するデーターバスやコントロールバス等のバス等から
構成されている。The computer 3 takes in the detection signal output from the detection device 21 and calculates information such as the distance to another vehicle. The computer 3 performs a CP for performing arithmetic processing.
U31, an input / output interface 33 for converting an external signal into a digital signal that can be processed internally, and an internal digital signal to an external signal, a RAM 35 as temporary storage means, ROM 37 storing the control programs and data of the above, and a bus such as a data bus and a control bus for connecting these.
【0033】コンピュータ3は、図10〜図13に示す
フローチャートに従った処理を実行する。まず、図10
のステップ100において検出装置21から得られた検
出信号から計測した車の位置を求める。車の位置は、例
えば、特開平1−213593号公報で述べられている
方法を用いて求めることができる。この時、図9に示す
ように、計測した他車の位置を車1、車2、・・・、車
j、・・・、車Nとする。一方、それまでの計測でRA
Mに位置情報等が記憶された車をモデルと呼ぶことに
し、このモデルを図9に示すように、モデル1、モデル
2、・・・、モデルj、・・・、モデルMとする。The computer 3 executes processing according to the flowcharts shown in FIGS. First, FIG.
In step 100, the position of the vehicle measured from the detection signal obtained from the detection device 21 is obtained. The position of the vehicle can be determined, for example, using the method described in Japanese Patent Application Laid-Open No. 1-213593. At this time, as shown in FIG. 9, the measured positions of the other vehicles are defined as vehicle 1, vehicle 2,..., Vehicle j,. On the other hand, RA
A model in which position information and the like are stored in M is referred to as a model, and the models are referred to as model 1, model 2,..., Model j,.
【0034】次のステップ200では、計測した車と、
RAMに記憶された車(モデル)とが対応しているか否
かを判断する。この判断の詳細は図11のフローチャー
トに示すルーチンによって実行される。このルーチンを
説明すると、まず、ステップ202で計測した車を調べ
るためのループを実行するために、車の番号jを初期値
である1に設定する。次に、ステップ204でモデルを
順に調べるためのループを実行するためにモデルの番号
iを初期値である1に設定する。次に、ステップ206
で番号jの車(車j)の対応フラグがリセットされてい
るか否かを判断し、リセットされているときにはモデル
i(i番目のモデル)に対応する車は存在しないので、
ステップ208で車jとモデルiとの対応を調べ、ステ
ップ210で車jとモデルiとが対応しているか否か判
断する。対応しているか否かは、車jとモデルiとが同
じものであると見なせるか否かで判定する。この判定は
次のようにして行う。In the next step 200, the measured vehicle is
It is determined whether or not the vehicle (model) stored in the RAM corresponds to the vehicle. The details of this determination are executed by the routine shown in the flowchart of FIG. This routine will be described. First, in order to execute a loop for examining the car measured in step 202, the number j of the car is set to 1, which is an initial value. Next, in step 204, a model number i is set to 1, which is an initial value, to execute a loop for sequentially examining models. Next, step 206
It is determined whether or not the corresponding flag of the car with the number j (vehicle j) is reset. When the flag is reset, there is no car corresponding to the model i (the i-th model).
In step 208, the correspondence between the car j and the model i is checked, and in step 210, it is determined whether or not the car j and the model i correspond. Whether or not the vehicle is compatible is determined based on whether or not the vehicle j and the model i can be regarded as being the same. This determination is carried out following good Unishi.
【0035】すなわち、モデルiに対して対応している
か否かを判定する探索の範囲を決定し、その範囲内で評
価値の最も高い車jを対応している車と判断する。その
範囲内に車が存在していない場合は、対応する車jが計
測できなかったものと判断する。対応しているか否かを
判定する探索の範囲は、1回の計測周期内で車が相対的
に移動する可能性のある距離やモデルの持つ位置誤差や
車の持つ位置誤差等を考慮して決定すれば良く、誤差の
計算結果に従って対応しているか否かを判定する探索の
範囲を自動的に変化させることも可能である。That is, a search range for determining whether or not the model i is supported is determined, and the car j having the highest evaluation value within the range is determined to be the corresponding car. If no car exists within the range, it is determined that the corresponding car j could not be measured. The range of the search for judging whether or not it is compatible takes into account the distance that the car may move relatively within one measurement cycle, the position error of the model, the position error of the car, and the like. It is only necessary to determine, and it is also possible to automatically change the range of the search for determining whether or not they correspond according to the calculation result of the error.
【0036】評価値の定め方としては、モデルiと車j
との距離が短いものほど高い評価値を与える方法、モデ
ルiと車jとの誤差の分散から確率的な一致度を求め、
この一致度を評価値とする方法等が考えられる。また、
この実施例では位置情報のみで評価値を定めているが、
位置以外の情報、例えば速度、車の色・形等を評価値に
加えて対応しているか否かを判断することも可能であ
る。The evaluation values are determined by the model i and the car j
A method that gives a higher evaluation value as the distance from the vehicle is shorter, obtains a stochastic matching degree from the variance of an error between the model i and the car j,
A method of using the degree of coincidence as an evaluation value is conceivable. Also,
In this embodiment, the evaluation value is determined only by the position information,
It is also possible to determine whether information other than the position, for example, the speed, the color and shape of the vehicle, and the like are supported by adding them to the evaluation value.
【0037】ステップ208とステップ210とで車j
とモデルiとの対応を判定し、車jとモデルiとが対応
していればステップ212に進み、対応していなければ
ステップ226に進む。At step 208 and step 210, the vehicle j
And the model i is determined. If the vehicle j and the model i correspond, the process proceeds to step 212, and if not, the process proceeds to step 226.
【0038】ステップ212では、モデルiの対応フラ
グがリセットされているか否かを判断することにより、
モデルiと対応した車が以前に存在していたか否かを判
断する。モデルiの対応フラグがリセットされていてモ
デルiと対応した車が存在していないならばステップ2
22に進み、車jの対応フラグに対応するモデルの番号
iをセットする。一方、既に対応した車が存在している
場合にはステップ214に進む。At step 212, it is determined whether or not the corresponding flag of the model i has been reset.
It is determined whether a car corresponding to the model i has existed before. If the corresponding flag of the model i has been reset and there is no vehicle corresponding to the model i, step 2
Proceeding to 22, the model number i corresponding to the corresponding flag of the car j is set. On the other hand, if a corresponding car already exists, the process proceeds to step 214.
【0039】ステップ214ではモデルiと既に対応し
ていたと判断された車とを調べる。ここでは、車j’と
対応していたものとする。In step 214, the model i and the car determined to have already corresponded are examined. Here, it is assumed that it corresponds to the car j '.
【0040】ステップ216では車jとモデルiとの対
応の評価値である距離L(i,j)と、車j’とモデル
iとの対応の評価値である距離L(i,j’)とを計算
する。ステップ218では評価値の比較を行う。もし、
距離L(i,j’)が距離L(i,j)以下ならばステ
ップ226に進む。一方、距離L(i,j’)が距離L
(i,j)より大きければ、ステップ220に進む。At step 216, the distance L (i, j), which is the evaluation value of the correspondence between the car j and the model i, and the distance L (i, j '), which is the evaluation value of the correspondence between the car j' and the model i Is calculated. In step 218, the evaluation values are compared. if,
If the distance L (i, j ′) is equal to or less than the distance L (i, j), the process proceeds to step 226. On the other hand, the distance L (i, j ′) is the distance L
If it is larger than (i, j), the process proceeds to step 220.
【0041】ステップ220では、ステップ218にて
距離L(i,j’)が距離L(i,j)より大きいと判
断されたことから、車j’よりも車jの方がモデルiに
よく対応している(距離が短い)ため、車j’の対応フ
ラグをリセットし、ステップ222で、車jの対応フラ
グに対応するモデルの番号iをセットする。そして、次
のステップ224で、モデルiの対応フラグに、対応す
る車の番号jをセットする。In step 220, since the distance L (i, j ') is determined to be larger than the distance L (i, j) in step 218, the car j is more likely to be the model i than the car j'. Since they correspond (the distance is short), the corresponding flag of the car j 'is reset, and in step 222, the model number i corresponding to the corresponding flag of the car j is set. Then, in the next step 224, the number j of the corresponding car is set in the corresponding flag of the model i.
【0042】ステップ226では次のモデルについて調
べるために、i=i+1とする。ステップ228ではモ
デルループが終了したか否かの判定を行う。モデルルー
プが終了していればステップ230に進み、まだモデル
ループが終了していなければステップ206に進んで上
記の処理を繰り返す。In step 226, i = i + 1 is set to check the next model. At step 228, it is determined whether or not the model loop has been completed. If the model loop has ended, the process proceeds to step 230, and if the model loop has not ended, the process proceeds to step 206 to repeat the above processing.
【0043】ステップ230では計測した次の車につい
て調べるために、j=j+1とし、ステップ232では
車のループが終了したか否かの判定を行う。車ループが
終了していれば処理を終了し、まだ車ループが終了して
いなければステップ204に進んで上記の処理を繰り返
す。At step 230, j = j + 1 is set in order to check the next measured vehicle. At step 232, it is determined whether or not the vehicle loop has been completed. If the car loop has ended, the process is terminated. If the car loop has not ended, the process proceeds to step 204 to repeat the above process.
【0044】図10のステップ200で上記のようにし
て車とモデルとの対応付けの判断を行なった後、ステッ
プ300で対応状態に応じた確信度の演算を行う。この
確信度の演算処理について図12のフローチャートに従
って詳細に説明する。After the correspondence between the car and the model is determined in step 200 in FIG. 10 as described above, a certainty factor is calculated in step 300 according to the correspondence state. The calculation processing of the certainty factor will be described in detail with reference to the flowchart of FIG.
【0045】まず、モデルを順に調べるためのループの
実行を開始するために、モデルの番号をi=1とする
(ステップ302)。次にステップ304においてモデ
ルiの対応フラグがリセットされているか否かを判断す
ることにより、ステップ200でモデルiに対応する車
が存在すると判断されたか否かを判断する。モデルiの
対応フラグがリセットされていると判断されたとき、す
なわち対応する車が存在していないと判断されたときに
はステップ306に進んで確信度を減少し、モデルiの
対応フラグがセットされていると判断されたとき、すな
わち対応する車が存在していると判断されたときはステ
ップ308に進んで確信度を増加させる。First, in order to start execution of a loop for sequentially examining models, the model number is set to i = 1 (step 302). Next, in step 304, it is determined whether or not the corresponding flag of the model i has been reset, thereby determining whether or not it is determined in step 200 that a vehicle corresponding to the model i exists. When it is determined that the corresponding flag of the model i is reset, that is, when it is determined that the corresponding vehicle does not exist, the process proceeds to step 306 to decrease the certainty factor, and the corresponding flag of the model i is set. When it is determined that the vehicle is present, that is, when it is determined that the corresponding vehicle exists, the process proceeds to step 308 to increase the certainty factor.
【0046】この確信度の増減について例を挙げて説明
する。図17のように検出装置21の計測範囲20と、
検出確率αを設定したものとする。ここでは、距離で範
囲を区切って確率αを設定しているが、他にも、センサ
の検知特性に応じて範囲を区切ったり、αを位置の関数
として表現すること等も可能である。また、図14に示
すように、各モデルの時刻tでの確信度をそれぞれ次の
ようにする。The increase / decrease of the certainty factor will be described with an example. As shown in FIG. 17, the measurement range 20 of the detection device 21;
It is assumed that the detection probability α has been set. Here, the probability α is set by dividing the range by the distance, but it is also possible to delimit the range according to the detection characteristics of the sensor, to express α as a function of the position, and the like. Further, as shown in FIG. 14, the confidence factor of each model at time t is as follows.
【0047】モデル1:確信度P1(t)=0.95 モデル2:確信度P2(t)=0.80 モデル3:確信度P3(t)=0.60 さらに、ステップ100の車位置の演算により得られた
車の位置は図15のようであるものとする。図16の対
応結果より、時刻t+1での確信度は次のように更新さ
れる。Model 1: certainty P1 (t) = 0.95 Model 2: certainty P2 (t) = 0.80 Model 3: certainty P3 (t) = 0.60 The position of the vehicle obtained by the calculation is as shown in FIG. From the correspondence result of FIG. 16, the certainty factor at time t + 1 is updated as follows.
【0048】モデル1:確信度増加 P1(t+1)=P1(t)+(1−P1(t))・α
1=0.95+(1−0.95)・0.95 =0.9975 モデル2:確信度増加 P2(t+1)=P2(t)+(1−P1(t))・α
2=0.80+(1−0.80)・0.90=0.98 モデル3:確信度減少 P3(k+t)=P3(t)・α3 =0.60・0.80 =0.48 ステップ310では次のモデルについて調べるために、
i=i+1とする。ステップ312ではモデルループが
終了したか否かの判定を行う。モデルループが終了して
いれば処理を終了し、まだモデルループが終了していな
ければステップ304に進む。Model 1: increase in confidence P1 (t + 1) = P1 (t) + (1−P1 (t)) · α
1 = 0.95 + (1−0.95) · 0.95 = 0.975 Model 2: Increased confidence P2 (t + 1) = P2 (t) + (1−P1 (t)) · α
2 = 0.80 + (1−0.80) · 0.90 = 0.98 Model 3: Decrease in confidence P3 (k + t) = P3 (t) · α3 = 0.60 · 0.80 = 0.48 Step At 310, to find out about the next model,
Let i = i + 1. In step 312, it is determined whether or not the model loop has ended. If the model loop has ended, the process ends. If the model loop has not ended, the process proceeds to step 304.
【0049】次のステップ400ではRAM中の車のモ
デルを更新する。このモデル更新のルーチンを図13に
基づいて説明する。このルーチンでは、不要なモデルを
記憶領域から削除し、新たなモデルの記憶領域を作成す
るものである。このルーチンで削除、作成をスムーズに
行うためには、例えばモデル全体を双方向リストで連結
すれば良い。In the next step 400, the model of the car in the RAM is updated. This model updating routine will be described with reference to FIG. In this routine, unnecessary models are deleted from the storage area, and a storage area for a new model is created. In order to smoothly delete and create in this routine, for example, the entire model may be linked by a bidirectional list.
【0050】ステップ402ではモデルループを開始す
るために、i=1とし、ステップ404ではモデルの確
信度が閾値以下であるかどうかを判断する。モデルの確
信度が閾値以下ならばステップ406に進んで該当する
モデルの記憶内容の削除を行う。一方、モデルの確信度
が閾値より大きければステップ408に進む。ステップ
408では次のモデルについて判断するために、i=i
+1とする。In step 402, i = 1 is set in order to start a model loop. In step 404, it is determined whether or not the degree of certainty of the model is equal to or smaller than a threshold value. If the confidence of the model is equal to or less than the threshold, the process proceeds to step 406 to delete the storage contents of the corresponding model. On the other hand, if the certainty factor of the model is larger than the threshold, the process proceeds to step 408. In step 408, to determine about the next model, i = i
+1.
【0051】次のステップ410ではモデルループが終
了したか否かの判定を行う。モデルループが終了したな
らば、ステップ412に進み、まだループが終了してい
なければステップ404に進んで上記の処理を繰り返
す。In the next step 410, it is determined whether or not the model loop has been completed. If the model loop has ended, the flow advances to step 412; if not, the flow advances to step 404 to repeat the above processing.
【0052】ステップ412では車ループを開始するた
めに、j=1とする。ステップ414では車jの対応フ
ラグがリセットされているか否かを判断することによ
り、車jに対応するモデルが存在したか否かを判断す
る。対応するモデルが存在していなかった場合は対応フ
ラグ=0になっているので、ステップ416に進み、対
応するモデルのが存在していなかった車の位置を記憶す
ることにより、新たなモデルをRAM内に作成する。一
方、対応するモデルが存在していたならば対応フラグに
は0以外のモデル番号がセットされているので、ステッ
プ418に進み、次の車について判断するために、j=
j+1とする。In step 412, j = 1 is set in order to start a car loop. In step 414, it is determined whether the model corresponding to the vehicle j exists by determining whether the corresponding flag of the vehicle j is reset. If the corresponding model does not exist, the corresponding flag is set to 0, so the process proceeds to step 416 to store the position of the car where the corresponding model did not exist, thereby storing the new model in the RAM. Create within. On the other hand, if a corresponding model exists, a model number other than 0 is set in the corresponding flag, so that the process proceeds to step 418, and j =
j + 1.
【0053】ステップ420では車ループが終了したか
否かの判定を行う。ループが終了していない場合はステ
ップ414に進み、ループが終了していれば処理を終了
する。In step 420, it is determined whether or not the vehicle loop has been completed. If the loop has not ended, the process proceeds to step 414, and if the loop has ended, the process ends.
【0054】[0054]
【発明の効果】以上説明したように本発明によれば、記
憶物体が存在している度合いを表す確信度を演算し、確
信度の大きさに応じて記憶内容の変更、消去及び新たな
記憶内容の記憶を行っているため、物体の長い見失いに
対処することができると共に、雑音等による誤検出の影
響を少なくすることができる、という効果が得られる。As described above, according to the present invention, the degree of certainty representing the degree of existence of a storage object is calculated, and the stored contents are changed, deleted, and newly stored according to the degree of certainty. Since the contents are stored, it is possible to cope with a long loss of the object and to reduce the influence of erroneous detection due to noise or the like.
【図1】本発明の一実施例を示すブロック図である。FIG. 1 is a block diagram showing one embodiment of the present invention.
【図2】記憶物体の位置を示す線図である。FIG. 2 is a diagram showing a position of a storage object.
【図3】検出物体の位置を示す線図である。FIG. 3 is a diagram illustrating a position of a detection object.
【図4】記憶物体と検出物体とが対応しているか否かを
判断するための範囲を示す線図である。FIG. 4 is a diagram showing a range for determining whether a storage object and a detected object correspond to each other.
【図5】検出範囲における存在確率を示す線図である。FIG. 5 is a diagram showing an existence probability in a detection range.
【図6】移動物体の見失いに対する移動物体の存在の確
信度の変化を示す線図である。FIG. 6 is a diagram showing a change in the certainty factor of the existence of a moving object with respect to the missing of the moving object.
【図7】ノイズによって誤検出した場合の移動物体の存
在の確信度の変化を示す線図である。FIG. 7 is a diagram showing a change in certainty of the presence of a moving object when an erroneous detection is made due to noise;
【図8】本実施例の具体例を示すブロック図である。FIG. 8 is a block diagram showing a specific example of this embodiment.
【図9】RAMに記憶されたモデルと車の記憶領域を示
す線図である。FIG. 9 is a diagram showing a model stored in a RAM and a storage area of a vehicle.
【図10】本実施例の車両検出処理ルーチンを示す流れ
図である。FIG. 10 is a flowchart illustrating a vehicle detection processing routine according to the present embodiment.
【図11】図10のステップ200の詳細を示す流れ図
である。FIG. 11 is a flowchart showing details of step 200 in FIG. 10;
【図12】図10のステップ300の詳細を示す流れ図
である。FIG. 12 is a flowchart showing details of step 300 in FIG. 10;
【図13】図10のステップ400の詳細を示す流れ図
である。FIG. 13 is a flowchart showing details of step 400 in FIG. 10;
【図14】モデルの位置を示す線図である。FIG. 14 is a diagram showing the position of a model.
【図15】検出した車の位置を示す線図である。FIG. 15 is a diagram showing a detected car position.
【図16】モデルと検出した車とが対応しているか否か
を判断するための範囲を示す線図である。FIG. 16 is a diagram showing a range for determining whether a model and a detected car correspond to each other.
【図17】検出範囲における存在確率を示す線図であ
る。FIG. 17 is a diagram showing the existence probability in the detection range.
3 コンピュータ 21 検出装置 3 Computer 21 Detector
フロントページの続き (72)発明者 本郷 武朗 愛知県愛知郡長久手町大字長湫字横道41 番地の1 株式会社豊田中央研究所内 (72)発明者 遠藤 徳和 愛知県豊田市トヨタ町1番地 トヨタ自 動車株式会社内 (72)発明者 久保田 有一 愛知県豊田市トヨタ町1番地 トヨタ自 動車株式会社内 (56)参考文献 特開 平4−243491(JP,A) 特開 昭62−36581(JP,A) (58)調査した分野(Int.Cl.7,DB名) G08G 1/16 G01S 13/93 Continued on the front page (72) Inventor Takero Hongo 41-41, Yokomichi, Nagakute-machi, Aichi-gun Inside (72) Inventor Yuichi Kubota 1 Toyota Town, Toyota City, Aichi Prefecture Inside Toyota Motor Co., Ltd. (56) References JP-A-4-2433491 (JP, A) JP-A-62-36581 (JP, A) (58) Field surveyed (Int.Cl. 7 , DB name) G08G 1/16 G01S 13/93
Claims (6)
と、 物体検出手段で検出された検出物体の過去の位置を記憶
する記憶手段と、 検出物体の現在位置と記憶手段に記憶されている記憶物
体の位置とに基づいて現在位置が検出された検出物体と
記憶手段に位置が記憶されている記憶物体とが対応して
いるか否かを判断する判断手段と、前記判断手段によって検出物体と記憶物体とが対応して
いると判断されたときには前回の値より大きくなり、か
つ検出物体と記憶物体とが対応していないと判断された
ときには前回の値より小さくなる 確信度を演算する演算
手段と、 確信度が所定値以上の記憶物体に対する記憶内容を検出
された現在位置に基づいて変更すると共に確信度が所定
値未満の記憶物体に対する記憶内容を消去し、かつ判断
手段によって記憶物体と対応していないと判断された検
出物体に対する位置を記憶させる記憶内容変更手段と、 を含む物体検出装置。1. An object detection means for detecting a current position of an object, a storage means for storing a past position of the detection object detected by the object detection means, and a current position of the detection object and stored in the storage means Judgment means for judging whether or not the detected object whose current position is detected based on the position of the storage object and the storage object whose position is stored in the storage means correspond to the detection object, and the detection object Corresponding to the memory object
If it is determined that the
It is determined that the detected object and the memory object do not correspond
A calculating means for calculating a certainty factor that is smaller than the previous value; and a method for changing the storage content of the storage object having the certainty factor equal to or more than the predetermined value based on the detected current position and for the storage object having the certainty factor less than the predetermined value An object detection device, comprising: storage content changing means for erasing storage content and storing a position for a detected object determined not to correspond to a storage object by the determination means.
置を含む所定範囲内の領域に現在位置が検出された検出
物体が存在していれば、現在位置が検出された検出物体
と記憶手段に位置が記憶されている記憶物体とが対応し
ていると判断する請求項1記載の物体検出装置。2. The method according to claim 1, wherein the determining means determines that the detected object whose current position has been detected exists in an area within a predetermined range including the stored past position. 2. The object detection device according to claim 1, wherein it is determined that the storage object whose position is stored in the means corresponds to the storage object.
物体とが同じものであるとみなせる場合に前記検出物体
と前記記憶物体とが対応していると判断する請求項1ま
たは請求項2記載の物体検出装置。3. The method according to claim 1, wherein the determining unit determines that the detected object and the storage object correspond to each other when the detected object and the storage object can be considered to be the same. The object detection device according to claim.
に記憶物体が存在するときの確信度をP(k)、その地
点で前記物体検出手段が物体を検出する確率をα(0<
<α<1)とするとき、時刻k+1における確信度P
(k+1)を以下の式に基づいて演算する請求項1〜請
求項3のいずれか1項記載の物体検出装置。 検出物体と記憶物体とが対応していると判断されたとき P(k+1)=P(k)+(1−P(k))・α 検出物体と記憶物体とが対応していないと判断されたと
き P(k+1)=P(k)・α4. The calculation means calculates a certainty factor P (k) when a stored object is present at a certain point at a time k, and sets a probability that the object detection means detects an object at the point at α (0 <0).
<Α <1), the certainty factor P at time k + 1
The object detection device according to any one of claims 1 to 3, wherein (k + 1) is calculated based on the following expression. When it is determined that the detected object and the storage object correspond to each other P (k + 1) = P (k) + (1−P (k)) · α It is determined that the detection object and the storage object do not correspond to each other. P (k + 1) = P (k) · α
の前記所定値をθ、物体が存在しているものとして扱い
たい見失い回数をn回としたとき、α=n√(1−θ)
である請求項4記載の物体検出装置。Wherein when the predetermined value for erasing the stored contents to the storage object theta, the number of times losing sight be treated as what the object is present is n times, α = n √ (1- θ)
The object detection device according to claim 4, wherein
に記憶物体が存在するときの確信度をP(k)、その地
点で前記物体検出手段が物体を検出する確率をα=(1
−θ)/n(ただし、θは記憶物体に対する記憶内容を
消去するための前記所定値、nは物体が存在しているも
のとして扱いたい見失い回数である。)とするとき、時
刻k+1における確信度P(k+1)を以下の式に基づ
いて演算する請求項1〜請求項3のいずれか1項記載の
物体検出装置。 検出物体と記憶物体とが対応していると判断されたとき P(k+1)=P(k)+α 検出物体と記憶物体とが対応していないと判断されたと
き P(k+1)=P(k)−α6. The computing means calculates a certainty factor P (k) when a stored object is present at a certain point at a time k, and calculates a probability that the object detecting means detects an object at the point at α = (1
−θ) / n (where θ is the predetermined value for erasing the stored contents of the stored object, and n is the number of times the object is lost as if the object is present), and the confidence at the time k + 1 is obtained. The object detection device according to claim 1, wherein the degree P (k + 1) is calculated based on the following equation. P (k + 1) = P (k) + α When it is determined that the detected object and the storage object do not correspond P (k + 1) = P (k) ) -Α
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP4294471A JP3065821B2 (en) | 1992-11-02 | 1992-11-02 | Object detection device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP4294471A JP3065821B2 (en) | 1992-11-02 | 1992-11-02 | Object detection device |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH06150195A JPH06150195A (en) | 1994-05-31 |
JP3065821B2 true JP3065821B2 (en) | 2000-07-17 |
Family
ID=17808209
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP4294471A Expired - Fee Related JP3065821B2 (en) | 1992-11-02 | 1992-11-02 | Object detection device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3065821B2 (en) |
Families Citing this family (34)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0487742B1 (en) * | 1990-06-18 | 1998-09-02 | Seiko Epson Corporation | Flat displaying device and device for driving displaying elements |
DE69611278T2 (en) * | 1995-11-10 | 2001-05-23 | Toyota Jidosha K.K., Toyota | Radar device for detecting the direction of the center of a target |
JP3257410B2 (en) * | 1995-11-24 | 2002-02-18 | トヨタ自動車株式会社 | In-vehicle scanning radar |
JPH09222477A (en) * | 1996-02-19 | 1997-08-26 | Toyota Motor Corp | On-board radar apparatus |
JP3314623B2 (en) | 1996-08-12 | 2002-08-12 | トヨタ自動車株式会社 | In-vehicle scanning radar |
JP3748306B2 (en) * | 1997-01-23 | 2006-02-22 | 富士通テン株式会社 | Radar equipment |
JP3385304B2 (en) * | 1997-08-29 | 2003-03-10 | 三菱電機株式会社 | Automotive radar equipment |
JP3995311B2 (en) * | 1997-09-01 | 2007-10-24 | 富士通テン株式会社 | Target recognition method in inter-vehicle distance control system |
JP3405327B2 (en) * | 2000-07-28 | 2003-05-12 | 株式会社デンソー | Object recognition method and apparatus, recording medium |
US6888622B2 (en) | 2002-03-12 | 2005-05-03 | Nissan Motor Co., Ltd. | Method for determining object type of reflective object on track |
JP4184096B2 (en) * | 2003-01-15 | 2008-11-19 | 富士通テン株式会社 | Preceding vehicle estimation method |
JPWO2005091015A1 (en) * | 2004-03-23 | 2008-02-07 | 株式会社村田製作所 | Radar |
JP2006047033A (en) * | 2004-08-03 | 2006-02-16 | Daihatsu Motor Co Ltd | Object recognition method and device |
JP2006090957A (en) * | 2004-09-27 | 2006-04-06 | Nissan Motor Co Ltd | Surrounding object detecting device for moving body, and surrounding object detection method for moving body |
JP4794268B2 (en) * | 2005-10-11 | 2011-10-19 | アルパイン株式会社 | Radar accuracy prediction device |
JP4859453B2 (en) * | 2005-12-16 | 2012-01-25 | ダイハツ工業株式会社 | Vehicle target recognition device |
JP4528320B2 (en) * | 2007-08-06 | 2010-08-18 | 本田技研工業株式会社 | Object detection device |
JP5309778B2 (en) * | 2007-12-19 | 2013-10-09 | 日産自動車株式会社 | Inter-vehicle maintenance support device and inter-vehicle maintenance support method |
JP2009198363A (en) | 2008-02-22 | 2009-09-03 | Omron Corp | Radiolocater and method |
JP5614969B2 (en) * | 2009-10-30 | 2014-10-29 | 東京計器株式会社 | Target tracking device and target tracking method |
JP5835243B2 (en) | 2013-02-07 | 2015-12-24 | 株式会社デンソー | Target recognition device |
EP2865575B1 (en) * | 2013-10-22 | 2022-08-24 | Honda Research Institute Europe GmbH | Confidence estimation for predictive driver assistance systems based on plausibility rules |
JP5735673B2 (en) * | 2014-02-03 | 2015-06-17 | 東京計器株式会社 | Target tracking device and target tracking method |
JP6404679B2 (en) | 2014-10-22 | 2018-10-10 | 株式会社デンソー | Object detection device |
JP6430777B2 (en) | 2014-10-22 | 2018-11-28 | 株式会社デンソー | Object detection device |
JP6442225B2 (en) | 2014-10-22 | 2018-12-19 | 株式会社デンソー | Object detection device |
JP6484000B2 (en) | 2014-10-22 | 2019-03-13 | 株式会社デンソー | Object detection device |
JP2016080641A (en) | 2014-10-22 | 2016-05-16 | 株式会社デンソー | Object detector |
JP6474228B2 (en) | 2014-10-22 | 2019-02-27 | 株式会社デンソー | Object detection device |
JP6462308B2 (en) | 2014-10-22 | 2019-01-30 | 株式会社デンソー | Object detection device |
JP6430778B2 (en) | 2014-10-22 | 2018-11-28 | 株式会社デンソー | Object detection device |
JP6645074B2 (en) * | 2015-08-25 | 2020-02-12 | 株式会社Ihi | Obstacle detection system |
WO2021033240A1 (en) * | 2019-08-19 | 2021-02-25 | オムロン株式会社 | Position detection device and moving body control system |
JP7433999B2 (en) * | 2020-03-13 | 2024-02-20 | 日清紡マイクロデバイス株式会社 | Distance calculation device, distance measurement system, distance calculation program and distance calculation method |
-
1992
- 1992-11-02 JP JP4294471A patent/JP3065821B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JPH06150195A (en) | 1994-05-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3065821B2 (en) | Object detection device | |
CN111507157A (en) | Method and device for optimizing resource allocation during automatic driving based on reinforcement learning | |
US10579888B2 (en) | Method and system for improving object detection and object classification | |
US11440541B2 (en) | Apparatus and method for predicting concurrent lane change and vehicle including the same | |
JPH08329393A (en) | Preceding vehicle detector | |
US11748593B2 (en) | Sensor fusion target prediction device and method for vehicles and vehicle including the device | |
KR20210111181A (en) | Method, apparatus, device and medium for detecting environmental change | |
JP5402983B2 (en) | Vehicular road shape recognition method and apparatus, and recording medium | |
US20210001858A1 (en) | Lane change control device and method for autonomous vehicle | |
US20210011481A1 (en) | Apparatus for controlling behavior of autonomous vehicle and method thereof | |
JP2023514163A (en) | A method and apparatus for calibrating the camera pitch of an automobile, and a method for continuously learning a vanishing point estimation model therefor | |
CN114325687A (en) | Radar data and visual information fusion processing method, device, system and equipment | |
CN114296095A (en) | Method, device, vehicle and medium for extracting effective target of automatic driving vehicle | |
JP2011039833A (en) | Vehicle detector, vehicle detection program, and vehicle detection method | |
CN116148860A (en) | Method and device for identifying static obstacle, vehicle and storage medium | |
JP3065822B2 (en) | Moving object detection device | |
CN115424245A (en) | Parking space identification method, electronic device and storage medium | |
CN113911111A (en) | Vehicle collision detection method, system, electronic device, and storage medium | |
CN113646820B (en) | Detection device and detection method | |
CN113771846A (en) | Automatic control method, apparatus, system, and medium for vehicle | |
CN116068574A (en) | Multi-target tracking track creation and deletion method, device, equipment and storage medium | |
JPH05113482A (en) | Rear end collision prevention device mounted on car | |
KR101963352B1 (en) | Vision based Adaptive Cruise Control System and Method | |
CN112896070A (en) | Parking space obstacle detection method and device and computer readable storage medium | |
JPH11110699A (en) | Device and method for recognizing preceding vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090512 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100512 Year of fee payment: 10 |
|
LAPS | Cancellation because of no payment of annual fees |