JP6428671B2 - 推定装置 - Google Patents

Description

本発明、オドメトリ情報から車両の旋回半径を推定する技術に関する。

ＧＰＳ装置やカメラなどの外界観測用のセンサを用いず、車速やヨー角、操舵角などの自車両のオドメトリ情報を用いて、走行路に対する自車位置や走行軌跡を推定する技術が知られている。

ところで、走行軌跡の推定に必要な情報の一つとして、車両の旋回半径がある。旋回半径は、ヨーレートセンサや舵角センサでの検出結果から求めることができる。このうち、ヨーレートセンサは、精度は良いが応答性が劣り、また、低速時の出力が不安定である。一方、舵角センサは、応答性に優れるが、タイヤのスリップ等により舵角と実際の進行方向とが正確には一致せず、誤差を含んだ検出結果が得られる。

これに対して、特許文献１には、 車速に応じて、高速時にはヨーレートセンサの出力を、低速時には舵角センサの出力を切り替えて使用する技術が提案されている。

特表２００７−５１６９０６号公報

しかしながら、ヨーレートセンサの出力から求めた旋回半径を利用して、例えば走行軌跡の推定が行われているときに、ハンドル操作が行なわれる等してヨーレートが急変すると、その操作に対してセンサ出力の変化が遅れるため、走行軌跡の推定値が実際の軌跡に対して誤差を持ってしまうという問題があった。なお、ヨーレートの急変は、ハンドル操作に限らず、直進していても、急ブレーキ時や凸凹路面の走行時等にも発生する。

本発明は、こうした問題に鑑みてなされたものであり、状況によらずオドメトリ情報から精度のよい走行軌跡の推定結果を得る技術を提供することを目的としている。

本発明の推定装置（１０）は、オドメトリ取得部（Ｓ１２０）と、推定値演算部（Ｓ２１０）と、変化率演算部（Ｓ２２０）と、寄与度調整部（Ｓ２３０〜Ｓ２７０）とを備える。オドメトリ取得部は、自車両に加わるヨーレートおよび自車両の舵角を含むオドメトリ情報を取得する。推定値演算部は、オドメトリ取得部にて取得された舵角およびヨーレートに基づいて、旋回半径の推定値を求める。変化率演算部は、オドメトリ取得部にて取得されるヨーレートの変化の度合いを表すヨー変化率を求める。寄与度調整部は、ヨー変化率が大きいほど、推定値演算部での推定値演算におけるヨーレートの寄与度を減少させ、かつ舵角の寄与度を増加させる調整を行なう。

このような構成によれば、ヨー変化率が小さい場合には検出精度に優れたヨーレートを重視し、ヨー変化率が大きい場合には応答性に優れた舵角を重視して、旋回半径の推定値が求められる。従って、ヨー変化率の小さい直進路等においては舵角に含まれる誤差の蓄積を抑制することができ、また、ヨー変化率の大きいカーブ路等においてはヨーレートの応答性の悪さに基づく誤差の発生を抑制することができる。その結果、ヨー変化率によらずどのような状況でも精度のよい旋回半径の推定値を得ることができ、更には、その旋回半径の推定値から精度のよい走行軌跡を求めることができる。

なお、この欄及び特許請求の範囲に記載した括弧内の符号は、一つの態様として後述する実施形態に記載の具体的手段との対応関係を示すものであって、本発明の技術的範囲を限定するものではない。

実施形態の車載システム１の構成を示すブロック図である。 隣接車線監視処理のフローチャートである。 推定半径設定処理のフローチャートである。 調整係数マップの内容を示す説明図である。 補正係数マップの内容を示す説明図である。 動作例に関する説明図である。 動作例におけるヨー変化率の変化を示すグラフである。 隣接車線確率マップの生成方法に関する説明図である。 隣接車線確率マップのイメージ図である。 ヨー半径および舵角半径から求めた走行経路の精度を示すグラフである。 実施形態の手法およびヨー半径を用いる比較手法による推定半径から求めた走行経路の精度を示すグラフである。

以下、図面を参照しながら、発明を実施するための形態を説明する。
［１．構成］
図１に示す本実施例の車載システム１は、運転支援ＥＣＵ２と、レーダシステム３と、警報装置４と、他の制御システム５とを備える。この車載システム１は、本実施形態では、４輪自動車である車両に搭載されている。なお、車載システム１が搭載された車両を、以下、自車両ともいう。

レーダシステム３は、複数のレーダ装置２１，２２・・・を備える。本実施形態では、レーダ装置として、車両の後部右側面に設置された右後側レーダ装置２１と、車両の後部左側面に設置された左後側レーダ装置２２とを少なくとも備える。右後側レーダ装置２１は、車両の右側および右後ろ側に存在する物体に関する情報を取得する。左後側レーダ装置２２は、車両の左側および左後ろ側に存在している物体に関する情報を取得する。なお、１つのレーダ装置を用いて上述の右後ろ側および左後ろ側の所定領域を含む車両の後方全体の物標情報を取得可能である場合は、上記２つのレーダ装置２１，２２に代えてその１つのレーダ装置を用いてもよい。

レーダシステム３を構成する複数のレーダ装置２１，２２・・・は、いずれも、基本的には同じ構成・機能を有している。そのため、以下の説明では、代表として、右後側レーダ装置２１を対象として説明する。

右後側レーダ装置２１は、レーダ波を発射して、その反射波を受信し、その受信信号に基づいて、レーダ波を反射した物体である物標に関する物標情報を演算して、運転支援ＥＣＵ２に入力する。右後側レーダ装置２１が演算する物標情報としては、自車両から物標までの距離Ｄ、自車両に対する物標の相対速度Ｖｒ、及び、自車両を基準とした物標の方位角θがある。つまり、物標情報は自車両を基準として表現される。

なお、レーダ装置において採用される物標の検知方式は、例えばＦＭＣＷ方式や二周波ＣＷ方式など、種々の検知方式が知られているが、本実施形態の右後側レーダ装置２１は、一例として、ＦＭＣＷ方式のいわゆる「ミリ波レーダ」として構成されているものとする。但し、ＦＭＣＷ方式のミリ波レーダにおける物標の検知方法はよく知られているため、ここではその詳細についての説明を省略する。

他の制御システム５は、車両に搭載されている、運転支援ＥＣＵ２以外の他の複数の車載装置（例えば、ＥＣＵやセンサ等）を包含したものである。
運転支援ＥＣＵ２は、他の制御システム５と、ネットワーク６を介してデータ通信可能に接続されている。ネットワーク６は、本実施形態では、車載ネットワークとして周知のＣＡＮである。

ネットワーク６には、他の制御システム５から定期的に各種のオドメトリ情報が送出されている。運転支援ＥＣＵ２は、ネットワーク６を介してオドメトリ情報を取得する。取得するオドメトリ情報には、車両の速度（以下、車速）Ｖｓ、車両のヨーレートω、車両の舵角α、車両の旋回半径Ｒｓ、などが含まれる。

これらオドメトリ情報は、不図示の車速センサ，ヨーレートセンサ，舵角センサからの検出信号に基づいて他の制御システム５が車速Ｖｓ，ヨーレートω，舵角αを演算し、更に舵角αに基づく所定の演算方法にて旋回半径Ｒｓを演算し、これら演算結果が定期的にネットワーク６に送出される。このように舵角αから算出される旋回半径Ｒｓを、以下では舵角半径という。舵角半径Ｒｓの演算方法は種々考えられる。例えば、舵角αと旋回半径Ｒとの対応関係をテーブル化しておいてそのテーブルを用いて演算する方法や、所定の数式に当てはめて演算する方法等が考えられる。なお、運転支援ＥＣＵ２は、舵角半径Ｒｓをネットワーク６経由で取得する代わりに、ネットワーク６経由で取得した舵角αに基づいて運転支援ＥＣＵ２内部で演算するようにしてもよい。

運転支援ＥＣＵ２は、制御ユニット１０と、入力ユニット１６と、ネットワークインタフェース（以下、ネットワークＩ／Ｆ）１７とを備える。入力ユニット１６は、レーダシステム３を構成する各レーダ装置２１，２２・・・から入力される物標情報を制御ユニット１０へ出力する。ネットワークＩ／Ｆ１７は、制御ユニット１０がネットワーク６を介して他の制御システム５とデータ通信を行うための通信Ｉ／Ｆである。

制御ユニット１０は、レーダシステム３を構成する各レーダ装置２１，２２・・・からそれぞれ入力ユニット１６を介して入力される、各レーダ装置２１，２２・・・ごとの物標情報Ｄ，Ｖｒ，θに基づく各種処理を行う。

また、制御ユニット１０は、他車両検出機能および隣接車線監視機能を備えている。他車両検出機能とは、レーダシステム３からの物標情報に基づいて、所定の監視エリア内に存在する他車両を検出する周知の機能である。隣接車線監視機能とは、自車両の走行車線に隣接する隣接車線を他車両が走行しているか否か判断し、他車両が走行していて且つその走行状態が特定の条件を満たしている場合に警報装置４を作動させて警報を出力させる機能である。この隣接車線監視機能の実現には、他の制御システム５からネットワーク６経由で取得されるオドメトリ情報や、レーダシステム３（主に右後側レーダ装置２１及び左後側レーダ装置２２）から取得される物標情報なども用いられる。

制御ユニット１０は、ＣＰＵ１１と、ＲＡＭ、ＲＯＭ、フラッシュメモリ等の半導体メモリ（以下、メモリ１２）と、を有する周知のマイクロコンピュータを中心に構成される。メモリ１２には、各種機能を実現するためのプログラムのほか、後述する調整係数Ｍの設定に用いる調整係数マップおよび補正係数Ｎの設定に用いる補正係数マップが少なくとも記憶されている。

制御ユニット１０の各種機能は、ＣＰＵ１１が非遷移的実体的記録媒体に格納されたプログラムを実行することにより実現される。この例では、メモリ１２が、プログラムを格納した非遷移的実体的記録媒体に該当する。また、このプログラムの実行により、プログラムに対応する方法が実行される。なお、制御ユニット１０を構成するマイクロコンピュータの数は１つでも複数でもよい。制御ユニット１０の機能を実現する手法はソフトウェアに限るものではなく、その一部又は全部の要素を、論理回路やアナログ回路等を組み合わせたハードウェアを用いて実現してもよい。

［２．処理］
［２−１．隣接車線監視処理］
次に、制御ユニット１０が実行する隣接車線監視処理について、その概要を、図２を用いて説明する。なお、制御ユニット１０は、実際には、自車両の左右両側それぞれについて隣接車線を監視するのであるが、ここでは説明の簡素化のため、自車両の右側の隣接車線が監視対象であるものとして説明する。従って、以下に説明する、自車両の右側を対象とした隣接車線監視処理は、自車両の左側についても同様に行われる。

制御ユニット１０のＣＰＵ１１は、起動後、メモリ１２から隣接車線監視処理のプログラムを読み込み、所定の制御周期Ｔで繰り返し実行する。制御ユニット１０のＣＰＵ１１は、本処理を開始すると、Ｓ１１０で、右後側レーダ装置２１から入力ユニット１６経由で物標情報を取得する。ここで取得する物標情報には、ターゲットである他車両に関するものと、壁に関するものが含まれる。なお、壁は、自車両の右側に存在する、壁に相当する静止した物標である。壁の物標情報を取得することで、制御周期Ｔ毎に、自車両に対する壁の方向と距離Ｗを算出することができる。

Ｓ１２０では、他の制御システム５からネットワーク６経由でオドメトリ情報を取得する。ここで取得するオドメトリ情報には、既述の通り、少なくとも車速Ｖｓ、ヨーレートω、舵角α、舵角半径Ｒｓが含まれる。

Ｓ１３０では、Ｓ１２０で取得したオドメトリ情報を用いて、自車両の旋回半径の推定値である推定半径Ｒｅを求める推定半径設定処理を実行する。その詳細については後述する。

Ｓ１４０では、Ｓ１２０で取得したオドメトリ情報およびＳ１３０で算出した推定半径Ｒｅを用いて、自車走行軌跡を推定する。具体的には、自車両の現在位置を基準とした、１サイクル前からＮサイクル前までの各制御タイミングにおける自車位置の推定値である自車推定位置を算出する。そして、現在位置を基点として各サイクルの自車推定位置を順次結んだ線を、自車走行軌跡として推定する。なお、このように旋回半径を含むオドメトリ情報から自車走行軌跡を推定する技術は周知のものであるため、その詳細についての説明は省略する。

これと共に、オドメトリ情報に含まれる誤差を考慮して、各サイクルの自車推定位置の推定存在範囲も算出する。オドメトリ情報に含まれる誤差は、例えば、各オドメトリ情報の検出に用いるセンサでの検出誤差や、検出結果に重畳されるノイズ等を原因とするものである。また、推定存在範囲は、自車推定位置を基準とした誤差分散として表すことができ、ここでは、正規分布（即ち、ガウス分布）を用いてモデル化する。つまり、自車推定位置の存在確率が、正規分布における確率の最も高いピーク値となり、自車推定位置から車線幅方向に離れるほど、正規分布に従って、存在確率が減少していくものとなる。また、誤差分散は、より過去の制御タイミングのものほど、ピークのつぶれた広がった分布、即ち、広い誤差範囲を持つものとなる。

Ｓ１５０では、Ｓ１４０での算出結果に基づいて隣接車線確率マップを算出する。具体的には、図８に示すように、まず、自車走行軌跡３１上の自車推定位置４０から所定距離（例えば、車線幅の半分）右側にシフトした位置である内側区分位置４１、およびその内側区分位置４１から更に車線幅分だけ右側にシフトした位置である外側区分位置４２を、隣接車線の車線幅方向の両端位置として求める。次に、内側区分位置４１および外側区分位置４２のそれぞれに、その自車推定位置４０について求められた推定存在範囲を示す誤差分散を射影する。以下では、内側区分位置４１に射影された誤差分散を内側確率分布４６、外側区分位置４２に射影された誤差分散を外側確率分布４７という。これにより、Ｎサイクル前までの各制御タイミングにおける自車推定位置での隣接車線の確率分布が求められる。但し、内側確率分布４６のうち、実際に意味のある分布領域は、ピーク値（即ち、内側区分位置４１）から左側の領域であり、外側確率分布４７のうち、実際に意味のある分布領域は、ピーク値（即ち、外側区分位置４２）から右側の領域である。両確率分布４６，４７のピーク間、即ち内側区分位置４１と外側区分位置４２の間が隣接車線範囲となる。

そして、隣接車線範囲を含み、両確率分布４６，４７の正規分布における１σに相当する位置５１，５６までの範囲内に隣接車線が存在する確率をＰ１、その外側の２σに相当する位置５２，５７までの範囲内に隣接車線が存在する確率をＰ２、更にその外側の３σに相当する位置５３，５８までの範囲内に隣接車線が存在する確率をＰ３とすると、これら確率の大小関係はＰ１＞Ｐ２＞Ｐ３となる。

そして、上記各制御タイミングにおける、内側確率分布４６が示す確率が等しい点同士および外側確率分布４７が示す確率が等しい点同士を結ぶことで、隣接車線確率マップが求められる。この隣接車線確率マップは、隣接車線が存在する確率がＰｘである領域内にターゲットが存在していれば、そのターゲットが隣接車線に存在している確率がＰｘであることを示すマップであるとも言える。

図９は、隣接車線確率マップのイメージであり、自車走行軌跡、隣接車線範囲、存在確率がＰ１となる範囲を示したものである。図示されているように、自車両から遠くなるほど、存在確率がＰ１となる範囲が広がったものとなる。

Ｓ１６０では、壁履歴を算出する。具体的には、現在からＮサイクル前までの各制御タイミングにおいてＳ１１０で得られた壁の位置に基づいて、壁が存在している位置の軌跡である壁履歴を算出する。

Ｓ１７０では、隣接車線におけるターゲットの存在確率を算出する。具体的には、Ｓ１５０で算出した隣接車線確率マップに、Ｓ１６０で算出した壁履歴を加味して、ターゲットの存在確率分布を算出する。即ち、基本的には、隣接車線確率マップに従ってターゲットの存在確率を算出するのであるが、壁が存在している場合には、隣接車線確率マップにおける、その壁の外側の領域については、一律に、隣接車線の存在確率を０とし、その領域についてはターゲットの存在確率は０とする。

Ｓ１８０では、隣接車線におけるターゲットの存在の有無を判定する。具体的には、Ｓ１７０で算出したターゲット存在確率と、レーダ装置にて検出されたターゲットの位置情報に基づいて、ターゲットが隣接車線に存在しているか否かを判定する。例えば、ターゲット存在確率が７０％以上の領域にターゲットが存在している場合には、そのターゲットは隣接車線に存在していると判定する。逆に、ターゲット存在領域が７０％未満の領域にターゲットが存在している場合には、そのターゲットは隣接車線には存在していないと判定する。なお、判定にしようする存在確率は７０％に限るものではなく、判定結果を利用する制御において必要な信頼度が確保されるように設定すればよい。

Ｓ１９０では、警報対象物を抽出する。具体的には、Ｓ１７０で隣接車線にターゲットが存在していると判定した場合に、そのターゲットと自車両との位置関係を確認する。そして、両者の位置関係が所定の条件を満たしている場合に、そのターゲットを警報対象物として抽出する。所定の条件としては、例えば、自車両とターゲットとの距離である相対距離が所定距離以下であることや、相対距離の減少率が所定値の減少率閾値以上であること、つまりターゲットが自車両に急接近していること、或いはこれら両者を共に満たしていること、などが挙げられる。

Ｓ２００では、警報出力処理を実行する。具体的には、Ｓ１９０で警報対象物を抽出した場合に、その警報対象物の存在を示す警報を警報装置４から出力させる。
［２−２．推定半径算出処理］
次に、先のＳ１３０で実行する推定半径算出処理について、図３を用いて説明する。

制御ユニット１０のＣＰＵ１１は、本処理が起動すると、Ｓ２１０では、先のＳ１２０で取得したオドメトリ情報のうちヨーレートωと車速Ｖｓとに基づき、（１）式を用いて、自車両の旋回半径であるヨー半径Ｒｙを算出する。

Ｒｙ＝Ｖｓ／ω （１）
Ｓ２２０では、Ｓ２１０にて今回の制御サイクルで求められたヨー半径と、前回の制御サイクルで求められたヨー半径とに基づき、ヨー半径の変化率（以下、ヨー変化率）ΔＹを（２）式に従って算出する。但し、制御サイクルのサイクル数を正整数ｎとし、Ｒｙ（ｎ×Ｔ）は、今回の制御サイクルで求められたヨー半径であり、Ｒｙ（（ｎ−１）×Ｔ）は、前回の制御サイクルで求められたヨー半径である。

ΔＹ＝|Ｒｙ(ｎ×Ｔ)−Ｒｙ((ｎ−１)×Ｔ)|／Ｒｙ((ｎ−１)×Ｔ)×１００ （２）
Ｓ２３０では、ヨー変化率ΔＹが予め設定された閾値ＴＨ以上であるか否かを判断する。ヨー変化率ΔＹが閾値ＴＨ（例えば５０％）より小さければＳ２４０に移行し、ヨー半径Ｒｙをそのまま推定半径Ｒｅとして設定して本処理を終了する。一方、ヨー変化率ΔＹが閾値ＴＨ以上であればＳ２５０に移行する。

Ｓ２５０では、ヨー変化率ΔＹと車速Ｖｓに基づき、図４に示す内容の調整係数マップを用いて調整係数Ｍを設定する。調整係数Ｍは、ヨー半径Ｒｙと舵角半径Ｒｓとを重み付け加算して推定半径Ｒｅを求める際に使用する混合比であり０〜１の値をとる。Ｍ＝１ではヨー半径Ｒｙが１００％使用され、Ｍ＝０では舵角半径Ｒｓが１００％使用されることを意味する。なお、調整係数マップでは、ヨー変化率ΔＹが大きいほど、また、車速Ｖｓが小さいほど、調整係数Ｍは小さな値となるように設定されている。なお、調整係数マップは、実験結果等に基づいて予め作成されたものを用いる。

Ｓ２６０では、Ｓ１２０で取得したオドメトリ情報のうち舵角半径Ｒｓに基づき、図５に示す内容の補正係数マップを用いて補正係数Ｎを設定する。補正係数Ｎは、舵角半径Ｒｓの補正に用いるものであり０〜１の値をとる。Ｎ＝１では、舵角半径Ｒｓをそのまま使用することを意味し、補正係数Ｎにより、舵角半径Ｒｓは算出値より小さめ目の値に補正される。なお、補正係数マップでは、舵角半径Ｒｓが一定値（例えば３０００ｍ）以上では、Ｎ＝１となり、それ以下では、舵角半径Ｒｓが小さくなるほど、補正係数Ｎは小さな値となるように設定されている。補正係数マップは、調整係数マップと同様に、実験結果等に基づいて予め作成されたものを用いる。

Ｓ２７０では、ヨー半径Ｒｙ、舵角半径Ｒｓ、Ｓ２５０にて設定された調整係数Ｍ、Ｓ２６０にて設定された補正係数Ｎに基づき、（３）式を用いて推定半径Ｒｅを算出して本処理を終了する。

Ｒｅ＝Ｍ×Ｒｙ＋Ｎ×（１−Ｍ）×Ｒｓ （３）
［３．動作例］
図６は、直進の状態からステアリングを操作して進行方向を左向きに変更した後、直進の状態に復帰し、更に、その状態からステアリングを操作して進行方向を右向きに変更した後、直進の状態に復帰した様子を示す。この場合、ヨー変化率ΔＹは、図７に示すように、直進時に相当する区間（以下、挙動安定区間）では、閾値より小さな値が検出され、進行方向を変更するためにステアリングを操作している区間（以下、挙動変化区間）は、閾値ＴＨ以上の大きな値が検出される。

このため、挙動安定期間では、推定半径Ｒｅとしてヨー半径Ｒｙがそのまま使用され、その結果、ヨーレートωによって自車軌跡が推定されることになる。つまり、挙動安定期間は、ヨーレート検出値の応答性の低さに基づく誤差の蓄積が少ないため、精度に優れたヨーレートを重視することで精度のよい推定が可能となる。一方、挙動変化期間では、推定半径Ｒｅとして、ヨー半径Ｒｙと舵角半径Ｒｓとを重み付け加算した値が使用され、その結果、舵角θで補正されたヨーレートωによって自車軌跡が推定されることになる。つまり、挙動変化期間は、ヨーレート検出値の応答性の低さに基づく誤差の蓄積を無視できないため、応答性に優れた舵角によって補正されたヨーレートを用いることで、誤差の影響を抑制することが可能となる。

［４．実験］
図１０は、挙動安定区間の一例である曲率半径が一定の道路を走行（以下、一定Ｒ走行）した場合と、挙動変化区間の一例であるＳ字路を走行（以下、Ｒ変化走行）した場合について、ヨー半径Ｒｙと舵角半径Ｒｓとを実測し、その実測結果を積算することで走行軌跡を求めた結果を示すものである。図示されているように、一定Ｒ走行時には、ヨー半径Ｒｙに基づく走行軌跡は殆ど誤差がなく、舵角半径Ｒｓに基づく走行軌跡は時間の経過と共に誤差が増大することがわかる。また、Ｒ変化走行時には、ヨー半径Ｒｙに基づく走行軌跡と比較して舵角半径Ｒｓに基づく走行軌跡の方が、誤差が小さいことがわかる。

図１１は、Ｒ変化走行時のヨー半径Ｒｙと舵角半径Ｒｓの実測値に基づき、ヨー半径Ｒｙだけを用いる比較手法によって走行軌跡を求めた結果と、上述の車載システム１に適用されている、状況に応じてヨー半径Ｒｙと舵角半径Ｒｓを組み合わせて用いる開示手法によって走行軌跡を求めた結果とを示すものである。図示されているように、走行軌跡を比較すると、比較手法と比較して開示手法の方が、誤差が大きく低減されていることがわかる。なお、図１０および図１１において、実線で示す軌跡が算出された走行軌跡であり、一点鎖線で示す軌跡はＧＰＳによって求めた実際の軌跡であり、点線で示す軌跡は走行軌跡に基づいて設定された認識エリアの境界を示すものである。但し、ここでは、自車線と自車線の右側に位置する隣接車線とを組み合わせた範囲を認識エリアとしている。

［５．効果］
以上詳述した実施形態によれば、以下の効果が得られる。
（１）車載システム１では、ヨー変化率ΔＹを用いて挙動安定区間か挙動変動区間かを判定し、挙動安定区間では、推定半径Ｒｅとしてヨー半径Ｒｙをそのまま使用し、挙動変化区間では、推定半径Ｒｅとしてヨー半径Ｒｙと舵角半径Ｒｓとを、状況に応じた加重値によって重み付け加算した値を使用している。つまり、挙動安定区間では、精度に優れたヨーレートセンサの出力が重視されることになるため、精度のよい推定半径Ｒｅや自車走行軌跡を得ることができる。一方、挙動変化区間では、応答性に優れた舵角センサの出力によってヨーレートセンサの出力が補正されることになるため、推定半径Ｒｅや自車走行軌跡に含まれる、ヨーレートセンサの応答性の悪さに基づく誤差を抑制することができる。

（２）車載システム１では、自車走行軌跡から隣接車線確率を求めており、自車走行軌跡の精度が向上することによって、隣接車線の確率分布を狭めることができる。その結果、自車両から離れた位置での隣接車線におけるターゲットの存在判定の判定精度や、その判定結果に基づく各種制御の精度を向上させることができる。つまり、誤判定に基づく制御の誤作動、例えば、後方車両が走行する車線の誤判定に基づく誤警報や誤ブレーキの発生等を抑制することができる。

（３）車載システム１では、ヨー変化率ΔＹを用いて、挙動安定区間か挙動変動区間かを判定しているため、ステアリング操作を伴わない（即ち、直進している）にも関わらず、大きなヨーレートが検出される状況（例えば、急ブレーキ時や凸凹路面の走行時）でも、推定半径Ｒｅや自車走行軌跡の精度劣化を抑制することができる。

［６．他の実施形態］
以上、本発明を実施するための形態について説明したが、本発明は上述の実施形態に限定されることなく、種々変形して実施することができる。

（Ａ）上記実施形態では、ヨー変化率ΔＹとして、ヨー半径Ｒｙの変化率を用いているが、これの代わりにヨーレートωの変化率を用いるようにしてもよい。
（Ｂ）上記実施形態では、推定半径Ｒｅを用いて算出された自車走行軌跡を、隣接車線を走行する隣接車両を検出して警報を発生させる制御に適用する例について説明したが、これに限定されるものではない。例えば、車線逸脱警報システムや車線維持システム等、走行の安全性を高めるための各種システムや、自動運転制御システム等に適用してもよい。

（Ｃ）上記実施形態では、レーダシステム３にて物標認識のみを実施し、全ての物標情報を運転支援ＥＣＵ２に出力し、運転支援ＥＣＵ２にて警報判定を実施するように構成されているがこれに限定されるものではない。例えば、レーダシステム３が警報判定、即ちＳ１２０〜Ｓ１９０の処理も実施し、その判定結果および運転ＥＣＵ２が実行する各種アプリケーションで必要となる一部の物標情報のみを、運転支援ＥＣＵ２に出力するように構成してもよい。

（Ｄ）上記実施形態における１つの構成要素が有する複数の機能を、複数の構成要素によって実現したり、１つの構成要素が有する１つの機能を、複数の構成要素によって実現したりしてもよい。また、複数の構成要素が有する複数の機能を、１つの構成要素によって実現したり、複数の構成要素によって実現される１つの機能を、１つの構成要素によって実現したりしてもよい。また、上記実施形態の構成の一部を省略してもよい。また、上記実施形態の構成の少なくとも一部を、他の上記実施形態の構成に対して付加又は置換してもよい。なお、特許請求の範囲に記載した文言のみによって特定される技術思想に含まれるあらゆる態様が本発明の実施形態である。

（Ｅ）上述した車載システムの他、旋回半径推定装置、走行軌跡推定装置、更には、これら装置を構成要素とするシステム、旋回半径推定装置や走行軌跡推定装置としてコンピュータを機能させるためのプログラム、このプログラムを記録した半導体メモリ等の非遷移的実態的記録媒体、旋回半径推定方法、走行軌跡推定方法など、種々の形態で本発明を実現することもできる。

１…車載システム、２…運転支援ＥＣＵ、３…レーダシステム、４…警報装置、５…制御システム、６…ネットワーク、１０…制御ユニット、１１…ＣＰＵ、１２…メモリ、１６…入力ユニット、１７…ネットワークＩ／Ｆ、２１…右後側レーダ装置、２２…左後側レーダ装置。

Claims (6)

1. 車両に搭載され、走行路の曲率半径を推定する推定装置（１０）であって、
   自車両に加わるヨーレートおよび自車両の舵角を含むオドメトリ情報を取得するオドメトリ取得部（Ｓ１２０）と、
   前記オドメトリ取得部にて取得された舵角およびヨーレートに基づいて、自車両の旋回半径の推定値を求める推定値演算部（Ｓ２１０）と、
   前記オドメトリ取得部にて取得されるヨーレートの変化の度合いを表すヨー変化率を求める変化率演算部（Ｓ２２０）と、
   前記ヨー変化率が大きいほど、前記推定値演算部での推定値演算における前記ヨーレートの寄与度を減少させ、かつ前記舵角の寄与度を増加させる調整を行なう寄与度調整部（Ｓ２３０〜Ｓ２７０）と、
   を備える推定装置。
2. 請求項１に記載の推定装置であって、
   前記寄与度調整部は、前記ヨー変化率が予め設定された閾値より小さい場合は、前記ヨーレートの寄与度を１００％とする、推定装置。
3. 請求項１または請求項２に記載の推定装置であって、
   前記オドメトリ取得部にて取得される前記オドメトリ情報には、自車両の速度である自車速が含まれ、
   前記寄与度調整部は、前記ヨー変化率による調整に加え、前記自車速が小さいほど前記ヨーレートの寄与度を減少させ、かつ前記舵角の寄与度を増加させる調整を行なう、推定装置。
4. 請求項１ないし請求項３のいずれか１項に記載の推定装置であって、
   前記寄与度調整部は、舵角が大きいほど、前記推定値演算部での推定値演算における前記舵角の寄与度を減少させる補正を行なう、推定装置。
5. 請求項１ないし請求項４のいずれか１項に記載の推定装置であって、
   前記推定値演算部は、前記ヨーレートから求めた旋回半径であるヨー半径と前記舵角から求めた旋回半径である舵角半径とを重み付け加算することで前記推定値を求め、
   前記寄与度調整部は、前記重み付け加算に使用する加重値を増減させることで寄与度の調整を行なう、推定装置。
6. 請求項１ないし請求項５のいずれか１項に記載の推定装置であって、
   前記推定値演算部にて求められた旋回半径の推定値を用いて、前記自車両の走行軌跡である自車走行軌跡を算出する走行軌跡算出部（Ｓ１４０）を、
   更に備える推定装置。