JP6455292B2 - Object detection apparatus and object detection method - Google Patents
Object detection apparatus and object detection method Download PDFInfo
- Publication number
- JP6455292B2 JP6455292B2 JP2015083435A JP2015083435A JP6455292B2 JP 6455292 B2 JP6455292 B2 JP 6455292B2 JP 2015083435 A JP2015083435 A JP 2015083435A JP 2015083435 A JP2015083435 A JP 2015083435A JP 6455292 B2 JP6455292 B2 JP 6455292B2
- Authority
- JP
- Japan
- Prior art keywords
- relative position
- detection unit
- object detection
- detected
- unit
- 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.)
- Active
Links
Images
Landscapes
- Optical Radar Systems And Details Thereof (AREA)
- Traffic Control Systems (AREA)
Description
本発明は、近距離センサと遠距離センサとを用いた物体検出装置及び物体検出方法に関する。 The present invention relates to an object detection apparatus and an object detection method using a short distance sensor and a long distance sensor.
関連する技術として、特許文献１に車載用測距装置が開示されている。この車載用測距装置は、近距離センサと遠距離センサとを用いて、高精度に車間距離を推定する装置である。近距離センサと遠距離センサの重複範囲内では、近距離センサの出力値と遠距離センサの出力値との平均値を先行車との距離とする。近距離センサの検出領域内且つ遠距離センサの検出領域外の領域では、周囲環境等で近距離センサが検出できないと判断した場合、不検出になる直前の出力値から物体の相対位置を推定する。 As a related technique, Patent Document 1 discloses an in-vehicle distance measuring device. This on-vehicle distance measuring device is a device that estimates the inter-vehicle distance with high accuracy using a short-range sensor and a long-range sensor. Within the overlapping range of the short distance sensor and the long distance sensor, the average value of the output value of the short distance sensor and the output value of the long distance sensor is set as the distance from the preceding vehicle. If it is determined that the short-range sensor cannot be detected in the detection area of the short-range sensor and outside the detection range of the long-range sensor, the relative position of the object is estimated from the output value immediately before the non-detection is detected. .
しかしながら、近距離センサと遠距離センサとの検出精度に違いがある場合、近距離センサと遠距離センサとの検出領域の重複領域で平均値を取ることで、推定した物体の相対位置に大きな変動が発生してしまう可能性がある。
本発明は、このような事情に鑑みてなされたものであって、推定した物体の相対位置の変動が少なく、より精度の良い結果を得るための物体検出装置及び物体検出方法を提供することを目的とする。
However, if there is a difference in the detection accuracy between the short-range sensor and the long-range sensor, a significant variation in the estimated relative position of the object can be obtained by taking the average value in the overlapping area of the detection range of the short-range sensor and the long-range sensor May occur.
The present invention has been made in view of such circumstances, and provides an object detection device and an object detection method for obtaining a more accurate result with less fluctuation in the relative position of the estimated object. Objective.
上記の課題を解決するため、本発明の一態様に係る物体検出装置及び物体検出方法では、第１の検出領域で自車と物体との第１の相対位置を検出する。第１の検出領域よりも検出可能距離が短く且つ位置検出精度が高い第２の検出領域で自車と物体との第２の相対位置を検出する。第１の相対位置及び第２の相対位置のうち少なくとも一方に基づき、物体の相対位置を推定する。物体の相対位置に基づき、物体に対して自車の回避動作が必要か否かを判定する。自車の回避動作が必要と判定していない場合であって、第１の検出領域で物体を検出し且つ第２の検出領域で物体を検出していない状況では、第１の相対位置を物体の相対位置と推定する。この状況から第２の検出領域でも物体を検出し且つ第１の相対位置と第２の相対位置との差が既定の閾値以下となった場合、第２の検出領域で物体を継続して検出している間は第２の相対位置を物体の相対位置と推定する。 In order to solve the above problems, in the object detection device and the object detection method according to one aspect of the present invention, the first relative position between the vehicle and the object is detected in the first detection region. A second relative position between the subject vehicle and the object is detected in a second detection area having a detectable distance shorter than that of the first detection area and having high position detection accuracy. The relative position of the object is estimated based on at least one of the first relative position and the second relative position. Based on the relative position of the object, it is determined whether an avoidance operation of the host vehicle is necessary for the object. When it is not determined that the avoidance operation of the host vehicle is necessary and the object is detected in the first detection area and the object is not detected in the second detection area, the first relative position is set to the object. The relative position of is estimated. From this situation, if the object is detected in the second detection area and the difference between the first relative position and the second relative position is equal to or less than a predetermined threshold, the object is continuously detected in the second detection area. During this time, the second relative position is estimated as the relative position of the object.
本発明の一態様によれば、第１の物体検出部で検出している第１の相対位置と第２の物体検出部で検出している第２の相対位置との差が既定の閾値以下となったときに、第２の物体検出部で物体を継続して検出している間は、第２の相対位置を物体の相対位置と推定するため、推定した物体の相対位置の変動が少なく、より精度の良い結果を得ることができる。 According to one aspect of the present invention, the difference between the first relative position detected by the first object detection unit and the second relative position detected by the second object detection unit is equal to or less than a predetermined threshold. Then, while the second object detection unit continuously detects the object, the second relative position is estimated as the relative position of the object, and therefore the estimated relative position fluctuation is small. More accurate results can be obtained.
次に、図面を参照して、本発明の第１〜第３実施形態について説明する。以下の図面の記載において、同一又は類似の部分には同一又は類似の符号を付している。但し、図面は模式的なものであり、現実のものとは異なることに留意すべきである。したがって、具体的な構成部品については以下の説明を参酌して判断すべきものである。
また、以下に示す第１〜第３実施形態は、本発明の技術的思想を具体化するための装置や方法を例示するものであって、本発明の技術的思想は、構成部品の形状、構造、配置等を下記のものに特定するものでない。本発明の技術的思想は、請求の範囲に記載された請求項が規定する技術的範囲内において、種々の変更を加えることができる。
Next, first to third embodiments of the present invention will be described with reference to the drawings. In the following description of the drawings, the same or similar parts are denoted by the same or similar reference numerals. However, it should be noted that the drawings are schematic and different from the actual ones. Therefore, specific components should be determined in consideration of the following description.
In addition, the first to third embodiments described below exemplify apparatuses and methods for embodying the technical idea of the present invention, and the technical idea of the present invention is the shape of a component, The structure and arrangement are not specified as follows. The technical idea of the present invention can be variously modified within the technical scope defined by the claims described in the claims.
＜第１実施形態＞
以下に、本発明の第１実施形態について説明する。
（物体検出装置の構成）
図１に示すように、本発明の第１実施形態に係る物体検出装置は、第１の物体検出部１０と、第２の物体検出部２０と、自車情報取得部３０と、制御装置５０とを備える。
第１の物体検出部１０は、自車前方の道路空間に存在する物体が自身の検出範囲である第１の検出領域に入った場合、自車と物体との第１の相対位置及び第１の相対速度を検出し、制御装置５０に出力する。第１の物体検出部１０の例として、自車の車室内（ルームミラー周辺等）に取り付けている狭角カメラ等の遠距離センサを想定している。
<First Embodiment>
The first embodiment of the present invention will be described below.
(Configuration of object detection device)
As shown in FIG. 1, the object detection device according to the first embodiment of the present invention includes a first
When the object existing in the road space ahead of the host vehicle enters the first detection area that is the detection range of the first
第２の物体検出部２０は、自車前方の道路空間に存在する物体が自身の検出範囲である第２の検出領域に入った場合、自車と物体との第２の相対位置及び第２の相対速度を検出し、制御装置５０に出力する。ここで、第１の検出領域は、自車の進行方向に対して長く（遠距離）、自車の幅方向に対して狭い（狭角）。一方、第２の検出領域は、第１の検出領域と比べて、自車の進行方向に対して短く（近距離）、自車の幅方向に対して広い（広角）。そして、第２の物体検出部２０の位置検出精度は、第１の物体検出部１０の位置検出精度よりも高い。このように、このように、第２の物体検出部２０は、第１の物体検出部１０と比べて、検出可能距離が短く、検出可能幅が広く、位置検出精度が高い。第２の物体検出部２０の例として、自車の車室外（フロント周辺等）に取り付けているレーザーレンジファインダ（ＬＲＦ）等の近距離センサを想定している。
なお、第１の物体検出部１０及び第２の物体検出部２０が検出する物体は、自車の走行車線内に侵入若しくは存在し、自車と接触する可能性のある物体等である。なお、物体は、静止体、動体を問わない。物体の例として、他の車両、路上の障害物や落下物、飛来物、道路空間に進入してきた人や動物等が考えられる。
When the object existing in the road space in front of the host vehicle enters the second detection area, which is the detection range of the second
The objects detected by the first
自車情報取得部３０は、少なくとも自車の速度、加速度、及び操舵角等の情報（自車情報）を取得し、制御装置５０に出力する。自車情報取得部３０の例として、車速センサ、加速度センサ、及び舵角センサ等の各種センサ群を想定している。
制御装置５０は、第１の物体検出部１０の出力値及び第２の物体検出部２０の出力値のうち少なくとも一方に基づき、自車前方の道路空間に存在する物体の相対位置を推定する。なお、制御装置５０は、第１の物体検出部１０の出力値及び第２の物体検出部２０の出力値のそれぞれを取得した時刻のタイムスタンプも同時に取得し、このタイムスタンプと自車情報取得部３０から送られる自車情報とに基づいて、第１の相対位置と第２の相対位置とを対応付けるようにしても良い。このとき、制御装置５０は、物体の相対位置から自車に対する物体の相対速度を算出することもできる。更に、制御装置５０は、物体の相対位置に基づいて、自車に対する警報及び／又は制動等の運転支援を行うようにすることも可能である。なお、運転支援の処理については公知技術を用いるものとして、ここでは詳細の説明は割愛する。制御装置５０の例として、電子制御装置（ＥＣＵ）を想定している。また、制御装置５０は、計算機、スマートフォン、タブレット端末、カーナビゲーションシステム等でも良い。
The own vehicle
The
（制御装置の構成）
図２を参照して、制御装置５０の詳細な構成例について説明する。
制御装置５０は、物***置推定部５１と、重複領域判定部５２と、同一物体判定部５３と、検出済物体判定部５４と、回避判定部５５と、停車判定部５６とを備える。
物***置推定部５１は、第１の物体検出部１０の出力値及び第２の物体検出部２０の出力値のうち少なくとも一方に基づき、物体の相対位置を推定する。更に、物***置推定部５１は、物体の相対位置から自車と物体との相対速度を算出しても良い。
(Configuration of control device)
A detailed configuration example of the
The
The object
重複領域判定部５２は、物***置推定部５１に対して、第１の相対位置と第２の相対位置との両方が入力された場合、第１の相対位置と第２の相対位置とが、第１の物体検出部１０と第２の物体検出部２０との重複領域に入っているか否かを判定する。
同一物体判定部５３は、重複領域判定部５２で第１の相対位置と第２の相対位置とが重複領域に入っていると判定された場合、第１の物体検出部１０と第２の物体検出部２０とが同じ物体を検出しているか否かを判定する。
検出済物体判定部５４は、同一物体判定部５３で同じ物体を検出していると判定された場合、重複領域において第１の物体検出部１０と第２の物体検出部２０との両方で同時に検出された物体に対して、重複領域に入る前に、第１の物体検出部１０よりも位置検出精度が高い第２の物体検出部２０で検出していたか否かを判定する。
When both the first relative position and the second relative position are input to the object
The same
When it is determined that the same object is detected by the same
回避判定部５５は、検出済物体判定部５４で重複領域に入る前に第２の物体検出部２０で物体を検出していたと判定されなかった場合、自車情報取得部３０から取得した自車情報と、物***置推定部５１で推定した物体の相対位置とに基づき、物体に対して自車の回避動作が必要か否かを判定する。このとき、回避判定部５５は、物体の相対位置から自車に対する物体の相対速度を算出し、物体の相対速度に基づき、物体に対して自車の回避動作が必要か否かを判定することもできる。
物***置推定部５１は、回避判定部５５で回避する必要があると判定された場合、物体の相対位置の推定結果の変動が少なくなるように、第１の物体検出部１０の出力値と第２の物体検出部２０との出力値の間の切り替えを行う（後述する物体回避必要時の相対位置推定処理）。
If the detected
When the
停車判定部５６は、少なくとも制御装置５０の動作中、自車のイグニッションスイッチ（ＩＧＮ）を監視し、イグニッションスイッチ（ＩＧＮ）がＯＦＦされたか否かを判定する。イグニッションスイッチ（ＩＧＮ）がＯＦＦされたと判定した場合、制御装置５０の処理を終了する。
更に、停車判定部５６は、自車のイグニッションスイッチ（ＩＧＮ）を監視し、イグニッションスイッチ（ＩＧＮ）がＯＮされたか否かを判定し、イグニッションスイッチ（ＩＧＮ）がＯＮされたと判定した場合に、制御装置５０の処理を開始するようにしても良い。
The
Further, the
（処理の流れ）
次に、図３に示すフローチャートを参照して、本発明の第１実施形態に係る物体検出装置での処理の流れについて説明する。
ステップＳ１０１では、第１の物体検出部１０と第２の物体検出部２０とのそれぞれが、自車と物体との相対位置（第１の相対位置、第２の相対位置）を検出し、制御装置５０に出力する。第１の物体検出部１０と第２の物体検出部２０との検出距離と視野角については、例えば図４に示しているように、第１の物体検出部１０が検出距離２００ｍ、視野角３０°に対して、第２の物体検出部２０が検出距離８０ｍ、視野角１１０°である。
(Process flow)
Next, with reference to the flowchart shown in FIG. 3, the flow of processing in the object detection apparatus according to the first embodiment of the present invention will be described.
In step S101, each of the first
ステップＳ１０２では、制御装置５０の物***置推定部５１は、第１の物体検出部１０の出力値及び第２の物体検出部２０の出力値のうち少なくとも一方に基づき、物体の相対位置を推定する。
ここでは、物***置推定部５１は、第１の相対位置のみ取得した場合、第１の相対位置を物体の相対位置と推定する。また、第２の相対位置を取得した場合、第２の相対位置を物体の相対位置と推定する。
In step S102, the object
Here, when only the first relative position is acquired, the object
なお、第１の相対位置を取得する前に、既に第２の相対位置を取得している場合、第２の相対位置を物体の相対位置と推定し続ける。
例えば、図５（ａ）、（ｂ）に示しているように、第１の物体検出部１０が物体を検出し始める前に、既に第２の物体検出部２０が物体を検出している場合、第２の物体検出部２０の検出精度が高いため、第２の相対位置を物体の相対位置と推定して使い続ける。
Note that, if the second relative position has already been acquired before the first relative position is acquired, the second relative position is continuously estimated as the relative position of the object.
For example, as shown in FIGS. 5A and 5B, the second
ステップＳ１０３では、制御装置５０の重複領域判定部５２は、第１の物体検出部１０と第２の物体検出部２０との両方が物体を検出しているとき、第１の物体検出部１０と第２の物体検出部２０とのそれぞれで検出された物体が、第１の物体検出部１０と第２の物体検出部２０との重複領域に入っているか否かを判定する。例えば、図４において、第１の検出領域と第２の検出領域とが重なる領域が重複領域である。
重複領域判定部５２は、物体が重複領域の中に入っていると判定した場合（ステップＳ１０３でＹｅｓ）、ステップＳ１０４へ進む。
重複領域判定部５２は、物体が重複領域の中に入っていると判定していない場合（ステップＳ１０３でＮｏ）、ステップＳ１０８へ進む。
In step S103, the overlapping
If the overlapping
If it is not determined that the object is in the overlapping area (No in step S103), the overlapping
ステップＳ１０４では、制御装置５０の同一物体判定部５３は、第１の物体検出部１０と第２の物体検出部２０とが同じ物体を検出しているか否かを判定する。
例えば、図６に示しているように、２つの物体が第１の検出領域と第２の検出領域との重複領域に入っており、第１の相対位置がそれぞれＡ１、Ａ２であり、第２の相対位置がそれぞれＢ１、Ｂ２である場合、Ａ１がＢ１、Ｂ２の中のいずれと同じ物体であるか否かを判定する必要がある。
In step S104, the same
For example, as shown in FIG. 6, two objects are in an overlapping area between the first detection area and the second detection area, and the first relative positions are A1 and A2, respectively. When the relative positions of B1 and B2 are respectively, it is necessary to determine whether A1 is the same object as B1 or B2.
ここでは、Ａ１、Ａ２と、Ｂ１、Ｂ２との距離で、最も近い同士を同じ物体と判定する。図６の場合、Ａ１とＢ２が同じ物体、Ａ２とＢ１が同じ物体であると判定することができる。
同一物体判定部５３は、第１の物体検出部１０と第２の物体検出部２０とが同じ物体を検出していると判定した場合（ステップＳ１０４でＹｅｓ）、ステップＳ１０５へ進む。
同一物体判定部５３は、第１の物体検出部１０と第２の物体検出部２０とが同じ物体を検出していると判定しなかった場合（ステップＳ１０４でＮｏ）、ステップＳ１０８へ進む。
Here, the closest objects are determined to be the same object by the distance between A1 and A2 and B1 and B2. In the case of FIG. 6, it can be determined that A1 and B2 are the same object, and A2 and B1 are the same object.
If the same
If the same
ステップＳ１０５では、制御装置５０の検出済物体判定部５４は、重複領域において第１の物体検出部１０と第２の物体検出部２０との両方で同時に検出された物体に対して、重複領域に入る前に、第１の物体検出部１０よりも位置検出精度が高い第２の物体検出部２０で検出していたか否かを判定する。
検出済物体判定部５４は、重複領域に入る前に第２の物体検出部２０で検出していたと判定した場合（ステップＳ１０５でＹｅｓ）、ステップＳ１０８へ進む。
検出済物体判定部５４は、重複領域に入る前に第２の物体検出部２０で検出していなかったと判定した場合（ステップＳ１０５でＮｏ）、ステップＳ１０６へ進む。
In step S <b> 105, the detected
If the detected
If the detected
ステップＳ１０６では、制御装置５０の回避判定部５５は、自車と物体との相対位置及び相対速度に基づいて、物体を回避する必要があるか否かを判定する。
回避判定部５５は、物体を回避する必要があると判定した場合（ステップＳ１０６でＹｅｓ）、ステップＳ１０７へ進む。
回避判定部５５は、物体を回避する必要がないと判定した場合（ステップＳ１０６でＮｏ）、ステップＳ１０８へ進む。
In step S106, the
If the
If the
ステップＳ１０７では、制御装置５０の物***置推定部５１は、物体回避必要時の相対位置推定処理として、回避判定部５５の判定結果と、第１の物体検出部１０の出力値及び第２の物体検出部２０の出力値のうち少なくとも一方に基づき、物体の相対位置を推定する。具体的には、物体の相対位置の推定結果の変動が少なくなるように、第１の物体検出部１０の出力値と第２の物体検出部２０の出力値との間の切り替えを行う。この物体回避必要時の相対位置推定処理の詳細については後述する（図７参照）。物体回避必要時の相対位置推定処理が終了すると、ステップＳ１０８へ進む。
In step S107, the object
ステップＳ１０８では、制御装置５０の停車判定部５６は、自車のイグニッションスイッチ（ＩＧＮ）を監視し、イグニッションスイッチ（ＩＧＮ）がＯＦＦされたか否かを判定する。
停車判定部５６は、イグニッションスイッチ（ＩＧＮ）がＯＦＦされたと判定した場合（ステップＳ１０８でＹｅｓ）、制御装置５０の一連の処理を終了する。
停車判定部５６は、イグニッションスイッチ（ＩＧＮ）がＯＦＦされたと判定されていない場合（ステップＳ１０８でＮｏ）、ステップＳ１０１へ戻る。すなわち、イグニッションスイッチ（ＩＧＮ）がＯＦＦされたと判定されるまで、制御装置５０の一連の処理を継続する。
In step S108, the
When it is determined that the ignition switch (IGN) is turned off (Yes in step S108), the
When it is not determined that the ignition switch (IGN) is turned off (No in step S108), the
（物体回避必要時の相対位置推定処理）
図７に示すフローチャートを参照して、本発明の第１実施形態における、図３に示したステップＳ１０７での物体回避必要時の相対位置推定処理の詳細について説明する。ここでは、物体の相対位置の推定結果の変動が少なくなるように、第１の物体検出部１０の出力値と第２の物体検出部２０の出力値との間の切り替えを行う。
(Relative position estimation processing when object avoidance is required)
With reference to the flowchart shown in FIG. 7, the details of the relative position estimation process when the object avoidance is required in step S107 shown in FIG. 3 in the first embodiment of the present invention will be described. Here, switching between the output value of the first
ステップＳ１１１では、物***置推定部５１は、自車と物体との相対位置及び相対速度に基づいて、当該物体を回避するまでの距離（回避開始距離）を算出する。
例えば、自車が時速３０ｋｍ／ｈで走行している時、駐車車両を検出した場合、０．２Ｇで、駐車車両と５ｍの車間距離で止まるために、回避開始距離ｓ＝Ｖ２／（２×０．２×９．８）＋５≒２２．７ｍ先に回避する必要があると算出することができる。
In step S111, the object
For example, when the host vehicle is traveling at a speed of 30 km / h and a parked vehicle is detected, the vehicle starts at 0.2 G and stops at a distance of 5 m between the parked vehicle and the avoidance start distance s = V 2 / (2 × 0.2 × 9.8) + 5≈22.7 m can be calculated as needing to be avoided first.
ステップＳ１１２では、物***置推定部５１は、第１の物体検出部１０と第２の物体検出部２０とのそれぞれの検出誤差の読み込みを行う。
例えば、第１の物体検出部１０と第２の物体検出部２０とのそれぞれの検出誤差を事前に調べてデータベースに格納しておく。例えば、図８に示しているように、第１の物体検出部１０の検出誤差（第１の検出誤差）が距離に応じて大きくなることに対して、第２の物体検出部２０の検出誤差（第２の検出誤差）が距離に関係なく、ほぼ一定である。
In step S <b> 112, the object
For example, the detection errors of the first
ステップＳ１１３では、物***置推定部５１は、読み込んだ第１の物体検出部１０と第２の物体検出部２０とのそれぞれの検出誤差に基づいて、回避動作開始する前に第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差（出力差）が既定の閾値（例えば２ｍ）以下になる可能性があるか否かを判定する。閾値は、事前に設定されているものとする。
In step S113, the object
例えば、図８に示しているように、自車の３０ｍ先に存在すると仮定した物体に対して、第１の物体検出部１０の検出誤差が３ｍであるため、検出条件が悪いときには出力値は３０＋３＝３３ｍとなると推定される。一方、第２の物体検出部２０の検出誤差が１ｍであるため、検出条件が悪いときには出力値は３０＋１＝３１ｍとなると推定される。したがって、回避開始距離２２．７ｍに対して、物体の相対位置が３０ｍ先になった時（回避開始する前）に、検出条件が悪くても出力値の差が３３−３１＝２ｍで２ｍ以下となると推定される（出力差：２ｍ≦閾値：２ｍ）。つまり、回避開始する前に、第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差が閾値以下になる可能性があると判定することができる。
For example, as shown in FIG. 8, the detection error of the first
このように、ステップＳ１１３において物***置推定部５１が行っている処理は、物体の相対位置、第１の物体検出部１０及び第２の物体検出部２０のそれぞれの検出誤差、及び回避開始距離に基づいて、将来、第１の物体検出部１０と第２の物体検出部２０との出力差が閾値以下となる可能性があるかという予測であり、第１の物体検出部１０と第２の物体検出部２０との実際の出力差が閾値以下となったかという判定ではない。
As described above, the processing performed by the object
物***置推定部５１は、閾値以下になる可能性があると判定した場合（ステップＳ１１３でＹｅｓ）、ステップＳ１１４へ進む。
物***置推定部５１は、閾値以下になる可能性がないと判定した場合（ステップＳ１１３でＮｏ）、この物体回避必要時の相対位置推定処理を終了する。
ステップＳ１１４では、物***置推定部５１は、第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差を計算する。
If the object
When the object
In step S <b> 114, the object
ステップＳ１１５では、物***置推定部５１は、第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差が閾値以下となったか否かを判定する。ステップＳ１１３に対し、ステップＳ１１５において物***置推定部５１が行っている処理は、第１の物体検出部１０と第２の物体検出部２０との実際の出力値を用いて、第１の物体検出部１０と第２の物体検出部２０との実際の出力差が閾値以下となったかという判定である。
物***置推定部５１は、閾値以下となったと判定した場合（ステップＳ１１５でＹｅｓ）、ステップＳ１１６へ進む。
物***置推定部５１は、閾値以下となったと判定しなかった場合（ステップＳ１１５でＮｏ）、ステップＳ１１４へ戻る。
In step S115, the object
If it is determined that the object
If the object
ステップＳ１１６では、物***置推定部５１は、物体の相対位置を新たに推定する。ここでは、現在の物体の相対位置を直ちに第２の物体検出部２０の出力値に変更する。
例えば、物***置推定部５１は、図９に示しているように、最初は物体が第１の物体検出部１０で検出され、重複領域内に入ってから第２の物体検出部２０も検出し始める。
物***置推定部５１は、第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差が閾値以下になっていない間には、継続して第１の相対位置を物体の相対位置と推定する。
物***置推定部５１は、自車と物体との相対位置が第１の切り替え開始点Ｗ１になったとき、第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差が閾値以下になり、制御開始位置の前であるので、ステップＳ１１６では、物体の相対位置を直ちに第２の物体検出部２０の出力値に切り替える。
In step S116, the object
For example, as shown in FIG. 9, the object
While the difference between the output value of the first
The object
（動作）
以下に、本発明の第１実施形態に係る物体検出装置を搭載した車両の挙動について説明する。
本発明の第１実施形態に係る物体検出装置を搭載した車両は、運転者がイグニッションスイッチ（ＩＧＮ）をＯＮした場合、制御装置５０の処理を開始する。車両は、運転者の運転操作又は電子制御等により、道路を走行する。
(Operation)
The behavior of the vehicle equipped with the object detection device according to the first embodiment of the present invention will be described below.
The vehicle equipped with the object detection device according to the first embodiment of the present invention starts the processing of the
車両は、道路を走行中、第１の物体検出部１０と第２の物体検出部２０とのそれぞれを用いて、自車前方の道路空間に存在する物体の有無を確認する。車両は、第１の物体検出部１０と第２の物体検出部２０との少なくとも一方において、自車前方の道路空間に存在する物体を検出した場合、自車とその物体との相対位置を検出する。このとき、車両は、第１の物体検出部１０のみで物体を検出した場合には、自車と物体との第１の相対位置を検出し、この第１の相対位置を物体の相対位置と推定する。反対に、車両は、第２の物体検出部２０のみで物体を検出した場合には、自車と物体との第２の相対位置を検出し、この第２の相対位置を物体の相対位置と推定する。車両は、推定した物体の相対位置に基づいて、自車に対する警報及び／又は制動等の運転支援を行う。
While traveling on the road, the vehicle uses each of the first
また、車両は、第１の物体検出部１０と第２の物体検出部２０との両方（重複領域）で物体を検出した場合には、第１の物体検出部１０と第２の物体検出部２０との両方で検出した物体が同一物体であるか否かを判定する。車両は、同一物体であると判定した場合には、第１の物体検出部１０よりも先に第２の物体検出部２０でその物体を検出していたか否か判定する。車両は、第１の物体検出部１０よりも先に第２の物体検出部２０でその物体を検出していなかったと判定した場合、車と物体との相対位置及び相対速度に基づいて、物体を回避する必要があるか否かを判定する。
Further, when the vehicle detects an object in both the first
車両は、物体を回避する必要があると判定した場合、自車と物体との相対位置及び相対速度に基づいて、当該物体を回避するまでの距離（回避開始距離）を算出した上で、第１の物体検出部１０と第２の物体検出部２０とのそれぞれの検出誤差の読み込みを行い、読み込んだ検出誤差に基づいて、回避動作開始する前に第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差（予測の出力差）が既定の閾値以下になる可能性があるか否かを判定する。
When the vehicle determines that it is necessary to avoid the object, the vehicle calculates the distance (avoidance start distance) until the object is avoided based on the relative position and relative speed between the vehicle and the object. The detection error of each of the first
車両は、予測の出力差が閾値以下になる可能性があると判定した場合、第１の物体検出部１０の出力値と第２の物体検出部２０との出力値とから実際の出力差を計算し、実際の出力差が閾値以下となったか否かを判定する。車両は、実際の出力差が閾値以下となったと判定しなかった場合、再度、実際の出力差を計算し、閾値以下となったと判定するまで当該処理を繰り返す。
車両は、実際の出力差が閾値以下となったと判定した場合、現在の物体の相対位置を第２の物体検出部２０の出力値に変更する。車両は、変更した物体の相対位置に基づいて、自車に対する警報及び／又は制動等の運転支援を行う。
When the vehicle determines that the predicted output difference may be less than or equal to the threshold value, the vehicle calculates the actual output difference from the output value of the first
When the vehicle determines that the actual output difference is equal to or less than the threshold, the vehicle changes the current relative position of the object to the output value of the second
なお、上記の動作において、車両は、第１の物体検出部１０と第２の物体検出部２０との両方で検出した物体が同一物体でないと判定した場合、第１の物体検出部１０よりも先に第２の物体検出部２０でその物体を検出していたと判定した場合、物体を回避する必要がないと判定した場合、及び予測の出力差が閾値以下になる可能性がないと判定した場合には、現状を維持する。
車両は、運転者がイグニッションスイッチ（ＩＧＮ）をＯＦＦした場合、制御装置５０の処理を終了する。
In the above operation, when the vehicle determines that the objects detected by both the first
The vehicle ends the process of the
（第１実施形態の効果）
本発明の第１実施形態によれば、以下のような効果を奏する。
（１）本発明の第１実施形態に係る物体検出装置は、第１の検出領域で自車と物体との第１の相対位置を検出する。第１の検出領域よりも検出可能距離が短く且つ位置検出精度が高い第２の検出領域で自車と物体との第２の相対位置を検出する。第１の相対位置及び第２の相対位置のうち少なくとも一方に基づき、物体の相対位置を推定する。物体の相対位置に基づき、物体に対して自車の回避動作が必要か否かを判定する。自車の回避動作が必要と判定していない場合であって、第１の検出領域で物体を検出し且つ第２の検出領域で物体を検出していない状況では、第１の相対位置を物体の相対位置と推定する。この状況から第２の検出領域でも物体を検出し且つ第１の相対位置と第２の相対位置との差が既定の閾値以下となった場合、第２の検出領域で物体を継続して検出している間は第２の相対位置を物体の相対位置と推定する。
その結果、第１の物体検出部で検出している第１の相対位置と第２の物体検出部で検出している第２の相対位置との差が閾値以下となった場合、第２の物体検出部で物体を継続して検出している間は、第２の相対位置を物体の相対位置と推定するため、物体の相対位置の推定結果の変動が少なく、より精度の良い結果を得ることができる。
(Effect of 1st Embodiment)
According to 1st Embodiment of this invention, there exist the following effects.
(1) The object detection apparatus according to the first embodiment of the present invention detects the first relative position between the vehicle and the object in the first detection region. A second relative position between the subject vehicle and the object is detected in a second detection area having a detectable distance shorter than that of the first detection area and having high position detection accuracy. The relative position of the object is estimated based on at least one of the first relative position and the second relative position. Based on the relative position of the object, it is determined whether an avoidance operation of the host vehicle is necessary for the object. When it is not determined that the avoidance operation of the host vehicle is necessary and the object is detected in the first detection area and the object is not detected in the second detection area, the first relative position is set to the object. The relative position of is estimated. From this situation, if the object is detected in the second detection area and the difference between the first relative position and the second relative position is equal to or less than a predetermined threshold, the object is continuously detected in the second detection area. During this time, the second relative position is estimated as the relative position of the object.
As a result, if the difference between the first relative position detected by the first object detection unit and the second relative position detected by the second object detection unit is less than or equal to the threshold value, the second While the object is continuously detected by the object detection unit, the second relative position is estimated as the relative position of the object, so that there is little fluctuation in the estimation result of the relative position of the object, and a more accurate result is obtained. be able to.
（２）本発明の第１実施形態に係る物体検出装置は、第２の物体検出部で物体が検出され且つ第１の物体検出部で物体が検出していない状況では、第２の相対位置を物体の相対位置と推定する。この状況から第１の物体検出部でも物体が検出される状況に移行しても、第２の相対位置を継続して物体の相対位置と推定する。
その結果、第１の物体検出部と第２の物体検出部の重複領域に入る前に、第２の物体検出部で検出し続けた物体に対して、第２の物体検出部で検出している第２の相対位置を継続して物体の相対位置と推定し、検出精度が高い第２の物体検出部の結果を使い続けるので、物体の相対位置を高い精度で推定することができる。
(2) The object detection device according to the first embodiment of the present invention has the second relative position in a situation where an object is detected by the second object detection unit and no object is detected by the first object detection unit. Is estimated as the relative position of the object. Even if the first object detection unit shifts from this situation to a situation where an object is detected, the second relative position is continuously estimated as the relative position of the object.
As a result, the object detected by the second object detection unit is detected by the second object detection unit before entering the overlapping region of the first object detection unit and the second object detection unit. The second relative position is continuously estimated as the relative position of the object, and the result of the second object detection unit with high detection accuracy is continuously used, so that the relative position of the object can be estimated with high accuracy.
（３）本発明の第１実施形態に係る物体検出装置は、物体の相対位置から自車に対する物体の相対速度を算出し、物体の相対速度に基づいて、自車の回避動作が必要か否かを判定する。
その結果、物体の相対位置の推定結果から自車と物体との相対速度を推定し、この相対速度に基づいて回避動作が必要か否かを判定するため、円滑な車両挙動を得ることができる。
(3) The object detection apparatus according to the first embodiment of the present invention calculates the relative speed of the object with respect to the own vehicle from the relative position of the object, and whether or not an avoidance operation of the own vehicle is necessary based on the relative speed of the object. Determine whether.
As a result, the relative speed between the vehicle and the object is estimated from the estimation result of the relative position of the object, and it is determined whether or not an avoidance operation is necessary based on the relative speed, so that a smooth vehicle behavior can be obtained. .
＜第２実施形態＞
以下に、本発明の第２実施形態について説明する。
本発明の第２実施形態に係る物体検出装置の構成及び処理内容については、基本的に第１実施形態と同様である。異なるのは、図７に示すフローチャートにおけるステップＳ１１３でＮｏとなった場合以降の処理である。
Second Embodiment
The second embodiment of the present invention will be described below.
The configuration and processing contents of the object detection device according to the second embodiment of the present invention are basically the same as those in the first embodiment. The difference is the processing after the case of No in step S113 in the flowchart shown in FIG.
第１実施形態では、回避動作開始する前に第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差が既定の閾値以下になる可能性があると判定された場合に、物体の相対位置を第１の物体検出部１０の出力値から第２の物体検出部２０の出力値に変更する処理方法を採用している。
これに対して、第２実施形態では、回避動作開始する前に第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差が既定の閾値以下になる可能性がない（閾値よりも大きい）と判定された場合にも、物体の相対位置を第１の物体検出部１０の出力値から第２の物体検出部２０の出力値に変更する処理方法を採用している。
In the first embodiment, it is determined that the difference between the output value of the first
On the other hand, in the second embodiment, the difference between the output value of the first
（物体回避必要時の相対位置推定処理）
図１０に示すフローチャートを参照して、本発明の第２実施形態における、図３に示したステップＳ１０７での物体回避必要時の相対位置推定処理の詳細について説明する。なお、図１０において、図７と同じ符号が付与された処理は、図７と同じ処理であるため、説明を省略する。
(Relative position estimation processing when object avoidance is required)
With reference to the flowchart shown in FIG. 10, the details of the relative position estimation process when the object avoidance is required in step S107 shown in FIG. 3 in the second embodiment of the present invention will be described. In FIG. 10, the process given the same reference numeral as in FIG. 7 is the same process as in FIG.
ステップＳ１１３では、物***置推定部５１は、閾値以下になる可能性がないと判定した場合（ステップＳ１１３でＮｏ）、ステップＳ１１７へ進む。
例えば、自車速Ｖ＝４５ｋｍ／ｈで走行し、駐車車両を検出した場合、０．２Ｇで、駐車車両との車間距離５ｍで停車したい場合、回避開始距離ｓ＝Ｖ２／（２×０．２×９．８）＋５≒４５ｍ先に回避開始する必要がある。しかし、図８に示しているように、自車の４５ｍ先に存在すると仮定した物体に対して、第１の物体検出部１０の検出誤差は４ｍであるため、検出条件が悪いときには出力値は４５＋４＝４９ｍとなると推定される。一方、第２の物体検出部２０の検出誤差は１ｍであるため、検出条件が悪いときには出力値は４５＋１＝４６ｍとなると推定される。したがって、回避開始距離４５ｍに対して、物体の相対位置が４５ｍ先になった時（回避開始する時）に、検出条件が悪ければ出力値の差が４９−４６＝３ｍで２ｍより大きくなる（出力差：３ｍ＞閾値：２ｍ）。つまり、回避開始する前に、第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差が閾値以下になる可能性がない（閾値より大きい）と判定することができる。
In step S113, when the object
For example, if the vehicle travels at a vehicle speed V = 45 km / h and a parked vehicle is detected, the avoidance start distance s = V 2 / (2 × 0. It is necessary to start avoiding 2 × 9.8) + 5≈45 m ahead. However, as shown in FIG. 8, the detection error of the first
ステップＳ１１７では、物***置推定部５１は、第１の相対位置から第２の相対位置に近づけるように物体の相対位置を推定するため、第１の物体検出部１０の出力値と第２の物体検出部２０との出力値とを近づける起点として第１の切り替え開始点Ｗ１を算出する。
つまり、ステップＳ１１３で回避動作開始する前に第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差が閾値以下になる可能性がないと判定した場合であっても、回避を開始する前に、推定した物体の相対位置を検出精度が高い第２の物体検出部２０の出力値に切り替えるのが望ましい。推定した物体の相対位置の急な変動を避けるために緩和して、第１の相対位置から第２の相対位置に近づけるように物体の相対位置を推定する。
In step S117, the object
That is, when it is determined in step S113 that there is no possibility that the difference between the output value of the first
例えば、回避開始する１ｓ前から、第１の相対位置から第２の相対位置に近づける場合、回避開始する１ｓ前は物体までの距離がＶ／１＋ｓ＝１２．５＋４５＝５７．５ｍである。図８に示しているように、５７．５ｍ先の物体に対して第１の物体検出部１０の検出誤差は５ｍで、５７．５先の物体に対しての検出値は６２．５ｍ、第２の物体検出部２０の検出誤差は１ｍで、５７．５先の物体に対しての検出値は５８．５ｍであり、第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差が６２．５−５８．５＝４ｍである。
For example, when approaching from the first relative position to the second relative position from 1 s before starting avoidance, the distance to the object is V / 1 + s = 12.5 + 45 = 57.5 m before 1 s before starting avoidance. As shown in FIG. 8, the detection error of the first
すなわち、図１１（ａ）に示しているように、第１の相対位置が６２．５ｍになった時、第１の相対位置から第２の相対位置に近づけさせ始める。例えば、第１の物体検出部１０と第２の物体検出部２０との検出周期が１００ｍｓの場合、１ｓ間で１０回検出処理を行うので、４ｍ／１０回＝０．４ｍずつ第１の相対位置から第２の相対位置に近づける。
That is, as shown in FIG. 11A, when the first relative position reaches 62.5 m, the first relative position starts to approach the second relative position. For example, when the detection cycle of the first
ステップＳ１１８では、物***置推定部５１は、ステップＳ１１７で算出した第１の切り替え開始点Ｗ１に到着したか否かを判定する。
物***置推定部５１は、第１の切り替え開始点Ｗ１に到着したと判定した場合、ステップＳ１１９へ進む。
物***置推定部５１は、第１の切り替え開始点Ｗ１に到着したと判定していない場合、引き続き第１の相対位置を物体の相対位置と推定する。
例えば、図１１（ｂ）に示しているように、第１の切り替え開始点Ｗ１に到着する前は、継続して第１の相対位置を物体の相対位置と推定する。
In step S118, the object
If the object
If the object
For example, as shown in FIG. 11B, the first relative position is continuously estimated as the relative position of the object before arriving at the first switching start point W1.
ステップＳ１１９では、物***置推定部５１は、ステップＳ１１８で第１の切り替え開始点Ｗ１に到着したと判定した場合、第１の相対位置から第２の相対位置に近づけるように物体の相対位置を推定する。すなわち、第１の相対位置を物体の相対位置と推定する状態から第２の相対位置を物体の相対位置と推定する状態にまで、推定している物体の相対位置を徐々に変化させる。
例えば、図１１（ｂ）に示しているように、第１の切り替え開始点Ｗ１に到着した時点から、第１の相対位置から第２の相対位置に近づけさせ始める。これにより、物体の相対位置が第１の相対位置から第２の相対位置になる。
In step S119, when the object
For example, as shown in FIG. 11B, the first relative position starts to approach the second relative position from the time when the first switching start point W1 is reached. As a result, the relative position of the object is changed from the first relative position to the second relative position.
（動作）
以下に、本発明の第２実施形態に係る物体検出装置を搭載した車両の挙動について説明する。なお、本発明の第１実施形態に係る物体検出装置を搭載した車両と同じ挙動については、説明を省略する。
本発明の第２実施形態に係る物体検出装置を搭載した車両は、回避動作開始する前に第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差が閾値以下になる可能性がないと判定した場合、第１の物体検出部１０の出力値と第２の物体検出部２０との出力値とを近づける起点として第１の切り替え開始点Ｗ１を算出し、算出した第１の切り替え開始点Ｗ１に到着したか否かを判定する。車両は、第１の切り替え開始点Ｗ１に到着していないと判定した場合、第１の切り替え開始点Ｗ１に到着したと判定するまで、当該判定処理を定期的に繰り返す。車両は、第１の切り替え開始点Ｗ１に到着したと判定した場合、第１の相対位置から第２の相対位置に近づけるように物体の相対位置を推定する。車両は、物体の相対位置に基づいて、自車に対する警報及び／又は制動等の運転支援を行う。
(Operation)
The behavior of the vehicle equipped with the object detection device according to the second embodiment of the present invention will be described below. In addition, description is abbreviate | omitted about the same behavior as the vehicle carrying the object detection apparatus which concerns on 1st Embodiment of this invention.
The vehicle equipped with the object detection device according to the second embodiment of the present invention has a difference between the output value of the first
（第２実施形態の効果）
本発明の第２実施形態によれば、以下のような効果を奏する。
（１）本発明の第２実施形態に係る物体検出装置は、自車の回避動作が必要と判定した後に、物体を第１の物体検出部で検出し且つ第２の物体検出部で検出していない状況から第２の物体検出部でも物体を検出している状況に移行した場合であって、第１の相対位置と第２の相対位置との差が既定の閾値より大きい場合には、第１の相対位置を物体の相対位置と推定する状態から第２の相対位置を物体の相対位置と推定する状態にまで、推定している物体の相対位置を徐々に変化させる。
(Effect of 2nd Embodiment)
According to 2nd Embodiment of this invention, there exist the following effects.
(1) The object detection apparatus according to the second embodiment of the present invention detects an object with the first object detection unit and detects with the second object detection unit after determining that the avoidance operation of the own vehicle is necessary. In the case where the second object detection unit shifts to a situation where the second object detection unit detects an object, and the difference between the first relative position and the second relative position is larger than a predetermined threshold value, The estimated relative position of the object is gradually changed from the state in which the first relative position is estimated as the relative position of the object to the state in which the second relative position is estimated as the relative position of the object.
その結果、回避動作が必要と判定した後で、第１の物体検出部で検出している物体が、第２の物体検出部で検出している場合であって、第１の物体検出部で検出している第１の相対位置と第２の物体検出部で検出している第２の相対位置との差が閾値より大きい場合、第１の相対位置から第２の相対位置に近づけるように物体の相対位置を推定し、回避動作を開始する前に相対位置を少しずつ精度が良好な第２の物体検出部の出力値に近づけるように切り替えるので、自車の挙動に影響を与えることなく、変動が少ない相対位置を得ることができる。
その他の効果については、第１実施形態と同様である。
As a result, when it is determined that an avoidance operation is necessary, the object detected by the first object detection unit is detected by the second object detection unit, and the first object detection unit When the difference between the detected first relative position and the second relative position detected by the second object detection unit is larger than the threshold, the first relative position is brought closer to the second relative position. Since the relative position of the object is estimated and the relative position is gradually switched closer to the output value of the second object detection unit with good accuracy before the avoidance operation is started, without affecting the behavior of the host vehicle The relative position with little fluctuation can be obtained.
Other effects are the same as in the first embodiment.
＜第３実施形態＞
以下に、本発明の第３実施形態について説明する。
本発明の第３実施形態に係る物体検出装置の構成及び処理内容については、基本的に第１実施形態と同様である。異なるのは、図３に示すフローチャートにおけるステップＳ１０６でＮｏとなった場合以降の処理である。
第１実施形態では、図３に示すフローチャートにおけるステップＳ１０６において、回避が必要であると判定された場合に、物体の相対位置を第１の物体検出部１０の出力値から第２の物体検出部２０の出力値に変更する処理方法を採用している。
これに対して、第３実施形態では、図３に示すフローチャートにおけるステップＳ１０６において、回避が必要でないと判定された場合に、物体の相対位置を第２の物体検出部２０の出力値から第１の物体検出部１０の出力値に変更する処理方法を採用している。
<Third Embodiment>
The third embodiment of the present invention will be described below.
The configuration and processing contents of the object detection apparatus according to the third embodiment of the present invention are basically the same as those in the first embodiment. The difference is the processing after the case of No in step S106 in the flowchart shown in FIG.
In the first embodiment, when it is determined in step S106 in the flowchart shown in FIG. 3 that avoidance is necessary, the relative position of the object is determined from the output value of the first
On the other hand, in the third embodiment, when it is determined in step S106 in the flowchart shown in FIG. 3 that avoidance is not necessary, the relative position of the object is determined from the output value of the second
（処理の流れ）
図１２に示すフローチャートを参照して、本発明の第３実施形態に係る物体検出装置での処理の流れについて説明する。なお、図１２において、図３と同じ符号が付与された処理は、図３と同じ処理であるため、説明を省略する。
図１２に示すように、第３実施形態では、ステップＳ１０９として、物***置推定部５１は、ステップＳ１０６で回避が必要でないと判定された場合に、後述する物体回避不要時の相対位置推定処理を実施する。その他の処理については、図３に示した処理と同様である。
なお、反対に、ステップＳ１０６で回避が必要であると判定された場合には、図３に示すフローチャートにおけるステップＳ１０７の処理として第１又は第２実施形態と同様の処理（図７、図１０参照）を行うようにしても良いし、図３に示すフローチャートにおけるステップＳ１０８へ進むようにしても良い。
(Process flow)
With reference to the flowchart shown in FIG. 12, the flow of processing in the object detection apparatus according to the third embodiment of the present invention will be described. In FIG. 12, the process given the same reference numeral as in FIG. 3 is the same process as in FIG.
As shown in FIG. 12, in the third embodiment, in step S109, the object
On the other hand, if it is determined in step S106 that avoidance is necessary, the processing in step S107 in the flowchart shown in FIG. 3 is the same as in the first or second embodiment (see FIGS. 7 and 10). ) May be performed, or the process may proceed to step S108 in the flowchart shown in FIG.
（物体回避不要時の相対位置推定処理）
図１３に示すフローチャートを参照して、本発明の第３実施形態における、図１２に示したステップＳ１０９での物体の相対位置の推定処理の詳細について説明する。
ステップＳ３１１では、物***置推定部５１は、ステップＳ１０６で回避する必要がないと判定された場合、検出された物体が第２の検出領域を逸脱する可能性があるか否かを判定する。
(Relative position estimation processing when object avoidance is unnecessary)
With reference to the flowchart shown in FIG. 13, the details of the process of estimating the relative position of the object in step S109 shown in FIG. 12 in the third embodiment of the present invention will be described.
In step S311, the object
例えば、先行車との相対距離６０ｍ、相対速度１０ｋｍ／ｈ（先行車が速い）の場合、７．２ｓ後に自車と物体との相対距離が８０ｍになることを算出することができる。つまり、７．２ｓ後に物体が第２の検出領域を逸脱する可能性があると判定することができる。
物***置推定部５１は、物体が第２の検出領域を逸脱する可能性があると判定した場合、ステップＳ３１２へ進む。
物***置推定部５１は、物体が第２の検出領域を逸脱する可能性がないと判定した場合、この物体回避不要時の相対位置推定処理を終了する。
For example, when the relative distance to the preceding vehicle is 60 m and the relative speed is 10 km / h (the preceding vehicle is fast), it can be calculated that the relative distance between the vehicle and the object is 80 m after 7.2 s. That is, it can be determined that the object may deviate from the second detection region after 7.2 seconds.
If the object
When the object
ステップＳ３１２では、物***置推定部５１は、推定した物体の相対位置の急な変動を避けるために、物体が第２の検出領域を逸脱する前に緩和して、第２の相対位置から第１の相対位置に近づけるように物体の相対位置を推定するため、第１の物体検出部１０の出力値と第２の物体検出部２０の出力値とを近づける起点として第２の切り替え開始点Ｗ２を算出する。
In step S312, the object
つまり、ステップＳ３１１で物体が第２の検出領域を逸脱する可能性があると判定した場合には、第２の検出領域を逸脱する前に、推定した物体の相対位置を第２の物体検出部２０の出力値から第１の物体検出部１０の出力値に早めに切り替えておくのが望ましい。推定した物体の相対位置の急な変動を避けるために緩和して、第２の相対位置から第１の相対位置に近づけるように物体の相対位置を推定する。
That is, if it is determined in step S311 that the object may deviate from the second detection area, the estimated relative position of the object is determined as the second object detection unit before deviating from the second detection area. It is desirable to switch from the output value of 20 to the output value of the first
例えば、第２の検出領域を逸脱する１ｓ前に、第２の相対位置から第１の相対位置に近づける場合、図１４（ａ）に示しているように、第２の検出領域を逸脱するＶ×ｔ＝（１０ｋｍ／ｈ）×３＝８ｍ先に切り替え始める。
この場合、自車と物体との相対距離が８０−８＝７２ｍ、図８に示しているように、第１の物体検出部１０の誤差が２０ｍであり、第２の物体検出部２０の検出誤差が１ｍであるので、第１の物体検出部１０の出力値と第２の物体検出部２０との出力値との差が１９ｍある。
例えば、第１の物体検出部１０と第２の物体検出部２０との検出周期１００ｍｓである場合、３ｓで３０回検出処理を行うので、１９ｍ／３０回＝０．６３ｍずつ第２の相対位置から第１の相対位置に近づける。
For example, when approaching the first relative position from the second relative position 1 s before deviating from the second detection area, as shown in FIG. 14A, V deviates from the second detection area. Xt = (10 km / h) × 3 = Start switching to 8 m ahead.
In this case, the relative distance between the vehicle and the object is 80−8 = 72 m, and as shown in FIG. 8, the error of the first
For example, when the detection cycle of the first
ステップＳ３１３では、物***置推定部５１は、ステップＳ３１２で算出した第２の切り替え開始点Ｗ２に到着したか否かを判定する。
物***置推定部５１は、第２の切り替え開始点Ｗ２に到着したと判定した場合、ステップＳ３１４へ進む。
物***置推定部５１は、第２の切り替え開始点Ｗ２に到着したと判定していない場合、引き続き第２の相対位置を物体の相対位置と推定する。
例えば、図１４（ｂ）に示しているように、第２の切り替え開始点Ｗ２に到着する前は、継続して第２の相対位置を物体の相対位置と推定する。
In step S313, the object
If the object
When the object
For example, as shown in FIG. 14B, before reaching the second switching start point W2, the second relative position is continuously estimated as the relative position of the object.
ステップＳ３１４では、物***置推定部５１は、ステップＳ３１３で第２の切り替え開始点Ｗ２に到着したと判定した場合、第２の相対位置から第１の相対位置に近づけるように物体の相対位置を推定する。すなわち、第２の相対位置を物体の相対位置と推定する状態から第１の相対位置を物体の相対位置と推定する状態にまで、推定している物体の相対位置を徐々に変化させる。
例えば、図１４（ｂ）に示しているように、第２の切り替え開始点Ｗ２から、第２の相対位置から第１の相対位置に近づけ始め、物体の相対位置が第２の相対位置から第１の相対位置になる。
In step S314, when the object
For example, as shown in FIG. 14B, the second relative start position W2 starts to approach the first relative position from the second switching start point W2, and the relative position of the object is changed from the second relative position to the first relative position. 1 relative position.
（動作）
以下に、本発明の第３実施形態に係る物体検出装置を搭載した車両の挙動について説明する。なお、本発明の第１実施形態に係る物体検出装置を搭載した車両と同じ挙動については、説明を省略する。
本発明の第３実施形態に係る物体検出装置を搭載した車両は、物体を回避する必要がないと判定した場合、検出された物体が第２の検出領域を逸脱する可能性があるか否かを判定する。車両は、物体が第２の検出領域を逸脱する可能性があると判定した場合、第２の相対位置から第１の相対位置に近づける起点として第２の切り替え開始点Ｗ２を算出し、算出した第２の切り替え開始点Ｗ２に到着したか否かを判定する。車両は、第２の切り替え開始点Ｗ２に到着していないと判定した場合、第２の切り替え開始点Ｗ２に到着したと判定するまで、当該判定処理を定期的に繰り返す。車両は、第２の切り替え開始点Ｗ２に到着したと判定した場合、第２の相対位置から第１の相対位置に近づけるように物体の相対位置を推定する。車両は、物体の相対位置に基づいて、自車に対する警報及び／又は制動等の運転支援を行う。
(Operation)
The behavior of the vehicle equipped with the object detection device according to the third embodiment of the present invention will be described below. In addition, description is abbreviate | omitted about the same behavior as the vehicle carrying the object detection apparatus which concerns on 1st Embodiment of this invention.
Whether or not the vehicle equipped with the object detection device according to the third embodiment of the present invention has a possibility that the detected object may deviate from the second detection area when it is determined that it is not necessary to avoid the object. Determine. When the vehicle determines that the object may deviate from the second detection area, the vehicle calculates the second switching start point W2 as a starting point that approaches the first relative position from the second relative position, and calculates It is determined whether or not the second switching start point W2 has been reached. When it is determined that the vehicle has not arrived at the second switching start point W2, the determination process is periodically repeated until it is determined that the vehicle has arrived at the second switching start point W2. When it is determined that the vehicle has arrived at the second switching start point W2, the vehicle estimates the relative position of the object so as to approach the first relative position from the second relative position. Based on the relative position of the object, the vehicle provides driving assistance such as warning and / or braking for the vehicle.
（第３実施形態の効果）
本発明の第３実施形態によれば、以下のような効果を奏する。
（１）本発明の第３実施形態に係る物体検出装置は、第２の検出領域で物体を検出し且つ第１の検出領域で物体を検出していない状況から第１の検出領域でも物体を検出している状況に移行した場合であって、物体を第２の検出領域の検出領域を逸脱すると推定した場合には、第２の検出領域で物体を検出できなくなる前に、第２の相対位置を物体の相対位置と推定する状態から第１の相対位置を物体の相対位置と推定する状態にまで、推定している物体の相対位置を徐々に変化させる。
(Effect of the third embodiment)
According to 3rd Embodiment of this invention, there exist the following effects.
(1) The object detection apparatus according to the third embodiment of the present invention detects an object in the first detection region from a situation in which the object is detected in the second detection region and no object is detected in the first detection region. If it is assumed that the object has deviated from the detection area of the second detection area when the state has shifted to the detection state, the second relative area is detected before the object cannot be detected in the second detection area. The relative position of the estimated object is gradually changed from the state where the position is estimated as the relative position of the object to the state where the first relative position is estimated as the relative position of the object.
その結果、自車と物体との相対距離が大きくなり、物体が第２の物体検出部の検出領域を逸脱すると推定された場合、第２の物体検出部で物体を検出できなくなる前に、第１の物体検出部で検出された第１の相対位置に近づけるように物体の相対位置を推定するため、第２の物体検出部で物体を検出できなくなることによる検出のロスト（消失）をなくすことができる。また、第２の物体検出部２０の出力値から第１の物体検出部の出力値に急に切り替わることによる物体の相対位置の変動を避けることもできる。
その他の効果については、第１実施形態と同様である。
As a result, when the relative distance between the vehicle and the object increases and the object is estimated to deviate from the detection area of the second object detection unit, the second object detection unit cannot detect the object before the second object detection unit can detect the object. Since the relative position of the object is estimated to be close to the first relative position detected by the first object detection unit, the lost detection (disappearance) due to the fact that the second object detection unit cannot detect the object is eliminated. Can do. Also, it is possible to avoid fluctuations in the relative position of the object due to abrupt switching from the output value of the second
Other effects are the same as in the first embodiment.
＜その他実施形態＞
上記のように、本発明は第１〜第３実施形態によって記載したが、この開示の一部をなす論述及び図面は本発明を限定するものであると理解すべきではない。この開示から当業者には様々な代替の実施形態、実施例及び運用技術が明らかとなろう。
上記の各実施形態は、第１〜第３実施形態で説明したそれぞれの技術的思想を互いに組み合わせることも可能である。また、装置の動作モードや機能の切り替え等により、実施形態を変更できるようにしても良い。
このように、本発明はここでは記載していない様々な実施形態等を含むことは勿論である。したがって、本発明の技術的範囲は上記の各実施形態に限られるものではなく、本発明の要旨を逸脱しない範囲の変更があっても本発明の技術的範囲に含まれる。
<Other embodiments>
As described above, the present invention has been described according to the first to third embodiments. However, it should not be understood that the description and drawings constituting a part of this disclosure limit the present invention. From this disclosure, various alternative embodiments, examples and operational techniques will be apparent to those skilled in the art.
In the above embodiments, the technical ideas described in the first to third embodiments can be combined with each other. The embodiment may be changed by switching the operation mode or function of the apparatus.
As described above, the present invention naturally includes various embodiments not described herein. Therefore, the technical scope of the present invention is not limited to the above-described embodiments, and changes in the scope that do not depart from the gist of the present invention are included in the technical scope of the present invention.
１０ 第１の物体検出部
２０ 第２の物体検出部
３０ 自車情報取得部
５０ 制御装置
５１ 物***置推定部
５２ 重複領域判定部
５３ 同一物体判定部
５４ 検出済物体判定部
５５ 回避判定部
５６ 停車判定部
DESCRIPTION OF
Claims (6)
前記第１の物体検出部よりも検出可能距離が短く且つ位置検出精度が高く、自車と物体との第２の相対位置を検出する第２の物体検出部と、
前記第１の物体検出部で検出した前記第１の相対位置及び前記第２の物体検出部で検出した前記第２の相対位置のうち少なくとも一方に基づき、前記物体の相対位置を推定する物***置推定部と、
前記物***置推定部で推定した前記物体の相対位置に基づき、前記物体に対して自車の回避動作が必要か否かを判定する回避判定部と、を備え、
前記物***置推定部は、前記回避判定部により自車の回避動作が必要と判定されていない場合であって、前記第１の物体検出部で前記物体が検出され且つ前記第２の物体検出部で前記物体が検出されていない状況では、前記第１の相対位置を前記物体の相対位置と推定し、
この状況から前記第２の物体検出部でも前記物体が検出される状況に移行し且つ前記第１の相対位置と前記第２の相対位置との差が既定の閾値以下となった場合、前記第２の物体検出部で前記物体を継続して検出されている間は前記第２の相対位置を前記物体の相対位置と推定することを特徴とする物体検出装置。 A first object detection unit for detecting a first relative position between the vehicle and the object;
A second object detection unit that detects a second relative position between the vehicle and the object, the detectable distance is shorter than the first object detection unit, and the position detection accuracy is high;
An object position for estimating the relative position of the object based on at least one of the first relative position detected by the first object detection unit and the second relative position detected by the second object detection unit. An estimation unit;
An avoidance determination unit that determines whether an avoidance operation of the host vehicle is necessary for the object based on the relative position of the object estimated by the object position estimation unit;
The object position estimation unit is a case where the avoidance determination unit has not determined that an avoidance operation of the host vehicle is necessary, and the first object detection unit detects the object and the second object detection unit In the situation where the object is not detected, the first relative position is estimated as the relative position of the object,
When the situation shifts from this situation to the situation where the second object detection unit detects the object, and the difference between the first relative position and the second relative position is equal to or less than a predetermined threshold, An object detection apparatus that estimates the second relative position as the relative position of the object while the object is continuously detected by the two object detection units.
この状況から前記第１の物体検出部でも前記物体が検出される状況に移行しても、前記第２の相対位置を継続して前記物体の相対位置と推定する請求項１に記載の物体検出装置。 In the situation where the object is detected by the second object detection unit and the object is not detected by the first object detection unit, the object position estimation unit calculates the second relative position relative to the object. Estimated position,
2. The object detection according to claim 1, wherein the second relative position is continuously estimated as the relative position of the object even if the first object detection unit shifts from this situation to a situation where the object is detected. apparatus.
前記第１の検出領域よりも検出可能距離が短く且つ位置検出精度が高い第２の検出領域で自車と前記物体との第２の相対位置を検出し、
前記第１の相対位置及び前記第２の相対位置のうち少なくとも一方に基づき、前記物体の相対位置を推定し、
前記物体の相対位置に基づき、前記物体に対して自車の回避動作が必要か否かを判定する物体検出方法であって、
自車の回避動作が必要と判定されていない場合であって、前記第１の検出領域で前記物体を検出し且つ前記第２の検出領域で前記物体を検出していない状況では、前記第１の相対位置を前記物体の相対位置と推定し、
この状況から前記第２の検出領域でも前記物体を検出し且つ前記第１の相対位置と前記第２の相対位置との差が既定の閾値以下となった場合、前記第２の検出領域で前記物体を継続して検出している間は前記第２の相対位置を前記物体の相対位置と推定することを特徴とする物体検出方法。 Detecting the first relative position between the vehicle and the object in the first detection region;
Detecting a second relative position between the vehicle and the object in a second detection area having a detectable distance shorter than the first detection area and having high position detection accuracy;
Estimating the relative position of the object based on at least one of the first relative position and the second relative position;
An object detection method for determining whether an avoidance operation of the host vehicle is necessary for the object based on a relative position of the object,
In a situation where it is determined that the avoidance operation of the host vehicle is not necessary and the object is detected in the first detection area and the object is not detected in the second detection area, Is estimated as the relative position of the object,
From this situation, when the object is detected also in the second detection area and the difference between the first relative position and the second relative position is equal to or less than a predetermined threshold value, the second detection area An object detection method, wherein the second relative position is estimated as the relative position of the object while the object is continuously detected.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2015083435A JP6455292B2 (en) | 2015-04-15 | 2015-04-15 | Object detection apparatus and object detection method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2015083435A JP6455292B2 (en) | 2015-04-15 | 2015-04-15 | Object detection apparatus and object detection method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2016206717A JP2016206717A (en) | 2016-12-08 |
| JP6455292B2 true JP6455292B2 (en) | 2019-01-23 |
Family
ID=57489936
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2015083435A Active JP6455292B2 (en) | 2015-04-15 | 2015-04-15 | Object detection apparatus and object detection method |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP6455292B2 (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2018158642A1 (en) * | 2017-03-01 | 2018-09-07 | Mobileye Vision Technologies Ltd. | Systems and methods for navigating with sensing uncertainty |
| DE102017118156A1 (en) * | 2017-08-09 | 2019-02-14 | Valeo Schalter Und Sensoren Gmbh | Method for monitoring an environmental region of a motor vehicle, sensor control device, driver assistance system and motor vehicle |
Family Cites Families (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3890846B2 (en) * | 2000-02-24 | 2007-03-07 | 日産自動車株式会社 | Vehicle tracking control device |
| JP2002032899A (en) * | 2000-07-17 | 2002-01-31 | Honda Motor Co Ltd | Object detecting device for moving body |
| JP3925332B2 (en) * | 2002-07-04 | 2007-06-06 | 日産自動車株式会社 | Vehicle external recognition device |
| JP2004108944A (en) * | 2002-09-18 | 2004-04-08 | Nissan Motor Co Ltd | Obstacle detection device |
| US20090254260A1 (en) * | 2008-04-07 | 2009-10-08 | Axel Nix | Full speed range adaptive cruise control system |
| JP5727356B2 (en) * | 2011-11-30 | 2015-06-03 | 日立オートモティブシステムズ株式会社 | Object detection device |
-
2015
- 2015-04-15 JP JP2015083435A patent/JP6455292B2/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP2016206717A (en) | 2016-12-08 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP6325670B2 (en) | Lane selection device, vehicle control system, and lane selection method | |
| US9809223B2 (en) | Driving assistant for vehicles | |
| US9911330B2 (en) | Driving assistance device and driving assistance method | |
| CN105799700B (en) | Avoid collision control system and control method | |
| US9499169B2 (en) | Driving assistance device | |
| CN109484400B (en) | Vehicle travel control device | |
| KR101617345B1 (en) | System and method for estimating driving lane of vehicle | |
| US9896098B2 (en) | Vehicle travel control device | |
| KR102108056B1 (en) | Apparatus and method for providing parking control | |
| KR102112125B1 (en) | Vehicle control device | |
| US20190073540A1 (en) | Vehicle control device, vehicle control method, and storage medium | |
| WO2007132860A1 (en) | Object recognition device | |
| CN107004367B (en) | Vehicle travel control device and travel control method | |
| CN104071157B (en) | Mobile unit | |
| WO2017017705A1 (en) | Host-position estimation device and host-position estimation method | |
| JP2010083244A (en) | Vehicle steering control device | |
| US20160101812A1 (en) | Steering assist control apparatus and steering assist control method | |
| JP6364869B2 (en) | Driving assistance device | |
| JP2015168406A (en) | Lane change assist system | |
| JP2011070311A (en) | Driving support display device | |
| WO2018047223A1 (en) | Obstacle determination method, parking support method, dispatch support method, and obstacle determination device | |
| JP2008149860A (en) | Travel control device | |
| JPWO2019008760A1 (en) | Parking assistance method and parking assistance device | |
| JP6245186B2 (en) | Confluence support device | |
| JP2018063122A (en) | Route selection method and route selection device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20180126 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20181109 |
|
| 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: 20181120 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20181203 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 6455292 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |