JP5323766B2 - 道路の特定のレーン上に目標車両が存在する確率を見積もる方法 - Google Patents
道路の特定のレーン上に目標車両が存在する確率を見積もる方法 Download PDFInfo
- Publication number
- JP5323766B2 JP5323766B2 JP2010136483A JP2010136483A JP5323766B2 JP 5323766 B2 JP5323766 B2 JP 5323766B2 JP 2010136483 A JP2010136483 A JP 2010136483A JP 2010136483 A JP2010136483 A JP 2010136483A JP 5323766 B2 JP5323766 B2 JP 5323766B2
- Authority
- JP
- Japan
- Prior art keywords
- state
- target vehicle
- road
- target
- vehicle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims description 40
- 230000027455 binding Effects 0.000 claims description 29
- 238000009739 binding Methods 0.000 claims description 29
- 238000005259 measurement Methods 0.000 claims description 23
- 230000001133 acceleration Effects 0.000 claims description 11
- 238000012795 verification Methods 0.000 claims description 11
- 230000004044 response Effects 0.000 claims description 5
- 230000007704 transition Effects 0.000 claims description 5
- 238000012545 processing Methods 0.000 claims description 4
- 238000005315 distribution function Methods 0.000 claims 2
- 230000035945 sensitivity Effects 0.000 claims 1
- 230000009870 specific binding Effects 0.000 claims 1
- 238000001914 filtration Methods 0.000 description 40
- 238000001514 detection method Methods 0.000 description 12
- 238000004422 calculation algorithm Methods 0.000 description 11
- 239000011159 matrix material Substances 0.000 description 10
- 230000008859 change Effects 0.000 description 8
- 230000010354 integration Effects 0.000 description 7
- 230000008569 process Effects 0.000 description 7
- 238000012360 testing method Methods 0.000 description 5
- 230000009471 action Effects 0.000 description 3
- 238000013459 approach Methods 0.000 description 3
- 239000006185 dispersion Substances 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 230000003466 anti-cipated effect Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 230000006378 damage Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 208000027418 Wounds and injury Diseases 0.000 description 1
- 230000004913 activation Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 208000014674 injury Diseases 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000010606 normalization Methods 0.000 description 1
- 230000003334 potential effect Effects 0.000 description 1
- 238000010200 validation analysis Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
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, i.e. the change in elevation or curvature of a plurality of continuous road segments
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Electromagnetism (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Radar Systems Or Details Thereof (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Description
図1を参照すると、予測的衝突検出システム10はホスト車両12に組み込まれ、ホスト車両12の外部にある物体を検出するレーダーシステム14、および、例えばジャイロスコープセンサーなどのヨーレートセンサー16、ホスト車両12の運動を検出するためのスピードセンサー18などのセンサー群を含む。ヨーレートセンサー16とスピードセンサー18はそれぞれホスト車両12のヨーレートとスピードの測定値を与える。例えばドップラーレーダーシステムなどのレーダーシステム14は、アンテナ20およびレーダープロセッサー22を含み、レーダープロセッサー22はアンテナ20から送信され、その視野角内の物体に反射するRF信号を発生する。レーダープロセッサー22は、反射し、アンテナ20で受信された関連するRF信号を復調し、アンテナ20から送信されたRF信号を照射された一または二以上の物体に応答する信号を検知する。例えば、レーダーシステム14は、ホスト車両12に固定された座標における目標のレンジ、レンジレート、およびアジマス角の測定値を提供する。図2を参照すると、アンテナ20は、ビームコントロール部24に応答して、例えば電気的あるいは機械的に、例えば±50度などの±γのアジマス角にわたってスキャンするRFエネルギーのレーダービーム23を発生するように適合し、レーダービーム23は、予想される事故を避けあるいはそれによる損害あるいは負傷を緩和するためにホスト車両12が採る有力な行動を緩和することができるように、ホスト車両12との予想される衝突の前十分遠くで目標を検出できるように、例えば100メートルのなどの十分に遠い距離範囲を持っている。レーダープロセッサー22、ヨーレートセンサー16、およびスピードセンサー18は、例えば目標車両36(図3に図示)などの物体との衝突が起こりそうか否かを決定し、もし起こりそうであれば、加えて例えば一または二以上の関連する警告システム28または安全システム30(例えばエアバッグ)の作動または予測される事故を避け、またはその帰結を軽減するために回避行動をとるための車両制御システム32(例えば関連するブレーキまたはステアリングシステム)の使用などの採るべき行動を決定する関連する予測的衝突アルゴリズムに従って動作するシグナルプロセッサー26に動作可能に連結している。
そのスピードセンサー18およびヨーレートセンサー16それぞれからのホスト車両12の速さUhおよびヨーレートωh;
ホスト車両12に装着されたレーダーシステム14から得られる、全ての目標車両36のレンジr、レンジレート
の測定値を、全ての測定値の誤差共分散行列との対応に従って用いる。予測的衝突検出システム10は、(1)ホスト車両の運動センサー、換言すればヨーレートセンサー16とスピードセンサー18からの測定値を用いた、道路34の曲率を見積もるための道路曲率見積もりサブシステム42、(2)レーダービーム23によって照らされ、レーダープロセッサー22によって検出された目標車両の状態を見積もるための非束縛目標状態見積もりサブシステム44、(3)目標が道路34のホストレーン38か隣接レーン40のいずれか可能なレーンに束縛されていると仮定し、目標の束縛の状態を見積もるための束縛目標状態見積もりサブシステム46、(4)非束縛目標状態といずれかの束縛に束縛された目標の状態のいずれが目標の状態として最適かを決定する目標状態決定サブシステム48、および、(5)統合された目標の状態を発生するために、非束縛目標状態を目標状態決定サブシステム48によって特定された適切な束縛と統合するための目標状態統合サブシステム50、を含む。ホスト車両12が目標と衝突する危険があるのか否かを決定し、もしあるなら、例えば警告システム28、安全システム30または車両制御システム32のいずれかまたはこれらの組み合わせの行動によって、衝突の結果を和らげるために最適な行動を決定し、生じさせるために、最良の見積もり(非束縛目標状態か統合された目標の状態のいずれか)は決定または制御サブシステムに用いられる。可能な場合には、道路34の幾何学的構造を目標の運動に対する束縛として使用することは、より正確な目標の状態の見積もりを提供し、それに応じて採られる行動の信頼性を向上させる。
道路曲率パラメータC0とC1は、ホスト車両12が道路34のセンターライン41または関連するホストレーン38に沿って動いているとの仮定の下、ホスト車両12内の運動センサー(ヨーレートセンサー16とスピードセンサー18)からのデータを用いて見積もられる。
ステップ514では、等式(24)の第一行を置き換えるために複数レーン道路の等式(33)を用いるので、複数束縛の状態の見積もりは、
関連する共分散は
ステップ516では、有効な束縛の状態にある状態の見積もりと共分散は、尤度関数と同様に、
ステップ518では、束縛の状態jに対応する尤度関数は、尺度が
ステップ520では、
目標車両36が道路34に従っていないとき、またはレーンを変更しているときには、運動学的状態変数に道路の束縛を課すことは、関連した非束縛の見積もりを用いるよりも悪いであろう間違った見積もりに終わるであろう。しかしながら、ノイズに関連した見積もりの誤差は、正しい道路の束縛条件を無効であると思わせる原因となりうる。従って、
有効な場合、すなわち目標車両36が特定のレーンにいる場合、に束縛を有効であるように保ち、無効である場合、すなわち、目標車両36がレーンを離れている場合にそれを即座に引き上げる手段を導入することは有益である。独立した目標の状態の見積もりを提供するので、非束縛目標状態は道路の束縛変数にとって重要な役割を担う。
見積もりの誤差がガウシアンであると仮定すると、H0対H1の検証は、以下のようになる。
ノイズの多い測定の組から、ノイズを前提として、状態と関連する動的システムの測定値を見積もるためにカルマンフィルターが用いられる。
システム力学は
Claims (27)
- 道路の特定のレーン上に目標車両が存在する確率を見積もる方法であって:
a.道路曲率の見積もりを発生すること;
b.目標車両の非束縛の状態とその関連する共分散を見積もること;
c.前記道路曲率の見積もりに応答する、少なくとも一つの将来の目標車両の束縛を構築すること;
d.少なくとも一つの将来の目標車両の束縛に対応する、目標車両の少なくとも一つの束縛の状態及びその関連する共分散を見積もること;
e.目標車両の非束縛の状態および少なくとも一つの目標車両の束縛の状態から選ばれる、最も有力な目標車両の状態を決定すること;および
f.もし前記少なくとも一つの目標車両の束縛の状態が最も有力な状態であれば、非束縛の目標車両の状態およびその共分散を、関連する前記最も有力な状態の束縛の状態およびその共分散と統合し、目標車両が前記少なくとも一つの束縛の状態に関連する道路の特定のレーン上に存在する確率を見積もって出力し;そうでなければ、目標車両は道路のいかなる特定のレーン上にも存在しないと見積もって出力すること
を含む、前記方法。 - 道路曲率を見積もる操作が;
a.道路を走行中のホスト車両の縦方向速さを測定することにより速さの測定値を発生すること;
b.ホスト車両のヨーレートを測定または決定することによりヨーレートの測定値を発生すること;および
c.少なくとも一つの曲率パラメータを見積もること、
を含み、
ここで、少なくとも一つの曲率パラメータは道路曲率を表現し、前記少なくとも一つの曲率パラメータの見積もりの操作は前記速さの測定値および前記ヨーレートの測定値に応答する、請求項1に記載の方法。 - 少なくとも一つの曲率パラメータは少なくとも一つの曲率のクロソイドモデルのパラメータを含み、前記曲率のクロソイドモデルは前記ホスト車両の座標系に関する、請求項2に記載の方法。
- 少なくとも一つの曲率パラメータは第一及び第二のクロソイドモデルのパラメータを含み、ここで、前記第一のパラメータは定数であって、前記第二のパラメータは道路に沿った距離に対する曲率の感度である、請求項3に記載の方法。
- 少なくとも一つの曲率パラメータ見積もりの操作は速さと角速度の測定値を少なくとも一つのカルマンフィルターで処理することを含む、請求項2に記載の方法。
- 少なくとも一つのカルマンフィルターは第一及び第二のカルマンフィルターを含み、前記第一のカルマンフィルターは速さの測定値及びヨーレートの測定値から状態変数の第一の組を見積もるように適合し、前記第二のカルマンフィルターは前記状態変数の前記第一の組の見積もりから少なくとも一つの曲率パラメータを見積もるように適合する、請求項5に記載の方法。
- 状態変数の第一の組は、車両速度、車両加速度、車両ヨーレートおよび車両ヨー加速度を含む、請求項6に記載の方法。
- 目標車両の非束縛の状態および関連する共分散を見積もる操作が;
a.ホスト車両対して相対的なレンジ、レンジレート、アジマス角を測定すること;および
b.ホスト車両に対して相対的なレンジ、レンジレート、アジマス角の前記測定値から目標車両の前記非束縛の状態を見積もること
を含む、請求項1に記載の方法。 - 目標車両の非束縛の状態を見積もる操作は、ホスト車両の座標系に対して相対的な目標車両の非束縛の状態の推定値を与えるために、ホスト車両に対して相対的な目標車両までの距離およびアジマス角の測定値を拡張されたカルマンフィルターにより処理することを含む、請求項1に記載の方法。
- 目標車両の前記非束縛の状態を、道路曲率の見積もりに対応する座標系に変換する操作をさらに含む、請求項1に記載の方法。
- 道路曲率の見積もりにおける座標系は、ホスト車両に固定された絶対座標系である、請求項1に記載の方法。
- 少なくとも一つの将来の目標車両の束縛は目標車両の横方向位置に適用され、目標車両の縦方向位置は非束縛である、請求項1に記載の方法。
- 少なくとも一つの将来の目標車両の束縛は、複数の将来の束縛を含み、道路の異なったレーンに対応する少なくとも二つの異なった将来の束縛を含む、請求項1に記載の方法
- 最も有力な目標車両の状態を決定する操作は;
a.アクティブな少なくとも一つの将来の目標車両の束縛に対応し、目標車両の非束縛の状態に対応する値において評価される対応する少なくとも一つの分布関数に応答する、少なくとも一つの有力な値を決定すること;
b.前記少なくとも一つの有力な値に応答する、目標車両の第一の束縛の状態の確率を決定すること;
c.少なくとも一つの、目標車両の前記非束縛の状態は前記第一の束縛の状態に対応するという仮説を検証すること;および
d.前記少なくとも一つの仮説の検証の操作に応答して最も有力な目標車両の状態を識別すること
を含む、請求項1に記載の方法。 - 最も有力な目標車両の状態を決定する操作は、目標車両が第一の状態から第二の状態に遷移する少なくとも一つの事前の確率を構築することを含み、
ここで、前記第一の状態と第二の状態は同じ状態であっても異なった状態であっても良く、前記目標車両の第一の束縛の状態の確率は、前記少なくとも一つの事前の確率に応答する請求項14に記載の道路上の目標車両の状態を見積もる方法。 - 少なくとも一つの分布関数は目標車両の特定の束縛の状態の共分散に応答する、請求項14に記載の方法。
- 少なくとも一つの束縛の状態は、複数の束縛の状態を含み、第一の束縛の状態は前記複数の束縛の状態の組み合わせである、請求項14に記載の方法。
- 第一の束縛の状態は、目標車両の少なくとも一つの束縛の状態の最も有力な状態を含む、請求項14に記載の道路上の目標車両の状態を見積もる方法。
- 第一の束縛の状態は、目標車両の少なくとも一つの束縛の状態の一つを含む、請求項14に記載の方法。
- 少なくとも一つの仮説の検証の操作は目標車両の状態の最新の見積もりに応答する、請求項14に記載の道路上の目標車両の状態を見積もる方法。
- 少なくとも一つの仮説の検証の操作は、
目標車両の最も有力な少なくとも一つの束縛の状態に対応する目標車両の特定の束縛の状態を識別すること、
非束縛の状態と前記特定の束縛の状態の差に応答する関数の値を計算すること、および
前記関数の値と閾値とを比較すること、
を含み、
前記仮説は、前記関数の値が前記閾値よりも低い場合に満足する、請求項14に記載の道路上の目標車両の状態を見積もる方法。 - 閾値は、目標車両の特定の束縛の状態に関連する特定の束縛に応答する、請求項21に記載の方法。
- 閾値は、目標車両によるホスト車両に対する危険が増加することに対応する特定の束縛の状態に対して相対的に小さくなる、請求項22に記載の方法。
- 目標車両によるホスト車両に対する危険が増加することに対応する特定の束縛の状態は、ホスト車両と同じレーンを走行している目標車両、およびホスト車両と同じレーンにレーン変更をする目標車両、のいずれかに関連するものである、請求項23に記載の方法。
- ホスト車両が目標車両と衝突する危険があるのか否かを決定することをさらに含む、請求項1に記載の方法。
- 非束縛の目標車両の状態およびその共分散を、関連する前記最も有力な状態の束縛の状態およびその共分散と統合し、目標車両の統合された状態およびその関連する統合された共分散の少なくとも一つを目標の見積もられた状態または共分散として出力することをさらに含む、請求項1に記載の方法。
- もし前記少なくとも一つの目標車両の束縛の状態が最も有力な状態でなければ、目標の非束縛の状態またはその関連する非束縛の共分散の少なくとも一つを、目標の見積もられた状態または共分散として出力することをさらに含む、請求項1に記載の方法。
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 JP2010280378A (ja) | 2010-12-16 |
JP5323766B2 true 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) |
Families Citing this family (88)
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 | Fm−cwレーダ装置 |
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 |
JP2007132938A (ja) | 2005-11-07 | 2007-05-31 | Samsung Electronics Co Ltd | ロボット及び前記ロボットの位置推定方法 |
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 |
US8581776B2 (en) * | 2008-12-18 | 2013-11-12 | Toyota Jidosha Kabushiki Kaisha | Radar system |
DE112008004200B4 (de) * | 2008-12-26 | 2023-02-09 | Toyota Jidosha Kabushiki Kaisha | Fahrtroutenschätzvorrichtung und Fahrtroutenschätzverfahren, das in dieser Vorrichtung verwendet wird |
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 | 현대모비스 주식회사 | 차량의 곡률 반경 추정 방법 및 그 장치 |
CN102706291B (zh) * | 2012-05-18 | 2014-12-24 | 长安大学 | 一种道路曲率半径自动测量方法 |
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 |
US9349058B2 (en) | 2012-10-31 | 2016-05-24 | 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 | パナソニックIpマネジメント株式会社 | レーダ装置及びレーダ状態推定方法 |
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 | パナソニックIpマネジメント株式会社 | 車両移動推定装置および車両移動推定方法 |
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 | 株式会社Soken | 物体検知装置 |
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 |
US10906536B2 (en) * | 2018-04-11 | 2021-02-02 | Aurora Innovation, Inc. | Control of autonomous vehicle based on determined yaw parameter(s) of additional vehicle |
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 |
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 |
US10933880B2 (en) | 2019-01-17 | 2021-03-02 | Toyota Motor Engineering & Manufacturing North America, Inc. | System and method for providing lane curvature estimates |
JP7260416B2 (ja) * | 2019-06-25 | 2023-04-18 | 株式会社Soken | 追跡装置 |
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智能驾驶控制器的传感器仿真建模方法及装置 |
KR102283237B1 (ko) * | 2020-05-29 | 2021-07-29 | 서울대학교산학협력단 | 데이터 주도 기계학습 기반 차량 조향 특성 모델 실시간 규명 장치 및 방법 |
CN111737633B (zh) * | 2020-06-23 | 2024-07-16 | 上海汽车集团股份有限公司 | 一种车辆前方道路曲率半径的计算方法和装置 |
US11702106B1 (en) * | 2020-11-19 | 2023-07-18 | Zoox, Inc. | Tuning a safety system based on near-miss events |
Family Cites Families (75)
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 |
US5479173A (en) * | 1993-03-08 | 1995-12-26 | Mazda Motor Corporation | Obstacle sensing apparatus for vehicles |
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 |
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 |
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 |
JP3189560B2 (ja) * | 1994-03-25 | 2001-07-16 | 株式会社デンソー | 車間距離検知装置および車間距離警報装置 |
US5631639A (en) * | 1994-04-20 | 1997-05-20 | Nippondenso Co., Ltd. | Collision alarm system for automotive vehicle |
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 |
JPH08160132A (ja) * | 1994-12-09 | 1996-06-21 | Nikon Corp | 車両用レーダ検出装置 |
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 |
JP3257410B2 (ja) * | 1995-11-24 | 2002-02-18 | トヨタ自動車株式会社 | 車載走査型レーダ装置 |
US5703593A (en) * | 1995-12-12 | 1997-12-30 | Northrop Grumman Corporation | Adaptive DPCA subsystem |
JP3656301B2 (ja) * | 1995-12-28 | 2005-06-08 | 株式会社デンソー | 車両用障害物警報装置 |
WO1997042521A1 (de) * | 1996-05-08 | 1997-11-13 | Daimler-Benz Aktiengesellschaft | 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 | 車両の周辺監視装置 |
JP2000002535A (ja) * | 1998-06-15 | 2000-01-07 | Daihatsu Motor Co Ltd | カーブ路の曲率検出方法及びこれに用いる検出装置 |
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 | 三菱電機株式会社 | 車両用前方監視装置 |
JP3427815B2 (ja) * | 2000-03-30 | 2003-07-22 | 株式会社デンソー | 先行車選択方法及び装置、記録媒体 |
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 | 株式会社デンソー | 道路形状認識装置、先行車両特定装置、及び記録媒体 |
EP1290467A4 (en) * | 2000-06-08 | 2006-02-15 | Automotive Systems Lab | GENERATOR OF ROAD MAPS |
US6470272B2 (en) * | 2000-06-09 | 2002-10-22 | Automotive Systems Laboratory, Inc. | Situation awareness processor |
JP2002008189A (ja) * | 2000-06-22 | 2002-01-11 | Matsushita Electric Ind Co Ltd | 車両検出装置および車両検出方法 |
KR100776860B1 (ko) * | 2000-09-08 | 2007-11-16 | 레이던 컴퍼니 | 경로 예측 시스템 및 방법 |
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 |
-
2003
- 2003-07-15 CN CNB038169673A patent/CN100365430C/zh not_active Expired - Fee Related
- 2003-07-15 WO PCT/US2003/022182 patent/WO2004008648A2/en active Application Filing
- 2003-07-15 AU AU2003251943A patent/AU2003251943A1/en not_active Abandoned
- 2003-07-15 EP EP03764720.3A patent/EP1537440B1/en not_active Expired - Fee Related
- 2003-07-15 JP JP2004521888A patent/JP4823520B2/ja not_active Expired - Fee Related
- 2003-07-15 US US10/620,749 patent/US7034742B2/en not_active Expired - Lifetime
-
2010
- 2010-06-15 JP JP2010136483A patent/JP5323766B2/ja not_active Expired - Fee Related
-
2013
- 2013-04-25 JP JP2013092625A patent/JP5864473B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
AU2003251943A8 (en) | 2004-02-02 |
AU2003251943A1 (en) | 2004-02-02 |
JP2010280378A (ja) | 2010-12-16 |
EP1537440A2 (en) | 2005-06-08 |
JP5864473B2 (ja) | 2016-02-17 |
EP1537440B1 (en) | 2016-04-06 |
WO2004008648A2 (en) | 2004-01-22 |
CN100365430C (zh) | 2008-01-30 |
US7034742B2 (en) | 2006-04-25 |
JP4823520B2 (ja) | 2011-11-24 |
CN1668938A (zh) | 2005-09-14 |
JP2013209085A (ja) | 2013-10-10 |
US20050179580A1 (en) | 2005-08-18 |
EP1537440A4 (en) | 2012-03-28 |
JP2005539288A (ja) | 2005-12-22 |
WO2004008648A3 (en) | 2004-09-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5323766B2 (ja) | 道路の特定のレーン上に目標車両が存在する確率を見積もる方法 | |
JP5848137B2 (ja) | 道路曲率推定システム | |
US7522091B2 (en) | Road curvature estimation system | |
US8112225B2 (en) | Method and system for collision avoidance | |
EP3319065B1 (en) | Route prediction device | |
JP4906398B2 (ja) | 車載道路形状識別装置、車載システム、道路形状識別方法及び周辺監視方法 | |
WO2018221453A1 (ja) | 出力装置、制御方法、プログラム及び記憶媒体 | |
JP5082433B2 (ja) | 移動体周囲危険度判定方法、装置、およびプログラム | |
JP5535816B2 (ja) | 移動物予測装置及びプログラム | |
JP2003536096A (ja) | 追跡マップジェネレータ | |
CN111352413B (zh) | 全向传感器融合系统和方法及包括该融合系统的车辆 | |
KR20120091179A (ko) | 도로 차량을 위한 충돌 회피 시스템 및 방법 그리고 컴퓨터 프로그램 제품 | |
JP4442520B2 (ja) | 車両用進路推定装置 | |
Eidehall | Tracking and threat assessment for automotive collision avoidance | |
EP3605500B1 (en) | Output device, control method, program, and storage medium | |
CN111959482B (zh) | 自主驾驶装置及方法 | |
Polychronopoulos et al. | Extended path prediction using camera and map data for lane keeping support | |
Shen et al. | Reliable road vehicle collision prediction with constrained filtering | |
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 |