Nothing Special   »   [go: up one dir, main page]

JP3065822B2 - Moving object detection device - Google Patents

Moving object detection device

Info

Publication number
JP3065822B2
JP3065822B2 JP4297416A JP29741692A JP3065822B2 JP 3065822 B2 JP3065822 B2 JP 3065822B2 JP 4297416 A JP4297416 A JP 4297416A JP 29741692 A JP29741692 A JP 29741692A JP 3065822 B2 JP3065822 B2 JP 3065822B2
Authority
JP
Japan
Prior art keywords
storage
detected
speed
model
stored
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
Application number
JP4297416A
Other languages
Japanese (ja)
Other versions
JPH06150196A (en
Inventor
真一 小島
芳樹 二宮
武朗 本郷
徳和 遠藤
有一 久保田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Motor Corp
Toyota Central R&D Labs Inc
Original Assignee
Toyota Motor Corp
Toyota Central R&D Labs Inc
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Toyota Motor Corp, Toyota Central R&D Labs Inc filed Critical Toyota Motor Corp
Priority to JP4297416A priority Critical patent/JP3065822B2/en
Publication of JPH06150196A publication Critical patent/JPH06150196A/en
Application granted granted Critical
Publication of JP3065822B2 publication Critical patent/JP3065822B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Traffic Control Systems (AREA)

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【産業上の利用分野】本発明は移動物体検出装置に係
り、より詳しくは、走行している車両等の移動物体を検
出する移動物体検出装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a moving object detecting device, and more particularly to a moving 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. Generally, at the time of follow-up running, a situation may occur in which another vehicle is interrupted between the own vehicle and the preceding vehicle, or the preceding vehicle changes because the preceding vehicle changes lanes to the adjacent lane. Therefore, it is necessary to consider vehicles other than the preceding vehicle as objects to be recognized.

【0003】特開平2−36500号公報、特開平1−
213593号公報、特開昭61−20877号公報、
及び特開平2−40800号公報には先行車を認識する
技術が開示されているが、これらの技術では、先行車以
外の車の認識については考慮されていない。
[0003] JP-A-2-36500, JP-A-1-36500
No. 213593, JP-A-61-20877,
And Japanese Patent Application Laid-Open No. 2-40800 disclose techniques for recognizing a preceding vehicle, but in these techniques, no consideration is given to recognition of a vehicle other than the preceding vehicle.

【0004】また、特開平1−197133号公報記載
の技術においては、先行車以外の車の認識も考慮してい
るが、送受信装置を各車に設け、電波で他車から情報を
得ているため、送受信装置を備えていない車の情報は得
ることができず、実際的ではない。
In the technology described in Japanese Patent Application Laid-Open No. 1-197133, although recognition of vehicles other than the preceding vehicle is also taken into consideration, a transmitting / receiving device is provided in each vehicle and information is obtained from other vehicles by radio waves. Therefore, it is not practical to obtain information on a vehicle that does not have a transmission / reception device.

【0005】更に、特開昭61−145474号公報に
おいては、過去の複数の距離データを記憶し、直線近似
で相対速度を求め、先行車と路側リフレクタとを分離す
る技術が開示されている。しかし、この方法を利用して
先行車以外の車を認識しようとすると、距離の情報のみ
を考慮し横方向の位置を考慮していないので、隣レーン
の車と先行車とを区別することができない。また、相対
速度を直線近似で求めているが、一般に先行車を含めた
他車の相対速度は一定ではないので直線近似では精度が
悪くなる。更に、距離データを直線近似する際のグルー
プ分けの基準として、一回前の観測結果との距離が近い
場合に同一グループと判断する処理を行っているが、図
13のような状況では、時刻tにおいて、L0(t)は
L0(t−1)に近いためG0のグループに、L1
(t)はL1(t−1)に近いためG1のグループに、
それぞれ誤って分類されることになる。
Further, Japanese Patent Application Laid-Open No. 61-145474 discloses a technique of storing a plurality of past distance data, obtaining a relative speed by linear approximation, and separating a preceding vehicle from a roadside reflector. However, when trying to recognize a vehicle other than the preceding vehicle using this method, it is not possible to distinguish the vehicle in the adjacent lane from the preceding vehicle because only the distance information is considered and the horizontal position is not considered. Can not. Further, the relative speed is obtained by linear approximation. However, since the relative speeds of other vehicles including the preceding vehicle are generally not constant, the accuracy of linear approximation deteriorates. Further, as a criterion for grouping when linearly approximating the distance data, a process of determining the same group when the distance from the immediately preceding observation result is short is performed. However, in the situation shown in FIG. At t, L0 (t) is close to L0 (t-1), so that L0 (t)
(T) is close to L1 (t-1), so it belongs to G1 group,
Each will be misclassified.

【0006】また、特開昭61−278775号公報、
特開昭62−36581号公報においては、複数レーダ
により、先行車認識を行い、隣レーンの車と先行車とを
区別する技術が開示されている。しかし、この公報の実
施例ではレーザビーム数が3個の場合について説明し、
「他のビーム数、例えば2、4、5・・・等を選んでも
良く、その数に応じた先行車検出能力を見込むことがで
きる。」と記載されているが、ビーム数が増えた場合、
2本以上のビームで対象を捉えた場合などを考えると、
ビームの数nに対して先行車認識部の条件分岐が複雑に
なり、実際的ではない。また、相対速度の計算は、ある
一つのビームに於ける検出距離の履歴1c−9、1c−
8、・・・1c−1、1cから計算しており、ビームを
跨ぎながら移動している物体の速度計算をすることは考
慮されていない。そのため、割り込み車の車速を直ちに
認識することはできない。
Further, Japanese Patent Application Laid-Open No. 61-278775,
JP-A-62-36581 discloses a technique in which a preceding vehicle is recognized by a plurality of radars and a vehicle in an adjacent lane is distinguished from a preceding vehicle. However, the embodiment of this publication describes a case where the number of laser beams is three,
It states that "another number of beams, for example, 2, 4, 5,... May be selected, and the preceding vehicle detection capability can be expected in accordance with the number." ,
Considering the case of capturing an object with two or more beams,
The conditional branch of the preceding vehicle recognition unit becomes complicated for the number n of the beams, which is not practical. Further, the calculation of the relative velocity is based on the detection distance history 1c-9, 1c-
8,... 1c-1, 1c, and does not consider calculating the velocity of an object moving while straddling the beam. Therefore, the vehicle speed of the interrupted vehicle cannot be immediately recognized.

【0007】更に、位置に基づく対応付けがなされてい
るため、上記と同様の対応間違いが起こる可能性があ
る。
[0007] Further, since correspondence is made based on the position, there is a possibility that the same correspondence error as described above may occur.

【0008】[0008]

【発明が解決しようとする課題】本発明は上記問題点を
解決すべく成されたもので、追跡している移動物体が切
り替わったときに直ちに切り替わった移動物体の情報が
得られると共に、割込みが発生する状況を予測して速度
等を制御する際に有効な情報が得られる移動物体検出装
置を提供することを目的とする。
SUMMARY OF THE INVENTION The present invention has been made in order to solve the above-mentioned problems, and when a moving object being tracked is switched, information of the switched moving object can be obtained immediately, and an interrupt is generated. It is an object of the present invention to provide a moving object detection device that can obtain effective information when controlling a speed or the like by predicting a situation to occur.

【0009】上記目的を達成するために本発明は、移動
している物体の位置を検出する位置検出手段と、移動し
ている物体と自車との相対速度を検出する速度検出手段
と、位置情報の履歴を記憶する記憶手段と、記憶手段に
記憶された位置情報及び速度検出手段で検出された相対
速度とに基づいて物体が移動する位置を予測する予測手
段と、位置検出手段で検出された位置と予測手段で予測
された位置とに基づいて位置が検出された移動している
物体と記憶手段に位置情報が記憶されている記憶物体と
が対応しているか否かを判断する判断手段と、判断手段
で対応していると判断された記憶物体及び判断手段で対
応していないと判断された回数が所定回未満の記憶物体
の位置情報を更新し、判断手段で対応していないと判断
された回数が所定回以上の記憶物体の位置情報を消去
し、かつ判断手段で記憶物体と対応していないと判断さ
れた検出物体の位置情報を記憶させる記憶内容変更手段
と、を含んで構成されている。
In order to achieve the above object, the present invention provides a position detecting means for detecting a position of a moving object , a speed detecting means for detecting a relative speed between the moving object and the own vehicle , Storage means for storing the history of information, and the relative information detected by the position information and speed detection means stored in the storage means
Prediction means for predicting a position of the object moves on the basis of the speed, the object position based on the predicted position detected position and predicting means by the position detecting means is moving is detected that the storage means The determination means for determining whether the storage object whose position information is stored corresponds to the storage object, and the storage object determined to be corresponding by the determination means and the determination means determine that the storage object does not correspond The position information of the storage object whose number of times is less than the predetermined number of times is updated, the position information of the storage object whose number of times determined that the storage object is not supported by the determination means is erased more than the predetermined number of times, and the determination means corresponds to the storage object Storage content changing means for storing the position information of the detected object determined not to have been stored.

【0010】[0010]

【作用】本発明の位置検出手段は、走行車両等の移動し
ている物体の位置を検出し、速度検出手段は、移動して
いる物体と自車との相対速度を検出する。この速度検出
手段としては、移動している物体の相対速度を直接検出
する速度センサや位置検出手段で検出された位置の履歴
から単位時間内の位置の変化を演算することによって物
体の相対速度を検出する演算手段を用いることができ
る。記憶手段は、位置情報の履歴を記憶する。なお、記
憶手段には速度情報等を合わせて記憶するようにしても
よい。予測手段は、記憶手段に記憶された位置情報及び
速度検出手段で検出された相対速度に基づいて物体が移
動する位置を予測する。判断手段は、位置検出手段で検
出された位置と予測手段で予測された位置、すなわち予
測位置とに基づいて、位置が検出された移動している物
体と記憶手段に位置情報が記憶されている記憶物体とが
対応しているか否かを判断する。例えば、予測位置を含
む所定範囲内の領域内に検出された位置が存在していれ
ば、位置が検出された検出物体と記憶手段に位置情報が
記憶されている記憶物体とが対応していると判断するこ
とができる。記憶内容変更手段は、判断手段で対応して
いると判断された記憶物体及び判断手段で対応していな
いと判断された回数が所定回未満の記憶物体の位置情報
を更新する。このように位置を予測して検出物体と記憶
物体とが対応しているか否かを判断しているため、他の
移動物体の割込みにも対処することができる。対応して
いないと判断された回数が所定回未満の記憶物体の位置
情報も更新するようにしているため、一時的に物体を見
失った場合においても記憶物体を仮想的な物体として取
り扱うことができる。また、記憶内容変更手段は、判断
手段で対応していないと判断された回数が所定回以上の
記憶物体の情報を消去する。これによって、対応してい
ないと判断された回数が所定回以上の記憶物体、すなわ
ち見失いが所定時間を越える物体に対しては記憶手段の
位置情報が消去される。また、記憶内容変更手段は、位
置検出手段によって検出されたが、判断手段で記憶物体
と対応していないと判断された検出物体に対する位置を
記憶手段に記憶させる。これによって、長い見失い後に
見失った物体を再検出した場合や新たな物体を検出した
場合等に対処することができる。
The position detecting means of the present invention detects the position of a moving object such as a traveling vehicle, and the speed detecting means detects the relative speed between the moving object and the own vehicle . As the speed detecting means, the relative speed of the object by calculating the change in position of a unit time from the history of the position detected by the speed sensor and position detecting means for detecting the relative velocity of a moving object directly Calculation means for detecting can be used. The storage unit stores a history of the position information. The storage means may store speed information and the like together. The prediction unit predicts a position at which the object moves based on the position information stored in the storage unit and the relative speed detected by the speed detection unit. Determination means, predicted position detected position and predicting means by the position detecting means, i.e. on the basis of the predicted position, the position is stored in the position information on the object storage means that is moving is detected It is determined whether or not the stored object corresponds. For example, if the detected position is present in an area within a predetermined range including the predicted position, the detected object whose position has been detected corresponds to the storage object whose position information is stored in the storage unit. Can be determined. The storage content changing means updates the position information of the storage object determined to be compatible by the determination means and the storage object whose number of times determined by the determination means to be incompatible is less than a predetermined number of times. As described above, since the position is predicted to determine whether the detected object and the storage object correspond to each other, it is possible to cope with an interruption of another moving object. Since the position information of the storage object that is determined to be incompatible is less than the predetermined number of times is also updated, the storage object can be treated as a virtual object even if the object is temporarily lost. . In addition, the storage content changing unit deletes information of the storage object whose number of times that the determination unit determines that the content is not supported is a predetermined number or more. As a result, the position information of the storage means is erased for a stored object whose number of times determined to be unsupported is equal to or more than a predetermined number of times, that is, for an object whose misplacement exceeds a predetermined time. In addition, the storage content changing means causes the storage means to store the position with respect to the detected object, which is detected by the position detecting means, but is determined not to correspond to the storage object by the determining means. Thus, it is possible to cope with a case where a lost object is detected again after a long loss or a case where a new object is detected.

【0011】[0011]

【実施例】以下本発明の実施例を説明する。まず、本実
施例を機能ブロックで表すと図1のようになる。図に示
すように、本実施例は、移動している複数物体の現在位
置を検出する位置検出手段10と、移動している複数物
体の位置情報の履歴等を記憶する記憶手段20とを備え
ている。この記憶手段20は、記憶手段20に記憶され
ている位置情報の履歴等から移動している複数物体の
との相対速度を演算する、速度検出手段としての速度
演算手段12に接続されている。記憶手段20と速度演
算手段12とは、記憶手段20に記憶されている移動し
ている複数物体の以前の位置と速度演算手段12で今回
演算した相対速度とから移動している複数物体が現在位
置すると予測される予測位置を演算する予測手段14に
接続されている。位置検出手段10と予測手段14と
は、予測位置を含む所定範囲内の領域内に検出された移
動している複数物体の位置が存在しているか否かを判断
して、位置が検出された移動している複数物体と記憶手
段20に位置情報が記憶されている記憶物体とが対応し
ているか否かを判断し、判断結果と共に位置情報も出力
する判断手段16に接続されている。判断手段16は、
判断手段16の判断結果に基づいて、記憶手段20の記
憶内容の更新、消去等を行う記憶内容変更手段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 a position detection unit 10 for detecting the current positions of a plurality of moving objects, and a storage unit 20 for storing a history of position information of the plurality of moving objects. ing. The storage means 20, the own multiple objects moving and the history of the position information stored in the storage means 20
It is connected to speed calculating means 12 as speed detecting means for calculating a relative speed with respect to the vehicle . The storage means 20 and the speed calculation means 12 determine whether a plurality of objects moving from the previous positions of the plurality of moving objects stored in the storage means 20 and the relative speeds calculated this time by the speed calculation means 12 are present. It is connected to a prediction means 14 for calculating a predicted position predicted to be located. The position detection means 10 and the prediction means 14 determine whether or not the positions of a plurality of moving objects detected within an area within a predetermined range including the predicted position are detected, and the positions are detected. It is connected to a judgment means 16 for judging whether or not a plurality of moving objects correspond to a storage object whose position information is stored in the storage means 20, and outputting position information together with the judgment result. The judgment means 16
The storage unit 20 is connected to a storage content change unit 18 that updates and deletes the storage content of the storage unit 20 based on the determination result of the determination unit 16.

【0012】位置検出手段10は、移動している物体の
位置を検出できるセンサであって、複数の物体を区別で
きるセンサ、例えば、スキャン型レーザ、画像式等の2
次元の座標が得られるセンサ、ミリ波を用いた1次元の
座標が得られるセンサ等を用いることができる。以下で
は、2次元の座標が求められるセンサを用いて説明す
る。
The position detecting means 10 is a sensor capable of detecting the position of a moving object, and a sensor capable of distinguishing a plurality of objects, for example, a scanning laser, an image type, or the like.
A sensor that can obtain dimensional coordinates, a sensor that can obtain one-dimensional coordinates using millimeter waves, or the like can be used. Hereinafter, a description will be given using a sensor that can obtain two-dimensional coordinates.

【0013】記憶手段20は、例えばRAMを用い、位
置検出手段10で検出した移動している複数物体の位置
情報の履歴、速度演算手段12で演算した相対速度の履
歴、予測手段14によって予測した位置、及びその他の
情報を各車毎にまとめて記憶する。
The storage means 20 uses, for example, a RAM, and records the position information history of a plurality of moving objects detected by the position detection means 10, the relative speed history calculated by the speed calculation means 12, and the prediction by the prediction means 14. The position and other information are collectively stored for each vehicle.

【0014】速度演算手段12では記憶手段20に記憶
されている位置情報から、移動している複数物体の相対
速度を演算する。現在時刻をtとし、ある物体の時刻t
での検出した位置をPm(t)、予測した位置をPp
(t)、演算した相対速度をVm(t)、Vp(t)と
する。記憶手段20に記憶されているある物体の前回の
計測で検出した位置Pm(t−1)、前々回の計測で検
出した位置Pm(t−2)とから、まず、前回の検出時
の相対速度は次式で求められる。
The speed calculating means 12 calculates the relative speed of a plurality of moving objects from the position information stored in the storage means 20. The current time is t, and the time t of a certain object is
Is the detected position in Pm (t), and the predicted position is Pp
(T), the calculated relative speeds are Vm (t) and Vp (t). First, from the position Pm (t-1) detected in the previous measurement of a certain object and the position Pm (t-2) detected in the last two measurements, the relative speed at the time of the previous detection is stored. Is obtained by the following equation.

【0015】Vm(t−1)=(Pm(t−1)−
(t−2))/△t △t:計測時間間隔 このままでは位置検出手段での検出した位置の誤差によ
る速度変動が大きいので過去の相対速度の履歴から適当
なフィルタを用いて求めたVp(t−1)を、前回の検
出時の相対速度とする。例えば、N次の移動平均フィル
タを用いる場合、
[0015] Vm (t-1) = ( Pm (t-1) - P m
(T−2)) / Δt Δt: Measurement time interval Since the speed fluctuation due to the error in the position detected by the position detection means is large in this state, Vp () obtained from the past relative speed history using an appropriate filter is used. t-1) is the relative speed at the time of the previous detection. For example, when using an N-order moving average filter,

【0016】[0016]

【数1】 (Equation 1)

【0017】N次のバタワースフィルタを用いる場合、When an Nth-order Butterworth filter is used,

【0018】[0018]

【数2】 (Equation 2)

【0019】An、Bn:定数 予測手段14においては、前回までの計測の結果として
記憶手段20に記憶されている記憶物体の前回の位置
と、速度演算手段12で演算した前回の相対速度とか
ら、現在の計測で移動しているであろう物体の位置を予
測する。ある物体の現在の予測位置Pp(t)は、記憶
手段20に記憶されている前回の計測で検出した位置P
m(t−1)と、速度演算手段で演算した前回の相対速
度Vp(t−1)とから、次式で求められる。
An, Bn: constants In the predicting means 14, the previous position of the storage object stored in the storage means 20 as a result of the previous measurement and the previous relative speed calculated by the speed calculating means 12 are used. , Predict the position of the object that will be moving in the current measurement. The current predicted position Pp (t) of a certain object is the position P detected in the previous measurement stored in the storage means 20.
From m (t-1) and the previous relative speed Vp (t- 1 ) calculated by the speed calculating means, it can be obtained by the following equation.

【0020】 Pp(t)=Pm(t−1)+Vp(t−1)×△t △t:計測時間間隔 判断手段16は、例えば、次のようにして位置検出手段
10で検出された物体(例えば、車)と記憶手段20に
記憶されている記憶物体(例えば、車)とが対応してい
るか否かを判断する。まず、記憶手段20に図2のよう
な記憶物体a〜cの位置情報が記憶されていたと仮定す
る。扇型20はセンサの計測範囲であり、扇型の角であ
る左端に自車が存在している。そして、次の測定(時刻
t)で図3のような位置に検出物体x〜zが検出された
と仮定する。検出物体x〜zと記憶物体a〜cとが対応
しているか否か判断するときには、図4のように各記憶
物体毎に予測位置Ppa(t)〜Ppc(t)を求め、
図5に示すようにPpa(t)〜Ppc(t)の周りに
対応付けを行う範囲a〜cを定める。これらの範囲a〜
c内で、記憶物体に最も近い検出物体をこの範囲の記憶
物体に対応付ける。この例では、記憶物体aの範囲a内
に検出物体xが存在しているため記憶物体aと検出物体
xとが対応し、記憶物体bの範囲b内に検出物体yが存
在しているため記憶物体bと検出物体yとが対応し、記
憶物体cの範囲c内には検出物体が存在していないため
記憶物体cに対応する検出物体はなく、また、結果とし
て検出物体zに対応する記憶物体もないことになる。な
お、この対応する記憶物体が存在しない検出物体に対し
ては記憶手段に記憶領域が設けられることになる。
Pp (t) = Pm (t−1) + Vp (t−1) × Δt Δt: Measurement Time Interval The determination unit 16 detects, for example, an object detected by the position detection unit 10 as follows. It is determined whether or not (for example, a car) corresponds to a storage object (for example, a car) stored in the storage unit 20. First, it is assumed that the storage unit 20 stores the position information of the storage objects a to c 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 x to z are detected at the positions shown in FIG. 3 in the next measurement (time t). When determining whether the detected objects x to z correspond to the storage objects a to c, the predicted positions Ppa (t) to Ppc (t) are obtained for each storage object as shown in FIG.
As shown in FIG. 5, ranges a to c for association are defined around Ppa (t) to Ppc (t). These ranges a to
Within c, the detected object closest to the stored object is associated with the stored object in this range. In this example, since the detected object x exists within the range a of the storage object a, the storage object a corresponds to the detected object x, and the detected object y exists within the range b of the storage object b. The storage object b and the detection object y correspond to each other, and there is no detection object in the range c of the storage object c, so that there is no detection object corresponding to the storage object c, and as a result, the detection object z corresponds. There will be no memory objects. It should be noted that a storage area is provided in the storage means for a detected object having no corresponding storage object.

【0021】対応付けを行う範囲は、検出した位置に含
まれる誤差の大きさや1回の計測で物体が移動する可能
性がある距離を考慮して決定することができる。もちろ
ん、他の要素を考慮することも可能であるし、対応付け
を行う範囲を恣意的に定めることもできる。対応付けを
行う範囲の形状も楕円や長方形等実際に行う方法に応じ
て選べば良い。
The range to be associated can be determined in consideration of the magnitude of the error included in the detected position and the distance that the object may move in one measurement. 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 operation, such as an ellipse or a rectangle.

【0022】記憶内容更新手段18では、判断手段16
の判断結果に基づき、次の処理を行う。すなわち、検出
物体と対応の取れた記憶物体については、検出された位
置Pm(t)を記憶し、他の記憶内容を更新する。検出
物体と対応の取れなかった記憶物体については、それ
が、記憶物体を記憶手段20から削除するための判定基
準を満たした場合、その記憶物体の情報を記憶手段20
から消去する。そうでなければ、予測した位置Pp
(t)を検出した位置Pm(t)として記憶し、他の記
憶内容を更新する。記憶物体と対応の取れなかった検出
物体については、所定の初期値を持った新しい記憶内容
を情報記憶手段20中に作成し、検出した位置Pm
(t)を記憶する。
In the storage content updating means 18, the judgment means 16
The following processing is performed based on the result of the determination. That is, for a storage object that is associated with the detected object, the detected position Pm (t) is stored, and the other storage contents are updated. If the storage object that does not correspond to the detected object satisfies the criterion for deleting the storage object from the storage means 20, the information of the storage object is stored in the storage means 20.
Erase from Otherwise, the predicted position Pp
(T) is stored as the detected position Pm (t), and the other stored contents are updated. For a detected object that has not been associated with a stored object, a new stored content having a predetermined initial value is created in the information storage means 20, and the detected position Pm
(T) is stored.

【0023】以下本発明の実施例を実現する具体例につ
いて図面に従って説明する。図7は、本実施例の移動物
体検出装置をコンピュータを用いて実現した車両検出装
置を示すブロック図である。図7において、車両検出装
置は、自車を基準とした他車の距離情報、角度情報等を
検出する検出装置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. 7 is a block diagram illustrating a vehicle detection device in which the moving object detection device according to the present embodiment is implemented using a computer. 7, the vehicle detection device includes a detection device 21 that detects distance information, angle information, and the like of another vehicle based on the own vehicle, and a computer 3 that performs data processing on an output signal of the detection device 21. . 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.

【0024】コンピュータ3は、検出装置21から出力
される信号を取り入れて、他車に対する距離等の情報を
演算する。コンピュータ3は、演算処理を行うCPU3
1と、外部からの信号を内部で処理可能なディジタル信
号に変換し、また、内部のディジタル信号を外部への信
号に変換する入出力インタフェース33と、一時的な記
憶手段としてのRAM35と、各種の制御プログラムや
データを格納しているROM37と、これらを接続する
データバスやコントロールバス等のバス等から構成され
ている。
The computer 3 calculates information such as the distance to another vehicle by taking in the signal output from the detecting device 21. The computer 3 is a CPU 3 that performs arithmetic processing.
1, an input / output interface 33 for converting an external signal into a digital signal which can be processed internally, and converting an internal digital signal into an external signal, a RAM 35 as a temporary storage means, ROM 37 storing control programs and data of the above, and a bus such as a data bus and a control bus for connecting these.

【0025】コンピュータ3は、図9〜図12に示すフ
ローチャートに従った処理を実行する。まず、図9のス
テップ100において検出装置21から得られた検出信
号から検出した車の現在位置を求める。車の位置は、例
えば、特開平1−213593号公報で述べられている
方法を用いることができる。この時、図8に示すよう
に、検出した他車の位置を車1、車2、・・・、車j、
・・・、車Nとする。一方、現在までに検出しRAMに
位置情報等が記憶された車、すなわち記憶物体をモデル
と呼ぶことにし、このモデルを図8に示すように、モデ
ル1、モデル2、・・・、モデルi、・・・、モデルM
とする。
The computer 3 executes processing according to the flowcharts shown in FIGS. First, in step 100 of FIG. 9, the current position of the vehicle detected from the detection signal obtained from the detection device 21 is obtained. For the position of the vehicle, for example, a method described in Japanese Patent Application Laid-Open No. 1-213593 can be used. At this time, as shown in FIG. 8, the detected positions of the other vehicles are designated as car 1, car 2,.
..., car N On the other hand, a car in which the position information and the like are detected and stored in the RAM, that is, a stored object is called a model, and this model is referred to as a model 1, a model 2,..., A model i as shown in FIG. , ..., Model M
And

【0026】次のステップ200では、RAMに記憶さ
れているモデル1〜Mの相対速度を演算し、モデルの位
置の予測を行う。この速度演算と位置予測の処理につい
て図10のフローチャートに従って詳細に説明する。
In the next step 200, the relative speeds of the models 1 to M stored in the RAM are calculated, and the positions of the models are predicted. The processing of the speed calculation and the position prediction will be described in detail with reference to the flowchart of FIG.

【0027】まず、モデルを順に調べるためのループの
実行を開始するために、モデルの番号iを所期値である
1に設定する(ステップ202)。
First, in order to start execution of a loop for sequentially examining models, the model number i is set to 1, which is an expected value (step 202).

【0028】ステップ204ではRAMに記憶されてい
るモデルの位置Pm(t−1)、Pm(t−2)、・・
・Pm(t−n)及び計測時間間隔△tを取込む。nの
値は、次のステップ206の速度演算で用いるフィルタ
の次数によって決まる。
In step 204, the model positions Pm (t-1), Pm (t-2),.
・ Pm (t−n) and the measurement time interval Δt are taken in. The value of n is determined by the order of the filter used in the speed calculation in the next step 206.

【0029】ステップ206ではモデルの速度の演算を
行う。これは以下の手順で行う。まず、前回の計測で検
出した位置Pm(t−1)と前々回の計測で検出した位
置Pm(t−2)とから、前回の計測時の相対速度は次
式で求められる。
In step 206, the speed of the model is calculated. This is performed in the following procedure. First, from the position Pm (t-1) detected in the previous measurement and the position Pm (t-2) detected in the previous measurement, the relative speed at the previous measurement is obtained by the following equation.

【0030】Vm(t−1)=(Pm(t−1)−Pm
(t−2))/△t △t:計測時間間隔 このままでは位置検出手段での検出した位置の誤差によ
る速度変動の影響が大きいので過去の相対速度の履歴か
ら適当なフィルタを用いて求めたVp(t−1)を、前
回の検出時の相対速度とする。例えば、3次の移動平均
フィルタを用いる場合、
Vm (t-1) = (Pm (t-1) -Pm
(T−2)) / Δt Δt: Measurement time interval Since the influence of the speed fluctuation due to the error of the position detected by the position detection means is large in this state, it was obtained from the past relative speed history using an appropriate filter. Let Vp (t-1) be the relative speed at the time of the previous detection. For example, when using a third-order moving average filter,

【0031】[0031]

【数3】 (Equation 3)

【0032】5次のバタワースフィルタを用いる場合、When a fifth-order Butterworth filter is used,

【0033】[0033]

【数4】 (Equation 4)

【0034】ただし、An、Bnは定数である。Here, An and Bn are constants.

【0035】上の式で、Vm(t−2)、・・・、Vp
(t−2)、・・・は、ステップ204で取り込んだモ
デルの過去の位置から演算することは可能であるが、速
度の演算結果をRAMに記憶することで毎回計算する必
要がなくなる。その場合は、ステップ204の取り込み
処理において、Vm(t−2)、・・・、Vp(t−
2)、・・・も取り込むことになる。また、速度演算の
フィルタとしてはこれらのフィルタの他にも、例えばカ
ルマンフィルタを用いる方法なども考えられる。
In the above equation, Vm (t-2),..., Vp
(T-2),... Can be calculated from the past position of the model fetched in step 204, but it is not necessary to calculate each time by storing the speed calculation result in the RAM. In that case, Vm (t-2),..., Vp (t-
2),... As a filter for speed calculation, in addition to these filters, for example, a method using a Kalman filter can be considered.

【0036】ステップ208ではモデルの位置の予測を
行う。これは次の式で計算できる。
[0036] make a prediction of the position of the model in step 208. This can be calculated by the following equation.

【0037】 Pp(t)=Pp(t−1)+Vp(t−1)×△t △t:計測時間周期 ステップ210では次のモデルについて調べるために、
i=i+1とする。ステップ212ではモデルループの
終了判定を行う。モデルループが終了していれば処理を
終了し、まだモデルループが終了していなければステッ
プ204に進む。
Pp (t) = Pp (t−1) + Vp (t−1) × Δt Δt: Measurement Time Period In step 210, to check the next model,
Let i = i + 1. In step 212, the end of the model loop is determined. If the model loop has ended, the process ends. If the model loop has not ended, the process proceeds to step 204.

【0038】図9の次のステップ300では検出した車
と、RAMに記憶されているモデルとが対応しているか
否かを判断する。この判断の詳細は図11のフローチャ
ートに示すルーチンによって実行される。このルーチン
を説明すると、まず、ステップ302で検出した車を調
べるためのループを実行するために、車の番号jを初期
値である1に設定する。次に、ステップ304でモデル
を順に調べるためのループを実行するためにモデルの番
号iを初期値である1に設定する。次に、ステップ30
6で番号jの車(車j)の対応フラグがリセットされて
いるか否かを判断し、リセットされているときには車j
に対応するモデルはまだ見つかっていないので、ステッ
プ308に進み車jとモデルiとの対応を調べ、リセッ
トされていなければ車jに対応するモデルが既に見つか
っているのでステップ330に進み、車ループを進め
る。
In the next step 300 of FIG. 9, it is determined whether or not the detected vehicle corresponds to the model stored in the RAM. The details of this determination are executed by the routine shown in the flowchart of FIG. To explain this routine, first, in order to execute a loop for examining the car detected in step 302, the number j of the car is set to 1, which is the initial value. Next, in step 304, the model number i is set to 1, which is an initial value, to execute a loop for sequentially examining the models. Next, step 30
It is determined in step 6 whether the corresponding flag of the car with the number j (vehicle j) has been reset.
Since the model corresponding to the vehicle j has not been found yet, the process goes to step 308 to check the correspondence between the vehicle j and the model i. If the model has not been reset, the model corresponding to the vehicle j has already been found and the process goes to step 330 to execute the vehicle loop. Advance.

【0039】ステップ308では車jとモデルiとの対
応を調べ、ステップ310で車jとモデルiとが対応し
ているか否か判断する。この判定は次のように行う。す
なわち、モデルiに対して対応しているか否かを判定す
る探索の範囲を決定し、その範囲内で評価値の最も高い
車jを対応がとれた物とする。その範囲内に車が存在し
ていない場合は、対応する車が計測できなかったものと
判断する。対応しているか否かを判定する探索の範囲
は、ステップ200で求めた予測位置Pp(t)を中心
とした範囲を用いればよく、モデルの持つ位置誤差等の
計測結果に従って対応しているか否かを判定する探索の
範囲を自動的に変化させることも可能である。評価値の
定め方としては、モデルiと車jとの距離が短いものほ
ど高い評価値を与える方法、モデルiと車jの位置誤差
の分散から確率的な一致度を求め、この一致度を評価値
とする方法などが考えられる。また、この実施例では位
置情報のみで評価値を定めているが、位置以外の情報、
例えば速度、車の色・形等を評価値に加えて対応してい
るか否かを判断することも可能である。
In step 308, the correspondence between the car j and the model i is checked, and in step 310, it is determined whether or not the car j and the model i correspond. This determination is made as follows. 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 one that has been handled. If no car exists within the range, it is determined that the corresponding car could not be measured. As a search range for determining whether or not the model is compatible, a range centered on the predicted position Pp (t) obtained in step 200 may be used. It is also possible to automatically change the search range for judging whether or not. As a method of determining the evaluation value, a method of giving a higher evaluation value as the distance between the model i and the car j is shorter, a stochastic matching degree from the variance of the position error between the model i and the car j, A method of setting an evaluation value is conceivable. Further, in this embodiment, the evaluation value is determined only by the position information, but information other than the position,
For example, it is also possible to determine whether or not the vehicle is supported by adding the speed, the color and the shape of the vehicle, etc. to the evaluation value.

【0040】ステップ308とステップ310とで車j
とモデルiとの対応を判定し、車jとモデルiとが対応
していればステップ312に進み、対応していなければ
ステップ326に進む。
At step 308 and step 310, the vehicle j
And the model i is determined. If the vehicle j corresponds to the model i, the process proceeds to step 312. If not, the process proceeds to step 326.

【0041】ステップ312では、モデルiの対応フラ
グがリセットされているか否かを判断することにより、
モデルiと対応する車が既に見つかっているか否かを判
断する。モデルiの対応フラグがリセットされていてモ
デルiと対応する車が見つかっていないならばステップ
322に進む。一方、既に対応した車が見つかっている
場合にはステップ314に進む。
In step 312, 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 already been found. If the corresponding flag of the model i has been reset and no car corresponding to the model i has been found, the process proceeds to step 322. On the other hand, if a corresponding car has already been found, the process proceeds to step 314.

【0042】ステップ314ではモデルiと既に対応し
ていたと判断された車とを調べる。ここでは、車j’と
対応していたものとする。
In step 314, the model i and the car determined to have already corresponded are checked. Here, it is assumed that it corresponds to the car j '.

【0043】ステップ316では、現在位置と予測位置
とに基づいて車jとモデルiとの対応の評価値である距
離L(i,j)と、車j’とモデルiとの対応の評価値
である距離L(i,j’)とを計算する。
In step 316, based on the current position and the predicted position, the distance L (i, j), which is the evaluation value of the correspondence between the car j and the model i, and the evaluation value of the correspondence between the car j 'and the model i And the distance L (i, j ′).

【0044】ステップ318では評価値の比較を行う。
もし、距離L(i,j)が距離L(i,j’)以下なら
ばステップ320に進む。一方、距離L(i,j)が距
離L(i,j’)より大きければ、ステップ326に進
む。ステップ320では、ステップ318にて距離L
(i,j)が距離L(i,j’)より小さいと判断され
たことから、車j’よりも車jの方がモデルiによく対
応している(距離が短い)ため、車j’の対応フラグを
リセットする。
In step 318, the evaluation values are compared.
If the distance L (i, j) is equal to or less than the distance L (i, j '), the process proceeds to step 320. On the other hand, if the distance L (i, j) is larger than the distance L (i, j ′), the process proceeds to step 326. In step 320, the distance L is calculated in step 318.
Since it is determined that (i, j) is smaller than the distance L (i, j '), the car j better corresponds to the model i than the car j' (the distance is shorter). 'Corresponding flag is reset.

【0045】ステップ322では、車jの対応フラグ
に、対応するモデルの番号iをセットする。そして、次
のステップ224で、モデルiの対応フラグに、対応す
る車の番号jをセットする。
At step 322, the corresponding model number i is set in the corresponding flag of the car j. Then, in the next step 224, the number j of the corresponding car is set in the corresponding flag of the model i.

【0046】ステップ326では次のモデルについて調
べるために、i=i+1とする。そしてステップ328
ではモデルループが終了したか否かの判定を行う。モデ
ルループが終了していればステップ330に進み、まだ
モデルループが終了していなければステップ306に進
んで上記の処理を繰り返す。
In step 326, i = i + 1 is set to check the next model. And step 328
Then, it is determined whether or not the model loop has ended. If the model loop has been completed, the process proceeds to step 330. If the model loop has not been completed, the process proceeds to step 306 to repeat the above processing.

【0047】ステップ330では検出した次の車につい
て調べるために、j=j+1とし、ステップ332では
車のループが終了したか否かの判定を行う。車ループが
終了していてば処理を終了し、まだ車ループが終了して
いなければステップ304に進んで上記の処理を繰り返
す。
In step 330, j = j + 1 is set in order to check the next detected vehicle. In step 332, it is determined whether or not the vehicle loop has been completed. If the car loop has ended, the process is ended. If the car loop has not ended, the process proceeds to step 304 to repeat the above process.

【0048】図9の次のステップ400ではRAM中の
車のモデルを更新する。このモデル更新のルーチンを図
12に基づいて説明する。このルーチンでは、不要なモ
デルを記憶領域から削除し、新たなモデルの記憶領域を
作成するものである。このルーチンで削除、作成をスム
ーズに行うためには、例えばモデル全体を双方向リスト
で連結すれば良い。これは、それぞれのモデルが記憶領
域中の前のモデルへのポインタと、後のモデルへのポイ
ンタを有しており、ポインタをたどることで、全てのモ
デルにアクセスすることができ、一周すると元のモデル
に戻ってくる。
In the next step 400 of FIG. 9, the model of the car in the RAM is updated. This model update 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. This is because each model has a pointer to the previous model in the storage area and a pointer to the subsequent model. By following the pointer, all models can be accessed. Come back to the model.

【0049】ステップ402ではモデルループを開始す
るために、i=1とし、ステップ404ではステップ2
00において、モデルiに対応する車が見つかったかど
うかを調べる。対応する車か見つかっていたならステッ
プ406に進み、対応する車が見つかっていなかった
ら、ステップ410に進む。
In step 402, i = 1 is set to start a model loop, and in step 404, step 2 is executed.
At 00, it is checked whether a car corresponding to the model i has been found. If a corresponding car has been found, the process proceeds to step 406. If a corresponding car has not been found, the process proceeds to step 410.

【0050】ステップ406では、モデルiに対応する
車が見つかっていないことを表す未対応フラグF(i)
を0にセットする。
At step 406, a non-correspondence flag F (i) indicating that a car corresponding to the model i has not been found.
Is set to 0.

【0051】ステップ408では、モデルiに対応する
車の検出した位置に基づいて、モデルiの現在位置Pm
i(t)をRAMに記憶し、ステップ418に進む。
In step 408, the current position Pm of the model i is determined based on the detected position of the car corresponding to the model i.
i (t) is stored in the RAM, and the flow advances to step 418.

【0052】一方、ステップ410では、モデルiに対
応する車が見つかっていないことを表す未対応フラグF
(i)に1を足す。
On the other hand, at step 410, a non-corresponding flag F indicating that no car corresponding to the model i has been found.
Add 1 to (i).

【0053】ステップ406とステップ410の操作に
より、未対応フラグF(i)は今までに連続して何回対
応が取れなかったかを表す数となる。
As a result of the operations in steps 406 and 410, the uncorrespondence flag F (i) is a number indicating the number of consecutive unsuccessful responses so far.

【0054】ステップ412では、未対応フラグがあら
かじめ定めた閾値より大きいかどうかを調べる。閾値よ
り大きければモデルiを削除するためステップ414に
進み、そうでなければステップ416に進む。
In step 412, it is checked whether the unsupported flag is larger than a predetermined threshold. If it is larger than the threshold value, the process proceeds to step 414 to delete the model i, and if not, the process proceeds to step 416.

【0055】ステップ414ではモデルの削除を行う。
ステップ416ではモデルiに対応する車が見つからな
かったことから、モデルの現在位置として予測位置Pp
i(t)を用い、 Pmi(t)=Ppi(t) とする。
In step 414, the model is deleted.
In step 416, since the vehicle corresponding to the model i was not found, the predicted position Pp is set as the current position of the model.
Using i (t), Pmi (t) = Ppi (t).

【0056】ステップ418では次のモデルについて調
べるために、i=i+1とする。ステップ420ではモ
デルループが終了したか否かの判定を行う。モデルルー
プが終了したならば、ステップ422に進む。まだルー
プが終了していないなら、ステップ404に進む。
In step 418, i = i + 1 is set to check the next model. In step 420, it is determined whether or not the model loop has ended. When the model loop ends, the process proceeds to step 422. If the loop has not ended, the process proceeds to step 404.

【0057】ステップ422では車ループを開始し、j
=1とする。ステップ424では車jに対応するモデル
があったかどうかを調べる。対応するモデルが無かった
場合は車jの対応フラグが0にセットされいるので、そ
の場合はステップ426に進む。対応するモデルがあっ
たなら対応フラグには0以外のモデルの番号が入ってい
るので、その場合にはステップ430に進む。
In step 422, a car loop is started and j
= 1. In step 424, it is checked whether or not there is a model corresponding to the car j. If there is no corresponding model, the corresponding flag of the car j is set to 0. In that case, the process proceeds to step 426. If there is a corresponding model, the corresponding flag contains a model number other than 0. In that case, the process proceeds to step 430.

【0058】ステップ426では、新たなモデルkをR
AMの記憶領域に作成し、ステップ428では車jの検
出した位置に基づいて新たに作成したモデルの現在位置
Pmk(t)をRAMに記憶する。
In step 426, the new model k is
In the storage area of the AM, in step 428, the current position Pmk (t) of the newly created model based on the detected position of the vehicle j is stored in the RAM.

【0059】ステップ430では、次の車について調べ
るために、j=j+1とする。ステップ432では車ル
ープが終了したか否かの判定を行う。まだループが終了
していないならステップ424に進み、ループが終了し
ていなければ処理を終了する。
In step 430, j = j + 1 is set to check the next vehicle. In step 432, it is determined whether or not the vehicle loop has ended. If the loop has not ended yet, the process proceeds to step 424, and if the loop has not ended, the process ends.

【0060】図6に、上記のように車モデルを使用した
場合と車モデルを使用しなかった場合との対応の判断を
比較して示す。車モデルを使用しなかった場合には、前
回観測した車の位置と今回観測した車の位置とを対応付
けるのが困難であるが、本実施例のように車モデルを使
用した場合には、移動位置を予測することによって対応
付けが容易になる。
FIG. 6 shows a comparison between the case where the car model is used as described above and the case where the car model is not used. If the car model is not used, it is difficult to associate the position of the previously observed car with the position of the car observed this time, but if the car model is used as in this embodiment, Prediction of the position facilitates association.

【0061】以上説明したように本実施例によれば次の
ような効果が得られる。 (1)速度により他車位置を予測するため、図13のよ
うに、位置のみで比較する場合より確実な対応付けが可
能になる。また、位置のみで対応付けする場合よりも計
測周期を長くでき、装置の簡素化に役立つ。
As described above, according to the present embodiment, the following effects can be obtained. (1) Since the position of the other vehicle is predicted on the basis of the speed, as shown in FIG. In addition, the measurement cycle can be made longer than in the case of associating only the position, which is useful for simplifying the apparatus.

【0062】(2)記憶物体の速度を演算している、す
なわち記憶物体の各々が既に速度情報を備えているた
め、先行車が変わった時に、新に相対速度を計算する必
要はなく、新しい先行車の相対速度が即座に得られる。
(2) Since the speed of the storage object is calculated, that is, each of the storage objects already has speed information, it is not necessary to calculate a new relative speed when the preceding vehicle changes, and a new relative speed is required. The relative speed of the preceding vehicle is immediately obtained.

【0063】(3)位置の予測を行うため、例えば、自
車の前方に左右から寄ってくる物体があれば割り込みが
あると判断でき、そのような状況での制御が可能とな
る。
(3) In order to predict the position, for example, if there is an object approaching from the left or right in front of the own vehicle, it can be determined that there is an interruption, and control can be performed in such a situation.

【0064】(4)記憶物体は、物体の検出に失敗した
場合でも存在しているものとして扱っているため、見失
い時に仮想的な先行車として扱うことができる。この場
合、先行車の相対位置が近づきつつある状況で見失った
場合にも、記憶物体の相対速度から先行車が近寄ってき
ていることがわかるので、見失い時に先行車位置を固定
して扱う方式より、安全な制御ができる。
(4) Since the stored object is treated as being present even when the detection of the object fails, it can be treated as a virtual preceding vehicle when it is lost. In this case, even if the relative position of the preceding vehicle is lost in the approaching situation, the relative speed of the stored object indicates that the preceding vehicle is approaching. , Safe control.

【0065】[0065]

【発明の効果】以上説明したように本発明によれば、記
憶物体の位置を予測し、予測位置に応じて記憶内容の変
更、消去及び新たな記憶内容の記憶を行っているため、
追跡中の移動物体が他の移動物体に切り替わることを予
測して対処することができると共に、切り替わったとき
に直ちに情報を得ることができる、という効果が得られ
る。
As described above, according to the present invention, the position of a storage object is predicted, and the storage contents are changed, deleted, and new storage contents are stored in accordance with the predicted position.
It is possible to predict that the moving object being tracked is switched to another moving object, to cope with it, and to obtain information immediately when the moving object is switched.

【図面の簡単な説明】[Brief description of the drawings]

【図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 predicted position.

【図5】記憶物体と検出物体とが対応しているか否かを
判断するための範囲を示す線図である。
FIG. 5 is a diagram showing a range for determining whether a storage object and a detected object correspond to each other.

【図6】車モデルを使用した場合と車モデルを使用しな
かった場合の対応を比較して示す線図である。
FIG. 6 is a diagram showing a comparison between a case where a car model is used and a case where a car model is not used.

【図7】本実施例の具体例を示すブロック図である。FIG. 7 is a block diagram showing a specific example of the embodiment.

【図8】RAMに記憶されたモデルと車の記憶領域を示
す線図である。
FIG. 8 is a diagram showing a model stored in a RAM and a storage area of a vehicle.

【図9】本実施例の車両検出処理ルーチンを示す流れ図
である。
FIG. 9 is a flowchart illustrating a vehicle detection processing routine according to the present embodiment.

【図10】図9のステップ200の詳細を示す流れ図で
ある。
FIG. 10 is a flowchart showing details of step 200 in FIG. 9;

【図11】図9のステップ300の詳細を示す流れ図で
ある。
FIG. 11 is a flowchart showing details of step 300 in FIG. 9;

【図12】図9のステップ400の詳細を示す流れ図で
ある。
FIG. 12 is a flowchart showing details of step 400 in FIG. 9;

【図13】従来技術を説明するための線図である。FIG. 13 is a diagram for explaining a conventional technique.

【符号の説明】[Explanation of symbols]

3 コンピュータ 21 検出装置 3 Computer 21 Detector

フロントページの続き (72)発明者 本郷 武朗 愛知県愛知郡長久手町大字長湫字横道41 番地の1 株式会社豊田中央研究所内 (72)発明者 遠藤 徳和 愛知県豊田市トヨタ町1番地 トヨタ自 動車株式会社内 (72)発明者 久保田 有一 愛知県豊田市トヨタ町1番地 トヨタ自 動車株式会社内 (56)参考文献 特開 平4−261000(JP,A) 特開 昭62−36581(JP,A) 特開 昭61−278775(JP,A) (58)調査した分野(Int.Cl.7,DB名) G08G 1/16 G08G 1/017 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 Corporation (56) References JP-A-4-261000 (JP, A) JP-A-62-36581 (JP, A) JP-A-61-278775 (JP, A) (58) Fields investigated (Int. Cl. 7 , DB name) G08G 1/16 G08G 1/017

Claims (4)

(57)【特許請求の範囲】(57) [Claims] 【請求項1】移動している物体の位置を検出する位置検
出手段と、 移動している物体と自車との相対速度を検出する速度検
出手段と、 位置情報の履歴を記憶する記憶手段と、 記憶手段に記憶された位置情報及び速度検出手段で検出
された相対速度とに基づいて物体が移動する位置を予測
する予測手段と、 位置検出手段で検出された位置と予測手段で予測された
位置とに基づいて位置が検出された移動している物体と
記憶手段に位置情報が記憶されている記憶物体とが対応
しているか否かを判断する判断手段と、 判断手段で対応していると判断された記憶物体及び判断
手段で対応していないと判断された回数が所定回未満の
記憶物体の位置情報を更新し、判断手段で対応していな
いと判断された回数が所定回以上の記憶物体の位置情報
を消去し、かつ判断手段で記憶物体と対応していないと
判断された検出物体の位置情報を記憶させる記憶内容変
更手段と、 を含む移動物体検出装置。
1. A position detecting means for detecting a position of a moving object , a speed detecting means for detecting a relative speed between the moving object and the own vehicle, and a storage means for storing a history of position information. and predicting means for the object based on the detected relative speed stored position information and the speed detecting means in the storage means to predict the location of the mobile, which is predicted by the prediction means and the detected position by the position detecting means A determination unit configured to determine whether a moving object whose position is detected based on the position and a storage object whose position information is stored in the storage unit correspond to the determination unit; The position information of the storage object determined to be unsuitable by the determination means and the number of times determined to be incompatible by the determination means is updated less than a predetermined number of times, and the number of times determined to be unsupported by the determination means is greater than or equal to the predetermined number Erase location information of stored objects And, and the moving object detection apparatus comprising: a storage content changing means for storing the position information of the detected object is determined not to correspond to the stored object in the determination means.
【請求項2】前記速度検出手段は、前記記憶手段に記憶
されている前回計測された位置、前々回計測された位
置、及び計測時間間隔から求められる速度と、フィルタ
ーとを用いて求めた速度を相対速度とする請求項1記載
の移動物体検出装置。
2. The apparatus according to claim 1, wherein said speed detecting means detects a speed obtained from a previously measured position, a position measured two times before, and a measuring time interval stored in said storage means, and a speed obtained by using a filter. 2. The moving object detecting device according to claim 1, wherein the moving speed is a relative speed.
【請求項3】前記予測手段は、前記記憶手段に記憶され
ている前回計測された位置と、前記速度検出手段で検出
された前回の相対速度とから物体が移動する位置を予測
する請求項1または2記載の移動物体検出装置。
3. The apparatus according to claim 1, wherein said predicting means predicts a position to which the object moves based on a previously measured position stored in said storage means and a previous relative speed detected by said speed detecting means. Or the moving object detection device according to 2.
【請求項4】前記判断手段は、予測位置を含む所定範囲
内の領域内に検出された位置が存在していれば、位置が
検出された検出物体と記憶手段に位置情報が記憶されて
いる記憶物体とが対応していると判断する請求項1〜3
のいずれか1項記載の移動物体検出装置。
4. If the detected position is present in an area within a predetermined range including the predicted position, the determining means stores the detected object and the position information in the storage means. 4. A method according to claim 1, wherein the storage object is determined to correspond to the storage object.
The moving object detection device according to any one of claims 1 to 7.
JP4297416A 1992-11-06 1992-11-06 Moving object detection device Expired - Fee Related JP3065822B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP4297416A JP3065822B2 (en) 1992-11-06 1992-11-06 Moving object detection device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP4297416A JP3065822B2 (en) 1992-11-06 1992-11-06 Moving object detection device

Publications (2)

Publication Number Publication Date
JPH06150196A JPH06150196A (en) 1994-05-31
JP3065822B2 true JP3065822B2 (en) 2000-07-17

Family

ID=17846229

Family Applications (1)

Application Number Title Priority Date Filing Date
JP4297416A Expired - Fee Related JP3065822B2 (en) 1992-11-06 1992-11-06 Moving object detection device

Country Status (1)

Country Link
JP (1) JP3065822B2 (en)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3995311B2 (en) * 1997-09-01 2007-10-24 富士通テン株式会社 Target recognition method in inter-vehicle distance control system
JP3327217B2 (en) * 1998-08-05 2002-09-24 三菱自動車工業株式会社 Vehicle running control method
JP4028135B2 (en) * 1999-05-27 2007-12-26 本田技研工業株式会社 Object detection device
JP4391624B2 (en) 1999-06-16 2009-12-24 本田技研工業株式会社 Object recognition device
JP4118452B2 (en) 1999-06-16 2008-07-16 本田技研工業株式会社 Object recognition device
JP3666338B2 (en) * 2000-01-20 2005-06-29 日産自動車株式会社 Vehicle travel control device
JP3791490B2 (en) 2002-12-18 2006-06-28 トヨタ自動車株式会社 Driving assistance system and device
JP3922173B2 (en) * 2002-12-18 2007-05-30 トヨタ自動車株式会社 Driving assistance system and device
JP4570907B2 (en) * 2004-05-26 2010-10-27 アルパイン株式会社 Object recognition device, navigation device, and object recognition method
JP2009256393A (en) * 2007-10-26 2009-11-05 Kibi Chemical Kk Non-flammable detergent composition
JP6074930B2 (en) * 2012-07-10 2017-02-08 株式会社デンソー Alarm device
JP6958500B2 (en) 2018-07-20 2021-11-02 株式会社デンソー Moving object detector

Also Published As

Publication number Publication date
JPH06150196A (en) 1994-05-31

Similar Documents

Publication Publication Date Title
JP3065821B2 (en) Object detection device
WO2020133449A1 (en) Target track determination method, target tracking system, and vehicle
JP3065822B2 (en) Moving object detection device
US20220001858A1 (en) Dangerous scene prediction device, dangerous scene prediction method, and dangerous scene prediction program
JP2015081083A (en) Confidence estimation for predictive driver assistance systems based on plausibility rules
KR102168288B1 (en) System and method for tracking multiple object using multi-LiDAR
US11797098B2 (en) Methods for recognizing human hand and hand gesture from human, and display apparatus
CN114323054A (en) Method and device for determining running track of automatic driving vehicle and electronic equipment
CN114296095A (en) Method, device, vehicle and medium for extracting effective target of automatic driving vehicle
CN110940979A (en) Obstacle detection method, apparatus, device, and storage medium
CN112487861A (en) Lane line recognition method and device, computing equipment and computer storage medium
CN110426714B (en) Obstacle identification method
US20210370891A1 (en) Information processing device, non-transitory computer-readable storage medium, and information processing method
Tay et al. The Bayesian occupation filter
JP2022502781A (en) Target tracking method and equipment
CN117908536A (en) Robot obstacle avoidance method, terminal equipment and computer readable storage medium
WO2020106201A1 (en) Method, Computer Program, Control Unit for Detecting Faults in a Driver-Assistance System and Vehicle
CN114475614B (en) Dangerous target screening method, dangerous target screening device, dangerous target screening medium and dangerous target screening equipment
JP3937540B2 (en) Vehicle object recognition device
CN114604274A (en) Curve target screening method, electronic equipment and storage medium
CN113470070A (en) Driving scene target tracking method, device, equipment and storage medium
KR101890482B1 (en) Appartus for distinction of stop and movement using radar spectrum and method thereof
KR102682215B1 (en) Object detection method utilizing radar point cloud
CN115782926B (en) Vehicle motion prediction method and device based on road information
JP2018018215A (en) Object feature point detector

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