JP2010280378A - 道路曲率見積もりシステムおよび自動車目標状態見積もりシステム - Google Patents

道路曲率見積もりシステムおよび自動車目標状態見積もりシステム Download PDF

Info

Publication number
JP2010280378A
JP2010280378A JP2010136483A JP2010136483A JP2010280378A JP 2010280378 A JP2010280378 A JP 2010280378A JP 2010136483 A JP2010136483 A JP 2010136483A JP 2010136483 A JP2010136483 A JP 2010136483A JP 2010280378 A JP2010280378 A JP 2010280378A
Authority
JP
Japan
Prior art keywords
state
road
target vehicle
target
curvature
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2010136483A
Other languages
English (en)
Other versions
JP5323766B2 (ja
Inventor
Shan Cong
コン，シャン
Shi Shen
シェン，シ
Lang Hong
ホン，ラン
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.)
Automotive Systems Laboratory Inc
Original Assignee
Automotive Systems Laboratory Inc
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 Automotive Systems Laboratory Inc filed Critical Automotive Systems Laboratory Inc
Publication of JP2010280378A publication Critical patent/JP2010280378A/ja
Application granted granted Critical
Publication of JP5323766B2 publication Critical patent/JP5323766B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Classifications

    • 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
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
    • B60K31/00—Vehicle fittings, acting on a single sub-unit only, for automatically controlling vehicle speed, i.e. preventing speed from exceeding an arbitrarily established velocity or maintaining speed at a particular velocity, as selected by the vehicle operator
    • B60K31/0008—Vehicle fittings, acting on a single sub-unit only, for automatically controlling vehicle speed, i.e. preventing speed from exceeding an arbitrarily established velocity or maintaining speed at a particular velocity, as selected by the vehicle operator including means for detecting potential obstacles in vehicle path
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
    • B60K31/00—Vehicle fittings, acting on a single sub-unit only, for automatically controlling vehicle speed, i.e. preventing speed from exceeding an arbitrarily established velocity or maintaining speed at a particular velocity, as selected by the vehicle operator
    • B60K31/0066—Vehicle fittings, acting on a single sub-unit only, for automatically controlling vehicle speed, i.e. preventing speed from exceeding an arbitrarily established velocity or maintaining speed at a particular velocity, as selected by the vehicle operator responsive to vehicle path curvature
    • B60K31/0083—Vehicle fittings, acting on a single sub-unit only, for automatically controlling vehicle speed, i.e. preventing speed from exceeding an arbitrarily established velocity or maintaining speed at a particular velocity, as selected by the vehicle operator responsive to vehicle path curvature responsive to centrifugal force acting on vehicle due to the path it is following
    • 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
    • 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/66—Radar-tracking systems; Analogous systems
    • G01S13/72—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
    • G01S13/723—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
    • 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/86—Combinations of radar systems with non-radar systems, e.g. sonar, direction finder
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T2210/00—Detection or estimation of road or environment conditions; Detection or estimation of road shapes
    • B60T2210/20—Road shapes
    • B60T2210/24—Curve radius
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T2260/00—Interaction of vehicle brake system with other systems
    • B60T2260/08—Coordination of integrated systems
    • 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
    • B60W50/00—Details 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
    • B60W2050/0001—Details of the control system
    • B60W2050/0043—Signal treatments, identification of variables or parameters, parameter estimation or state estimation
    • B60W2050/0052—Filtering, filters
    • 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
    • B60W2520/00—Input parameters relating to overall vehicle dynamics
    • B60W2520/14—Yaw
    • 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
    • B60W2552/00—Input parameters relating to infrastructure
    • B60W2552/20—Road profile
    • 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
    • B60W2552/00—Input parameters relating to infrastructure
    • B60W2552/30—Road curve radius
    • 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
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/40—Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404—Characteristics
    • B60W2554/4041—Position
    • 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
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/40—Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404—Characteristics
    • B60W2554/4042—Longitudinal speed
    • 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
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/40—Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404—Characteristics
    • B60W2554/4043—Lateral speed
    • 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
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/80—Spatial relation or speed relative to objects
    • B60W2554/803—Relative lateral speed
    • 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
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/80—Spatial relation or speed relative to objects
    • B60W2554/804—Relative longitudinal speed
    • 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/9325—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles for inter-vehicle distance regulation, e.g. navigating in platoons
    • 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/9327—Sensor installation details
    • G01S2013/93271—Sensor installation details in the front of the vehicles

Abstract

【課題】道路の曲率を見積もる。
【解決手段】第一のカルマンフィルター（５２）は、ヨーレートおよび速さの測定値をホスト車両内のそれぞれのセンサー（１６、１８）の測定値から見積もり、第二のカルマンフィルター（５４）はそれらから道路曲率のクロソイドモデルのパラメータを見積もる。レーダーシステム（１４）からのレンジ、レンジレートおよびアジマス角の測定値は、目標車両３６の状態の非束縛の見積もりを提供するために拡張されたカルマンフィルター（５６）によって処理される。関連する道路に束縛された目標の状態の見積もりは一または二以上の道路のレーンについて発生され、独立でまたは組み合わせで非束縛の見積もりと比較される。もし束縛された目標の状態の見積もりが非束縛の見積もりに対応しているなら、目標車両の状態は非束縛及び束縛の見積もりの統合で発生され、そうでないならば、非束縛の見積もりのみで与えられる。
【選択図】図４

Description

態様の説明
図１を参照すると、予測的衝突検出システム１０はホスト車両１２に組み込まれ、ホスト車両１２の外部にある物体を検出するレーダーシステム１４、および、例えばジャイロスコープセンサーなどのヨーレートセンサー１６、ホスト車両１２の運動を検出するためのスピードセンサー１８などのセンサー群を含む。ヨーレートセンサー１６とスピードセンサー１８はそれぞれホスト車両１２のヨーレートとスピードの測定値を与える。例えばドップラーレーダーシステムなどのレーダーシステム１４は、アンテナ２０およびレーダープロセッサー２２を含み、レーダープロセッサー２２はアンテナ２０から送信され、その視野角内の物体に反射するＲＦ信号を発生する。レーダープロセッサー２２は、反射し、アンテナ２０で受信された関連するＲＦ信号を復調し、アンテナ２０から送信されたＲＦ信号を照射された一または二以上の物体に応答する信号を検知する。例えば、レーダーシステム１４は、ホスト車両１２に固定された座標における目標のレンジ、レンジレート、およびアジマス角の測定値を提供する。図２を参照すると、アンテナ２０は、ビームコントロール部２４に応答して、例えば電気的あるいは機械的に、例えば±５０度などの±γのアジマス角にわたってスキャンするＲＦエネルギーのレーダービーム２３を発生するように適合し、レーダービーム２３は、予想される事故を避けあるいはそれによる損害あるいは負傷を緩和するためにホスト車両１２が採る有力な行動を緩和することができるように、ホスト車両１２との予想される衝突の前十分遠くで目標を検出できるように、例えば１００メートルのなどの十分に遠い距離範囲を持っている。レーダープロセッサー２２、ヨーレートセンサー１６、およびスピードセンサー１８は、例えば目標車両３６（図３に図示）などの物体との衝突が起こりそうか否かを決定し、もし起こりそうであれば、加えて例えば一または二以上の関連する警告システム２８または安全システム３０（例えばエアバッグ）の作動または予測される事故を避け、またはその帰結を軽減するために回避行動をとるための車両制御システム３２（例えば関連するブレーキまたはステアリングシステム）の使用などの採るべき行動を決定する関連する予測的衝突アルゴリズムに従って動作するシグナルプロセッサー２６に動作可能に連結している。
図３を参照すると、ホスト車両１２はレーンが複数ある直線またはカーブの道路３４を走行しており、目標車両３６は逆方向、すなわちホスト車両１２に向かって走行していることが示されている。一般的に、それぞれホスト車両１２と同じ方向または逆方向に走行している目標車両３６は、道路３４上であれば、何台でも良い。目標車両３６はホストレーン３８にいても良いし、隣接レーン４０にいてもよく、隣接レーン４０はホストレーン３８と近接していてもよいし分離していても良いが、一般的にはそれと平行である。解析する目的のために、ホスト車両１２はレーン３８のセンターライン４１に沿ってレーン内でふらつくことなく走行していると仮定し、全ての平行レーン３８、４０の曲率は等しいと仮定する。ホスト車両１２と検出可能な全ての目標車両３６の進行角度（heading angle）の差が１５度以下となるように、道路曲率は小さいと仮定する。
図４を参照すると、予測的衝突検出システム１０は、ホストに固定した座標における各測定時のそれぞれの目標車両の二次元的な位置、速度、加速度
Figure 2010280378
 を見積もるために、好ましくは誤差を可能な限り小さくして、
そのスピードセンサー１８およびヨーレートセンサー１６それぞれからのホスト車両１２の速さＵｈおよびヨーレートωｈ；
ホスト車両１２に装着されたレーダーシステム１４から得られる、全ての目標車両３６のレンジｒ、レンジレート
Figure 2010280378
 およびアジマス角η；
の測定値を、全ての測定値の誤差共分散行列との対応に従って用いる。予測的衝突検出システム１０は、(1)ホスト車両の運動センサー、換言すればヨーレートセンサー１６とスピードセンサー１８からの測定値を用いた、道路３４の曲率を見積もるための道路曲率見積もりサブシステム４２、(2)レーダービーム２３によって照らされ、レーダープロセッサー２２によって検出された目標車両の状態を見積もるための非束縛目標状態見積もりサブシステム４４、(3)目標が道路３４のホストレーン３８か隣接レーン４０のいずれか可能なレーンに束縛されていると仮定し、目標の束縛の状態を見積もるための束縛目標状態見積もりサブシステム４６、(4)非束縛目標状態といずれかの束縛に束縛された目標の状態のいずれが目標の状態として最適かを決定する目標状態決定サブシステム４８、および、(5)統合された目標の状態を発生するために、非束縛目標状態を目標状態決定サブシステム４８によって特定された適切な束縛と統合するための目標状態統合サブシステム５０、を含む。ホスト車両１２が目標と衝突する危険があるのか否かを決定し、もしあるなら、例えば警告システム２８、安全システム３０または車両制御システム３２のいずれかまたはこれらの組み合わせの行動によって、衝突の結果を和らげるために最適な行動を決定し、生じさせるために、最良の見積もり（非束縛目標状態か統合された目標の状態のいずれか）は決定または制御サブシステムに用いられる。可能な場合には、道路３４の幾何学的構造を目標の運動に対する束縛として使用することは、より正確な目標の状態の見積もりを提供し、それに応じて採られる行動の信頼性を向上させる。
図５を参照すると、ホスト車両１２の視野角内の目標の状態、換言すれば運動学的変数を検出する方法５００が示されており、そのステップは例えばシグナルプロセッサー２６で実行される。ステップ５０２および５０４では、道路３４に対するホスト車両１２の速さＵｈとヨーレートωｈがそれぞれスピードセンサー１８およびヨーレートセンサー１６からそれぞれ読み込まれる。その後、ステップ５０６で、道路３４の曲率パラメータとそれに関連する共分散が、それぞれホスト車両１２の状態（換言すれば、ホスト車両１２の運動状態変数）とそれに関連する共分散を見積もりその後道路３４の曲率パラメータとそれに関連する共分散を見積もる第一のカルマンフィルター５２と第二のカルマンフィルター５４を用いて、見積もられる。ここで、後文に説明するとおり、道路３４の曲率パラメータおよびその共分散は、次いで、予測的に目標車両３６が存在する有力な位置における関連する束縛を発生するために、束縛目標状態見積もりサブシステム４６に用いられる。
良くデザインされ、構成されている道路３４は、曲率を含む一組のパラメータで記述することができ、ここで、道路３４のある弧の曲率は、
Figure 2010280378
 と定義される。ここで、Ｒはその弧の半径である。一般的に、なめらかな道路３４では、曲率の変動は、いわゆるクロソイドモデル、換言すれば、
Figure 2010280378
 によって、道路３４に沿った距離ｌの関数として記述できる。ここで、Ｃ１＝１／Ａ２であり、Ａはクロソイドパラメータと呼ばれる。
図６を参照すると、進行方向を定義する進行角度θは、
Figure 2010280378
 により得られる。等式（２）を等式（３）に代入すると、
Figure 2010280378
 が得られる。
図６を参照すると、x-y座標での道路３４の等式は、
Figure 2010280378
 および
Figure 2010280378
 で与えられる。
進行角度θが１５度以下である、すなわち
Figure 2010280378
 と仮定すると、等式（５）および（６）はおよそ、
Figure 2010280378
Figure 2010280378
 とすることができる。
従って、道路３４は、付加的な曲率の係数Ｃ０とＣ１によってモデル化される。この付加的な道路の等式は広範囲の道路の形状を以下のごとく記述する；(1)直線の道路３４では、Ｃ０＝０かつＣ１＝０；(2)円状の道路３４では、Ｃ１＝０；(3)進行角度θが１５度以下であって任意の形状を持つ一般的な道路３４では、Ｃ０＞０である。
道路曲率パラメータＣ０とＣ１は、ホスト車両１２が道路３４のセンターライン４１または関連するホストレーン３８に沿って動いているとの仮定の下、ホスト車両１２内の運動センサー（ヨーレートセンサー１６とスピードセンサー１８）からのデータを用いて見積もられる。
道路曲率パラメータＣ０とＣ１は、ホスト車両１２の運動センサーから手に入るホスト車両１２のヨーレートωｈと速さＵｈに応答する
Figure 2010280378
 のデータから計算できる。しかしながら、一般的にヨーレートセンサー１６とスピードセンサー１８からそれぞれえられる、ヨーレートωｈと速さＵｈの測定値はノイズが多い。関連するノイズの多いヨーレートωｈと速さＵｈの測定値から
Figure 2010280378
 の見積もりを発生するために、第一のカルマンフィルター５２によって実行されるホスト状態フィルターが有益である。その後、曲率パラメータＣ０とＣ１の平滑化した見積もりを発生するために、第二のカルマンフィルター５４によって実行される曲率フィルターが用いられる。ホスト状態フィルターのためのホスト車両１２の力学は、以下に与えられる所定の運動学的等式（この場合は一定の速度）に従う：
Figure 2010280378
Figure 2010280378
 ここで、
Figure 2010280378
 であり、Ｔはサンプリング周期であり、上付の(・)ｈはこのフィルターがホストフィルターであることを示し、Ｕｈとωｈはホスト車両１２の速さとヨーレートの測定値である。第一のカルマンフィルター５２は、図４に示されるとおり、ホスト状態
Figure 2010280378
 とその誤差共分散
Figure 2010280378
 を見積もるために実行される。
第一のカルマンフィルター５２、すなわちホスト状態フィルターからのホスト状態の見積もりは、その後第二のカルマンフィルター５４、すなわち曲率係数フィルターにインプットされる統合的な測定値（synthetic measurement）を発生するために用いられる。ここで、関連するカルマンフィルター５２と５４は、後掲の付録にて全体を説明するカルマンフィルタリングプロセスに従って動作する。道路曲率パラメータＣ０とＣ１とホスト状態変数
Figure 2010280378
 との関係は以下の通りである。
図７に示されるように、等式（４）から道路の半径Ｒは一般的に道路に沿った距離ｌの関数Ｒ（ｌ）として表される。等式（４）の両辺の時間微分をとると、次の等式が得られる。
Figure 2010280378
 ここで、
Figure 2010280378
 すなわちホスト車両１２のヨーレートであり、
Figure 2010280378
 すなわちホスト車両１２の速さであることに注目すべきである。そして、クロソイドモデルの等式（２）を等式（１２）に代入すると、以下の式が得られる。
Figure 2010280378
 または、
Figure 2010280378
 クロソイドパラメータＣ０は、ｌ＝０の地点における曲率の値Ｃまたは
Figure 2010280378
 として与えられる。
等式（１４）の両辺の微分をとると、
Figure 2010280378
 となる。
等式（２）からＣ１の定義を用いると、Ｃ１はホスト状態に関して以下のように表される。
Figure 2010280378
曲率の見積もり
Figure 2010280378
 を発生する、第二のカルマンフィルター５４、すなわち曲率フィルターのシステム方程式（system equation）は、
Figure 2010280378
Figure 2010280378
 によって与えられる。ここで、
Figure 2010280378
 であり、Δｔは第二のカルマンフィルター５４の更新周期であり、測定値ベクトル
Figure 2010280378
 の要素の値は曲率フィルターの状態変数に対応する値−−すなわちクロソイドパラメータＣ０とＣ１−−によって与えられる。
測定値
Figure 2010280378
 は見積もられた状態
Figure 2010280378
 から以下のように変換される。
Figure 2010280378
 そして、測定値の関連する共分散は、
Figure 2010280378
 で与えられる。ここで、
Figure 2010280378
 である。
道路３４の曲率パラメータを見積もる他のシステムおよび方法が、上述の道路曲率見積もりサブシステム４２と置換されても良いということが理解されるべきである。例えば、道路曲率パラメータは、関連するセンサーから得られる速さＵｈとヨーレートωｈの測定値を基にした上述のシステムの代わりに、またはこれと協働で、道路３４の画像から視覚システムによって見積もっても良い。さらに、ヨーレートは様々な方法によりまたは様々な手段を用いて測定または決定することができることが理解されるべきである。これに限定されるものではないが、例えば、ヨージャイロセンサー（yaw gyro sensor）、ステアリング角センサー、微分式車輪速度センサー（differential wheel speed sensor）、またはＧＰＳを基にしたセンサーやこれらの組み合わせ、またはこれらの測定値の関数（例えば、特に、ステアリング角比率）を用いることができる。
再び図５を参照すると、ステップ５０８において、目標のレンジｒ、レンジレート
Figure 2010280378
 およびアジマス角ηがレーダープロセッサー２２から読み込まれ、それはその後拡張されたカルマンフィルター５６、すなわちメインフィルターの入力として利用される。メインフィルターは、ステップ５１０で非束縛目標状態、すなわち目標の運動学的な状態の変数を見積もるものであり、その見積もり値はホスト車両１２と共に動くローカル座標系（すなわちホストに固定された座標）における相対的な値である。束縛目標状態の見積もりを発生するために後述する関連する束縛での等式の中で使う場合に、道路に束縛される等式が由来し関連する曲率パラメータが一定であると仮定される絶対座標系と一致するように、ステップ５１２で非束縛目標状態、すなわち目標の速度および加速度は図３に示されるようにその瞬間のホスト車両１２に固定された絶対座標系の絶対座標に変換される。絶対座標系はその瞬間の空間における移動座標系を重ね、そのため、ステップ５１２での変換は、ｘ方向、ｙ方向の両方で、ホスト車両１２の速度および加速度を応答する目標の見積もりに加算することで実現される。
ステップ５１２での拡張されたカルマンフィルター５６の出力の座標変換の結果は、ホスト車両１２に対する目標車両３６の相対的なｘとｙのそれぞれの位置に対応して、以下のような部分に分配される。ここで上付の１は目標車両３６の非束縛目標状態であることをしめす。
Figure 2010280378
再び図５を参照すると、ステップ５０６と５１２に続く、後文でより全体を説明するステップ５１４から５２４では、目標車両３６が有力な束縛に従って運動していると考えられるかどうかを決定するために、目標車両３６の有力な軌道の様々な束縛が適用されテストされる。例えば、束縛条件はホストレーン３８および有力な隣接レーン４０を含むレーンの組を形成すると仮定され、また、有力な束縛条件に従って運動すると考えられる目標車両３６はホストレーン３８または有力な隣接レーン４０の内の一つのいずれかの上を運動していると考えられるであろう。ステップ５２４では、目標車両３６はホストレーン３８または有力な隣接レーン４０の内の一つのいずれかの上を運動しているという仮説はそれぞれの有力なレーンについてテストされる。もし、有力なレーンの一つについてその仮説が満足しないのであれば、ステップ５２６で目標の状態は非束縛目標状態であると仮定され、それは次の予測的衝突検出解析およびそれに応答する制御に用いられる。そうでなければ、ステップ５２４から、ステップ５２８で目標の状態は目標状態統合サブシステム５０によって、非束縛目標状態とステップ５２４で最も適当であると特定された関連する束縛の状態との統合として計算される。
目標が束縛条件に束縛されていると考えられるかどうかを決定し、もしそうなら何が最も適当な束縛条件かを決定するステップ５１４から５２４のプロセスについて議論する前に、非束縛目標状態と束縛状態との統合のプロセスを、目標車両３６がホスト車両１２と同じレーンを動いている場合においてまず説明する。束縛条件はｙ方向のみアクティブであると仮定され、ホスト車両１２はレーン３８のセンターライン４１に沿ってレーン内をふらつくことなく安定走行し、かつ平行レーン３８、４０の曲率は等しいとの仮定と一致し、また絶対座標系はその瞬間のホスト車両１２に固定されていることから与えられる。ステップ５１４で、目標車両３６がホスト車両１２と同じレーン３８を走行していると仮定し、見積もられた係数と共に道路の束縛の等式を用いるので、束縛の状態の変数は横方向の運動学的変数に関して以下のように与えられる。
Figure 2010280378
 および
Figure 2010280378
 ここで、
Figure 2010280378
 であり、また、
Figure 2010280378
 である。
ステップ５２８で、一つはメインフィルターからで他方は道路の束縛条件からの二つのｙ座標の見積もりは以下の通り統合される。
Figure 2010280378
Figure 2010280378
 最終的に作られた目標の状態の見積もりは、
Figure 2010280378
 および
Figure 2010280378
 であり、ここで、
Figure 2010280378
 である。
もしステップ５１４から５２４において目標車両３６がホストレーン３８を走行していると決定されたならば、ステップ５３０でこの作られた見積もりが目標の状態の見積もりとして出力される。
目標が束縛に束縛されていると考えられるかどうかを決定し、もしそうなら何が最も適当な束縛条件かを決定するステップ５１４から５２４のプロセスに戻る。目標は同じ道路３４に従っているという仮定に従うと、もし目標車両３６が特定のレーン内を走行していると分かったならば、そのレーンの見積もられた道路のパラメータを目標の運動を見積もるメインフィルター内の束縛条件として使うことが望まれるであろう。しかしながら、現在目標車両３６が走行しているレーンの知識は、一般的に得ることができず、特に目標が曲がった道路３４を走行しているときは得られない。道路の等式（８）はホストを中心とした座標内のホストレーン３８についてのみの式であるから、束縛のフィルタリングは目標がどちらのレーンにいるかが分かっていることを必要とするであろうし、また異なったレーンには異なった束縛の等式が必要であろう。これらの平行レーン間の曲率を無視する、すなわちそれぞれのレーンの曲率が等しいと仮定すると、任意のレーンについての道路の等式は
Figure 2010280378
 と書ける。ここで、Ｂはレーンの幅であり、ｍは記述すべきレーンを表す（ｍ＝０はホストレーン３８に対応し、ｍ＝１は右の隣接レーン４０に対応し、ｍ＝−１は左の隣接レーン４０に対応し、以下は同様である。）。目標のレーン位置についての事前知識なしに、複数束縛系（multiple constraint system）（いわゆる複数モデル系（multiple model system）と似ている）を構成する複数の束縛は、もしあれば、どの束縛がアクティブであるかを決定するためにテストされる。複数束縛（ＭＣ：multipul constraint）系は、一つの有限の数ＮＣに従う。いずれの与えられた時間においても一つの束縛のみが有効である。このようなシステムはハイブリッドと呼ばれ、不連続な数の束縛と同様に連続的（ノイズ）な状態変数を持つ。
以下の定義およびモデリング仮定はこの問題の解決を促進する。
束縛の等式：
Figure 2010280378
 ここで、
Figure 2010280378
 はｔｋで終了するサンプリング周期の間有効な、時間ｔｋにおける束縛条件を意味する。
可能なＮＣの束縛条件の間の束縛条件：
Figure 2010280378
Figure 2010280378
 ：束縛条件
Figure 2010280378
 を用いた時間ｔｋにおける状態の見積もり
Figure 2010280378
 ：束縛条件
Figure 2010280378
 下での時間ｔｋにおける共分散行列
Figure 2010280378
 ：時間ｔｋ−１において目標が束縛条件ｊに従っている確率
束縛条件のジャンププロセス（constraint jump process）は既知の遷移確率を用いたマルコフチェーンである：
Figure 2010280378
 一以上の有力な束縛の状態を有する系にマルコフモデルを導入するために、それぞれのスキャン時間に目標が束縛の状態ｉからｊへと遷移する確率が存在すると仮定する。これらの確率は事前に分かっており、以下に示す確率遷移行列として表すことができると仮定する。
Figure 2010280378
Figure 2010280378
 が正しい（
Figure 2010280378
 が有効）という事前の確率は
Figure 2010280378
 であり、ここで、Ｚ０は事前の情報であり、正しい束縛条件は仮定されたＮＣの束縛条件の中にあるので、
Figure 2010280378
 である。
束縛目標状態見積もりサブシステム４６は、目標の状態が有力な束縛の状態に対応するかどうかの決定を提供し、もしそうであれば、最も適切な束縛の状態の決定を提供する。
これを決定する方法の一つは、バーシャローム（Bar-Shalom）によって提案された複数モデルフィルタリングアルゴリズム（multiple model filtering algorithm）であり、ここではＮＣの並列フィルターが同時に実行される。
他の方法では、複数束縛（ＭＣ）見積もりアルゴリズムは、それぞれの束縛の状態に関する尤度関数および確率の計算に伴う尺度として非束縛の状態の見積もり
Figure 2010280378
 を用いることで、ＮＣの束縛された状態の見積もりを調和させ、更新する。複数束縛（ＭＣ）見積もりアルゴリズムの一つの実施態様では、束縛の状態の見積もりの出力は全ての束縛された状態の見積もりの組み合わせからなる。もしこの束縛された状態が有効であれば、すなわちもし束縛の状態の見積もりが非束縛の状態の見積もりに応答していれば、目標状態は束縛の状態と非束縛の状態の見積もりの統合から得られる。そうでなければ、目標状態は非束縛の状態の見積もりから得られる。この複数束縛（ＭＣ）見積もりアルゴリズムの実施態様は以下のステップを含む。
１．複数束縛からの状態変数の見積もり
ステップ５１４では、等式（２４）の第一行を置き換えるために複数レーン道路の等式（３３）を用いるので、複数束縛の状態の見積もりは、
Figure 2010280378
 によって与えられ、ここで、
Figure 2010280378
 であり、Ｂはレーンの幅である。別に述べたように、束縛の状態の見積もりは、目標車両３６が位置することができるそれぞれの有力なレーンのセンターラインのｙ座標に応答する。
関連する共分散は
Figure 2010280378
 で与えられる。ここで、
Figure 2010280378
 は等式（２６）と（２７）によって与えられ、
Figure 2010280378
 は等式（２３）から、
Figure 2010280378
 は曲率フィルターから得られる。
２．束縛された状態の更新
ステップ５１６では、有効な束縛の状態にある状態の見積もりと共分散は、尤度関数と同様に、
Figure 2010280378
 のそれぞれの束縛の状態について更新される。束縛の状態ｊに対応する更新された状態の見積もりと共分散は尺度
Figure 2010280378
 を用いることで以下のように得られる。
Figure 2010280378
Figure 2010280378
Figure 2010280378
３．尤度計算
ステップ５１８では、束縛の状態ｊに対応する尤度関数は、尺度が
Figure 2010280378
 のそれぞれの束縛の状態における束縛された状態の見積もりの周囲にガウス分布すると仮定して、非束縛目標状態の見積もりの値
Figure 2010280378
 において以下のように評価される。
Figure 2010280378
 ここで、ガウス分布Ｎ（ ; , ）は平均値
Figure 2010280378
 と関連する共分散
Figure 2010280378
 を持つ。
４．束縛確率評価
ステップ５２０では、
Figure 2010280378
 のそれぞれの束縛の状態において、更新された束縛確率が以下のように計算される。
Figure 2010280378
 ここで、
Figure 2010280378
 は束縛ｊが有効である遷移の後の確率であり、
Figure 2010280378
 により与えられ、規格化定数は
Figure 2010280378
 である。
５．全体的な状態見積もりと共分散
ステップ５２２では、最新の束縛の状態の見積もりと共分散の組み合わせが、
Figure 2010280378
Figure 2010280378
Figure 2010280378
 によって与えられる。
上記のアルゴリズム内のステップ５２２からの見積もり器の出力は、等式（２８）と（２９）で表される統合プロセスの束縛された見積もりとして用いられ、等式（３２）の結果の代わりに等式（５１）の結果が等式（３１）に用いられる。
目標車両３６が道路３４に従っていないとき、またはレーンを変更しているときには、運動学的状態変数に道路の束縛を課すことは、関連した非束縛の見積もりを用いるよりも悪いであろう間違った見積もりに終わるであろう。しかしながら、ノイズに関連した見積もりの誤差は、正しい道路の束縛条件を無効であると思わせる原因となりうる。従って、
有効な場合、すなわち目標車両３６が特定のレーンにいる場合、に束縛を有効であるように保ち、無効である場合、すなわち、目標車両３６がレーンを離れている場合にそれを即座に引き上げる手段を導入することは有益である。独立した目標の状態の見積もりを提供するので、非束縛目標状態は道路の束縛変数にとって重要な役割を担う。
一つのやり方は、非束縛目標状態は道路の束縛の等式を満足するという仮説、または同様に束縛の状態の見積もりと非束縛の状態の見積もりはそれぞれ同じ目標に対応しているという仮説を検証することである。最善の検証はこれまでの時間ｔｋにおける全ての入手可能な目標状態の見積もりを使用することを要求するであろうし、これは一般的に実用的ではない。実用的なやり方は、最も新しい状態の見積もりのみに基づいて実行される逐次仮説検証である。上文で使用した表記法に従って、束縛と非束縛の目標状態の見積もり（ｙ方向のみ）は、
Figure 2010280378
 で示され、これは、
Figure 2010280378
 の見積もりとしてのものである。ここで、
Figure 2010280378
 は実際の目標状態で、
Figure 2010280378
 は道路３４（またはレーン）に沿って動く目標の実際の状態である。ステップ５２４では、「同じ目標」仮説が検証される。すなわち、
Figure 2010280378
 対
Figure 2010280378
 である。
メインフィルター誤差
Figure 2010280378
 は束縛から生じる誤差
Figure 2010280378
 から独立であると仮定される。差
Figure 2010280378
 の共分散は仮定Ｈ０の下、
Figure 2010280378
 で与えられる。
見積もりの誤差がガウシアンであると仮定すると、Ｈ０対Ｈ１の検証は、以下のようになる。
Figure 2010280378
 閾値は、
Figure 2010280378
 のように選ばれ、ここで、αは所定の許容誤差値である。
ここで、上述のガウシアン誤差仮説に基づくと、
Figure 2010280378
 は自由度ｎｙのカイ二乗分布をもつことに留意すべきである。この閾値の選択は重要な設計要素であり、特定の用途における必要性に基づくべきである。道路での車両衝突予測では、ホストレーン３８内の目標は衝突するコースにいるとみなされ、隣接レーン４０の一つにいる目標よりも危険であると判断される。それ故、束縛フィルタリングは、「レーン変更」操作中にそのような目標はホスト車両に衝突する恐れを生じさせないという正確な目標の状態の見積もりを提供できるので、ホストレーン３８内にいる目標に対して高い閾値（低い許容誤差値）が望ましい。一方で、隣接レーン４０にいる目標は通常は通り過ぎる車両であると考えられる。束縛フィルタリングは誤った警報の割合を下げるであろうが、目標の「レーン変更」操作（ホストレーン３８に入ってくる）は実際にホスト車両１２に衝突する危険を生じさせうる。それ故、もし誤った警報の割合が十分に低いのであれば、隣接レーン内の目標に対しては低い閾値（高い許容誤差値）が望ましい。
上述の解析に基づくと、仮説の検証スキームは、現在目標がどちらのレーン内にいるのが最も有力かについての知識を提供する複数束縛フィルタリングアルゴリズムとともに、効率的には異なったレーンの目標に対しては異なった閾値を用いる。道路３４にはＮＣの有力なレーンがありそれぞれのレーンは束縛の等式で記述されると仮定するので、最も高い確率
Figure 2010280378
 を用いた目標についての束縛の等式は、時間ｔｋ（現在の時間）において目標がいるとして最も有力なレーンに対応する。この最も有力なレーンをｌｔと表すと、
Figure 2010280378
 となる。
非束縛の状態の見積もりとレーンｌｔの束縛の状態の見積もり（ｙ方向のみ）の間の差は、
Figure 2010280378
 で示され、これは、
Figure 2010280378
 の見積もりである。ここで、
Figure 2010280378
 は実際の目標状態で、
Figure 2010280378
 はレーンｌｔに沿って動く目標の実際の状態である。「同じ目標」仮説の検証は、
Figure 2010280378
 対
Figure 2010280378
 で与えられる。
束縛の状態の見積もりの誤差は、
Figure 2010280378
 で与えられる。
見積もりの誤差は独立でありガウシアンであると仮定するので、Ｈ０対Ｈ１の検証は、以下のようになる。
Figure 2010280378
 ここで、
Figure 2010280378
 であり、閾値は
Figure 2010280378
 である。ここで、
Figure 2010280378
 である。
束縛フィルタリングによって見積もりの正確さは大幅に改善しているが、このようなレーンに適応した仮説の検証スキームは、目標車両３６が現在のレーンを離れた場合に目標状態の見積もりの出力のプロンプトスイッチを非束縛の状態に提供する。
複数束縛（ＭＣ）見積もりアルゴリズムのための他の態様では、仮説の検証に用いられる束縛の状態の見積もりは、全ての束縛された目標状態の見積もりからなる組み合わせではなく、最も有力な個々の目標状態の見積もり（すなわち「勝者総獲得」戦略）である。もしこの最も有力な束縛の状態の見積もりが有効であれば、すなわちその最も有力な束縛の状態の見積もりが非束縛の状態の見積もりに対応していれば、目標の状態は最も有力な束縛の状態の見積もりと非束縛の状態の見積もりとの統合から得られ、そうでなければ目標の状態は非束縛の状態の見積もりから得られる。
複数束縛（ＭＣ）見積もりアルゴリズムのためのさらにその他の態様では、仮説の検証はそれぞれの束縛の状態の見積もりに対して行われる。もし満足する仮説がなかったら、目標の状態は非束縛の状態の見積もりから得られる。もしただ一つの仮説が満足するのであれば、目標の状態は対応する束縛の状態の見積もりと非束縛の状態の見積もりとの統合から得られる。もし複数の仮説が満足するのであれば、複数の試みからの投票結果または異なった閾値での再度の仮説検証により、最も有力な束縛の状態が特定される。
一般的に、ホスト車両１２の環境の変化に対応するように、関連するパラメータと共に束縛条件の数（すなわち道路のレーンの数）は時間に応じて変化しうる。例えば、１レーンの道路、反対車線がある２レーンの道路、中央に右左折レーンがある３レーンの道路、反対車線が２レーンある４レーンの道路、または複数のレーンが分離されている高速道路を、ホスト車両１２は一回のドライブで走ることができる。
束縛および非束縛フィルタリングを用いた道路車両追跡シミュレーションが４つのシナリオについて実行された。全てのシナリオにおいて、ホスト車両１２は１５．５ｍ／ｓで走行しており、目標車両３６は同じ道路３４上を１５．５ｍ／ｓで接近している。目標の最初の位置はホストからｘ方向に１２５メートル離れており、全てのレーンの幅を３．６メートルと仮定した。車両スピードセンサーの測定の分散は０．０２ｍ／ｓであり、ジャイロスコープヨーレート測定の分散は０．００６３ｒａｄ／ｓであった。レーダーレンジ、レンジレート、およびアジマス角の測定の分散はそれぞれ、０．５ｍ、１ｍ／ｓ、１．５度であった。シミュレーションの結果は、関連する追跡フィルターの１００回のモンテカルロの実行によって生成された。
第一のシナリオでは、ホスト車両１２と目標車両３６は直線道路３４（Ｃ０＝０かつＣ１＝０）を走行しており、目標車両３６は同じレーンをホスト車両１２に向かって走行している。図８ａ〜ｄは、非束縛および束縛のフィルタリングスキームにおける、目標の状態の見積もりと道路曲率の見積もりの結果を示し、図９ａ〜ｂは、非束縛および束縛のフィルタリングスキームにおける、目標車両３６の横方向の位置、速度、および加速度のＲＭＳ誤差の平均を示している。束縛フィルタリングからの見積もりの誤差は実質的に減少している。目標車両３６がホスト車両１２から６５メートル以上離れている４８回目のレーダースキャンの前、束縛フィルタリングは、目標の横方向速度の見積もりでは誤差が４０パーセント以上減少し、横方向加速度の見積もりでは誤差が６０パーセント以上減少する結果を得た。目標車両３６がホスト車両１２から６５メートル以内にいるときには、より適切な状況であり、束縛フィルタリングによって、横方向位置の見積もりでは誤差が５０パーセント以上、横方向速度の見積もりおよび加速度の見積もりでは誤差が９０パーセント以上減少した。
第二のシナリオでは、ホスト車両１２と目標車両３６は曲がった道路３４（Ｃ０＝−１０−５かつＣ１＝−３×１０−５）を走行しており、目標車両３６は同じレーンをホスト車両１２に向かって走行している。図１０ａ〜ｄは非束縛および束縛のフィルタリングスキームにおける、目標の状態の見積もりと道路曲率の見積もりの結果を示し、図１１ａ〜ｂは、非束縛および束縛のフィルタリングスキームにおける、目標車両３６の横方向位置、速度、および加速度のＲＭＳ誤差の平均を示している。束縛フィルタリングからの見積もりの誤差は、目標車両３６がホスト車両１２から６５メートル以内にいるときである４８回目のレーダースキャン以降、実質的に減少している。目標車両３６がホスト車両１２からおよそ１００メートル離れているときである２０回目のレーダースキャン以前は、束縛フィルタリングと非束縛フィルタリングの見積もりの誤差は同じである。目標車両３６がホスト車両１２から６５メートル〜１００メートルの間に位置している間では束縛フィルタリングは、横方向速度および加速度の見積もりで誤差がおよそ３０パーセント減少する結果となり、目標車両３６がホスト車両１２から６５メートル以内の時には束縛フィルタリングによって、横方向位置の見積もりでは誤差が５０パーセント以上、横方向速度の見積もりおよび加速度の見積もりでは誤差が９０パーセント以上減少した。目標車両３６が遠くにあるときの束縛フィルタリングの改善の欠如は、束縛の誤差がホスト車両１２と目標車両３６の間の距離に比例する原因である道路曲率パラメータの見積もり誤差に起因する。これは、曲率の見積もり誤差は大きくなりそれがレーン位置の曖昧さを大きくする原因となる曲がった道路３４の場合により明らかである。
第三のシナリオでは、ホスト車両１２と目標車両３６は直線道路３４（Ｃ０＝０かつＣ１＝０）を走行しており、目標車両３６は最初左の隣接レーン内にいて接近しきている。ｔ＝２．２秒（５５回目のレーダースキャン）のとき、目標車両３６はそのレーンをそれてホストレーン３８の方へと向きを変え、ｔ＝４秒（１００回目のレーダースキャン）のとき衝突する結果となる。図１２ａ〜ｄは、非束縛および束縛フィルタリングスキームにおける、目標状態の見積もりの結果と横方向位置および速度のＲＭＳ誤差を示している。束縛妥当性仮説検証（等式（６９））における誤差許容レベルは、ホストレーン３８については
Figure 2010280378
 、全ての隣接レーン４０についてはα＝０．５と選んだ。検証なしの束縛フィルタリングは目標車両３６が向きを変えるまでは実質的に低い見積もり誤差を生じるが、目標車両３６がそのレーン（左の隣接レーン）から向きを変え始めた後は、関連する目標の状態の見積もりは正しくなく、ＲＭＳ誤差も非束縛フィルタリングのそれよりもはるかに大きい。これは、目標車両３６がそのレーンをそれ始めた後は無効になる道路の束縛条件は、即座に引き上げられないということを暗示している。一方で、検証を用いる束縛フィルタリングは、目標車両３６が向きを変えるまではやや小さい見積もり誤差を生じ、目標車両３６が向きを変えた後は目標の状態の見積もりおよびＲＭＳ誤差で非束縛フィルタリングと同じであることを示しており、束縛フィルタリングの性能は非束縛フィルタリングのそれに迫っている。これは、目標車両３６がそのレーンをそれ始めると即座に道路の束縛条件が引き上げられるということを暗示している。
第四のシナリオは第三のシナリオに似ており、唯一の違いは、車両が直線道路ではなく曲がった道路３４
Figure 2010280378
 にいるということである。目標車両３６はｔ＝２．２秒のときそれはじめて、ｔ＝４秒のとき衝突する結果となる。図１３ａ〜ｄは、非束縛および束縛フィルタリングスキームにおける、目標状態の見積もりの結果と横方向位置および速度のＲＭＳ誤差を示している。誤差許容レベルは第三のシナリオと同じで、結果および観測結果も第三のシナリオのそれと類似していた。提案された束縛の検証によって、目標車両３６がそのレーンをそれ始めた後即座に、道路の束縛条件は引き上げられた。一般的に、目標車両３６の横方向の運動の見積もりの正確さにおける束縛フィルタリングによる全体的な改善は、実質的に、目標車両３６の横方向の運動の見積もりの正確さはしばしばレーダーの角度分解能の低さによって制限されるという事実によって与えられる。
従って、直線および曲線の道路３４における道路車両追跡のシミュレーション結果は、予測的衝突検出システム１０は、目標車両３６がホストレーン３８にいるときに、目標車両３６の横方向の運動の見積もりの誤差を実質的に減らすことができることを示している。目標車両３６が隣接レーンからホストレーン３８へ入る操作をするとき、予測的衝突検出システム１０は即座にこの操作を検出し、誤った束縛の状態の結果を避けるために道路の束縛を引き上げる。レーダーの角度分解能の低さが横方向の運動の見積もりを悪くするという事実を考慮して、予測的衝突検出システム１０は、目標車両３６の横方向の運動の見積もりの正確さに実質的な改善を提供し、これは早くかつ信頼の置ける道路車両衝突予測に有益である。
特定の実施態様が上述の詳細な説明で詳細に説明され、貼付の図面に図示されたが、当業者は、本明細書による教示の全体に照らしてその細部について多種の改変および代替を加えうることを認識するであろう。したがって、本明細書に開示される特定の構成は説明することのみを目的とし、本発明の範囲について限定を加えるものではなく、本発明の範囲は、貼付の請求の範囲の全範囲およびその均等物に対して与えられる。
付録：カルマンフィルタリングの説明
ノイズの多い測定の組から、ノイズを前提として、状態と関連する動的システムの測定値を見積もるためにカルマンフィルターが用いられる。
システム力学は
Figure 2010280378
 と定義される。ここで、
Figure 2010280378
 は系の状態ベクトルであり、Ｆｋは系の行列であり、
Figure 2010280378
 はそれぞれの状態変数に対応するノイズ変数であり、それぞれのノイズ変数は平均値０と関連する分散ベクトルＱｋの対応する要素によって与えられる分散を有する。
関連する系の測定の力学は
Figure 2010280378
 によって与えられる。ここで、
Figure 2010280378
 は系の測定のベクトルであり、Ｈｋは系の測定の行列であり、
Figure 2010280378
 はそれぞれの測定変数に対応するノイズ変数であり、それぞれのノイズ変数は平均値０と関連する分散ベクトルＲｋの対応する要素によって与えられる分散を有する。関連する分散ベクトルＲｋの要素の値は、関連する典型的な動作環境の組における関連する系の典型的な測定の解析から事前に決めることができる。関連する分散ベクトルＱｋの要素の値は、モデリング誤差からなる。一般的に、関連する行列
Figure 2010280378
 は時間と共に変化できる。
時間ｋにおける測定値
Figure 2010280378
 および時間ｋ−１における状態の値
Figure 2010280378
 と
Figure 2010280378
 を与えられて、カルマンフィルターは、時間ｋにおける関連する状態
Figure 2010280378
 と関連する共分散
Figure 2010280378
 を見積もるために用いられる。
フィルタリングプロセスの最初のステップは、時間ｋ−１の見積もりに基づいて、時間ｋにおける状態
Figure 2010280378
 および関連する共分散
Figure 2010280378
 を以下のように見積もる。
Figure 2010280378
Figure 2010280378
次のステップは、時間ｋにおける尺度
Figure 2010280378
 および関連する共分散行列Ｓｋを以下のように予測する。
Figure 2010280378
Figure 2010280378
次のステップは、状態ベクトル
Figure 2010280378
 および関連する共分散行列
Figure 2010280378
 を更新するために用いるゲイン行列Ｇｋを、以下のように計算する。
Figure 2010280378
最後に、時間ｋにおける状態ベクトル
Figure 2010280378
 および関連する共分散行列
Figure 2010280378
 が、関連する尺度
Figure 2010280378
 に応答して以下のように見積もられる。
Figure 2010280378
Figure 2010280378
予測的衝突検出システムに関するハードウェアのブロック図である。 予測的衝突検出システムで使用されるレーダービームの捕捉範囲のパターンである。 予測的衝突検出システムの動作を説明するための運転シナリオである。 予測的衝突検出システムのハードウェアおよび関連する信号処理アルゴリズムのブロック図である。
予測的衝突検出システムの関連する信号処理アルゴリズムのフローチャートである。 道路曲率パラメータを決定するために使用する幾何学である。 円弧の幾何学である。
直線道路における目標の位置、横向きの速度、および道路曲率パラメータの見積もりの例である。 直線道路における目標の位置、横向きの速度、および道路曲率パラメータの見積もりの例である。 直線道路における目標の位置、横向きの速度、および道路曲率パラメータの見積もりの例である。 直線道路における目標の位置、横向きの速度、および道路曲率パラメータの見積もりの例である。
図８ａ〜ｄに対応する、直線道路における非束縛フィルタリングおよび束縛フィルタリングからのＲＭＳ誤差である。 図８ａ〜ｄに対応する、直線道路における非束縛フィルタリングおよび束縛フィルタリングからのＲＭＳ誤差である。
曲がった道路における目標の位置、横向きの速度、および道路曲率パラメータの見積もりの例である。 曲がった道路における目標の位置、横向きの速度、および道路曲率パラメータの見積もりの例である。 曲がった道路における目標の位置、横向きの速度、および道路曲率パラメータの見積もりの例である。 曲がった道路における目標の位置、横向きの速度、および道路曲率パラメータの見積もりの例である。
図１０ａ〜ｄに対応する、曲がった道路における非束縛フィルタリングおよび束縛フィルタリングからのＲＭＳ誤差である。 図１０ａ〜ｄに対応する、曲がった道路における非束縛フィルタリングおよび束縛フィルタリングからのＲＭＳ誤差である。
レーン変更を含む場合の、直線道路における目標の位置、横向きの速度、道路曲率パラメータおよび関連するＲＭＳ誤差の見積もりの例である。 レーン変更を含む場合の、直線道路における目標の位置、横向きの速度、道路曲率パラメータおよび関連するＲＭＳ誤差の見積もりの例である。 レーン変更を含む場合の、直線道路における目標の位置、横向きの速度、道路曲率パラメータおよび関連するＲＭＳ誤差の見積もりの例である。 レーン変更を含む場合の、直線道路における目標の位置、横向きの速度、道路曲率パラメータおよび関連するＲＭＳ誤差の見積もりの例である。
レーン変更を含む場合の、曲がった道路における目標の位置、横向きの速度、道路曲率パラメータおよびそのＲＭＳ誤差の見積もりの例である。 レーン変更を含む場合の、曲がった道路における目標の位置、横向きの速度、道路曲率パラメータおよびそのＲＭＳ誤差の見積もりの例である。 レーン変更を含む場合の、曲がった道路における目標の位置、横向きの速度、道路曲率パラメータおよびそのＲＭＳ誤差の見積もりの例である。 レーン変更を含む場合の、曲がった道路における目標の位置、横向きの速度、道路曲率パラメータおよびそのＲＭＳ誤差の見積もりの例である。

Claims (37)

  1. 道路曲率を見積もる方法であって：
    ａ．道路を走行中のホスト車両の縦方向速さを測定することにより速さの測定値を発生すること；
    ｂ．前記ホスト車両のヨーレートを測定または決定することによりヨーレートの測定値を発生すること；および
    ｃ．少なくとも一つの曲率パラメータを見積もること、
    を含み、
    ここで、前記少なくとも一つの曲率バラメータは道路曲率を表現し、前記少なくとも一つの曲率パラメータの見積もりの操作は前記速さの測定値および前記ヨーレートの測定値に応答する、前記方法。
  2. 少なくとも一つの曲率パラメータは少なくとも一つの曲率のクロソイドモデルのパラメータを含み、前記曲率のクロソイドモデルは前記ホスト車両の座標系に関する、請求項１に記載の道路曲率を見積もる方法。
  3. 少なくとも一つの曲率パラメータは第一及び第二のクロソイドモデルのパラメータを含み、ここで、前記第一のパラメータは定数であって、前記第二のパラメータは道路に沿った距離に対する曲率の感度である、請求項２に記載の道路曲率を見積もる方法。
  4. 少なくとも一つの曲率パラメータの見積もりの操作は速さと角速度の測定値を少なくとも一つのカルマンフィルターで処理することを含む、請求項１に記載の道路曲率を見積もる方法。
  5. 少なくとも一つのカルマンフィルターは第一及び第二のカルマンフィルターを含み、前記第一のカルマンフィルターは速さの測定値及びヨーレートの測定値から状態変数の第一の組を見積もるように適合し、前記第二のカルマンフィルターは前記状態変数の前記第一の組の見積もりから少なくとも一つの曲率パラメータを見積もるように適合する、請求項１に記載の道路曲率を見積もる方法。
  6. 状態変数の第一の組は、車両速度、車両加速度、車両ヨーレートおよび車両ヨー加速度を含む、請求項５に記載の道路曲率を見積もる方法。
  7. 道路上の目標車両の状態を見積もる方法であって：
    ａ．道路曲率の見積もりを発生すること；
    ｂ．目標車両の非束縛の状態とその関連する共分散を見積もること；
    ｃ．前記道路曲率の見積もりに応答する、少なくとも一つの将来の目標車両の束縛を構築すること；
    ｄ．少なくとも一つの将来の目標車両の束縛に対応する、目標車両の少なくとも一つの束縛の状態及びその関連する共分散を見積もること；
    ｅ．目標車両の非束縛の状態および少なくとも一つの目標車両の束縛の状態から選ばれる、最も有力な目標車両の状態を決定すること；および
    ｆ．もし前記少なくとも一つの目標車両の束縛の状態が最も有力な状態であれば、非束縛の目標車両の状態およびその共分散を、関連する前記最も有力な状態の束縛の状態およびその共分散と統合し、目標車両の統合された状態およびその関連する統合された共分散の少なくとも一つを目標の見積もられた状態または共分散として出力し；そうでなければ、目標の非束縛の状態またはその関連する非束縛の共分散の少なくとも一つを、目標の見積もられた状態または共分散として出力すること
    を含む、前記方法。
  8. 道路曲率を見積もる操作が；
    ａ．道路を走行中のホスト車両の縦方向速さを測定することにより速さの測定値を発生すること；
    ｂ．ホスト車両のヨーレートを測定または決定することによりヨーレートの測定値を発生すること；および
    ｃ．少なくとも一つの曲率パラメータを見積もること、
    を含み、
    ここで、少なくとも一つの曲率パラメータは道路曲率を表現し、前記少なくとも一つの曲率パラメータの見積もりの操作は前記速さの測定値および前記ヨーレートの測定値に応答する、請求項７に記載の道路上の目標車両の状態を見積もる方法。
  9. 少なくとも一つの曲率パラメータは少なくとも一つの曲率のクロソイドモデルのパラメータを含み、前記曲率のクロソイドモデルは前記ホスト車両の座標系に関する、請求項８に記載の道路上の目標車両の状態を見積もる方法。
  10. 少なくとも一つの曲率パラメータは第一及び第二のクロソイドモデルのパラメータを含み、ここで、前記第一のパラメータは定数であって、前記第二のパラメータは道路に沿った距離に対する曲率の感度である、請求項９に記載の道路上の目標車両の状態を見積もる方法。
  11. 少なくとも一つの曲率パラメータ見積もりの操作は速さと角速度の測定値を少なくとも一つのカルマンフィルターで処理することを含む、請求項８に記載の道路上の目標車両の状態を見積もる方法。
  12. 少なくとも一つのカルマンフィルターは第一及び第二のカルマンフィルターを含み、前記第一のカルマンフィルターは速さの測定値及びヨーレートの測定値から状態変数の第一の組を見積もるように適合し、前記第二のカルマンフィルターは前記状態変数の前記第一の組の見積もりから少なくとも一つの曲率パラメータを見積もるように適合する、請求項１１に記載の道路上の目標車両の状態を見積もる方法。
  13. 状態変数の第一の組は、車両速度、車両加速度、車両ヨーレートおよび車両ヨー加速度を含む、請求項１２に記載の道路上の目標車両の状態を見積もる方法。
  14. 目標車両の非束縛の状態および関連する共分散を見積もる操作が；
    ａ．ホスト車両対して相対的なレンジ、レンジレート、アジマス角を測定すること；および
    ｂ．ホスト車両に対して相対的なレンジ、レンジレート、アジマス角の前記測定値から目標車両の前記非束縛の状態を見積もること
    を含む、請求項７に記載の道路上の目標車両の状態を見積もる方法。
  15. 目標車両の前記非束縛の状態を、道路曲率の見積もりに対応する座標系に変換する操作をさらに含む、請求項７に記載の道路上の目標車両の状態を見積もる方法。
  16. 少なくとも一つの将来の目標車両の束縛は目標車両の横方向位置に適用され、目標車両の縦方向位置は非束縛である、請求項７に記載の道路上の目標車両の状態を見積もる方法。
  17. 少なくとも一つの将来の目標車両の束縛は、複数の将来の束縛を含み、道路の異なったレーンに対応する少なくとも二つの異なった将来の束縛を含む、請求項７に記載の道路上の目標車両の状態を見積もる方法。
  18. 最も有力な目標車両の状態を決定する操作は；
    ａ．アクティブな少なくとも一つの将来の目標車両の束縛に対応し、目標車両の非束縛の状態に対応する値において評価される対応する少なくとも一つの分布関数に応答する、少なくとも一つの有力な値を決定すること；
    ｂ．前記少なくとも一つの有力な値に応答する、目標車両の第一の束縛の状態の確率を決定すること；
    ｃ．少なくとも一つの、目標車両の前記非束縛の状態は前記第一の束縛の状態に対応するという仮説を検証すること；および
    ｄ．前記少なくとも一つの仮説の検証の操作に応答して最も有力な目標車両の状態を識別すること
    を含む、請求項７に記載の道路上の目標車両の状態を見積もる方法。
  19. 最も有力な目標車両の状態を決定する操作は、目標車両が第一の状態から第二の状態に遷移する少なくとも一つの事前の確率を構築することを含み、
    ここで、前記第一の状態と第二の状態は同じ状態であっても異なった状態であっても良く、前記目標車両の第一の束縛の状態の確率は、前記少なくとも一つの事前の確率に応答する、
    請求項１８に記載の道路上の目標車両の状態を見積もる方法。
  20. 少なくとも一つの分布関数は目標車両の特定の束縛の状態の共分散に応答する、請求項１８に記載の道路上の目標車両の状態を見積もる方法。
  21. 少なくとも一つの束縛の状態は、複数の束縛の状態を含み、第一の束縛の状態は前記複数の束縛の状態の組み合わせである、請求項１８に記載の道路上の目標車両の状態を見積もる方法。
  22. 第一の束縛の状態は、目標車両の少なくとも一つの束縛の状態の最も有力な状態を含む、請求項１８に記載の道路上の目標車両の状態を見積もる方法。
  23. 第一の束縛の状態は、目標車両の少なくとも一つの束縛の状態の一つを含む、請求項１８に記載の道路上の目標車両の状態を見積もる方法。
  24. 少なくとも一つの仮説の検証の操作は目標車両の状態の最新の見積もりに応答する、請求項１８に記載の道路上の目標車両の状態を見積もる方法。
  25. 少なくとも一つの仮説の検証の操作は、
    目標車両の最も有力な少なくとも一つの束縛の状態に対応する目標車両の特定の束縛の状態を識別すること、
    非束縛の状態と前記特定の束縛の状態の差に応答する関数の値を計算すること、および
    前記関数の値と閾値とを比較すること、
    を含み、
    前記仮説は、前記関数の値が前記閾値よりも低い場合に満足する、請求項１８に記載の道路上の目標車両の状態を見積もる方法。
  26. 閾値は、目標車両の特定の束縛の状態に関連する特定の束縛に応答する、請求項２５に記載の道路上の目標車両の状態を見積もる方法。
  27. 閾値は、目標車両によるホスト車両に対する危険が増加することに対応する特定の束縛の状態に対して相対的に小さくなる、請求項２６に記載の道路上の目標車両の状態を見積もる方法。
  28. 目標車両によるホスト車両に対する危険が増加することに対応する特定の束縛の状態は、ホスト車両と同じレーンを走行している目標車両、およびホスト車両と同じレーンにレーン変更をする目標車両、から選択される、請求項２７に記載の道路上の目標車両の状態を見積もる方法。
  29. 道路曲率を見積もるシステムであって：
    ａ．道路上の車両の縦方向速さを測定するように適合したスピードセンサー；
    ｂ．前記車両のヨーレートを測定するように適合したヨーレートセンサー；および
    ｃ．前記スピードセンサーと前記ヨーレートセンサーに動作可能に連結したプロセッサー
    を含み、
    ここで、前記プロセッサーは、前記スピードセンサーおよび前記ヨーレートセンサーからの測定値に応答して道路曲率を見積もるように適合する、前記システム。
  30. プロセッサーは少なくとも一つのカルマンフィルターを含み、前記少なくとも一つのカルマンフィルターは、縦方向速さ及びヨーレートの測定値に応答して少なくとも一つの曲率パラメータの見積もりを生成するように適合し、ここで、前記少なくとも一つの曲率パラメータは道路曲率を表現する、請求項２９に記載の道路曲率を見積もるシステム。
  31. 少なくとも一つのカルマンフィルターは、第一および第二のカルマンフィルターを含み、前記第一のカルマンフィルターは、縦方向速さ及びヨーレートの測定値に応答する、ヨーレート、ヨー加速度、縦方向速さおよび縦方向加速度の見積もりを含む出力を発生するように適合し；前記第二のカルマンフィルターは、前記第一のカルマンフィルターの出力に応答する、少なくとも一つの曲率パラメータの見積もりを発生するように適合する、請求項３０に記載の道路曲率を見積もるシステム。
  32. 道路上の目標車両の状態を見積もるシステムであって：
    ａ．ホスト車両が走行している道路曲率を見積もるための道路曲率見積もりサブシステム；
    ｂ．動作可能に前記ホスト車両に連結し、道路上の目標車両を追跡するように適合した目標状態見積もりサブシステム；および
    ｃ．前記道路曲率見積もりサブシステムおよび前記目標状態見積もりサブシステムに動作可能に連結するか、またはその一部である、少なくとも一つのプロセッサー
    を含み、
    ここで、前記プロセッサーは、前記道路曲率見積もりサブシステムによって見積もられた前記曲率および前記目標状態見積もりサブシステムからの目標の運動の測定値に対応して、目標車両が道路の特定のレーンを走行していると考えられるかどうかを決定するように適合する、前記システム。
  33. 道路曲率を見積もるための道路曲率見積もりサブシステムが：
    ａ．道路上のホスト車両の縦方向速さを測定するように適合したスピードセンサー；および
    ｂ．前記道路上のホスト車両のヨーレートを測定するように適合したヨーレートセンサー
    を含み、
    ここで、少なくとも一つのプロセッサーは前記スピードセンサーおよび前記ヨーレートセンサーに動作可能に連結し、前記プロセッサーは前記スピードセンサーおよび前記ヨーレートセンサーからの測定値に応答して道路曲率を見積もるように適合する、請求項３２に記載の道路上の目標車両の状態を見積もるシステム。
  34. 目標状態見積もりサブシステムはホスト車両に動作可能に連結したレーダーシステムを含む、請求項３２に記載の道路上の目標車両の状態を見積もるシステム。
  35. プロセッサーが、前記目標状態見積もりサブシステムのレンジ、レンジレートおよびアジマス角に応答する目標の運動の測定値を見積もるように適合した拡張されたカルマンフィルターを含む、請求項３２に記載の道路上の目標車両の状態を見積もるシステム。
  36. 目標の運動の測定値はホスト車両の座標に関する目標の位置の測定値を含む、請求項３５に記載の道路上の目標車両の状態を見積もるシステム。
  37. 目標の運動の測定値は、ホスト車両の座標に関する目標の速度の測定値をさらに含む、請求項３６に記載の道路上の目標車両の状態を見積もるシステム。
JP2010136483A 2002-07-15 2010-06-15 道路の特定のレーン上に目標車両が存在する確率を見積もる方法 Expired - Fee Related JP5323766B2 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
US39621102P 2002-07-15 2002-07-15
US60/396,211 2002-07-15

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2004521888A Division JP4823520B2 (ja) 2002-07-15 2003-07-15 道路上の目標車両の状態を見積もる方法

Related Child Applications (1)

Application Number Title Priority Date Filing Date
JP2013092625A Division JP5864473B2 (ja) 2002-07-15 2013-04-25 自動車目標状態見積もりシステム

Publications (2)

Publication Number Publication Date
JP2010280378A true JP2010280378A (ja) 2010-12-16
JP5323766B2 JP5323766B2 (ja) 2013-10-23

Family

ID=30115986

Family Applications (3)

Application Number Title Priority Date Filing Date
JP2004521888A Expired - Fee Related JP4823520B2 (ja) 2002-07-15 2003-07-15 道路上の目標車両の状態を見積もる方法
JP2010136483A Expired - Fee Related JP5323766B2 (ja) 2002-07-15 2010-06-15 道路の特定のレーン上に目標車両が存在する確率を見積もる方法
JP2013092625A Expired - Fee Related JP5864473B2 (ja) 2002-07-15 2013-04-25 自動車目標状態見積もりシステム

Family Applications Before (1)

Application Number Title Priority Date Filing Date
JP2004521888A Expired - Fee Related JP4823520B2 (ja) 2002-07-15 2003-07-15 道路上の目標車両の状態を見積もる方法

Family Applications After (1)

Application Number Title Priority Date Filing Date
JP2013092625A Expired - Fee Related JP5864473B2 (ja) 2002-07-15 2013-04-25 自動車目標状態見積もりシステム

Country Status (6)

Country Link
US (1) US7034742B2 (ja)
EP (1) EP1537440B1 (ja)
JP (3) JP4823520B2 (ja)
CN (1) CN100365430C (ja)
AU (1) AU2003251943A1 (ja)
WO (1) WO2004008648A2 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102706291A (zh) * 2012-05-18 2012-10-03 长安大学 一种道路曲率半径自动测量方法
KR102283237B1 (ko) * 2020-05-29 2021-07-29 서울대학교산학협력단 데이터 주도 기계학습 기반 차량 조향 특성 모델 실시간 규명 장치 및 방법

Families Citing this family (84)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7522091B2 (en) * 2002-07-15 2009-04-21 Automotive Systems Laboratory, Inc. Road curvature estimation system
JP2004226158A (ja) * 2003-01-21 2004-08-12 Fujitsu Ten Ltd Ｆｍ−ｃｗレーダ装置
US7113079B2 (en) * 2003-10-28 2006-09-26 Oakland University System and method for detecting a collision using a continuous mode hidden Markov model
US8031112B2 (en) * 2004-03-19 2011-10-04 Purdue Research Foundation, Office Of Technology Commercialization System and method for high dynamic acquisition and tracking of signals from the global positioning system
US7409295B2 (en) * 2004-08-09 2008-08-05 M/A-Com, Inc. Imminent-collision detection system and process
DE102004047087A1 (de) * 2004-09-29 2006-03-30 Robert Bosch Gmbh Verfahren zur Objektverifaktion in Radarsystemen für Kraftfahrzeuge
DE102004057604B4 (de) * 2004-11-29 2014-04-30 Daimler Ag Verfahren für ein Sicherheitssystem in einem Fahrzeug
DE102004058663A1 (de) * 2004-12-06 2006-06-14 Robert Bosch Gmbh Verfahren und Vorrichtung zur Steuerung einer automatischen Notbremsung
US7639841B2 (en) * 2004-12-20 2009-12-29 Siemens Corporation System and method for on-road detection of a vehicle using knowledge fusion
JP4062310B2 (ja) * 2005-02-07 2008-03-19 日産自動車株式会社 運転意図推定装置、車両用運転操作補助装置および車両用運転操作補助装置を備えた車両
DE102005038314A1 (de) * 2005-03-08 2006-09-14 Daimlerchrysler Ag Verfahren zum Schätzen des Verlaufs einer Fahrspur
US7180443B1 (en) * 2005-03-16 2007-02-20 Lockheed Martin Corporation Reduced state estimator for systems with physically bounded parameters
US7009554B1 (en) * 2005-03-30 2006-03-07 Lockheed Martin Corporation Reduced state estimation with multisensor fusion and out-of-sequence measurements
JP4754856B2 (ja) * 2005-03-31 2011-08-24 株式会社デンソーアイティーラボラトリ 車載用レーダ装置
US7301497B2 (en) * 2005-04-05 2007-11-27 Eastman Kodak Company Stereo display for position sensing systems
US7375679B1 (en) * 2005-08-16 2008-05-20 Lockheed Martin Corporation Reduced state estimation with biased and out-of-sequence measurements from multiple sensors
US7460951B2 (en) * 2005-09-26 2008-12-02 Gm Global Technology Operations, Inc. System and method of target tracking using sensor fusion
US7826926B2 (en) 2005-11-07 2010-11-02 Samsung Electronics Co., Ltd. Robot and method of localizing the same
EP2019013B1 (en) * 2005-12-27 2010-10-27 Honda Motor Co., Ltd. Vehicle control device
US7277047B1 (en) * 2006-02-06 2007-10-02 Lockheed Martin Corporation Reduced state estimation with biased measurements
JP4906398B2 (ja) * 2006-05-15 2012-03-28 アルパイン株式会社 車載道路形状識別装置、車載システム、道路形状識別方法及び周辺監視方法
JP4793094B2 (ja) * 2006-05-17 2011-10-12 株式会社デンソー 走行環境認識装置
US20070282558A1 (en) * 2006-06-01 2007-12-06 Denso Corporation Abnormal condition determining system for steering angle sensor
US7876926B2 (en) * 2006-11-03 2011-01-25 Delphi Technologies, Inc. Lane marker detection and fitting methods
DE102006057276B4 (de) * 2006-12-05 2023-09-28 Robert Bosch Gmbh Verfahren und Vorrichtung zum Objekt-Tracking in einem Fahrerassistenzsystem eines Kraftfahrzeugs
JP4967806B2 (ja) * 2007-05-22 2012-07-04 株式会社日立製作所 経路曲率に応じた車両の速度制御装置
JP2009042181A (ja) * 2007-08-10 2009-02-26 Denso Corp 推定装置
KR101071732B1 (ko) * 2007-12-17 2011-10-11 현대자동차주식회사 차량 주행속도 제어 장치 및 그 방법
JP5078637B2 (ja) * 2008-01-29 2012-11-21 富士通テン株式会社 レーダ装置、及び物標検出方法
US8825399B2 (en) * 2008-07-24 2014-09-02 Raytheon Company System and method of passive and autonomous navigation of space vehicles using an extended Kalman filter
US8055445B2 (en) * 2008-09-24 2011-11-08 Delphi Technologies, Inc. Probabilistic lane assignment method
JP5126556B2 (ja) * 2008-12-18 2013-01-23 トヨタ自動車株式会社 レーダーシステム
US8989913B2 (en) * 2008-12-26 2015-03-24 Toyota Jidosha Kabushiki Kaisha Travel route estimation device and travel route estimation method used in the same device
US8155807B2 (en) * 2009-03-04 2012-04-10 Raytheon Company Fusion for automated target recognition
JP5618744B2 (ja) * 2010-05-26 2014-11-05 三菱電機株式会社 道路形状推定装置及びコンピュータプログラム及び道路形状推定方法
US8515712B1 (en) 2010-08-26 2013-08-20 Lockheed Martin Corporation Information based optimal reduced state estimator for poorly conditioned estimation problems
DE102010054066A1 (de) * 2010-12-10 2012-06-14 GM Global Technology Operations LLC Verfahren zum Betreiben eines Sensors eines Fahrzeugs und Fahrerassistenzsystem für ein Fahrzeug
EP2525303A1 (en) * 2011-05-17 2012-11-21 Harman Becker Automotive Systems GmbH Lane tracking
KR101789073B1 (ko) * 2011-08-24 2017-10-23 현대모비스 주식회사 차량의 곡률 반경 추정 방법 및 그 장치
TWI438434B (zh) * 2012-06-11 2014-05-21 Wistron Corp 測速方法及其相關電子裝置
US10737665B2 (en) 2012-08-28 2020-08-11 Ford Global Technologies, Llc Vehicle braking based on external object communications
DE102012020906A1 (de) * 2012-10-24 2014-04-24 Audi Ag Verfahren und System zum Betreiben eines Antriebsstrangs eines Kraftwagens
WO2014070448A1 (en) 2012-10-31 2014-05-08 Tk Holdings, Inc. Vehicular path sensing system and method
EP2762834B1 (en) * 2013-02-01 2017-03-22 Intel Corporation An integrated global navigation satellite system and inertial navigation system
JP5739465B2 (ja) * 2013-02-14 2015-06-24 本田技研工業株式会社 車両の操舵制御装置
US9274222B1 (en) * 2013-03-04 2016-03-01 Toyota Motor Engineering & Manufacturing North America, Inc. Dynamic allocation of radar beams in automotive environments with phased array radar
WO2014152470A2 (en) 2013-03-15 2014-09-25 Tk Holdings, Inc. Path sensing using structured lighting
KR102037036B1 (ko) * 2013-04-11 2019-10-28 현대모비스 주식회사 자동주행 제어시스템
CA2824703C (en) * 2013-08-26 2021-03-16 Alastair Malarky Methods and systems for determining vehicle position in an automatic vehicle identification system
CA2824704A1 (en) 2013-08-26 2015-02-26 Alastair Malarky Methods and systems for determining a range rate for a backscatter transponder
DE102014200687A1 (de) * 2014-01-16 2015-07-16 Robert Bosch Gmbh Verfahren zum Betreiben eines Fahrzeugs
CN104101878B (zh) * 2014-06-23 2017-02-15 北京智行者科技有限公司 一种车辆前方目标识别系统及识别方法
CN104359492B (zh) * 2014-11-03 2017-03-01 中国科学院合肥物质科学研究院 惯性导航和轮速计组成的航迹推算定位系统误差估算算法
CN104401328A (zh) * 2014-11-14 2015-03-11 江苏省交通科学研究院股份有限公司 汽车弯道限速识别仪及其识别方法
JP6425130B2 (ja) * 2014-12-18 2018-11-21 パナソニックＩｐマネジメント株式会社 レーダ装置及びレーダ状態推定方法
US9562779B2 (en) * 2014-12-23 2017-02-07 Here Global B.V. Method and apparatus for providing a steering reliability map based on driven curvatures and geometry curvature
CN104615889B (zh) * 2015-02-09 2017-12-26 武汉大学 基于回旋曲线追随的智能车辆路径跟踪方法及系统
CN104635233B (zh) * 2015-02-17 2017-12-26 苏州安智汽车零部件有限公司 基于车载毫米波雷达的前方物体运动状态估计及分类方法
JP6421935B2 (ja) * 2015-03-31 2018-11-14 パナソニックＩｐマネジメント株式会社 車両移動推定装置および車両移動推定方法
US9815462B2 (en) * 2015-08-27 2017-11-14 Toyota Motor Engineering & Manufacturing North America, Inc. Path determination for automated vehicles
KR101714250B1 (ko) 2015-10-28 2017-03-08 현대자동차주식회사 주변 차량의 이동 경로의 예측 방법
US10025319B2 (en) 2016-08-31 2018-07-17 Ford Global Technologies, Llc Collision-warning system
JP6643215B2 (ja) 2016-09-29 2020-02-12 株式会社デンソー 他車線監視装置
DE102016220581A1 (de) * 2016-10-20 2018-04-26 Continental Teves Ag & Co. Ohg Verfahren und vorrichtung zur bestimmung eines umfeldmodells
JP6649865B2 (ja) * 2016-10-27 2020-02-19 株式会社Ｓｏｋｅｎ 物体検知装置
CN106515740B (zh) * 2016-11-14 2018-10-09 江苏大学 基于icdkf的分布式电驱动汽车行驶状态参数估计算法
JP6592423B2 (ja) * 2016-11-25 2019-10-16 株式会社デンソー 車両制御装置
CN106740868B (zh) * 2016-12-30 2019-03-29 东软集团股份有限公司 一种车速规划的方法、装置和设备
KR101848198B1 (ko) * 2017-02-06 2018-05-24 한양대학교 산학협력단 차선 추정 방법 및 장치
CN108569289A (zh) * 2017-05-19 2018-09-25 浙江工业职业技术学院 一种车载雷达及其逼近探测和目标判别方法
JP6856496B2 (ja) * 2017-11-07 2021-04-07 株式会社デンソーアイティーラボラトリ 方位誤差関数取得装置、方法及びプログラム
US10737693B2 (en) 2018-01-04 2020-08-11 Ford Global Technologies, Llc Autonomous steering control
US10605897B2 (en) 2018-03-06 2020-03-31 Veoneer Us, Inc. Vehicle lane alignment correction improvements
US10775494B2 (en) * 2018-03-07 2020-09-15 Aptiv Technologies Limited Method and system for determining the pointing angle of a moving object
DE102018203802A1 (de) * 2018-03-13 2019-09-19 Bayerische Motoren Werke Aktiengesellschaft Verfahren, Vorrichtung und Fortbewegungsmittel zur mehrstufigen Filterung eines Signals im Bordnetz eines Fortbewegungsmittels
CN111971723B (zh) * 2018-04-20 2022-04-19 三菱电机株式会社 驾驶监视装置和计算机能读取的记录介质
CN110487288B (zh) * 2018-05-14 2024-03-01 华为技术有限公司 一种行车道路的估计方法以及行车道路估计系统
US10914813B2 (en) * 2018-08-21 2021-02-09 Aptiv Technologies Limited Classifying potentially stationary objects tracked by radar
US10933880B2 (en) 2019-01-17 2021-03-02 Toyota Motor Engineering & Manufacturing North America, Inc. System and method for providing lane curvature estimates
US11216000B2 (en) 2019-01-17 2022-01-04 Toyota Motor Engineering & Manufacturing North America, Inc. System and method for estimating lane prediction errors for lane segments
US11327492B2 (en) * 2019-12-03 2022-05-10 Mitsubishi Electric Research Laboratories, Inc. Adaptive control of autonomous or semi-autonomous vehicle
CN111736486A (zh) * 2020-05-01 2020-10-02 东风汽车集团有限公司 一种面向l2智能驾驶控制器的传感器仿真建模方法及装置
CN111737633A (zh) * 2020-06-23 2020-10-02 上海汽车集团股份有限公司 一种车辆前方道路曲率半径的计算方法和装置
US11702106B1 (en) * 2020-11-19 2023-07-18 Zoox, Inc. Tuning a safety system based on near-miss events

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08160132A (ja) * 1994-12-09 1996-06-21 Nikon Corp 車両用レーダ検出装置
JPH09203780A (ja) * 1995-11-24 1997-08-05 Toyota Motor Corp 車載走査型レーダ装置
JP2000002535A (ja) * 1998-06-15 2000-01-07 Daihatsu Motor Co Ltd カーブ路の曲率検出方法及びこれに用いる検出装置
JP2001283391A (ja) * 2000-03-30 2001-10-12 Denso Corp 先行車選択方法及び装置、記録媒体

Family Cites Families (71)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US2709804A (en) * 1945-09-14 1955-05-31 Chance Britton Automatic range and azimuth tracking system
US3177485A (en) * 1960-03-02 1965-04-06 Jr John W Taylor Automatic radar target tracking system
US3603994A (en) * 1966-04-26 1971-09-07 Hughes Aircraft Co System for automatically generating smoothing parameters in an automatic track-while-scan radar system
US3699573A (en) * 1966-05-05 1972-10-17 Hughes Aircraft Co System for automatic initiation of target tracking in track-while-scan radar
US3725918A (en) * 1970-11-18 1973-04-03 Sperry Rand Corp Collision avoidance display apparatus for maneuverable craft
GB1430389A (en) * 1972-06-21 1976-03-31 Solartron Electronic Group Computing apparatus for tracking movinb objects
US3971018A (en) * 1974-06-24 1976-07-20 Sperry Rand Corporation Marine traffic conflict assessment system
GB8304686D0 (en) * 1983-02-19 1983-03-23 Sperry Ltd Collision avoidance apparatus
IT1240974B (it) * 1990-07-05 1993-12-27 Fiat Ricerche Metodo e apparecchiatura per evitare la collisione di un autoveicolo contro ostacoli.
US5170440A (en) * 1991-01-30 1992-12-08 Nec Research Institute, Inc. Perceptual grouping by multiple hypothesis probabilistic data association
US5051751A (en) * 1991-02-12 1991-09-24 The United States Of America As Represented By The Secretary Of The Navy Method of Kalman filtering for estimating the position and velocity of a tracked object
US5307289A (en) * 1991-09-12 1994-04-26 Sesco Corporation Method and system for relative geometry tracking utilizing multiple distributed emitter/detector local nodes and mutual local node tracking
US5138321A (en) * 1991-10-15 1992-08-11 International Business Machines Corporation Method for distributed data association and multi-target tracking
IL100175A (en) * 1991-11-27 1994-11-11 State Of Isreal Ministry Of De Vehicle collision warning device
US5202691A (en) * 1992-04-28 1993-04-13 The United States Of America As Represented By The Secretary Of The Air Force Hick's probabilistic data association method
US5530651A (en) * 1992-08-03 1996-06-25 Mazda Motor Corporation Running-safety system for an automotive vehicle
US5598164A (en) * 1992-08-10 1997-01-28 Reppas; George S. Vehicle obstacle avoidance system
JPH06144076A (ja) * 1992-11-10 1994-05-24 Toyota Motor Corp 車両用走行制御装置
US5314037A (en) * 1993-01-22 1994-05-24 Shaw David C H Automobile collision avoidance system
DE4407757A1 (de) * 1993-03-08 1994-09-15 Mazda Motor Vorrichtung zur Erfassung von Hindernissen für ein Fahrzeug
US5406289A (en) * 1993-05-18 1995-04-11 International Business Machines Corporation Method and system for tracking multiple regional objects
US5402129A (en) * 1993-08-04 1995-03-28 Vorad Safety Systems, Inc. Monopulse azimuth radar system for automotive vehicle tracking
US6553130B1 (en) * 1993-08-11 2003-04-22 Jerome H. Lemelson Motor vehicle warning and control system and method
US5983161A (en) 1993-08-11 1999-11-09 Lemelson; Jerome H. GPS vehicle collision avoidance warning and control system and method
US5633642A (en) * 1993-11-23 1997-05-27 Siemens Aktiengesellschaft Radar method and device for carrying out the method
US5537119A (en) * 1993-12-21 1996-07-16 Colorado State University Research Foundation Method and system for tracking multiple regional objects by multi-dimensional relaxation
US5959574A (en) * 1993-12-21 1999-09-28 Colorado State University Research Foundation Method and system for tracking multiple regional objects by multi-dimensional relaxation
JP3189560B2 (ja) * 1994-03-25 2001-07-16 株式会社デンソー 車間距離検知装置および車間距離警報装置
DE19514654B4 (de) * 1994-04-20 2009-07-09 Denso Corporation, Kariya Kollisionsalarmsystem für ein Kraftfahrzeug
US5594414A (en) * 1994-08-02 1997-01-14 Namngani; Abdulatif Collision probability detection system
GB9417170D0 (en) * 1994-08-25 1994-10-12 Isis Innovation Non-linear filtering
US5587929A (en) * 1994-09-02 1996-12-24 Caterpillar Inc. System and method for tracking objects using a detection system
US5689264A (en) * 1994-10-05 1997-11-18 Mazda Motor Corporation Obstacle detecting system for vehicles
JP3470453B2 (ja) * 1995-04-06 2003-11-25 株式会社デンソー 車間距離制御装置
US6405132B1 (en) * 1997-10-22 2002-06-11 Intelligent Technologies International, Inc. Accident avoidance system
US6370475B1 (en) * 1997-10-22 2002-04-09 Intelligent Technologies International Inc. Accident avoidance system
US5667251A (en) * 1995-09-14 1997-09-16 Prest; J. David Universal waste water outlet coupling
US5657251A (en) 1995-10-02 1997-08-12 Rockwell International Corporation System and process for performing optimal target tracking
US5703593A (en) * 1995-12-12 1997-12-30 Northrop Grumman Corporation Adaptive DPCA subsystem
JP3656301B2 (ja) * 1995-12-28 2005-06-08 株式会社デンソー 車両用障害物警報装置
DE59704311D1 (de) * 1996-05-08 2001-09-20 Daimler Chrysler Ag Verfahren zur erkennung des vorausliegenden fahrbahnverlaufs für kraftfahrzeuge
US5646613A (en) * 1996-05-20 1997-07-08 Cho; Myungeun System for minimizing automobile collision damage
DE19637245C2 (de) 1996-09-13 2000-02-24 Bosch Gmbh Robert Verfahren und Vorrichtung zur Regelung der Geschwindigkeit eines Fahrzeugs
US5948043A (en) * 1996-11-08 1999-09-07 Etak, Inc. Navigation system using GPS data
US6085151A (en) * 1998-01-20 2000-07-04 Automotive Systems Laboratory, Inc. Predictive collision sensing system
JP3430832B2 (ja) * 1997-01-27 2003-07-28 日産自動車株式会社 道路曲率推定装置
JP3366220B2 (ja) * 1997-05-26 2003-01-14 本田技研工業株式会社 道路形状判定装置及び車両制御装置
US6282478B1 (en) * 1997-07-10 2001-08-28 Aisin Seiki Kabushiki Kaisha Travelling direction correction apparatus
US6275231B1 (en) * 1997-08-01 2001-08-14 American Calcar Inc. Centralized control and management system for automobiles
US5964822A (en) * 1997-08-27 1999-10-12 Delco Electronics Corp. Automatic sensor azimuth alignment
US5926126A (en) * 1997-09-08 1999-07-20 Ford Global Technologies, Inc. Method and system for detecting an in-path target obstacle in front of a vehicle
DE19749086C1 (de) 1997-11-06 1999-08-12 Daimler Chrysler Ag Vorrichtung zur Ermittlung fahrspurverlaufsindikativer Daten
JPH11139396A (ja) * 1997-11-10 1999-05-25 Makoto Toyama 編隊飛行制御装置
JPH11345394A (ja) * 1998-06-03 1999-12-14 Mitsubishi Electric Corp 車両の周辺監視装置
DE59914189D1 (de) * 1998-08-08 2007-03-29 Volkswagen Ag Verfahren zur Bestimmung des Kurvenradius einer Fahrbahn
JP3371854B2 (ja) * 1998-09-07 2003-01-27 株式会社デンソー 周囲状況検出装置及び記録媒体
DE19855400A1 (de) * 1998-12-01 2000-06-15 Bosch Gmbh Robert Verfahren und Vorrichtung zur Bestimmung eines zukünftigen Kursbereichs eines Fahrzeugs
US6161071A (en) * 1999-03-12 2000-12-12 Navigation Technologies Corporation Method and system for an in-vehicle computing architecture
JP3167993B2 (ja) * 1999-09-21 2001-05-21 富士重工業株式会社 道路形状推定装置及びそれを用いたカーブ進入制御装置
JP4066573B2 (ja) * 1999-09-22 2008-03-26 株式会社デンソー 先行車選択装置、車間制御装置及び記録媒体
JP3822770B2 (ja) * 1999-12-10 2006-09-20 三菱電機株式会社 車両用前方監視装置
DE10018556A1 (de) * 2000-04-14 2001-10-18 Bosch Gmbh Robert Verfahren zur Regelung der Geschwindigkeit eines Fahrzeugs
JP2001319299A (ja) * 2000-05-12 2001-11-16 Denso Corp 車両用道路曲率推定装置、先行車選択装置
JP3417381B2 (ja) * 2000-05-25 2003-06-16 株式会社デンソー 道路形状認識装置、先行車両特定装置、及び記録媒体
JP2003536096A (ja) * 2000-06-08 2003-12-02 オートモーティブ システムズ ラボラトリー インコーポレーテッド 追跡マップジェネレータ
EP1297445A4 (en) * 2000-06-09 2005-11-23 Automotive Systems Lab SITUATION AWARENESS PROCESSOR
JP2002008189A (ja) * 2000-06-22 2002-01-11 Matsushita Electric Ind Co Ltd 車両検出装置および車両検出方法
JP2004508627A (ja) * 2000-09-08 2004-03-18 レイセオン・カンパニー 経路予測システムおよび方法
DE10118265A1 (de) 2001-04-12 2002-10-17 Bosch Gmbh Robert Verfahren zur Erkennung eines Spurwechsels eines Fahrzeugs
US6643588B1 (en) * 2002-04-11 2003-11-04 Visteon Global Technologies, Inc. Geometric based path prediction method using moving and stop objects
US6753804B2 (en) * 2002-05-21 2004-06-22 Visteon Global Technologies, Inc. Target vehicle identification based on the theoretical relationship between the azimuth angle and relative velocity

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08160132A (ja) * 1994-12-09 1996-06-21 Nikon Corp 車両用レーダ検出装置
JPH09203780A (ja) * 1995-11-24 1997-08-05 Toyota Motor Corp 車載走査型レーダ装置
JP2000002535A (ja) * 1998-06-15 2000-01-07 Daihatsu Motor Co Ltd カーブ路の曲率検出方法及びこれに用いる検出装置
JP2001283391A (ja) * 2000-03-30 2001-10-12 Denso Corp 先行車選択方法及び装置、記録媒体

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102706291A (zh) * 2012-05-18 2012-10-03 长安大学 一种道路曲率半径自动测量方法
KR102283237B1 (ko) * 2020-05-29 2021-07-29 서울대학교산학협력단 데이터 주도 기계학습 기반 차량 조향 특성 모델 실시간 규명 장치 및 방법

Also Published As

Publication number Publication date
CN1668938A (zh) 2005-09-14
EP1537440B1 (en) 2016-04-06
AU2003251943A1 (en) 2004-02-02
US7034742B2 (en) 2006-04-25
EP1537440A4 (en) 2012-03-28
CN100365430C (zh) 2008-01-30
WO2004008648A3 (en) 2004-09-02
US20050179580A1 (en) 2005-08-18
JP5864473B2 (ja) 2016-02-17
AU2003251943A8 (en) 2004-02-02
EP1537440A2 (en) 2005-06-08
WO2004008648A2 (en) 2004-01-22
JP5323766B2 (ja) 2013-10-23
JP2005539288A (ja) 2005-12-22
JP2013209085A (ja) 2013-10-10
JP4823520B2 (ja) 2011-11-24

Similar Documents

Publication Publication Date Title
JP5323766B2 (ja) 道路の特定のレーン上に目標車両が存在する確率を見積もる方法
JP5848137B2 (ja) 道路曲率推定システム
US7522091B2 (en) Road curvature estimation system
US8112225B2 (en) Method and system for collision avoidance
JP4906398B2 (ja) 車載道路形状識別装置、車載システム、道路形状識別方法及び周辺監視方法
US8401782B2 (en) System and method for assessing vehicle paths in a road environment
EP3319065A1 (en) Route prediction device
JP5082433B2 (ja) 移動体周囲危険度判定方法、装置、およびプログラム
JP5535816B2 (ja) 移動物予測装置及びプログラム
JP2003536096A (ja) 追跡マップジェネレータ
KR20120091179A (ko) 도로 차량을 위한 충돌 회피 시스템 및 방법 그리고 컴퓨터 프로그램 제품
JP2003536137A (ja) 状況認識プロセッサ
JP4442520B2 (ja) 車両用進路推定装置
Eidehall Tracking and threat assessment for automotive collision avoidance
EP3605500B1 (en) Output device, control method, program, and storage medium
CN111352413A (zh) 全向传感器融合系统和方法及包括该融合系统的车辆
CN111959482B (zh) 自主驾驶装置及方法
Shen et al. Reliable road vehicle collision prediction with constrained filtering
Polychronopoulos et al. Extended path prediction using camera and map data for lane keeping support
CN110709727B (zh) 用于检测迎面车辆的车辆系统
CN113706887B (zh) 用于后方交叉碰撞警告的方法和装置
WO2021229704A1 (ja) 物体認識装置、経路生成装置、駐車支援装置、物体認識システム、経路生成システム及び駐車支援システム

Legal Events

Date Code Title Description
A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20120313

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20120613

A602 Written permission of extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A602

Effective date: 20120618

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20120713

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20121225

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130425

A911 Transfer to examiner for re-examination before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A911

Effective date: 20130507

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130717

R150 Certificate of patent or registration of utility model

Ref document number: 5323766

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313113

Free format text: JAPANESE INTERMEDIATE CODE: R313111

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

S343 Written request for registration of root pledge or change of root pledge

Free format text: JAPANESE INTERMEDIATE CODE: R316354

SZ02 Written request for trust registration

Free format text: JAPANESE INTERMEDIATE CODE: R316Z02

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees