JP5411284B2 - 実際の軌道を進行している車両の横方向のずれを、推定された仮想道路に基づいて決定し、横方向のずれに基づき運転者の横方向制御能力を決定するための方法、システム及びコンピュータプログラム製品 - Google Patents

実際の軌道を進行している車両の横方向のずれを、推定された仮想道路に基づいて決定し、横方向のずれに基づき運転者の横方向制御能力を決定するための方法、システム及びコンピュータプログラム製品 Download PDF

Info

Publication number
JP5411284B2
JP5411284B2 JP2011534420A JP2011534420A JP5411284B2 JP 5411284 B2 JP5411284 B2 JP 5411284B2 JP 2011534420 A JP2011534420 A JP 2011534420A JP 2011534420 A JP2011534420 A JP 2011534420A JP 5411284 B2 JP5411284 B2 JP 5411284B2
Authority
JP
Japan
Prior art keywords
road
driver
vehicle
data
lateral
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
Application number
JP2011534420A
Other languages
English (en)
Other versions
JP2012507780A (ja
Inventor
マルックラ,グスタブ
サンドブロム,フレデリク
Original Assignee
ボルボ テクノロジー コーポレイション
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by ボルボ テクノロジー コーポレイション filed Critical ボルボ テクノロジー コーポレイション
Publication of JP2012507780A publication Critical patent/JP2012507780A/ja
Application granted granted Critical
Publication of JP5411284B2 publication Critical patent/JP5411284B2/ja
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06Road conditions
    • B60W40/076Slope angle of the road
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06Road conditions
    • B60W40/072Curvature of the road

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Mathematical Physics (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

本発明は、道路データを決定するための方法及びシステムに関する。
車両が走行している道路に関する知識は、実際の軌道が正常な範囲にあるかどうか、又は、理想上の軌道と実際の軌道との間の横方向のずれ若しくは横方向のずれのパターンが運転者の横方向制御能力の低下を示し得るかどうかを決定するための基準(根拠)である。
理想上の軌道とは、実際の道路上で、運転者の最適な横方向制御能力(すなわち、運転者が車線を維持し又は望ましい経路を進行する能力)下で車両が進行すべきであった経路を意味する。実際の軌道とは、車両が実際に進行した経路を意味する。
横方向制御能力の低下が、運転者の不注意(例えば、眠気、注意散漫及び/又は作業負荷により生じる)を示す場合がある。従って、現行の技術から知られる複数の方法及びシステムにおいて、実際の軌道と実際の道路の車線との間の横方向のずれが、運転者の不注意を評価するための測定値として用いられる。
例えば、特許文献1は、車両が走行している道路を、道路の左側レーンマーカ又は右側レーンマーカを画像化するCCDカメラを用いることにより決定することを提示している。車線内の車両位置が、車両の中央から左側レーンマーカまでの横方向距離及び道路幅から算出されることができる。カメラの代わりに、道路下に埋設された磁気ネイルに基づく道路−車両通信システムを用いることもでき、また、GPSに基づくナビゲーションシステムを、横方向変位(横変位)を検出するために用いることができる。さらに、ステアリング角度から横方向変位を検出することが可能であるため、横方向変位検出部がステアリング角度センサを用いることができる。さらに、ヨーレート又は横方向加速度(横加速度)を検出することにより横方向変位が推定され得る。車両の横方向の揺れ又は揺らぎが測定され、変位量のデータが、周波数成分を得るために記憶される。このシステムは、運転者が不注意であるかどうかを横方向変位の周波数に基づいて決定することができる。
特許文献2は、運転者の覚醒状態を検出するために周波数に基づく方法を用いることにより、運転者の覚醒状態の正確な推定が常に可能ではないという問題について述べている。例えば、山間の、異なる屈曲方向にて連続的なカーブを有するハイウェイにて、通常のレベルの覚醒状態にある運転者は、ステアリングホイールを比較的小さいステアリング角度で左右に回転させることにより車を運転する。このような場合のステアリングホイールの回転は、ふらつきの決定のために用いられる低周波数成分として抽出され易く、これが誤決定を生じさせることがある。従って、この文献に記載されている方法は、複数のカーブを有する道路に関して言及するために、道路形状に基づいた(road-shape-based)補正値を用いる。この道路形状に基づいた補正値は、レーントラッキング(車線追跡)センサの出力から導出される(レーントラッキングセンサは、車両の走行方向にて車両の前方に位置する左側レーンマーキング及び右側レーンマーキングを、車両上に配置されたCCD(固体撮像装置)を用いた立体カメラ又は単レンズカメラにより得られる画像に基づいて認識する)。車線内での変位に関する正確なデータを得るために、車線認識結果補正装置が、道路上に配置されたレーンマーキングのタイプを、認識された車線幅に基づいて、予め設定された複数のレーンマーキングのタイプの1つとして特定する。車線幅は、レーントラッキングセンサにより認識される左側レーンマーキングの位置と右側レーンマーキングの位置との差から得られる。車線認識補正装置は、さらに、車両の運転方向に対して垂直な方向における車両の変位(横方向変位)を、このようにして特定されたレーンマーキングのタイプに基づいて検出する。
道路に対する車両の位置を決定するための上記の例示的な方法の全てにおいて、「レーントラッカ」(“lane tracker”)(車線追跡)センサが用いられる。このセンサは、車両の道路上又は車線内での実際の位置を、そして、選択的には前方道路の形状も測定することができ、こうして、車線境界又は道路自体が理想上の軌道を画定する。レーントラッカは多数の様々な技術に基づくことができ、最も一般的な技術は前方監視カメラセンサである。車線位置を測定するために車両に取り付けられたカメラセンサは以前より市販されており、車線境界が意図的でなく交差された場合に運転者に警告すること(「車線逸脱警告(“lane departure warning”)」)を目的としている。
幾つかの場合において、運転者に横方向制御能力の低下を知らせるための時間スケールは、例えば車線逸脱警告、衝突警告又はその他のタイムクリティカルな(スピード重視の)システムのための時間スケールと同程度に最小化される必要はない。特に、運転者の不注意が検出されなければならない場合、時間スケールは、数秒又は1秒未満といった短時間ではなく、数10秒又は数分までも拡大されることができる。このような拡大が可能な理由は、運転者の不注意、例えば眠気がゆっくりとしたプロセスであり、数秒ではなく、むしろ、数10秒又は数分の範囲内でも変化するからである。これは、運転者の状態に関する結論を、検出された実際の軌道に基づいて導く機会をもたらし、例えば、車両の実際の位置を検出するセンサから収集された過去のデータを用いることが可能である。
このようなシステム及び方法が、例えば、特許文献3に記載されている。このシステム及び方法において、道路に沿った車両の実際の軌道、及び道路自体は、車両環境のデータ代表値(すなわち、道路に対する車両の横方向位置)、並びに、適切な車両状態パラメータ(例えば、車両速度及びヨーレート)により決定され、道路又は車線は、好ましくはレーントラッキングシステムにより観察される。この公知のシステム及び方法は、車両の力学特性に関する、以前の時点で収集された情報(例えばヨーレート)に基づいて、運転者が意図した経路の推定値(すなわち、以前の時点で運転者が進行しようとしたと見られる経路)を計算し、この意図された経路を、観察された実際の車線と比較する。実際の道路の形状寸法と、運転者が以前の時点で意図した経路との間の偏差が、運転者の不注意を示すものと見なされる。車両環境のデータ代表値を決定するために、車線位置システム、例えば、カメラ(例えば、前方監視単眼カメラ)が用いられる。
この公知のシステムの主な欠点は、車両の環境を決定するためのセンサ(特には、車線に対する車両の位置を決定するためのカメラ)が、ロバスト性及び信頼性において限界を有することである。例えば、センサデータが不正確であり、又は全く利用不可能なことが時々生じ得る。これは、センサ自体の技術的限界による場合もあり、また、外的な問題(例えば道路の摩耗により、或いは、例えば水又は雪がマーキングを覆っているためにレーンマーキングが見え難く、又は全く見えないこと)による場合もある。さらに、レーントラッカセンサを用いることによりシステム全体のコストが増大するであろう。なぜなら、カメラのコスト、及び、カメラ画像の処理の実行に必要なコンピュータハードウェアのコストが追加される必要があるからである。
さらに、車両の横方向位置情報ではなく、幾つかの先行技術において用いられているように、ステアリングホイール角度の測定値又は車両ヨーレートの測定値を、運転者の眠気、不注意などの判定のために用いることは困難である。なぜなら、個々の運転者の挙動、及び/又は、環境による影響(例えば横風の作用)が、ステアリングホイール角度及びヨーレート信号に多くの差異を生じ、これが判定の妨げになることがあるからである。
米国特許第6,335,689号明細書 米国特許第7,084,773号明細書 欧州特許出願公開第1672389号明細書
Andreas Eidehall、Fredrik Gustafssonによる論文"Obtaining reference road geometry parameters form recorded sensor data"(「記録されたセンサデータからの道路形状寸法の基準パラメータの取得」)の256頁〜260頁
従って、本発明の目的は、道路データを決定するための、より正確でロバストな、且つ費用効率的な方法及びシステムを提供することにある。
この目的は、請求項1及び10に記載の方法、請求項14及び16に記載のシステム、並びに、請求項17及び18に記載のコンピュータプログラムにより達成される。
本発明は、実際の道路の形状寸法を、実際の道路のレーンマーキング又はその他の表示物をカメラセンサなどを用いて検出する代わりに、道路の形状寸法値が、車両が走行している実際の経路に基づいて推定され、これにより、道路設計実施、及び/又は道路に対する典型的な物理的制約の情報が用いられるという発想に基づいている。すなわち、実際の道路の形状をレーントラッカシステムを用いて観察又は検出する代わりに仮想道路が決定され、この仮想道路が、レーントラッカシステムと基本的に同一の、しかし所定の時間遅延を有するデータを提供する。そして、仮想道路は、車両の実際の経路が通常の範囲内にあるか否かを決定するための基準として機能することができる。
この方法は可能である。なぜなら、道路は特定の境界条件に従って設計されるからである。すなわち、道路の形状寸法は、例えば、特定の最大曲率により制限され、これらの最大曲率は、一般に、道路のタイプに依存する(例えば、ハイウェイは山道の最大曲率よりも低い最大曲率を有する)。道路のコースを設計するためのこれらの境界条件は既知の事実であり、従って、本発明の計算モデルにて考慮される。さらに、最大曲率値の単純閾値に加えて、道路のカーブの距離に関する変化も、一般に、明確なモデルに従っている。例えば、ヨーロッパにおいては、道路のコースを設計するために、いわゆるクロソイドモデルが用いられ、従って、このようなモデルを、好ましくは仮想道路を画成するために用いることができる。
道路の形状寸法値の推定自体は、センサシステム(特にはトラッキングシステム及びナビゲーションシステム)の性能を有効に用いるための現行技術から知られる。これらのシステムにおいて、センサデータの出力が基準データと比較されることが必要である。基準データは、例えば、GPSシステムからのデータを用いることにより得られるが、GPSの測定がわずかにより正確な場合が多い。新しい方法が、2006年6月13日〜15日に日本国の東京で開催されたインテリジェントビークルシンポジウム(Intelligent Vehicle Symposium)にて発表された非特許文献1にて提示されている。この非特許文献1において、非特許文献1の著者は、推定された道路形状寸法値を基準データとして用いることを提案し、また、適切な数学的アルゴリズムが推定の基準として用いられる場合には、得られた結果を、トラッキングシステム及びナビゲーションシステムのための基準データとして用いることができると述べている。開示されたモデルベースの道路形状寸法の推定が、車線における車両の横方向位置を推定することも可能であるとしても、このパラメータは、その他のパラメータの精度を高めるために視覚システム(すなわちカメラ)により測定される。
本発明によれば、幾つかの場合には、運転者に横方向制御能力の低下を知らせ又は警告するための時間スケールが、例えば車線逸脱警告、側方衝突警告又はその他のタイムクリティカルな(スピード重視の)システムのための時間スケールと同程度には最小化される必要がないことがさらに考慮されている。これは、本発明の仮想道路方法を、ゆっくりと変化する横方向制御能力の基準としても用いることを可能にする。従って、本文中に開示される本発明の方法及びシステムが、運転者へのタイムクリティカルな警告のために用いられることを意図されていないことが明確に留意されるべきである。
横方向制御能力の低下が、ゆっくりと進行する運転者の不注意(例えば、眠気、及び/若しくは、何らかの注意散漫、並びに/又は作業負荷タイプの不注意)による場合、時間スケールは、数秒又は1秒未満などの時間ではなく、数10秒又は数分にまでも拡大されることができる。これが、異なる方法(すなわち、仮想道路を決定する方法)を用いる機会をもたらし、これにより、技術的に複雑でコスト高なセンサからのセンサデータの代わりに、車両の実際の軌道を決定するためのデータを提供することにも適した、よりロバストなセンサからのデータを用いることができる。例えば、車両速度センサ及びヨーレートセンサ、又は、ヨーレートセンサのみを用いることができるが、その他のデータ、例えば、車両位置加速度及び/又はヨー角を組み込むこともでき、それにより、比較的単純な運動モデルが用いられる。ヨーレートセンサを用いる代わりに、車両のヨーレートをステアリングホイール角度センサにより決定することもできる。
実際の軌道を決定するために、センサデータSを用いることが適切であることが分かった。センサデータSは、好ましくは、センサ測定データの時系列であり、少なくとも、車両速度データ及び車両ヨーレートデータを含むことができる。さらに、センサデータは、車両位置データ、車両ヨー角データ、及び/若しくは、長手方向/横方向加速度データ、並びに/又は、他の任意の慣性センサのデータを含むことができる。
好ましい実施形態において、仮想道路の決定は、モデルベースの信号処理方法により実行される。この方法は、例えば、パラメトリック曲線(例えば3次スプライン)を決定された実際の軌道にフィッティングする(例えば、加重又は非加重最小二乗法による)方法である。これは、収集された信号のノイズ低減、平均化作用をもたらす。そしてこれは、ステアリングホイール角度又は車両のヨーレートの測定値(個々の運転者の挙動及び環境による影響により大きく変化する)を用いることが、仮想道路の決定の結果の質を低下させないことを意味する。さらに、走行速度に基づく情報、及び/又は、地図データからの道路タイプに関する情報を、パラメトリック曲線のフィッティングのために計算に組み込むことができる。
そしてまた、或いは、車両の位置又はロードマップデータに関するGPSデータを、仮想道路自体の決定のために計算に組み込むこともできる。これが特に好ましい状況の1つは、車両が走行している道路の形状寸法が道路設計の標準モデルに適合しない場合である。さらに、さらなる情報、例えば、個々の運転者の挙動を考慮することもできる。
別の好ましい実施形態において、実際の軌道及び仮想道路は、モデルベースの信号処理方法(又は、より一般的には、統計的信号処理方法)を用いて決定される。実際の軌道及び仮想道路を、実際の軌道に関する状態ベクトルa、仮想道路に関する状態ベクトルvr(少なくとも位置及び/又はヘディングを含む)により示すことができる。さらなる状態パラメータ(例えば、位置及びヘディングの微分値を含む)も含まれることができる。測定値及び状態ベクトルは、線形の及び/又は線形化されたフィルタリングアルゴリズム(線形処理を用いる場合には、例えばカルマンフィルタベースのトラッキング)と、測定モデルと/又は、非線形モデル(例えば自転車運動モデル)のための拡張カルマンフィルタ及び/又はアンセンテッドカルマンフィルタのトラッキングフレームワークとにて用いられることができる。
また、モンテカルロ法(例えば粒子フィルタ)も、仮想道路を決定するために適切であり得る。詳細には、モンテカルロ法をベースとした推定を用いることが好ましい。なぜなら、実際の軌道も状態ベクトルに含まれることができ、また、運転者により行われる生じ得る操作が、可能な仮説として、関連する確率と共に含まれることができるからである。
結果が即時に提供される必要はないため、道路の形状寸法又は仮想道路のそれぞれ、又は上記のパラメータ推定戦略を因果的方法に限定することは必要でない。
仮想道路は、実際の道路の形状寸法を推定したものと見なされることができるため、偏差、すなわち実際の軌道と仮想道路との間の横方向のずれが、運転者の運転能力又は運転成果を判断するために用いられ得る。従って、横方向のずれを、運転者が運転者の車両の望ましい経路のどの程度近くを維持しようとしているかを示す推定値と見なすことができる。従って、運転者の横方向制御能力に関する結論を、実際の軌道の、仮想道路からの横方向のずれの量及び/又は形状から導くことが可能である。しかし、いずれの運転者においても、運転者の注意及び努力が安全な範囲にある状況でさえも、幾らかの量の横方向の揺れが車線にて一般的に生じるであろうことに留意されたい。この主な理由は、人間の運転者が、通常、所与の軌道からの所定の逸脱範囲内のずれは許容され得ると見なすことである。
仮想道路を実際の軌道から(特には、道路の形状寸法データを推定することより)決定することにより、本発明は、運転者の挙動(例えば、カーブの真直走行若しくはカーブ無視、車線変更又は追い越し)により発生される当然の車線位置変化に対しては、感度がより低い。
以上に述べたように、幾つかの運転者支援システム(例えば、眠気の検出及び警告システム)が、長い時間スケールで機能するため、本発明の方法及び本発明のシステムは、これらの運転者支援システムにて用いられて、横方向のずれ(例えば、運転者の眠気、不注意、注意散漫、又は運転者の努力不足により生じる)をロバストで費用効率的に検出することを可能にする。これは、既存のセンサ又は標準装備のセンサ(例えば、ヨーレート又はステアリングホイール角度センサ及び速度センサ)を用いることができ、従って、既存の車両モデル又は車両プラットフォームに、本発明の方法及びシステムを、車両のハードウェア設定に影響を全く又は部分的にしか与えずに搭載することができるというさらなる利点を有する。ステアリングホイール角度又は車両のヨーレートの測定値が、運転者の挙動及び環境による影響による変動を含んでも、これらのデータは、本発明の方法及びシステムにて、結果の質を低下せずに用いられることができる。なぜなら、仮想道路の算出がこれらの因子を計算に組み込むことができるからである。
さらなる有利な実施形態において、長い時間スケールで機能する運転者支援システムは、さらにHMI(ヒューマンマシンインタフェース)(Human machine interface)を含み、これは、(i)本発明によるシステムと車両の運転者との、運転者支援システム(例えば眠気検出システム)への入力などを介しての相互作用、及び/又は(ii)運転者の挙動プロファイルを記憶するためのメモリを設けることを可能にする。これは、システムが学習可能で、従って、個々の運転者又は個々の運転挙動に適合されることができるという利点を有する。さらに、運転者は、さらなる道路データを手動で提供することが(例えば、運転者が走行している道路が、例えばハイウェイであることを明確に示すことにより)できる。
本発明のさらなる利点及び好ましい実施形態は、特許請求の範囲、詳細な説明、及び/又は図面にて定義される。
以下に、本発明を、好ましい実施形態を用いて記載する。記載される実施形態は例示的に過ぎず、本発明の範囲をこれらの実施形態に限定するために用いられるものではない。
本発明の方法の好ましい実施形態を示すフロー図である。 実際の軌道と仮想道路との間の横方向のずれを決定するための計算原理を示す概略図である。 実際の軌道の、仮想道路からの横方向のずれを示す概略図である。 本発明による実験的に導出された実際の軌道及び仮想道路のデータを、現行技術により公知のレーントラッカセンサから収集されたデータと比較した図である。
図1は、本発明の好ましい実施形態を示す。図1にて参照番号2により示されている円が、車両の実際の軌道Aを決定するための適切なデータSを提供する少なくとも1つのセンサを示している。記号S、A、VR及びdの意味を以下に説明する。ボックス4、6、8及び10が計算ユニットの計算ステップを示し、計算ステップ4において実際の軌道AがセンサデータSから決定される。次のステップ6において、仮想道路VRが実際の軌道Aから決定される。実際の軌道Aと仮想道路VRとの間の偏差又は横方向のずれが計算ステップ8にて決定される。ボックス10は計算ステップを示し、計算ステップ10において、検出されたセンサデータS、決定された実際の軌道A、及び、推定された仮想道路VRに基づいて信頼値が決定される。以下に、図1及び概略的に説明した上記のステップを、さらに詳細に説明する。
以上に説明したように、センサ又は複数のセンサのネットワークがセンサデータSを提供する。これらのセンサは、例えば、車両のヨーレートセンサ及び車両の速度センサであってよい。しかし、他のデータ(例えば、車両位置、加速度及び/又はヨー角)が組み込まれることもできる。これらのデータは、好ましくは、S=(S,S,…S)により示される、いわゆるセンサ測定データマトリクスに含まれる。Sは、測定データベクトルS(1≦j≦k)の時系列を含み、Sは、時点tにて得られる全てのセンサデータであり、Sは、時点tにて得られる全てのセンサデータであり、その他の時点で得られるセンサデータも同様である。下付文字kは、システムの現在の(最新の)時刻であり、時点tに対応している。システムにおける時間が、システムの時間単位Tのステップとして測定されるため、時点tを、t=k×Tと表記することもできる。式中、Tはシステムのサンプル速度を示す。サンプル速度は、センサにより測定されたデータが読み出されて、さらなる処理のために一時的に記憶される速度を意味する。従って、Tを、計算システムの時間単位と見なすこともできる。
好ましくは、車両は、(水平方向)車両位置x(t)、y(t)、ヨー角データψ(t)から決定される車両のヘディング、車両のヨーレートω(t)、及び車両速度v(t)に関するデータを提供するためのセンサを備える。従って、測定ベクトルは、量[x,y,ψ,v,ω]を有し、これらの量から実際の軌道Aを算出することができる(実際の軌道は、センサデータとして、車両の状態ベクトルa,a,…aを含むマトリクスA=(a,a,…a)の形態を有する)。車両の垂直方向位置z(t)を計算に組み込んで状態ベクトルに含むことも可能である。特に、車両が坂道を上下移動する場合、車両の垂直方向位置z(t)が変化し、また、横方向移動も異なり得る。垂直方向位置z(t)の情報を計算に組み込むことにより、横方向移動源の誤解釈の可能性をさらに低減することができる。
センサデータマトリクスS=(S,S,…S)は、システムの起動時より(例えば、車両のイグニションをオンにしたときから)提供され続けた全てのセンサデータを含み、実際の軌道(すなわち、車両が進行した実際の経路)を計算ユニット4(図1)により算出するための入力として機能する。こうして、センサデータから、実際の軌道の状態マトリクスA=(a,a,…a)が生成される。
センサデータマトリクスSと同様に、実際の軌道のマトリクスA=(a,a,…a)も、車両状態a(1≦j≦k)の時系列を含み、これは、実際の軌道の対応するデータ、例えば車両位置及びヘディング(例えばヨー角ψから導出される)、並びに、さらなるパラメータ(例えば、車両位置及びヘディングの第1の微分値)を含む。実際の軌道のマトリクスは、車両運動モデルの選択に依存したその他の状態の時系列データも含む。計算ステップ4は、本発明のシステムの個々の装置にて実行されることができ、又は、本発明の方法に基づいたプログラムコードを有するコンピュータプログラムを実行させるように適合された既存の搭載コンピュータの一部であってもよい。
上記の説明において、マトリクスS及びAが、システムの動作開始時からの全てのセンサデータ及び実際の軌道のデータを示すことを述べてきた。実際には、メモリの限界により、このデータの新しい部分のみが実際にシステムに(好ましくは、ファイフォ(先入れ先出し)(“FIFO”)式で)記憶され得る。この場合、予め決められた時間ステップの順番よりも古いデータはシステムにより廃棄され得る。
連続した2つの測定ベクトルの決定の間の時間間隔T(すなわち、車両状態の時系列の長さ)は、調節可能であっても、或いは、予め設定された一定の値を有してもよい。有利には、時間間隔は調節可能であり、それにより、本発明のシステムは様々な運転挙動及び状況に適応可能である。
実際の軌道マトリクスA=(a,a,…a)は、aを車両の初期状態ベクトルであるように初期化し(初期位置及びヘディングは任意に選択され得る)、次いで、例えば、必要とされる量を算出するための以下の1組の式(運動モデル)を用いることにより決定されることができる。
Figure 0005411284
式中、Δtk−1,kは、連続した2つの測定点k−1とkとの間の時間であり、この時間は、先に述べたTと、必然的にではないが、しばしば等しい。
本発明の別の実施形態において、アルゴリズムは、よりロバストな軌道決定を達成するために、線形の又は線形化されたフィルタリングアルゴリズム(例えばカルマンフィルタベースのトラッキング)を含む。この実施形態において、量[x,y,ψ,v,ω,a](aは、運転方向に沿った長手方向加速度)を有する状態ベクトルが、フィルタを有するモデル、例えば、単純化された自転車モデル、及び/又は、アンセンテッドカルマンフィルタのトラッキングフレームワークを用いて実際の車両軌道を示すのに非常に適していることが分かった。
第3の実施形態において、非線形最適化方法が用いられ、この方法において、車両の実際の軌道Aが、例えばモンテカルロ法(粒子フィルタなど)を用いて算出される。これは、道路を、例えばより低速(詳細には、例えば70km/時未満)で適切に示す固有のモデルがない状況に対処することに特に適している。同様に、車線変更操作又は追い越しなどの操作が、モデル化されてトラッキングに含まれることができる。類似の作用が、上記のような線形又は線形化されたフィルタのための多重仮説フレームワークから得られると考えられ得る。
仮想道路VRの決定が、図1の計算ステップ6にて行われる。計算ステップ6も本発明のシステムの個々の装置にて実行されることができるが、例えば、既存の搭載コンピュータが計算を実行することも可能である。或いは、この決定は、実際の軌道の決定を行うユニットと同一の計算ユニットにて実行されることができるが、別個の計算ユニットを用いることも可能である。
仮想道路VRを決定するために、道路の形状寸法が、決定された実際の軌道Aに基づいて推定される。しかし、仮想道路の計算を、本発明の出力を用いる用途の特定の条件を考慮することにより適合させることも可能である。例えば、好ましい実施形態において、本発明のシステム及び方法の出力が、運転者支援システム及び燃料消費効率システムの両方のための入力として用いられる。この場合、運転者支援システムのための入力を生成する仮想道路の計算が、この運転者支援システムに関するパラメータ(例えば、運転者の個々の操舵動作)を計算に組み込むことができる。仮想道路の計算が、燃料消費効率システムのための入力を生成する場合、仮想道路の計算は、例えば、道路のタイプ(すなわち、ハイウェイ、山道など)を考慮することができる。さらに、本発明は、意図的でない運動(例えば、運転者の不注意により生じることがあり、また、外部環境条件、例えば、横風、道路上の氷/雪/水などにより生じることもある)を計算に含めることもできる。
仮想道路VRは、道路であるかのようにパラメータ化されることができるため、仮想道路を、仮想道路の状態ベクトルvr(1≦j≦k)の時系列を含むマトリクスVR=(vr,vr,…vr)と見なすこともできる。
実際の軌道を、リアルタイムでの充分な精度を有して決定することができる場合においても、仮想道路VRを、実際の軌道での時点と同一の時点にて決定することはできない。なぜなら、本発明のシステムは、道路の形状寸法値を推定し、その値から仮想道路VRを導出するための、車両の実際の軌道に関するサンプル化された十分な情報を得るために、所定の(好ましくは、予め決められた)時間、待たなければならないからである。例えば、車両が、しばらくの間真直なラインに沿って走行しており、そしてヨーレートが検出された場合、システムは、このヨーレートが道路のカーブにより生じているのか、それとも、運転者が車線にて一時的にふらついているのかを判断できない。しかし、システムは、検出されたセンサデータに基づいて、車両の実際の軌道を決定することができる。しかし、仮想道路を決定するためには、システムは、実際の軌道が時間の経過によりどのように変化するかに関するさらなる情報を必要とする。従って、システムは、道路の形状寸法の推定又は仮想道路の計算が信頼性を有すると見なされることができる前に、所定の時間(例えば、数秒)、又は、上記の表記を用いれば、時間単位Tの倍数m×Tで表される所定の時間遅れを待たなければならず、従って、仮想道路マトリクスVRの第1のk−m要素のみが、本発明のシステムにより用いられ、且つ/又は、出力される。従って、実際の軌道マトリクスAと仮想道路マトリクスVRk−mとは、遅れm×Tだけ時間が異なる。この遅れm×Tは、一定の時間(m=定数)であっても、又は、好ましくは、可変時間(例えば、車両速度に依存する)であってもよい。これは、実際の軌道マトリクスA=(a,a,…a)が実際に仮想道路マトリクスVRk−m=(vr,vr,…vrk−m)を決定することを意味する。しかし、これは、本発明のシステム及び方法が、レーントラッカセンサと基本的に同一の情報を提供し、それがレーントラッカセンサよりも遅れた時点で行われるだけであることも意味する。
車両の状態ベクトルa、仮想道路の状態ベクトルvrは、各々、同一のタイプのデータを含むことができる(しかし、前記データに限定されない)。先に説明したように、少なくとも「位置」パラメータ(例えばデカルト座標系におけるx、y)、及び「ヘディング」パラメータが存在しなければならないが、これらの量の微分値も存在し得る。これは特に車両の状態ベクトルに関して存在し得る。なぜなら、多くの運動モデルがこれらの微分値を用いるからである。
仮想道路の計算の精度をより高めるために、さらに、例えば、GPSセンサから、又は、車両の環境を検出するレーダセンサから得られるデータを用いることができる。
本発明の一実施形態において、アルゴリズムが、3次スプラインのシーケンスの、実際の軌道マトリクスAへのフィッティングを、例えば、最小二乗法により実行し、得られたスプラインのシーケンスを、仮想道路マトリクスVRk−mのための道路の状態ベクトルとして用いる。3次スプライン以外のパラメトリック曲線を用いることも適切な選択肢である。ここで、パラメトリック曲線、可能なパラメータ値の選択、及び、個々のスプライン間の距離の選択が、好ましくは、道路設計の情報に基づいて行われることができる。
例えば、1つの好ましい実施形態において、3次スプラインは、車両が例えば70km/時で走行している場合に例えば、約20秒の間隔を有する。速度及び/又は用いられるアルゴリズムモデルに従って、測定間の時間を、例示的に選択された20秒間よりも長くすることができ(例えば、約30秒〜50秒の範囲)、又は、より短くすることができる(例えば、約5秒〜15秒の範囲)。
さらに、本発明の別の実施形態において、アルゴリズムは、道路設計に用いられる実際のモデル、例えばクロソイドモデル(このモデルのパラメータ化がヨーロッパの道路に適用される)に関する情報を、仮想道路VRの計算のために組み込むことができる。
さらに、本発明の別の実施形態において、モデルの不確定性の統計的記述がフィルタリングフレームワークにて用いられる。これにより、加重最小二乗法を行うことができ、例えば、カルマンフィルタ、若しくは拡張カルマンフィルタ、又はアンセンテッドカルマンフィルタを用いることが可能になる。
別の好ましい実施形態において、実際の軌道Aの計算とは独立にパラメトリック曲線を実際の軌道マトリクスAにフィッティングさせる代わりに、仮想道路マトリクスVRk−mを実際の軌道マトリクスAと共に計算することが可能である。これは、例えば、対応する仮想道路の状態ベクトルvr,vr,…vrk−mを、結合された状態マトリクスM=(a,a,…a,vr,vr,…vrk−m)に含み、そして、同一のモデルベースのフィルタリング技術及び非因果的フィルタリング技術を用いることにより行われる。一例は、軌道の決定のための、上述のモンテカルロ法をベースとした実施形態であり、この実施形態において、さらに、運転者の操作が、可能な仮説として、関連する確率と共に含まれることができる。
さらに、運転者の様々な操作又は様々な道路特性を示し且つ検出するために、カルマンフィルタのバンク(例えば、IMM(インタラクティブ多重モデル)フレームワーク又は静的多重モデルフレームワーク)を用いることも可能である。このようなフィルタバンクを、それぞれ実際の軌道又は仮想道路を決定するために用いることも可能である。
本発明の全ての実施形態において、意図的に行われた操作を検出及び認識することが、それらの操作がどのように検出及び認識されるかに関係なく好ましい。より詳細には、車両が単一車線を進行しているときに、通常の注意深い運転中に生じる横方向移動とは異なる車両の横方向移動を運転者が意図的に行う場合、このような操作が検出されることが好ましい。このような操作の例の2つが、車線変更及び追い越しである。このような操作は、急速に行われた場合、望ましい経路からの意図的でない逸脱としてシステムに解釈され得る横方向移動を含み得る(何故なら、結果として生じる実際の軌道が、典型的な道路のカーブよりも大きく曲がったカーブを有するからである)。従って、これらの意図された操作を検出及び認識し、それにより、例えば、対応するデータ部分を破棄し、又は、対応する低信頼度をシステム出力にて報告することが有利である。しかし、このような意図された動作が滑らかに行われた場合、結果として生じる横方向移動は、単一車線進行中の通常の注意深い運転中に生じる横方向移動と類似であり得る。この場合、この操作を検出する必要はない。むしろ、本発明の利点は、実際の車線位置情報(例えば、レーントラッカカメラから得られる)を用いる既知の方法と比較して、車両が滑らかに車線変更をしている場合においても仮想道路が計算されることができることである。
先に述べたように、幾つかの好ましい実施形態において、実際の軌道及び仮想道路が計算されると同時に、モデルベースのフィルタリング及び非因果的フィルタリング技術を用いて操作が検出される。他の実施形態において、他の検出方法(例えば、ルールベースの方法)が用いられ得る。以下に示す表1は、意図的な操作、例えば車線変更及び追い越しのためのさらなる検出の可能性を示す。
Figure 0005411284
本発明の幾つかの実施形態は、ロードマップデータベースと組み合せられ得るGPS装置(図示せず)から得られる車両位置データも含み得る。この車両位置データを、仮想道路VRの計算ステップ6の実行中に(すなわち、仮想道路を推定するために)用いることもできる。好ましい実施形態においてレーダデータも利用可能であろうから、これらのレーダデータも、仮想道路VRを算出するために用いることができる。
図1に示されている計算ステップ8において、横方向のずれdが決定される。横方向のずれdの決定は、実際の軌道と仮想道路とを互いに関連付けることにより行われる。
好ましい実施形態において、横方向のずれは、時点tにおける実際の軌道の状態ベクトルaと仮想道路の状態ベクトルvrとの間の横方向距離dとして定義される。これは、dがaとvrとの間の「符号付き横方向距離」(“signed lateral distance”)として、すなわち、正の値、負の値、又はゼロ値を有するスカラーとして算出されることを意味する。このスカラーの絶対値は、ベクトルaの位置とベクトルvrの位置との間の距離であり、aがvrの一方の側(例えば、vrのヘディングに対してvrの右側)を示すとき、dの符号は正である。そして、aがvrの他方の側を示すとき、dの符号は負である。横方向の距離dは、例えばスカラー積Δ×nとしてコンピュータにより算出されることができ、Δは、aの位置とvrの位置との間の距離であり、nは、vrのヘディングと比較して水平面にて時計回りに90度回転された、vrのヘディングの正規化された(すなわち、ノルム値を有するようにスケーリングされた)ベクトルである。
図2は、推定された仮想道路マトリクスVRk−m =(vr,vr,…vrk−m)を概略的に示し、この図において、例示的に時点t=i×T、及びt=j×Tにて、a、vr、dとa、vr、dとの関係が示されている。図に見られるように、図2は、時点t及び時点tにおける2つの横方向のずれd及びdを示す。時点tにて、aはvrの右側にあり、正の値の横方向距離dを生じ、時点tにて、aはvrの左側にあり、負の値の横方向距離dを生じている。
実際の軌道と仮想道路との関係を算出する代わりに、実際の軌道及び仮想道路に関するデータを直接出力することも可能である。或いは、実際の軌道及び仮想道路に関するデータを、算出された横方向のずれの他にさらに出力することも可能である。どのような種類のデータが出力として用いられるかは、本発明のシステムの出力を入力として用いる、さらなるシステムの要求条件により決定されることができる。横方向のずれが出力のみである場合、本発明のシステムを、その出力が所定の時間遅れて与えられるレーントラッカカメラと見なすこともできる。概して、本発明のシステムの出力の、最新時点でのデータは(そして、実際の軌道のデータも)、時点(k−m)×Tにおけるデータに常に対応すると述べられよう。その理由は、図3から理解される。
図3は、実際の軌道マトリクスA及び仮想道路マトリクスVRk−mと横方向のずれdとの関係を概略的に示す。先に説明したように、本発明の方法は、仮想道路マトリクスVRk−mを算出するために所定の時間遅れを用いることにより機能する。従って、本発明のシステムは、時点k×Tにおいて、車両の状態ベクトルa…aを含む実際の軌道マトリクスAを算出する。本発明のシステムは、これらのベクトルに基づいて、時点(k−m)×Tに関して仮想道路マトリクスVRk−mを算出する。これは、時点(k−m)×Tにおいて、仮想道路の推定により結果が示される(すなわち、車両が、例えば図3に概略的に示されているように道路のカーブを走行していることが示される)ことを意味する。図3の実線12及び14は、それぞれ、仮想道路の右の縁部及び左の縁部とみなされる。従って、仮想道路ベクトルにより仮想道路の車線の中央が定義されることも理解されよう。
先に述べたように、仮想道路は、実際の道路を推定したものと見なされるため、仮想道路を、実際の道路を進行するための最適経路を推定するために用いることができる。そして、横方向のずれdを、運転者が最適経路のどの程度近くを維持しようとしているかを示す測定値と見なすことができる。さらなるステップにおいて、横方向のずれは、運転者が、自分が意図する経路を進行しているかどうか、又は、車両が運転者の不注意によりふらついているかどうかを決定するための基準としても用いられることができる。
注意深い運転者は、当然、仮想道路の非常に近くを進行するであろう。それにより生じる横方向のずれ又は偏差dは非常に小さい。生じる偏差は、特には、気象条件(横風)、及び/又は運転者により行われる、仮想道路に沿って道路を進行するための、ステアリングホイールを補助としたわずかな駆動修正により生じ得る。一方、何らかの障害を有する、又は不注意な運転者は、横方向偏差d及び横方向速度偏差の、より大きくより極端な変化を発生させる。ここで問題となるのは、実際の距離の値ではなく、所定時間にわたり測定される横方向距離制御の総合的なパターンである。
図1に示されているさらなる計算ステップ10において、システムの計算のための1以上の信頼値が決定される。この計算ステップ10からの出力は、システムのその他の出力パラメータ(先に説明したように、S、A、VR及びdの全て又は部分集合を含み得る)により生じる信頼推定値である。信頼推定値は、例えば、出力量の各々に対して別々に、例えば、各々に関してゼロと1との間の信頼値の形態で、又は、例えば、システムの1以上の又は全ての出力パラメータに基づいた単一の全体信頼値として与えられ得る。信頼推定値の計算は、センサデータの品質を、センサ自体から報告されたものと見なすこと、及び/又は、実際のセンサ出力の特性(例えば、センサの誤動作がルールベースの方法などを用いて検出され得る)から推定されたものと見なすことを含む。信頼推定値の計算は、さらに、先に述べたような検出された操作を考慮に入れることを含み得る。なぜなら、所定の操作(例えば、突然の車線変更)中には、仮想道路VRが、実際の道路を進行するための運転者の好ましい最適な経路を真に反映しない場合があるからである。従って、このような場合、推定される横方向の偏差dの信頼値も低くなる。信頼推定値の計算にて考慮され得る別の課題は、道路設計の標準モデルに従わない道路の形状寸法の検出である。このような道路の形状寸法は、さらなる情報(典型的に、GPS及び/又は地図データに基づく)を用いて検討されることができる。
図4は、本発明による実験的に導出された実際の軌道及び算出した仮想道路のデータを、現行技術により公知のレーントラッカセンサから収集されたデータと比較した図である。この図において、データは、道路の2次元鳥瞰図(すなわち、道路より上から見られた図)として、メートルをx軸及びy軸の単位として用いて示されている。
図4のグラフ20は、慣用のレーントラッカシステムにより見られるような道路を示し、参照番号22は、検出された右側のレーンマーキングに対応し、参照番号24により示されているラインは、左側のレーンマーキングに対応している。
図4のグラフ26は、本発明のシステム及び方法により決定された実際の軌道Aを示す。実際の軌道は、車両位置及び車両ヘディングにより決定される。先に説明したように、本発明のシステムは、実際の軌道のデータと、道路の既知の物理的な制約とに基づいて仮想道路VRを決定する。仮想道路の状態ベクトルにより画定される仮想道路の中央がグラフ28により示されている。道路が1以上の車線を含む場合、仮想道路は、単一車線の中央に対応する。
グラフ20とグラフ26とを比較すると、レーントラッカセンサにより検出される実際の道路のコースと仮想道路のコースとが非常に類似していることが示される。また、本発明のシステム及び方法が、仮想道路の決定が、既知のレーントラッカシステムで生じるような測定の失敗又は不確実性(図4に、円30、円32及び円34により示す)により影響されないという利点を有することも理解されよう。これらの測定の失敗又は不確実性は、レーントラッカセンサが、時々、レーンマーキングの検出に失敗し(例えば参照番号34を参照)、又は、タールマカダム舗装道路の端部をレーンマーキングと認識する(例えば、参照番号30及び参照番号32を参照)という事実による。これとは対照的に、本発明のシステムにより決定される仮想道路は、実際の道路の形状に正確に従っている。
公知のレーントラッカと、本発明の方法により得られるデータとを比較すると以下のことが分かる。すなわち、慣用のレーントラッカシステムを本発明の方法及びシステムに替えることは、技術的に可能なだけでなく、車両が走行している道路の道路データを決定するときに、より長い(約数分又は数秒の)時間スケールをミリ秒の代わりに用いることができるならば、より良好でロバストな結果をもたらす。
2 センサ
4 計算ステップ
6 計算ステップ
8 計算ステップ
S 変数
A 実際の軌道
VR 仮想道路
10 計算ステップ
12 仮想道路の右の縁部
14 仮想道路の左の縁部
20 道路
22 右側のレーンマーキング
24 左側のレーンマーキング
26 実際の軌道
28 仮想道路の中央
30 レーントラッカシステム測定の失敗

Claims (17)

  1. 実際の軌道(A)を進行している車両の横方向のずれ(d)を、推定された仮想道路(VR)に基づいて決定し、前記横方向のずれ(d)に基づき運転者の横方向制御能力を決定するための方法であって、前記実際の軌道(A)及び前記仮想道路(VR)が、複数のステップにより決定される方法であり、前記複数のステップは、
    前記車両の前記実際の軌道(A)を決定するために適した変数(S)を測定するステップと、
    前記測定された変数(S)から前記実際の軌道(A)を決定するステップと、
    前記決定された実際の軌道(A)に基づいて道路の形状寸法値を推定するステップと、
    前記推定された道路の形状寸法値及び実際の軌道(A)に基づいて、前記車両が辿っている前記仮想道路(VR)を決定するステップとからなる方法。
  2. さらに、前記横方向のずれ(d)が予め決められた範囲内にあるかどうかを決定するステップを含む請求項1に記載の方法。
  3. 前記横方向のずれ(d)の前記予め決められた範囲を決定するために、運転者による意図的な追い越し及び/又は車線変更などの生じ得る操作、及び/又は、少なくとも1人の運転者の個々の運転挙動に関する情報が用いられ、前記運転挙動が、好ましくは前記運転者のプロファイルの一部としてデータベースに記憶され、且つ/又は、このような意図的な操作及び/又は運転者の個々の運転挙動に起因する前記横方向のずれ(d)の量及び/又は形状が分析される請求項2に記載の方法。
  4. 前記決定された横方向のずれ(d)、実際の軌道(A)及び仮想道路(VR)データの少なくとも1つにより決定される前記運転者の横方向制御能力が、運転者の不注意を評価するための基準として用いられる請求項1乃至3のいずれか一項に記載の方法。
  5. 道路の形状寸法値を推定するために、且つ/又は前記仮想道路(VR)を決定するために、道路の設計実行及び/又は道路に対する典型的な物理的制約の情報が用いられる請求項1乃至4のいずれか一項に記載の方法。
  6. 推定される道路の形状寸法値が、パラメトリック曲線などのモデルに含まれ、前記パラメトリック曲線が、好ましくは、道路の形状寸法をモデル化するのに適した3次スプライン、及び/若しくはクロソイド、並びに/又は、3次スプラインとクロソイドとの組合せである請求項1乃至5のいずれかに記載の方法。
  7. 前記実際の軌道(A)を決定するための前記測定された変数(S)が、検出された車両データ、特には、車両速度データ、及び/又は、車両ヨーレートデータ、及び/又は、車両位置データ、及び/又は、車両加速度データ、及び/又は、車両ヨー角データを含む請求項1乃至6のいずれかに記載の方法。
  8. 前記実際の軌道(A)の決定が、線形及び/又は非線形フィルタリングアルゴリズムを前記測定された変数(S)に適用することにより実行される請求項1乃至7のいずれかに記載の方法。
  9. 前記仮想道路(VR)の決定が、前記モデルを前記実際の軌道にフィッティングすることにより行われ、前記フィッティングが、好ましくは、加重又は非加重最小二乗最適化により行われ、且つ/又は、前記フィッティングが、線形及び/又は非線形フィルタリングアルゴリズムを前記実際の軌道(A)に適用することにより行われる請求項6に記載の方法。
  10. 前記フィルタリングアルゴリズムが、単一の仮説フィルタ、好ましくは最小平均二乗誤差推定量、及び/又は、線形及び/又は線形化されたフィルタ、特には、カルマンフィルタ若しくは拡張カルマンフィルタ又はアンセンテッドカルマンフィルタを含むフィルタリングアルゴリズムであるか、若しくは、複数の仮説、例えばカルマンフィルタのバンク、特には、拡張カルマンフィルタ及び/又はアンセンテッドカルマンフィルタのバンクを処理することができるフィルタリングアルゴリズムであるか、又は、モンテカルロ法、特には粒子フィルタである請求項8又は9に記載の方法。
  11. 前記仮想道路(VR)の前記決定が、前記実際の軌道(A)の前記決定と共同に行われる請求項1乃至10のいずれかに記載の方法。
  12. 前記仮想道路(VR)を決定するために、さらなる道路情報、特には、前記車両位置のGPSデータ及び/又はロードマップデータが計算に組み込まれ、且つ/又は、少なくとも1人の運転者の個々の運転挙動に関する情報が計算に組み込まれ、前記運転挙動が、好ましくは、前記運転者のプロファイルの一部としてデータベースに記憶される請求項1乃至11のいずれかに記載の方法。
  13. 実際の軌道(A)を進行する車両の仮想道路(VR)上での横方向のずれ(d)を決定し、前記横方向のずれ(d)に基づき運転者の横方向制御能力を決定するためのシステムであって、前記実際の軌道(A)及び前記仮想道路(VR)を、請求項1乃至12のいずれか一項に記載の方法のステップに従って計算するための計算ユニットを備えたシステム。
  14. 車両速度データを検出するためのセンサ、特には速度計、並びに/又は、車両のヨーレートデータを検出するためのセンサ、並びに/又は、車両位置データ及び/若しくはロードマップデータを提供するGPS装置、並びに/又は、運転者の操作を検出するための手段、特には、追い越し及び/又は車線変更を検出するためのターンインジケータの起動、並びに/又は、追い越しを検出するために加速度プロファイルを決定するためのデバイス若しくは装置を備えた請求項13に記載のシステム。
  15. 請求項1乃至12のいずれか一項に記載の方法に従って運転者の横方向制御能力を決定するための請求項13乃至14のいずれか一項に記載のシステムを備えた、運転者の不注意を検出するためのシステム。
  16. 請求項1乃至12のいずれか一項に記載の方法を実行するように、又は請求項1乃至12のいずれか一項に記載の方法にて用いられるように適合されたソフトウェアコードを含むコンピュータプログラム製品であって、前記プログラムがプログラミング可能なマイクロコンピュータにて実行され、且つ/又は、前記コンピュータプログラムが、好ましくは、インターネットに接続されたコンピュータ上で実行されるときにサポートユニット又は前記サポートユニットのコンポーネントの1つにダウンロードされるように適合されているコンピュータプログラム製品。
  17. コンピュータ上で請求項1乃至12のいずれか一項に記載の方法で用いられるためのソフトウェアコードを含む、コンピュータ可読媒体に格納されたコンピュータプログラム製品。
JP2011534420A 2008-11-06 2008-11-06 実際の軌道を進行している車両の横方向のずれを、推定された仮想道路に基づいて決定し、横方向のずれに基づき運転者の横方向制御能力を決定するための方法、システム及びコンピュータプログラム製品 Expired - Fee Related JP5411284B2 (ja)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/SE2008/000631 WO2010053408A1 (en) 2008-11-06 2008-11-06 Method and system for determining road data

Publications (2)

Publication Number Publication Date
JP2012507780A JP2012507780A (ja) 2012-03-29
JP5411284B2 true JP5411284B2 (ja) 2014-02-12

Family

ID=42153072

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2011534420A Expired - Fee Related JP5411284B2 (ja) 2008-11-06 2008-11-06 実際の軌道を進行している車両の横方向のずれを、推定された仮想道路に基づいて決定し、横方向のずれに基づき運転者の横方向制御能力を決定するための方法、システム及びコンピュータプログラム製品

Country Status (6)

Country Link
US (1) US20110320163A1 (ja)
EP (1) EP2352664A4 (ja)
JP (1) JP5411284B2 (ja)
CN (1) CN102209658B (ja)
BR (1) BRPI0823224A2 (ja)
WO (1) WO2010053408A1 (ja)

Families Citing this family (49)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2249162A1 (en) * 2009-04-30 2010-11-10 Stallergenes Sa Method for grass species identification
JP5276637B2 (ja) * 2010-09-08 2013-08-28 富士重工業株式会社 車線推定装置
KR101962890B1 (ko) * 2012-03-02 2019-08-01 현대모비스 주식회사 차량 센서 오프셋 보정 시스템 및 그 방법
JP6127560B2 (ja) * 2013-02-13 2017-05-17 日産自動車株式会社 道路形状予測装置
CN104019821B (zh) * 2013-02-28 2018-02-09 腾讯科技(深圳)有限公司 一种电子地图的匹配方法和装置
CN104034327B (zh) * 2013-03-04 2016-08-31 华为技术有限公司 行人导航处理方法、终端设备和系统
CN103439884B (zh) * 2013-07-19 2015-12-23 大连理工大学 一种基于模糊滑模的智能汽车横向控制方法
KR20150059489A (ko) * 2013-11-22 2015-06-01 현대자동차주식회사 협로 검출 방법과 협로 검출 장치 및 협로 검출 시스템
US10406981B2 (en) * 2014-03-20 2019-09-10 Magna Electronics Inc. Vehicle vision system with curvature estimation
JP6128608B2 (ja) * 2014-08-19 2017-05-17 株式会社Soken 車両制御装置
JP6492469B2 (ja) * 2014-09-08 2019-04-03 株式会社豊田中央研究所 自車走行レーン推定装置及びプログラム
US9892296B2 (en) 2014-11-12 2018-02-13 Joseph E. Kovarik Method and system for autonomous vehicles
JP6137212B2 (ja) * 2015-02-02 2017-05-31 トヨタ自動車株式会社 運転支援装置
CN104615889B (zh) * 2015-02-09 2017-12-26 武汉大学 基于回旋曲线追随的智能车辆路径跟踪方法及系统
US9766344B2 (en) * 2015-12-22 2017-09-19 Honda Motor Co., Ltd. Multipath error correction
CN105741542B (zh) * 2016-01-29 2018-05-04 深圳市美好幸福生活安全系统有限公司 行车安全预警的方法及装置
EP3208786B1 (en) * 2016-02-22 2023-06-07 Volvo Car Corporation Method and system for evaluating inter-vehicle traffic gaps and time instances to perform a lane change manoeuvre
EP3217374A1 (en) * 2016-03-10 2017-09-13 Volvo Car Corporation Method and system for estimating a boundary of a road technical field
FR3051756B1 (fr) * 2016-05-24 2020-03-20 Renault S.A.S Dispositif de controle de trajectoire d’un vehicule
CN106092121B (zh) * 2016-05-27 2017-11-24 百度在线网络技术(北京)有限公司 车辆导航方法和装置
DE102016210032A1 (de) * 2016-06-07 2017-12-07 Robert Bosch Gmbh Verfahren Vorrichtung und System zur Falschfahrererkennung
JP6500844B2 (ja) * 2016-06-10 2019-04-17 株式会社デンソー 車両位置姿勢算出装置及び車両位置姿勢算出プログラム
JP7127941B2 (ja) * 2016-07-21 2022-08-30 モービルアイ ビジョン テクノロジーズ リミテッド 方法、システム及びプログラム
DE102016214045A1 (de) * 2016-07-29 2018-02-01 Bayerische Motoren Werke Aktiengesellschaft Verfahren und Vorrichtung zum Ermitteln eines Fahrbahnmodells für ein Fahrzeugumfeld
DE102016220583A1 (de) * 2016-10-20 2018-04-26 Audi Ag Verfahren zur Überprüfung einer Überholmöglichkeitsbedingung
CN108020838B (zh) * 2016-11-02 2021-08-20 惠州市德赛西威汽车电子股份有限公司 一种毫米波雷达信号在自适应巡航中的处理方法
FR3063265B1 (fr) 2017-02-28 2019-04-05 Renault S.A.S Dispositif de controle de trajectoire d un vehicule
CN109270927B (zh) * 2017-07-17 2022-03-11 阿里巴巴(中国)有限公司 道路数据的生成方法及装置
JP6993136B2 (ja) * 2017-08-09 2022-01-13 株式会社デンソーテン レーダ装置および物標検知方法
US10977946B2 (en) * 2017-10-19 2021-04-13 Veoneer Us, Inc. Vehicle lane change assist improvements
US10864819B2 (en) * 2017-10-31 2020-12-15 Speedgauge, Inc. Driver alertness warning system and method
CN109154821B (zh) * 2017-11-30 2022-07-15 深圳市大疆创新科技有限公司 轨迹生成方法、装置和无人驾驶地面车辆
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
US11273836B2 (en) * 2017-12-18 2022-03-15 Plusai, Inc. Method and system for human-like driving lane planning in autonomous driving vehicles
US10737693B2 (en) * 2018-01-04 2020-08-11 Ford Global Technologies, Llc Autonomous steering control
KR102553247B1 (ko) * 2018-04-27 2023-07-07 주식회사 에이치엘클레무브 전방 차량 추종 제어 시 안전성을 향상할 수 있는 차선 유지 보조 시스템 및 방법
US10513270B2 (en) * 2018-05-04 2019-12-24 Ford Global Technologies, Llc Determining vehicle driving behavior
DE102018207102A1 (de) * 2018-05-08 2019-11-14 Robert Bosch Gmbh Verfahren zur Ermittlung der Trajektorienfolgegenauigkeit
CN110487288B (zh) * 2018-05-14 2024-03-01 华为技术有限公司 一种行车道路的估计方法以及行车道路估计系统
CN108920753B (zh) * 2018-05-25 2023-01-17 江苏大学 一种基于优秀驾驶员行驶轨迹的弯道彩色路面设计方法
US20190389470A1 (en) * 2018-06-22 2019-12-26 GM Global Technology Operations LLC System and method for controlling a vehicle based on an anticipated lane departure
DE102018221864A1 (de) * 2018-12-17 2020-06-18 Volkswagen Aktiengesellschaft Verfahren und System zum Bestimmen einer Trajektorie eines Fahrzeugs
EP3680877A1 (en) * 2019-01-08 2020-07-15 Visteon Global Technologies, Inc. Method for determining the location of an ego-vehicle
CN111696048B (zh) * 2019-03-15 2023-11-14 北京四维图新科技股份有限公司 墙体采样线的平滑处理方法和装置
CN110222822B (zh) * 2019-05-31 2021-04-09 北京工业大学 黑盒预测模型内部特征因果图的构建方法
WO2021049108A1 (ja) * 2019-09-11 2021-03-18 日立Astemo株式会社 車両制御装置、車両制御方法、車両運動制御システム、及びレーン推定装置
US11499833B2 (en) * 2019-09-25 2022-11-15 GM Global Technology Operations LLC Inferring lane boundaries via high speed vehicle telemetry
KR102290008B1 (ko) * 2019-12-26 2021-08-18 주식회사 켐트로닉스 차량의 주행 경로를 이용한 adas 모드 제어 장치
CN111976719A (zh) * 2020-08-03 2020-11-24 长沙理工大学 一种车辆入库系统及方法

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE19630970B4 (de) * 1995-08-01 2008-12-24 Honda Giken Kogyo K.K. Fahrzustandsüberwachungseinrichtung für Kraftfahrzeuge
JPH09301011A (ja) * 1996-05-20 1997-11-25 Honda Motor Co Ltd 車両用運転状況監視装置
KR100195018B1 (ko) * 1996-11-04 1999-06-15 윤종용 수치지도 형상데이터 합성시 그 명칭 처리방법
JP3430832B2 (ja) * 1997-01-27 2003-07-28 日産自動車株式会社 道路曲率推定装置
GB2358975B (en) * 2000-02-05 2004-05-05 Jaguar Cars Motor vehicle trajectory measurement
JP3736413B2 (ja) * 2001-09-28 2006-01-18 日産自動車株式会社 車線逸脱防止装置
US6751547B2 (en) * 2001-11-26 2004-06-15 Hrl Laboratories, Llc Method and apparatus for estimation of forward path geometry of a vehicle based on a two-clothoid road model
US7522091B2 (en) * 2002-07-15 2009-04-21 Automotive Systems Laboratory, Inc. Road curvature estimation system
JP3997142B2 (ja) * 2002-10-23 2007-10-24 富士重工業株式会社 車両用の覚醒度推定装置および覚醒度推定方法
JP4366145B2 (ja) * 2003-08-26 2009-11-18 富士重工業株式会社 運転者の覚醒度推定装置及び覚醒度推定方法
EP1672389B1 (en) * 2004-12-20 2013-08-07 Volvo Car Corporation Method for estimating a traffic situation
DE102005038314A1 (de) * 2005-03-08 2006-09-14 Daimlerchrysler Ag Verfahren zum Schätzen des Verlaufs einer Fahrspur
JP4259587B2 (ja) * 2007-03-30 2009-04-30 株式会社デンソー データベース装置、注意喚起装置及び運転支援装置

Also Published As

Publication number Publication date
US20110320163A1 (en) 2011-12-29
CN102209658A (zh) 2011-10-05
JP2012507780A (ja) 2012-03-29
BRPI0823224A2 (pt) 2015-06-16
EP2352664A4 (en) 2014-04-23
WO2010053408A1 (en) 2010-05-14
EP2352664A1 (en) 2011-08-10
CN102209658B (zh) 2014-01-15

Similar Documents

Publication Publication Date Title
JP5411284B2 (ja) 実際の軌道を進行している車両の横方向のずれを、推定された仮想道路に基づいて決定し、横方向のずれに基づき運転者の横方向制御能力を決定するための方法、システム及びコンピュータプログラム製品
CN107031331B (zh) 横穿道路的异常检测系统和方法
US20080291276A1 (en) Method for Driver Assistance and Driver Assistance Device on the Basis of Lane Information
JP5045374B2 (ja) 運転状態判定装置
JP4724043B2 (ja) 対象物認識装置
US8700324B2 (en) Machine navigation system having integrity checking
WO2018076855A1 (zh) 车辆行驶窄道辅助系统
US20220169280A1 (en) Method and Device for Multi-Sensor Data Fusion For Automated and Autonomous Vehicles
KR101526816B1 (ko) 차선 추정 시스템 및 그 방법
CN111976722B (zh) 包括自主控制系统的用于控制车辆的方法和设备
US20050278112A1 (en) Process for predicting the course of a lane of a vehicle
CN104094177A (zh) 基于感知不确定性的车辆控制
EP2201496A2 (en) Inattentive state determination device and method of determining inattentive state
JP6941178B2 (ja) 自動運転制御装置及び方法
JP6115429B2 (ja) 自車位置認識装置
JP4724079B2 (ja) 対象物認識装置
EP4001844A1 (en) Method and apparatus with localization
US20220101637A1 (en) Method and Device for Multi-Sensor Data Fusion For Automated and Autonomous Vehicles
JP2015221636A (ja) 車線維持支援装置
JP5003705B2 (ja) 開閉眼状態判定装置、前横向き状態判定装置、及びプログラム
CN116118770A (zh) 面向稳健自动驾驶控制的车辆感知系统的自适应合理化器
JP6232883B2 (ja) 自車位置認識装置
CN108701223B (zh) 用于估算车辆的驾驶员的注意力等级的装置和方法
CN113327456A (zh) 一种车道结构检测方法及装置
KR20210034626A (ko) 주차 공간 유형 결정 방법

Legal Events

Date Code Title Description
A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20121106

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20130205

A602 Written permission of extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A602

Effective date: 20130213

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20130306

A602 Written permission of extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A602

Effective date: 20130313

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130405

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20130618

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130917

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20131015

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20131107

LAPS Cancellation because of no payment of annual fees