JP6845117B2 - 移動物体認識装置 - Google Patents

移動物体認識装置 Download PDF

Info

Publication number
JP6845117B2
JP6845117B2 JP2017201899A JP2017201899A JP6845117B2 JP 6845117 B2 JP6845117 B2 JP 6845117B2 JP 2017201899 A JP2017201899 A JP 2017201899A JP 2017201899 A JP2017201899 A JP 2017201899A JP 6845117 B2 JP6845117 B2 JP 6845117B2
Authority
JP
Japan
Prior art keywords
moving object
moving
road
recognition device
roadside
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
Application number
JP2017201899A
Other languages
English (en)
Other versions
JP2019074466A (ja
Inventor
悠介 赤峰
悠介 赤峰
康之 三宅
康之 三宅
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Denso Corp
Original Assignee
Denso Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Denso Corp filed Critical Denso Corp
Priority to JP2017201899A priority Critical patent/JP6845117B2/ja
Priority to PCT/JP2018/038528 priority patent/WO2019078211A1/ja
Publication of JP2019074466A publication Critical patent/JP2019074466A/ja
Priority to US16/851,795 priority patent/US11841419B2/en
Application granted granted Critical
Publication of JP6845117B2 publication Critical patent/JP6845117B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00—Image analysis
    • G06T7/20—Analysis of motion
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50—Systems of measurement based on relative movement of target
    • G01S13/58—Velocity or trajectory determination systems; Sense-of-movement determination systems
    • G01S13/62—Sense-of-movement determination
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095—Predicting travel path or likelihood of collision
    • B60W30/0956—Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50—Systems of measurement based on relative movement of target
    • G01S13/52—Discriminating between fixed and moving objects or between objects moving at different speeds
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50—Systems of measurement based on relative movement of target
    • G01S13/58—Velocity or trajectory determination systems; Sense-of-movement determination systems
    • G01S13/60—Velocity or trajectory determination systems; Sense-of-movement determination systems wherein the transmitter and receiver are mounted on the moving object, e.g. for determining ground speed, drift angle, ground track
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/50—Context or environment of the image
    • G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/16—Anti-collision systems
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/932—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles using own vehicle data, e.g. ground speed, steering wheel direction
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9322—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles using additional data, e.g. driver condition, road state or weather data
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00—Indexing scheme for image analysis or image enhancement
    • G06T2207/30—Subject of image; Context of image processing
    • G06T2207/30248—Vehicle exterior or interior
    • G06T2207/30252—Vehicle exterior; Vicinity of vehicle

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Multimedia (AREA)
  • Theoretical Computer Science (AREA)
  • Electromagnetism (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Traffic Control Systems (AREA)
  • Radar Systems Or Details Thereof (AREA)
  • Image Analysis (AREA)
  • Signal Processing (AREA)

Description

本開示は、移動物体の移動方向を推定する技術に関する。
自車両の周囲に存在する移動物体の動きを予測する技術が知られている。例えば、特許文献１に記載された技術によると、自車両の周辺に存在するターゲットの動きを予測フィルタで予測するために、ターゲットの検出開始時から所定時間内に検出されたターゲットの複数の位置情報に対して、回帰解析として線形回帰処理を行い予測フィルタに入力する初期値としている。
特開２００１−２７２４６６号公報
しかしながら、特許文献１に記載された技術では、回帰解析により予測フィルタに入力する初期値を算出するために、ターゲットの検出開始時から所定時間内、ターゲットの複数の位置情報を検出する必要があるので、ターゲットの動きを予測するまでの応答性が低いという課題がある。
ターゲットの位置情報の検出回数を低減し、所定時間を短縮すれば応答性は向上する。しかし、ターゲットの位置情報の検出回数を低減して所定時間を短縮すると、ターゲットの動きを予測するために予測フィルタに入力する初期値の精度が低下する。
本開示は、移動物体の移動方向を、精度を確保しつつ高い応答性で推定する技術を提供する。
本開示の移動物体認識装置（２０）は、物体検出部（２２、Ｓ４００、Ｓ４０２）と、位置検出部（２４、Ｓ４００）と、道路方向推定部（２８、Ｓ４０６、Ｓ４２２〜Ｓ４２８）と、移動方向推定部（３２、Ｓ４０８、Ｓ４１０）と、を備えている。
物体検出部は、自車両（１００）の周囲に存在する物体（１１０、２００）から、自車両の周囲の道路を移動する移動物体（１１０）と道路の路側物体（２００）とを検出する。位置検出部は、物体検出部が検出する移動物体と路側物体との位置を検出する。道路方向推定部は、位置検出部が検出する路側物体の位置に基づいて、移動物体が移動している道路の道路方向を推定する。移動方向推定部は、道路方向推定部が推定する道路方向に基づいて移動物体の移動方向（１１２）を推定する。
路側物体は道路の方向に沿って存在しているので、複数の路側物体の位置に基づいて道路方向を推定できる。複数の路側物体の位置は１回の検出処理により検出できるので、１回の検出処理により道路方向を推定できる。移動部物体は道路に沿って移動しているので、１回の検出処理により推定された道路方向に基づいて、移動物体が道路方向のどちらかに移動していることを高精度に推定できる。
移動物体が道路方向のどちらに移動しているかは、例えば移動物体の位置の変化方向、あるいは自車両に対する移動物体の相対速度等を検出することにより、極力少ない検出回数で決定できる。
したがって、道路方向に基づいて、精度を確保しつつ高い応答性で移動物体の移動方向を推定できる。
尚、この欄および特許請求の範囲に記載した括弧内の符号は、一つの態様として後述する実施形態に記載の具体的手段との対応関係を示すものであって、本開示の技術的範囲を限定するものではない。
本実施形態の移動物体認識装置を示すブロック図。 自車両と移動物体と路側物体との関係を示す模式図。 自車両と移動物体と路側物体との他の関係を示す模式図。 路側物体群の形成を説明する模式図。 路側物体群の近似直線が示す道路方向の信頼度を説明する模式図。 路側物体群の近似直線が示す道路方向の信頼度を説明する模式図。 移動物体の位置と移動方向との推定を説明する模式図。 移動物体の両側の路側物体群の間隔と道路の幅との関係を示す模式図。 自車両と移動物体との交差を説明する模式図。 自車両と移動物体との交差の一例を示す模式図。 自車両と移動物体との交差の他の例を示す模式図。 移動物体認識処理を示すフローチャート。 道路方向推定処理を示すフローチャート。
以下、本開示の実施形態を図に基づいて説明する。
［１．構成］
図１に示す車載の移動物体認識システム２は、センサ群１０と、移動物体認識装置２０と、スピーカ４０と、ディスプレイ４２とを備えている。センサ群１０は、少なくとも車速センサ１２とミリ波レーダ１４とを備えている。
ミリ波レーダ１４は、三角波で周波数変調した送信波をアンテナから出力し、自車両の周囲に存在する物体から反射した反射波をアンテナで受信してミキシングすることでビート信号を出力する。
ビート信号は、物体までの距離および相対速度に応じて生じる干渉により波形が変化するので、ビート信号の波形から自車両と物体との距離と、自車両に対する物体の相対速度とを算出できる。また、送信波の照射方向に物体が存在すれば反射波が受信されるので、自車両の周囲に存在する物体の自車両に対する方向を検出することができる。自車両と物体との距離と、自車両に対する物体の方向とに基づいて、自車両に対する物体の相対位置を検出できる。
移動物体認識装置２０は、ＣＰＵと、ＲＡＭ、ＲＯＭ、フラッシュメモリ等の半導体メモリと、を有する周知のマイクロコンピュータを中心に構成される。移動物体認識装置２０の各種機能は、ＣＰＵが非遷移的実体的記録媒体に格納されたプログラムを実行することにより実現される。
この例では、半導体メモリが、プログラムを格納した非遷移的実体的記録媒体に該当する。また、このプログラムが実行されることで、プログラムに対応する方法が実行される。なお、移動物体認識装置２０を構成するマイクロコンピュータの数は一つでも複数でもよい。
移動物体認識装置２０は、ＣＰＵがプログラムを実行することで実現される機能の構成として、物体検出部２２と、位置検出部２４と、群形成部２６と、道路方向推定部２８と、信頼度算出部３０と、移動方向推定部３２と、フィルタ処理部３４と、報知部３６と、を備えている。
移動物体認識装置２０を構成するこれらの要素を実現する手法はソフトウェアに限るものではなく、その一部または全部の要素について、一つあるいは複数のハードウェアを用いて実現してもよい。例えば、上記機能がハードウェアである電子回路によって実現される場合、その電子回路は多数の論理回路を含むデジタル回路またはアナログ回路、あるいはこれらの組合せによって実現してもよい。
物体検出部２２は、ミリ波レーダ１４の検出信号に基づいて、自車両と物体との距離と自車両に対する物体の方向とを検出する。さらに、物体検出部２２は、ミリ波レーダ１４の検出信号に基づいて、自車両に対する物体の相対速度を検出する。
物体検出部２２は、車速センサ１２から取得する自車両の車速と、自車両に対する物体の相対速度とに基づいて、自車両の周囲に存在する物体から移動物体と静止物体である路側物体とを検出する。
位置検出部２４は、物体検出部２２が検出する自車両と物体との距離と自車両に対する物体の方向とに基づいて、自車両に対する物体の相対位置を検出する。
群形成部２６は、物体検出部２２が路側物体を検出すると、図２に示すように、複数の路側物体２００をグループ化して路側物体群２０２を形成する。複数の路側物体２００は、一つずつがミリ波レーダ１４により検出される一つの物体に対応する検出点であるか、一つずつがミリ波レーダ１４により検出されるガードレールのような連続した一つの物体の一部に対応する検出点である。
検出点として検出される路側物体は、ガードレールに限らず、縁石、建物等であってもよい。
群形成部２６は、路側物体群２０２を構成する路側物体２００の位置を近似する近似直線２０４を設定する。例えば、群形成部２６は、近似直線２０４と路側物体２００との距離の二乗和が最小となるように近似直線２０４を設定する。群形成部２６は、図３に示すように、自車両１００の走行方向１０２に対し、路側物体群２０２の近似直線２０４が斜めになる場合も、図２と同様に路側物体群２０２を構成する路側物体２００の位置を近似する近似直線２０４を設定する。
群形成部２６は、図４に示すように、同じ符号で示される路側物体２００ａ、２００ｂ、２００ｃ、２００ｄ、２００ｅ同士の距離と、各路側物体２００ａ、２００ｂ、２００ｃ、２００ｄ、２００ｅの位置と、各路側物体２００ａ、２００ｂ、２００ｃ、２００ｄ、２００ｅの位置と近似直線２０４ａ、２０４ｂ、２０４ｃ、２０４ｄ、２０４ｅとの誤差と、近似直線２０４ａ、２０４ｂ、２０４ｃ、２０４ｄ、２０４ｅと交差する方向の路側物体群２０２ａ、２０２ｂ、２０２ｃ、２０２ｄ、２０２ｅの長さとの少なくとも一つに基づいて、路側物体群２０２ａ、２０２ｂ、２０２ｃ、２０２ｄ、２０２ｅを形成する路側物体を選択する。
例えば、路側物体群２０２ａの路側物体２００ａとの距離が所定距離以上離れている路側物体２００ｃは路側物体群２０２ａから除外される。
また、路側物体群２０２ａの近似直線２０４ａから所定距離以上離れている位置の路側物体２００ｃは路側物体群２０２ａから除外される。
また、路側物体群２０２ａの近似直線２０４ａと交差する方向の路側物体群２０２ａの長さよりも路側物体群２０２ａから外れている路側物体２００ｃは、路側物体群２０２ａから除外される。
道路方向推定部２８は、路側物体群２０２の近似直線２０４が示す２方向を道路の道路方向と推定する。道路方向推定部２８は、図４に示すように、自車両１００の周囲に複数の路側物体群２０２ａ、２０２ｂ、２０２ｃ、２０２ｄ、２０２ｅが存在する場合、自車両１００が移動物体１１０と交差する可能性が高い、自車両１００が走行している道路２１０と交差する道路２２０の道路方向だけを推定してもよい。
また、図４において道路方向推定部２８は、複数の路側物体群２０２ａ、２０２ｂ、２０２ｃ、２０２ｄ、２０２ｅのうち、移動物体１１０に最も近い路側物体群２０２ｃの近似直線２０４ｃだけに基づいて、移動物体１１０が移動する道路２２０の道路方向を推定してもよい。
信頼度算出部３０は、路側物体群２０２を構成する路側物体２００の検出点数と、路側物体群２０２の近似直線２０４が示す方向の長さと、路側物体２００の位置と近似直線２０４との誤差との少なくとも一つに基づいて、道路方向推定部２８が推定する道路方向の信頼度を算出する。
例えば、図５に示す路側物体群２０２と図６に示す路側物体群２０２とを比較すると、図６の路側物体群２０２を構成する路側物体２００の検出点数は図５の路側物体群２０２を構成する路側物体２００の検出点数よりも多い。この場合、信頼度算出部３０は、図６の近似直線２０４が示す道路方向の信頼度を図５の近似直線２０４が示す道路方向の信頼度よりも高く算出する。
また、図６の路側物体群２０２の近似直線２０４が示す方向の長さは、図５の路側物体群２０２の近似直線２０４が示す方向の長さよりも長い。この場合、信頼度算出部３０は、図６の近似直線２０４が示す道路方向の信頼度を図５の近似直線２０４が示す道路方向の信頼度よりも高く算出する。
また、図６の路側物体群２０２を構成する路側物体２００の位置と近似直線２０４との誤差は、図５の路側物体群２０２を構成する路側物体２００の位置と近似直線２０４との誤差よりも小さい。この場合、信頼度算出部３０は、図６の近似直線２０４が示す道路方向の信頼度を図５の近似直線２０４が示す道路方向の信頼度よりも高く算出する。
移動方向推定部３２は、道路方向推定部２８が推定する道路方向と、自車両１００に対する移動物体１１０の相対速度の符号とに基づいて、移動物体１１０の移動方向１１２を推定する。例えば、相対速度の符号が負であれば移動物体１１０は道路方向に沿って自車両１００に接近し、相対速度の符号が正であれば移動物体１１０は道路方向に沿って自車両１００から離れている。
移動方向推定部３２は、複数の路側物体群２０２の近似直線２０４の方向に基づいて道路方向推定部２８が複数の道路方向を推定する場合、移動物体１１０に最も近い路側物体群２０２の近似直線２０４の方向を移動物体１１０が移動する道路の方向として認識する。
例えば、図４において、移動方向推定部３２は、複数の路側物体群２０２ａ、２０２ｂ、２０２ｃ、２０２ｄ、２０２ｅのうち、移動物体１１０に最も近い路側物体群２０２ｃの近似直線２０４ｃの方向を移動物体１１０が移動する道路の方向として認識する。
フィルタ処理部３４は、図７に示すように、道路方向推定部２８により前回推定された道路方向３１０とフィルタ処理部３４が前々回推定した移動物体１１０の移動方向３０２とをフィルタ処理して、前回の移動物体１１０の移動方向３１２をフィルタ処理により推定する。
例えば、道路方向推定部２８により前回推定された道路方向３１０の信頼度を信頼度算出部３０が算出すると、フィルタ処理部３４は、算出された道路方向３１０の信頼度に応じて、前回推定された道路方向３１０と前々回推定された移動物体１１０の移動方向３０２とを重み付けして、前回の移動物体１１０の移動方向３１２をフィルタ処理により推定する。
前回推定された道路方向３１０と前々回推定された移動物体の移動方向３０２とが同じ重みの場合には、前回推定された道路方向３１０と前々回推定された移動物体の移動方向３０２とが形成する角度を２等分する方向が移動物体の前回の移動方向３１２になる。
フィルタ処理部３４は、前回設定した移動物体１１０の位置３００と前回推定した移動物体１１０の移動方向３１２と移動物体１１０の相対速度とに基づいて、今回の移動物体１１０の位置３１４を推定する。フィルタ処理部３４は、推定した今回の移動物体１１０の位置３１４と今回検出された移動物体の検出位置３２０とをそれぞれ重み付けして、移動物体１１０の今回の位置３２２をフィルタ処理により設定する。
推定された今回の移動物体の位置３１４と今回検出された移動物体の検出位置３２０とが同じ重みの場合には、位置３１４と検出位置３２０との中間位置が移動物体の今回の位置３２２になる。
そして、フィルタ処理部３４は、道路方向推定部２８により今回推定された道路方向３３０の信頼度を信頼度算出部３０が算出すると、算出された道路方向３３０の信頼度に応じて、今回推定された道路方向３３０と前回推定された移動物体１１０の移動方向３１２とを重み付けして、今回の移動物体１１０の移動方向３３２をフィルタ処理により推定する。
そして、フィルタ処理部３４は、今回設定した移動物体１１０の位置３２２と推定した移動物体の今回の移動方向３３２と移動物体１１０の相対速度とに基づいて、移動物体１１０の次回の移動位置３４０を推定する。
フィルタ処理部３４は、移動物体１１０の移動位置を推定する場合、図８に示すように、移動物体１１０の両側の路側物体群２０２ａの道路方向を示す近似直線２０４ａと路側物体群２０２ｂの道路方向を示す近似直線２０４ｂとの間が示す道路幅ｄを移動物体１１０の移動可能範囲とする。そして、フィルタ処理部３４は、近似直線２０４ａと近似直線２０４ｂとの間で移動物体１１０の移動位置を推定する。
尚、前述した移動方向推定部３２は、物体検出部２２が移動物体１１０を２回目以降に検出する場合、フィルタ処理部３４がフィルタ処理により推定する移動物体１１０の移動方向を採用する。
報知部３６は、図９に示すように、自車両１００の走行方向１０２と移動物体１１０の移動方向１１２とが交差する場合、警告をスピーカ４０からの音声または警告音、ディスプレイ４２への表示等で報知する。
報知部３６は、交差点以外にも、図１０に示すように、例えば自車両１００が走行している高速道路に移動物体１１０が斜めから合流する場合、あるいは図１１に示すように、交差点を左折しようとしている自車両１００の左側後方を移動物体１１０が移動している場合、自車両１００と移動物体１１０との交差を報知する。
［２．処理］
（１）移動物体認識処理
移動物体認識装置２０が実行する移動物体認識処理を図１２に示フローチャートに基づいて説明する。
Ｓ４００において物体検出部２２は、ミリ波レーダ１４の検出信号に基づいて、自車両１００の周囲の物体の自車両１００に対する相対速度を検出する。また、Ｓ４００において位置検出部２４は、ミリ波レーダ１４の検出信号に基づいて、物体検出部２２が検出する自車両１００の周囲の物体と自車両１００との距離、ならびに自車両１００に対する物体の方向から、自車両１００に対する物体の相対位置を検出する。
Ｓ４０２において物体検出部２２は、自車両１００に対する物体の相対速度と自車両１００の車速とに基づいて、検出した物体が移動物体１１０であるか路側物体２００であるかを判定する。
Ｓ４０４において物体検出部２２は、検出した移動物体１１０が初めて移動物体として検出された物体であるか否かを判定する。Ｓ４０４の判定がＮｏである、つまり検出された移動物体１１０がすでに移動物体として検出されている場合、処理はＳ４１０に移行する。
Ｓ４０４の判定がＹｅｓである、つまり検出された移動物体１１０が物体検出部２２により初めて移動物体として検出された場合、Ｓ４０６において道路方向推定部２８は、物体検出部２２により検出された路側物体２００が形成する路側物体群２０２の近似直線２０４に基づいて、移動物体１１０が移動している道路の道路方向を推定する。初めて検出された移動物体１１０が複数存在する場合、それぞれの移動物体１１０について道路方向が推定される。
移動物体Ｓ４０６における道路方向の推定処理の詳細については、図１３に基づいて後述する。
Ｓ４０６の道路方向推定処理により移動物体１１０が移動している道路方向が推定されると、Ｓ４０８において移動方向推定部３２は、移動物体１１０が移動している道路方向と自車両１００に対する移動物体１１０の相対速度とに基づいて、移動物体１１０の移動方向１１２の初期値を推定し、処理をＳ４１２に移行する。
Ｓ４０８において移動方向推定部３２は、Ｓ４０６の道路方向推定処理において一つの道路方向が推定される場合、推定された一つの道路方向を移動物体１１０が移動する道路方向として選択する。
また、Ｓ４０８において移動方向推定部３２は、Ｓ４０６の道路方向推定処理において、複数の道路方向が推定される場合、移動物体１１０に最も近い路側物体群２０２の近似直線２０４が示す道路方向を移動物体１１０が移動する道路方向として選択する。
Ｓ４１０において移動方向推定部３２は、前述した図７に基づいて説明したフィルタ処理部３４によるフィルタ処理により、移動物体１１０の移動方向１１２と移動位置とを推定し、処理をＳ４１２に移行する。
Ｓ４１２において報知部３６は、自車両１００の走行方向１０２と移動物体１１０の移動方向１１２とが交差するか否かを判定する。
Ｓ４１２の判定がＮｏである、つまり自車両１００の走行方向１０２と移動物体１１０の移動方向１１２とが交差しない場合、本処理は終了する。
Ｓ４１２の判定がＹｅｓである、つまり自車両１００の走行方向１０２と移動物体１１０の移動方向１１２とが交差する場合、Ｓ４１４において報知部３６は、スピーカ４０からの音声または警告音、ディスプレイ４２での表示により、自車両１００の走行方向１０２と移動物体１１０の移動方向１１２とが交差することを報知する。
（２）道路方向推定処理
移動物体認識装置２０が実行する道路方向推定処理を図１３に示すフローチャートに基づいて説明する。図１３の処理は、図１２のＳ４０６において実行される。
Ｓ４２０において群形成部２６は、物体検出部２２により検出された路側物体２００に基づいて自車両１００の周囲に存在する路側物体群２０２を形成する。
Ｓ４２２において道路方向推定部２８は、路側物体群２０２を構成する路側物体２００の位置を近似する近似直線２０４を算出する。Ｓ４２４において道路方向推定部２８は、移動物体１１０と自車両１００の周囲に存在する複数の路側物体群２０２のそれぞれとの距離を算出する。Ｓ４２６において道路方向推定部２８は、Ｓ４２４で算出した距離に基づいて、移動物体１１０に最も近く、移動物体１１０の移動方向を推定するために参照する路側物体群２０２を決定する。
Ｓ４２８において道路方向推定部２８は、Ｓ４２６で決定した移動物体１１０の移動方向を推定するために参照する路側物体群２０２の近似直線２０４に基づいて、移動物体１１０が移動する道路の道路方向を推定する。
尚、図１３に示す道路方向推定処理では、移動物体１１０に最も近い路側物体群２０２の近似直線２０４に基づいて、移動物体１１０が移動する道路の道路方向を一つ推定した。これに対し、道路方向推定部２８は、自車両１００の周囲に存在するすべての路側物体群２０２の近似直線２０４に基づいて、複数の道路方向を推定してもよい。
また、道路方向推定部２８は、自車両１００が走行する道路２１０と交差する道路２２０の路側物体群２０２の近似直線２０４に基づいて、一つまたは複数の道路方向を推定してもよい。
［３．効果］
以上説明した本実施形態によると、以下の効果を得ることができる。
（１）移動物体１１０が移動している道路の路側物体２００の位置を近似する近似直線２０４に基づいて道路の道路方向を推定し、推定した道路方向と移動物体１１０の相対速度とに基づいて、移動物体１１０の移動方向を推定する。
移動物体１１０の移動方向１１２は、移動物体１１０が移動している道路の道路方向のどちらかである。そして、自車両１００に対する移動物体１１０の相対速度により、移動物体１１０が道路方向のどちらに移動しているかを決定できる。さらに、近似直線２０４の算出と移動物体１１０の相対速度の検出とは、ミリ波レーダ１４の検出信号に基づく１回の検出処理により実行できる。これにより、精度を確保しつつ高い応答性で移動物体１１０の移動方向を推定できる。
（２）移動物体１１０に対する２回目以降の検出処理の場合、前回推定された移動方向と今回推定された道路方向とを、推定された道路方向の信頼度に応じて重み付けしてフィルタ処理するので、道路方向の信頼度に応じて移動物体１１０の今回の移動方向を高精度に推定できる。
以上説明した本実施形態において、ミリ波レーダ１４が自車両に対する物体の相対速度を検出するセンサに対応する。
またＳ４００、Ｓ４０２が物体検出部２２の処理に対応し、Ｓ４００が位置検出部の処理に対応し、Ｓ４０６、Ｓ４２２〜Ｓ４２８が道路方向推定部の処理に対応し、Ｓ４０８、Ｓ４１０が移動方向推定部の処理に対応し、Ｓ４１０が信頼度算出部とフィルタ処理部との処理に対応し、Ｓ４１４が報知部の処理に対応し、Ｓ４２０が群形成部の処理に対応する。
［４．他の実施形態］
以上、本開示の実施形態について説明したが、本開示は上述の実施形態に限定されることなく、種々変形して実施することができる。
（１）上記実施形態では、ミリ波レーダ１４の検出信号に基づいて、自車両１００に対する移動物体１１０の相対速度を１回の検出処理により検出し、検出した相対速度と移動物体１１０が移動する道路の走路方向とに基づいて移動物体１１０の移動方向１１２を１回の検出処理により推定した。
これに対し、ミリ波レーダ１４に代えて、移動物体１１０の相対速度を検出できないセンサとして、例えばＬｉＤＡＲまたはカメラを使用してもよい。ＬｉＤＡＲは、Light Detection and Rangingの略である。
この場合、ＬｉＤＡＲの検出信号またはカメラが撮像する画像データに基づいて移動物体１１０の位置を検出できるので、２回の検出処理により移動物体１１０の位置が変化している方向を検出できる。
したがって、移動物体１１０の位置の変化方向と、移動物体１１０が移動している道路の道路方向とに基づいて、道路の道路方向のどちらに移動物体１１０が移動しているかを、精度を確保しつつ高い応答性で推定できる。
（２）上記実施形態では、移動物体１１０に対する２回目以降の検出処理の場合、前回推定された移動方向と今回推定された道路方向とをフィルタ処理部３４がフィルタ処理して推定する移動物体１１０の今回の移動方向を、移動方向推定部３２は移動物体１１０の移動方向１１２として採用した。
これに対し、移動物体１１０に対する２回目以降の検出処理においても、移動物体１１０が移動する道路の道路方向と、自車両１００に対する移動物体１１０の相対速度または移動物体１１０の位置の変化方向とに基づいて移動物体１１０の移動方向を推定してもよい。
（３）上記実施形態では、路側物体群２０２の近似直線２０４を算出し、近似直線２０４の方向に基づいて道路方向を推定した。これに対し、路側物体群２０２が延びている路側物体群２０２の長手方向に基づいて道路方向を推定してもよい。
（４）上記実施形態における一つの構成要素が有する複数の機能を、複数の構成要素によって実現したり、一つの構成要素が有する一つの機能を、複数の構成要素によって実現したりしてもよい。また、複数の構成要素が有する複数の機能を、一つの構成要素によって実現したり、複数の構成要素によって実現される一つの機能を、一つの構成要素によって実現したりしてもよい。また、上記実施形態の構成の一部を省略してもよい。また、上記実施形態の構成の少なくとも一部を、他の上記実施形態の構成に対して付加または置換してもよい。なお、特許請求の範囲に記載した文言から特定される技術思想に含まれるあらゆる態様が本開示の実施形態である。
（５）上述した移動物体認識装置２０の他、当該移動物体認識装置２０を構成要素とする移動物体認識システム、当該移動物体認識装置２０としてコンピュータを機能させるためのプログラム、このプログラムを記録した半導体メモリ等の非遷移的実態的記録媒体、移動物体認識方法など、種々の形態で本開示を実現することもできる。
２：移動物体認識システム、１４：ミリ波レーダ（相対速度を検出するセンサ）、２０：移動物体認識装置、２２：物体検出部、２４：位置検出部、２６：群形成部、２８：道路方向推定部、３０：信頼度算出部、３２：移動方向推定部、３４：フィルタ処理部、３６：報知部、１００：自車両：１０２：走行方向、１１０：移動物体：１１２：移動方向、２００：路側物体、２０２：路側物体群、２０４：近似直線

Claims (15)

  1. 車載の移動物体認識装置（２０）であって、
    自車両（１００）の周囲に存在する物体（１１０、２００）から、前記自車両の周囲の道路を移動する移動物体（１１０）と前記道路の路側物体（２００）とを検出するように構成された物体検出部（２２、Ｓ４００、Ｓ４０２）と、
    前記物体検出部が検出する前記移動物体と前記路側物体との位置を検出するように構成された位置検出部（２４、Ｓ４００）と、
    前記位置検出部が検出する前記路側物体の位置に基づいて、前記移動物体が移動している前記道路の道路方向を推定するように構成された道路方向推定部（２８、Ｓ４０６、Ｓ４２２〜Ｓ４２８）と、
    前記道路方向推定部が推定する前記道路方向に基づいて前記移動物体の移動方向（１１２）を推定するように構成された移動方向推定部（３２、Ｓ４０８、Ｓ４１０）と、
    を備える移動物体認識装置。
  2. 請求項１に記載の移動物体認識装置であって、
    前記物体検出部（Ｓ４０２）は、前記自車両に対する前記物体の相対速度を検出するセンサ（１４）から前記相対速度を検出し、前記相対速度に基づいて、前記移動物体と前記路側物体とを検出するように構成されている、
    移動物体認識装置。
  3. 請求項２に記載の移動物体認識装置であって、
    前記移動方向推定部は、前記道路方向と前記相対速度とに基づいて前記移動物体の前記移動方向を推定するように構成されている、
    移動物体認識装置。
  4. 請求項２または３に記載の移動物体認識装置であって、
    前記移動方向推定部（Ｓ４０８）は、前記物体検出部が初めて検出する前記移動物体の移動方向を、前記物体検出部が初めて前記移動物体を検出するときの前記相対速度と前記道路方向とに基づいて推定するように構成されている、
    移動物体認識装置。
  5. 請求項１から４のいずれか一項に記載の移動物体認識装置であって、
    前記路側物体をグループ化して路側物体群（２０２）を形成するように構成された群形成部（２６、Ｓ４２０）をさらに備え、
    前記道路方向推定部は、前記群形成部が形成する前記路側物体群を構成する前記路側物体の位置を近似する近似直線（２０４）の方向を前記道路方向として推定するように構成されている、
    移動物体認識装置。
  6. 請求項５に記載の移動物体認識装置であって、
    前記群形成部は、前記路側物体同士の距離と、前記路側物体の位置と前記近似直線との誤差と、前記近似直線と交差する方向の前記路側物体群の長さとの少なくとも一つに基づいて前記路側物体群を形成する前記路側物体を選択するように構成されている、
    移動物体認識装置。
  7. 請求項５または６に記載の移動物体認識装置であって、
    前記移動方向推定部は、前記移動物体に最も近い前記路側物体群の前記近似直線の方向に基づいて前記移動物体の前記移動方向を推定するように構成されている、
    移動物体認識装置。
  8. 請求項１から７のいずれか一項に記載の移動物体認識装置であって、
    前記位置検出部が検出する前記移動物体の今回の検出位置（３２０）と、前回推定された前記移動物体の今回の推定位置（３１４）とに基づいて前記移動物体の今回の位置（３２２）をフィルタ処理により設定し、前記移動方向推定部が前回推定した前記移動物体の前記移動方向（３１２）と、前記道路方向推定部が今回推定する前記道路方向（３３０）とに基づいて前記移動物体の今回の前記移動方向（３３２）をフィルタ処理により推定し、推定した前記移動物体の今回の前記移動方向と今回設定された前記移動物体の今回の位置とに基づいて前記移動物体の次回の位置（３４０）を設定するように構成されたフィルタ処理部（３４、Ｓ４１０）をさらに備える移動物体認識装置。
  9. 請求項５から７のいずれか一項を引用する請求項８に記載の移動物体認識装置であって、
    前記フィルタ処理部は、前記移動物体の両側の前記路側物体群の間隔を前記移動物体が移動する道路の幅とし、前記道路の幅の範囲に前記移動物体の移動位置を限定するように構成されている、
    移動物体認識装置。
  10. 請求項１から９のいずれか一項に記載の移動物体認識装置であって、
    前記道路方向推定部は、前記自車両が走行する前記道路と交差する交差道路の前記道路方向を推定するように構成されている、
    移動物体認識装置。
  11. 請求項１０に記載の移動物体認識装置であって、
    前記道路方向推定部が推定する前記交差道路の前記道路方向の信頼度を算出するように構成された信頼度算出部（３０、Ｓ４１０）をさらに備える、
    移動物体認識装置。
  12. 請求項５から７のいずれか一項、あるいは請求項５から７のいずれか一項を引用する請求項８、あるいは請求項９に記載の移動物体認識装置であって、
    前記道路方向推定部は、前記自車両が走行する前記道路と交差する交差道路の前記道路方向を推定するように構成されており、
    前記路側物体群を構成する前記路側物体の検出点数と、前記路側物体群の前記近似直線の方向の長さと、前記路側物体群を構成する前記路側物体の位置と前記近似直線との誤差との少なくとも一つに基づいて、前記道路方向推定部が推定する前記交差道路の前記道路方向の信頼度を算出するように構成された信頼度算出部（３０、Ｓ４１０）をさらに備える、
    移動物体認識装置。
  13. 請求項８または９のいずれかを引用する請求項１１、あるいは請求項８または９のいずれかを引用する請求項１２に記載の移動物体認識装置であって、
    前記フィルタ処理部は、前記信頼度算出部が算出する前記信頼度に応じて、前記移動方向推定部が前回推定した前記移動物体の前記移動方向と今回前記道路方向推定部が推定する前記道路方向とを重み付けして、フィルタ処理により今回の前記移動物体の前記移動方向を推定するように構成されている、
    移動物体認識装置。
  14. 請求項１から１３のいずれか一項に記載の移動物体認識装置であって、
    前記物体検出部は、レーダの検出信号に基づいて前記自車両の周囲に存在する前記物体を検出するように構成されている、
    移動物体認識装置。
  15. 請求項１から１４のいずれか一項に記載の移動物体認識装置であって、
    前記移動物体の前記移動方向と前記自車両の走行方向（１０２）とが交差する場合に報知するように構成された報知部（３６、Ｓ４１４）をさらに備える、
    移動物体認識装置。
JP2017201899A 2017-10-18 2017-10-18 移動物体認識装置 Active JP6845117B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2017201899A JP6845117B2 (ja) 2017-10-18 2017-10-18 移動物体認識装置
PCT/JP2018/038528 WO2019078211A1 (ja) 2017-10-18 2018-10-16 移動物体認識装置
US16/851,795 US11841419B2 (en) 2017-10-18 2020-04-17 Stationary and moving object recognition apparatus

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017201899A JP6845117B2 (ja) 2017-10-18 2017-10-18 移動物体認識装置

Publications (2)

Publication Number Publication Date
JP2019074466A JP2019074466A (ja) 2019-05-16
JP6845117B2 true JP6845117B2 (ja) 2021-03-17

Family

ID=66174136

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017201899A Active JP6845117B2 (ja) 2017-10-18 2017-10-18 移動物体認識装置

Country Status (3)

Country Link
US (1) US11841419B2 (ja)
JP (1) JP6845117B2 (ja)
WO (1) WO2019078211A1 (ja)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7294978B2 (ja) * 2019-10-04 2023-06-20 株式会社Soken 進行方向推定装置及び物体追跡装置
JP7323493B2 (ja) * 2020-06-22 2023-08-08 株式会社Soken 道路形状認識装置

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3229558B2 (ja) * 1997-02-21 2001-11-19 三菱電機株式会社 車間距離検出装置
JP2001272466A (ja) 2000-03-27 2001-10-05 Toyota Central Res & Dev Lab Inc レーダ装置
JP3975922B2 (ja) 2003-01-17 2007-09-12 トヨタ自動車株式会社 カーブ半径推定装置
JP2007292643A (ja) * 2006-04-26 2007-11-08 Alpine Electronics Inc 周辺物体識別装置
US7612658B2 (en) * 2007-04-11 2009-11-03 Ford Global Technologies, Inc. System and method of modifying programmable blind spot detection sensor ranges with vision sensor input
JP5556317B2 (ja) * 2010-04-07 2014-07-23 株式会社デンソー 物体認識装置
JP5618744B2 (ja) * 2010-05-26 2014-11-05 三菱電機株式会社 道路形状推定装置及びコンピュータプログラム及び道路形状推定方法
JP2015057686A (ja) * 2012-12-21 2015-03-26 株式会社デンソー 注意喚起装置
EP3032221B1 (en) * 2014-12-09 2022-03-30 Volvo Car Corporation Method and system for improving accuracy of digital map data utilized by a vehicle
JP6846630B2 (ja) * 2015-02-16 2021-03-24 パナソニックＩｐマネジメント株式会社 走行レーン検出装置、走行レーン検出方法、併走車検出装置及び隣接するレーンを走行する併走車の検出方法
KR102404155B1 (ko) * 2016-09-28 2022-05-31 톰톰 글로벌 콘텐트 비.브이. 위치파악 참조 데이터를 생성 및 사용하기 위한 방법 및 시스템
US11112237B2 (en) * 2016-11-14 2021-09-07 Waymo Llc Using map information to smooth objects generated from sensor data
DE112020002666T5 (de) * 2019-06-06 2022-05-12 Mobileye Vision Technologies Ltd. Systeme und verfahren für die fahrzeugnavigation

Also Published As

Publication number Publication date
JP2019074466A (ja) 2019-05-16
US11841419B2 (en) 2023-12-12
WO2019078211A1 (ja) 2019-04-25
US20200244840A1 (en) 2020-07-30

Similar Documents

Publication Publication Date Title
JP6410949B2 (ja) 車線認識装置および車線認識方法
JP6970936B2 (ja) 物体検出装置、物体検出プログラム、および記録媒体
JP6022983B2 (ja) 運転支援装置
US11351997B2 (en) Collision prediction apparatus and collision prediction method
JPWO2014091858A1 (ja) 駐車スペース検出装置
JP2013530435A (ja) 自動車のための車道推移を求める方法
JP5012270B2 (ja) 物体検出装置
JP2015001773A (ja) 車線推定装置
JP4937844B2 (ja) 歩行者検出装置
JP6845117B2 (ja) 移動物体認識装置
JP2018147399A (ja) 物標検出装置
JP2018060422A (ja) 物体検出装置
JP2016018371A (ja) 車載システム、情報処理装置、及びプログラム
JP5594102B2 (ja) 道路形状推定装置
JP6834020B2 (ja) 物体認識装置および物体認識方法
JP4644590B2 (ja) 周辺車両位置検出装置および周辺車両位置検出方法
JP2020060414A (ja) 自車位置推定装置
US11983937B2 (en) Intersecting road estimation device
JP2007240316A (ja) 車載測距装置
JP2018018215A (ja) 物体特徴点検知装置
JP7380705B2 (ja) 情報生成装置、情報生成方法、及びコンピュータプログラム
JP2019215177A (ja) 軌道設定装置
EP3214459A1 (en) Location determination device and method for operating same
WO2022102371A1 (ja) 物体検出装置、物体検出方法
JP6743665B2 (ja) カーブ推定装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200402

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201124

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201222

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: 20210202

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210225

R150 Certificate of patent or registration of utility model

Ref document number: 6845117

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250