JP5103722B2 - Stop vehicle discrimination device - Google Patents
Stop vehicle discrimination device Download PDFInfo
- Publication number
- JP5103722B2 JP5103722B2 JP2005282150A JP2005282150A JP5103722B2 JP 5103722 B2 JP5103722 B2 JP 5103722B2 JP 2005282150 A JP2005282150 A JP 2005282150A JP 2005282150 A JP2005282150 A JP 2005282150A JP 5103722 B2 JP5103722 B2 JP 5103722B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- stop
- stopped
- determination
- detected
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Traffic Control Systems (AREA)
- Radar Systems Or Details Thereof (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
Description
本発明は、自車両前方の物体が停止車両であるか否かを判別する停止車両判別装置に関するものである。 The present invention relates to a vehicle stops determination equipment which the vehicle ahead of the object to determine whether the vehicle is stopped.
従来の停止車両判別装置としては、スキャニング式レーザレーダにて検出した、自車両前方の物体を示す複数の検出点(検出点群)に基づいて、自車両前方の物体が走行車両であるか停止物であるか、停止物であるときには標識等の停止物体であるか停止車両であるかを判別するというものが知られている(例えば、特許文献1参照)。
このとき、停止物体であるか停止車両であるかの判別は、自車両前方の物体を示す検出点群の検出点数、検出点と自車両との距離、及び検出点の端部幅から算出されるデータ充填率に基づいて行っている。
At this time, whether the vehicle is a stopped object or a stopped vehicle is calculated from the number of detection points of the detection point group indicating the object ahead of the host vehicle, the distance between the detection point and the host vehicle, and the end width of the detection point. This is based on the data filling rate.
ところで、スキャニング式レーザレーダには、水平方向のレーザビーム幅の細い(主にリフレクタ反射を検出する:リフレクタ反射式レーザ)タイプのものと、レーザビーム幅の広い(主にボディ反射を検出する:ボディ反射式レーザ)タイプのものがある。上記リフレクタ反射式レーザは、水平方向のレーザビーム幅が細いことから、ボディ反射式レーザに比べて高分解能且つ高価であることが特徴である。 By the way, there are two types of scanning laser radars: one with a narrow horizontal laser beam width (mainly reflector reflection detection: reflector reflection laser) and one with a wide laser beam width (mainly body reflection detection: (Body reflection type laser) type. The reflector reflection type laser is characterized in that it has a high resolution and is expensive compared to the body reflection type laser because the horizontal laser beam width is narrow.
上記従来の停止車両判別装置では、スキャニング式レーザレーダにて検出した検出点数に基づいて停止車両の判別を行っているので、レーザビーム幅の広いタイプのスキャニング式レーザレーダを適用した場合、その受光感度の高さから、特に自車両から遠方に存在する物体の停止車両判別精度が悪いという未解決の課題がある。また、レーザビーム幅の細いタイプのリフレクタ反射式レーザを適用した場合、コストが嵩むという未解決の課題がある。
そこで、本発明は、高分解能のレーザレーダを用いなくても、自車両前方の物体が停止車両であるか否かを、精度良く判別することができる停止車両判別装置を提供することを課題としている。
In the conventional stopped vehicle discrimination device, the stop vehicle is discriminated based on the number of detection points detected by the scanning laser radar. Therefore, when a scanning laser radar of a wide laser beam type is applied, the light reception is detected. Due to the high sensitivity, there is an unsolved problem that the accuracy of determining a stopped vehicle of an object existing far away from the host vehicle is particularly poor. Moreover, when a reflector type laser having a narrow laser beam width is applied, there is an unsolved problem that the cost increases.
The present invention, without using a laser radar of high resolution, problems that the vehicle ahead of the object whether the vehicle stops, to provide a stop vehicle discrimination equipment which can accurately determine It is said.
上記課題を解決するために、本発明に係る停止車両判別装置は、物体検出手段で自車両前方の物体を検出し、横幅取得手段で、前記物体検出手段で検出された検出物体の横幅を取得し、停止判断手段で、前記前方物体が停止していることを判断し、閾値設定手段で、自車両と前記停止判断手段で停止していると判断された停止物との距離に基づいて停止車両判別閾値を設定し、停止車両判別手段で、その停止物の横幅と前記閾値設定手段で設定された停止車両判別閾値とを比較することで、当該停止物が車両であるか否かを判別する停止車両判別処理を行う。
また、閾値設定手段は、停止車両判別閾値として、上限閾値と下限閾値とを設定するものであり、自車両と前記停止物との距離が遠ざかるほど、下限閾値を大きく設定する。そして、停止車両判別手段は、前記停止物の横幅が前記上限閾値及び前記下限閾値の範囲に適合すると判断されたとき、当該停止物が車両であると判別する。
In order to solve the above-described problem, the stopped vehicle determination device according to the present invention detects an object ahead of the host vehicle with the object detection unit, and acquires the width of the detected object detected with the object detection unit with the width acquisition unit. The stop determining means determines that the front object is stopped, and the threshold setting means stops based on the distance between the host vehicle and the stopped object determined to be stopped by the stop determining means. A vehicle determination threshold is set, and the stop vehicle determination means determines whether the stop is a vehicle by comparing the width of the stop with the stop vehicle determination threshold set by the threshold setting means. A stop vehicle discrimination process is performed.
The threshold value setting means sets an upper limit threshold value and a lower limit threshold value as the stop vehicle determination threshold value, and sets the lower limit threshold value larger as the distance between the host vehicle and the stopped object increases. Then, the stop vehicle determining means determines that the stop object is a vehicle when it is determined that the lateral width of the stop object matches the range of the upper limit threshold value and the lower limit threshold value.
本発明によれば、自車両と自車両前方の停止物との距離に基づいて、その停止物の横幅と比較するための停止車両判別閾値を設定するので、例えば、自車両と前記停止物との距離が遠ざかるほどレーザビームの広がりが大きくなって物体検知の不確かさが増すことを考慮して前記停止車両判別閾値を設定することができ、自車両前方の停止物が物体であるか車両であるかの判別を精度良く行うことができるという効果が得られる。 According to the present invention, based on the distance between the host vehicle and the stop in front of the host vehicle, the stop vehicle determination threshold value for comparison with the lateral width of the stop is set. The stop vehicle discrimination threshold can be set in consideration of the fact that the laser beam spread increases and the object detection uncertainty increases as the distance of the vehicle increases. There is an effect that it is possible to accurately determine whether there is any.
以下、本発明の実施の形態を図面に基づいて説明する。
(第1の実施の形態)
(構成)
図1は本発明の実施形態における停止車両判別装置を適用した車両の概略構成図であり、図中符号1は自車両前方の物体を検知するための、例えばスキャニング式のレーザレーダである。図2は、本実施形態における停止車両判別装置の構成を示すブロック図であり、このレーザレーダ1が物体検出手段101に対応している。
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
(First embodiment)
(Constitution)
FIG. 1 is a schematic configuration diagram of a vehicle to which a stopped vehicle discriminating apparatus according to an embodiment of the present invention is applied.
そして、このレーザレーダ1の走査結果は、レーダ処理装置2に入力され、ここで、レーザレーダ1によって検出した一つ又は複数の物体に対して、各物体の状態量として、自車両を原点とする二次元座標値、つまり、車間距離方向及び車幅方向における座標値が算出されると共に、検知物体の幅(大きさ)が算出される。これが横幅取得手段に対応している。そして、これら算出結果は、外界認識装置10に入力される。このレーザレーダ1及びレーダ処理装置2が状態量検出手段に対応している。
Then, the scanning result of the
また、車両の適所には、自車両前方を撮像し、自車両前方の状況を高速に把握するための物体検出手段としての、例えばプログレッシブスキャン式の3CCDカメラ等で構成される撮像装置3が搭載され、この撮像装置3の撮像結果は画像処理装置4に入力される。この画像処理装置4では、レーダ処理装置2で捕捉したレーダ検知物体の位置座標付近を注目領域としておき、自車両のピッチング変動等によってレーダ検知物体をロストした場合に、カメラ画像によりロストしたレーダ検知物体を検知し続ける等の処理を行う。そして、この画像処理装置4での検知結果は、外界認識装置10に入力される。なお、レーザレーダ1が物体を検知できない走行状況では、前記3CCDカメラの撮像データを画像処理することによる前方物体検知が実施される。
In addition, an
また、この車両には、自車両の走行状態を検出するためのセンサとして、従動輪の左右車輪速度を検出する車速センサ5や、前輪操舵角を検出する操舵角センサ6が搭載され、これらセンサの検出値は、前記外界認識装置10に入力される。これら車速センサ5、操舵角センサ6で図2の走行状態検出手段102を構成している。
そして、前記外界認識装置10では、後述する停止車両判別処理によって、レーダ処理装置2で捕捉した各物体が、路側構造物であるか停止車両であるかを判断し、その物体が自車両にとって障害物であるか否かを判断する。そして、その物体が自車両にとって障害物であり、自車両がこの障害物と接触する可能性があると判定される場合には、必要に応じて自動ブレーキ制御装置12に制動指令を出力する。この自動ブレーキ制御装置12では、外界認識装置10からの制動指令に応じて負圧ブレーキブースタ14のソレノイドバルブに制動力指令電圧を印加することで負圧ブレーキブースタ14を作動し、各車輪に制動力を付与して当該障害物との接触を回避するようになっている。
Further, this vehicle is equipped with a
Then, the external
この自動ブレーキ制御装置12及び負圧ブレーキブースタ14が走行制御手段に対応している。
なお、前記レーダ処理装置2や、画像処理装置4、外界認識装置10、自動ブレーキ制御装置12は、マイクロコンピュータ等の演算処理装置とその周辺機器、並びに、各アクチュエータを駆動するための駆動回路等を備えており、互いに通信回路を介して情報を送受信できるようになっている。
The automatic
The
次に、前記外界認識装置10で実行される停止車両判別処理を、図3に示すフローチャートをもとに説明する。
この停止車両判別処理は、所定時間(例えば、100msec)毎のタイマ割込み処理として実行され、先ず、ステップS1で各種データを読み込む。具体的には、車速センサ5で検出された自車速Vsp、操舵角センサ6で検出された操舵角Stを読み込む。
Next, the stopped vehicle determination process executed by the external
This stop vehicle determination process is executed as a timer interrupt process at predetermined time intervals (for example, 100 msec). First, various data are read in step S1. Specifically, the host vehicle speed Vsp detected by the
次に、ステップS2に移行して、将来の自車走行進路として、曲率半径の逆数Row[1/m]を、次式をもとに算出し、ステップS3に移行する。
Row=1/{(1+A・Vsp2・LWB)/St} ………(1)
ここで、Aは車両固有の値であるスタビリティファクタ(車重、ホイールベース長、重心位置、タイヤの横力で決まる定数)、LWBはホイールベース長、Stは操舵角(右切りがプラス)である。
Next, the process proceeds to step S2, and a reciprocal number of the curvature radius Row [1 / m] is calculated based on the following equation as a future own vehicle traveling route, and the process proceeds to step S3.
Row = 1 / {(1 + A · Vsp 2 · L WB ) / St} (1)
Here, A is a stability factor (a constant determined by the vehicle weight, wheelbase length, center of gravity, and tire lateral force), LWB is the wheelbase length, and St is the steering angle (right turn is a plus). ).
ステップS3では、レーザレーダ1で検出された物体の位置(横方向位置Px_z0[i],前後方向位置Py_z0[i])及び物体の幅(大きさ)objW_z0[i]を読み込み、ステップS4に移行する。ここで、_z0とは、今回のサンプリングにおける検出値であることを意味し、前回のサンプリングにおける検出値は_z1とする。また、[i]は検知物体ごとに割り付けられるID番号を意味しており、i≧0である。
In step S3, the object position (lateral position Px_z0 [i], front / rear direction position Py_z0 [i]) and object width (size) objW_z0 [i] detected by the
ステップS4では、レーザレーダ1で検出された各物体について、自車両との相対速度(横方向相対速度rVx_z0[i],前後方向相対速度rVy_z0[i])を、次式で表される伝達関数G(Z)により算出する。
G(Z)=(cZ2−c)/(Z2−aZ+b) ………(2)
ここで、Zは進み演算子である。また、係数a,b,cは正数であり、これらは所望の擬似微分特性を有するようにサンプリング周期100msで離散化されたものである。また、本実施形態における相対速度の符号は、負の場合を、前後方向=自車両と接近方向、横方向=自車進行方向に対して右側方向とする。
In step S4, the relative speed (lateral relative speed rVx_z0 [i], longitudinal relative speed rVy_z0 [i]) with respect to the subject vehicle for each object detected by the
G (Z) = (cZ 2 −c) / (Z 2 −aZ + b) (2)
Here, Z is a lead operator. The coefficients a, b, and c are positive numbers, and these are discretized at a sampling period of 100 ms so as to have a desired pseudo-differential characteristic. Further, the sign of the relative speed in the present embodiment is that the negative direction is the front-rear direction = the approach direction of the host vehicle, and the lateral direction = the right direction with respect to the traveling direction of the host vehicle.
次に、ステップS5に移行して、レーザレーダ1で検出された各物体が停止物であるか移動物(走行車両)であるかを判定する。この判定は、各物体の相対速度rVy_z0[i]と自車速Vspとの差分値ΔV[i]の絶対値が属性判別閾値Th以下であるか否かによって行い、ΔV[i]≦Thである場合には、その物体は停止物であると判定する。ここで、属性判別閾値Thは、次式で示されるような特性を有するものとする。
Th=HysTh+Kdw・Vsp ………(3)
ここで、HysThは、停止物と移動物との判定結果が安定するように、停止物から移動物に判定する場合とその逆の場合とでヒステリシスを付与することを意味する変数であり、Kdwは、動回転半径の変動による自車速Vspの誤差(実車速と計測車速との差)の最大見積もり値である。
Next, the process proceeds to step S5, and it is determined whether each object detected by the
Th = HysTh + Kdw · Vsp (3)
Here, HysTh is a variable that means adding hysteresis in the case of determining from a stationary object to a moving object and vice versa so that the determination result of the stationary object and the moving object becomes stable, and Kdw Is the maximum estimated value of the error (the difference between the actual vehicle speed and the measured vehicle speed) of the host vehicle speed Vsp due to the fluctuation of the dynamic rotation radius.
上記(3)式からも明らかなように、自車速Vspが大きくなるほど属性判別閾値Thは大きく設定されるので、自車両前方の検知物体が停止物であると判断する条件が緩和されて、当該検知物体が停止物であると判断されやすくなる。高速走行時には、人間の感覚として、停止車両に対する制御と極低速走行車両に対する制御とを同じにしても違和感がないため、停止車両と極低速走行車両とを区別する必要がない。そのため、自車速Vspが高くなるほど自車両前方の検知物体を停止物であると判断し易くすることで、停止車両を走行車両であると誤判別させるより極低速走行車両を停止車両であると判別させて、運転者への誤判別に対する違和感を低減することができる。
なお、Kdwは、本来の動回転半径の変動に対して数倍以上の大きなゲインであっても良い。このように、動回転半径の変動以上に閾値を停止車両と判定し易くすることで、運転者への誤判別に対する違和感を低減することができる。
As is clear from the above equation (3), the attribute determination threshold Th is set to be larger as the host vehicle speed Vsp increases. Therefore, the condition for determining that the detected object ahead of the host vehicle is a stop object is relaxed, and It becomes easier to determine that the detected object is a stopped object. When traveling at high speed, there is no sense of incongruity even if the control for the stopped vehicle and the control for the extremely low speed traveling vehicle are the same as human senses, so there is no need to distinguish between the stopped vehicle and the extremely low speed traveling vehicle. Therefore, by making it easier to determine that the detected object ahead of the host vehicle is a stopped object as the host vehicle speed Vsp increases, it is determined that the extremely low-speed traveling vehicle is a stopped vehicle rather than misidentifying the stopped vehicle as a traveling vehicle. In this way, it is possible to reduce a sense of incongruity with misjudgment to the driver.
Note that Kdw may be a large gain that is several times greater than the original fluctuation of the dynamic rotational radius. Thus, by making it easier to determine that the threshold value is a stopped vehicle than the fluctuation of the dynamic rotation radius, it is possible to reduce a sense of incongruity for misjudgment to the driver.
次に、ステップS6では、各検知物体が自車両の走行予想進路内に存在する可能性Reco[i]を、次式をもとに算出する。
Reco[i]=func1(Px_z0[i],Py_z0[i],Row) ………(4)
ここで、func1(X,Y,R)は、図4に表される特性を有する関数であり、検知物体が自車両の走行予想進路内に存在する可能性が大きいほど、Reco[i]の値は大きく算出される。
Next, in step S6, the possibility Reco [i] that each detected object exists in the predicted travel path of the host vehicle is calculated based on the following equation.
Reco [i] = func1 (Px_z0 [i], Py_z0 [i], Row) (4)
Here, func1 (X, Y, R) is a function having the characteristics shown in FIG. 4, and the greater the possibility that the detected object is in the predicted travel path of the host vehicle, the greater the value of Reco [i]. The value is greatly calculated.
次に、ステップS7では、各検知物体の選別を行う。具体的には、前記ステップS5の判定結果により停止物であると判断された検知物体と、移動物であると判断された検知物体とを選別し、停止物であると判断された検知物体に対しては後述するステップS10以降の処理を施し、移動物であると判断された検知物体に対してはステップS8以降の処理を施すようにする。 Next, in step S7, each detected object is selected. Specifically, the detected object determined to be a stopped object and the detected object determined to be a moving object are selected based on the determination result of step S5, and the detected object determined to be a stopped object is selected. On the other hand, the process after step S10 mentioned later is performed, and the process after step S8 is performed with respect to the detected object judged to be a moving object.
ステップS8では、検知物体の属性フラグAttrObjCar[i]を、次式に示すように、物体が走行車両として属性付けされたことを意味する“2”に設定してステップS9に移行する。ここで、属性フラグAttrObjCar[i]は、初期状態は路側構造物に相当する“0”に属性付けされているものとする。
AttrObjCar[i]=2 ………(5)
ステップS9では、微分演算などで用いる変数の過去値を更新してからタイマ割込み処理を終了する。
In step S8, the attribute flag AttrObjCar [i] of the detected object is set to “2” indicating that the object is attributed as a traveling vehicle, as shown in the following equation, and the process proceeds to step S9. Here, it is assumed that the attribute flag AttrObjCar [i] is attributed to “0” corresponding to the roadside structure in the initial state.
AttrObjCar [i] = 2 (5)
In step S9, the timer interrupt process is terminated after updating the past value of the variable used in the differential operation or the like.
また、ステップS10では、各検知物体が自車両の走行予想進路内に存在するか否かを判定する。この判定は、前記ステップS6で算出されたReco[i]が所定の進路内判断閾値Th_OwnLaneより大きいか否かによって行い、Reco[i]>Th_OwnLaneであるときには、その検知物体が自車両の走行予想進路内に存在すると判断して後述するステップS12に移行し、Reco[i]≦Th_OwnLaneであるときには、その検知物体が自車両の走行予想進路内に存在しないと判断してステップS11に移行する。ここで、進路内判断閾値Th_OwnLaneは、1未満の正数である。 Further, in step S10, it is determined whether or not each detected object is present in the predicted travel path of the host vehicle. This determination is made based on whether or not Reco [i] calculated in step S6 is greater than a predetermined in-track determination threshold Th_OwnLane. If Reco [i]> Th_OwnLane, the detected object is the predicted travel of the host vehicle. If it is determined that the detected object exists in the course, the process proceeds to step S12 described later. If Reco [i] ≦ Th_Ownlane, it is determined that the detected object does not exist in the predicted travel path of the host vehicle, and the process proceeds to step S11. Here, the in-course determination threshold Th_OwnLane is a positive number less than 1.
ステップS11では、検知物体の属性フラグAttrObjCar[i]を、次式に示すように、物体が路側構造物として属性付けされたことを意味する“0”に設定して前記ステップS9に移行する。
AttrObjCar[i]=0 ………(6)
ところで、レーダの視野角端に物体が存在する場合、その物体がレーダ視野内に完全に収まらないために、正確な物体幅を検知できない場合がある。また、レーダによる物体幅の検出精度は、自車両の正面ほど高くなる。そのため、前記ステップS10の判定結果により、検知物体が自車両の走行予想進路内に存在しないと判断したときには、その検知物体を路側構造物として属性付けすることで、物体の正確な大きさを検知できずに誤った停止車両判別を行ってしまうことを回避することができると共に、レーザの信頼性の高い検知状態で停止車両判別を行うことができる。
In step S11, the attribute flag AttrObjCar [i] of the detected object is set to “0” which means that the object is attributed as a roadside structure as shown in the following expression, and the process proceeds to step S9.
AttrObjCar [i] = 0 (6)
By the way, when an object is present at the viewing angle end of the radar, the object does not completely fit in the radar field of view, so that an accurate object width may not be detected. Further, the accuracy of detecting the object width by the radar becomes higher as the front of the host vehicle. Therefore, when it is determined from the determination result of step S10 that the detected object does not exist in the predicted traveling path of the host vehicle, the detected object is attributed as a roadside structure to detect the exact size of the object. It is possible to avoid erroneous stop vehicle discrimination without being possible, and to make stop vehicle discrimination in a highly reliable detection state of the laser.
また、自車走行車線外の遠方に存在する物体の脇を自車両が通過する際に、その物体は自車両の走行予想進路内に存在しなくても、位置精度の低下により自車進路上に侵入してくるものと誤った判断がなされる可能性があるが、この可能性を考慮して、自車両の走行進路外に存在する物体を停止車両であると判別しないことで、位置精度の低下が生じた場合の走行制御システムにおける誤作動や誤警報を軽減することができる。なお、ここで、走行制御システムにおける制御や警報などは、そのタイミングや制御量を“車両”であるか“非車両”であるかに応じて変更する一般的なシステムを用いるものとする。 In addition, when the host vehicle passes by an object that is far away from the host vehicle lane, even if the object does not exist in the predicted driving path of the host vehicle, the position accuracy decreases and the vehicle However, in consideration of this possibility, it is not possible to determine that an object that exists outside the traveling path of the host vehicle is a stopped vehicle. It is possible to reduce malfunctions and false alarms in the travel control system in the event of a drop in Here, it is assumed that a general system that changes the timing and control amount according to whether it is “vehicle” or “non-vehicle” is used for the control and alarm in the travel control system.
ステップS12では、各検知物体に対して、停止物体であるか停止車両であるかの判別に用いる停止物判別閾値の下限閾値Th_Width1[i]及び上限閾値Th_Width2[i]を、次式をもとに算出する。
Th_Width1[i]=W1+func2(Py_z0[i]),
Th_Width2[i]=W2−func2(Py_z0[i]) ………(7)
ここで、func2(Y)は、図5に示すような特性を有する関数である。この図5に示すように、func2(Y)の値は自車両と検知物体との前後方向距離Yに比例して大きくなるように設定されている。これにより、自車両と検知物体との距離Yが大きいほど、停止物判別閾値の下限閾値Th_Width1[i]は大きく、上限閾値Th_Width2[i]は小さく算出されることになる。
In step S12, for each detected object, the lower threshold Th_Width1 [i] and the upper threshold Th_Width2 [i] of the stop object determination threshold used for determining whether the object is a stopped object or a stopped vehicle are expressed by the following equations. To calculate.
Th_Width1 [i] = W1 + func2 (Py_z0 [i]),
Th_Width2 [i] = W2-func2 (Py_z0 [i]) (7)
Here, func2 (Y) is a function having characteristics as shown in FIG. As shown in FIG. 5, the value of func2 (Y) is set so as to increase in proportion to the front-rear direction distance Y between the host vehicle and the detected object. As a result, the lower limit threshold Th_Width1 [i] of the stop object determination threshold is larger and the upper limit threshold Th_Width2 [i] is smaller as the distance Y between the host vehicle and the detected object is larger.
また、W1,W2は、夫々小型車両の車幅と大型車両の車幅に相当する定数を意味しており、仕向け地によって変更するようにしてもよい。このように、停止物判別閾値Th_Width1[i]及びTh_Width2[i]は、検知物体の横幅と比較するための閾値である。
次に、ステップS13に移行して、検知された停止物が停止車両であるか否かを判定する。この判定は、検知物体の横幅objW_z0[i]が、前記ステップS12で算出された停止物判別閾値Th_Width1[i]及びTh_Width2[i]の範囲内に適合するか否かによって行い、Th_Width1[i]<objW_z0[i]<Th_Width2[i]であるときには、その物体は停止車両であると判断して後述するステップS14に移行する。一方、Th_Width1[i]≧objW_z0[i]又はTh_Width2[i]≦objW_z0[i]であるときには、その物体は路側構造物であると判断して前記ステップS11に移行する。
W1 and W2 mean constants corresponding to the vehicle width of the small vehicle and the vehicle width of the large vehicle, respectively, and may be changed depending on the destination. As described above, the stop object determination threshold values Th_Width1 [i] and Th_Width2 [i] are threshold values for comparison with the width of the detected object.
Next, it transfers to step S13 and it is determined whether the detected stop is a stop vehicle. This determination is performed based on whether or not the width objW_z0 [i] of the detected object is within the range of the stop object determination thresholds Th_Width1 [i] and Th_Width2 [i] calculated in Step S12, and Th_Width1 [i]. When <objW_z0 [i] <Th_Width2 [i], it is determined that the object is a stopped vehicle, and the process proceeds to step S14 described later. On the other hand, when Th_Width1 [i] ≧ objW_z0 [i] or Th_Width2 [i] ≦ objW_z0 [i], it is determined that the object is a roadside structure, and the process proceeds to Step S11.
図6は、レーザレーダ1の不確かさと停止物判別閾値との関係を示す図であり、横軸に自車両と検知物体との縦位置(前後方向距離)、縦軸に検知物体の横幅と比較するための停止物判別閾値をとっている。ここで、前述したように、W1は小型車両の車幅、W2は大型車両の車幅であり、平均的な車両の車幅は、このW1からW2までの範囲の値となる。
FIG. 6 is a diagram showing the relationship between the uncertainty of the
レーザレーダ1のビームの分解能に依存した不確かさは、自車両と検知物体との距離Yが大きくなるほど大きくなる。つまり、図6の破線に示すように、自車両との距離Yが零であるときには不確かさも零であるが、自車両との距離Yが大きくなるほど、例えば横幅W1の物体をレーザレーダ1で検知した場合、その検出値には最大ΔW1の誤差が生じる。
The uncertainty depending on the beam resolution of the
したがって、本実施形態のように、検知物体と自車両との距離が大きくなるほど、停止物判別閾値の下限閾値Th_Width1[i]と上限閾値Th_Width2[i]との差を最大値(W2−W1)から徐々に小さくすることで、自車両から遠方に存在する物体に対して、より確実な方向に上記不確かさの影響を排除することができる。
このとき、各閾値Th_Width1[i]及びTh_Width2[i]の自車両と検知物体と距離に対する変化率は、符号が逆で絶対値が同じとし、その絶対値は、レーザレーダ1の水平方向の分解能に基づいて定める。これにより、レーザレーダの設計仕様に応じた適切な閾値を設定することができる。
Therefore, as in the present embodiment, the difference between the lower limit threshold Th_Width1 [i] and the upper limit threshold Th_Width2 [i] of the stop object determination threshold becomes the maximum value (W2-W1) as the distance between the detected object and the host vehicle increases. From the above, it is possible to eliminate the influence of the uncertainty in a more reliable direction with respect to an object that is far away from the host vehicle.
At this time, the rate of change of each threshold Th_Width1 [i] and Th_Width2 [i] with respect to the own vehicle, the detected object, and the distance is assumed to have the same sign but the absolute value is the same as the resolution in the horizontal direction of the
また、ステップS14では、検知物体の属性フラグAttrObjCar[i]を、次式に示すように、物体が停止車両として属性付けされたことを意味する“1”に設定して前記ステップS9に移行する。
AttrObjCar[i]=1 ………(8)
図3の処理において、ステップS4及びS5の処理が停止判断手段に対応し、ステップS6及びS10の処理が判別許可手段に対応し、ステップS12の処理が閾値設定手段に対応し、ステップS13の処理が停止車両判別手段に対応している。
In step S14, the attribute flag AttrObjCar [i] of the detected object is set to “1” indicating that the object is attributed as a stopped vehicle, as shown in the following equation, and the process proceeds to step S9. .
AttrObjCar [i] = 1 (8)
In the process of FIG. 3, the processes in steps S4 and S5 correspond to the stop determination means, the processes in steps S6 and S10 correspond to the discrimination permission means, the process in step S12 corresponds to the threshold setting means, and the process in step S13. Corresponds to the stop vehicle discrimination means.
すなわち、図2に示すように、物体検出手段101で検出した前方物体の相対速度と、走行状態検出手段102で検出した自車速とに基づいて、停止判断手段103で、物体検出手段101で検出した物体が停止しているか否かを判断する。また、走行状態検出手段102で検出した自車両の走行状態(自車速及び操舵角)と、物体検出手段101で検出した前方物体の位置とに基づいて、判別許可手段104で、前記停止判断手段103で停止していると判断された物体に対する停止車両判別処理の実行を許可するか否かを判断する。さらに、物体検出手段101で検出した前方物体の自車両までの距離基づいて、閾値設定手段105で、物体検出手段101の検出結果に含まれる不確かさを反映した、検出物体の横幅に関する閾値を設定する。そして、これら停止判断手段103、判別許可手段104及び閾値設定手段105からの出力と、物体検出手段101で検出した前方物体の横幅とに基づいて、停止車両判別手段106で、自車両前方の停止物が物体であるか車両であるかを判別する。
That is, as shown in FIG. 2, based on the relative speed of the front object detected by the
(動作)
次に、本発明の第1の実施形態の動作について説明する。
今、図7に示すように、自車両MCが直線路LMを走行中であり、自車前方の停止車両N0(i=0)、路側構造物N1(i=1)及びN2(i=2)をレーザレーダ1で検知しているものとする。この場合、物体N0は自車走行レーンLM内に存在しているため、Reco[0]>Th_OwnLaneとなって、図3のステップS10の判定結果によりステップS12に移行する。このステップS12では、図8に示す物体N0の自車両MCとの前後方向距離Py_z0[0]に応じて、停止物判別閾値の下限閾値Th_Width1[0]がW1とほぼ等しいW1N0に、上限閾値Th_Width2[0]がW2とほぼ等しいW2N0に算出される。そして、Th_Width1[0]<objW_z0[0](=α)<Th_Width2[0]であり、物体N0の幅が停止物判別閾値に適合しているため、この物体N0が停止車両であると判断され、自動ブレーキ制御の対象となる。
(Operation)
Next, the operation of the first embodiment of the present invention will be described.
Now, as shown in FIG. 7, the vehicle MC is traveling on a straight road L M, the vehicle ahead of the vehicle is stopped N0 (i = 0), roadside structures N1 (i = 1) and N2 (i = 2) is detected by the
また、物体N1は、自車走行レーンLM内に存在していないため、Reco[1]≦Th_OwnLaneとなって、ステップS10の判定結果によりステップS11に移行する。このように、自車走行レーン内に存在しない物体は、路側構造物であると判断されて自動ブレーキ制御の対象としないので、自動ブレーキ制御が作動してしまうことに起因する運転者の違和感を防止することができる。 Further, the object N1 is because it does not exist in the current lane in L M, becomes Reco [1] ≦ Th_OwnLane, the process proceeds to step S11 by the determination result of step S10. In this way, since an object that does not exist in the vehicle lane is determined to be a roadside structure and is not subject to automatic brake control, the driver feels uncomfortable due to the automatic brake control being activated. Can be prevented.
また、物体N2は、自車走行レーンLM内に存在しているため、Reco[2]>Th_OwnLaneとなって、ステップS10の判定結果によりステップS12に移行する。このステップS12では、図8に示す物体N2の自車両MCとの前後方向距離Py_z0[2]に応じて、停止物判別閾値の下限閾値Th_Width1[2]がW1より大きいW1N2に、上限閾値Th_Width2[2]がW2より大きいW2N2に算出される。そして、この物体N2の大きさobjW_z0[2](=α)が下限閾値Th_Width1[2]から上限閾値Th_Width2[2]までの範囲内にないことから、この物体N2は路側構造物であると判断され、自動ブレーキ制御の対象外となる。このように、物体N0と物体N2とは同じ大きさであるが、物体N0は停止車両、物体N2は停止物体として判断される。 Further, the object N2 is because it is present in current lane in L M, becomes Reco [2]> Th_OwnLane, the process proceeds to step S12 by the determination result of step S10. In step S12, the lower limit threshold Th_Width1 [2] of the stop object determination threshold is set to W1 N2 greater than W1 and the upper limit threshold Th_Width2 according to the front-rear direction distance Py_z0 [2] of the object N2 shown in FIG. [2] is calculated to be W2 N2 larger than W2. Since the size objW_z0 [2] (= α) of the object N2 is not within the range from the lower limit threshold Th_Width1 [2] to the upper limit threshold Th_Width2 [2], it is determined that the object N2 is a roadside structure. Therefore, it is not subject to automatic brake control. Thus, although the object N0 and the object N2 are the same size, it is determined that the object N0 is a stopped vehicle and the object N2 is a stopped object.
レーザレーダ1と検知物体との前後方向距離が大きいほどビーム幅の広がりは大きくなるため、物体幅の検出値に誤差が生じやすい。そのため、実際は停止物判別閾値に適合しない路側構造物が、物体幅の検出誤差により停止車両であると誤って判断される可能性がある。
これに対して、本実施形態では、自車両前方の検知物体(停止物)と自車両との距離に基づいて停止車両判別閾値を設定するので、レーザレーダのビーム幅の広がりにより、停止物と自車両との距離が遠ざかるほど物体幅の検出精度が悪化することを考慮して停止物判別閾値を設定することができる。すなわち、検知物体と自車両との前後方向距離が大きいほど、レーザレーダ1のビーム幅の照射に関する不確かさが大きいとして、停止物判別閾値の上限閾値と下限閾値との差を小さく設定するので、実際の物体幅に対して生じる誤差を加味した(物体検出手段の検出結果に含まれる不確かさを反映した)閾値を設定することができる。
As the distance in the front-rear direction between the
On the other hand, in this embodiment, the stop vehicle discrimination threshold is set based on the distance between the detected object (stop object) ahead of the host vehicle and the host vehicle. The stop object determination threshold can be set in consideration of the fact that the detection accuracy of the object width deteriorates as the distance from the host vehicle increases. That is, the larger the distance in the front-rear direction between the detected object and the vehicle, the greater the uncertainty regarding the irradiation of the beam width of the
その結果、レーザレーダの検出誤差により自車両から遠方の停止物体N2の横幅が、偶然平均的な車幅であるW1からW2までの範囲内に適合してしまった場合であっても、停止車両であると誤判別することを抑制することができ、レーザレーダのビーム幅の広がりを不確かさとして考慮してより高精度な停止車両判別を行うことができる。 As a result, even if the lateral width of the stopped object N2 far from the own vehicle accidentally fits within the range from W1 to W2, which is the average vehicle width, due to the detection error of the laser radar, the stopped vehicle Therefore, it is possible to prevent the vehicle from being misidentified and to determine the stopped vehicle with higher accuracy in consideration of the spread of the beam width of the laser radar as an uncertainty.
(第1の実施形態の効果)
(1)自車両前方の停止物の横幅と、閾値設定手段で自車両とその停止物との距離に基づいて設定される停止車両判別閾値とを比較することで、停止車両判別手段が、その停止物が車両であるか否かを判別する。
したがって、物体検出手段による検出結果の不確かさを反映した閾値を用いて、適切に停止車両判別処理を行うことができる。その結果、ビーム幅の細い高分解能レーザレーダ(リフレクタ反射式レーザ)を用いなくても、高精度で停止車両判別を行うことができる。
(Effects of the first embodiment)
(1) By comparing the lateral width of the stop ahead of the host vehicle and the stop vehicle determination threshold set based on the distance between the host vehicle and the stop by the threshold setting unit, the stop vehicle determination unit It is determined whether or not the stopped object is a vehicle.
Therefore, the stopped vehicle discrimination process can be appropriately performed using the threshold value reflecting the uncertainty of the detection result by the object detection means. As a result, it is possible to determine the stopped vehicle with high accuracy without using a high resolution laser radar (reflector reflection type laser) having a narrow beam width.
(2)停止物判別閾値として上限閾値と下限閾値とを設け、自車両と停止物との距離が遠ざかるほど、上限閾値を小さく、下限閾値を大きくするので、物体検出手段による検出結果の不確かさを反映した閾値をより適切に設定することができる。また、このようにして設定された閾値を用いることで、より高精度な停止車両判別を行うことができる。 (2) An upper limit threshold value and a lower limit threshold value are provided as stop object determination threshold values. As the distance between the host vehicle and the stop object increases, the upper limit threshold value is decreased and the lower limit threshold value is increased. Can be set more appropriately. In addition, by using the threshold value set in this way, it is possible to perform stop vehicle determination with higher accuracy.
(3)物体検出手段の水平方向の分解能に基づいて、上限閾値及び下限閾値を変化させるので、物体検出手段の設計仕様に応じた適切な停止物判別閾値を設定することができる。その結果、自車両から遠方の停止物体を停止車両であると誤判別することを防止することができる。
(4)走行状態検出手段で検出された走行状態に基づいて停止車両判別処理の実行を許可された停止物に対して、当該停止車両判別処理を行うので、判別精度が高められる走行状況下で停止車両判別処理を行うことができる。
(3) Since the upper limit threshold and the lower limit threshold are changed based on the horizontal resolution of the object detection means, it is possible to set an appropriate stationary object discrimination threshold according to the design specifications of the object detection means. As a result, it is possible to prevent erroneously determining that a stopped object far from the host vehicle is a stopped vehicle.
(4) Since the stop vehicle discrimination process is performed on a stationary object that is permitted to execute the stop vehicle discrimination process based on the running state detected by the running state detection means, under a driving situation in which the discrimination accuracy is improved. Stopped vehicle discrimination processing can be performed.
(5)自車両前方の停止物のうち自車両の走行進路上にある停止物に対してのみ、停止車両判別処理の実行を許可する。したがって、検知物体がレーダ視野内に完全に収まらない場合に誤った停止車両判別を行ってしまうことを防止することができると共に、常にレーダの信頼性の高い検知状態で停止車両判別を行うことができる。
(6)自車速が速いほど、自車両前方の検知物体が停止していると判断し易くするため、動回転半径の変化に対応することができ、停止車両を走行車両であると誤判別するより走行車両を停止車両であると判別して、運転者への誤判別に対する違和感を低減することができる。
(5) The execution of the stopped vehicle determination process is permitted only for a stop on the traveling path of the own vehicle among the stops ahead of the own vehicle. Therefore, it is possible to prevent erroneous detection of a stopped vehicle when the detected object does not completely fall within the radar field of view, and to always determine the stopped vehicle with a highly reliable detection state of the radar. it can.
(6) The faster the host vehicle speed, the easier it is to determine that the detected object in front of the host vehicle is stopped. Therefore, it is possible to cope with changes in the dynamic rotation radius, and erroneously determine that the stopped vehicle is a traveling vehicle. Thus, it is possible to determine that the traveling vehicle is a stopped vehicle, and to reduce a sense of discomfort with respect to an erroneous determination to the driver.
(7)自車両前方の物体を検出する検出手段の検出結果に含まれる不確かさを反映した、検出物体の横幅に関する判別条件に基づいて、検出物体が停止車両であるか否かを判別するので、適切に停止車両判別処理を行うことができる。
(8)自車両前方の検出物体が停止車両であるか否かを判別し、その判別結果に応じた走行制御を行う。したがって、停止車両であると判別された検出物体を障害物である認識し、自動ブレーキ制御装置で各車輪に制動力を付与することによって当該障害物との接触を回避することができ、安定走行を確保することができる。
(7) Since it is determined whether or not the detected object is a stopped vehicle based on the determination condition relating to the width of the detected object that reflects the uncertainty included in the detection result of the detection means for detecting the object ahead of the host vehicle Thus, the stop vehicle determination process can be appropriately performed.
(8) It is determined whether or not the detected object in front of the host vehicle is a stopped vehicle, and travel control is performed according to the determination result. Therefore, the detected object determined to be a stopped vehicle is recognized as an obstacle, and contact with the obstacle can be avoided by applying a braking force to each wheel by the automatic brake control device. Can be secured.
(9)自車両と、物体検出手段で検出された自車両前方の物体のうち停止していると判断された停止物との距離に基づいて、停止車両判別閾値を設定し、その停止物の横幅と前記停止車両判別閾値とを比較することで、当該停止物が車両であるか否かを判別する。したがって、適切に停止車両判別処理を行うことができると共に、ビーム幅の細い高分解能レーザレーダ(リフレクタ反射式レーザ)を用いなくても、高精度で停止車両判別を行うことができる。 (9) Based on the distance between the host vehicle and a stop object determined to be stopped among the objects ahead of the host vehicle detected by the object detection means, a stop vehicle discrimination threshold is set, and the stop object By comparing the width and the stop vehicle determination threshold, it is determined whether or not the stop object is a vehicle. Therefore, it is possible to appropriately perform the stopped vehicle determination process and to determine the stopped vehicle with high accuracy without using a high resolution laser radar (reflector reflection type laser) having a narrow beam width.
(応用例)
なお、上記第1の実施形態においては、検知物体が自車両の走行進路上に存在するときに、停止車両判別処理の実行を許可する場合について説明したが、これに限定されるものではなく、検知物体が自車両の正面に存在するときに停止車両判別処理の実行を許可するようにしてもよい。この場合にも、検知物体がレーダ視野内に完全に収まらないことに起因する誤判別を防止することができると共に、常にレーダの信頼性の高い検知状態で停止車両判別を行うことができる。
(Application examples)
In the first embodiment, the case where the execution of the stopped vehicle determination process is permitted when the detected object exists on the traveling path of the host vehicle is described, but the present invention is not limited to this. You may make it permit execution of a stop vehicle discrimination | determination process when a detection object exists in front of the own vehicle. In this case as well, it is possible to prevent erroneous determination caused by the detected object not being completely within the radar field of view, and to always determine the stopped vehicle in a detection state with high reliability of the radar.
(第2の実施形態)
次に、本発明の第2の実施形態について説明する。
(構成)
この第2の実施形態では、より遠方の検知物体に対する誤判別の対策、及び雨天などで生じ易いガントリーなどに装着されている案内標識等に対する誤判別の対策を行うようにしたものである。
すなわち、第2の実施形態の停止車両判別処理を図9に示すように、図3の第1の実施形態の停止車両判別処理におけるステップS6の後に、各検知物体の状態量(横方向位置)の安定度合いPxV[i]を算出するステップS21を追加し、ステップS10の前に前記横方向位置の安定度合いPxV[i]に基づいて、各検知物体の横方向位置が安定しているか否かを判定するステップS22を追加し、ステップS12の処理をステップS23の処理に置換したことを除いては、前述した図3と同様の処理を実行するため、図3との対応部分には同一符号を付し、その詳細な説明は省略する。このステップS21及びS22の処理が判別許可手段に対応し、ステップS23の処理が閾値設定手段に対応している。
(Second Embodiment)
Next, a second embodiment of the present invention will be described.
(Constitution)
In the second embodiment, countermeasures for misidentification with respect to a farther sensing object and countermeasures for misclassification with respect to a guide sign or the like attached to a gantry or the like that is likely to occur in rainy weather are taken.
That is, as shown in FIG. 9 for the stopped vehicle discrimination process of the second embodiment, after step S6 in the stopped vehicle discrimination process of the first embodiment of FIG. 3, the state quantity (lateral position) of each detected object. Step S21 for calculating the degree of stability PxV [i] is added, and whether or not the lateral position of each sensing object is stable based on the degree of stability PxV [i] of the lateral position before step S10. 3 is added, except that step S12 is replaced with the process of step S23, the same processing as that of FIG. 3 described above is executed. The detailed explanation is omitted. The processes in steps S21 and S22 correspond to the determination permission unit, and the process in step S23 corresponds to the threshold setting unit.
ステップS21では、各検知物体の横方向位置の安定度合いとして、次式で表される標準偏差PxV[i]を算出し、前記ステップS7に移行する。
n=func3(Py_z0[i]),
A=(Px_z0[i]+Px_z1[i]+…+Px_zn[i])/(n+1),
PxV[i]=√[{(Px_z0[i]−A)2+(Px_z1[i]−A)2+…+(Px_zn[i]−A)2}/(n+1)] ………(9)
ここで、func3(Y)は、図10に示されるような特性を有する関数であり、func3(Y)の値は、自車両と検知物体との距離Yが大きくなるにつれて段階的に大きくなるように設定されている。つまり、nは、過去にさかのぼる期間の長さのサンプリング数であって、Aは、その期間中の平均値を意味している。
In step S21, the standard deviation PxV [i] expressed by the following equation is calculated as the degree of stability of the lateral position of each sensing object, and the process proceeds to step S7.
n = func3 (Py_z0 [i]),
A = (Px_z0 [i] + Px_z1 [i] +... + Px_zn [i]) / (n + 1),
PxV [i] = √ [{(Px_z0 [i] −A) 2 + (Px_z1 [i] −A) 2 +... + (Px_zn [i] −A) 2 } / (n + 1)] (9) )
Here, func3 (Y) is a function having the characteristics shown in FIG. 10, and the value of func3 (Y) increases stepwise as the distance Y between the host vehicle and the detected object increases. Is set to That is, n is the number of samplings of the length of the period going back in the past, and A means an average value during that period.
この(9)式からも明らかなように、各検知物体の横方向位置の分散値は、各検知物体の横方向位置の過去の参照期間のサンプリングデータに基づいて算出し、そのサンプリングデータの数nは、自車両とその検知物体との前後方向距離Yが大きいほど多くなるように設定されている。言い換えると、上記参照期間(各検知物体の横方向位置の分散値の算出期間)は、自車両とその検知物体との前後方向距離Yが大きいほど長く(過去にさかのぼるように)設定されている。 As is apparent from the equation (9), the variance value of the lateral position of each sensing object is calculated based on the sampling data of the past reference period of the lateral position of each sensing object, and the number of the sampling data n is set so as to increase as the front-rear direction distance Y between the host vehicle and the detected object increases. In other words, the reference period (the calculation period of the dispersion value of the lateral position of each detected object) is set longer (as if going back in the past) as the longitudinal distance Y between the host vehicle and the detected object is larger. .
また、ステップS22では、前記ステップS21で算出された各検知物体の横方向位置の安定度合いPxV[i]に基づいて、各検知物体の横方向位置が安定しているか否かを判定する。この判定は、下記(10)式を満足するか否かによって行い、下記(10)式を満足するときには、その物体の横方向位置が安定しているものと判断して前記ステップS10に移行し、下記(10)式を満足しないときには前記ステップS11に移行する。
PxV[i]<Th_V ………(10)
ここで、Th_Vは、ばらつきに関する閾値である。このように、横方向位置が安定しない物体を、幅情報を問わず路側構造物である(停止車両ではない)と判定するので、より誤判別の少ない停止車両判別が可能となる。
In step S22, it is determined whether the lateral position of each detected object is stable based on the degree of stability PxV [i] of the lateral position of each detected object calculated in step S21. This determination is made based on whether or not the following expression (10) is satisfied. When the following expression (10) is satisfied, it is determined that the lateral position of the object is stable, and the process proceeds to step S10. If the following expression (10) is not satisfied, the process proceeds to step S11.
PxV [i] <Th_V (10)
Here, Th_V is a threshold concerning variation. Thus, since the object whose lateral position is not stable is determined to be a roadside structure (not a stopped vehicle) regardless of the width information, it is possible to determine a stopped vehicle with fewer erroneous determinations.
上記(9)式に表されるように、検知物体との位置が自車両から離れるほど過去にさかのぼって横方向位置の安定度合いPxV[i]を算出するので、保守的な算出結果となる。これにより、遠方に存在する物体の横方向位置の検出精度が低いために、本来は停止車両判別をすべきでない物体に対して誤って停止車両判別処理を施し、誤って停止物体を停止車両であると判別してしまうことを抑制することができる。 As expressed in the above equation (9), the degree of lateral position stability PxV [i] is calculated by going back in the past as the position of the detected object moves away from the host vehicle, resulting in a conservative calculation result. As a result, since the detection accuracy of the lateral position of the object existing in the distance is low, the stop vehicle determination process is erroneously performed on the object that should not be determined as the stop vehicle, and the stop object is mistakenly detected by the stop vehicle. It is possible to suppress the determination of being present.
ステップS23では、各検知物体に対して、停止物体であるか停止車両であるかの判別に用いる停止物判別閾値の下限閾値Th_Width1[i]及び上限閾値Th_Width2[i]を、次式をもとに算出し、前記ステップS13に移行する。
Th_Width1[i]=W1+func4(Py_z0[i]),
Th_Width2[i]=W2−func4(Py_z0[i]) ………(11)
In step S23, for each detected object, the lower threshold Th_Width1 [i] and the upper threshold Th_Width2 [i] of the stationary object determination threshold used for determining whether the object is a stopped object or a stopped vehicle are expressed by the following equations. And the process proceeds to step S13.
Th_Width1 [i] = W1 + func4 (Py_z0 [i]),
Th_Width2 [i] = W2-func4 (Py_z0 [i]) (11)
ここで、func4(Y)は、図11に示すような特性を有する関数である。この図11に示すように、func4(Y)の値は自車両と検知物体との距離Yが大きくなるほど大きくなるように設定されており、その変化率の絶対値は、距離Yが所定値YTH(例えば、35m程度)まではfunc2(Y)と同等であり、所定値YTHを超えるとfunc2(Y)より大きく設定されている。これにより、自車両と検知物体との距離が大きいほど、停止物判別閾値の下限閾値Th_Width1[i]はより大きく、上限閾値Th_Width2[i]はより小さく算出されることになる。 Here, func4 (Y) is a function having characteristics as shown in FIG. As shown in FIG. 11, the value of func4 (Y) is set so as to increase as the distance Y between the host vehicle and the detected object increases, and the absolute value of the rate of change is such that the distance Y is a predetermined value Y. TH (for example, about 35m) until is equivalent to func2 (Y), is set to be larger than exceeds a predetermined value Y TH func2 (Y). Accordingly, the lower limit threshold Th_Width1 [i] of the stop object determination threshold is larger and the upper limit threshold Th_Width2 [i] is smaller as the distance between the host vehicle and the detected object is larger.
つまり、このときの停止物判別閾値の下限閾値Th_Width1[i]及び上限閾値Th_Width2[i]を図12に示すように、前述した第1の実施形態と同様に、各閾値の差は、自車両と検知物体との距離が大きくなるほど小さくなるように設定され、各閾値の変化率は、符号が逆で絶対値が同じになる。ここで、その絶対値は、自車両と検知物体との距離が大きくなるほど、より大きくなるように設定されるため、より停止車両であると判断し難くなる。
これにより、自車両からより遠方の停止物体に対して、レーザの反射状況が想定外の結果となることでその物体の横幅が偶然W1からW2までの範囲に適合してしまい、誤って停止車両と判別してしまうことをより低減することができる。
That is, as shown in FIG. 12, the lower threshold Th_Width1 [i] and the upper threshold Th_Width2 [i] of the stationary object determination threshold at this time are similar to those in the first embodiment described above. And the detection object are set so as to decrease as the distance between the detection object and the detection object increases, and the change rate of each threshold value has the opposite sign and the same absolute value. Here, the absolute value is set so as to increase as the distance between the host vehicle and the detected object increases, so that it is difficult to determine that the vehicle is a stopped vehicle.
As a result, for a stopped object farther away from the host vehicle, the laser reflection status becomes an unexpected result, so that the horizontal width of the object accidentally matches the range from W1 to W2, and the stopped vehicle is accidentally stopped. Can be further reduced.
(動作)
次に、本発明の第2の実施形態の動作について説明する。
今、雨天時に自車両が高速道路を走行中であり、図13に示すように、自車両前方にガントリーGaに横一列に装着された案内標識Sが存在するものとする。雨天時には、レーザ発光から受光において2次反射が生じ易く、案内標識等の看板をレーザレーダで検知し易くなる。そのため、このような走行環境では、ガントリーに取り付けられた横一列に並ぶ看板のどこからレーザ光が反射するか分からないため、検知物体の横方向位置が安定しないという現象が生じ易い。
そして、この案内標識Sの横位置の安定度合いPxV[i]が、図9のステップS21で閾値Th_V以上に算出されると、ステップS22の判定によりステップS11に移行して、路側構造物であると判別される。
(Operation)
Next, the operation of the second exemplary embodiment of the present invention will be described.
Now, it is assumed that the host vehicle is traveling on a highway during rainy weather, and there is a guide sign S mounted in a horizontal row on the gantry Ga in front of the host vehicle as shown in FIG. When it rains, secondary reflection is likely to occur during laser light emission and light reception, and it is easy to detect signs such as guide signs with a laser radar. For this reason, in such a traveling environment, it is not known where the laser light is reflected from the signboards arranged in a horizontal row attached to the gantry, and thus the phenomenon that the lateral position of the detection object is unstable is likely to occur.
Then, when the degree of stability PxV [i] of the lateral position of the guide sign S is calculated to be equal to or greater than the threshold value Th_V in step S21 of FIG. 9, the process proceeds to step S11 based on the determination in step S22, and is a roadside structure. Is determined.
(第2の実施形態の効果)
(1)検知物体の状態量の安定度合いに基づいて当該状態量が安定していると判断されたときに、その物体に対する停止車両判別手段の実行を許可するので、路側構造物を停止車両であると誤判別することを抑制することができる。
(2)前記検知物体の状態量として検知物体の横方向位置を適用するので、検知物体の横方向位置が安定しない検知状況における判別処理の誤作動を抑制することができる。
つまり、検知物体の横方向位置が安定しない検知状況で、本来は停止車両判別処理を行うべき停止物に対して誤って判別処理が行わなかったり、本来は停止車両判別処理を行わない停止物に対して誤って判別処理が行われてしまったりすることを抑制することができる。また、反射率の高いガントリーなどに対して停止車両判別処理を行った場合、誤って停止車両であると誤判別することを確実に回避することができる。
(Effect of 2nd Embodiment)
(1) When it is determined that the state quantity is stable based on the degree of stability of the state quantity of the detected object, execution of the stop vehicle determination means for the object is permitted, so the roadside structure is It is possible to suppress erroneous determination as being present.
(2) Since the lateral position of the detected object is applied as the state quantity of the detected object, it is possible to suppress a malfunction of the determination process in a detection situation where the lateral position of the detected object is not stable.
In other words, in a detection situation where the lateral position of the detected object is not stable, the stop object that should be subjected to the stop vehicle determination process is not erroneously determined, or the stop object that is not originally subjected to the stop vehicle determination process is On the other hand, it is possible to suppress erroneous determination processing. In addition, when the stopped vehicle determination process is performed on a gantry having a high reflectance, it is possible to reliably avoid erroneously determining that the vehicle is a stopped vehicle.
(3)検知物体の状態量の安定度合いとして、当該状態量の分散値に基づいて算出される標準偏差を用いる。分散値は、前記状態量の過去の参照期間におけるサンプリングデータに基づいて算出し、その参照期間を、検知物体と自車両との距離が遠いほど長くなるように設定する。したがって、遠方に存在する物体の状態量の検出精度を考慮して、より誤判別を低減することができる。
(4)停止車両判別閾値の上限閾値及び下限閾値の自車両と停止物との距離に対する変化率を、符号が逆で絶対値が同じとし、その絶対値を自車両と検知物体との距離が大きくなるほどより大きくするので、より遠方の物体を停止車両であると判断し難くして、より誤判別を低減することができる。
(3) The standard deviation calculated based on the dispersion value of the state quantity is used as the degree of stability of the state quantity of the detected object. The variance value is calculated based on the sampling data of the state quantity in the past reference period, and the reference period is set to be longer as the distance between the detected object and the host vehicle is longer. Therefore, misjudgment can be further reduced in consideration of the detection accuracy of the state quantity of an object that exists far away.
(4) The rate of change of the upper and lower thresholds of the stop vehicle discrimination threshold with respect to the distance between the host vehicle and the stopped object is assumed to be the same as the absolute value of the distance between the host vehicle and the detected object. Since it becomes larger as the size becomes larger, it is difficult to determine that a distant object is a stopped vehicle, and erroneous determination can be further reduced.
(第3の実施形態)
次に、本発明の第3の実施形態について説明する。
(構成)
この第3の実施形態は、物体検出手段として、レーザレーダとCCDカメラとを併用し、これらを用いて停止車両判別処理を行うようにしたものである。
すなわち、第3の実施形態の停止車両判別処理を図14に示すように、図9の第2の実施形態の停止車両判別処理におけるステップS21の後に、検知物体に対してデリニエータの属性付けを行うステップS31と、CCDカメラ3により画像処理する検知物体を決定するステップS32と、ステップS32で決定した物体の横幅をCCDカメラ3で検出するステップS33と、ステップS32で決定した物体の横幅をステップS33の検出値に更新するステップS34と、各検知物体の状態量(横幅)の安定度合いoWv[i]を算出するステップS35とを追加し、ステップS10の後に横幅の安定度合いoWv[i]に基づいて、各検知物体の横幅が安定しているか否かを判定するステップS36を追加し、ステップS23の処理をステップS37の処理に置換したことを除いては、前述した図9と同様の処理を実行するため、図9との対応部分には同一符号を付し、その詳細な説明は省略する。このステップS35及びS36の処理が判別許可手段に対応し、ステップS37の処理が閾値設定手段に対応している。
(Third embodiment)
Next, a third embodiment of the present invention will be described.
(Constitution)
In the third embodiment, a laser radar and a CCD camera are used in combination as object detection means, and a stopped vehicle discrimination process is performed using these.
That is, as shown in FIG. 14 for the stopped vehicle determination process of the third embodiment, after step S21 in the stopped vehicle determination process of the second embodiment of FIG. 9, the delineator is attributed to the detected object. Step S31, Step S32 for determining a detected object to be image-processed by the
ステップS31では、各検知物体の相対位置から道路形状を形成する物体を道路構造物(デリニエータ)として属性付けし、ステップS32に移行する。
ステップS32では、CCDカメラ3により画像処理する検知物体を決定する。具体的には、先ず、自車両前方の物体のうち停止物であると判別された物体であり、且つこれまでは路側構造物(AttrObjCar[i]=0)として属性付けされている物体であり、且つ前記ステップS6で算出される自車両の走行予想進路内に存在する可能性Reco[i]がTh_OwnLaneより大きく、自車両の走行予想進路内に存在する物体の中で、最も自車両に近い距離に存在する物体を選択する。そして、選択した物体のID番号をcam_chk_idという変数に代入する。ここで、上記条件に該当する物体が存在しない場合には、cam_chk_idには負の値(例えば、−1)を代入する。
In step S31, an object that forms a road shape from the relative position of each detected object is attributed as a road structure (delineator), and the process proceeds to step S32.
In step S32, the detection object to be image-processed by the
次に、ステップS33に移行して、前記ステップS32で設定したcam_chk_idが負の値でない場合に、その物体のレーザレーダ検知位置に基づいてカメラ画像処理により物体幅CamWidthを算出し、ステップS34に移行する。ここで、cam_chk_idが負の値であるときにはカメラ画像処理を行わずにステップS34に移行する。 Next, the process proceeds to step S33, and when the cam_chk_id set in step S32 is not a negative value, the object width CamWidth is calculated by camera image processing based on the laser radar detection position of the object, and the process proceeds to step S34. To do. Here, when cam_chk_id is a negative value, the process proceeds to step S34 without performing camera image processing.
ここで、カメラ画像処理による物体幅CamWidthの算出方法としては、例えば、画像処理領域について、公知のSobelフィルター演算等によりエッジ画像を求め、このエッジ画像から、縦エッジのペアとその間の横エッジ(H型のエッジ)を探す。そして、縦エッジペア(H型エッジにおける左側の縦エッジと右側の縦エッジと)の画素間隔Ewと検知物体の距離とに基づいて、下記(12)式をもとに、物体幅CamWidthを算出する。
CamWidth=Ew・Py_z0[cam_chk_id]/focusH ………(12)
ここで、focusHは、画素換算したカメラの水平方向の焦点距離[pix]である。
ステップS34では、前記ステップS33の画像処理で検出した物体幅CamWidthから、レーザ検知物体の幅を修正する。
objW_z0[cam_chk_id]=CamWidth ………(13)
Here, as a method of calculating the object width CamWidth by the camera image processing, for example, an edge image is obtained for the image processing region by a known Sobel filter calculation or the like, and a pair of vertical edges and a horizontal edge (between them) ( Look for H-shaped edges. Based on the pixel interval Ew of the vertical edge pair (the left vertical edge and the right vertical edge in the H-shaped edge) and the distance of the detected object, the object width CamWidth is calculated based on the following equation (12). .
CamWidth = Ew · Py_z0 [cam_chk_id] / focusH (12)
Here, focusH is the horizontal focal length [pix] of the camera in terms of pixels.
In step S34, the width of the laser detected object is corrected from the object width CamWidth detected in the image processing in step S33.
objW_z0 [cam_chk_id] = CamWidth (13)
このように、自車両前方の物体のうち、自車両の走行予想進路内に存在する路側構造物で最も自車両に近い距離に存在する物体について、その物体幅をカメラ画像処理により算出するので、万が一、停止車両を停止物体と誤判別している場合であっても、物体幅が正確な値に更新されることにより適切な停止車両判別を行うことができる。また、最も自車両に近い距離に存在する物体のみをカメラ画像処理する物体として選定するので、カメラ画像処理の負荷が大きくなることを抑制することができる。 Thus, among the objects ahead of the host vehicle, the object width is calculated by the camera image processing for the object that is present in the distance closest to the host vehicle in the roadside structure that is present in the predicted traveling path of the host vehicle. Even if the stopped vehicle is erroneously determined as a stopped object, it is possible to perform appropriate stopped vehicle determination by updating the object width to an accurate value. In addition, since only an object that is present at a distance closest to the host vehicle is selected as an object for camera image processing, an increase in the load of camera image processing can be suppressed.
次に、ステップS35に移行して、各検知物体の横幅の安定度合いとして、次式で表される標準偏差oWv[i]を算出し、前記ステップS7に移行する。
n=func3(Py_z0[i]),
A=(objW_z0[i]+objW_z1[i]+…+objW_zn[i])/(n+1),
oWv[i]=√[{(objW_z0[i]−A)2+(objW_z1[i]−A)2+…+(objW_zn[i]−A)2}/(n+1)] ………(14)
Next, the process proceeds to step S35, and the standard deviation oWv [i] expressed by the following equation is calculated as the lateral width stability degree of each detected object, and the process proceeds to step S7.
n = func3 (Py_z0 [i]),
A = (objW_z0 [i] + objW_z1 [i] +... + ObjW_zn [i]) / (n + 1),
oWv [i] = √ [{(objW_z0 [i] −A) 2 + (objW_z1 [i] −A) 2 +... + (objW_zn [i] −A) 2 } / (n + 1)] (14) )
この(14)式からも明らかなように、各検知物体の横幅の分散値は、各検知物体の横幅の過去のサンプリングデータに基づいて算出し、そのサンプリングデータの数nは、自車両とその検知物体との前後方向距離Yが大きいほど多くなるように設定されている。言い換えると、各検知物体の横幅の分散値の算出期間は、自車両とその検知物体との前後方向距離Yが大きいほど過去にさかのぼるように設定されている。 As is apparent from the equation (14), the variance value of the width of each detected object is calculated based on the past sampling data of the width of each detected object. The distance Y is set so as to increase as the distance Y in the front-rear direction from the detected object increases. In other words, the calculation period of the variance value of the width of each detected object is set so as to go back in the past as the longitudinal distance Y between the host vehicle and the detected object increases.
また、前記ステップS10の判定結果がYes、即ち検知物体が自車両の予想進路内に存在する場合には、ステップS36に移行し、このステップS36で、前記ステップS35で算出された各検知物体の横幅の安定度合いoWv[i]に基づいて、各検知物体の横幅が安定しているか否かを判定する。
この判定は、下記(15)式を満足するか否かによって行い、下記(15)式を満足するときには横幅が安定しているものと判断してステップS37に移行し、下記(15)式を満足しないときには前記ステップS11に移行する。
oWv[i]<Th_v ………(15)
ここで、Th_vは、ばらつきに関する閾値である。このように、横幅が安定しない物体を路側構造物である(停止車両ではない)と判定するので、より誤判別の少ない停止車両判別が可能となる。
On the other hand, if the determination result in step S10 is Yes, that is, if the detected object is present in the expected course of the host vehicle, the process proceeds to step S36, and in this step S36, each detected object calculated in step S35 is determined. Based on the degree of lateral stability oWv [i], it is determined whether the lateral width of each sensing object is stable.
This determination is made based on whether or not the following expression (15) is satisfied. When the following expression (15) is satisfied, it is determined that the lateral width is stable, and the process proceeds to step S37. When not satisfied, the process proceeds to step S11.
oWv [i] <Th_v (15)
Here, Th_v is a threshold concerning variation. Thus, since the object whose lateral width is not stable is determined to be a roadside structure (not a stopped vehicle), it is possible to determine a stopped vehicle with fewer erroneous determinations.
上記(14)式に表されるように、検知物体との位置が自車両から離れるほど過去にさかのぼって横幅の安定度合いoWv[i]を算出するので、保守的な算出結果となる。これにより、遠方に存在する物体の横幅制度が低いために、本来は停止車両でないと判別されるべき物体に対して誤って停止車両と判別してしまうことを抑制することができる。 As expressed by the above equation (14), the degree of stability of the lateral width oWv [i] is calculated by going back in the past as the position of the detected object is farther from the host vehicle, resulting in a conservative calculation result. As a result, since the lateral width system of the object existing in the distance is low, it is possible to prevent the object that should be originally determined not to be the stopped vehicle from being erroneously determined as the stopped vehicle.
ステップS37では、各検知物体に対して、停止物体か停止車両かの判別に用いる停止物判別閾値の下限閾値Th_Width1[i]及び上限閾値Th_Width2[i]を算出する。検知物体のID番号がcam_chk_idと異なる場合には、前述した第1の実施形態におけるステップS12と同様に、前記(7)式をもとに算出し、検知物体のID番号がcam_chk_idと同じ場合には次式をもとに算出し、前記ステップS13に移行する。
Th_Width1[i]=W1+func5(Py_z0[i]),
Th_Width2[i]=W2−func5(Py_z0[i]) ………(16)
In step S37, for each detected object, a lower limit threshold Th_Width1 [i] and an upper limit threshold Th_Width2 [i] of a stop object determination threshold used for determining whether the object is a stopped object or a stopped vehicle are calculated. When the ID number of the detected object is different from cam_chk_id, as in step S12 in the first embodiment described above, the calculation is made based on the equation (7), and the ID number of the detected object is the same as cam_chk_id. Is calculated based on the following equation, and the process proceeds to step S13.
Th_Width1 [i] = W1 + func5 (Py_z0 [i]),
Th_Width2 [i] = W2-func5 (Py_z0 [i]) (16)
ここで、func5(Y)は、図15に示すような特性を有する関数である。この図15に示すように、func5(Y)の値は自車両と検知物体との距離Yに比例して大きくなるように設定されており、その変化率の絶対値は、func2(Y)と比較して小さく設定されている。これにより、カメラ画像処理が施された物体に対しては、停止判別閾値の下限閾値Th_Width1[i]は、距離Yが大きくなるほど大きくなるもののW1にほぼ等しく、上限閾値Th_Width2[i]は、距離Yが大きくなるほど小さくなるもののW2にほぼ等しく算出されることになる。 Here, func5 (Y) is a function having characteristics as shown in FIG. As shown in FIG. 15, the value of func5 (Y) is set to increase in proportion to the distance Y between the host vehicle and the detected object, and the absolute value of the rate of change is func2 (Y). It is set small compared. As a result, for an object that has undergone camera image processing, the lower threshold Th_Width1 [i] of the stop determination threshold is substantially equal to W1 that increases as the distance Y increases, and the upper threshold Th_Width2 [i] Although the smaller Y is, the smaller it is, it is calculated approximately equal to W2.
つまり、このときの停止物判別閾値の下限閾値Th_Width1[i]及び上限閾値Th_Width2[i]を図16に示すように、前述した第1の実施形態と同様に、各閾値の差は、自車両と検知物体との距離が大きくなるほど小さくなるように設定され、各閾値の変化率は、符号が逆で絶対値が同じになる。そして、その絶対値は、物体を検知したセンサの種類(レーザレーダかCCDカメラか)によって異なり、レーザレーダで検知した場合には実線で示すように絶対値は大きく設定され、CCDカメラで検知した場合には一点鎖線で示すように絶対値は小さく設定される。これは、レーザレーダとCCDカメラとの分解能に依存した不確かさの違いに基づくものである。 That is, as shown in FIG. 16, the lower threshold Th_Width1 [i] and the upper threshold Th_Width2 [i] of the stationary object determination threshold at this time are similar to the first embodiment described above. And the detection object are set so as to decrease as the distance between the detection object and the detection object increases, and the change rate of each threshold value has the opposite sign and the same absolute value. The absolute value differs depending on the type of sensor (laser radar or CCD camera) that detected the object. When detected by laser radar, the absolute value is set large as shown by the solid line, and detected by the CCD camera. In such a case, the absolute value is set to be small as indicated by the alternate long and short dash line. This is based on the difference in uncertainty depending on the resolution between the laser radar and the CCD camera.
(動作)
次に、本発明の第3の実施形態の動作について説明する。
今、図13に示すように、自車両前方にガントリーGaに横一列に装着された案内標識Sが存在するものとする。一般に、案内標識等の看板は、レーザ発光から受光における反射が安定せず、物体幅の検出値が安定し難くなる。そして、この案内標識Sの横幅の安定度合いoWv[i]が、図14のステップS35で閾値Th_v以上に算出されると、ステップS36の判定によりステップS11に移行して、路側構造物であると判別される。
(Operation)
Next, the operation of the third embodiment of the present invention will be described.
Now, as shown in FIG. 13, it is assumed that there is a guide sign S mounted in a horizontal row on the gantry Ga in front of the host vehicle. In general, a sign such as a guide sign is not stable in reflection from laser light emission to light reception, and the detected value of the object width is difficult to stabilize. Then, when the degree of lateral stability oWv [i] of the guide sign S is calculated to be greater than or equal to the threshold Th_v in step S35 of FIG. Determined.
(第3の実施形態の効果)
(1)検知物体の状態量としての検知物体の横幅を適用するので、検知物体の横幅が安定しない検知状況における判別処理の誤作動を抑制することができる。
つまり、検知物体の横幅が安定しない検知状況で、偶然平均的な車幅であるW1からW2までの範囲に適合して誤った停止車両判別を行ってしまうことを抑制することができる。具体的には、反射の安定しないガントリーなどを誤って停止車両であると誤判別することを回避することができる。さらに、検知物が車両背面の反射板であるリフレクタを有する物体であるか否かを判定しやすくなる。その結果、より車両以外の物体を正しく路側構造物として属性付けすることができる。
(Effect of the third embodiment)
(1) Since the width of the detected object as the state quantity of the detected object is applied, it is possible to suppress malfunction of the determination process in a detection situation where the width of the detected object is not stable.
In other words, it is possible to suppress accidental stop vehicle determination in accordance with a range from W1 to W2, which is an average vehicle width, in a detection situation where the width of the detection object is not stable. Specifically, it is possible to avoid erroneously determining that a gantry or the like whose reflection is not stable is a stopped vehicle. Furthermore, it becomes easy to determine whether or not the detected object is an object having a reflector that is a reflector on the back of the vehicle. As a result, an object other than the vehicle can be correctly attributed as a roadside structure.
(2)停止車両判別閾値の上限閾値及び下限閾値の変化率を、符号が逆で絶対値が同じとし、その絶対値を物体検出手段の種類に応じて変更するので、自車両前方の物体を検出したセンサの違いによる横幅に関する不確かさの違いを反映した停止物判別閾値を設定することができる。これにより、より正確な停止車両判別を行うことができる。
(3)物体検出手段の種類に応じて停止物判別閾値の設定を適正化するので、物体検出手段としてレーザレーダとCCDカメラとを冗長的に用いた場合でも、適切に停止車両判別処理を行うことができる。
(2) Since the change rate of the upper limit threshold and the lower limit threshold of the stop vehicle discrimination threshold is reversed and the absolute value is the same, and the absolute value is changed according to the type of the object detection means, It is possible to set a stationary object discrimination threshold that reflects a difference in uncertainty regarding the width due to a difference in the detected sensor. Thereby, a more accurate stop vehicle determination can be performed.
(3) Since the setting of the stop object discrimination threshold is optimized according to the type of the object detection means, even when the laser radar and the CCD camera are used redundantly as the object detection means, the stop vehicle discrimination process is appropriately performed. be able to.
(応用例)
なお、上記各実施形態においては、走行制御手段で実施する制御として、外界認識装置10で停止車両であると判断された前方物体を障害物と認識し、自動ブレーキ制御装置12で各車輪に制動力を付与することによって当該障害物との接触を回避するような制御を適用する場合について説明したが、これに限定されるものではなく、上記障害物との接触を回避するために操舵トルクを制御したり、上記障害物と自車両との距離に応じて運転者に対して警報を発したりする制御を適用することもできる。
(Application examples)
In each of the above embodiments, as the control performed by the travel control means, a front object that is determined to be a stopped vehicle by the
1 レーザレーダ
2 レーダ処理装置
3 撮像装置(CCDカメラ)
4 画像処理装置
5 車速センサ
6 操舵角センサ
10 外界認識装置
12 自動ブレーキ制御装置
14 負圧ブレーキブースタ
DESCRIPTION OF
4
Claims (10)
前記検出物体の横幅を取得する横幅取得手段と、前記検出物体が停止していることを判断する停止判断手段と、自車両と前記停止判断手段で停止していると判断された停止物との距離に基づいて停止車両判別閾値を設定する閾値設定手段と、その停止物の横幅と前記閾値設定手段で設定された停止車両判別閾値とを比較することで、当該停止物が車両であるか否かを判別する停止車両判別処理を行う停止車両判別手段とを備え、
前記閾値設定手段は、停止車両判別閾値として、上限閾値と下限閾値とを設定するものであり、自車両と前記停止物との距離が遠ざかるほど、下限閾値を大きく設定し、前記停止車両判別手段は、前記停止物の横幅が前記上限閾値及び前記下限閾値の範囲に適合すると判断されたとき、当該停止物が車両であると判別することを特徴とする停止車両判別装置。 In an object detection unit that detects an object in front of the host vehicle, and a stop vehicle determination device that determines whether the detected object detected by the object detection unit is a stop vehicle,
A width acquisition unit that acquires a width of the detected object, a stop determination unit that determines that the detection object is stopped, and a stop object that is determined to be stopped by the host vehicle and the stop determination unit. Whether the stop is a vehicle by comparing threshold value setting means for setting a stop vehicle determination threshold based on the distance, and the width of the stop object and the stop vehicle determination threshold set by the threshold setting means. and a stopping vehicle discrimination means for performing stop vehicle determination process to determine whether,
The threshold value setting means sets an upper limit threshold value and a lower limit threshold value as the stop vehicle determination threshold value, and sets the lower limit threshold value larger as the distance between the host vehicle and the stop object increases, and the stop vehicle determination means Is a stop vehicle discriminating apparatus that discriminates that the stop is a vehicle when it is determined that the lateral width of the stop matches the range of the upper limit threshold and the lower limit threshold .
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005282150A JP5103722B2 (en) | 2005-09-28 | 2005-09-28 | Stop vehicle discrimination device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005282150A JP5103722B2 (en) | 2005-09-28 | 2005-09-28 | Stop vehicle discrimination device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2007093347A JP2007093347A (en) | 2007-04-12 |
JP5103722B2 true JP5103722B2 (en) | 2012-12-19 |
Family
ID=37979249
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005282150A Expired - Fee Related JP5103722B2 (en) | 2005-09-28 | 2005-09-28 | Stop vehicle discrimination device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5103722B2 (en) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5012270B2 (en) * | 2007-07-10 | 2012-08-29 | トヨタ自動車株式会社 | Object detection device |
JP5050002B2 (en) * | 2009-06-09 | 2012-10-17 | 本田技研工業株式会社 | Vehicle object detection device |
JP6340738B2 (en) * | 2016-09-13 | 2018-06-13 | 本田技研工業株式会社 | Vehicle control device, vehicle control method, and vehicle control program |
KR102529397B1 (en) * | 2016-12-15 | 2023-05-09 | 현대자동차주식회사 | Algorithm for discrimination of target by using informations from radar |
JP7127969B2 (en) * | 2017-07-12 | 2022-08-30 | 株式会社デンソーテン | Radar device and signal processing method |
EP4306993A1 (en) * | 2021-03-10 | 2024-01-17 | Pioneer Corporation | Sensor device, control device, control method, program, and storage medium |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0489590A (en) * | 1990-08-01 | 1992-03-23 | Nippon Soken Inc | Distance measurement device |
JP3223700B2 (en) * | 1994-04-26 | 2001-10-29 | 株式会社デンソー | Vehicle obstacle warning device |
JP3146903B2 (en) * | 1995-02-01 | 2001-03-19 | トヨタ自動車株式会社 | Automotive radar equipment |
JP3206532B2 (en) * | 1997-12-19 | 2001-09-10 | 株式会社デンソー | Steering angle neutral learning device, curve curvature estimation device, inter-vehicle distance control device, and recording medium |
JP3512066B2 (en) * | 1998-12-10 | 2004-03-29 | トヨタ自動車株式会社 | Automotive radar equipment |
JP3952874B2 (en) * | 2002-06-19 | 2007-08-01 | 日産自動車株式会社 | Front object recognition device |
JP4215520B2 (en) * | 2003-01-14 | 2009-01-28 | 富士通テン株式会社 | Radar equipment |
JP4114587B2 (en) * | 2003-09-29 | 2008-07-09 | 株式会社デンソー | Own vehicle travel position detection device and program |
-
2005
- 2005-09-28 JP JP2005282150A patent/JP5103722B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2007093347A (en) | 2007-04-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3366539B1 (en) | Information processing apparatus and information processing method | |
US20230079730A1 (en) | Control device, scanning system, control method, and program | |
US7782179B2 (en) | Obstacle detection apparatus | |
US10217364B2 (en) | Lane assistance system responsive to extremely fast approaching vehicles | |
US9020747B2 (en) | Method for recognizing a turn-off maneuver | |
CN112154455B (en) | Data processing method, equipment and movable platform | |
US9827956B2 (en) | Method and device for detecting a braking situation | |
US10583737B2 (en) | Target determination apparatus and driving assistance system | |
US20150032369A1 (en) | Wayfinding method and device | |
JP2004531424A (en) | Sensing device for cars | |
US10752223B2 (en) | Autonomous emergency braking system and method for vehicle at crossroad | |
JP5103722B2 (en) | Stop vehicle discrimination device | |
KR20200115640A (en) | A system and method for detecting the risk of collision between a vehicle and a secondary object located in a lane adjacent to the vehicle when changing lanes | |
CN111341148B (en) | Control system and control method for a motor vehicle for processing multiple reflection signals | |
KR102463722B1 (en) | Apparatus and method for setting velocity of vehicle | |
KR20210076139A (en) | How to create car control settings | |
CN113650607B (en) | Low-speed scene automatic driving method, system and automobile | |
CN111923914A (en) | Identification of the shoulder driving of a motor vehicle | |
US11492016B2 (en) | Autonomous driving control method and device | |
US11087149B2 (en) | Object detection apparatus | |
CN115056773B (en) | Pedestrian micro-collision recognition method and system in low-speed scene | |
CN113022593B (en) | Obstacle processing method and device and traveling equipment | |
US11816903B2 (en) | Method for determining a type of parking space | |
US11787469B2 (en) | Vehicle and control method thereof | |
JP2006047033A (en) | Object recognition method and device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20080728 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20100917 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20101216 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110802 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110928 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20120904 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20120917 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20151012 Year of fee payment: 3 |
|
LAPS | Cancellation because of no payment of annual fees |