JP6714148B2 - 自動車レーダを利用する標的対象物の改善された検出 - Google Patents

自動車レーダを利用する標的対象物の改善された検出 Download PDF

Info

Publication number
JP6714148B2
JP6714148B2 JP2019507832A JP2019507832A JP6714148B2 JP 6714148 B2 JP6714148 B2 JP 6714148B2 JP 2019507832 A JP2019507832 A JP 2019507832A JP 2019507832 A JP2019507832 A JP 2019507832A JP 6714148 B2 JP6714148 B2 JP 6714148B2
Authority
JP
Japan
Prior art keywords
host vehicle
target object
cross
path
time
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
JP2019507832A
Other languages
English (en)
Other versions
JP2019532265A (ja
Inventor
コン、シャン
ヤン、ベイ
Original Assignee
ヴィオニア ユーエス インコーポレイティド
ヴィオニア ユーエス インコーポレイティド
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
Priority claimed from US15/253,343 external-priority patent/US9889798B1/en
Application filed by ヴィオニア ユーエス インコーポレイティド, ヴィオニア ユーエス インコーポレイティド filed Critical ヴィオニア ユーエス インコーポレイティド
Publication of JP2019532265A publication Critical patent/JP2019532265A/ja
Application granted granted Critical
Publication of JP6714148B2 publication Critical patent/JP6714148B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • B60W30/0956Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0027Planning or execution of driving tasks using trajectory prediction for other traffic participants
    • B60W60/00276Planning or execution of driving tasks using trajectory prediction for other traffic participants for two or more other traffic participants
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems 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/66Radar-tracking systems; Analogous systems
    • G01S13/72Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
    • G01S13/723Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems 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/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/66Tracking systems using electromagnetic waves other than radio waves
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4042Longitudinal speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4044Direction of movement, e.g. backwards
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/80Spatial relation or speed relative to objects
    • B60W2554/805Azimuth angle
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems 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/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/932Radar 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems 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/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9323Alternative operation using light waves
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/03Details of HF subsystems specially adapted therefor, e.g. common to transmitter and receiver
    • G01S7/032Constructional details for solid-state radar subsystems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/28Details of pulse systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Traffic Control Systems (AREA)
  • Radar Systems Or Details Thereof (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Description

1.相互関連出願
本出願は、それらの全体が本明細書によって本明細書に組み込まれる、「DETECTION OF A TARGET OBJECT UTILIZING AUTOMOTIVE RADAR」と題された、2016年8月31日に出願された米国特許一部継続出願第15/253,343号に対する優先権の利益を主張するものである。本出願はまた、それらの全体が本明細書によって本明細書に組み込まれる、「IMPROVED DETECTION OF A TARGET OBJECT UTILIZING AUTOMOTIVE RADAR」と題された、2016年9月8日に出願された米国仮特許出願第62/384,911号に対する優先権の利益を主張するものである。
2.技術分野
本開示は、自動車レーダシステムに関し、特に、自動車レーダを利用して標的対象物を検出するためのシステム及び方法に関する。
3.関連技術の議論
自動車レーダシステムでは、複数のレーダセンサは、ホスト車両に取り付けられ得る。各レーダセンサは、車両に隣接して関心領域にレーダ信号を伝送するための送信器と、関心領域内の対象物から返送レーダ信号を受信するための受信器とを含む。各センサにおける処理回路は、受信された返送レーダ信号を処理して、様々な標的対象物(他の車両など)を検出し、かつ対象物の範囲、軸受、及び/又は速度を決定する。
有用な検出シナリオの一例は、ホスト車両と標的対象物との間におけるような交差経路検出(例えば、駐車角度検出)を伴う。例えば、いくつかの実施形態では、ホスト車両は、目的とする前方に引くこと又は後退すること(駐車場から出るか、又は車道と合流することなど)を行う現在の静的車両(駐車場に駐車されるか、又は交差点で停止されるなど)を表し得る。したがって、そのような操縦の間にホスト車両で経路を交差し得る他の車両などの標的対象物を検出することは、そのようなシナリオにおいて有用である。有利なことに、標的対象物の交差経路検出は、可能な衝突を防止するために、警報又は他のフィードバックを提供するために使用され得る。いくつかの実施形態では、フィードバックは、例えば、受動的なフィードバックであり得、差し迫った衝突の視覚及び/又は可聴警告を介して運転者に警報を出す。他の実施形態では、フィードバックは、例えば、自動運転システム、自動制動システムなどを介して、ホスト車両の移動を自動的に調整/制御し得る能動的フィードバックであり得る。
自動車レーダを介した標的対象物の従来の交差経路検出は、典型的には、ホスト車両に対して1つ以上の所定の関心領域によって画定された所定の警報区画を利用した。とりわけ、これらの1つ以上の関心領域は、交差経路角度(ホスト車両のヘディングと標的対象物の軌道との間の角度)に関係なく同じままである。本明細書に開示されるように、いくつかの実施形態では、重複関心領域は、いくつかの可能性がある交差経路シナリオのために集合警報区画を表すように選択され得る。例えば、図1は、2つの異なる関心領域(領域1及び領域2)によって画定された集合警報区画を利用する例示の実施形態を描写する。本実施形態では、領域2は、仮定された90度の交差経路角度シナリオのために関心領域を表すように構成されており、領域1は、仮定された45〜60度の交差経路角度シナリオのために関心領域を表すように構成されている。図1に描写される集合警報区画などの所定の警報区画を利用する残念な結果は、所定の警報区画が、典型的には、上方と下方の両方で、所与の交差経路角度シナリオのための異なる最適関心領域に関して包括的であり得る(例えば、図1における45度の交差経路角度シナリオのための最適関心領域を参照)。これにより、1つ以上の所定の関心領域を利用する集合警報区画などの所定の警報区画は、多くの場合、結果として標的対象物の不正確な検出を生じ(差し迫った衝突の誤指示、又は更に悪いことに、差し迫った衝突の遅延した若しくは不正確な指示を提供し)得る。
したがって、ホスト車両と標的対象物との間の交差経路検出のための改善されたシステム及び方法の必要性がある。これら及び他の必要性は、本開示により満たされる。
システム及び方法は、ホスト車両と標的対象物との間の改善された交差経路検出のために本明細書に提示される。例示の実施形態では、ホスト車両のための交差交通警報システムは、ホスト車両に取付可能で、かつ複数の時点にわたって標的対象物のホスト車両に対する相対位置を追跡するために構成されている自動車接近感知検出器であって、任意の所与の時点で、標的対象物の軌道及びホスト車両の運転経路が、交差経路角度で交差する、自動車接近感知検出器と、デジタル信号を受信し、デジタル信号を処理して、標的対象物の軌道と、ホスト車両の共通の基準位置(複数の時点にわたる)との間の、各時点における垂直経路距離の、複数の時点にわたる分散を最小限に抑える最適化問題を解決することによって、交差経路角度を算出するためのプロセッサと、を含み得る。
例示の実施形態では、ある時点における垂直経路距離は、交差経路角度、及びその時点における標的対象物についての追跡情報の関数として表され得る。例示の実施形態では、追跡情報は、極座標で表され得る。時点iにおける垂直経路距離を表す瞬間垂直経路距離P(i)は、交差経路角度θcp、時点iにおける瞬間追跡範囲R(i)、及び時点iにおける瞬間追跡角度θ(i)の関数として算出され得る。P(i)=−R(i)cos(θcp+θ−θ(i))であり、式中、θは、ホスト車両のセンサ取付角度であることに留意されたい。n個の時点について、交差経路角度は、最適化問題
Figure 0006714148
を解決することによって算出され得、式中、
Figure 0006714148
である。例示の実施形態では、最適化問題は、平均二乗誤差を用いて解決され得る。いくつかの実施形態では、これは、マトリックスの固有分解を使用して解決され得る。他の実施形態では、これは、各時点iにおける垂直経路距離を表す瞬間垂直経路距離P(i)を、複素数表現に変換することによって解決され得る。
例示の実施形態では、プロセッサは、標的対象物が関心領域内にあるかどうかに少なくとも部分的に基づいて、交差交通警報又は他のフィードバックがトリガされるべきかどうかを判定するように構成され得、関心領域は、交差経路角度に少なくとも部分的に基づいて決定される。いくつかの実施形態では、プロセッサは、デジタル信号を更に処理して、算出された交差経路角度によって判定される、時点iにおけるホスト車両の位置と標的対象物の軌道との間で瞬間最短経路距離を決定する。この瞬間最短経路距離は、時点iにおける標的対象物の軌道に垂直な軸に沿った、時点iにおけるホスト車両と標的対象物との間の距離の予測として決定され得、時点iにおける、ホスト車両と標的対象物との間の距離は、追跡範囲測定値に基づいて決定される。有利なことに、交差交通警報又は他のフィードバックは、決定された瞬間最短経路距離に少なくとも部分的に基づいてトリガされるべきかどうかを判定するように構成され得る。例えば、プロセッサは、交差交通警報又は他のフィードバックが、決定された瞬間最短経路距離が閾値を超えることに少なくとも部分的に基づいてトリガされるべきかどうかを判定するように構成され得る。とりわけ、この閾値は、一定であるか、可変(例えば、算出された交差経路角度に基づいて可変)であり得る。更なる例示の実施形態では、プロセッサは、デジタル信号を更に処理して、算出された交差経路角度によって判定される、時点iにおける標的対象物の軌道に垂直なベクトルと時点iにおけるホスト車両の位置との間の垂直距離を特徴とする、時点iにおける標的対象物とホスト車両との間で瞬間横方向距離を決定する。この瞬間横方向距離は、時点iにおける標的対象物の軌道に平行な軸に沿った、時点iにおける、ホスト車両と標的対象物との間の距離の予測として決定され得、時点iにおける、ホスト車両と標的対象物との間の距離は、追跡範囲測定値に基づいて決定される。時点iにおける対象物に対する瞬間的な衝突までの時間(time to collision、TTC)は、時点i、及び標的対象物に対する速度における、標的対象物とホスト車両との間の瞬間横方向距離に基づいて更に決定され得る。有利なことに、プロセッサは、交差交通警報又は他のフィードバックが、標的対象物に対する決定された瞬間的TTCに少なくとも部分的に基づいてトリガされるべきかどうかを判定するように構成され得る。
いくつかの実施形態では、ホスト車両は、運転経路に対して運動している場合がある(動的ホストシナリオ)。これにより、動的ホストの場合には、ホスト車両の共通の基準位置は、時点の各々におけるホスト車両の位置に対する既知のオフセットを含む共通の基準点であり得る。例示の実施形態では、ホスト車両の基準点は、瞬間時点iにおけるホスト車両の位置であり得る。これにより、各時点における標的対象物についての追跡情報は、瞬間時点iにおけるホスト車両の位置に正規化され得る。例示の実施形態では、各時点における標的対象物についての正規化された追跡情報は、ホスト車両のホスト速度及び角度変化の関数として算出され得る。
いくつかの実施形態では、最適化問題は、多重仮説問題として解決され得、多重仮説問題は、複数の可能な交差経路角度解を想定し、各々の交差経路角度解は、標的対象物の対応する可能な軌道を表し、交差経路角度は、標的対象物の軌道とホスト車両の共通の基準位置(複数の時点にわたる)との間の、各時点における垂直経路距離の、複数の時点にわたる分散を最小限に抑える複数の可能な交差経路角度解から1つの交差経路角度解を選択することによって、決定される。これにより、例示の実施形態では、多重仮説問題を解決することは、(i)時点の各々について、複数の可能な交差経路角度解の各々について、その時点における標的対象物の対応する軌道とホスト車両の基準位置との間の対応する垂直経路距離を算出することと、(ii)時点の各々についての対応する垂直経路距離の間の分散を最小限に抑える複数の可能な交差経路角度解から1つの交差経路角度解を選択することに基づいて交差経路角度を決定することと、を含み得る。例として、複数の時点は、第1の時点及び第2の時点を含み、多重仮説問題を解決することは、(i)第1の時点について、複数の可能な交差経路角度解の各々について、第1の時点における標的対象物の対応する可能な軌道とホスト車両の基準位置との間の対応する垂直経路距離を算出することと、(ii)第2の時点について、複数の可能な交差経路解の各々について、第2の時点における標的対象物の対応する可能な軌道とホスト車両の基準位置との間の対応する垂直経路距離を算出することと、(iii)複数の可能な交差経路角度解の各々について、第1の時点における対応する垂直経路距離と第2の時点における対応する垂直経路距離との間の差を決定することと、を含み得る。
例示の実施形態では、分散情報は、第1の複数の時点について算出されて、バッファ内に記憶され得、その後、その基礎となった垂直経路距離は、メモリから破棄され得る。更なる例示の実施形態では、交差経路角度は、第1の複数の時点について算出され、次いで、例えば、標的対象物の軌道とホスト車両の共通の基準位置(複数の時点にわたる)との間の第2の複数の時点における各時点で、垂直経路距離の、第2の複数の時点にわたる分散を最小限に抑える最適化問題を解決することによって、第2の複数の時点について再算出され得る。
更なる例示の実施形態では、ホスト車両のための交差交通警報システムであって、ホスト車両に取付可能で、かつ3つ以上の時点にわたって標的対象物のホスト車両に対する相対位置を追跡するために構成されている自動車接近感知検出器であって、所与の任意の時点で、標的対象物の軌道及びホスト車両のヘディングが、交差経路角度で交差する、自動車接近感知検出器と、自動車接近感知検出器からデータを受信及び処理して、3つ以上の時点にわたる最適化問題を解決することによって交差経路角度を算出するように構成されているプロセッサと、を備える、交差交通警報システムが提示される。より具体的には、最適化問題は、有利なことに、標的対象物の軌道とホスト車両の共通の基準位置(複数の時点にわたる)との間の、各時点における垂直経路距離の、3つ以上の時点にわたる分散を最小限に抑え得る。
更なる例示の実施形態では、ホスト車両のための交差交通警報システムであって、ホスト車両に取付可能で、かつ複数の時点にわたって標的対象物のホスト車両に対する相対位置を追跡するために構成されている自動車接近感知検出器であって、所与の任意の時点で、標的対象物の軌道及びホスト車両のヘディングが、交差経路角度で交差する、自動車接近感知検出器と、自動車接近感知検出器からデータを受信及び処理して、標的対象物の複数の追跡の各々についての交差経路角度の推定値を決定するように構成されている、プロセッサであって、各追跡が、2つ以上の時点の異なる組を特徴とする、プロセッサと、を備える、交差交通警報システムが提示される。有利なことに、プロセッサは、交差経路角度推定値間の分散を決定するように更に構成され得る。いくつかの実施形態では、プロセッサは、互いに対して低い分散で交差経路角度推定値を特定及び平均化することによって、平均交差経路角度を決定するように更に構成され得る。更なる実施形態では、クラスタ分析が適用され得る。例えば、いくつかの実施形態では、複数の追跡の各々について(例えば、複数の連続した時点対の各々について)の交差経路角度推定値は、決定され得る。一般に、クラスタ分析は、交差経路角度推定値における経時的変化を評価するために使用され得る。クラスタ分析(クラスタ化)は、次いで、複数の交差経路角度推定値に適用され得る。クラスタ分析は、交差経路角度における急激な経時的変化を表す別個の密接に分配されたクラスタを検出するために使用され得る。代替的に、互いに流入して、より広い拡大分布を形成するクラスタは、交差経路角度における段階的変化を示し得る。様々なクラスタモデル及びアルゴリズムは、クラスタ分析を実施する際に適用され得る。いくつかの実施形態では、経時的平均交差経路角度は、クラスタ中心に基づいて決定され得る。更なる実施形態では、クラスタ分析は、誤った算出(例えば、基準分布密度)を表し得る外れ値データ点を特定するために使用され得る。そのような外れ値データ点は、例えば、クラスタ算出(平均交差経路角度を算出する又は旋回/曲線経路を検出することなど)から軽視され得る。これにより、クラスタ分析は、データ検証目的のために有利に使用され得る。
他の実施形態では、プロセッサは、複数の交差経路角度推定値を平均化することによって、平均交差経路角度を決定するように更に構成され得る。更なる実施形態では、プロセッサは、交差経路角度推定値間の分散に基づいて、標的対象物の軌道における変化を判定するように更に構成され得る。例えば、交差経路角度推定値間の分散が、第1の閾値を超える場合、プロセッサは、旋回を示す標的対象物の方向に大きな変化があったことを判定するように構成され得る。旋回が検出される場合、平均交差経路角度を決定するとき、方向の大きな変化の前の追跡からの交差経路角度推定値は無視され得る。交差経路天使推定値間の分散は、第1の閾値未満であり、かつ第2の閾値を超える場合、プロセッサはまた、曲線を示す標的対象物の方向における小さな変化があったことを判定するように構成され得る。曲線が検出される場合、(i)データサンプリングレートのうちの1つ以上は、時間交差経路角度推定値を低減させるように増加され得るか、又は(ii)バッファリングサイズは、平均を決定するときにより少ない交差経路角度推定値を使用するように減少され得る。
更なる例示の実施形態では、ホスト車両のための交差交通警報システムであって、ホスト車両に取付可能で、かつ複数の時点にわたって標的対象物のホスト車両に対する相対位置を追跡するために構成されている自動車接近感知検出器であって、所与の任意の時点で、標的対象物の軌道及びホスト車両のヘディングが、交差経路角度で交差する、自動車接近感知検出器と、自動車接近感知検出器からデータを受信及び処理して、交差経路角度を決定し、かつホスト車両の位置と交差経路角度の推定値によって決定されるような標的対象物の軌道との間の最短経路距離を決定するように構成されている、プロセッサと、を備える、交差交通警報システムが提示される。この最短経路距離はまた、交差経路角度の推定値を特徴とする標的対象物の軌道に垂直な軸に沿って、ホスト車両の位置と標的対象物の位置との間の距離の予測として決定され、ホスト車両の位置と標的対象物の位置との間の距離は、追跡範囲測定値に基づいて決定され得る。有利なことに、プロセッサは、交差交通警報又は他のフィードバックが、決定された最短経路距離に少なくとも部分的に基づいてトリガされるべきかどうかを判定するように構成され得る。例えば、プロセッサは、交差交通警報又は他のフィードバックが、決定された最短経路距離が閾値を超えることに少なくとも部分的に基づいてトリガされるべきかどうかを判定するように構成され得る。とりわけ、この閾値は、一定であるか、可変(例えば、算出された交差経路角度に基づいて可変)であり得る。
更なる例示の実施形態では、ホスト車両のための交差交通警報システムであって、ホスト車両に取付可能で、かつ複数の時点にわたって標的対象物のホスト車両に対する相対位置を追跡するために構成されている自動車接近感知検出器であって、所与の任意の時点で、標的対象物の軌道及びホスト車両のヘディングが、交差経路角度で交差する、自動車接近感知検出器と、自動車接近感知検出器からデータを受信及び処理して、交差経路角度の推定値を決定し、かつ交差経路角度の推定値によって決定される、標的対象物の軌道に垂直なベクトルとホスト車両の位置との間の垂直距離を特徴とする横方向距離を決定する、プロセッサと、を備える、交差交通警報システムが提示される。この横方向距離は、標的対象物の現在の軌道と平行な軸に沿って、ホスト車両の位置と標的対象物の位置との間の距離の予測として決定され得、ホスト車両の位置と標的対象物の位置との間の距離は、範囲測定に基づいて決定される。例示の実施形態では、プロセッサは、横方向距離、及び横方向距離方向の標的対象物に対する速度に基づいて、標的対象物に対する衝突までの時間(TTC)を決定するように更に構成され得る。有利なことに、交差交通警報又は他のフィードバックは、標的対象物について判定されたTTCに少なくとも部分的に基づいてトリガされるべきかどうかを判定するように構成され得る。
本開示に従う、例示の所定の集合警報区画を描写する。
本開示に従う、例示の自動車レーダシステムの概略ブロック図を描写する。
本開示に従う、警報区画についての最適関心領域が、ホスト車両と標的対象物との間の交差経路角度に依存して、(ホスト車両に対して)変化し得る方法を描写する。
本開示に従う、例示的な交差経路警報システムについてのフロー図を描写する。
本開示に従う、図5の交差経路警報システムについての例示的な処理モジュールについてのフロー図を描写する。
本開示に従う、異なる交差経路角度シナリオのためにホスト車両に対して移動する標的対象物の例示の追跡を描写する。 本開示に従う、異なる交差経路角度シナリオのためにホスト車両に対して移動する標的対象物の例示の追跡を描写する。
本開示に従う、交差経路角度を推定するための例示的なアルゴリズムのフローチャートを描写する。
本開示に従う、図8のアルゴリズムの有効性を実証する経験的な結果を描写する。 本開示に従う、図8のアルゴリズムの有効性を実証する経験的な結果を描写する。
本開示に従う、ホスト位置及び配向がtn−1とtとの間で変化した動的ホストの例を描写する。
本開示に従う、動的ホストが垂直経路距離及び横方向距離算出に影響を与える方法並びに本明細書に記載される座標変換がそのようなものを補償し得る方法を描写する。 本開示に従う、動的ホストが垂直経路距離及び横方向距離算出に影響を与える方法並びに本明細書に記載される座標変換がそのようなものを補償し得る方法を描写する。 本開示に従う、動的ホストが垂直経路距離及び横方向距離算出に影響を与える方法並びに本明細書に記載される座標変換がそのようなものを補償し得る方法を描写する。 本開示に従う、動的ホストが垂直経路距離及び横方向距離算出に影響を与える方法並びに本明細書に記載される座標変換がそのようなものを補償し得る方法を描写する。
本開示は、詳細な説明で更に記載され、本開示の実施形態の非限定的な例として、記載された複数の図面に関するものが続き、図面中、同様の参照番号は、図面のいくつかの図を通して類似の部分を表す。
本開示の例示的な実施形態によると、自動車レーダシステムを利用する、ホスト車両と標的対象物との間の改善された交差経路検出のための方法が提供される。一般的に言って、本開示のシステム及び方法は、標的対象物の位置における変化を追跡して、位置におけるそのような追跡された変化に基づいて、ホスト車両の経路と標的対象物の経路との間などの交差経路角度を決定するために、ホスト車両上で自動車レーダを利用する。この交差経路角度は、標的対象物及びホスト車両の現在の軌道に基づいて、交差経路検出のために最適関心領域を有利なことに特徴付け得る。本明細書における様々な例示の実施形態が「レーダ」及び「レーダシステム」の使用に関するものである一方で、本出願がそのような電波に基づく感知に限定されないことを、出願人は示す。むしろ、本明細書に記載されるシステム及び方法は、標的対象物の相対位置を追跡すること(例えば、レーザースキャン(例えば、ライダ)系システム、カメラ、又は他の画像に基づく感知システムなどの標的対象物についての範囲及び角度位置情報を提供することなど)ができる任意の自動車接近感知検出器を利用し得る。
本明細書に記載されるように、交差経路角度を推定することは、有利なことに、標的対象物の軌道とホスト車両の共通の基準位置(複数の時点にわたる)との間の、各時点における垂直経路距離の、複数の時点にわたる分散を最小限に抑える最適化問題を解決することを伴い得る。より具体的には、各々の時点における垂直経路距離が、交差経路角度、及びその時点における標的対象物についてのレーダ情報の関数として表されるので、最適化問題を解決することは、結果として時点の各々における同一又は類似の垂直経路距離になる交差経路角度解を選択することを本質的に伴う。
とりわけ、この最適化問題は、任意の数の異なる数学的技法を使用して解決され得る。例えば、いくつかの実施形態では、この最適化問題は、多重仮説問題として仮定され得、複数の異なる交差経路角度解が試みられる。そのような実施形態では、最良の解は、複数の異なる交差経路角度解(その解に基づいて、結果として垂直経路距離における最小の分散をもたらす)から選択され得る。
更なる実施形態では、反復プロセスは、最適交差経路角度を選択するために適用され得る。これにより、例えば、いくつかの実施形態では、次の交差経路角度解は、試みられ、反復プロセスにおいて、前の交差経路角度解と比較され得、2つの解のうちの良い方(最も小さな分散を有する解)は、次の反復のための前の交差経路角度解として選択されている。そのような実施形態では、次の交差経路角度解は、前の交差経路角度解の分散に部分的に基づいて選択され得る。特に、前の交差経路角度解についての垂直経路距離が、第2の時点と比較して第1の時点においてより大きい又はより小さかったどうかに依存して、次の交差経路角度解は、前の交差経路角度解よりも大きい又は小さいものとして選択され得る。
また更なる実施形態では、本明細書に記載される最適化問題は、そこから解決され得る数学的解を有し得る。例えば、いくつかの実施形態では、最適化問題は、平均二乗誤差を用いて解決され得る。例示の実施形態では、マトリックスの固有分解は、複数の時点にわたる垂直経路距離における分散を最小限に抑える最適交差経路角度を決定するために適用され得る。代替的に、最適交差経路角度は、瞬間垂直経路距離P(i)(各時点iにおける垂直経路距離を表す)を、複素数表現に変換することに基づいて解決され得る。
有利なことに、いくつかの実施形態では、交差経路角度は、反復的に/再帰的に(例えば、少なくとも複数の独立した追跡を表す3つ以上の点にわたって)決定され得る。交差経路角度の反復/回帰判定は、有利なことに、標的対象物及び/又はホスト車両の、曲線経路などの軌道における変化(交差経路角度における変化によって特徴付けられ得る)の検出を可能にし、及びそれを説明し得る。これにより、例えば、いくつかの実施形態では、標的対象物の位置における変化を追跡するためのサンプリング頻度は、例えば、交差経路角度における変化に基づいて、能動的に調節され得る。例えば、いくつかの実施形態では、変化(標的対象物及び/又はホスト車両の曲線経路軌道を示す変化など)が交差経路角度で検出されるとき、サンプル周波数を増加して及び/又はバッファサイズを低減させることは有利であり得る。
交差経路角度の反復/回帰判定はまた、交差経路角度における反復/回帰変化に基づいて、データセットにおける複数の交差経路角度データ点の適応的ウィンドウ処理を可能にし得る。このように、外れ値データ点は、結果として交差経路角度の単一の追跡算出よりも高信頼のデータを生じるデータセットから差し引かれ/破棄され得る。いくつかの実施形態では、交差経路角度における変化は、標的対象物の方向の変化を検出/決定するために使用され得る。これにより、例えば、適応的ウィンドウ処理は、方向における変化の後からデータ点だけを利用するように構成され得る。
好ましい実施形態では、交差経路検出は、例えば、駐車場若しくは車道から後退するのを準備しているか、又は交差点で待機している車両などの固定又は静的ホスト車両を仮定し得る。固定又は静的ホスト車両を仮定することは、有利なことに、ホスト車両軌道と標的対象物軌道との間の交差経路角度の算出を単純化し得る。
いくつかの実施形態では、交差経路角度は、標的対象物の第1の追跡(例えば、2つ以上の時点の第1の組にわたって標的対象物を追跡することを特徴とする)について決定され得る。これにより、いくつかの実施形態では、交差経路角度は、時点の各々についての対応する垂直経路距離の間の分散を最小限に抑える最適交差経路角度を決定する最適化問題を解決することによって決定され得る。
上記したように、いくつかの実施形態では、いくつかの実施形態では、この最適化問題は、交差経路角度についての可能な解の範囲を想定する多重仮説問題として、仮定され得、各々の解は、ホスト車両のヘディングに対する標的対象物の軌道についての可能な対応する解ベクトルの角度オフセットを特徴付ける。そのような実施形態では、多重仮説問題を解決することは、各々の可能な交差経路角度解について、対応する解ベクトルと標的対象物との間の対応する垂直経路距離を算出することを、第1の追跡における複数の時点の各々について含み得る。多重仮説問題は、次いで、時点の各々についての対応する垂直経路距離の間の分散を最良に最小限に抑える交差経路角度解について解決され得る。
有利なことに、多重仮説タイプ問題の使用は、複数の時点にわたる独立した算出の各々が複数の可能な解を想定する手法、及び交差経路角度が複数の時点にわたるこれらの可能な解の収束に基づいて推定される手法を容易にし得る。例えば、いくつかの実施形態では、交差経路角度のために可能な解の範囲を想定する多重仮説問題が起こされ得、各々の可能な交差経路角度解は、所与の時点における標的対象物のための対応する可能な軌道を表す。これにより、多重仮説問題を解決することは、(i)第1の複数の時点の各々について、複数の可能な交差経路角度解の各々について、その時点における標的対象物の対応する可能な軌道とホスト車両の基準位置との間の対応する垂直経路距離を算出することと、(ii)複数の可能な交差経路角度解の各々について、時点の各々についての対応する垂直経路距離の間の分散を決定することと、を含み得る。これにより、例えば、第1の複数の時点は、第1の時点及び第2の時点を含み、多重仮説問題を解決することは、(i)第1の時点について、複数の可能な交差経路角度解の各々について、第1の時点における標的対象物の対応する可能な軌道とホスト車両の基準位置との間の対応する垂直経路距離を算出することと、(ii)第2の時点について、複数の可能な交差経路解の各々について、第2の時点における標的対象物の対応する可能な軌道とホスト車両の基準位置との間の対応する垂直経路距離を算出することと、(iii)複数の可能な交差経路角度解の各々について、第1の時点における対応する垂直経路距離と第2の時点における対応する垂直経路距離との間の差を決定することと、を含み得る。最適交差経路角度解は、次いで、第1の時点における対応する垂直経路距離と第2の時点における対応する垂直経路距離との間の最小の差を有する交差経路角度解として選択され得る。
しかしながら、本出願が、最適交差経路角度について解決するために多重仮説問題解釈を使用することに限定されないことを、出願人は示す。実際、本明細書に記載されるように、最適交差経路角度について直接解決するか又は反復的に解決するための他の数学的技法がまた、本明細書に記載される。
本明細書で使用するとき、「分散」という用語は、その平均からのパラメータ値の偏差の期待値である分散の数学的決定に限定されないことを、出願人は示す。むしろ、「分散」は、概して、パラメータ値が、パラメータ値の分布、又はパラメータ値の分布に対する何らかの他の品質評価測定値に対して拡散する程度を反映する何らかの測定値を指すために使用される。これにより、いくつかの実施形態では、分散は、数学的分散算出、標準偏差算出、絶対値算出の平均などを含み得る。
いくつかの実施形態では、交差経路角度についての最適化問題が、2つ以上の時点にわたって解決され得ることに留意されたい。これにより、いくつかの実施形態では、交差経路角度を推定することは、どの可能な交差経路角度解が、結果として、3つ以上の時点の各々のための対応する垂直経路距離の間の最低分散を生じるかに基づき得る。多重仮説タイプ分析の場合、3つの時点にわたって解決することは、例えば、第3の時点について、交差経路角度の可能な解の各々について、第3の時点における標的対象物の対応する可能な軌道とホスト車両の基準位置との間の対応する垂直経路距離を算出することを更に含み得る。
代替的に、いくつかの実施形態では、別個の交差経路角度解は、複数の追跡の各々について算出され得る。これにより、いくつかの実施形態では、システム及び方法は、複数の追跡のための交差経路角度解の間の分散を更に決定し得、その分散が所与の閾値未満である場合に、平均推定交差経路角度を算出し(異なる追跡減少についてそれらの交差経路角度解を平均化することは、許容可能な分散範囲に収まり)得る。
とりわけ、いくつかの実施形態では、対応する解ベクトルと標的対象物との間の垂直距離は、ホスト車両の現在の位置と標的対象物の現在の軌道との間の最短経路距離であり得る。この最短経路距離が、標的対象物の現在の軌道に垂直な軸に沿った、ホスト車両と標的対象物との間の距離の予測として特徴付けられ得ることに留意されたい。これにより、いくつかの実施形態では、最短経路距離は、例えば、標的対象物の経路とホスト車両の現在の位置との間の垂直距離として特徴付けられ得る。有利なことに、本明細書に記載されるように、最短経路距離は、例えば、関心領域を囲むための有用な測定基準であり、それによって、ホスト車両のための警報区画を確立し得る。特に、システム及び方法は、ホスト車両が標的対象物に対して所定の最短経路距離内にある場合のみ、警報又は他のフィードバックをトリガするように構成され得る。とりわけ、いくつかの実施形態では、最短経路距離は、解決された交差経路角度に基づいて算出され得る。いくつかの実施形態では、最短経路距離がまた、第2の時点についての対応する解ベクトルと標的対象物との間の垂直距離に実質的に等しい、第1の時点についての対応する解ベクトルと標的対象物との間の垂直距離の収束として特徴付けられ得ることにも留意されたい。
ホスト車両の所与の位置について、最短経路距離が、ホスト車両の現在の配向に関係なく一定のままであるように構成されている(相対配向のみが変化し、最短経路距離ベクトルの大きさは変化しない)ことに留意されたい。このように、最短経路距離は、ホスト車両の配向に関係なく警報区画を特徴付ける関心領域に対する固定バッファ距離を適用する(例えば、最短経路距離に関して固定閾値を適用することによって)ことを表すために使用され得る。これにより、いくつかの実施形態では、警報区画のバッファ幅は、一定のままであり得、警報区画の配向のみが、交差経路角度に基づいて決定されるように、ホスト車両に対して変化している。他の実施形態では、ホスト車両配向に依存して、分散するバッファ距離を適用することが有用であり得る。例えば、いくつかの実施形態では、可変閾値は、例えば、交差経路角度に基づいて、最短経路距離に関して適用され得る。これにより、60度及び45度の角度は、90度の角度とは異なる閾値(例えば、実施形態に依存してより大きな閾値又はより小さな閾値)を有するように構成され得る。
いくつかの実施形態では、利用され得る別の有用な測定基準は、真の経路距離である。真の経路距離は、ホスト車両の現在の位置と標的対象物の現在の軌道との間の、ホスト車両のヘディングに沿った距離を指し得る。ホスト車両の所与の位置について、真の経路距離が、ホスト車両の現在の配向に依存して分散する(相対配向のみが変化し、最短経路距離ベクトルの大きさは変化しない)ことに留意されたい。このように、真の経路距離はまた、ホスト車両の配向に依存している警報区画を特徴付ける関心領域に対する可変バッファ距離を確立するために使用され得る。これにより、いくつかの実施形態では、警報区画のバッファ幅は、交差経路角度によって分散するように構成され得る。例示の実施形態では、この可変バッファ幅は、ホスト車両の現在の位置と標的対象物の現在の軌道との間のホスト車両のヘディングに沿って延在する真の経路距離ベクトルに適用された閾値に基づいて決定され得る(例えば、閾値がベクトルの大きさに適用される場合)。これにより、バッファ幅は、標的対象物の現在の軌道に垂直な軸に沿った閾値処理されたベクトルの予測として算出され得る。このように、交差経路角度が90度により近い場合、可変バッファ幅が、より大きくなるように構成され得ることに留意されたい。
いくつかの実施形態では、真の経路距離が、集合バッファ幅を確立するために最短経路距離に連動して使用され得ることに留意されたい。例えば、いくつかの実施形態では、バッファ幅は、真の経路距離について算出されたバッファ幅と集合された最短経路距離に対するバッファ幅の集合に基づいて確立され得る。これにより、いくつかの実施形態では、最短経路距離に適用され得る閾値は、固定閾値に、標的対象物の現在の軌道に垂直な軸に沿った、閾値処理された真の経路距離ベクトルの予測を加えたものと等しい可変閾値であり得る。
本明細書に記載される更に有用な測定基準は、通常、本明細書で使用するとき垂直距離を指し得る、標的対象物の現在の位置における標的対象物の現在の軌道に垂直なベクトルとホスト車両のヘディングに沿った点との間の横方向距離である。いくつかの実施形態では、ホスト車両のヘディングに沿った点は、ホスト車両の現在の位置であり得、その場合には、横方向距離は、標的対象物の現在の軌道と平行の軸に沿った、ホスト車両と標的対象物との間の距離の予測として算出され得る。代替の実施形態では、ホスト車両のヘディングに沿った点は、ホスト車両のヘディングと標的対象物の軌道との間の交差点であり得る。これにより、そのような横方向距離では、標的対象物の現在の軌道に沿った、標的対象物の現在の位置とホスト車両のヘディングとの間の距離を表し得る。
有利なことに、本明細書に記載されるように、横方向距離は、例えば、その横方向距離及び標的対象物の現在の速度に基づいて、標的対象物に対する衝突(TTC)の時間を推定するための有用な測定基準であり得る。これにより、横方向距離及び/又は標的対象物のTTCは、例えば、関心領域を囲む際に更に使用されて、それによって、ホスト車両のための警報区画を確立し得る。特に、システム及び方法は、標的対象物がホスト車両からの所定の横方向距離及び/又はTTC内にある場合のみ、警報又は他のフィードバックをトリガするように構成され得る。
更なる実施形態において、例えば、ホスト車両の真の経路距離及び現在の速度に基づいて、標的対象物の軌道経路を交差しているホスト車両のために、TTCが更に決定され得ることに留意されたい。いくつかの実施形態では、ホスト車両のためのTTCは、関心領域のための追加の境界因子として利用され得る。
これにより、いくつかの実施形態では、システム及び方法は、以下の基準のうちの1つ以上の任意の組み合わせが満たされる場合のみ、警報又は他のフィードバックをトリガするように構成され得る:(i)ホスト車両が、標的対象物に所定の最短経路距離内である、(ii)ホスト車両が、標的対象物に所定の横方向距離内である、(iii)標的対象物のTTCが、所与の閾値未満である、及び/又は、(iv)ホスト車両のTTCが所与の閾値未満である。例えば、好ましい実施形態では、(i)ホスト車両が、標的対象物に対して所定の最短経路距離内にあるか、又はホスト車両のTTCが所与の閾値未満であるとき、及び(ii)標的対象物のTTCが所定の閾値未満であるとき、警報又はフィードバックは、トリガされ得る。いくつかの実施形態では、基準は、トリガする状況及びフィードバックの警報のトリガを防止する状況の両方を提供し得る。これにより、例えば、いくつかの実施形態では、基準は、最短経路距離に関して、警報又はフィードバックをトリガするための第1の閾値と、警報又はフィードバックがトリガすることを防止するための第2の閾値と、を含み得る。とりわけ、これは、それら自体では警報又はフィードバックを自動的にトリガしないが、むしろ、警報又はフィードバックが他の基準に基づいてトリガされることを可能にする最短経路距離についての中間範囲値を考慮に入れる。
本明細書における例示の実施形態及び算出は、概して、静的なホスト車両(関心の単純さにおいて)に関する一方で、本開示がそのような実施形態に限定されるものではないことに留意されたい。これにより、いくつかの実施形態では、交差経路検出は、移動するホスト車両を更に説明し得る。そのような実施形態では、第2の時点におけるホスト車両の位置及び配向は、第1の時点におけるホスト車両の位置及び配向に対して(例えば、ホスト車両のGPS又は他の運動追跡(ジャイロ又はステアリングホイール角度、速度計/オドメータ読取り値など)に基づいて、)知られ得る。この既知の相対位置データは、例えば、レーダ入力の共通の基準点を提供するように、有利なことに、時点のうちの1つ以上においてレーダ算出をオフセットするために使用され得る(とりわけ、共通の基準点は、第1の時点におけるホスト車両位置及び配向、車両位置及び配向の何らかの他の共通の基準点の第2の時点における車両位置及び配向であり得る)。これにより、交差経路角度の算出は、本明細書に記載される類似した算出を使用して、共通の基準点に基づいて進行し得る(本質的に、ホスト車両位置及び配向の共通の基準点の使用は、ホスト車両が静的である場合に、交差経路角度の算出を1つに低減させる)。このように、ホスト車両に対する交差経路角度は、共通の基準点において車両に対して算出され得、例えば、交差経路角度は、第1の時点で、又は第2の時点でホスト車両位置及び配向に対して決定され得る。いくつかの実施形態では、基準点に対する交差経路角度解が、所望の時点におけるホスト車両位置及び配向に対する交差経路角度解を表すように、置換され得る(そのような置換は、共通の基準点に対するオフセットに基づいて実装され得る)ことに留意されたい。これにより、一般的に言って、動的ホストの場合、レーダ測定値は、ホスト車両が、例えば、ホストヨーレート及び速度情報を特徴とする配向及び/又は位置において移動するたびに、補償され得る。
上記したように、本明細書に記載されるシステム及び方法は、ホスト車両の自動車レーダシステムを標的対象物の交差経路検出のために利用する。図2は、いくつかの例示的な実施形態に従う、自動車レーダ信号を処理するための1つ以上のレーダセンサモジュール12を含む、自動車レーダシステム10の概略ブロック図を含む。図2を参照すると、レーダシステム10は、ホスト車両においてレーダシステム10と互換性を有するレーダ送受信信号を処理する1つ以上のレーダモジュール12を含む。レーダセンサモジュール12は、レーダシステムによって監視されているホスト車両に隣接する関心領域にレーダ信号を生成及び伝送する。信号の生成及び伝送は、RF信号生成器24、レーダ伝送回路20、及び伝送アンテナ16によって達成される。レーダ伝送回路20は、概して、伝送アンテナ16を介して伝送される信号を生成することを必要とされる任意の回路(信号変換/タイミング回路、伝送トリガ回路、RFスイッチ回路、RF電力増幅器回路、又は、レーダシステム10によって使用されて、本明細書に詳細に記載される例示的な実施形態に従う、伝送されたレーダ信号を生成する任意の他の適切な伝送回路など)を含む。いくつかの実施形態では、RF信号伝送回路20は、RF信号生成器24に含まれるRF発振器からの入力に依存し得るRFスイッチ機構を含み得る。RF信号伝送回路は、有利なことに、例えば、伝送アンテナ三角関数算出に基づくパルス整形回路を更に含み得る。
レーダモジュール12はまた、受信アンテナ18を介してレーダ受信回路22におけるレーダ信号を受信する。レーダ受信回路22は、概して、受信アンテナ18を介して受信された信号を処理することを必要とされる任意の回路(RF低雑音増幅器回路、信号変換/タイミング回路、受信トリガ回路、RFスイッチ回路、又は、レーダシステム10によって使用される任意の他の適切な回路など)を含む。いくつかの実施形態では、レーダ受信回路22はまた、複数の受信アンテナから受信アンテナを選択するための受信アンテナ選択モジュールを含み得る。いくつかの例示的な実施形態では、レーダ受信回路22によって処理される受信された信号は、所定の位相差を有する2つの信号を生成する移相器回路26に転送される。同相(I)信号及び直交(Q)信号と称されるこれらの2つの信号は、それぞれ、混合機28及び30によって、RF信号生成器24からのRF信号と混合されて、I及びQ中間周波数(IF)信号を生成する。いくつかの実施形態では、混合は、受信アンテナ三角関数算出に基づくRF信号生成器24からのRF信号のパルス整形に更に基づき得る。結果として得られるIF信号は、回路32をフィルタ処理することによって、必要に応じて更にフィルタ処理されて、図2において「I」及び「Q」に標識付けされた、フィルタ処理されたIF I及びQ信号を生成する。IF I及びQ信号は、アナログデジタル変換器回路(ADC)34によってデジタル化される。これらのデジタル化されたI及びQ IF信号は、デジタル信号プロセッサ(DSP)36などのプロセッサによって処理される。いくつかの例示的な実施形態では、DSP36は、システム10によって実施される対象物範囲、軸受、及び/又は速度決定を含む、対象物検出及びパラメータ決定を実行することが必要とされる処理の全てを実施し得る。
図2に図解されるシステム構成が例示的であるだけで、他のシステム構成が本明細書に記載される実施形態を実装するために使用され得ることが理解されよう。例えば、IF信号及びアナログデジタル変換のフィルタ処理の順序付けは、図2に図解される順序とは異なり得る。IF信号は、フィルタ処理の前にデジタル化され得、次いで、デジタルフィルタ処理は、デジタル化された信号(複数可)上で実行され得る。他の実施形態では、RF信号が更なるデジタル化及び処理のためにDCに直接変換されるように、IFステージ全体は除去され得る。
本開示によると、本明細書に提供されるシステム及び方法は、有利なことに、ホスト車両と標的対象物との間などの交差経路検出を提供し得る。上記したように、いくつかの実施形態では、ホスト車両は、目的とする前方に引くこと又は後退すること(例えば、駐車場から出るか、又は車道と合流することなど)を行う車両(例えば、駐車場に駐車されるか、又は交差点で停止されるなど)を表し得る。したがって、そのような操縦の間にホスト車両で経路を交差し得る他の車両などの標的対象物を検出することは、そのようなシナリオにおいて有用である。有利なことに、標的対象物の交差経路検出は、可能な衝突を防止するために、警報又は他のフィードバックを提供するために使用され得る。いくつかの実施形態では、フィードバックは、例えば、受動的なフィードバックであり得、差し迫った衝突の視覚及び/又は可聴警告を介して運転者に警報を出す。他の実施形態では、フィードバックは、例えば、自動運転システム、自動制動システムなどを介して、ホスト車両の移動を自動的に調整/制御し得る能動的フィードバックであり得る。
所定の静的な区画警報区画(例えば、1つ以上の重複関心領域を特徴とする)を利用する従来の交差経路検知システムと対照的に、本出願のシステム及び方法は、警報区画が、交差経路角度の関数として変化することを可能にする可能にする。図3は、最適関心領域が、ホスト車両の配向に依存して、(ホスト車両に対して)変化し得る方法を図解する。特に、図3は、ホスト車両の3つの例示の配向を描写する。とりわけ、最適関心領域は、各々の場合では、ホスト車両とよりもむしろ標的対象物の軌道と整列されたままである。
ここで図4を参照すると、例示的な交差経路警報システムのためのフロー図が描写される。ステップ410では、ホスト車両による標的対象物の追跡についての受信されたレーダ情報などの入力は、システムによって受信される。これらの入力は、次に、ステップ420において処理されて、例えば、本明細書に記載されるものなどの最適化問題を解決することを介して、交差経路角度を推定する。いくつかの実施形態では、ステップ420は、標的対象物に対するホスト車両の最短経路距離(ホスト車両と標的対象物の現在の軌道との間の垂直距離を特徴とする)を推定するために交差経路角度を利用することを更に含み得る。有利なことに、この経路距離は、関心領域を確立する際に使用され得、それは、特定の閾値経路距離に限定され得る。これにより、例えば、警報区画は、ホスト車両から所定の最短経路距離未満であるように囲まれ得る。更なる実施形態では、ステップ420はまた、標的対象物に対するホスト車両の横方向距離(例えば、いくつかの実施形態では、標的対象物の現在の軌道に垂直なベクトルとホスト車両の現在の位置との間の垂直距離によって特徴付けられ得るように)を決定するために交差経路角度を利用することを含み得る。また更なる実施形態では、ステップ420は、例えば、その横方向距離及び標的対象物の現在の速度に基づいて、標的対象物に対するTTC算出を含み得る。とりわけ、いくつかの実施形態では、ステップ420はまた、本明細書に記載されるように、例えば、ホスト車両に対する真の経路距離及びTTCに関するものなどの他の更なる算出を含み得る。有利なことに、いくつかの実施形態では、ステップ420の算出は、単一の処理モジュール(例えば、図4のFarPathモジュール)を介して利用して実装され得る。これらの算出は、交差経路フィードバックモジュール(例えば、図4のRCPモジュール)への入力となり得、それは、ステップ430で、可能な警報又は他のフィードバックを決定するためにそのようなパラメータを評価し得る。例えば、いくつかの実施形態では、交差経路フィードバックモジュールは、警報区画を確立するパラメータが処理モジュールの算出によって与えられる場合、標的が警報区画にあるとき、警報又は他のフィードバックを生成するように構成されている既存の警報モジュールであり得る。最後に、ステップ440では、警報又はフィードバックは、交差経路フィードバックモジュールから生成される。上記したように、フィードバックは、受動的であり得る(運転者への聴覚又は視覚警告など)か、又は能動的であり得る(自動制動特性を起動することなど)。
ここで図5を参照すると、例示的な処理モジュールのためのフロー図が描写される。ステップ510では、交差経路角度は、所与の追跡のために推定される。図6及び図7の各々は、ホスト車両に対して移動する標的対象物の例示の追跡を図解する。図6は、交差経路角度が90度である例を表し、図7は、交差経路角度が60度である例を表す。図6及び図7は、図4のステップ510で交差経路角度の推定において使用され得る様々な入力パラメータを更に図解する。例えば、これらのレーダ入力パラメータは、レーダ範囲算出R(所与の時点におけるホスト車両と標的車両との間の距離であり得る)、及びレーダ角度θ(所与の時点におけるレーダボアサイトに対する標的車両の角度であり得る)を含み得る。レーダ角度θは、レーダ取付角度θ(レーダボアサイトに垂直な軸とホスト車両の運転経路との間の角度であり得る)などの1つ以上の追加のパラメータを介して、ホスト車両に対して更に位置的に関連付けられ得る。図6及び図7の実施形態では、交差経路角度はまた、(図6及び図7の例が、静止したホスト車両を仮定するならば)駐車角度θpkと称される。「経路距離」という用語が、垂直経路距離を指すために図6及び図7において使用されることに留意されたい。
いくつかの実施形態では、駐車角度θpkを算出することを容易にするために、経路距離P(i,j)は、等式P(i,j)=−R(i)cos(θpk(j)+θ−θ(i))(等式(1)とも称される)(式中、iは時刻であり、jは仮説反復/回帰である)を使用して、各々の時点及び各々の可能な駐車角度θpk(j)について算出される。これにより、多重仮説問題が起こされ、θpkは、時点の間でベクトルPの分散を最小限に抑えることによって解決され得る(標的が直線で移動するという仮定下で):θpk=argmin(var(P))。この方法は、性質において本質的に凸状である費用関数を利用して、計算量を最小限に抑える。
図8は、駐車角度θpkを算出して、多重仮説タイプ問題に基づいて最短経路距離を決定するための例示的なアルゴリズムのフローチャートを描写する。ステップ810では、新しいデータ(R(i)、θ(i)が利用可能であるとき、経路距離P(i,j)を得るために全ての駐車角度仮説θpk(j)についての等式(1)が実行される。ステップ820では、i≧2(3つ以上の時点)のとき、P(i,j)の分散は、jごとのiの全ての履歴に対応して算出され、これにより、経路距離ベクトルVarP(j)の分散を生じる。次に、ステップ830では、ベクトルVarP(j)の最小値が決定され、また現在の時間iまでのデータについての最良の駐車角度である対応するθpk(j)が決定される。ステップ840では、経路距離ベクトルは、等式(1)及びステップ830で解決されたθpk(j)を使用して、(現在の時間iまで)再算出される。この経路距離ベクトルは、ホスト車両に対する最短経路距離を表し、警報区画についてのパラメータとして使用され得る。とりわけ、例示のアルゴリズム当たりの距離推定は、駐車角度推定値収束の重み付き平均を利用する。これにより、最後に、ステップ850では、最短経路距離及びOEM要件に基づく警報論理が実装される。
図9及び図10を参照すると、図8のアルゴリズムの有効性が実証される。特に、図9は、異なる相対位置に対する駐車角度を推定する際に、図8のアルゴリズムの相対的な有効性を実証する。図9では、X(m)は横方向距離であり、Y(m)は最短経路距離である。図10は、次いで、(i)最短経路距離、(ii)横方向距離、(iii)駐車角度、及び(iv)TTCを上から下まで含む様々なパラメータの推定の多重仮説問題を解決するための収束時間を実証する。
とりわけ、図8のアルゴリズムは、有利なことに、各々の新しい時点(i,i+1,i+2,i+3など)によって提供される各々の新しい追跡のために反復的に/再帰的に実行され得る。この反復/回帰手法は、有利なことに、データ平滑化、並びにデータセットから差し引かれ/破棄され得る外れ値データ点を特定することを可能にし得る。例えば、いくつかの実施形態では、交差経路角度、最短経路距離などの算出されたパラメータのうちの1つ以上は、その後の算出によって検証され得、例えば、適合算出の閾値の数は、そのようなデータ点を検証することを必要とされる。更なる実施形態では、交差経路角度、最短経路距離などの算出されたパラメータは、複数の追跡からの結果の平均に基づいて決定される。いくつかの実施形態では、非適合算出は、例えば、外れ値として差し引かれ/破棄され得る。一般に、複数の追跡にわたるパラメータの相互算出は、単一の追跡からのデータを使用して達成できるよりも大きなデータ信頼性及び完全性を提供する。
代替的に、数学的解は、その中で起こされる最適化問題から解決され得る。これにより、例えば、再び図7を参照すると、駐車角度θpkが、標的経路方向とホスト車両ヘディング方向との間の角度として定義される場合、センサ取付角度θは、センサ表面方向とホスト車両ヘディング方向との間の角度として定義される。アルゴリズムの目的は、垂直経路距離推定の最小分散と標的車両追跡を適合させる最適駐車角度(交差経路角度)を見い出して、次いで、対応する経路距離を見い出すことである。所与の時点における瞬間垂直経路距離は、
Figure 0006714148
として表され得、式中、iは、瞬間時間であり、P(i)は、瞬間経路距離であり、R(i),θ(i)は、それに応じたレーダ追跡範囲及び角度である。これにより、最適化問題は、標的が直線で移動するという仮定下で、経路距離ベクトル
Figure 0006714148
の分散を最小限に抑える最適駐車角度θpkについて解決するものとして表され得る。これにより、
Figure 0006714148
であり、式中、
Figure 0006714148
nは、推定(例えば、使用される時点の数)を算出するために使用されるデータの長さである。
上記の仮定された最適化問題は、有利なことに、最小平均二乗誤差について(例えば、分散を最小限に抑えることの表現として)解決され得る。いくつかの実施形態では、固有分解が使用され得る一方で、これは、計算及びメモリの観点から高価であり得るマトリックス演算を伴う。これにより、本明細書に提示される例示の実施形態は、
Figure 0006714148
を複素数表現に変換する代替の手法を利用する。これがマトリックス演算を回避するので、それは、計算コスト及びメモリ使用の両方を省く。そのような実施形態によると、最適駐車角度θpkは、
Figure 0006714148
として算出され得、
式中、
Figure 0006714148
であり、
Figure 0006714148
は、ベクトルC、範囲ベクトル
Figure 0006714148
及び角度ベクトル
Figure 0006714148
の平均である。
とりわけ、mは、
Figure 0006714148
の条件を有する任意の整数である。
駐車角度θpkについての上記の最適化問題解は、以下のとおりに証明され得る。
Figure 0006714148
を定義することによって、経路距離ベクトル
Figure 0006714148
は、以下のように表され得る。
Figure 0006714148
式中、
Figure 0006714148
であり、
Figure 0006714148
は、ベクトル
Figure 0006714148
の平均として定義され、そのため、
Figure 0006714148
であり、式中、それに応じて、
Figure 0006714148
は、ベクトルCの平均であり、そのため、平均を有しない経路距離ベクトルは、
Figure 0006714148
であり、以下の関係を使用する。
Figure 0006714148
を導き得、式中、は置換を有しない共役を表し、は置換を表す。したがって、経路距離ベクトルの分散は、以下のように算出され得る。
Figure 0006714148
Figure 0006714148
の特性を使用することとして算出され得、式中、
Figure 0006714148
である。
これは、結果として
Figure 0006714148
の解になる
Figure 0006714148
であるとき、最小限に抑えられ得る。
再び図5を参照すると、ステップ540では、最適交差経路角度解は、最短経路距離を決定するために利用され得る。本明細書に理解されるように、いくつかの実施形態では、最適交差経路角度について解決することは、交差経路角度の関数として垂直経路距離についてのパラメータを既に含み得、それによって、ステップ540は、実はステップ510に連動してある程度実行され得る。例えば、本明細書に記載される多重仮説技法は、既に、経路距離P(i,j)についてのパラメータをもたらし、それは、解決された駐車足首θpk(j)について、最短経路距離である。上述の最小平均二乗手法を使用して、最短経路距離は、
Figure 0006714148
として解決され得る。
また図5を参照すると、交差経路角度(例えば、算出された駐車角度θpkはまた、標的対象物の軌道と平行な軸へのホスト車両と標的対象物との間の距離の予測として算出され得る横方向経路距離を算出するために使用され得る(ステップ550で)。次に、横方向経路距離は、例えば、その横方向距離及び標的対象物の速度に基づいて、標的対象物についてTTCを算出するために使用され得る(ステップ560で)。本明細書に記載されるように、これらのパラメータに基づく警報論理はまた、実装され得る。上述の最小平均二乗手法を使用して、横方向距離は、以下のように解決され得る。
Figure 0006714148
標的対象物の速度は、次いで、レーダドップラー速度
Figure 0006714148
から算出され得、TTCは、以下のように算出され得る。
Figure 0006714148
であり、式中
Figure 0006714148
である。
再び図7を参照すると、交差経路角度において分散を最小限に抑えることによって何が意味されるかについての更なる説明が提供される。駐車角度の第1の仮説jのための時点i及びi+1についての垂直経路距離が描写される。とりわけ、仮説jについて、時点iにおける垂直経路距離P(i,j)は、時点i+1における垂直経路距離P(i+1,j)よりも長い。これにより、仮説jが最適解でない分散が高く示される。むしろ、時点iにおける垂直経路距離P(i)が時点i+1における垂直経路距離P(i+1)と同じである場合、最適解は、交差経路角度解によって表される。
有利なことに、本明細書に提示されるいくつかの例が2つの時点にわたって分散を最小限に抑えるために単純化される一方で、本開示のシステム及び方法は、そのようなものに限定されない。むしろ、垂直経路距離における分散を最小限に抑える最適化問題として交差経路角度の算出を仮定することによって、本明細書に提示されるシステム及び方法は、有利なことに、3つ以上の時点からデータを考慮して、同時にそれによって、交差経路角度のより良好なより高信頼の算出を考慮に入れ得る。
有利なことに、いくつかのシステム及び方法では、処理モジュールは、標的対象物の軌道における変化を検出するための処理(ステップ520で)(例えば、旋回検出及び/又は曲線軌道検出)を更に含み得る。有利なことに、標的対象物の軌道における変化のそのような検出は、複数の追跡にわたる交差経路角度の反復/回帰判定によって可能にされる。特に、標的対象物の方向における変化は、1つの追跡からその後の追跡までの交差経路角度における変化に基づいて検出され得る。とりわけ、ホスト車両が静的である実施形態では、交差経路角度における変化は、標的対象物によって方向における変化に完全に起因し得る。しかしながら、ホスト車両がまた追跡の間の配向における変化を経験し得る他の実施形態では、正規化交差経路角度における変化を比較する前に、共通の基準点に対する各々の追跡のために交差経路角度を最初に正規化することが必要であり得る。
いずれの場合も、いくつかの実施形態では、閾値は、例えば、旋回している標的対象物に起因し得る、方向における大きな変化を検出するために適用され得る。これにより、例えば、複数の追跡にわたる交差経路角度における変化が、第1の閾値Φ(一定値又は追跡の価値依存時間若しくは距離のいずれかかとして実装され得る)よりも大きい場合、いくつかの実施形態では、システム及び方法は、旋回が起こったことを判定し得る。上記したように、交差経路角度の反復/回帰判定は、交差経路角度における反復/回帰変化に基づいて、データセットにおける複数の交差経路角度データ点の適応的ウィンドウ処理を可能にし得る。旋回が検出されている場合、これは、旋回の前にデータ点を破棄して、その後のデータ点のみをパラメータ算出に含むことによって実装され得る。
いくつかの実施形態では、方向における変化は、データ点を破棄することを必要とするようには分割され得ない。そのような実施形態では、システム及び方法は、Φ未満であるが、第2の閾値Φ(一定値又は追跡の価値依存時間若しくは距離のいずれかとして実装され得る)よりも更に大きい複数の追跡にわたる交差経路角度における変化に基づいて曲線経路を検出し得る。特に、駐車角度推定における単調な増加又は減少があり、かつ全体的な変化がΦよりも大きく、かつΦ未満である限り、曲線が示され得る。標的対象物の変化する軌道をより良好に追跡するために、曲線軌道が検出される場合、システム及び方法は、いくつかの実施形態では、追跡のためにサンプル周波数を増加し得る。代替的に、他の実施形態では、平均又は集合パラメータ決定のために使用されるバッファサイズは、減少され得る(例えば、曲線が検出される場合、より少ないデータ点が、交差経路角度を決定又は検証する際に使用され得る)。これにより、データ平滑化は、標的車両の方向における検出された変化の間に低減され得る。適応的バッファサイズ、データ点のウィンドウ処理、及びサンプリングレートの変化の可能な使用が、図5のステップ530において反映されることに留意されたい。
上記したように、いくつかの実施形態では、システム及び方法は、複数の追跡にわたって平均/集合パラメータ値を決定するように更に構成され得る(図5のステップ570で)。これにより、いくつかの実施形態では、平均(グローバル)交差経路角度は、複数の追跡からの集合データに基づいて決定され得る。より具体的には、少なくとも2つの独立した追跡からの交差経路角度推定が利用可能であるとき、第1の追跡のための交差経路角度の推定と第2の追跡のための交差経路角度の推定との間の分散が算出される。変動が、所与の閾値Φ3(一定値、又は追跡の時間若しくは距離依存値のいずれかとして実装され得る)未満である場合、第1及び第2の追跡からのデータは、平均化の候補として考えられる。一旦所定の数(例えば、3つ)のデータ点が一致する(例えば、3つ以上の追跡のための交差経路角度推定値の全てが互いの所定の分散内にある)場合、平均パラメータ値(平均(グローバル)交差経路角度など)は、そのようなデータに基づいて(例えば、これらの追跡の各々から交差経路角度推定を平均化することに基づいて)決定され得る。この様式で、独立したデータ点は、その信頼性を増加するために第1に、他のデータ点に対して検証され、次いで、平均化される。
代替の実施形態では、クラスタ分析は、複数の追跡(例えば、複数の連続した時点対/群)からの集合追跡データに基づいて、平均(グローバル)交差経路角度を決定するために適用され得る。特に、連続した追跡(例えば、連続した時点対/群)のための複数の交差経路角度推定は、クラスタ中心を決定するために分析され得る。クラスタ化はまた、標的の方向における急激な変化を検出するために使用され得る。特に、旋回は、第2の別個の交差経路角度クラスタの発現に基づいて検出され得る。これは、結果として別個のものとしてのクラスタ中心(例えば、標的の段階的な曲線経路の場合などにおける)を生じないであろう交差経路角度における段階的な変化と対比され得る。これにより、クラスタ分析は、交差経路角度推定値における経時的変化を評価するための有用なツールであり、(i)高信頼のグローバル又は平均交差経路角度を(例えば、クラスタ中心に基づいて)検出すること、(ii)データを検証して、任意の外れ値(例えば、いずれのクラスタ中にも存在しないデータ点)を特定する及び不適格とすること、並びに(iii)交差経路角度における変化が、標的の段階的な曲線経路と標的の迅速な旋回とを(例えば、クラスタ分離に基づいて)区別するように、段階的又は急激であるかを判断することのために使用され得る。例示の実施形態では、kは、クラスタ中心(複数可)からの二乗距離が各々の交差経路角度データ点について最小限に抑えられるように、クラスタ化が利用され得ることを意味する。分布に基づくクラスタ化はまた、例えば、様々な分布モデル(例えば、期待値最大化に基づくガウス分布)に基づいて利用され得る。密度に基づくクラスタ化はまた、交差経路角度推定値における経時的変化を評価するために利用され得る。
本明細書で使用するとき、追跡は、複数の時点についての追跡データを含み得る。これにより、いくつかの実施形態では、標的対象物の連続した追跡は、重複データ(例えば、重複時点)を含み得る。例えば、いくつかの実施形態では、第1の追跡は、第1の複数の時点(i...i+n)についての追跡情報を含み得る一方で、第2の追跡は、第2の複数の時点(i+1...i+n+1)についての追跡情報を含み得る。代替的に、標的対象物の連続した追跡は、重複しない場合がある。
本明細書に記載のいくつかの実施形態及び算出は、概して、静的なホスト車両(関心の単純さにおいて)に関する一方で、本開示がそのような実施形態に限定されるものではないことに留意されたい。これにより、上記したように、いくつかの実施形態では、交差経路角度検出は、移動しているホスト車両を更に説明し得る。そのような実施形態では、第2の時点におけるホスト車両の位置及び配向は、第1の時点におけるホスト車両の位置及び配向に対して(例えば、ホスト車両のGPS又は他の運動追跡(ジャイロ又はステアリングホイール角度、速度計/オドメータ読取り値など)に基づいて、)知られ得る。この既知の相対位置データは、例えば、レーダ入力の共通の基準点を提供するように、有利なことに、時点のうちの1つ以上においてレーダ算出をオフセットするために使用され得る(とりわけ、共通の基準点は、第1の時点におけるホスト車両位置及び配向、車両位置及び配向の何らかの他の共通の基準点の第2の時点における車両位置及び配向であり得る)。これにより、交差経路角度の算出は、本明細書に記載される類似した算出を使用して、共通の基準点に基づいて進行し得る(本質的に、ホスト車両位置及び配向の共通の基準点の使用は、ホスト車両が静的である場合に、交差経路角度の算出を1つに低減させる)。このように、ホスト車両に対する交差経路角度は、共通の基準点において車両に対して算出され得、例えば、交差経路角度は、第1の時点で、又は第2の時点でホスト車両位置及び配向に対して決定され得る。いくつかの実施形態では、基準点に対する交差経路角度解が、所望の時点におけるホスト車両位置及び配向に対する交差経路角度解を表すように、置換され得る(そのような置換は、共通の基準点に対するオフセットに基づいて実装され得る)ことに留意されたい。これにより、一般的に言って、動的ホストの場合、レーダ測定値は、ホスト車両が、例えば、ホストヨーレート及び速度情報を特徴とする配向及び/又は位置において移動するたびに、補償され得る。
とりわけ、動的ホストの場合に補償され得る多くの異なるタイプのシナリオが存在し得る。例えば、いくつかの実施形態では、ホスト車両は一定軌道を呈し得る一方で、他の実施形態では、ホスト車両は軌道を変化させ得る。更にまた、いくつかの実施形態では、ホスト車両は一定速度を呈し得る一方で、他の実施形態では、ホスト車両速度は可変であり得る。最後に、いくつかの実施形態では、ホスト車両は一定ヨーレートを呈し得る一方で、他の実施形態では、ホスト車両ヨーレートは可変であり得る。動的ホスト補償は、有利なことに、最適様式でこれらのシナリオの各々に対処することを可能にし得る。
有利なことに、いくつかの実施形態では、座標変換は、前のデータ(前の時点)に適用され得る。特に、例示の実施形態では、ホストが新しい位置を有するたびに、(1つ以上の前の時点についての)全てのバッファデータは、交差経路角度を推定する前に新しい座標に再算出され得る。したがって、いくつかの実施形態では、本開示のシステム及び方法は、ホスト車両位置の変化を有利なことに検出/監視するように構成され得る。例示の実施形態では、これは、車両速度及びヨーレートを検出/監視することに基づいて、達成され得る。これにより、一旦動的ホスト状況が検出されると、システム及び方法は、バッファされた追跡データ(例えば、レーダ範囲及びレーダ角度データ)に前の時点から座標変換を自動的に適用し得る。例示の実施形態では、座標変換は、(i)前のフレーム座標における追跡データ(分散している時間である)、(ii)ホスト速度、及び(iii)角度変化(ヨーレート、ステアリングホイール角度など)に基づいて算出され得る。
図11を参照すると、tの座標においてtn−1に対する座標変換を実施する例が提供され、tは現在の時点であり、tn−1は前の時点である。描写された実施形態では、ホスト位置及び配向が、tn−1とtとの間で変化したことに留意されたい。提供された実施形態では、前の時点tn−1についてのレーダ範囲R及びレーダ角度θ情報が、tにおけるホストのための座標系に変換される一方で、代替の実施形態では、現在の時間tについてのレーダ範囲R及びレーダ角度θ情報が、tn−1におけるホストのための座標系に変換され得るか、又は現在及び前の時点の両方についてのレーダ範囲R及びレーダ角度θ情報が、いずれかの時点におけるホストのための座標系のためとは異なり得る基準座標系に変換され得ることが理解されよう。
第1のステップでは、前の時点tn−1についてのバッファされたレーダ角度θ情報(複数の前の時点からのデータを含み得る)は、新しい時点tにおけるホストのための座標系に再算出及び変換され得る。これにより、
Figure 0006714148
であり、
式中、
Figure 0006714148
v(t)はホスト速度であり、ω(t)は時間tのホストヨーレートであり、Δはサンプリング間隔である。
現在のレーダ角度θ(t)は、レーダ角度ベクトル
Figure 0006714148
として加えられ得る。
次に、前の時点tn−1についてのバッファされたレーダ範囲R情報(複数の前の時点からのデータを再度含み得る)は、新しい時点tにおけるホストのための座標系に再算出及び変換され得る。これにより、
Figure 0006714148
現在のレーダ角度R(t)は、レーダ角度ベクトル
Figure 0006714148
として加えられ得る。
とりわけ、これらの算出は、交差経路角度θから独立するように更に低減され得る。これにより、
Figure 0006714148
本明細書に記載されるように、以下の証明は、動的補償を実証及び検証する。tの座標における時間tn−1の範囲測定で開始して、
Figure 0006714148
式中、v(t)は、ホスト速度であり、ω(t)は、ホストヨーレートである。
の座標における時間tn−1の角度測定
Figure 0006714148
三角関数の公式を使用して、C=θ(tn−1│tn−1)+θ−ω(tn−1)Δを定義し、以下を有する。
Figure 0006714148
単純化するために、第1に以下を解決する必要がある。
Figure 0006714148
Figure 0006714148
式中、f(a,b)はa,b関数であるため、
Figure 0006714148
この等式が成り立つ条件は、以下である。
a cos(f(a,b))=−b sin(f(a,b))
よって、
Figure 0006714148
上記を組み合わせると、以下を有する。
Figure 0006714148
図12〜図15は、動的ホストが垂直経路距離及び横方向距離算出に影響を与える方法並びに本明細書に記載される座標変換がそのようなものを補償し得る方法を描写する。より具体的には、図12〜15の各々は、動的ホストの異なるシナリオに関する。例えば、図12は、動的ホスト一定速度及び軌道に変化なしに関し、図13は、分散する速度を有し、かつ軌道の変化を有しない動的ホストに関し、図14は、一定ヨーレートを有する動的ホストに関し、図15は、分散するヨーレートを有する動的ホストに関する。とりわけ、本明細書に記載される座標変換は、これらのシナリオの各々において動的ホストを補償するために有効である。
本開示の多くの変更及び修正が、前述の説明を読んだ後に疑いなく当業者に明らかになるであろう一方で、図解によって示され及び記載される特定の実施形態が、制限すると考えられることを決して意図するものではないことを理解されたい。更に、本主題は、特定の実施形態に関して記載されたものであるが、本開示の趣旨及び範囲内の変動は当業者に起こるものとする。前述の例が、説明の目的のためにのみ提供されたものであって、本開示を制限するものとして決して解釈されないことに留意されたい。
本発明の概念がその例示的な実施形態に関して特に示されて、記載された一方で、形態及び詳細における様々な変化が、以下の特許請求の範囲によって定義されるように、本発明の概念の趣旨及び範囲から逸脱することなく、本発明において行われ得ることが、当業者によって理解されるであろう。

Claims (23)

  1. ホスト車両のための交差交通警報システムであって、
    ホスト車両に取付可能で、かつ複数の時点にわたって標的対象物の前記ホスト車両に対する相対位置を追跡する自動車接近感知検出器と、
    前記自動車接近感知検出器からデジタル信号を受信及び処理して、標的対象物の軌道と、前記ホスト車両の共通の基準位置(複数の時点にわたる)との間の、各時点における垂直経路距離の、前記複数の時点にわたる分散を最小限に抑える最適化問題を解決することによって、交差経路角度算出するプロセッサと、を備え
    前記交差経路角度が、前記複数の各時点において、前記標的対象物の軌道と前記ホスト車両の向いている方向が交差する角度である、交差交通警報システム。
  2. ある時点における前記垂直経路距離が、前記交差経路角度、及びその時点における前記標的対象物についての追跡情報の関数として表される、請求項1に記載の交差交通警報システム。
  3. 前記プロセッサは、前記標的対象物が関心領域内にあるかどうかに少なくとも部分的に基づいて、交差交通警報又は他のフィードバックがトリガされるべきかどうかを判定するように構成されており、前記関心領域が、前記交差経路角度に少なくとも部分的に基づいて決定される、請求項1に記載の交差交通警報システム。
  4. 前記プロセッサが、前記デジタル信号を更に処理して、前記算出された交差経路角度によって判定される、時点iにおける前記ホスト車両の位置と前記標的対象物の軌道との間で瞬間最短経路距離を決定する、請求項1に記載の交差交通警報システム。
  5. 前記瞬間最短経路距離が、時点iにおける前記標的対象物の軌道に垂直な軸に沿った、時点iにおける前記ホスト車両と前記標的対象物との間の距離の予測として決定され、時点iにおける、前記ホスト車両と前記標的対象物との間の前記距離が、追跡範囲測定値に基づいて決定される、請求項に記載の交差交通警報システム。
  6. 前記プロセッサは、交差交通警報又は他のフィードバックが、前記決定された瞬間最短経路距離に少なくとも部分的に基づいてトリガされるべきかどうかを判定するように構成されている、請求項に記載の交差交通警報システム。
  7. 前記プロセッサは、交差交通警報又は他のフィードバックが、前記決定された瞬間最短経路距離が閾値を超えることに少なくとも部分的に基づいてトリガされるべきかどうかを判定するように構成されている、請求項に記載の交差交通警報システム。
  8. 前記閾値が、前記算出された交差経路角度に関係なく一定である、請求項に記載の交差交通警報システム。
  9. 前記閾値が、前記算出された交差経路角度に基づいて可変である、請求項に記載の交差交通警報システム。
  10. 前記プロセッサが、前記デジタル信号を更に処理して、前記算出された交差経路角度によって判定される、時点iにおける前記標的対象物の軌道に垂直なベクトルと時点iにおけるホスト車両の位置との間の前記垂直距離を特徴とする、時点iにおける前記標的対象物と前記ホスト車両との間で瞬間横方向距離を決定する、請求項1に記載の交差交通警報システム。
  11. 前記瞬間横方向距離が、時点iにおける前記標的対象物の軌道に平行な軸に沿った、時点iにおける、前記ホスト車両と前記標的対象物との間の距離の予測として決定され、時点iにおける、前記ホスト車両と前記標的対象物との間の前記距離が、追跡範囲測定値に基づいて決定される、請求項10に記載の交差交通警報システム。
  12. 前記プロセッサが、前記デジタル信号を更に処理して、時点iにおける前記標的対象物と前記ホスト車両との間の前記瞬間横方向距離、及び前記標的対象物の相対速度に基づいて、時点iにおける前記標的対象物に対する瞬間的な衝突までの時間(TTC)を決定する、請求項10に記載の交差交通警報システム。
  13. 前記プロセッサは、交差交通警報又は他のフィードバックが、前記標的対象物に対する前記決定された瞬間的TTCに少なくとも部分的に基づいてトリガされるべきかどうかを判定するように構成されている、請求項12に記載の交差交通警報システム。
  14. 前記ホスト車両が、前記運転経路に対して運動しており、前記ホスト車両の前記共通の基準位置が、前記時点の各々における前記ホスト車両の位置に対する既知のオフセットを含む共通の基準点である、請求項1に記載の交差交通警報システム。
  15. 前記ホスト車両の前記基準点が、瞬間時点iにおける前記ホスト車両の位置である、請求項14に記載の交差交通警報システム。
  16. 各時点における前記標的対象物についての追跡情報が、瞬間時点iにおける前記ホスト車両の前記位置に正規化される、請求項15に記載の交差交通警報システム。
  17. 各時点における前記標的対象物についての正規化された追跡情報が、前記ホスト車両のホスト速度及び角度変化の関数として算出される、請求項1に記載の交差交通警報システム。
  18. 前記最適化問題が、多重仮説問題として解決され、前記多重仮説問題が、複数の可能な交差経路角度解を想定し、各々の交差経路角度解が、前記標的対象物の対応する可能な軌道を表し、前記交差経路角度が、標的対象物の前記軌道と前記ホスト車両の前記共通の基準位置(前記複数の時点にわたる)との間の、各時点における前記垂直経路距離の、複数の時点にわたる前記分散を最小限に抑える前記複数の可能な交差経路角度解から1つの交差経路角度解を選択することによって、決定される、請求項1に記載の交差交通警報システム。
  19. 前記多重仮説問題を解決することが、(i)前記時点の各々について、前記複数の可能な交差経路角度解の各々について、その時点における前記標的対象物の対応する軌道と、前記ホスト車両の基準位置との間の対応する垂直経路距離を算出することと、(ii)前記時点の各々についての前記対応する垂直経路距離の間の分散を最小限に抑える前記複数の可能な交差経路角度解から1つの交差経路角度解を選択することに基づいて前記交差経路角度を決定することと、を含む、請求項18に記載の交差交通警報システム。
  20. 前記複数の時点が、第1の時点及び第2の時点を含み、前記多重仮説問題を解決することが、(i)前記第1の時点について、前記複数の可能な交差経路角度解の各々について、前記第1の時点における前記標的対象物の前記対応する可能な軌道と、前記ホスト車両の基準位置との間の対応する垂直経路距離を算出することと、(ii)前記第2の時点について、前記複数の可能な交差経路解の各々について、前記第2の時点における前記標的対象物の前記対応する可能な軌道と、前記ホスト車両の基準位置との間の対応する垂直経路距離を算出することと、(iii)前記複数の可能な交差経路角度解の各々について、前記第1の時点における前記対応する垂直経路距離と、前記第2の時点における前記対応する垂直経路距離との間の差を決定することと、を含む、請求項19に記載の交差交通警報システム。
  21. 複数の時間が、第1の複数の時点を含み、前記第1の複数の時点についての分散情報が、バッファ内に記憶され、その後、その基礎となった垂直経路距離が、メモリから破棄される、請求項20に記載の交差経路警報システム。
  22. 前記複数の時間が、第1の複数の時点を含み、前記プロセッサが、標的対象物の軌道と前記ホスト車両の共通の基準位置(前記複数の時点にわたる)との間の、第2の複数の時点における各時点における垂直経路距離の、前記第2の複数の時点にわたる分散を最小限に抑える最適化問題を解決することによって、前記交差経路角度を再算出するように更に構成されている、請求項21に記載の交差経路警報システム。
  23. ホスト車両のための交差交通警報システムであって、
    ホスト車両に取付可能で、かつ3つ以上の時点にわたって標的対象物の前記ホスト車両に対する相対位置を追跡する自動車接近感知検出器と、
    前記自動車接近感知検出器からデータを受信及び処理して、前記3つ以上の時点にわたる最適化問題を解決することによって前記交差経路角度を算出するプロセッサとを備え
    前記交差経路角度が、前記複数の時点の各時点において、前記標的対象物の軌道と前記ホスト車両の向いている方向が交差する角度であり、
    前記最適化問題が、標的対象物の軌道と前記ホスト車両の共通の基準位置(前記複数の時点にわたる)との間の、各時点における垂直経路距離の、前記3つ以上の時点にわたる分散を最小限に抑えることである交差経路警報システム。
JP2019507832A 2016-08-31 2017-08-30 自動車レーダを利用する標的対象物の改善された検出 Active JP6714148B2 (ja)

Applications Claiming Priority (5)

Application Number Priority Date Filing Date Title
US15/253,343 US9889798B1 (en) 2016-08-31 2016-08-31 Detection of a target object utilizing automotive radar
US15/253,343 2016-08-31
US201662384911P 2016-09-08 2016-09-08
US62/384,911 2016-09-08
PCT/US2017/049416 WO2018045055A1 (en) 2016-08-31 2017-08-30 Improved detection of a target object utilizing automotive radar

Publications (2)

Publication Number Publication Date
JP2019532265A JP2019532265A (ja) 2019-11-07
JP6714148B2 true JP6714148B2 (ja) 2020-06-24

Family

ID=59829503

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019507832A Active JP6714148B2 (ja) 2016-08-31 2017-08-30 自動車レーダを利用する標的対象物の改善された検出

Country Status (2)

Country Link
JP (1) JP6714148B2 (ja)
WO (1) WO2018045055A1 (ja)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019166141A1 (en) * 2018-03-01 2019-09-06 Jaguar Land Rover Limited Vehicle control method and apparatus
CN112799055A (zh) * 2020-12-28 2021-05-14 深圳承泰科技有限公司 一种探测被测车辆的方法、装置以及电子设备
EP4124887A1 (en) * 2021-07-29 2023-02-01 Aptiv Technologies Limited Methods and systems for predicting trajectory data of an object and methods and systems for training a machine learning method for predicting trajectory data of an object
DE102021214883B4 (de) 2021-12-22 2023-10-12 Zf Friedrichshafen Ag Verfahren und System zum Überwachen eines Fahrzeugumfelds
CN114114321A (zh) * 2022-01-20 2022-03-01 雷神等离子科技(杭州)有限公司 一种激光雷达检测目标的防撞预测方法和系统
EP4358065A1 (en) * 2022-10-19 2024-04-24 Continental Autonomous Mobility Germany GmbH Vehicle object detection system and method for detecting a target object in a detection area located behind and lateral of a subject vehicle
CN115691220B (zh) * 2022-10-28 2024-06-14 江苏必安仕安防科技有限公司 一种基于物联网的后向来车防撞预警系统及方法
CN115675282A (zh) * 2022-10-28 2023-02-03 重庆长安汽车股份有限公司 倒车预警策略确定方法、预警方法、系统、设备及介质

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3980764B2 (ja) * 1998-08-19 2007-09-26 本田技研工業株式会社 車両の走行安全装置
JP5034966B2 (ja) * 2008-01-16 2012-09-26 トヨタ自動車株式会社 物体速度検出装置
JP5120139B2 (ja) * 2008-08-08 2013-01-16 トヨタ自動車株式会社 物体検出装置
US7978096B2 (en) * 2009-04-28 2011-07-12 Ford Global Technologies, Llc Parking angle determination and cross traffic alert
US8072352B2 (en) * 2009-04-28 2011-12-06 Ford Global Technologies, Llc Cross traffic alert with parking angle trajectory
US8952799B2 (en) * 2011-04-12 2015-02-10 Conti Temic Microelectronic Gmbh Method and system for warning a driver of a vehicle about potential obstacles behind the vehicle
JP5846109B2 (ja) * 2012-11-20 2016-01-20 株式会社デンソー 衝突判定装置及び衝突回避システム

Also Published As

Publication number Publication date
WO2018045055A1 (en) 2018-03-08
JP2019532265A (ja) 2019-11-07

Similar Documents

Publication Publication Date Title
JP6714148B2 (ja) 自動車レーダを利用する標的対象物の改善された検出
US9889798B1 (en) Detection of a target object utilizing automotive radar
EP3151034B1 (en) Automated vehicle radar system to determine yaw-rate of a target vehicle
US10605896B2 (en) Radar-installation-angle calculating device, radar apparatus, and radar-installation-angle calculating method
US11002849B2 (en) Driving lane detection device and driving lane detection method
WO2014125981A1 (ja) レーダセンサ取付角度を認識可能な車載レーダ装置
US11300415B2 (en) Host vehicle position estimation device
CN111615641B (zh) 用于探测关键横向运动的方法和设备
EP3502737A1 (en) True velocity vector estimation
JP2014115119A (ja) 物体検出装置
JP2023165850A (ja) 電子機器、電子機器の制御方法、及び電子機器の制御プログラム
US11142187B2 (en) Parking assistance device
CN117647797A (zh) 雷达的近距离速度纠正方法、装置、雷达及存储介质
CN110678776B (zh) 用于增强的对象跟踪的系统
US20170350975A1 (en) Radar device and signal processing method
WO2021074301A1 (en) Method for estimating an intrinsic speed of a vehicle
JP7303365B2 (ja) 検出値のストリングに基づいたセンサ較正
JP2014211332A (ja) レーダ装置、レーダ装置の制御方法
CN110691985B (zh) 用于增强的对象追踪的系统
WO2020066497A1 (ja) 電子機器、電子機器の制御方法、及び電子機器の制御プログラム
WO2023058559A1 (ja) 情報処理装置、物体追跡装置、追跡方法、プログラム
JPH11287855A (ja) レーダ装置

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20190416

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190214

A711 Notification of change in applicant

Free format text: JAPANESE INTERMEDIATE CODE: A711

Effective date: 20190416

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200212

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200426

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200604

R150 Certificate of patent or registration of utility model

Ref document number: 6714148

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313113

S531 Written request for registration of change of domicile

Free format text: JAPANESE INTERMEDIATE CODE: R313531

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350