JP2000028713A - Vehicle rear side monitoring method and vehicle rear side monitoring device - Google Patents
Vehicle rear side monitoring method and vehicle rear side monitoring deviceInfo
- Publication number
- JP2000028713A JP2000028713A JP10192637A JP19263798A JP2000028713A JP 2000028713 A JP2000028713 A JP 2000028713A JP 10192637 A JP10192637 A JP 10192637A JP 19263798 A JP19263798 A JP 19263798A JP 2000028713 A JP2000028713 A JP 2000028713A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- parallel
- traveling
- rear side
- candidate
- 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.)
- Granted
Links
Landscapes
- Radar Systems Or Details Thereof (AREA)
Abstract
(57)【要約】
【課題】 路肩の静止物等の非併走車両を除去して併走
車両を的確に監視する。
【解決手段】 トラック1の後側方の所定監視エリアを
監視するレーザレーダ2の出力と、トラック1の走行軌
跡を算出するジャイロ4及び車速センサ5の出力とをE
CU3で受け、ECU3に、座標系内の複数の併走車両
候補が遷移走行軌跡の近傍に有る場合はそれらの併走車
両候補をノイズとして除去し、ノイズ除去後の併走車両
候補の現在位置を推定すると共に今回の併走車両位置を
特定し、併走車両の速度及び移動方向を算出する機能を
備え、路肩の静止物等を効率良く除去すると共に、併走
車両の速度及び移動方向を正確に認識する。
(57) [Summary] [PROBLEMS] To accurately monitor a parallel traveling vehicle by removing a non-parallel vehicle such as a stationary object on a road shoulder. SOLUTION: The output of a laser radar 2 for monitoring a predetermined monitoring area on the rear side of a truck 1 and the outputs of a gyro 4 and a vehicle speed sensor 5 for calculating a running locus of the truck 1 are represented by E.
When received by the CU 3, the ECU 3 removes, as noise, the plurality of parallel vehicle candidates in the coordinate system near the transition traveling locus, and estimates the current position of the parallel vehicle candidate after noise removal. In addition, a function for calculating the speed and the moving direction of the parallel traveling vehicle is specified by specifying the position of the parallel traveling vehicle at this time, and the stationary object on the road shoulder is efficiently removed, and the speed and the traveling direction of the parallel traveling vehicle are accurately recognized.
Description
【0001】[0001]
【発明の属する技術分野】本発明は、車両の後側方に対
する併走車両の状況を監視する後側方監視装置及び後側
方監視方法に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a rear-side monitoring device and a rear-side monitoring method for monitoring the status of a parallel vehicle with respect to the rear side of the vehicle.
【0002】[0002]
【従来の技術】トラック等の大型車を含む自動車で左折
や車線変更を行なう場合、運転者はミラーにより後側方
を確認して併走車両の有無を確認している。この時、ミ
ラーによる確認では運転者が併走車両を見落としたり、
夜間や雨天等によりミラーによる後側方の確認が困難な
場合、併走車両の認識が不十分となってしまうことがあ
る。2. Description of the Related Art When making a left turn or a lane change in a vehicle including a large vehicle such as a truck, a driver checks the presence of a parallel vehicle by checking the rear side with a mirror. At this time, the driver can overlook the parallel vehicle by checking with the mirror,
When it is difficult to confirm the rear side by the mirror at night or in rainy weather, the recognition of the parallel traveling vehicle may be insufficient.
【0003】[0003]
【発明が解決しようとする課題】このため、運転者の目
視によらずに車両の後側方に対する併走車両の状況を監
視できる技術が望まれてきている。車両周囲の物体を検
知する装置としては、例えば、特開平7-229961号公報に
は、車両の後進時にレーダにより障害物の距離及び方向
を検知し、障害物と自車とをディスプレイに表示して障
害物と自車との位置関係を明確に認識する技術が示され
ている。しかし、このような技術を車両の前進走行時に
おける後側方に対する併走車両の状況の監視にそのまま
適用した場合、路肩の静止物と併走車両との識別をする
ことができず、精度良く併走車両の監視を行なうことが
不可能である。Therefore, there is a demand for a technique capable of monitoring the status of a parallel traveling vehicle with respect to the rear side of the vehicle without looking at the driver. As a device for detecting objects around the vehicle, for example, Japanese Patent Application Laid-Open No. Hei 7-229961 discloses a method in which the distance and direction of an obstacle is detected by a radar when the vehicle moves backward, and the obstacle and the vehicle are displayed on a display. There is disclosed a technology for clearly recognizing the positional relationship between an obstacle and a host vehicle. However, when such a technique is directly applied to monitoring the situation of a parallel vehicle with respect to the rear side when the vehicle is traveling forward, it is not possible to distinguish between a stationary object on the roadside and the parallel vehicle, and the parallel vehicle is not accurately determined. Is impossible to monitor.
【0004】本発明は上記状況に鑑みてなされたもの
で、路肩の静止物等の非併走車両を除去して併走車両を
的確に監視することができる後側方監視装置及び後側方
監視方法を提供することを目的とする。The present invention has been made in view of the above circumstances, and a rear side monitoring device and a rear side monitoring method capable of accurately monitoring a parallel traveling vehicle by removing a non-parallel vehicle such as a stationary object on a road shoulder. The purpose is to provide.
【0005】[0005]
【課題を解決するための手段】上記目的を達成するため
の本発明の後側方監視方法は、車両の後側方の所定監視
エリアを監視するレーダ装置の出力を車両前後方向軸と
車幅方向軸とからなる座標系に変換して併走車両候補を
検出し、自車の走行軌跡を座標系内で車幅方向軸方向に
遷移させて座標系内の複数の併走車両候補が遷移走行軌
跡の近傍にある場合はそれらの併走車両候補をノイズと
して除去し、前回検出した併走車両の位置、移動方向及
び速度からノイズ除去後の併走車両候補の現在位置を推
定し、前回検出した併走車両の位置からノイズ除去後の
併走車両候補の位置までの移動方向と前回検出した移動
方向、及び推定現在位置とノイズ除去後の併走車両候補
の位置に基づいて今回の併走車両位置を特定し、前回検
出した併走車両の位置と今回検出した併走車両の位置と
に基づき併走車両の速度及び移動方向を算出するように
し、路肩の静止物等を効率良く除去すると共に、併走車
両の速度及び移動方向を正確に認識する。According to the present invention, there is provided a rear side monitoring method for monitoring a predetermined monitoring area on a rear side of a vehicle. By converting to a coordinate system consisting of directional axes and detecting parallel traveling vehicle candidates, the traveling locus of the own vehicle is transited in the vehicle width direction axial direction in the coordinate system, and multiple concurrent traveling vehicle candidates in the coordinate system are transition traveling locus In the case of being in the vicinity of the vehicle, those parallel vehicle candidates are removed as noise, the current position of the parallel vehicle candidate after noise removal is estimated from the position, moving direction, and speed of the parallel vehicle detected last time. The current parallel vehicle position is specified based on the moving direction from the position to the position of the candidate parallel vehicle after noise removal and the previously detected moving direction, and the estimated current position and the position of the candidate parallel vehicle after noise removal. Of the parallel running vehicle Calculate the velocity and direction of movement of the adjacent parallel vehicle based on the position of the adjacent parallel vehicle detected location and time, the shoulder of the stationary object such as to efficiently remove accurately recognize the speed and direction of movement of the adjacent parallel vehicle.
【0006】また、上記目的を達成するための本発明の
後側方監視装置は、車両の後側方の所定監視エリアを監
視するレーダ装置の出力と、車両の走行軌跡を算出する
走行軌跡算出手段の出力とを制御手段で受けて車両の後
側方の併走車両を監視する際に、制御手段の機能によ
り、レーダ装置の出力を車両前後方向軸と車幅方向軸と
からなる座標系に変換して併走車両候補を検出すると共
に、自車の走行軌跡を座標系内で車幅方向に遷移させて
座標系内の複数の併走車両候補が遷移走行軌跡の近傍に
有る場合はそれらの併走車両候補をノイズとして除去
し、前回検出した併走車両の位置、移動方向及び速度か
らノイズ除去後の併走車両候補の現在位置を推定すると
共に、前回検出した併走車両の位置からノイズ除去後の
併走車両候補の位置までの移動方向と前回検出した移動
方向、及び推定現在位置とノイズ除去後の併走車両候補
の位置に基づいて今回の併走車両位置を特定し、前回検
出した併走車両の位置と今回検出した併走車両の位置と
に基づき併走車両の速度及び移動方向を算出すること
で、路肩の静止物等を効率良く除去すると共に、併走車
両の速度及び移動方向を正確に認識する。In order to achieve the above object, a rear side monitoring apparatus according to the present invention comprises: an output of a radar apparatus for monitoring a predetermined monitoring area on a rear side of a vehicle; and a travel path calculation for calculating a travel path of the vehicle. When the output of the means is received by the control means and the parallel traveling vehicle on the rear side of the vehicle is monitored, the output of the radar device is converted into a coordinate system consisting of the vehicle longitudinal axis and the vehicle width direction axis by the function of the control means. In addition to detecting the parallel traveling vehicle candidate, the traveling locus of the own vehicle is transited in the vehicle width direction in the coordinate system, and when a plurality of parallel traveling vehicle candidates in the coordinate system are in the vicinity of the transition traveling locus, the parallel traveling is performed. The vehicle candidate is removed as noise, the current position of the parallel vehicle candidate after noise removal is estimated from the position, moving direction and speed of the parallel vehicle detected last time, and the parallel vehicle after noise removal from the position of the parallel vehicle detected last time To the position of the candidate Based on the moving direction of the vehicle and the previously detected moving direction, and the estimated current position and the position of the parallel vehicle candidate after noise removal, the current parallel vehicle position is specified, and the position of the previously detected parallel vehicle and the current parallel vehicle detected By calculating the speed and moving direction of the parallel traveling vehicle based on the position, the stationary object on the road shoulder is efficiently removed, and the speed and the traveling direction of the parallel traveling vehicle are accurately recognized.
【0007】[0007]
【発明の実施の形態】図1には本発明の一実施形態例に
係る車両の後側方監視装置の概略構成を表すブロック構
成、図2にはレーザレーダの検出状況を表す概略状況、
図3には併走車両を認識するための本発明の一実施形態
例に係る車両の後側方監視方法の工程説明を示してあ
る。FIG. 1 is a block diagram showing a schematic configuration of a vehicle rear side monitoring device according to an embodiment of the present invention. FIG. 2 is a schematic diagram showing a detection status of a laser radar.
FIG. 3 shows a process description of a vehicle rear side monitoring method according to an embodiment of the present invention for recognizing a parallel vehicle.
【0008】図2に示すように、車両としてのトラック
1の運転席の側部には車両後方の所定監視エリアに向け
てレーザビームを照射するレーダ装置としてのレーザレ
ーダ2が設けられ、レーザレーダ2は例えば水平方向の
12度の範囲でスキャニングし、水平方向の12度の範
囲、垂直方向の4度の範囲の監視エリアに向けてレーザ
ビームを照射し、併走車両候補を検出するようになって
いる。As shown in FIG. 2, a laser radar 2 as a radar device for irradiating a laser beam toward a predetermined monitoring area behind the vehicle is provided on a side of a driver's seat of a truck 1 as a vehicle. 2 scans, for example, in a horizontal 12-degree range, irradiates a laser beam toward a monitoring area in a horizontal 12-degree range and a vertical 4-degree range, and detects a candidate for a parallel vehicle. ing.
【0009】図1に示すように、トラック1の制御手段
としてのECU3には、レーザレーダ2の検出情報が入
力されると共に、走行軌跡算出手段としてのジャイロ4
及び車速センサ5の情報が入力される。ECU3は、ジ
ャイロ4及び車速センサ5からの情報に基づいてトラッ
ク1の走行軌跡を算出する機能も有しており、ジャイロ
4及び車速センサ5と共に走行軌跡算出手段を構成して
いる。As shown in FIG. 1, detection information of the laser radar 2 is inputted to an ECU 3 as a control means of the truck 1 and a gyro 4 as a travel locus calculation means.
And information of the vehicle speed sensor 5 is input. The ECU 3 also has a function of calculating the traveling locus of the truck 1 based on information from the gyro 4 and the vehicle speed sensor 5, and constitutes a traveling locus calculating means together with the gyro 4 and the vehicle speed sensor 5.
【0010】ECU3では、レーザレーダ2の検出情報
及びジャイロ4、車速センサ5の入力情報に基づいて併
走車両候補を検出する共に併走車両候補からガードレー
ルの反射テープやリフレクタ等の道路形状を表す反射物
である非併走車両の情報を除去し、更に、併走車両の速
度や移動方向を算出する。The ECU 3 detects candidate parallel vehicles based on the detection information of the laser radar 2 and the input information of the gyro 4 and the vehicle speed sensor 5, and also uses a reflective object representing a road shape such as a reflective tape of a guard rail or a reflector from the candidate parallel vehicles. Is removed, and the speed and moving direction of the parallel traveling vehicle are calculated.
【0011】ECU3には、ターンシグナル6の情報が
入力され、ターンシグナル6の情報により進路変更の意
思が判断された場合に、進路変更先に併走車両が存在し
ていた際に警報7を発するようになっている。尚、図示
例では、ターンシグナル6の情報に基づいて警報7を発
するようにしたが、トラック1の減速、ハンドル角また
は横加速度等の情報に応じて進路変更の意思を判断して
警報7を発するようにしてもよい。また、警報7に代え
てランプや画像等の表示手段により併走車両の存在を表
示して認識させたり、音声により併走車両の存在を認識
させることも可能である。[0011] The information of the turn signal 6 is input to the ECU 3, and when the intention of the course change is determined based on the information of the turn signal 6, an alarm 7 is issued when a parallel vehicle exists at the course change destination. It has become. In the illustrated example, the alarm 7 is issued based on the information of the turn signal 6. However, the warning 7 is issued by determining the intention to change the course in accordance with information such as the deceleration of the truck 1, the steering wheel angle or the lateral acceleration. You may make it emit. Further, instead of the alarm 7, it is possible to display and recognize the presence of the parallel vehicle by a display means such as a lamp or an image, or to recognize the presence of the parallel vehicle by voice.
【0012】図3に示すように、ECU3では、レーザ
レーダ2の出力を車両前後方向軸(x軸)と車幅方向軸
(y軸)とからなる座標系(x−y座標系)に変換して
併走車両候補を検出するx−y座標変換(S1:併走車
両候補検出工程)を実施し、検出した検出点をx−y座
標系の中で近い検出点同士で複数のグループ(併走車両
候補)にグループ化(S2)する。次に、自車の軌跡を
x−y座標系内で車幅方向軸方向に遷移させ、x−y座
標系内の複数のグループが遷移走行軌跡の近傍にある場
合はそれらの複数のグループを非併走車両(ノイズ)と
して除去する(S3:ノイズ除去工程)。As shown in FIG. 3, the ECU 3 converts the output of the laser radar 2 into a coordinate system (xy coordinate system) composed of a vehicle longitudinal axis (x axis) and a vehicle width direction axis (y axis). Xy coordinate conversion (S1: parallel vehicle candidate detection step) for detecting parallel vehicle candidates, and the detected detection points are divided into a plurality of groups (parallel vehicles) by adjacent detection points in the xy coordinate system. (S2). Next, the trajectory of the own vehicle is transited in the vehicle width direction axial direction in the xy coordinate system, and when a plurality of groups in the xy coordinate system are near the transition traveling trajectory, the plurality of groups are changed. It is removed as a non-parallel running vehicle (noise) (S3: noise removal step).
【0013】非併走車両を除去した後、前回検出した併
走車両の位置、移動方向及び速度から併走車両の現在位
置(併走車両とされるグループの重心位置)を推定する
(S4:現在位置推定工程)。現在位置を推定した後、
ノイズ除去後の併走車両候補の中から前回検出した併走
車両と同一の併走車両を判断する(S5)。即ち、前回
検出した併走車両の位置からノイズ除去後の併走車両候
補の位置までの移動方向と前回検出した移動方向との角
度差、及び推定された現在位置からノイズ除去後の併走
車両候補の位置までの距離に基づいて、ノイズ除去後の
併走車両候補の中から前回検出した併走車両と同一のも
のを特定して今回の併走車両検出結果とする(併走車両
検出工程)。After removing the non-parallel vehicles, the current position of the parallel vehicles (the center of gravity of the group of parallel vehicles) is estimated from the position, moving direction, and speed of the parallel vehicles detected last time (S4: current position estimation step). ). After estimating your current location,
A parallel vehicle that is the same as the previously detected parallel vehicle is determined from the parallel vehicle candidates after noise removal (S5). That is, the angle difference between the moving direction from the position of the parallel vehicle detected last time to the position of the candidate parallel vehicle after noise removal and the previously detected moving direction, and the position of the candidate parallel vehicle after noise removal from the estimated current position. Based on the distance to the vehicle, the same vehicle as the previously detected parallel vehicle is specified from among the parallel vehicle candidates after noise removal, and is set as the current parallel vehicle detection result (parallel vehicle detection step).
【0014】併走車両を検出した後、前回検出した併走
車両の位置(重心位置)と今回検出して特定された併走
車両の位置(重心位置)とから、併走車両の移動方向及
び移動速度を計算する(S6)。併走車両の移動速度
は、レーザレーダ2の検出周期が一定であるため、距離
に基づいて速度が計算される。After detecting the traveling vehicle, the traveling direction and traveling speed of the traveling vehicle are calculated from the position of the traveling vehicle (center of gravity) detected last time and the position of the traveling vehicle (center of gravity) specified and detected this time. (S6). The traveling speed of the parallel traveling vehicle is calculated based on the distance since the detection cycle of the laser radar 2 is constant.
【0015】以上のS1乃至S6を実行することで、併
走車両候補を検出する共に併走車両候補からガードレー
ルの反射テープやリフレクタ等の道路形状を表す反射物
である非併走車両の情報を効率良く除去し、併走車両の
速度や移動方向を正確に算出する。図4乃至図11に基
づいてS1乃至S6の処理の詳細を説明する。By executing the above-mentioned steps S1 to S6, a candidate for a parallel vehicle is detected, and information on a non-parallel vehicle that is a reflector representing a road shape such as a reflective tape or a reflector of a guardrail is efficiently removed from the candidate parallel vehicle. Then, the speed and moving direction of the traveling vehicle are accurately calculated. Details of the processing of S1 to S6 will be described based on FIGS.
【0016】図4基づいてx−y座標変換(S1)を説
明する。図4にはx−y座標変換の概念を示してある。
図に示すように、レーザレーダ2で検出された併走車両
候補11(検出点)の車両前後方向軸(x軸)と車幅方
向軸(y軸)のx−y座標(px,py)は、レーザレーダ2
からの距離L及び角度θに基づいて、px=Lcos θ、py
=Lsin θで表すことができる。The xy coordinate conversion (S1) will be described with reference to FIG. FIG. 4 shows the concept of xy coordinate conversion.
As shown in the figure, the xy coordinates (px, py) of the vehicle longitudinal direction axis (x axis) and the vehicle width direction axis (y axis) of the parallel vehicle candidate 11 (detection point) detected by the laser radar 2 are: , Laser radar 2
Px = Lcos θ, py
= L sin θ.
【0017】図5乃至図7に基づいて複数の併走車両候
補のグループ化(S2)の手法について説明する。図5
には検出点のグループ化を実行するためのフローチャー
ト、図6にはグループ化範囲の設定状況、図7にはグル
ープ化範囲更新の設定状況を示してある。A method of grouping a plurality of parallel traveling vehicle candidates (S2) will be described with reference to FIGS. FIG.
FIG. 6 shows a flowchart for executing detection point grouping, FIG. 6 shows a setting state of the grouping range, and FIG. 7 shows a setting state of the grouping range update.
【0018】図5に示すように、ステップS11で最初
の検出点(例えばP1) のグループ化フラグが0か否かが
判断される。グループ化フラグが1の場合、他の検出点
との間でグループ化がなされた場合であるため、最初の
検出点ではグループ化フラグは0であり、ステップS1
1ではグループ化フラグは0であると判断され、ステッ
プS12で検出点(例えばP1) のグループ化フラグを1
にセットする。As shown in FIG. 5, in step S11, it is determined whether the grouping flag of the first detection point (for example, P1) is 0 or not. If the grouping flag is 1, it means that grouping has been performed with another detection point, so the grouping flag is 0 at the first detection point, and step S1 is performed.
In step 1, the grouping flag is determined to be 0, and in step S12, the grouping flag of the detection point (for example, P1) is set to 1
Set to.
【0019】ステップS12で検出点P1のグループ化フ
ラグを1にセットした後、ステップS13で最初の検出
点のグループ化範囲の初期状態を設定する。即ち、図6
に示すように、検出点(例えばP1) を中心にx軸方向に
それぞれdx(例えば2m)、y軸方向にそれぞれdy(例
えば2m)の範囲の四角形(2dx×2dy)を設定し、検
出点P1におけるグループ化範囲21とする。初期のグル
ープ化範囲21を設定した後、ステップS14で次の検
出点(例えばP2) に移行する。After setting the grouping flag of the detection point P1 to 1 in step S12, the initial state of the grouping range of the first detection point is set in step S13. That is, FIG.
As shown in the figure, a rectangle (2dx × 2dy) is set in the range of dx (for example, 2 m) in the x-axis direction and dy (for example, 2 m) in the y-axis direction around the detection point (for example, P1). The grouping range 21 in P1 is set. After setting the initial grouping range 21, the process moves to the next detection point (for example, P2) in step S14.
【0020】ステップS15では、次の検出点(例えば
P2)のグループ化フラグが0か否かが判断され、次の検
出点P2ではグループ化の判断がなされていないため、グ
ループ化フラグは0と判断される。ステップS15でグ
ループ化フラグが0であると判断されると、ステップS
16で次の検出点(例えばP2)が検出点P1におけるグル
ープ化範囲21の範囲内にあるか否かが判断される。ス
テップS16で検出点P2が検出点P1におけるグループ化
範囲21の範囲内であると判断された場合、ステップS
17でグループ化範囲21を検出点P1,P2におけるグル
ープ化範囲22に更新する。In step S15, the next detection point (for example,
It is determined whether the grouping flag of P2) is 0 or not. Since the grouping is not determined at the next detection point P2, the grouping flag is determined to be 0. If it is determined in step S15 that the grouping flag is 0, the process proceeds to step S15.
At 16, it is determined whether the next detection point (for example, P2) is within the grouping range 21 at the detection point P1. If it is determined in step S16 that the detection point P2 is within the grouping range 21 at the detection point P1,
At 17, the grouping range 21 is updated to the grouping range 22 at the detection points P1 and P2.
【0021】つまり、図7に示すように、検出点P1にお
けるグループ化範囲21内に検出点P2が存在した場合、
検出点P2を中心にx軸方向にそれぞれdx、y軸方向にそ
れぞれdyの範囲の四角形(2dx×2dy)を設定して検出
点P2のグループ化範囲21a とし、検出点P2のグループ化
範囲21a と検出点P1のグループ化範囲21とを重ね合わ
せてステップS17で新たなグループ化範囲22として
更新する。That is, as shown in FIG. 7, when the detection point P2 exists within the grouping range 21 at the detection point P1,
A square (2dx × 2dy) with a range of dx in the x-axis direction and a range of dy in the y-axis direction around the detection point P2 is set as a grouping range 21a of the detection point P2, and a grouping range 21a of the detection point P2. And the grouping range 21 of the detection point P1 are superimposed and updated as a new grouping range 22 in step S17.
【0022】ステップS17で新たなグループ化範囲2
2を更新すると、ステップS18で検出点P2のグループ
化フラグを1にセットし、ステップS19でグループ化
範囲22の重心座標P0を計算・更新する。次に、ステッ
プS20で検出点P2が最終検出点か否かが判断され、通
常検出点は多数(例えばn個)存在するため、ステップ
S14で次の検出点(例えばP3) に移行し、ステップS
15からステップS20の処理が繰り返される。In step S17, a new grouping range 2
When 2 is updated, the grouping flag of the detection point P2 is set to 1 in step S18, and the center-of-gravity coordinates P0 of the grouping range 22 is calculated and updated in step S19. Next, in step S20, it is determined whether or not the detection point P2 is the final detection point. Since there are a large number (for example, n) of normal detection points, the process proceeds to the next detection point (for example, P3) in step S14. S
The processing from step 15 to step S20 is repeated.
【0023】ステップS15で次の検出点(例えばPn)
のグループ化フラグが0ではない、即ち、既に他の検出
点との間でグループ化されていると判断された場合、ス
テップS20に移行する。また、ステップS16で次の
検出点が設定されているグループ化範囲内にはないと判
断された場合、ステップS20に移行する。In step S15, the next detection point (for example, Pn)
If the grouping flag is not 0, that is, if it is determined that the grouping has already been performed with another detection point, the process proceeds to step S20. If it is determined in step S16 that the next detection point is not within the set grouping range, the process proceeds to step S20.
【0024】ステップS20で検出点が最終検出点(例
えばPn)であると判断された場合、ステップS20で最
初の検出点P1に進み、ステップS11で最初の検出点P1
のグループ化フラグが0か否かが判断される。この時、
検出点P1のグループ化フラグは1であるので、ステップ
S22に移行して全ての検出点P1〜Pnのグループ化フラ
グが1であるか否か、即ち、全ての検出点P1〜Pnでグル
ープ化の判断がされたか否かが判断される。ステップS
22で全ての検出点P1〜Pnでグループ化の判断がされた
と判断された場合、グループ化の処理を終了する。If it is determined in step S20 that the detected point is the final detected point (for example, Pn), the process proceeds to the first detected point P1 in step S20, and proceeds to the first detected point P1 in step S11.
It is determined whether or not the grouping flag is 0. At this time,
Since the grouping flag of the detection point P1 is 1, the process proceeds to step S22 to determine whether or not the grouping flags of all the detection points P1 to Pn are 1, that is, the grouping is performed at all the detection points P1 to Pn. Is determined. Step S
If it is determined at 22 that grouping has been determined for all of the detection points P1 to Pn, the grouping process ends.
【0025】ステップS22で全ての検出点P1〜Pnのグ
ループ化フラグが1ではない、即ち、全ての検出点P1〜
Pnでグループ化の判断がされていないと判断された場
合、ステップS23で次の検出点に進み、ステップS1
1に移行して次の検出点を基準にグループ化されていな
い検出点についてグループ化の判断がなされ、全ての検
出点P1〜Pnでグループ化フラグが1にされるまで前述し
た処理を繰り返す。このようにして、検出点P1〜Pnを複
数のグループGP1 〜GPn の併走車両候補としてグループ
化する。In step S22, the grouping flags of all the detection points P1 to Pn are not 1, ie, all the detection points P1 to Pn
If it is determined that grouping has not been determined in Pn, the process proceeds to the next detection point in step S23, and step S1
The process proceeds to 1 and the grouping is determined for detection points that are not grouped based on the next detection point, and the above-described processing is repeated until the grouping flag is set to 1 at all the detection points P1 to Pn. In this way, the detection points P1 to Pn are grouped as the parallel vehicle candidates of the plurality of groups GP1 to GPn.
【0026】例えば、検出点としてP1〜P5が存在する場
合、先ず、検出点P1のグループ化フラグを1にセット
し、検出点P1を基準として検出点P2〜P5について順次グ
ループ化の判断が行なわれ、グループ化された検出点に
ついてはグループ化フラグが1にセットされる。検出点
P1を基準とした処理が終了した後は最初の検出点に戻る
が、検出点P1は既にグループ化フラグが1にセットされ
ているため、次の検出点P2に進む。検出点P2のグループ
化フラグが0であれば、検出点P2のグループ化フラグを
1にセットして検出点P2を基準としてグループ化フラグ
が0となっている残りの検出点についてグループ化の判
断の処理が行なわれる。For example, when the detection points P1 to P5 exist, the grouping flag of the detection point P1 is first set to 1, and the detection points P2 to P5 are sequentially determined to be grouped based on the detection point P1. The grouping flag is set to 1 for the grouped detection points. Detection point
After the processing based on P1 is completed, the process returns to the first detection point. However, the detection point P1 proceeds to the next detection point P2 because the grouping flag is already set to 1. If the grouping flag of the detection point P2 is 0, the grouping flag of the detection point P2 is set to 1 and the determination of grouping is performed on the remaining detection points whose grouping flag is 0 based on the detection point P2. Is performed.
【0027】検出点P2を基準としたグループ化の判断の
処理が終了した後、あるいは、検出点P1を基準としたグ
ループ化の判断の処理で検出点P2のグループ化フラグが
1にセットされている場合は、検出点P1,P2 のグループ
化フラグが1にセットされているので、検出点P3のグル
ープ化フラグが1にセットされているか否かが判断され
て、検出点P3のグループ化フラグが1にセットされてい
なければ検出点P3のグループ化フラグを1にセットして
検出点P3を基準としたグループ化の判断の処理が行なわ
れる。このような処理が繰り返されて、全ての検出点P1
〜P5のグループ化フラグが1にセットされれば、グルー
プ化の処理が終了となる。After the grouping determination process based on the detection point P2 is completed, or the grouping flag of the detection point P2 is set to 1 in the grouping determination process based on the detection point P1. If it is, the grouping flags of the detection points P1 and P2 are set to 1, and it is determined whether the grouping flag of the detection point P3 is set to 1 and the grouping flag of the detection point P3 is determined. If is not set to 1, the grouping flag of the detection point P3 is set to 1 and a process of determining grouping based on the detection point P3 is performed. Such processing is repeated, and all the detection points P1
When the grouping flags of .about.P5 are set to 1, the grouping process ends.
【0028】次に、上述したグループ化の処理で設定さ
れた複数のグループGP1 〜GPn のx−y座標系に対し、
自車の軌跡をx−y座標系内で車幅方向軸方向に遷移さ
せ、遷移させた自車の軌跡の近傍に、グループGP1 〜GP
n の中で複数のグループが存在すれば、それらの複数の
グループをガードレールの反射テープやリフレクタ等の
道路形状を表す反射物である非併走車両(ノイズ)とし
て、併走車両と誤認識しないように除去する。Next, with respect to the xy coordinate system of the plurality of groups GP1 to GPn set in the above grouping process,
The trajectory of the own vehicle is shifted in the vehicle width direction in the xy coordinate system, and groups GP1 to GP
If there are a plurality of groups in n, the groups should be recognized as non-parallel vehicles (noise) that are reflective objects that represent the road shape, such as reflective tapes and reflectors on guardrails, so as not to be mistaken as parallel vehicles. Remove.
【0029】図8、図9に基づいて非併走車両をノイズ
として除去する(S3)手法について説明する。図8、
図9には非併走車両を除去する手法を説明する概念を示
してある。図示例は、グループ化の処理で設定された4
個のグループGP1 〜GP4 の中から非併走車両を判定して
除去する例を示してある。A method of removing a non-parallel running vehicle as noise (S3) will be described with reference to FIGS. FIG.
FIG. 9 shows a concept for explaining a method of removing a non-parallel running vehicle. In the illustrated example, 4 is set in the grouping process.
An example is shown in which non-parallel vehicles are determined and removed from the groups GP1 to GP4.
【0030】図に示すように、ジャイロ4及び車速セン
サ5の情報に基づいてトラック1の走行軌跡を演算し、
例えば、過去40m分の軌跡を3次元で曲線近似した軌
跡Sとする。曲線近似した軌跡Sをx−y座標系内で車
幅方向軸方向(y軸方向:図中矢印方向)に遷移させて
遷移軌跡Tとし、遷移軌跡Tを4個のグループGP1 〜GP
4 の中の一つに重ね合わせる。グループGP1 〜GP4 の重
心点と遷移軌跡Tまでの距離を計算し、遷移軌跡Tまで
の重心点の距離がしきい値(例えば0.5m) 以内のグルー
プGP1 〜GP4 が3つ以上あれば、それらのグループを非
併走車両として除去する。As shown in the figure, the traveling locus of the truck 1 is calculated based on the information of the gyro 4 and the vehicle speed sensor 5,
For example, it is assumed that a trajectory for the past 40 m is a trajectory S obtained by performing a three-dimensional curve approximation. The locus S approximated to the curve is transited in the vehicle width direction axial direction (y-axis direction: arrow direction in the drawing) in the xy coordinate system to be a transition locus T, and the transition locus T is divided into four groups GP1 to GP.
Overlay one of the four. The distance between the center of gravity of each of the groups GP1 to GP4 and the transition trajectory T is calculated. If there are three or more groups GP1 to GP4 in which the distance between the center of gravity to the transition trajectory T is within a threshold value (for example, 0.5 m), Are removed as non-parallel vehicles.
【0031】即ち、図8に示すように、遷移軌跡Tをグ
ループGP1 の重心点に合わせた場合、他のグループGP2
〜GP4 の重心点は遷移軌跡Tから離れており、しかも、
遷移軌跡Tまでの距離がしきい値以内のグループは存在
しない。これにより、グループGP1 を非併走車両ではな
い、即ち、併走車両であると認識する。That is, as shown in FIG. 8, when the transition locus T is adjusted to the center of gravity of the group GP1, the other group GP2
The center of gravity of ~ GP4 is far from the transition locus T, and
There is no group whose distance to the transition locus T is within the threshold. As a result, it is recognized that the group GP1 is not a non-parallel vehicle, that is, a group vehicle.
【0032】また、図9に示すように、遷移軌跡Tをグ
ループGP2 の重心点に合わせた場合、グループGP3,GP4
の重心点が遷移軌跡Tのしきい値以内となり、遷移軌跡
Tまでの距離がしきい値以内のグループがグループGP2
と合わせて3個となる。これにより、グループGP2 〜GP
4 は、トラック1の走行軌跡に略沿って存在する反射物
等であると推測され、グループGP2 〜GP4 を非併走車両
であると認識して除去する。As shown in FIG. 9, when the transition trajectory T is set to the center of gravity of the group GP2, the groups GP3 and GP4
Is within the threshold of the transition locus T, and the group whose distance to the transition locus T is within the threshold is group GP2.
And three in total. As a result, the groups GP2 to GP
4 is presumed to be a reflector or the like existing substantially along the traveling locus of the truck 1, and the groups GP2 to GP4 are recognized as non-parallel vehicles and removed.
【0033】以上により、複数のグループGP1 〜GP4 か
らグループGP2 〜GP4 を非併走車両であると認識して除
去し、グループGP1 を併走車両であると認識する。グル
ープGP2 〜GP4 を非併走車両として除去した後、前回検
出した併走車両の位置、移動方向及び速度からグループ
GP1 の現在位置(重心位置)を推定する(S4)。即
ち、前回併走車両として認識された各グループGPに対
し、その重心位置と移動方向、移動速度から今回の併走
車両(グループGP1 )の現在位置の重心位置を推定す
る。As described above, the groups GP2 to GP4 are recognized and removed from the plurality of groups GP1 to GP4 as non-parallel vehicles, and the group GP1 is recognized as a parallel vehicle. After removing groups GP2 to GP4 as non-parallel vehicles, the group, position, direction and speed of the
The current position (centroid position) of GP1 is estimated (S4). That is, the center of gravity of the current position of the current parallel vehicle (group GP1) is estimated from the center of gravity, the moving direction, and the moving speed of each group GP recognized as the parallel vehicle last time.
【0034】今回の併走車両の現在の重心位置を推定し
た後、前回検出した併走車両と今回推定された併走車両
が同一の併走車両であることを判断する(S5)。図1
0に基づいて同一の併走車両を判断する手法について説
明する。図10には同一の併走車両を判断する手法を説
明する概念を示してある。After estimating the current position of the center of gravity of the parallel vehicle this time, it is determined that the parallel vehicle detected last time and the parallel vehicle estimated this time are the same parallel vehicle (S5). FIG.
A method for determining the same parallel vehicle based on 0 will be described. FIG. 10 shows a concept for explaining a method of determining the same parallel traveling vehicle.
【0035】図に示すように、グループ化の処理で設定
された今回の各グループ(例えば、グループGPa,GP
b)に対し、推定した重心位置との差(d-dist-a,d-dist
-b) 及び移動方向の差(d-dir-a,d-dir-b) から、同一度
(iden-rate) を下式(1) で計算し、推定されたグループ
が前回のどのグループと同一対象であるかを判断する。
即ち、同一度の最も高いものを同一対象物として特定す
る。 (iden-rate)=(dist-rate)*k+(dir-rate)・・・(1) 但し、k は、例えば、1.5 程度に設定された重み付けの
係数、(dist-rate) は、1.0-(d-dist)/(dist-th)で、(d
ist-th) は、例えば、2m、(dir-rate)は、1.0-(d-di
r)/180である。As shown in the figure, each group (for example, groups GPa, GPa) set this time in the grouping process
b), the difference from the estimated position of the center of gravity (d-dist-a, d-dist
-b) and the difference in movement direction (d-dir-a, d-dir-b),
(iden-rate) is calculated by the following equation (1), and it is determined whether the estimated group is the same as the previous group.
That is, the object having the highest degree of identity is specified as the same object. (iden-rate) = (dist-rate) * k + (dir-rate) ・ ・ ・ (1) where k is, for example, a weighting coefficient set to about 1.5, and (dist-rate) is 1.0- In (d-dist) / (dist-th), (d
ist-th) is, for example, 2m, (dir-rate) is 1.0- (d-di
r) / 180.
【0036】ここで、同一対象であるかの判断に、重心
位置との差(d-dist)に加え、移動方向の差(d-dir) を加
味した理由を図11に基づいて説明する。図11には重
心位置との差でのみ同一の併走車両を判断した場合の概
念を示してある。The reason why the difference in the moving direction (d-dir) in addition to the difference (d-dist) from the position of the center of gravity is added to the determination as to whether or not the objects are the same will be described with reference to FIG. FIG. 11 shows a concept in the case where the same parallel traveling vehicle is determined only by the difference from the position of the center of gravity.
【0037】図に示すように、グループ化の処理で設定
された今回の各グループ(例えば、グループGPa,GP
b)の移動方向が互いに逆になっている場合、グループ
GPaの推定位置の重心に対して今回のグループGPa,GP
bの重心位置の差(d-dist-a,d-dist-b) をみると、グル
ープGPbとの差(d-dist-b)の方がグループGPaとの差(d
-dist-a)よりも小さい場合がある。このような場合、重
心位置の差(d-dist-a,d-dist-b) だけで同一の併走車両
を判断すると、今回のグループGPbが前回のグループGP
aと同一であると判断されてしまう。移動方向の差(d-d
ir) を加味することにより、今回のグループGPaが前回
のグループGPaと同一であると判断されるようになる。As shown in the figure, each of the current groups (eg, groups GPa, GPa) set in the grouping process
If the movement directions of b) are opposite to each other, the group
This group GPa, GP with respect to the center of gravity of the estimated position of GPa
Looking at the difference (d-dist-a, d-dist-b) in the position of the center of gravity of b, the difference (d-dist-b) from the group GPb is the difference (d-dist-b) from the group GPa.
-dist-a). In such a case, if the same parallel vehicle is determined based only on the difference (d-dist-a, d-dist-b) of the center of gravity, the current group GPb becomes the previous group GPb.
It is determined that they are the same as a. Movement direction difference (dd
By adding ir), it is determined that the current group GPa is the same as the previous group GPa.
【0038】従って、移動方向の差(d-dir) を加味する
ことで、精度良く同一の併走車両の位置を特定すること
ができる。Therefore, by taking into account the difference (d-dir) in the moving direction, the position of the same parallel traveling vehicle can be specified with high accuracy.
【0039】今回の各グループGPに対し、前回のグルー
プGPとの同一対象を判断した後、前回のグループGPの重
心位置と今回のグループGPの重心位置とから、今回のグ
ループGP(同一対象となった併走車両)の移動方向及び
移動速度を計算する(S6)。併走車両の移動速度は、
レーザレーダ2の検出周期が一定であるため、距離に基
づいて速度が計算される。After determining the same target as the previous group GP for each of the current group GPs, the current group GP (the same target as the same target) is determined from the center of gravity position of the previous group GP and the center of gravity of the current group GP. Then, the moving direction and the moving speed of the parallel traveling vehicle are calculated (S6). The traveling speed of the traveling vehicle is
Since the detection cycle of the laser radar 2 is constant, the speed is calculated based on the distance.
【0040】以上の処理により、レーザレーダ2で検出
した併走車両候補の中から実際の併走車両の情報を精度
良く誤認識なしに特定することができ、進路変更時等に
進路変更先に併走車両が存在していた際に警報7を確実
に発することができる。With the above processing, the information of the actual parallel vehicle can be specified accurately from the parallel vehicle candidates detected by the laser radar 2 without erroneous recognition. The alarm 7 can be reliably issued when is present.
【0041】上述した車両の後側方監視装置及び車両の
後側方監視方法では、トラック1の後側方の所定監視エ
リアを監視するレーザレーダ2の検出情報をx−y座標
系に変換して併走車両候補を検出し、ジャイロ4及び車
速センサ5の出力情報により自車の走行軌跡Sを求め、
走行軌跡をx−y座標系内でy軸方向に遷移させてx−
y座標系内の複数の併走車両候補が遷移軌跡Tの近傍に
ある場合は、それらの併走車両候補をノイズとして除去
するので、自車の走行軌跡Sに略対応して配列される路
肩の静止物等を効率良く除去できる。In the vehicle rear side monitoring device and the vehicle rear side monitoring method described above, the detection information of the laser radar 2 for monitoring a predetermined monitoring area on the rear side of the truck 1 is converted into an xy coordinate system. To determine the traveling locus S of the own vehicle from the output information of the gyro 4 and the vehicle speed sensor 5,
The traveling locus is shifted in the y-axis direction in the xy
When a plurality of parallel vehicle candidates in the y coordinate system are near the transition trajectory T, these parallel vehicle candidates are removed as noise. Objects and the like can be efficiently removed.
【0042】また、上述した車両の後側方監視装置及び
車両の後側方監視方法では、前回の併走車両の位置から
ノイズを除去した後の併走車両候補の位置までの移動方
向と前回の併走車両の移動方向との角度差、及び併走車
両の推定現在位置からノイズ除去後の併走車両候補の位
置までの距離に基づいて今回の併走車両位置を特定する
ようにしたので、併走車両候補の中から前回と同一の併
走車両の現在位置を的確に特定することができ、同時
に、速度及び移動方向を正確に算出することができる。In the above-described vehicle rear side monitoring device and the vehicle rear side monitoring method, the moving direction from the position of the preceding parallel vehicle to the position of the candidate for the parallel vehicle after removing noise and the previous parallel running Since the current position of the parallel vehicle is specified based on the angle difference from the moving direction of the vehicle and the distance from the estimated current position of the parallel vehicle to the position of the parallel vehicle candidate after noise removal, Thus, it is possible to accurately specify the current position of the same parallel vehicle as the previous time, and at the same time, it is possible to accurately calculate the speed and the moving direction.
【0043】[0043]
【発明の効果】本発明の車両の後側方監視方法及び車両
の後側方監視装置は、車両の後側方の所定監視エリアを
監視するレーダ装置の出力を車両前後方向軸と車幅方向
軸とからなる座標系に変換して併走車両候補を検出し、
自車の軌跡を座標系内で車幅方向軸方向に遷移させて遷
移走行軌跡に応じて非併走車両をノイズとして除去する
ので、自車の走行軌跡に略対応して配列される路肩の静
止物等を効率良く除去できる。According to the method for monitoring the rear side of a vehicle and the rear side monitoring device of the vehicle according to the present invention, the output of a radar device for monitoring a predetermined monitoring area on the rear side of the vehicle is controlled by using a vehicle front-rear axis and a vehicle width direction. Convert to a coordinate system consisting of axes and detect parallel vehicle candidates,
Since the trajectory of the own vehicle is shifted in the vehicle width direction in the coordinate system and non-co-running vehicles are removed as noise according to the transition trajectory, stationary road shoulders arranged substantially corresponding to the trajectory of the own vehicle Objects and the like can be efficiently removed.
【0044】また、ノイズ除去後の併走車両候補までの
移動方向と前回検出した移動方向、及び推定現在位置と
ノイズ除去後の併走車両候補の位置に基づいて今回の併
走車両位置を特定し、併走車両の速度及び移動方向を算
出するようにしたので、併走車両候補の中から前回と同
一の併走車両の現在位置を的確に特定することができる
と共に、併走車両の速度及び移動方向を正確に認識する
ことができる。Further, the current parallel vehicle position is specified based on the moving direction to the parallel vehicle candidate after noise removal and the previously detected moving direction, and the estimated current position and the position of the parallel vehicle candidate after noise removal. Since the speed and moving direction of the vehicle are calculated, the current position of the same parallel vehicle as the previous one can be accurately specified from among the candidate vehicles, and the speed and moving direction of the parallel vehicle can be accurately recognized. can do.
【0045】この結果、路肩の静止物等の非併走車両を
除去して併走車両を的確に監視することが可能となる。As a result, it is possible to accurately monitor the parallel running vehicle by removing the non-parallel running vehicle such as a stationary object on the road shoulder.
【図1】本発明の一実施形態例に係る車両の後側方監視
装置の概略構成を表すブロック図。FIG. 1 is a block diagram illustrating a schematic configuration of a vehicle rear side monitoring device according to an embodiment of the present invention.
【図2】レーザレーダの検出状況を表す概略図。FIG. 2 is a schematic diagram showing a detection situation of a laser radar.
【図3】併走車両を認識するための本発明の一実施形態
例に係る車両の後側方監視方法の工程説明図。FIG. 3 is a process explanatory view of a method for monitoring a rear side of a vehicle according to an embodiment of the present invention for recognizing a parallel traveling vehicle;
【図4】x−y座標変換の概念図。FIG. 4 is a conceptual diagram of xy coordinate conversion.
【図5】検出点のグループ化を実行するためのフローチ
ャート。FIG. 5 is a flowchart for executing detection point grouping.
【図6】グループ化範囲の設定状況説明図。FIG. 6 is an explanatory diagram of a setting status of a grouping range.
【図7】グループ化範囲更新の設定状況説明図。FIG. 7 is an explanatory diagram of a setting status of grouping range update.
【図8】非併走車両を除去する手法を説明する概念図。FIG. 8 is a conceptual diagram illustrating a method for removing a non-parallel running vehicle.
【図9】非併走車両を除去する手法を説明する概念図。FIG. 9 is a conceptual diagram illustrating a method of removing a non-parallel running vehicle.
【図10】同一の併走車両を判断する手法を説明する概
念図。FIG. 10 is a conceptual diagram illustrating a method of determining the same parallel traveling vehicle.
【図11】重心位置との差でのみ同一の併走車両を判断
した場合の概念図。FIG. 11 is a conceptual diagram in the case where the same parallel running vehicle is determined only based on the difference from the position of the center of gravity.
1 トラック 2 レーザレーダ 3 ECU 4 ジャイロ 5 車速センサ 6 ターンシグナル 7 警報 11 併走車両候補 S 走行軌跡 T 遷移軌跡 Reference Signs List 1 track 2 laser radar 3 ECU 4 gyro 5 vehicle speed sensor 6 turn signal 7 alarm 11 parallel running candidate S running locus T transition locus
Claims (2)
るレーダ装置の出力を車両前後方向軸と車幅方向軸とか
らなる座標系に変換して併走車両候補を検出する併走車
両候補検出工程と、 自車の走行軌跡を前記座標系内で車幅方向軸方向に遷移
させて座標系内の複数の併走車両候補が遷移走行軌跡の
近傍にある場合はそれらの併走車両候補をノイズとして
除去するノイズ除去工程と、 前回検出した併走車両の位置、移動方向及び速度からノ
イズ除去後の併走車両候補の現在位置を推定する現在位
置推定工程と、 前回検出した併走車両の位置からノイズ除去後の併走車
両候補の位置までの移動方向と前回検出した移動方向、
及び前記推定現在位置とノイズ除去後の併走車両候補の
位置に基づいて今回の併走車両位置を特定する併走車両
検出工程と、 前回検出した併走車両の位置と今回検出した併走車両の
位置とに基づき併走車両の速度及び移動方向を算出する
併走車両状態算出工程と、 を備えたことを特徴とする車両の後側方監視方法。1. A parallel vehicle candidate detection system for converting an output of a radar device for monitoring a predetermined monitoring area on the rear side of a vehicle into a coordinate system including a vehicle longitudinal direction axis and a vehicle width direction axis to detect a parallel vehicle candidate. Steps, the traveling locus of the own vehicle is transited in the vehicle width direction axial direction in the coordinate system, and when a plurality of parallel traveling vehicle candidates in the coordinate system are near the transition traveling locus, those parallel traveling vehicle candidates are regarded as noise. A noise removal process for removing, a current position estimation process for estimating a current position of a candidate for a parallel vehicle after noise removal from a position, a moving direction, and a speed of the parallel vehicle detected last time; The moving direction up to the position of the parallel vehicle candidate and the moving direction detected last time,
And a parallel vehicle detection step of specifying the current parallel vehicle position based on the estimated current position and the position of the parallel vehicle candidate after noise removal, based on the position of the parallel vehicle detected previously and the position of the parallel vehicle detected this time. A parallel vehicle status calculating step of calculating a speed and a moving direction of the parallel vehicle, and a rear side monitoring method of the vehicle, comprising:
るレーダ装置と、前記車両の走行軌跡を算出する走行軌
跡算出手段と、前記レーダ装置の出力と前記走行軌跡算
出手段の出力とを受けて車両の後側方の併走車両を監視
する制御手段とを有し、 前記制御手段には、 前記レーダ装置の出力を車両前後方向軸と車幅方向軸と
からなる座標系に変換して併走車両候補を検出すると共
に、自車の走行軌跡を前記座標系内で車幅方向に遷移さ
せて座標系内の複数の併走車両候補が遷移走行軌跡の近
傍に有る場合はそれらの併走車両候補をノイズとして除
去し、 前回検出した併走車両の位置、移動方向及び速度からノ
イズ除去後の併走車両候補の現在位置を推定すると共
に、前回検出した併走車両の位置からノイズ除去後の併
走車両候補の位置までの移動方向と前回検出した移動方
向、及び前記推定現在位置とノイズ除去後の併走車両候
補の位置に基づいて今回の併走車両位置を特定し、前回
検出した併走車両の位置と今回検出した併走車両の位置
とに基づき併走車両の速度及び移動方向を算出する機能
が備えられていることを特徴とする車両の後側方監視装
置。2. A radar device for monitoring a predetermined monitoring area on a rear side of a vehicle, a traveling locus calculating means for calculating a traveling locus of the vehicle, and an output of the radar device and an output of the traveling locus calculating means. Control means for receiving and monitoring a parallel vehicle on the rear side of the vehicle, wherein the control means converts the output of the radar device into a coordinate system consisting of a vehicle longitudinal axis and a vehicle width direction axis. In addition to detecting concurrently traveling vehicle candidates, the traveling locus of the own vehicle is shifted in the vehicle width direction in the coordinate system, and when a plurality of concurrently traveling vehicle candidates in the coordinate system are near the transition traveling locus, those concurrently traveling vehicle candidates are Is removed as noise, the current position of the parallel vehicle candidate after noise removal is estimated from the position, moving direction, and speed of the parallel vehicle detected last time, and the parallel vehicle candidate after noise removal is estimated from the position of the parallel vehicle detected last time. Up to position Based on the moving direction and the previously detected moving direction, and the estimated current position and the position of the parallel vehicle candidate after the noise removal, the current parallel vehicle position is specified, and the position of the parallel vehicle detected previously and the position of the parallel vehicle detected this time are determined. A rear side monitoring device for a vehicle, comprising a function of calculating a speed and a moving direction of a parallel traveling vehicle based on a position.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP19263798A JP3424908B2 (en) | 1998-07-08 | 1998-07-08 | Vehicle rear side monitoring method and vehicle rear side monitoring device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP19263798A JP3424908B2 (en) | 1998-07-08 | 1998-07-08 | Vehicle rear side monitoring method and vehicle rear side monitoring device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2000028713A true JP2000028713A (en) | 2000-01-28 |
| JP3424908B2 JP3424908B2 (en) | 2003-07-07 |
Family
ID=16294573
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP19263798A Expired - Fee Related JP3424908B2 (en) | 1998-07-08 | 1998-07-08 | Vehicle rear side monitoring method and vehicle rear side monitoring device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3424908B2 (en) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002098758A (en) * | 2000-07-25 | 2002-04-05 | Daimlerchrysler Ag | Method and device for finding position of automobile with respect to traveling lane |
| JP2003098256A (en) * | 2001-09-26 | 2003-04-03 | Nissan Motor Co Ltd | Obstacle map generator for vehicles |
| JP2009145121A (en) * | 2007-12-12 | 2009-07-02 | Toyota Motor Corp | Object detection device |
| WO2016009945A1 (en) * | 2014-07-16 | 2016-01-21 | 株式会社デンソー | Vehicle-mounted radar device, notification system, and traveling vehicle detection method of vehicle-mounted radar device |
| US20160061935A1 (en) * | 2014-08-28 | 2016-03-03 | Google Inc. | Methods and Systems for Vehicle Radar Coordination and Interference Reduction |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH05180933A (en) * | 1991-12-27 | 1993-07-23 | Honda Motor Co Ltd | Method for estimating position of concerning obstacle from vehicle |
| JPH07104062A (en) * | 1993-09-30 | 1995-04-21 | Honda Motor Co Ltd | Collision prevention device |
| JPH0883400A (en) * | 1994-08-24 | 1996-03-26 | Delco Electron Corp | Vehicle obstacle identification system |
| JPH08124080A (en) * | 1994-10-20 | 1996-05-17 | Honda Motor Co Ltd | Vehicle obstacle detection device |
| JPH08240660A (en) * | 1995-03-01 | 1996-09-17 | Honda Motor Co Ltd | A method for recognizing an object in a vehicle |
| JPH09318740A (en) * | 1996-05-31 | 1997-12-12 | Denso Corp | Obstacle recognizing apparatus for vehicle |
-
1998
- 1998-07-08 JP JP19263798A patent/JP3424908B2/en not_active Expired - Fee Related
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH05180933A (en) * | 1991-12-27 | 1993-07-23 | Honda Motor Co Ltd | Method for estimating position of concerning obstacle from vehicle |
| JPH07104062A (en) * | 1993-09-30 | 1995-04-21 | Honda Motor Co Ltd | Collision prevention device |
| JPH0883400A (en) * | 1994-08-24 | 1996-03-26 | Delco Electron Corp | Vehicle obstacle identification system |
| JPH08124080A (en) * | 1994-10-20 | 1996-05-17 | Honda Motor Co Ltd | Vehicle obstacle detection device |
| JPH08240660A (en) * | 1995-03-01 | 1996-09-17 | Honda Motor Co Ltd | A method for recognizing an object in a vehicle |
| JPH09318740A (en) * | 1996-05-31 | 1997-12-12 | Denso Corp | Obstacle recognizing apparatus for vehicle |
Cited By (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002098758A (en) * | 2000-07-25 | 2002-04-05 | Daimlerchrysler Ag | Method and device for finding position of automobile with respect to traveling lane |
| JP2003098256A (en) * | 2001-09-26 | 2003-04-03 | Nissan Motor Co Ltd | Obstacle map generator for vehicles |
| JP2009145121A (en) * | 2007-12-12 | 2009-07-02 | Toyota Motor Corp | Object detection device |
| WO2016009945A1 (en) * | 2014-07-16 | 2016-01-21 | 株式会社デンソー | Vehicle-mounted radar device, notification system, and traveling vehicle detection method of vehicle-mounted radar device |
| JP2016023949A (en) * | 2014-07-16 | 2016-02-08 | 株式会社デンソー | On-vehicle radar device and notification system |
| CN106574969A (en) * | 2014-07-16 | 2017-04-19 | 株式会社电装 | Vehicle-mounted radar device, notification system, and traveling vehicle detection method of vehicle-mounted radar device |
| US20160061935A1 (en) * | 2014-08-28 | 2016-03-03 | Google Inc. | Methods and Systems for Vehicle Radar Coordination and Interference Reduction |
| US9720072B2 (en) * | 2014-08-28 | 2017-08-01 | Waymo Llc | Methods and systems for vehicle radar coordination and interference reduction |
| US10698082B2 (en) | 2014-08-28 | 2020-06-30 | Waymo Llc | Methods and systems for vehicle radar coordination and interference reduction |
| US11237245B2 (en) | 2014-08-28 | 2022-02-01 | Waymo Llc | Methods and systems for vehicle radar coordination and interference reduction |
| US12196878B2 (en) | 2014-08-28 | 2025-01-14 | Waymo Llc | Methods and systems for vehicle radar coordination and interference reduction |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3424908B2 (en) | 2003-07-07 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4906398B2 (en) | In-vehicle road shape identification device, in-vehicle system, road shape identification method and periphery monitoring method | |
| KR20220054278A (en) | Travelling track prediction method and device for vehicle | |
| JP3603018B2 (en) | Electric vehicle control device | |
| JP3791490B2 (en) | Driving assistance system and device | |
| JP2019128612A (en) | Vehicle control device, vehicle control method, and program | |
| CN110942623A (en) | Auxiliary traffic accident handling method and system | |
| US11273825B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
| JPH10221451A (en) | Radar equipment for vehicles | |
| JPWO2019065564A1 (en) | Automatic operation control device and method | |
| JP3356058B2 (en) | Rear monitor system for vehicles | |
| WO2021053763A1 (en) | Driving assistance device, driving assistance method, and program | |
| CN114734995A (en) | Collision avoidance system and collision avoidance method | |
| US12084082B2 (en) | Determination device, vehicle control device, determination method, and storage medium | |
| JP2017073008A (en) | Vehicle driving support system and driving support method | |
| JP2022139009A (en) | Driving support device, driving support method and program | |
| JP2022103505A (en) | Vehicle control devices, vehicle control methods, and programs | |
| US12337832B2 (en) | Driving assistance apparatus | |
| JP3424908B2 (en) | Vehicle rear side monitoring method and vehicle rear side monitoring device | |
| US11702078B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
| JP2020129331A (en) | Reverse run determination system, reverse run determination method, and reverse run determination program | |
| JP7083768B2 (en) | Recognition device, vehicle control device, recognition method, and program | |
| US12497030B2 (en) | Driving assist apparatus | |
| US12024171B2 (en) | Moving object control device, moving object control method, and storage medium | |
| US11801838B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
| JP2020051943A (en) | Stereo camera device for vehicles |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20030401 |
|
| S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
| R371 | Transfer withdrawn |
Free format text: JAPANESE INTERMEDIATE CODE: R371 |
|
| S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080502 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090502 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100502 Year of fee payment: 7 |
|
| LAPS | Cancellation because of no payment of annual fees |