JP2007095038A5 - - Google Patents
Download PDFInfo
- Publication number
- JP2007095038A5 JP2007095038A5 JP2006223394A JP2006223394A JP2007095038A5 JP 2007095038 A5 JP2007095038 A5 JP 2007095038A5 JP 2006223394 A JP2006223394 A JP 2006223394A JP 2006223394 A JP2006223394 A JP 2006223394A JP 2007095038 A5 JP2007095038 A5 JP 2007095038A5
- Authority
- JP
- Japan
- Prior art keywords
- host vehicle
- vehicle
- remote vehicle
- remote
- coordinates
- 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.)
- Pending
Links
- 238000004891 communication Methods 0.000 claims description 18
- 230000004913 activation Effects 0.000 claims description 3
- 230000001186 cumulative Effects 0.000 claims description 2
- 230000002596 correlated Effects 0.000 claims 1
- 238000001514 detection method Methods 0.000 description 6
- 230000000875 corresponding Effects 0.000 description 5
- 230000003111 delayed Effects 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 230000023298 conjugation with cellular fusion Effects 0.000 description 3
- 230000013011 mating Effects 0.000 description 3
- 230000021037 unidirectional conjugation Effects 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000015556 catabolic process Effects 0.000 description 1
- 230000004059 degradation Effects 0.000 description 1
- 238000006731 degradation reaction Methods 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006011 modification reaction Methods 0.000 description 1
Description
本出願は、2005年4月18日に出願された米国特許出願シリアル番号11/207,168号の部分継続出願であり、「衝突検出及び車両経路を予測するためのシステム及び方法」と題された。その内容全体は、ここで参照したことにより本願に組み込まれ、本願発明の譲受人に譲り受けされる。本出願及び優先権出願は、重なり合った部分を含んでいるが、異なる主要事項を請求する。
本発明は、能動的安全応用技術及び実時間車両追跡システムに係り、より詳しくは、少なくとも1つの移動遠隔車両に対してホスト車両合致経路を決定するための改善されたシステムに関する。
例えば、夜間走行、ガイダンス、安全性又は護衛のモデル等の様々な状況で遅れ車両の追跡を促進することが長く望まれていた。例えばボート、自動車及び航空機等の輸送機の間の交通運動を監視することを援助するため、能動的安全技術及び追跡システムが開発された。これらの従来の用途及びシステムは、典型的には、車両の位置決め/追跡を提供するためホスト車両及び周囲の車両の正確な相対的位置及び予測可能な運転軌跡を決定する能力に頼っていた。これらのタスクを達成するため、技術アプローチの現在の状態は、周囲の車両を検出し、それらの相対的範囲、変化率の範囲及び進行方向を計算する様々な外部車両センサーからの入力を使用する。これらのセンサー入力は、予測経路を決定し、又は、予め決定された事象のホスト又は遠隔車両を変えるため、コントローラによって利用されている。
これらのマルチセンサーを基にしたシステムは、一般に使用されているが、一般的な懸念事項及び非効率性を与えている。例えば、360度に亘る検出を提供するため、多数のセンサーが要求されており、ホスト車両の製造及び修繕にかかる総コストをかなり増大させている。多数のセンサーは、最終決定アルゴリズムにおいてセンサー入力を解釈し、融合させる際に含まれる過剰の複雑さに起因して信頼性が低くなっている。更には、これらの従来システムの複雑さは、トレーニング、製造及び設計に伴う労力コストを増加させる。
上記システムは、柔軟性を欠く車両特定形態に起因して動作的にも制限されている。主要な懸念事項の中では、これらのシステムは、センサーの能力により制限されている。加えて、適切なセンサー性能も、益々複雑となった過負荷の車両通信ネットワークによっても影響を及ぼされている。この構成では、電気制御ユニットを与えるセンサーを各々別々に実行することは、ノード間の通信のために利用可能な帯域を利用しており、より多くのセンサーを利用すればするほど、必要となる帯域及び処理能力も更に増大していく。ボーレート又はキャパシティが不十分となる場合、センサー入力の確保は、従来システムの性能低下又は故障を引き起こし得る。
一方、通信システムの作動範囲内にある他のV2V搭載車両に車両内データをリレーするため車両間(V2V)通信システムが開発された。これらのV2Vシステムは、典型的には、それらのメッセージを伝達するため、無線周波数(RF)又は短距離範囲のローカル無線ネットワーク等の幾つかの従来の短距離通信技術のうち一つを用いている。従来のV2V通信システムは、能動的安全技術を含むイントラ車両通信ネットワーク内でしばしば相互接続され、典型的には検知範囲よりも多くの範囲を提供するが、予防的な追跡解決法による使用には適していなかった。それどころか、この点に関し、誤案内された遅れ車
両が所望の経路から方向転回し、検知追跡範囲から逸脱する場合には、V2Vの機能は阻止された。
両が所望の経路から方向転回し、検知追跡範囲から逸脱する場合には、V2Vの機能は阻止された。
本発明では、遅れ車両による、例えば車線変更等の合致経路の逸脱を決定するシステム及び方法が説明される。本発明に係るシステムは、ホスト車両に関する、相対的なヨーレート、横方向距離及び進行方向の差異を決定するため、ホスト車両及び少なくとも1つの遠隔車両に関する、複数の位置座標、ヨーレート及び進行方向に頼るのが好ましい。本発明のシステムは、測定機関内での連続的位置の間の三角法的な関係と外挿とを利用する。車両の位置座標、ヨーレート及び進行方向は、各ポイントにおいて決定される。
本発明の第1の態様は、移動するホスト車両で使用するための追跡システムであって、前記ホスト車両は、該ホスト車両に先行する少なくとも1つの移動する遠隔車両から間隔を隔てられ且つ通信接続されている、前記追跡システムに関する。該追跡システムは、前記ホスト車両及び前記少なくとも1つの遠隔車両に関する現在位置及び軌跡座標の組を少なくとも一定期間に亘って決定し、格納させるように構成された位置突き止め装置を備える。遠隔車両センサーは、前記格納した遠隔車両の位置における該遠隔車両に関連した状態のデータ値を少なくとも一定期間に亘って決定し、格納させるように構成される。ホスト車両位置突き止め装置が備えられ、該ホスト車両に関連した現在位置及び軌跡座標の組を少なくとも一定期間に亘って決定し、格納させるように構成されていると共に、ホスト車両センサーが前記現在のホスト車両の位置における該ホスト車両に関連した状態のデータ値を少なくとも一定期間に亘って決定し、格納させるように同様に構成されている。
結局のところ、本発明のホスト車両コントローラは、前記装置及び前記センサーに通信接続され、前記ホスト車両と前記遠隔車両との前記現在位置及び軌跡座標を比較して前記両車両の相対位置を決定するように構成されている。コントローラは、更に、前記遠隔車両が前記ホスト車両に先行するとき、前記現在のホスト車両位置に対して2つの最も近接する遠隔車両軌跡座標における前記格納された遠隔車両データ値を前記ホスト車両現在位置データ値と比較して、これらのデータ値の間の差異を自動的に決定するように構成されている。本コントローラは、更に、前記差異を閾値と比較して前記ホスト車両による合致経路の逸脱を決定するように構成されている。ここで、前記データ値、差異及び閾値は、前記ホスト車両による前記合致経路の逸脱を示すように協働的に構成されている。
本発明の第2の態様は、合致して移動する遠隔車両と通信接続することにより、移動するホスト車両の経路逸脱を検出する方法に関する。本方法は、前記移動する遠隔車両及びホスト車両に関する、複数の現在位置及び軌跡座標の組と、各組の座標におけるヨーレートとを決定し、格納する工程を備えている。次に、両車両の相対的位置の差異を決定するように遠隔車両の軌跡座標に対するホスト車両の横方向の逸れを決定するため、座標の組が比較され、各座標の組における両車両の相対的進行方向が決定される。前記複数の座標の組が、前記遠隔車両が前記ホスト車両に先行し、両車両が合致して移動することを示すとき、ホスト車両のその現在位置におけるホスト車両のヨーレート及び進行方向と、現在のホスト車両位置に対する2つの最も近接する遠隔車両軌跡座標とが比較されてヨーレート及び進行方向の差異を決定する。最終的には、当該差異は各々の閾値と比較され、ホスト車両による経路逸脱を決定し、該経路逸脱は遠隔車両に連絡される。
本発明は、例えば監視遠隔車両に合致した経路から移動する車両が進路を変えた否かを決定する改善された方法を提供することを始めとして、従来技術を超える多数の利点を提供することが理解され、認められよう。本発明は、ホスト車両の車線変更を決定する際に使用される、位置、ヨーレート及び進行方向の差異の故に、直線道路及び曲線道路の両方の区分に適用される。本発明は、目標とする車両の移動を検出するためのセンサーの使用を減少することにより、ガイダンス及び交通の制御システムの効率を増大させる。車両間(V2V)通信の使用は、従来のセンサーに基づくシステムよりも大きな範囲及び機能を提供する。
本発明の他の態様及び利点は、好ましい実施例の次の詳細な説明及び添付図面から明らかとなる。
以下、本発明の好ましい実施例を添付図面を参照して詳細に説明する。
図1に示されるように、本発明は、ホスト車両12で使用し、遠隔車両16の操縦者14を警告するように構成された車両追跡システム10に関する。システム10は、例えば、自動車、SUV、トラック等の車両に関して示され、説明される。しかし、航空機及び船舶、人力駆動車、又は、経路合致が所望されている他の輸送モードで利用することもできる。システム10は、図2に示されるように、ホスト車両12に関する、複数の軌跡座標12t及び現在の位置座標12cと、少なくとも1つの遠隔車両16に関する、同様の組の座標16t及び16cと、を決定するように構成されている。説明のため複数の遠隔車両が必要とされている場合を除いて、以下では、1台の遠隔車両16に関して本発明を説明する。この説明は、本発明の進歩的な態様が複数の遠隔車両に関して同時に実施することができ、各遠隔車両とホスト車両との間の関係からの結果は、複数の遠隔車両16が合致して移動している場合、ホスト車両経路の逸脱の最終的な判定を達成する前に、更に平均化され、他の仕方で取り扱うことができるという理解の下でなされる。
図1に示されるように、本発明は、ホスト車両12で使用し、遠隔車両16の操縦者14を警告するように構成された車両追跡システム10に関する。システム10は、例えば、自動車、SUV、トラック等の車両に関して示され、説明される。しかし、航空機及び船舶、人力駆動車、又は、経路合致が所望されている他の輸送モードで利用することもできる。システム10は、図2に示されるように、ホスト車両12に関する、複数の軌跡座標12t及び現在の位置座標12cと、少なくとも1つの遠隔車両16に関する、同様の組の座標16t及び16cと、を決定するように構成されている。説明のため複数の遠隔車両が必要とされている場合を除いて、以下では、1台の遠隔車両16に関して本発明を説明する。この説明は、本発明の進歩的な態様が複数の遠隔車両に関して同時に実施することができ、各遠隔車両とホスト車両との間の関係からの結果は、複数の遠隔車両16が合致して移動している場合、ホスト車両経路の逸脱の最終的な判定を達成する前に、更に平均化され、他の仕方で取り扱うことができるという理解の下でなされる。
前述されたように、本発明の進歩的な態様は、車線レベル相対的配置を検出し、合致経路の逸脱を決定するためV2V通信技術を使用することである。かくして、ホスト車両12及び遠隔車両16は、適切なワイヤレス技術により通信接続される。例えば、車両12、16は、無線ローカルエリアネットワーク、RF技術、又は、実時間での情報の車両間共有を可能にする他の従来手段によって接続することができる。代替例として、車両12、16は、関連する位置データを連続的に収集し、本明細書で説明される決定を実行し、合致経路の逸脱の警告を遠隔車両16に送信し返す、第三者の媒介手段18(図1a参照)を介して通信接続することができる。安全用途の信頼性は、備わっているV2V通信システムの精度に依存していることが認められよう。
位置突き止め装置20は、ホスト車両12及び遠隔車両16によって使用されるように構成されている。装置20は、ホスト車両12及び遠隔車両16に関する、現在の位置座標及び複数の軌跡座標を、決定し及び格納し、又は少なくとも一定期間に亘って格納させるように構成されている。図1に示されるように、好ましい位置突き止め装置20は、GPSを使用して、経度、緯度、及び、より好ましくは、高度座標を決定するように構成される。かくして、装置20は、各車両12、16内に設けられたGPS受信機22を更に備え、少なくとも4つの地図衛星24、26、28、30が全時刻で各受信機22に別々の送信信号を分配するように通信接続され、構築されている。代替例として、制御位置に配置された他の信号源を受信機22に通信接続することもでき、例えば、軍用グリッド基準システム(MGRS)又はECEF X、Y、Z等の様々な測地データ、ユニット、投影法及び基準に基づく他の座標系を、本発明に従って利用することができる。
好ましいシステム10は、操縦者14による、検出された合致経路の逸脱(又は、図示の実施例で示されているように車線変更)の視覚的感覚を可能にするように従来のナビゲーションシステムで使用するように構成されている。この点において、好ましい位置突き止
め装置20は、好ましくは遠隔車両12及びホスト車両16内に収容された地図データベース32を更に備えている。各々のデータベース32は、グローバル位置決めポイントからなる少なくとも1つの地図記録32aを有する。装置20は、ホスト車両及び遠隔車両の現在の位置及び軌跡座標を、地図記録32a上の対応するポイントに合致させるように構成されている。図2に示されるように、この構成で慣習となっているように、好ましいシステム10は、データベース32及び装置20に通信接続され、地図記録32a及び座標を表示するように構成されたモニター34を更に備えている。データベース32は、例えばCD−ROM、内部ハードディスク、及び、取り外し可能なメモリカード等の従来の記憶手段により格納することができる。
め装置20は、好ましくは遠隔車両12及びホスト車両16内に収容された地図データベース32を更に備えている。各々のデータベース32は、グローバル位置決めポイントからなる少なくとも1つの地図記録32aを有する。装置20は、ホスト車両及び遠隔車両の現在の位置及び軌跡座標を、地図記録32a上の対応するポイントに合致させるように構成されている。図2に示されるように、この構成で慣習となっているように、好ましいシステム10は、データベース32及び装置20に通信接続され、地図記録32a及び座標を表示するように構成されたモニター34を更に備えている。データベース32は、例えばCD−ROM、内部ハードディスク、及び、取り外し可能なメモリカード等の従来の記憶手段により格納することができる。
本発明に係るシステム10は、自動的に、ホスト車両12による経路逸脱の発生を判定し、該発生を遠隔車両16に伝達する(即ち、操縦者の参加無しに)ように構成されている。本発明に係るアルゴリズムは、車両12、16の現在位置及び軌跡座標の組、並びに、当該組の座標の各々において両車両に存在する少なくとも1つの状態のデータ値に基づいている。本発明の好ましい実施例では、車両12、16の各々は、少なくとも1つの状態のデータ値を決定し、該データ値を格納させるように構成された少なくとも1つのセンサー36を備えている。例えば、図示の実施例では、各々の車両12、16は、各位置において測定車両の瞬間的なヨーレートνを検出するように作動可能であるヨージャイロが備え付けられている。代替例として、又は、より好ましくは追加的に、各車両12、16は、ハンドルの回転角度を検出するように作動可能である操舵角度センサーを更に備えている。好ましいセンサー36は、データ値それ自身を格納するように、メモリ能力を備えていてもよい。
ホスト車両12において、コントローラ38は、V2V通信システムを介して遠隔車両16から位置及び状態のデータを受信するように、装置20及び遠隔車両16に通信接続されている。好ましいコントローラ38は、同様のホスト車両データを更に決定し、より好ましくは、経路逸脱判定における追加の所望の状態のデータ値を計算するためプログラム可能に構成されている。例えば、好ましい実施例では、コントローラ38は、ヨーレート(又は、利用可能であれば、操舵角度)及び座標を受信し、それらの各々の座標及びヨーレートに基づいて、ホスト車両12及び遠隔車両16の各々に対して、進行方向hを決定するように構成されている。
好ましいコントローラ38は、ホスト車両の経路逸脱が決定されたとき、遠隔車両において、可聴、可視及び/又は触覚可能(例えば、対応する側における穏やかな座席振動)となる警告34aを発生するように構成されている。より詳しくは、好ましいコントローラ38は、状態が最小の閾値より大きくなって逸れたとき、警告を発生するように構成されている。より好ましくは、逸脱の変動する度合いを伝達し、複数の閾値のうち一つに対応する、複数の警告のうち一つを、更に後述されるように生成してもよい。例えば、複数の警告は、表象、色、ピッチ、音の大きさ、位置、フォント、語法、閃光率等において変動することができる。
より詳しくは、図2aに示されるように、一例としての衝突検出信号34aは、モニター34上に例えば「追跡車両の車線変更」等の表象の間欠的表示を含んでいてもよい。図2bに示されるように、一例としての経路逸脱警告34bは、経路逸脱の方向、即ち左又は右に向かって操縦者14を向かわせる複数の矢印の一つの表示であってもよい。最終的には、信号34a、bは、操縦者14を満足に警告するのに十分な、所定の好ましい変更可能な期間に亘って提供される。
かくして、好ましいシステム10は、ホスト車両及び追跡車両の相対的位置を最初に決定するように構成されている。好ましい方法は、現在座標及び軌跡座標、ヨーレート、並
びに、より好ましくは、ホスト車両12及び遠隔車両16の進行方向を利用して、合致した移動遠隔車両16を決定する。合致経路の逸脱を決定するための本発明に係るアルゴリズム及びコントローラ38のプログラムされた機能の好ましい実施例は、以下でより詳細に説明される。
I. 同じ方向に移動する車両の同定
ホスト車両12と同じ方向に移動する遠隔車両16は、相対的進行方向を比較することによって決定される。次の不等式(1)は、そのような車両の部分集合を与える。
びに、より好ましくは、ホスト車両12及び遠隔車両16の進行方向を利用して、合致した移動遠隔車両16を決定する。合致経路の逸脱を決定するための本発明に係るアルゴリズム及びコントローラ38のプログラムされた機能の好ましい実施例は、以下でより詳細に説明される。
I. 同じ方向に移動する車両の同定
ホスト車両12と同じ方向に移動する遠隔車両16は、相対的進行方向を比較することによって決定される。次の不等式(1)は、そのような車両の部分集合を与える。
CosθhCosθs+SinθhSinθs>0.5 (1)
ここで、θhは、時刻tにおけるホスト車両の進行方向であり、θsは、遠隔車両の進行方向であり、不等式の真の値は、同じ相対的移動方向を与えている。逆に、0.5より小さい積の総和は、ホスト車両12及び遠隔車両16のための反対の相対的移動方向を与える。当該プロセスを簡単にするため、ホスト車両の進行方向θhは、好ましくは、選択された座標系に対してゼロに設定され、よって不等式(1)は、SinθhSinθs>0.5となる。ホスト車両12のV2V範囲内であるが、該ホスト車両とは反対方向に、同じ通路を移動する遠隔車両は、システム10によって更に考察の対象とはならない。
II. 同じ方向に移動する車両の車線レベルの交通への分類
ホスト車両12と略同じ方向に移動する遠隔車両16は、ホスト車両12及び遠隔車両16の現在位置座標を比較することにより複数の相対位置の一つに分類される。ホスト車両の進行方向を考慮することにより、これらの遠隔車両16は、初期には、「遅れ」及び「前方」(又は、先行)の集合へと分離することができる。略遅れ遠隔車両16は、ホスト車両がその2車両の間の距離を増大するようにするときに決定される。より好ましくは、ホスト車両12の後ろに位置する遠隔車両16は、次の不等式(2)によって計算される。
ここで、θhは、時刻tにおけるホスト車両の進行方向であり、θsは、遠隔車両の進行方向であり、不等式の真の値は、同じ相対的移動方向を与えている。逆に、0.5より小さい積の総和は、ホスト車両12及び遠隔車両16のための反対の相対的移動方向を与える。当該プロセスを簡単にするため、ホスト車両の進行方向θhは、好ましくは、選択された座標系に対してゼロに設定され、よって不等式(1)は、SinθhSinθs>0.5となる。ホスト車両12のV2V範囲内であるが、該ホスト車両とは反対方向に、同じ通路を移動する遠隔車両は、システム10によって更に考察の対象とはならない。
II. 同じ方向に移動する車両の車線レベルの交通への分類
ホスト車両12と略同じ方向に移動する遠隔車両16は、ホスト車両12及び遠隔車両16の現在位置座標を比較することにより複数の相対位置の一つに分類される。ホスト車両の進行方向を考慮することにより、これらの遠隔車両16は、初期には、「遅れ」及び「前方」(又は、先行)の集合へと分離することができる。略遅れ遠隔車両16は、ホスト車両がその2車両の間の距離を増大するようにするときに決定される。より好ましくは、ホスト車両12の後ろに位置する遠隔車両16は、次の不等式(2)によって計算される。
(xs−xh)Cosθh+(ys−yh)Sinθh<0 (2)
ここで、xs、ysは遠隔車両16の座標であり、xh、yhは、ホスト車両12の座標である。ゼロより大きい積の総和(>0)は、遠隔車両16がホスト車両12の前方に位置するときに生じる。しかし、簡単化された平面での解析を与えるため、高さの座標zxが考慮されていないことが理解されるべきである。
ここで、xs、ysは遠隔車両16の座標であり、xh、yhは、ホスト車両12の座標である。ゼロより大きい積の総和(>0)は、遠隔車両16がホスト車両12の前方に位置するときに生じる。しかし、簡単化された平面での解析を与えるため、高さの座標zxが考慮されていないことが理解されるべきである。
所望ならば、相対車線位置は、サンプル周期の開始時刻tでホスト車両12及び遠隔車両16の軌跡座標及び現在位置座標の間の横方向のオフセットを計算することによって決定することができる。この構成では、車線オフセットを画定するため閾値を使用することができる。例えば、負の座標と正の座標との間の横方向オフセットは、ホスト車両12及び遠隔車両16が同じ車線を分かち合うことを示すことができる。与えられた座標で垂直方向に横方向オフセットを取ることによって、本方法は、直線大通り及び曲がった大通り上で等しく機能し得ることが認められよう。
図3では、rPjがホスト車両の現在位置と遠隔車両16の2つの最も近接した軌跡座標により画定されたラインとの間の直交距離即ち最短距離である。より詳しくは、図3に示されるように、最短距離rPjは、当該ライン又は経路上の外挿された点(xN、yN、νN、hN)から測定される。引き続く位置及び時刻における最短距離の変化は、次式に従って決定される。
δrH=((xH−xN)2+(yH−yN)2)0.5−rt (3)
ここで、rtは、サンプリング周期の開始時で測定された最短距離である。
外挿された点は、2つの最も近接した遠隔車両軌跡座標と、現在のホスト車両位置とから、三角法で決定される。Nにおける推定条件値は、ヨーレート及び2つの最も近接した遠隔車両軌跡座標における進行方向から外挿される。例えば、Pj(xPj、yPj、ν
Pj、hPj)及びPj+1(xPj+1、yPj+1、νPj+1、hPj+1)は、2つの最も近接した位置を表し、位置Pjにおけるヨーレートの変化、即ちδνPjは、位置PjにおけるヨーレートからPj+1におけるヨーレートを引いたものに等しく、外挿位置におけるヨーレートの変化、即ちδνNは次式の通り計算可能となる。
ここで、rtは、サンプリング周期の開始時で測定された最短距離である。
外挿された点は、2つの最も近接した遠隔車両軌跡座標と、現在のホスト車両位置とから、三角法で決定される。Nにおける推定条件値は、ヨーレート及び2つの最も近接した遠隔車両軌跡座標における進行方向から外挿される。例えば、Pj(xPj、yPj、ν
Pj、hPj)及びPj+1(xPj+1、yPj+1、νPj+1、hPj+1)は、2つの最も近接した位置を表し、位置Pjにおけるヨーレートの変化、即ちδνPjは、位置PjにおけるヨーレートからPj+1におけるヨーレートを引いたものに等しく、外挿位置におけるヨーレートの変化、即ちδνNは次式の通り計算可能となる。
(δνPj/(Pj+1)(Pj))(Pj+1N) (4)
ここで、(Pj+1)(Pj)は2つの最も近接した軌跡座標の間の直線距離であり、Pj+1Nは外挿位置と追跡位置Pj+1との間の直線距離である。かくして、この構成では、外挿位置Nにおける、推定されたヨーレートと、同様に推定された進行方向とは、次式の通り決定可能となる。
ここで、(Pj+1)(Pj)は2つの最も近接した軌跡座標の間の直線距離であり、Pj+1Nは外挿位置と追跡位置Pj+1との間の直線距離である。かくして、この構成では、外挿位置Nにおける、推定されたヨーレートと、同様に推定された進行方向とは、次式の通り決定可能となる。
νN=νPj+1+δνN (5)
hN=hPj+1+δhN (6)
III.合致経路の逸脱(車線変更)の検出
ホスト車両12は、外挿位置においてその状態データ値が遠隔車両の状態データ値と略合致しているとき(即ち、受容可能な測定及びセンサー誤差制限値内にあるとき)合致経路を維持している。ホスト車両12は、追跡している遠隔車両及びホスト車両12が合致経路を持っているか否かを自動的に決定すると共に、追跡している遠隔車両にメッセージを分配して、経路逸脱の存在を監視し、通信伝達するように該遠隔車両を指令し、本明細書に記載されているようにホスト車両12が遠隔車両16となるように構成することができる。代替例として、2つの車両の操縦者は、手動で、そのような関係を確立することができる。しかし、いずれの構成の下においても、一旦合致経路が決定されたならば、現在のホスト車両の位置と外挿された遠隔車両の追跡位置δνHとの間の状態データ値の差異(不一致)を決定し、当該差異を所定の閾値(例えば、10%より大きいヨーレートの差異)と比較することによって、経路の逸脱が監視される。自然の車線内経路の揺らぎに許容するように構成された状態閾値を当該差異が超えた場合、逸脱と認識される。
hN=hPj+1+δhN (6)
III.合致経路の逸脱(車線変更)の検出
ホスト車両12は、外挿位置においてその状態データ値が遠隔車両の状態データ値と略合致しているとき(即ち、受容可能な測定及びセンサー誤差制限値内にあるとき)合致経路を維持している。ホスト車両12は、追跡している遠隔車両及びホスト車両12が合致経路を持っているか否かを自動的に決定すると共に、追跡している遠隔車両にメッセージを分配して、経路逸脱の存在を監視し、通信伝達するように該遠隔車両を指令し、本明細書に記載されているようにホスト車両12が遠隔車両16となるように構成することができる。代替例として、2つの車両の操縦者は、手動で、そのような関係を確立することができる。しかし、いずれの構成の下においても、一旦合致経路が決定されたならば、現在のホスト車両の位置と外挿された遠隔車両の追跡位置δνHとの間の状態データ値の差異(不一致)を決定し、当該差異を所定の閾値(例えば、10%より大きいヨーレートの差異)と比較することによって、経路の逸脱が監視される。自然の車線内経路の揺らぎに許容するように構成された状態閾値を当該差異が超えた場合、逸脱と認識される。
より好ましくは、図4に示されるように、システム10は、複数の照合状態(例えば、ヨーレート、進行方向、及び、横方向距離)を検知、決定し、各々の差異を決定するように構成される。この構成における逸脱は、各々の状態の差異がその対応する閾値を超える場合にのみ生じる。しかし、代替例として、多重状態分析を、それらを代替又は並列とみなすことによって余剰を提供するように構成することができる。例えば、GPSシステム、ヨーレートセンサー、操舵角度センサー及び旋回信号作動センサーの有効性/作動、並びに、閾値が差異により超えられたか否かに応じて、+1、0又は−1のポイントを重み付け因子に帰する、ルーチンを利用することができる。図4aに示されるように、そのようなルーチンは、一つのポイントに帰する前に両方の満足を要求することにより、関連する閾値への重み付けをより少なく寄与すると共に、総合した重み付け因子が2より大きい場合には、経路逸脱を決定し、経路逸脱の他の車両を警告ように構成されてもよい。最終的には、好ましい閾値は、ユーザーの趣向及び/又は用途に従って変わり得る。
前述したように、システム10は、サンプリング周期の間に複数の現在のホスト車両位置において状態差異を決定するように構成される。該周期は、差異プロフィールを形成するように、開始時刻tから終了時間TLを介して延長する。この構成では、与えられた条件に対して差異の総累積値は、次式に従って決定される。
かくして、各々総合した差異は、経路逸脱を決定するため対応する総累積閾値と比較されるのが好ましい。多重入力又は累積方法を利用することは、単一の変則データの入力に基づいて生成される警告の機会を減少させることが理解されよう。
IV. 車線変更のプロフィール(兆候)
例えばヨーレートδνH等の経路逸脱(即ち車線変更)期間の間における状態変化データ値のばらつきは、経路逸脱プロフィールを与えている。図5及び図6に示されるように、状態変化率ΔδνHは、プロフィールの急勾配により与えられている。プロフィールを分析することにより、複数の逸脱カテゴリーを変化率に応じて区別することができる。例えば、急な逸脱対緩やかな逸脱の関係を決定し、遠隔車両16に警告することができる。ここで、より短い期間TL及びより大きい最大値即ちピークΔνHMAXは、急な(突然の)逸脱を示し、より長い期間TL及びより小さいピークΔνHMAXは、滑らかな逸脱(緩やかな逸脱)を示している。
IV. 車線変更のプロフィール(兆候)
例えばヨーレートδνH等の経路逸脱(即ち車線変更)期間の間における状態変化データ値のばらつきは、経路逸脱プロフィールを与えている。図5及び図6に示されるように、状態変化率ΔδνHは、プロフィールの急勾配により与えられている。プロフィールを分析することにより、複数の逸脱カテゴリーを変化率に応じて区別することができる。例えば、急な逸脱対緩やかな逸脱の関係を決定し、遠隔車両16に警告することができる。ここで、より短い期間TL及びより大きい最大値即ちピークΔνHMAXは、急な(突然の)逸脱を示し、より長い期間TL及びより小さいピークΔνHMAXは、滑らかな逸脱(緩やかな逸脱)を示している。
最終的には、逸脱の方向に関する更なる分類分けが、図5及び図6に示されるように、当該プロフィールから識別することができる。ΔνHの符合は、逸脱方向(例えば、右旋回又は左旋回)を示している。ここで、正のプロフィールは、右旋回逸脱を表し(図5参照)、負のプロフィールは、左旋回逸脱を表している(図6参照)。
前述した本発明の好ましい形態は、例示のみとして使用されるべきであり、本発明の範囲を解釈する際に限定的な意味で利用されるべきではない。例示としての実施例及び本願明細書に記載された操作方法への明らかな変更は、本発明の精神から逸脱すること無く、当業者により容易になすことができる。本願発明者らは、添付した請求の範囲に記載された本発明の文言上の範囲から実質的に逸脱しないが文言上の範囲外にある任意のシステム又は方法が属するものとして本発明の合理的な公正の範囲を決定し、評価する際に均等論に頼る意図を表明する。
Claims (17)
- 移動するホスト車両で使用するための追跡システムであって、
前記ホスト車両は、該ホスト車両に先行する少なくとも1つの移動する遠隔車両から間隔を隔てられ且つ通信接続されており、
前記追跡システムは、
前記ホスト車両及び前記少なくとも1つの遠隔車両に関する現在位置及び軌跡座標の組を少なくとも一定期間に亘って決定し、格納させるように構成された位置突き止め装置と、
前記格納した遠隔車両の位置における該遠隔車両に関連した状態のデータ値を少なくとも一定期間に亘って決定し、格納させるように構成された遠隔車両センサーと、
前記現在のホスト車両の位置における該ホスト車両に関連した状態のデータ値を少なくとも一定期間に亘って決定し、格納させるように構成されたホスト車両センサーと、
前記装置及び前記センサーに通信接続されたホスト車両コントローラと、
を備え、
前記ホスト車両コントローラは、
前記ホスト車両と前記遠隔車両との前記現在位置及び軌跡座標を比較して、該両車両の相対位置を決定し、
前記遠隔車両が前記ホスト車両に先行するとき、前記現在のホスト車両位置に対して2つの最も近接する遠隔車両軌跡座標における前記格納された遠隔車両データ値を、前記ホスト車両現在位置データ値と比較して、これらのデータ値の間の差異を自動的に決定し、
前記差異を閾値と比較して、前記ホスト車両による合致経路の逸脱を決定し、前記データ値、差異及び閾値は、前記ホスト車両による前記合致経路の逸脱を示すように協働的に構成されている、追跡システム。 - 前記遠隔車両センサー及び前記ホスト車両センサーの各々は、ヨーレートジャイロを備え、前記状態は、特定の車両の瞬間的なヨーレートνである、請求項1に記載の追跡システム。
- 前記遠隔車両センサー及び前記ホスト車両センサーの各々は、操舵角度センサーであり、前記状態は、特定の車両のハンドル角度である、請求項1に記載の追跡システム。
- 前記遠隔車両センサー及び前記ホスト車両センサーの各々は、旋回信号作動センサーであり、前記状態は、特定の車両の旋回信号作動の状態ステータスである、請求項1に記載の追跡システム。
- 前記コントローラは、前記遠隔車両センサー及び前記ホスト車両センサーの各々に関する、前記位置の各々における進行方向hを決定し、現在の位置座標における前記ホスト車両の進行方向を、前記2つの最も近接した軌跡座標の組における前記格納された遠隔車両の進行方向と比較し、これらの進行方向の差異を決定するように更に構成されている、請求項1に記載の追跡システム。
- 前記コントローラは、前記2つの最も近接する軌跡座標の組により画定されたラインに沿った、前記現在のホスト車両位置に対する最近接点を三角法で決定し、前記2つの最も近接する軌跡座標の組における前記座標データ値に基づいて前記最近接点において相関状態データ値を外挿するように更に構成されている、請求項1に記載の追跡システム。
- 前記コントローラは、次式に従って、前記最近接点において遠隔車両状態値を外挿するように構成されており、
(Δ(データ値)Pj/Pj+1Pj)(Pj+1N)
ここで、Δ(データ値)Pjは、前記現在のホスト車両位置に対する、前記2つの最も近接する遠隔車両軌跡位置の組におけるデータ値の間の差異に等しく、
Pj+1Pjは、前記2つの最も近接する遠隔車両軌跡位置の組の間の直線距離であり、
Pj+1Nは、前記外挿位置と、前記2つの最も近接する遠隔車両軌跡位置のうち先行する位置との間の直線距離である、請求項6に記載の追跡システム。 - 前記コントローラは、前記ホスト車両の現在位置及び軌跡座標と相関する外挿遠隔車両軌跡座標とに基づいて、前記期間内で横方向距離の変化を決定すると共に、前記横方向距離の変化を距離閾値と更に比較して前記合致経路の逸脱を決定するように更に構成されている、請求項6に記載の追跡システム。
- 前記コントローラは、前記期間の間に複数のホスト車両位置におけるデータ値の差異を決定し、これら複数の差異と、該複数の差異及び前記期間に基づいて得られる差異プロフィールと、累積した差異の総和とを決定し、該総和を累積閾値と比較して、前記期間の間の前記ホスト車両による合致経路の逸脱を決定するように更に構成されている、請求項1に記載の追跡システム。
- 前記コントローラは、前記差異プロフィールを複数の異なる閾値と比較して、前記ホスト車両による合致経路の逸脱の複数のカテゴリーのうち一つを決定するように更に構成されている、請求項9に記載の追跡システム。
- 前記コントローラは、前記差異プロフィールによって急な逸脱又は緩やかな逸脱を決定するように更に構成されている、請求項10に記載の追跡システム。
- 前記コントローラは、前記差異プロフィールによって左旋回又は右旋回の逸脱を決定するように更に構成されている、請求項10に記載の追跡システム。
- 移動するホスト車両で使用するための追跡システムであって、
前記ホスト車両は、該ホスト車両に先行する少なくとも1つの移動する遠隔車両から間隔を隔てられ且つ通信接続されており、
前記追跡システムは、
前記ホスト車両及び前記少なくとも1つの遠隔車両に関する現在位置及び軌跡座標の組を少なくとも一定期間に亘って決定し、格納させるように構成された位置突き止め装置と、
前記格納した遠隔車両の位置の各々における該遠隔車両の瞬間的なヨーレートのデータ値を少なくとも一定期間に亘って決定し、格納させるように構成された遠隔車両ヨージャイロと、
前記現在のホスト車両の位置における該ホスト車両の瞬間的なヨーレートのデータ値を少なくとも一定期間に亘って決定し、格納させるように構成されたホスト車両ヨージャイロと、
前記装置及び前記ジャイロに通信接続されたホスト車両コントローラと、
を備え、
前記ホスト車両コントローラは、
前記ホスト車両と前記遠隔車両との前記現在位置及び軌跡座標を比較して、該両車両の相対位置を決定し、
前記位置の各々において前記ホスト車両及び前記遠隔車両の各々に対する進行方向を決定し、
前記遠隔車両が前記ホスト車両に先行するとき、前記現在のホスト車両位置に対して2つの最も近接する遠隔車両追跡座標における前記格納された遠隔車両ヨーレート及び進行方向を、前記ホスト車両の現在位置のヨーレート及び進行方向と比較して、これらのデータ値の間の差異を自動的に決定し、
前記差異を複数の異なる閾値と比較して、前記ホスト車両による合致経路の逸脱の複数のカテゴリーのうち一つを決定するように構成されている、追跡システム。 - 合致して移動する遠隔車両と通信接続することにより、移動するホスト車両の経路逸脱を検出する方法であって、
(a) 前記移動する遠隔車両及びホスト車両の現在位置及び軌跡座標の複数の組を決定し、
(b) 前記複数の座標の組を比較して前記両車両の相対位置を決定し、
(c) 前記複数の座標の組が、前記遠隔車両が前記ホスト車両に先行することを示すとき、前記座標の各組における前記両車両の相対的進行方向を決定し、前記ホスト車両のその現在位置における進行方向及び現在のホスト車両位置に対して2つの最も近接する遠隔車両軌跡座標を比較して、進行方向の差異を決定し、
(d) 前記差異の各々を各閾値と比較して前記ホスト車両による経路逸脱を決定し、
(e) 車両間通信を利用して、前記ホスト車両の経路逸脱を前記遠隔車両に連絡する、各工程を備える方法。 - 前記工程(a)及び(c)は、前記移動する遠隔車両及びホスト車両の各組の座標におけるヨーレートを検出する工程と、前記複数の座標の組が、前記遠隔車両が前記ホスト車両に先行することを示すとき、前記ホスト車両のその現在位置におけるヨーレート及び進行方向と、前記2つの最も近接する遠隔車両軌跡座標とを比較して、ヨーレート及び進行方向の差異を決定する工程と、を更に備える、請求項14に記載の方法。
- 前記工程(a)及び(c)は、一定期間の間の多数の瞬間において、現在のホスト車両位置と前記2つの最も近接する遠隔車両軌跡座標により画定されたラインとの間の最短距離を決定する工程と、前記複数の座標の組が、前記遠隔車両が前記ホスト車両に先行することを示すとき、ヨーレート、進行方向及び最短距離を比較して、前記ヨーレート、進行方向及び最短距離の差異を決定する工程と、を更に備える、請求項14に記載の方法。
- 前記工程(a)及び(c)は、ヨーレート、操舵角度又は旋回信号動作を検出する工程と、一定期間の間の多数の瞬間において、現在のホスト車両位置と前記2つの最も近接する遠隔車両軌跡座標により画定されたラインとの間の最短距離を決定する工程と、前記複数の座標の組が、前記遠隔車両が前記ホスト車両に先行することを示すとき、ヨーレート、進行方向及び最短距離を比較して、前記ヨーレート、進行方向及び最短距離の差異を決定する工程と、を更に備え、
前記工程(d)は、旋回信号動作ステータス及び差異と閾値との比較に基づいて重み付け因子を決定する工程と、該重み付け因子を重み付け閾値と比較して経路の逸脱を決定する工程を更に備える、請求項14に記載の方法。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US11/207,168 US7729857B2 (en) | 2005-08-18 | 2005-08-18 | System for and method of detecting a collision and predicting a vehicle path |
US11/436,497 US7920969B2 (en) | 2005-08-18 | 2006-05-18 | System for and method of determining a host vehicle lane change |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2007095038A JP2007095038A (ja) | 2007-04-12 |
JP2007095038A5 true JP2007095038A5 (ja) | 2009-09-10 |
Family
ID=37905478
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2006223394A Pending JP2007095038A (ja) | 2005-08-18 | 2006-08-18 | ホスト車線を決定するシステム及び方法 |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP2007095038A (ja) |
DE (1) | DE102006038160B4 (ja) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102008047700A1 (de) * | 2008-09-18 | 2010-03-25 | GM Global Technology Operations, Inc., Detroit | Kraftfahrzeug mit einem Kommunikationssystem und einem Spurassistenzsystem |
JP5761162B2 (ja) | 2012-11-30 | 2015-08-12 | トヨタ自動車株式会社 | 車両位置推定装置 |
WO2015170869A1 (ko) * | 2014-05-07 | 2015-11-12 | 서울대학교산학협력단 | 협력 통신을 이용하여 주변 이동체를 탐지하는 방법 및 시스템 |
KR101637374B1 (ko) * | 2014-05-07 | 2016-07-07 | 서울대학교산학협력단 | 협력 통신을 이용하여 주변 이동체를 탐지하는 방법 및 시스템 |
US11320284B2 (en) * | 2017-12-15 | 2022-05-03 | Regents Of The University Of Minnesota | Real-time lane departure detection using map shape points and trajectory histories |
US11958485B2 (en) | 2018-03-01 | 2024-04-16 | Jaguar Land Rover Limited | Vehicle control method and apparatus |
GB2571590A (en) * | 2018-03-01 | 2019-09-04 | Jaguar Land Rover Ltd | Vehicle control method and apparatus |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5572449A (en) * | 1994-05-19 | 1996-11-05 | Vi&T Group, Inc. | Automatic vehicle following system |
JPH1120499A (ja) * | 1997-06-27 | 1999-01-26 | Mitsubishi Motors Corp | 自動追従走行システム |
JP4190660B2 (ja) * | 1999-05-31 | 2008-12-03 | 本田技研工業株式会社 | 自動追従走行システム |
JP3658519B2 (ja) * | 1999-06-28 | 2005-06-08 | 株式会社日立製作所 | 自動車の制御システムおよび自動車の制御装置 |
JP2001255937A (ja) * | 2000-03-10 | 2001-09-21 | Toshiba Corp | 車両用自動走行制御装置 |
JP2003022130A (ja) * | 2001-07-05 | 2003-01-24 | Tsubakimoto Chain Co | 搬送台車及び搬送台車の操舵制御方法 |
-
2006
- 2006-08-16 DE DE102006038160.2A patent/DE102006038160B4/de not_active Expired - Fee Related
- 2006-08-18 JP JP2006223394A patent/JP2007095038A/ja active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7920969B2 (en) | System for and method of determining a host vehicle lane change | |
CN105937912B (zh) | 车辆的地图数据处理装置 | |
US9937860B1 (en) | Method for detecting forward collision | |
US9514642B2 (en) | Method for detecting traffic jams using a wireless vehicle to vehicle communication system | |
US7474961B2 (en) | System to determine the path of a vehicle | |
US8954260B2 (en) | Method and system for collision assessment for vehicles | |
JP2019532292A (ja) | 車両位置特定の自律走行車両 | |
US20160146618A1 (en) | Method to gain driver's attention for autonomous vehicle | |
US20120303222A1 (en) | Driver assistance system | |
US10030978B2 (en) | System and method for detection of surrounding vehicle lane departure | |
US10239452B1 (en) | Minimizing false collision avoidance warnings | |
JP2007095038A5 (ja) | ||
JP2007095038A (ja) | ホスト車線を決定するシステム及び方法 | |
KR102487155B1 (ko) | 교통 취약자 충돌 방지를 위한 시스템 및 방법 | |
US11845471B2 (en) | Travel assistance method and travel assistance device | |
US11738776B2 (en) | Perception performance evaluation of a vehicle ADAS or ADS | |
US10629073B2 (en) | Method, device and system for wrong-way driver detection | |
US20160027304A1 (en) | On-board vehicle control system and method for determining whether a value is within an area of interest for extraneous warning suppression | |
US20210312726A1 (en) | Asset and Vehicle Coupling | |
WO2016178613A1 (en) | Device and method for managing communication for a vehicle | |
US11099579B2 (en) | System for determining the number of remote vehicles following a host vehicle | |
US9031758B1 (en) | On-board vehicle control system and method for determining whether a vehicle is within a geographical area of interest | |
EP4078557A1 (en) | Intersection trajectory determination and messaging | |
US11059480B2 (en) | Collision avoidance system with elevation compensation | |
JP2019519044A (ja) | 逆走ドライバを検出するための方法、装置、およびシステム |