自車位置演算装置、自車位置演算方法、および、自車位置演算プログラム
【課題】測定した自車位置を地図の道路上にマップマッチングするときに、自車が走行している道路を高精度に選択すること。
【解決手段】コンピュータが、道路を示すリンクについて、リンクの長さ方向を示す方位ベクトルを含む地図情報を、記憶手段から取得し、通信手段により自車位置を検出し、検出した自車位置を、取得した地図情報上に対応づけて補正前自車位置とし、自車への操舵操作を検知することで、自車の進行方向における方位ベクトルを演算し、自車周辺の各リンクについて、自車の方位ベクトルと、リンクの方位ベクトルとのベクトル差分が最小となるリンクを、補正先の道路を示すリンクとして選択し、選択されたリンク上の位置を補正後自車位置として決定し、地図情報上に表示する。
【解決手段】コンピュータが、道路を示すリンクについて、リンクの長さ方向を示す方位ベクトルを含む地図情報を、記憶手段から取得し、通信手段により自車位置を検出し、検出した自車位置を、取得した地図情報上に対応づけて補正前自車位置とし、自車への操舵操作を検知することで、自車の進行方向における方位ベクトルを演算し、自車周辺の各リンクについて、自車の方位ベクトルと、リンクの方位ベクトルとのベクトル差分が最小となるリンクを、補正先の道路を示すリンクとして選択し、選択されたリンク上の位置を補正後自車位置として決定し、地図情報上に表示する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、自車位置演算装置、自車位置演算方法、および、自車位置演算プログラムに関する。
【背景技術】
【０００２】
カーナビゲーションなどに搭載される自車位置演算装置において、ＧＰＳなどにより検出される自車位置は、電波障害などにより、必ずしも実際に走行している自車位置を示していないこともある。そのとき、地図情報としてあらかじめ与えられている道路を示すリンク上の位置に、自車位置をマッチングする、マップマッチングが知られている。
【０００３】
例えば、自車位置を演算する手段として、自車の車速などから走行距離を演算し、その走行距離分だけ進んだ地図のリンク上の位置に自車をマッチングする。また、曲線路などを通過する際に発生する自車位置の誤差を補正する方法として、右左折時の車両の走行距離（円弧長）分を、右左折前後の道路中心線の交点（交差点のノード）から加算した地点に自車位置を補正する方法が知られている。
【０００４】
特許文献１に記載の自車位置決定方法では、自車が交差点などで右左折する場合に、まず地図上で右左折前後の道路中心線の交点まで直線的に自車を移動させる。次に、その交点にて右左折前後の道路中心線の交差角度分だけ自車の方向を変化させる。その後、右左折後の道路の中心線上で方向転換した自車を直線的に移動させて、地図上の自車位置を決定する方法が開示されている。
【０００５】
また、特許文献２に記載の車両走行位置表示装置では、車両の現在位置と検定点（ノード：右左折前後の道路中心線の交点）とを比較して、車両の現在位置を補正する方法が開示されており、例えば車両の右左折が検出された場合に、右左折前後の道路の幅、車両の屈曲角、円弧状の走行軌跡の旋回半径に基づいて補正量を演算して自車位置を補正することにより自車位置精度の向上が図られている。
【特許文献１】特開平４−６７３００号公報
【特許文献２】特開平８−６１９６９号公報
【発明の開示】
【発明が解決しようとする課題】
【０００６】
カーナビゲーションなどの自車位置演算装置の画面などに正確な自車位置を表示して運転者に正確な自車位置を報知することにより、運転時の快適性やカーナビゲーションなどに対する信頼性を向上することができる。そのため、マップマッチングの精度を高める必要がある。
【０００７】
高精度なマップマッチングをするために、自車がどの道路上を走っているのかを選択する必要がある。もし、自車の周辺に道路が１本しかないときには、その道路をそのまま選択すればよい。しかし、自車の周辺に複数の道路が存在するときには、その中から１つの道路を選択する必要がある。この補正先の道路の表示は、交差点での左折や、速度制限による減速など、自車の制御のための、運転者にとってきわめて重要な情報である。
【０００８】
例えば、補正前の自車位置に最も近い位置に存在する道路を選択する手法を挙げる。この手法は、ＧＰＳなどにより検出した補正前の自車位置と、地図情報上に設定されたリンクの位置とが、共に高精度であることが前提となる。もし、いずれかの情報の精度が低いときには、道路の選択精度が低くなってしまい、不便である。
【０００９】
地図情報上に設定されたリンクの位置は、高精度でない場合がある。例えば、カーナビゲーションに表示する地図を構成するノードが正確な地点（道路中心線の交点）に配置されていないときには、それらのノードを端点とするリンクの位置も不正確となる。このとき、補正先の道路として、自車から遠い道路を選択してしまうこともある。
【００１０】
そこで、本発明は、前記した問題を解決し、測定した自車位置を地図の道路上にマップマッチングするときに、自車が走行している道路を高精度に選択することを、主な目的とする。
【課題を解決するための手段】
【００１１】
前記課題を解決するため、本発明は、ナビゲーション画面に表示する自車位置を補正する自車位置演算装置であって、道路を示すリンクについて、リンクの長さ方向を示す方位ベクトルを含む地図情報を、記憶手段から取得する地図情報取得部と、通信手段により自車位置を検出する自車位置検出部と、前記自車位置検出部で検出した自車位置を、前記地図情報取得部で取得した地図情報上に対応づけて補正前自車位置とする補正前自車位置演算部と、自車への操舵操作を検知することで、自車の進行方向における方位ベクトルを演算する方位演算部と、自車周辺の各リンクについて、自車の方位ベクトルと、リンクの方位ベクトルとのベクトル差分が最小となるリンクを、補正先の道路を示すリンクとして選択する補正先道路選択部と、前記補正先道路選択部で選択されたリンク上の位置を補正後自車位置として決定する補正後自車位置演算部と、前記補正後自車位置演算部が決定した前記補正後自車位置を、前記地図情報取得部で取得した地図情報上に対応づけて表示する自車位置表示部と、を有することを特徴とする。その他の手段は、後記する。
【発明の効果】
【００１２】
本発明により、測定した自車位置を地図の道路上にマップマッチングするときに、自車が走行している道路を高精度に選択することが可能になった。
【発明を実施するための最良の形態】
【００１３】
以下、図面を用いて本発明に関わる実施形態について説明する。
【００１４】
図１は、本発明の一実施形態を示す自車位置演算装置の構成図である。自車位置演算装置１は、自動車内に設置され、例えば、カーナビゲーション装置などのコンピュータに組み込まれる。なお、自車位置演算装置１は、演算処理を行う際に用いられる記憶手段としてのメモリと、前記演算処理を行う演算処理装置とを少なくとも備えるコンピュータとして構成される。なお、メモリは、ＲＡＭ（Random Access Memory）などにより構成される。演算処理は、ＣＰＵ（Central Processing Unit）によって構成される演算処理装置が、メモリ上のプログラムを実行することで、実現される。
【００１５】
自車位置演算装置１は、自車位置演算部１０と、自車位置補正部２０と、自車位置表示部３０とを有する。自車位置演算部１０は、補正前自車位置を計算する。自車位置演算部１０は、地図情報取得部１１と、自車位置検出部１２と、補正前自車位置演算部１３と、パラメータ検出部１４と、自車情報取得部１５と、を有する。
【００１６】
地図情報取得部１１は、記憶手段から地図情報を取得する。自車位置検出部１２は、自車位置情報を検出する。補正前自車位置演算部１３は、自車位置検出部１２で検出した自車位置を、地図情報取得部１１で取得した地図上に配置し、補正前自車位置とする。パラメータ検出部１４は、各種センサからの出力により、自車の走行情報に関するパラメータを検出する。自車情報取得部１５は、記憶手段から自車情報のカタログスペックを取得する。
【００１７】
自車位置補正部２０は、自車位置演算部１０で計算した補正前自車位置を補正して補正後自車位置を計算する。自車位置補正部２０は、進行方向演算部２１と、補正先道路選択部２２と、補正後自車位置演算部２３と、を有する。進行方向演算部２１は、方位演算部２１ａと、勾配演算部２１ｂとのうち、少なくとも１つの演算部から構成される。
【００１８】
進行方向演算部２１は、地図情報取得部１１で取得した地図情報と、パラメータ検出部１４で検出した走行情報と、自車情報取得部１５で取得した自車情報とを用いて、自車の進行方向ベクトルを演算する。方位演算部２１ａは、自車の進行方向ベクトルのうち、方位ベクトル（例えば、北を０度、東を９０度、南を１８０度、西を２７０度とする。方角とも呼ばれる。自車の左折右折などにより変更される。）を演算する。勾配演算部２１ｂは、自車の進行方向ベクトルのうち、勾配ベクトル（自車が走行する道路の上り下りを示す。傾斜とも呼ばれる。）を演算する。
【００１９】
補正先道路選択部２２は、地図情報取得部１１で取得した地図情報において自車の近傍に存在する複数の道路から、進行方向演算部２１で計算した自車の進行方向ベクトルに基づいて、補正先の道路を選択する。補正後自車位置演算部２３は、補正先道路選択部２２で選択した補正先の道路上に、補正前自車位置を補正して、補正後自車位置とする。
【００２０】
自車位置表示部３０は、自車位置演算部１０が計算した補正前自車位置と、自車位置補正部２０が計算した補正後自車位置とを、地図情報で示される地図上の位置に表示する。
【００２１】
以下、図１の自車位置演算装置１が補正後自車位置を計算する実施形態について、進行方向演算部２１として方位演算部２１ａを用いる第１実施形態と、進行方向演算部２１として勾配演算部２１ｂを用いる第２実施形態と、を順に説明する。これらの第１実施形態と第２実施形態とは、同一の自車位置演算装置１での併用が可能である。
【００２２】
図２は、第１実施形態における自車位置演算装置１の動作を示すフローチャートである。このフローチャートは、自車が走行することにより、自車位置が耐えず変動するので、所定周期で繰りかえし実行される。自車がカーブを曲がっているときだけでなく、直線路を走行中にもこのフローチャートを実行してもよく、走行中の微小なふらつきなどにより積算される位置誤差を低減することが可能である。
【００２３】
まず、自車位置演算部１０（地図情報取得部１１、パラメータ検出部１４、自車情報取得部１５）は、自車位置の計算に必要なデータを取得する（Ｓ１１）。以下、自車位置演算部１０の処理部ごとに、必要なデータを具体的に説明する。
【００２４】
Ｓ１１において、地図情報取得部１１は、記憶手段または通信手段から地図情報を取得する。記憶手段は、例えば、コンピュータが読み取り可能なＣＤ−ＲＯＭ、ＤＶＤ−ＲＯＭ、ハードディスクなどが挙げられる。通信手段は、例えば、所定の情報センタから地図情報を取得するために用いられる。なお、地図情報は、一般的にデータ量が多いので、自車位置の近傍に絞り込んで取得した方が処理効率がよい。
【００２５】
地図情報は、道路の主要地点（交差点など）を示すノード、道路を構成するリンク、カーナビゲーションに表示する地形や店舗の情報、道路周辺の物体の位置（緯度・経度・高度・道路との位置関係など）により構成される。
Ｎｎ（ｘｎ，ｙｎ）は、ノードを示す。Ｎｎの添字ｎは、ｎ番目のノードを示す。ｘｎは、経度を示し、ｙｎは、緯度を示す。
Ｌｎ（ｒＬ，θＬ，ＷＬ）は、リンクを示す。Ｌｎの添字ｎは、ｎ番目のリンクを示す。ｒＬは道路の長さ（リンク長）を、θＬは東西南北などの道路の方位（方位におけるリンク角度）を、ＷＬは道路における車線の幅を、それぞれ示す。なお、１つのリンクは、２つのノード（リンクの始点終点）と対応することで、リンクの地図上の位置が確定する。なお、前記した以外のリンクの情報として、例えば、道路の曲率半径を含めてもよい。
【００２６】
【表１】
【００２７】
Ｓ１１において、パラメータ検出部１４は、各種センサからの出力により、自車の走行情報に関するパラメータを検出する。検出するパラメータは、表１に例示される。
なお、入力トルクＴｎは、エンジンに関する値を元に、計算式「ポンプ容量係数×（エンジン回転数）２」によって求められる。エンジン回転数は、カタログスペック値または計測値である。ポンプ容量係数は、カタログスペック値である。
表１に例示されるパラメータの内、方位演算部２１ａが方位ベクトルの計算のために主に使用するパラメータは、車速ＶＳＰ、運転者の操舵操作量α、車両のヨーレートγである。また、前記パラメータの他に、運転者のアクセル操作量やブレーキ操作量などを検出してもよい。
【００２８】
Ｓ１１において、自車情報取得部１５は、記憶手段から自車情報のカタログスペックを取得する。カタログスペックのパラメータは、例えば、車両重量Ｗと、タイヤ半径ＲＴとが挙げられる。なお、車両重量Ｗは、搭載する人員や荷物などにより変動するので、自車内に重量計を設置して（サスペンションの変位量を計測して）、補正することが望ましい。
【００２９】
次に、自車位置演算部１０は、補正前自車位置を計算する（Ｓ１２）。具体的には、まず、自車位置検出部１２は、ＧＰＳ（Global Positioning System：衛星航法システム）との通信や、自車周辺のインフラストラクチャからの通信（路車間通信や車々間通信）により、自車位置の情報（緯度・経度・高度など）を検出する。自車位置は、自車の重心がある位置である。次に、補正前自車位置演算部１３は、自車位置検出部１２が検出した自車位置を、地図情報取得部１１が取得した地図上に配置し、補正前自車位置とする。
【００３０】
そして、進行方向演算部２１（方位演算部２１ａ）は、自車の進行方向ベクトル（方位ベクトル）を演算する（Ｓ１３）。以下、Ｓ１３の詳細について、Ｓ１３ａからＳ１３ｄの処理を説明する。
【００３１】
方位演算部２１ａは、自車が直進しているか否かを判定する（Ｓ１３ａ）。そのため、計算式「θＳ＝α／Ｇ」（αは操舵操作量、Ｇはステアリング比）により操舵角θＳを求める。次に、直進判定式「｜θＳ｜≦θｔｈ」（θｔｈは判定用の閾値）を所定時間満たし続けているとき、自車が直進していると判定し（Ｓ１３ａ，Ｙｅｓ）、処理をＳ１３ｂへ進める。一方、その直進判定式を所定時間の間に１回でも満たしていなければ、自車はカーブを曲がっていると判定し（Ｓ１３ａ，Ｎｏ）、処理をＳ１３ｃへ進める。
【００３２】
方位演算部２１ａは、１周期前に演算した操舵角θｓｚをもとに、計算式「θｓｔ＝（θＳ＋θｓｚ×積分係数）／Ｎ」により、基準姿勢パラメータθｓｔを計算する（Ｓ１３ｂ）。なお、θｓｚは演算周期の１周期前に演算した操舵角θＳ、Ｎはθｓｔを計算した演算周期ごとの繰り返し回数、積分係数は演算周期に応じて決定される値である。
【００３３】
方位演算部２１ａは、自車の最も近傍の直線路のリンク角θＬを、基準姿勢パラメータθｓｔとする（Ｓ１３ｃ）。
【００３４】
方位演算部２１ａは、Ｓ１３ａで計算した操舵角θＳと、Ｓ１３ｂまたはＳ１３ｃで計算した基準姿勢パラメータθｓｔとを用いて、計算式「θＰ＝θｓ−θｓｔ」により、方位ベクトルθＰを計算する（Ｓ１３ｄ）。なお、θＰの代わりに、自車の移動した距離比tanθＰを方位ベクトルとしてもよい。
【００３５】
以上、Ｓ１３の方位ベクトルの演算方法として、Ｓ１３ａ〜Ｓ１３ｄを説明した。Ｓ１３の別の実現方法として、車両前部に取り付けたフロントカメラあるいは車両後部に取り付けたリアカメラを用いて、自車が走行する道路の白線を認識することにより、左右方向の車両運動から演算してもよい。さらに、車両のヨーレートγや横加速度Ｇｙを利用して、方位ベクトルθＰや基準姿勢パラメータθｓｔを演算してもよい。または、ジャイロセンサが計算するヨー軸の速度または加速度から、方位ベクトルθＰを求めてもよい。ただし、以上のようにした計算された方位ベクトルθＰは、少なくとも測定誤差などを含むため、補正後自車位置Ｐ３（詳細は後記）を中心に少なくとも±１〜５ｍの範囲内にマッチングされる。
【００３６】
ここで、補正先道路選択部２２は、Ｓ１２で求めた補正前自車位置の近傍に存在する複数の道路から、計算した自車の進行方向ベクトルに基づいて、補正先の道路を選択する（Ｓ１４）。具体的には、複数の道路それぞれのリンク角度θＬと、Ｓ１３で計算した方位ベクトルθＰとのベクトル差分を計算式「｜θＰ−θＬ｜」により計算し、その差分が最小となるリンクを、補正先の道路として選択する。
【００３７】
なお、補正先の道路を選択する（Ｓ１４）ための別の手法として、補正前自車位置の最も近傍にある道路を、補正先の道路として選択する比較例がある。しかし、精度の低い位置情報を用いる比較例に比べ、精度の高い進行方向ベクトルを用いる方式は、実際には自車位置が走行していない道路を選択する誤った選択を抑制することができる。
【００３８】
補正後自車位置演算部２３は、Ｓ１４で選択した補正先の道路上に、補正前自車位置を補正して、補正後自車位置とする（Ｓ１５）。
【００３９】
図３は、補正前自車位置および補正後自車位置を示す説明図である。図３（ａ）は、直線路から曲線路に向かって自車が進行していく旨を示す図である。図３（ｂ）は、図３（ａ）の一部を拡大した図である。
【００４０】
図３（ａ）のノードＮｎ，Ｎｎ＋１，Ｎｎ＋２，Ｎｎ＋３は、リンクＬｎ−１，Ｌｎ，Ｌｎ＋１，Ｌｎ＋２上に存在する。そして、自車は、各補正前自車位置Ｐ１において、各進行方向（方位ベクトルθＰ）に向かって進行している。自車位置演算装置１は、補正前自車位置Ｐ１と、方位ベクトルθＰとを参照して、リンク上の補正後自車位置Ｐ３を求める。
【００４１】
図２の補正後自車位置の計算（Ｓ１５）は、例えば、（１）最短距離方式、または、（２）走行距離方式のいずれかにより、実現できる。
【００４２】
（１）最短距離方式を説明する。この方式は、補正前自車位置Ｐ１（ｘ１，ｙ１）から最短距離に位置する補正先の道路上の地点Ｐ３（ｘ３，ｙ３）を、補正後自車位置とする。つまり、補正前自車位置Ｐ１（ｘ１，ｙ１）から補正先の道路に向かって引いた垂線と、補正先の道路との交点を、補正後自車位置とする。
【００４３】
Ｃ（ｒＣ，θＣ）は、補正前自車位置から補正後自車位置までの自車位置補正量を示す。
【００４４】
ｒＣは、補正前自車位置から補正後自車位置までの距離を示す。θＰ＜θＬのときには「ｒＣ＝ＤＣsin（θＬ−θＰ）」で求め、θＰ＞θＬのときには「ｒＣ＝ＤＣsin（θＰ−θＬ）」で求める。ＤＣは、直前に通過したノードＮｎを基点とした自車の走行距離であり、直線路上の車速の積分値によって求める。θＬは、補正先の道路のリンク角度を示す。
ΔｒＣは、ｒＣの変化量であり、前回計算したｒＣと、今回計算したｒＣとの差分である。ΔｒＣがばらつくときには、車線内における自車がふらついていると判断する。
【００４５】
θＣは、補正前自車位置から補正後自車位置に向かう角度を示す。θＰ＜θＬのときには「θＣ＝π／２＋θＬ」で求め、θＰ＞θＬのときには「θＣ＝π／２−θＬ」で求める。
【００４６】
Ｐ３（ｘ３，ｙ３）は、補正後自車位置であり、補正前自車位置Ｐ１（ｘ１，ｙ１）と、自車位置補正量Ｃ（ｒＣ，θＣ）とのベクトル和により求める。ｘ１、ｘ３は、経度であり、ｙ１、ｙ３は、緯度である。
【００４７】
（２）走行距離方式を説明する。この方式は、補正前自車位置Ｐ１（ｘ１，ｙ１）に至る直前に通過した、補正先の道路上のノードＮｎから、走行距離ＤＣ分だけなぞった位置を、補正後自車位置Ｐ２（Ｘ２，Ｙ２）とする。
【００４８】
以上説明した、（１）最短距離方式、および、（２）走行距離方式の例について、図３（ｂ）を参照しながら、説明する。図３（ｂ）は、補正前自車位置Ｐ１から、補正後自車位置Ｐ２または補正後自車位置Ｐ３へと補正される旨を示す。
【００４９】
（２）走行距離方式では、補正後自車位置Ｐ２は、自車が補正前自車位置Ｐ１まで走行した走行距離分を、リンクＬｎ上でなぞることにより、計算される。これにより、補正前自車位置Ｐ１を起点とせずに補正後自車位置Ｐ２が求まるので、ビルの谷間などの電波遮蔽により、補正前自車位置Ｐ１が取得困難な時期についても、自車位置を出力することが可能である。
【００５０】
（１）最短距離方式では、補正後自車位置Ｐ３は、補正前自車位置Ｐ１を起点とした自車位置補正量Ｃを求め、補正前自車位置Ｐ１と、自車位置補正量Ｃとのベクトル和により、計算される。これにより、補正後自車位置Ｐ３は、自車の走行距離に影響を受けないので、蛇行運転や、カーブ時に外側に流れてしまうなどのリンクＬの位置と多少異なる経路で運転しても、高精度な自車位置を出力することが可能である。
例えば、カーブの外側を走行したことで余分な走行距離が発生してしまったとき、補正後自車位置Ｐ２はその余分な走行距離分だけ先行してしまっているが、補正後自車位置Ｐ３は補正前自車位置Ｐ１から最短距離に位置するので、余分な走行距離の影響を受けずに済む。
つまり、カーブにおいて、リンクＬが地図データ上の道路中央に配置されているとき、自車が道路中央より外側を走行していると、道路中央を走行したときよりも走行距離が長いので、補正後自車位置Ｐ３よりも補正後自車位置Ｐ２が先行する。一方、自車が道路中央より内側を走行していると道路中央を走行したときよりも走行距離が短いので、補正後自車位置Ｐ３よりも補正後自車位置Ｐ２が後退する。
【００５１】
自車位置表示部３０は、計算した自車位置を地図上に表示する（Ｓ１６）。なお、表示画面に関しては、カーナビゲーションの表示画面のほかにインナーパネルにある速度計表示画面、ヘッドアップディスプレイなどでもよい。
【００５２】
図４（ａ）は、高速道路などの分岐路において、自車が分岐路に進入する場合の概要図である。車両が分岐路などにさしかかった場合に、図３のＳ１４で示した手法により補正先の道路を特定する。このとき、車両の進行方向ベクトルθｐと、分岐路へ伸びるリンクＬｎ＋２のリンク角度θＬと、の差分が閾値θＬｔｈ以下である状態が、所定時間に途切れることなく続いたときに、分岐路へ進入すると判定する。または、方向指示器の操作により、分岐路へ進入すると判定してもよい。
【００５３】
分岐路へ進入すると判定された場合には、分岐路へ自車をマッチングする。一方、分岐路へ進入しないと判定された場合には、現状の速度あるいは運転者のアクセル操作量に応じた速度で走行する。
【００５４】
さらに、自車が分岐路に進入すると判定されたときには、分岐路先の曲線路の形状に応じて必要な速度まで減速することで、適切な速度制御を実現する。つまり、そのカーブの入口において、カーブの曲率半径に応じた目標速度となるように、車両を適切なタイミングおよび減速度で減速させる。なお、目標速度は、車両のフロント部に搭載したカメラなどでカーブの手前にある速度制限の標識などを数字認識して取得してもよいし、地図情報からあらかじめ設定された目標速度を読み込んでもよい。
【００５５】
図４（ｂ）は、自車が車線変更する場合の概要図である。まず、Ｓ１１において、地図情報取得部１１が取得する地図情報は、車線毎のノードおよびリンク情報（車線の区別、車線幅などを含む）が記載されている高精度地図である。
【００５６】
片側２車線（走行車線、追い越し車線）の道路において、自車が追い越し車線から走行車線へと車線変更する場合を説明する。図３のＳ１４で示した手法を使用すると、２車線を示す各リンクが平行であるため、角度のベクトル差分では、どちらのリンクを選択するか、特定が困難である。
【００５７】
そこで、自車位置補正量Ｃ（ｒＣ，θＣ）における自車位置補正距離ｒＣ（Ｓ１５の（１）最短距離方式で計算される）と、車線の幅ＷＲとをもとに、車線変更判定式「｜ｒＣ｜≧｜ＷＲ／２｜」にて比較することにより、車線変更するか否かを判定する。車線変更判定式を満たすときには、車線変更すると判定する。または、車線変更の検出時には方向指示器などによる信号を用いてもよい。
【００５８】
さらに、車線内における車両のふらつき（ΔｒＣ）が大きいときには、運転者への警報（画面，音声など）あるいはステア操作などにより車線逸脱防止を図ることが可能である。
【００５９】
以上、方位演算部２１ａを用いる第１実施形態を説明した。以下、勾配演算部２１ｂを用いる第２実施形態を説明する。
【００６０】
図５は、第２実施形態における自車位置演算装置１の動作を示すフローチャートである。以下、第１実施形態（図２）との違いに着目しつつ、説明を行う。
【００６１】
図５のＳ２１では、図２のＳ１１で示したように、表１に例示されるパラメータを検出する。ここで、地図情報には、高さ軸の情報が含まれる。
Ｎｎ（ｘｎ，ｙｎ，ｚｎ）は、ノードを示す。ｚｎは、ノードの標高を示す。
Ｌｎ（ｒＬ，θＬ，σＬ，ＷＬ）は、リンクを示す。σＬは上り坂などの道路勾配（勾配におけるリンク角度）を示す。
ここで、表１に例示されるパラメータの内、勾配演算部２１ｂが勾配ベクトルの計算のために主に使用するパラメータは、車速ＶＳＰ、加速度Ａｖおよび減速度ＡＤ、入力トルクＴｎである。Ｓ２２は、Ｓ１２と同じである。
【００６２】
そして、進行方向演算部２１（勾配演算部２１ｂ）は、自車の進行方向ベクトル（ピッチベクトル）を演算する（Ｓ２３）。以下、Ｓ２３の詳細について、Ｓ２３ａからＳ２３ｄの処理を説明する。
【００６３】
まず、自車に作用する各トルクを計算する（Ｓ２３ａ）。以下、計算する各トルクの詳細について、図６を参照して説明する。
【００６４】
図６は、上下２つの道路から構成される高架道路において、高架上の道路を自車が走行する一例を示す説明図である。図６（ａ）の一部を拡大し、視点を横にした図が、図６（ｂ）である。図６（ａ）では、高架路の下側を走行している自車が、登坂道路の勾配を上り、高架路の上側を走行する。図６（ｂ）では、登坂道路の勾配を上っている自車に対して作用する各トルクを示す。
【００６５】
λは、減速比を示す。減速比（変速比とも言う）とは、トランスミッションのギア等により減速（または加速）されるエンジン回転数の比率である。つまり、同一のエンジン回転数の場合、減速比（変速比）が大きいほど、パワー（力）は大きいが、スピード（速度）は小さい。一方、減速比（変速比）が小さいほど、パワー（力）は小さいが、スピード（速度）は大きい。
ＴＴＢは、タービントルクを示す。ＴＴＢは、「入力トルクＴｎ×トルク比」で求める。トルク比は、カタログスペック値、または、センサによる計測値である。
ＴＤは、駆動トルクを示す。ＴＤは、計算式「ＴＤ＝（ＴＴＢ×ｇ）×λ／２ＲＴ」により、計算される。ここで、ｇは重力加速度を、ＲＴはタイヤ半径を示す。
ＲＦＶは、抵抗（摩擦）力を示す。ＲＦＶは、計算式「ＲＦＶ＝ｋ×Ｗ」により、計算される。ここで、ｋは道路種別（アスファルトなど）や路面状態（ウェットや積雪など）によって規定される摩擦係数を、Ｗは車両重量を示す。
ＲＡＲは、空気抵抗力を示す。ＲＡＲは、計算式「ＲＡＲ＝Ｋ×ＶＳＰ２」により、計算される。ここで、Ｋは、比例係数を示す。
ＴＦＲは、平地走行抵抗トルクを示す。ＴＦＲは、計算式「ＴＦＲ＝ＲＦＶ＋ＲＡＲ」により、計算される。
ＴＡＲは、加速抵抗トルクを示す。ＴＡＲは、計算式「ＴＡＲ＝（Ｗ＋ΔＷ）×ＡＶ×ＲＴ」により、計算される。ここで、Ａｖは、車両加速度を示す。
Ｔσは、勾配抵抗トルクを示す。Ｔσは、計算式「Ｔσ＝ＴＤ−（ＴＦＲ＋ＴＡＲ）」により、計算される。
【００６６】
次に、Ｓ２３ａで計算した各トルクから、自車の走行する道路の勾配を勾配ベクトルとして求める（Ｓ２３ｂ）。σＰは、進行方向ベクトル（勾配ベクトル）を示す。σＰは、計算式「σＰ＝ sin-1｛Ｔσ／（Ｗ・ｇ・ＲＴ）｝」により、計算される。ここで、ｇは重力加速度を示す。なお、勾配ベクトルσＰの表記としては、道路構造令に基づくパーセント（％）表示あるいは度数（角度）表示である。また、勾配ベクトルσＰは、地図情報取得部１１により取得されるリンクの道路勾配σＬの値を設定してもよい。
【００６７】
そして、自車が平坦な道路を走行しているか否かを判定する（Ｓ２３ｃ）。具体的には、Ｓ２３ｂで計算した勾配ベクトルσＰと、予め設定するしきい値σｔｈと、を勾配判定式「｜σｔｈ｜≦｜σ｜」にて比較する。所定時間連続で勾配判定式を満たすときには、勾配が急な道路を走行しており、少なくとも１回以上不成立となった場合は、比較的平坦な道路を自車が走行している。しきい値σｔｈとしては、例えば、２％〜５％の数値を設定する。
【００６８】
自車が勾配の急な道路を走行しているとき（Ｓ２３ｃ，Ｙｅｓ）、Ｓ２３ｂで更新された勾配ベクトルσＰを、コンピュータなどに内蔵されたハードディスクドライブ、ＣＤ−Ｒ、ＤＶＤ−ＲＡＭなどに記憶することで、更新する（Ｓ２３ｄ）。
【００６９】
以上、Ｓ２３の詳細を説明した。Ｓ２３の別の実現方法として、車両前部に取り付けたフロントカメラあるいは車両後部に取り付けたリアカメラを用いて、自車が走行する道路などの周辺景色を撮影し、その撮影画像に含まれる道路標識などのオブジェクトに着目し、その上下方向の変化度合いを認識することにより、演算してもよい。または、ジャイロセンサが計算するピッチ軸の速度または加速度から、勾配ベクトルσＰを求めてもよい。
【００７０】
そして、Ｓ２３で計算した勾配ベクトルσＰをもとに、補正先の道路を選択する（Ｓ２４）。補正後自車位置の計算（Ｓ２３）は、例えば、（Ａ）勾配有無方式、または、（Ｂ）高さ測定方式のいずれかにより、実現できる。
【００７１】
（Ａ）勾配有無方式は、大まかに自車が走行している道路を特定する。例えば、自車が高架下の道路を走行していたとする。その後、自車が急な道路を走行している（Ｓ２３ｃ，Ｎｏ）と判定されたとき、補正先の道路を高架上の道路に変更する。これにより、道路の高さ情報の詳細な値を必要とせずに、道路を選択することができるため、詳細な地図情報が不要であり、低コストで実現できる。
【００７２】
（Ｂ）高さ測定方式は、勾配σのある道路における自車の走行距離と、走行した道路の勾配σから高低差を演算し、地図情報と前記高低差に応じて、一番高さが近い道路を選択する方式である。これにより、同じ緯度経度地点において高さが多段階存在するような複雑な道路（高速道路のランプなど）に対しても、高精度で道路を選択することができる。
【００７３】
また、前記（Ａ）、（Ｂ）の方式の他に、ＧＰＳ精度が低下する場所や起伏の多い山間部などの道路を車両が走行する場合には、平面的な移動距離（２次元走行距離と称する）と道路勾配に応じて、起伏を考慮した走行距離（３次元走行距離と称する）を演算することにより、地図上の適切な位置に自車をマッチングすることが可能となる。また、前記した３次元走行距離を用いて、標高を含む地図情報に更新してもよい。
【００７４】
図５のＳ２５は、図２のＳ１５と同じである。図５のＳ２６は、図２のＳ１６と同じである。
【００７５】
図７は、Ｓ１６およびＳ１７で表示する画面の一例を示す画面図である。自車位置表示欄７０１は、地図上の自車の位置をアイコンで示す。進行方向表示欄７０２は、進行方向演算部２１により計算された各ベクトルを、道路構造令に則った％表示または角度表示（度）で示す。さらに、地図上に表示される地図情報としては建物および建物の種類・業種など、実景観に対応する地図情報である。前記した建物の種類・業種としては、ガソリンスタンド、コンビニエンスストア、駅、学校などの記号、名前などの表示がある。
【００７６】
補正オンオフ表示欄７０３は、Ｓ１５またはＳ２５で自車位置を補正するか（ＯＮ）、否か（ＯＦＦ）を表示する。このオンオフは、所定操作により切替が可能である。ＯＮのときには、補正後自車位置が自車位置表示欄７０１に表示され、ＯＦＦのときには、補正前自車位置が自車位置表示欄７０１に表示される。または、ＯＮのときに、自車位置表示欄７０１の点滅あるいは音声により、画面上の自車位置を補正してマッチングしていることを運転者および同乗者に報知してもよい。
【００７７】
なお、道路形状の進行方向と、運転者の操舵操作に基づく車両の進行方向（方位、勾配）とを比較して、車両の進行方位が道路形状の進行方向に対して適切でない場合（ハンドルの切りすぎなど）には、進行方向表示欄７０２の点滅や「ピピピピピ」などの音声により、操舵操作が適切でない旨を運転者に警告してもよい。
【００７８】
また、道路勾配と自車の速度を比較して、自車の速度が適切でない場合（くだり坂での速度の出しすぎなど）には、進行方向表示欄７０２の点滅や「ピピピピピ」などの音声により、道路に対して速度が適切でないむねを運手者に警告してもよい。
【００７９】
さらに、補正オンオフ表示欄７０３に表示される自車位置の補正は、方位演算部２１ａで演算される車両の方位と、勾配演算部２１ｂで演算される車両の勾配と、をそれぞれ個別に補正のオンオフを指定してもよい。例えば、周囲に高架道路が存在しない地域では、勾配演算部２１ｂによる補正処理をオフにすることで、計算量を減らすことができる。
【００８０】
以上説明したように、車載端末装置の画面上に、運転者の操舵操作に応じた車両の進行方向や、走行中の道路の勾配などの車両の姿勢をもとに、補正後自車位置を計算することで、地図上の高精度な自車位置を表示して運手者および同乗者に正確な自車位置や車両状態を報知することができる。その結果、補正後自車位置を表示するための車載端末装置の信頼性向上および運転時の快適性向上を図ることができる。
【図面の簡単な説明】
【００８１】
【図１】本発明の一実施形態に関する自車位置演算装置を示す構成図である。
【図２】本発明の第１実施形態に関する自車位置演算装置の動作を示すフローチャートである。
【図３】本発明の第１実施形態に関する補正前自車位置および補正後自車位置を示す説明図である。
【図４】本発明の第１実施形態に関する分岐路および車線変更の場合を示す概要図である。
【図５】本発明の第２実施形態に関する自車位置演算装置の動作を示すフローチャートである。
【図６】本発明の第２実施形態に関する上下２つの道路から構成される高架道路において、高架上の道路を自車が走行する一例を示す説明図である。
【図７】本発明の一実施形態に関する表示する画面の一例を示す画面図である。
【符号の説明】
【００８２】
１ 自車位置演算装置
１０ 自車位置演算部
１１ 地図情報取得部
１２ 自車位置検出部
１３ 補正前自車位置演算部
１４ パラメータ検出部
１５ 自車情報取得部
２０ 自車位置補正部
２１ 進行方向演算部
２１ａ 方位演算部
２１ｂ 勾配演算部
２２ 補正先道路選択部
２３ 補正後自車位置演算部
３０ 自車位置表示部
【技術分野】
【０００１】
本発明は、自車位置演算装置、自車位置演算方法、および、自車位置演算プログラムに関する。
【背景技術】
【０００２】
カーナビゲーションなどに搭載される自車位置演算装置において、ＧＰＳなどにより検出される自車位置は、電波障害などにより、必ずしも実際に走行している自車位置を示していないこともある。そのとき、地図情報としてあらかじめ与えられている道路を示すリンク上の位置に、自車位置をマッチングする、マップマッチングが知られている。
【０００３】
例えば、自車位置を演算する手段として、自車の車速などから走行距離を演算し、その走行距離分だけ進んだ地図のリンク上の位置に自車をマッチングする。また、曲線路などを通過する際に発生する自車位置の誤差を補正する方法として、右左折時の車両の走行距離（円弧長）分を、右左折前後の道路中心線の交点（交差点のノード）から加算した地点に自車位置を補正する方法が知られている。
【０００４】
特許文献１に記載の自車位置決定方法では、自車が交差点などで右左折する場合に、まず地図上で右左折前後の道路中心線の交点まで直線的に自車を移動させる。次に、その交点にて右左折前後の道路中心線の交差角度分だけ自車の方向を変化させる。その後、右左折後の道路の中心線上で方向転換した自車を直線的に移動させて、地図上の自車位置を決定する方法が開示されている。
【０００５】
また、特許文献２に記載の車両走行位置表示装置では、車両の現在位置と検定点（ノード：右左折前後の道路中心線の交点）とを比較して、車両の現在位置を補正する方法が開示されており、例えば車両の右左折が検出された場合に、右左折前後の道路の幅、車両の屈曲角、円弧状の走行軌跡の旋回半径に基づいて補正量を演算して自車位置を補正することにより自車位置精度の向上が図られている。
【特許文献１】特開平４−６７３００号公報
【特許文献２】特開平８−６１９６９号公報
【発明の開示】
【発明が解決しようとする課題】
【０００６】
カーナビゲーションなどの自車位置演算装置の画面などに正確な自車位置を表示して運転者に正確な自車位置を報知することにより、運転時の快適性やカーナビゲーションなどに対する信頼性を向上することができる。そのため、マップマッチングの精度を高める必要がある。
【０００７】
高精度なマップマッチングをするために、自車がどの道路上を走っているのかを選択する必要がある。もし、自車の周辺に道路が１本しかないときには、その道路をそのまま選択すればよい。しかし、自車の周辺に複数の道路が存在するときには、その中から１つの道路を選択する必要がある。この補正先の道路の表示は、交差点での左折や、速度制限による減速など、自車の制御のための、運転者にとってきわめて重要な情報である。
【０００８】
例えば、補正前の自車位置に最も近い位置に存在する道路を選択する手法を挙げる。この手法は、ＧＰＳなどにより検出した補正前の自車位置と、地図情報上に設定されたリンクの位置とが、共に高精度であることが前提となる。もし、いずれかの情報の精度が低いときには、道路の選択精度が低くなってしまい、不便である。
【０００９】
地図情報上に設定されたリンクの位置は、高精度でない場合がある。例えば、カーナビゲーションに表示する地図を構成するノードが正確な地点（道路中心線の交点）に配置されていないときには、それらのノードを端点とするリンクの位置も不正確となる。このとき、補正先の道路として、自車から遠い道路を選択してしまうこともある。
【００１０】
そこで、本発明は、前記した問題を解決し、測定した自車位置を地図の道路上にマップマッチングするときに、自車が走行している道路を高精度に選択することを、主な目的とする。
【課題を解決するための手段】
【００１１】
前記課題を解決するため、本発明は、ナビゲーション画面に表示する自車位置を補正する自車位置演算装置であって、道路を示すリンクについて、リンクの長さ方向を示す方位ベクトルを含む地図情報を、記憶手段から取得する地図情報取得部と、通信手段により自車位置を検出する自車位置検出部と、前記自車位置検出部で検出した自車位置を、前記地図情報取得部で取得した地図情報上に対応づけて補正前自車位置とする補正前自車位置演算部と、自車への操舵操作を検知することで、自車の進行方向における方位ベクトルを演算する方位演算部と、自車周辺の各リンクについて、自車の方位ベクトルと、リンクの方位ベクトルとのベクトル差分が最小となるリンクを、補正先の道路を示すリンクとして選択する補正先道路選択部と、前記補正先道路選択部で選択されたリンク上の位置を補正後自車位置として決定する補正後自車位置演算部と、前記補正後自車位置演算部が決定した前記補正後自車位置を、前記地図情報取得部で取得した地図情報上に対応づけて表示する自車位置表示部と、を有することを特徴とする。その他の手段は、後記する。
【発明の効果】
【００１２】
本発明により、測定した自車位置を地図の道路上にマップマッチングするときに、自車が走行している道路を高精度に選択することが可能になった。
【発明を実施するための最良の形態】
【００１３】
以下、図面を用いて本発明に関わる実施形態について説明する。
【００１４】
図１は、本発明の一実施形態を示す自車位置演算装置の構成図である。自車位置演算装置１は、自動車内に設置され、例えば、カーナビゲーション装置などのコンピュータに組み込まれる。なお、自車位置演算装置１は、演算処理を行う際に用いられる記憶手段としてのメモリと、前記演算処理を行う演算処理装置とを少なくとも備えるコンピュータとして構成される。なお、メモリは、ＲＡＭ（Random Access Memory）などにより構成される。演算処理は、ＣＰＵ（Central Processing Unit）によって構成される演算処理装置が、メモリ上のプログラムを実行することで、実現される。
【００１５】
自車位置演算装置１は、自車位置演算部１０と、自車位置補正部２０と、自車位置表示部３０とを有する。自車位置演算部１０は、補正前自車位置を計算する。自車位置演算部１０は、地図情報取得部１１と、自車位置検出部１２と、補正前自車位置演算部１３と、パラメータ検出部１４と、自車情報取得部１５と、を有する。
【００１６】
地図情報取得部１１は、記憶手段から地図情報を取得する。自車位置検出部１２は、自車位置情報を検出する。補正前自車位置演算部１３は、自車位置検出部１２で検出した自車位置を、地図情報取得部１１で取得した地図上に配置し、補正前自車位置とする。パラメータ検出部１４は、各種センサからの出力により、自車の走行情報に関するパラメータを検出する。自車情報取得部１５は、記憶手段から自車情報のカタログスペックを取得する。
【００１７】
自車位置補正部２０は、自車位置演算部１０で計算した補正前自車位置を補正して補正後自車位置を計算する。自車位置補正部２０は、進行方向演算部２１と、補正先道路選択部２２と、補正後自車位置演算部２３と、を有する。進行方向演算部２１は、方位演算部２１ａと、勾配演算部２１ｂとのうち、少なくとも１つの演算部から構成される。
【００１８】
進行方向演算部２１は、地図情報取得部１１で取得した地図情報と、パラメータ検出部１４で検出した走行情報と、自車情報取得部１５で取得した自車情報とを用いて、自車の進行方向ベクトルを演算する。方位演算部２１ａは、自車の進行方向ベクトルのうち、方位ベクトル（例えば、北を０度、東を９０度、南を１８０度、西を２７０度とする。方角とも呼ばれる。自車の左折右折などにより変更される。）を演算する。勾配演算部２１ｂは、自車の進行方向ベクトルのうち、勾配ベクトル（自車が走行する道路の上り下りを示す。傾斜とも呼ばれる。）を演算する。
【００１９】
補正先道路選択部２２は、地図情報取得部１１で取得した地図情報において自車の近傍に存在する複数の道路から、進行方向演算部２１で計算した自車の進行方向ベクトルに基づいて、補正先の道路を選択する。補正後自車位置演算部２３は、補正先道路選択部２２で選択した補正先の道路上に、補正前自車位置を補正して、補正後自車位置とする。
【００２０】
自車位置表示部３０は、自車位置演算部１０が計算した補正前自車位置と、自車位置補正部２０が計算した補正後自車位置とを、地図情報で示される地図上の位置に表示する。
【００２１】
以下、図１の自車位置演算装置１が補正後自車位置を計算する実施形態について、進行方向演算部２１として方位演算部２１ａを用いる第１実施形態と、進行方向演算部２１として勾配演算部２１ｂを用いる第２実施形態と、を順に説明する。これらの第１実施形態と第２実施形態とは、同一の自車位置演算装置１での併用が可能である。
【００２２】
図２は、第１実施形態における自車位置演算装置１の動作を示すフローチャートである。このフローチャートは、自車が走行することにより、自車位置が耐えず変動するので、所定周期で繰りかえし実行される。自車がカーブを曲がっているときだけでなく、直線路を走行中にもこのフローチャートを実行してもよく、走行中の微小なふらつきなどにより積算される位置誤差を低減することが可能である。
【００２３】
まず、自車位置演算部１０（地図情報取得部１１、パラメータ検出部１４、自車情報取得部１５）は、自車位置の計算に必要なデータを取得する（Ｓ１１）。以下、自車位置演算部１０の処理部ごとに、必要なデータを具体的に説明する。
【００２４】
Ｓ１１において、地図情報取得部１１は、記憶手段または通信手段から地図情報を取得する。記憶手段は、例えば、コンピュータが読み取り可能なＣＤ−ＲＯＭ、ＤＶＤ−ＲＯＭ、ハードディスクなどが挙げられる。通信手段は、例えば、所定の情報センタから地図情報を取得するために用いられる。なお、地図情報は、一般的にデータ量が多いので、自車位置の近傍に絞り込んで取得した方が処理効率がよい。
【００２５】
地図情報は、道路の主要地点（交差点など）を示すノード、道路を構成するリンク、カーナビゲーションに表示する地形や店舗の情報、道路周辺の物体の位置（緯度・経度・高度・道路との位置関係など）により構成される。
Ｎｎ（ｘｎ，ｙｎ）は、ノードを示す。Ｎｎの添字ｎは、ｎ番目のノードを示す。ｘｎは、経度を示し、ｙｎは、緯度を示す。
Ｌｎ（ｒＬ，θＬ，ＷＬ）は、リンクを示す。Ｌｎの添字ｎは、ｎ番目のリンクを示す。ｒＬは道路の長さ（リンク長）を、θＬは東西南北などの道路の方位（方位におけるリンク角度）を、ＷＬは道路における車線の幅を、それぞれ示す。なお、１つのリンクは、２つのノード（リンクの始点終点）と対応することで、リンクの地図上の位置が確定する。なお、前記した以外のリンクの情報として、例えば、道路の曲率半径を含めてもよい。
【００２６】
【表１】
【００２７】
Ｓ１１において、パラメータ検出部１４は、各種センサからの出力により、自車の走行情報に関するパラメータを検出する。検出するパラメータは、表１に例示される。
なお、入力トルクＴｎは、エンジンに関する値を元に、計算式「ポンプ容量係数×（エンジン回転数）２」によって求められる。エンジン回転数は、カタログスペック値または計測値である。ポンプ容量係数は、カタログスペック値である。
表１に例示されるパラメータの内、方位演算部２１ａが方位ベクトルの計算のために主に使用するパラメータは、車速ＶＳＰ、運転者の操舵操作量α、車両のヨーレートγである。また、前記パラメータの他に、運転者のアクセル操作量やブレーキ操作量などを検出してもよい。
【００２８】
Ｓ１１において、自車情報取得部１５は、記憶手段から自車情報のカタログスペックを取得する。カタログスペックのパラメータは、例えば、車両重量Ｗと、タイヤ半径ＲＴとが挙げられる。なお、車両重量Ｗは、搭載する人員や荷物などにより変動するので、自車内に重量計を設置して（サスペンションの変位量を計測して）、補正することが望ましい。
【００２９】
次に、自車位置演算部１０は、補正前自車位置を計算する（Ｓ１２）。具体的には、まず、自車位置検出部１２は、ＧＰＳ（Global Positioning System：衛星航法システム）との通信や、自車周辺のインフラストラクチャからの通信（路車間通信や車々間通信）により、自車位置の情報（緯度・経度・高度など）を検出する。自車位置は、自車の重心がある位置である。次に、補正前自車位置演算部１３は、自車位置検出部１２が検出した自車位置を、地図情報取得部１１が取得した地図上に配置し、補正前自車位置とする。
【００３０】
そして、進行方向演算部２１（方位演算部２１ａ）は、自車の進行方向ベクトル（方位ベクトル）を演算する（Ｓ１３）。以下、Ｓ１３の詳細について、Ｓ１３ａからＳ１３ｄの処理を説明する。
【００３１】
方位演算部２１ａは、自車が直進しているか否かを判定する（Ｓ１３ａ）。そのため、計算式「θＳ＝α／Ｇ」（αは操舵操作量、Ｇはステアリング比）により操舵角θＳを求める。次に、直進判定式「｜θＳ｜≦θｔｈ」（θｔｈは判定用の閾値）を所定時間満たし続けているとき、自車が直進していると判定し（Ｓ１３ａ，Ｙｅｓ）、処理をＳ１３ｂへ進める。一方、その直進判定式を所定時間の間に１回でも満たしていなければ、自車はカーブを曲がっていると判定し（Ｓ１３ａ，Ｎｏ）、処理をＳ１３ｃへ進める。
【００３２】
方位演算部２１ａは、１周期前に演算した操舵角θｓｚをもとに、計算式「θｓｔ＝（θＳ＋θｓｚ×積分係数）／Ｎ」により、基準姿勢パラメータθｓｔを計算する（Ｓ１３ｂ）。なお、θｓｚは演算周期の１周期前に演算した操舵角θＳ、Ｎはθｓｔを計算した演算周期ごとの繰り返し回数、積分係数は演算周期に応じて決定される値である。
【００３３】
方位演算部２１ａは、自車の最も近傍の直線路のリンク角θＬを、基準姿勢パラメータθｓｔとする（Ｓ１３ｃ）。
【００３４】
方位演算部２１ａは、Ｓ１３ａで計算した操舵角θＳと、Ｓ１３ｂまたはＳ１３ｃで計算した基準姿勢パラメータθｓｔとを用いて、計算式「θＰ＝θｓ−θｓｔ」により、方位ベクトルθＰを計算する（Ｓ１３ｄ）。なお、θＰの代わりに、自車の移動した距離比tanθＰを方位ベクトルとしてもよい。
【００３５】
以上、Ｓ１３の方位ベクトルの演算方法として、Ｓ１３ａ〜Ｓ１３ｄを説明した。Ｓ１３の別の実現方法として、車両前部に取り付けたフロントカメラあるいは車両後部に取り付けたリアカメラを用いて、自車が走行する道路の白線を認識することにより、左右方向の車両運動から演算してもよい。さらに、車両のヨーレートγや横加速度Ｇｙを利用して、方位ベクトルθＰや基準姿勢パラメータθｓｔを演算してもよい。または、ジャイロセンサが計算するヨー軸の速度または加速度から、方位ベクトルθＰを求めてもよい。ただし、以上のようにした計算された方位ベクトルθＰは、少なくとも測定誤差などを含むため、補正後自車位置Ｐ３（詳細は後記）を中心に少なくとも±１〜５ｍの範囲内にマッチングされる。
【００３６】
ここで、補正先道路選択部２２は、Ｓ１２で求めた補正前自車位置の近傍に存在する複数の道路から、計算した自車の進行方向ベクトルに基づいて、補正先の道路を選択する（Ｓ１４）。具体的には、複数の道路それぞれのリンク角度θＬと、Ｓ１３で計算した方位ベクトルθＰとのベクトル差分を計算式「｜θＰ−θＬ｜」により計算し、その差分が最小となるリンクを、補正先の道路として選択する。
【００３７】
なお、補正先の道路を選択する（Ｓ１４）ための別の手法として、補正前自車位置の最も近傍にある道路を、補正先の道路として選択する比較例がある。しかし、精度の低い位置情報を用いる比較例に比べ、精度の高い進行方向ベクトルを用いる方式は、実際には自車位置が走行していない道路を選択する誤った選択を抑制することができる。
【００３８】
補正後自車位置演算部２３は、Ｓ１４で選択した補正先の道路上に、補正前自車位置を補正して、補正後自車位置とする（Ｓ１５）。
【００３９】
図３は、補正前自車位置および補正後自車位置を示す説明図である。図３（ａ）は、直線路から曲線路に向かって自車が進行していく旨を示す図である。図３（ｂ）は、図３（ａ）の一部を拡大した図である。
【００４０】
図３（ａ）のノードＮｎ，Ｎｎ＋１，Ｎｎ＋２，Ｎｎ＋３は、リンクＬｎ−１，Ｌｎ，Ｌｎ＋１，Ｌｎ＋２上に存在する。そして、自車は、各補正前自車位置Ｐ１において、各進行方向（方位ベクトルθＰ）に向かって進行している。自車位置演算装置１は、補正前自車位置Ｐ１と、方位ベクトルθＰとを参照して、リンク上の補正後自車位置Ｐ３を求める。
【００４１】
図２の補正後自車位置の計算（Ｓ１５）は、例えば、（１）最短距離方式、または、（２）走行距離方式のいずれかにより、実現できる。
【００４２】
（１）最短距離方式を説明する。この方式は、補正前自車位置Ｐ１（ｘ１，ｙ１）から最短距離に位置する補正先の道路上の地点Ｐ３（ｘ３，ｙ３）を、補正後自車位置とする。つまり、補正前自車位置Ｐ１（ｘ１，ｙ１）から補正先の道路に向かって引いた垂線と、補正先の道路との交点を、補正後自車位置とする。
【００４３】
Ｃ（ｒＣ，θＣ）は、補正前自車位置から補正後自車位置までの自車位置補正量を示す。
【００４４】
ｒＣは、補正前自車位置から補正後自車位置までの距離を示す。θＰ＜θＬのときには「ｒＣ＝ＤＣsin（θＬ−θＰ）」で求め、θＰ＞θＬのときには「ｒＣ＝ＤＣsin（θＰ−θＬ）」で求める。ＤＣは、直前に通過したノードＮｎを基点とした自車の走行距離であり、直線路上の車速の積分値によって求める。θＬは、補正先の道路のリンク角度を示す。
ΔｒＣは、ｒＣの変化量であり、前回計算したｒＣと、今回計算したｒＣとの差分である。ΔｒＣがばらつくときには、車線内における自車がふらついていると判断する。
【００４５】
θＣは、補正前自車位置から補正後自車位置に向かう角度を示す。θＰ＜θＬのときには「θＣ＝π／２＋θＬ」で求め、θＰ＞θＬのときには「θＣ＝π／２−θＬ」で求める。
【００４６】
Ｐ３（ｘ３，ｙ３）は、補正後自車位置であり、補正前自車位置Ｐ１（ｘ１，ｙ１）と、自車位置補正量Ｃ（ｒＣ，θＣ）とのベクトル和により求める。ｘ１、ｘ３は、経度であり、ｙ１、ｙ３は、緯度である。
【００４７】
（２）走行距離方式を説明する。この方式は、補正前自車位置Ｐ１（ｘ１，ｙ１）に至る直前に通過した、補正先の道路上のノードＮｎから、走行距離ＤＣ分だけなぞった位置を、補正後自車位置Ｐ２（Ｘ２，Ｙ２）とする。
【００４８】
以上説明した、（１）最短距離方式、および、（２）走行距離方式の例について、図３（ｂ）を参照しながら、説明する。図３（ｂ）は、補正前自車位置Ｐ１から、補正後自車位置Ｐ２または補正後自車位置Ｐ３へと補正される旨を示す。
【００４９】
（２）走行距離方式では、補正後自車位置Ｐ２は、自車が補正前自車位置Ｐ１まで走行した走行距離分を、リンクＬｎ上でなぞることにより、計算される。これにより、補正前自車位置Ｐ１を起点とせずに補正後自車位置Ｐ２が求まるので、ビルの谷間などの電波遮蔽により、補正前自車位置Ｐ１が取得困難な時期についても、自車位置を出力することが可能である。
【００５０】
（１）最短距離方式では、補正後自車位置Ｐ３は、補正前自車位置Ｐ１を起点とした自車位置補正量Ｃを求め、補正前自車位置Ｐ１と、自車位置補正量Ｃとのベクトル和により、計算される。これにより、補正後自車位置Ｐ３は、自車の走行距離に影響を受けないので、蛇行運転や、カーブ時に外側に流れてしまうなどのリンクＬの位置と多少異なる経路で運転しても、高精度な自車位置を出力することが可能である。
例えば、カーブの外側を走行したことで余分な走行距離が発生してしまったとき、補正後自車位置Ｐ２はその余分な走行距離分だけ先行してしまっているが、補正後自車位置Ｐ３は補正前自車位置Ｐ１から最短距離に位置するので、余分な走行距離の影響を受けずに済む。
つまり、カーブにおいて、リンクＬが地図データ上の道路中央に配置されているとき、自車が道路中央より外側を走行していると、道路中央を走行したときよりも走行距離が長いので、補正後自車位置Ｐ３よりも補正後自車位置Ｐ２が先行する。一方、自車が道路中央より内側を走行していると道路中央を走行したときよりも走行距離が短いので、補正後自車位置Ｐ３よりも補正後自車位置Ｐ２が後退する。
【００５１】
自車位置表示部３０は、計算した自車位置を地図上に表示する（Ｓ１６）。なお、表示画面に関しては、カーナビゲーションの表示画面のほかにインナーパネルにある速度計表示画面、ヘッドアップディスプレイなどでもよい。
【００５２】
図４（ａ）は、高速道路などの分岐路において、自車が分岐路に進入する場合の概要図である。車両が分岐路などにさしかかった場合に、図３のＳ１４で示した手法により補正先の道路を特定する。このとき、車両の進行方向ベクトルθｐと、分岐路へ伸びるリンクＬｎ＋２のリンク角度θＬと、の差分が閾値θＬｔｈ以下である状態が、所定時間に途切れることなく続いたときに、分岐路へ進入すると判定する。または、方向指示器の操作により、分岐路へ進入すると判定してもよい。
【００５３】
分岐路へ進入すると判定された場合には、分岐路へ自車をマッチングする。一方、分岐路へ進入しないと判定された場合には、現状の速度あるいは運転者のアクセル操作量に応じた速度で走行する。
【００５４】
さらに、自車が分岐路に進入すると判定されたときには、分岐路先の曲線路の形状に応じて必要な速度まで減速することで、適切な速度制御を実現する。つまり、そのカーブの入口において、カーブの曲率半径に応じた目標速度となるように、車両を適切なタイミングおよび減速度で減速させる。なお、目標速度は、車両のフロント部に搭載したカメラなどでカーブの手前にある速度制限の標識などを数字認識して取得してもよいし、地図情報からあらかじめ設定された目標速度を読み込んでもよい。
【００５５】
図４（ｂ）は、自車が車線変更する場合の概要図である。まず、Ｓ１１において、地図情報取得部１１が取得する地図情報は、車線毎のノードおよびリンク情報（車線の区別、車線幅などを含む）が記載されている高精度地図である。
【００５６】
片側２車線（走行車線、追い越し車線）の道路において、自車が追い越し車線から走行車線へと車線変更する場合を説明する。図３のＳ１４で示した手法を使用すると、２車線を示す各リンクが平行であるため、角度のベクトル差分では、どちらのリンクを選択するか、特定が困難である。
【００５７】
そこで、自車位置補正量Ｃ（ｒＣ，θＣ）における自車位置補正距離ｒＣ（Ｓ１５の（１）最短距離方式で計算される）と、車線の幅ＷＲとをもとに、車線変更判定式「｜ｒＣ｜≧｜ＷＲ／２｜」にて比較することにより、車線変更するか否かを判定する。車線変更判定式を満たすときには、車線変更すると判定する。または、車線変更の検出時には方向指示器などによる信号を用いてもよい。
【００５８】
さらに、車線内における車両のふらつき（ΔｒＣ）が大きいときには、運転者への警報（画面，音声など）あるいはステア操作などにより車線逸脱防止を図ることが可能である。
【００５９】
以上、方位演算部２１ａを用いる第１実施形態を説明した。以下、勾配演算部２１ｂを用いる第２実施形態を説明する。
【００６０】
図５は、第２実施形態における自車位置演算装置１の動作を示すフローチャートである。以下、第１実施形態（図２）との違いに着目しつつ、説明を行う。
【００６１】
図５のＳ２１では、図２のＳ１１で示したように、表１に例示されるパラメータを検出する。ここで、地図情報には、高さ軸の情報が含まれる。
Ｎｎ（ｘｎ，ｙｎ，ｚｎ）は、ノードを示す。ｚｎは、ノードの標高を示す。
Ｌｎ（ｒＬ，θＬ，σＬ，ＷＬ）は、リンクを示す。σＬは上り坂などの道路勾配（勾配におけるリンク角度）を示す。
ここで、表１に例示されるパラメータの内、勾配演算部２１ｂが勾配ベクトルの計算のために主に使用するパラメータは、車速ＶＳＰ、加速度Ａｖおよび減速度ＡＤ、入力トルクＴｎである。Ｓ２２は、Ｓ１２と同じである。
【００６２】
そして、進行方向演算部２１（勾配演算部２１ｂ）は、自車の進行方向ベクトル（ピッチベクトル）を演算する（Ｓ２３）。以下、Ｓ２３の詳細について、Ｓ２３ａからＳ２３ｄの処理を説明する。
【００６３】
まず、自車に作用する各トルクを計算する（Ｓ２３ａ）。以下、計算する各トルクの詳細について、図６を参照して説明する。
【００６４】
図６は、上下２つの道路から構成される高架道路において、高架上の道路を自車が走行する一例を示す説明図である。図６（ａ）の一部を拡大し、視点を横にした図が、図６（ｂ）である。図６（ａ）では、高架路の下側を走行している自車が、登坂道路の勾配を上り、高架路の上側を走行する。図６（ｂ）では、登坂道路の勾配を上っている自車に対して作用する各トルクを示す。
【００６５】
λは、減速比を示す。減速比（変速比とも言う）とは、トランスミッションのギア等により減速（または加速）されるエンジン回転数の比率である。つまり、同一のエンジン回転数の場合、減速比（変速比）が大きいほど、パワー（力）は大きいが、スピード（速度）は小さい。一方、減速比（変速比）が小さいほど、パワー（力）は小さいが、スピード（速度）は大きい。
ＴＴＢは、タービントルクを示す。ＴＴＢは、「入力トルクＴｎ×トルク比」で求める。トルク比は、カタログスペック値、または、センサによる計測値である。
ＴＤは、駆動トルクを示す。ＴＤは、計算式「ＴＤ＝（ＴＴＢ×ｇ）×λ／２ＲＴ」により、計算される。ここで、ｇは重力加速度を、ＲＴはタイヤ半径を示す。
ＲＦＶは、抵抗（摩擦）力を示す。ＲＦＶは、計算式「ＲＦＶ＝ｋ×Ｗ」により、計算される。ここで、ｋは道路種別（アスファルトなど）や路面状態（ウェットや積雪など）によって規定される摩擦係数を、Ｗは車両重量を示す。
ＲＡＲは、空気抵抗力を示す。ＲＡＲは、計算式「ＲＡＲ＝Ｋ×ＶＳＰ２」により、計算される。ここで、Ｋは、比例係数を示す。
ＴＦＲは、平地走行抵抗トルクを示す。ＴＦＲは、計算式「ＴＦＲ＝ＲＦＶ＋ＲＡＲ」により、計算される。
ＴＡＲは、加速抵抗トルクを示す。ＴＡＲは、計算式「ＴＡＲ＝（Ｗ＋ΔＷ）×ＡＶ×ＲＴ」により、計算される。ここで、Ａｖは、車両加速度を示す。
Ｔσは、勾配抵抗トルクを示す。Ｔσは、計算式「Ｔσ＝ＴＤ−（ＴＦＲ＋ＴＡＲ）」により、計算される。
【００６６】
次に、Ｓ２３ａで計算した各トルクから、自車の走行する道路の勾配を勾配ベクトルとして求める（Ｓ２３ｂ）。σＰは、進行方向ベクトル（勾配ベクトル）を示す。σＰは、計算式「σＰ＝ sin-1｛Ｔσ／（Ｗ・ｇ・ＲＴ）｝」により、計算される。ここで、ｇは重力加速度を示す。なお、勾配ベクトルσＰの表記としては、道路構造令に基づくパーセント（％）表示あるいは度数（角度）表示である。また、勾配ベクトルσＰは、地図情報取得部１１により取得されるリンクの道路勾配σＬの値を設定してもよい。
【００６７】
そして、自車が平坦な道路を走行しているか否かを判定する（Ｓ２３ｃ）。具体的には、Ｓ２３ｂで計算した勾配ベクトルσＰと、予め設定するしきい値σｔｈと、を勾配判定式「｜σｔｈ｜≦｜σ｜」にて比較する。所定時間連続で勾配判定式を満たすときには、勾配が急な道路を走行しており、少なくとも１回以上不成立となった場合は、比較的平坦な道路を自車が走行している。しきい値σｔｈとしては、例えば、２％〜５％の数値を設定する。
【００６８】
自車が勾配の急な道路を走行しているとき（Ｓ２３ｃ，Ｙｅｓ）、Ｓ２３ｂで更新された勾配ベクトルσＰを、コンピュータなどに内蔵されたハードディスクドライブ、ＣＤ−Ｒ、ＤＶＤ−ＲＡＭなどに記憶することで、更新する（Ｓ２３ｄ）。
【００６９】
以上、Ｓ２３の詳細を説明した。Ｓ２３の別の実現方法として、車両前部に取り付けたフロントカメラあるいは車両後部に取り付けたリアカメラを用いて、自車が走行する道路などの周辺景色を撮影し、その撮影画像に含まれる道路標識などのオブジェクトに着目し、その上下方向の変化度合いを認識することにより、演算してもよい。または、ジャイロセンサが計算するピッチ軸の速度または加速度から、勾配ベクトルσＰを求めてもよい。
【００７０】
そして、Ｓ２３で計算した勾配ベクトルσＰをもとに、補正先の道路を選択する（Ｓ２４）。補正後自車位置の計算（Ｓ２３）は、例えば、（Ａ）勾配有無方式、または、（Ｂ）高さ測定方式のいずれかにより、実現できる。
【００７１】
（Ａ）勾配有無方式は、大まかに自車が走行している道路を特定する。例えば、自車が高架下の道路を走行していたとする。その後、自車が急な道路を走行している（Ｓ２３ｃ，Ｎｏ）と判定されたとき、補正先の道路を高架上の道路に変更する。これにより、道路の高さ情報の詳細な値を必要とせずに、道路を選択することができるため、詳細な地図情報が不要であり、低コストで実現できる。
【００７２】
（Ｂ）高さ測定方式は、勾配σのある道路における自車の走行距離と、走行した道路の勾配σから高低差を演算し、地図情報と前記高低差に応じて、一番高さが近い道路を選択する方式である。これにより、同じ緯度経度地点において高さが多段階存在するような複雑な道路（高速道路のランプなど）に対しても、高精度で道路を選択することができる。
【００７３】
また、前記（Ａ）、（Ｂ）の方式の他に、ＧＰＳ精度が低下する場所や起伏の多い山間部などの道路を車両が走行する場合には、平面的な移動距離（２次元走行距離と称する）と道路勾配に応じて、起伏を考慮した走行距離（３次元走行距離と称する）を演算することにより、地図上の適切な位置に自車をマッチングすることが可能となる。また、前記した３次元走行距離を用いて、標高を含む地図情報に更新してもよい。
【００７４】
図５のＳ２５は、図２のＳ１５と同じである。図５のＳ２６は、図２のＳ１６と同じである。
【００７５】
図７は、Ｓ１６およびＳ１７で表示する画面の一例を示す画面図である。自車位置表示欄７０１は、地図上の自車の位置をアイコンで示す。進行方向表示欄７０２は、進行方向演算部２１により計算された各ベクトルを、道路構造令に則った％表示または角度表示（度）で示す。さらに、地図上に表示される地図情報としては建物および建物の種類・業種など、実景観に対応する地図情報である。前記した建物の種類・業種としては、ガソリンスタンド、コンビニエンスストア、駅、学校などの記号、名前などの表示がある。
【００７６】
補正オンオフ表示欄７０３は、Ｓ１５またはＳ２５で自車位置を補正するか（ＯＮ）、否か（ＯＦＦ）を表示する。このオンオフは、所定操作により切替が可能である。ＯＮのときには、補正後自車位置が自車位置表示欄７０１に表示され、ＯＦＦのときには、補正前自車位置が自車位置表示欄７０１に表示される。または、ＯＮのときに、自車位置表示欄７０１の点滅あるいは音声により、画面上の自車位置を補正してマッチングしていることを運転者および同乗者に報知してもよい。
【００７７】
なお、道路形状の進行方向と、運転者の操舵操作に基づく車両の進行方向（方位、勾配）とを比較して、車両の進行方位が道路形状の進行方向に対して適切でない場合（ハンドルの切りすぎなど）には、進行方向表示欄７０２の点滅や「ピピピピピ」などの音声により、操舵操作が適切でない旨を運転者に警告してもよい。
【００７８】
また、道路勾配と自車の速度を比較して、自車の速度が適切でない場合（くだり坂での速度の出しすぎなど）には、進行方向表示欄７０２の点滅や「ピピピピピ」などの音声により、道路に対して速度が適切でないむねを運手者に警告してもよい。
【００７９】
さらに、補正オンオフ表示欄７０３に表示される自車位置の補正は、方位演算部２１ａで演算される車両の方位と、勾配演算部２１ｂで演算される車両の勾配と、をそれぞれ個別に補正のオンオフを指定してもよい。例えば、周囲に高架道路が存在しない地域では、勾配演算部２１ｂによる補正処理をオフにすることで、計算量を減らすことができる。
【００８０】
以上説明したように、車載端末装置の画面上に、運転者の操舵操作に応じた車両の進行方向や、走行中の道路の勾配などの車両の姿勢をもとに、補正後自車位置を計算することで、地図上の高精度な自車位置を表示して運手者および同乗者に正確な自車位置や車両状態を報知することができる。その結果、補正後自車位置を表示するための車載端末装置の信頼性向上および運転時の快適性向上を図ることができる。
【図面の簡単な説明】
【００８１】
【図１】本発明の一実施形態に関する自車位置演算装置を示す構成図である。
【図２】本発明の第１実施形態に関する自車位置演算装置の動作を示すフローチャートである。
【図３】本発明の第１実施形態に関する補正前自車位置および補正後自車位置を示す説明図である。
【図４】本発明の第１実施形態に関する分岐路および車線変更の場合を示す概要図である。
【図５】本発明の第２実施形態に関する自車位置演算装置の動作を示すフローチャートである。
【図６】本発明の第２実施形態に関する上下２つの道路から構成される高架道路において、高架上の道路を自車が走行する一例を示す説明図である。
【図７】本発明の一実施形態に関する表示する画面の一例を示す画面図である。
【符号の説明】
【００８２】
１ 自車位置演算装置
１０ 自車位置演算部
１１ 地図情報取得部
１２ 自車位置検出部
１３ 補正前自車位置演算部
１４ パラメータ検出部
１５ 自車情報取得部
２０ 自車位置補正部
２１ 進行方向演算部
２１ａ 方位演算部
２１ｂ 勾配演算部
２２ 補正先道路選択部
２３ 補正後自車位置演算部
３０ 自車位置表示部
【特許請求の範囲】
【請求項１】
ナビゲーション画面に表示する自車位置を補正する自車位置演算装置であって、
道路を示すリンクについて、リンクの長さ方向を示す方位ベクトルを含む地図情報を、記憶手段から取得する地図情報取得部と、
通信手段により自車位置を検出する自車位置検出部と、
前記自車位置検出部で検出した自車位置を、前記地図情報取得部で取得した地図情報上に対応づけて補正前自車位置とする補正前自車位置演算部と、
自車への操舵操作を検知することで、自車の進行方向における方位ベクトルを演算する方位演算部と、
自車周辺の各リンクについて、自車の方位ベクトルと、リンクの方位ベクトルとのベクトル差分が最小となるリンクを、補正先の道路を示すリンクとして選択する補正先道路選択部と、
前記補正先道路選択部で選択されたリンク上の位置を補正後自車位置として決定する補正後自車位置演算部と、
前記補正後自車位置演算部が決定した前記補正後自車位置を、前記地図情報取得部で取得した地図情報上に対応づけて表示する自車位置表示部と、を有することを特徴とする
自車位置演算装置。
【請求項２】
ナビゲーション画面に表示する自車位置を補正する自車位置演算装置であって、
道路を示すリンクについて、リンクの地上方向の高さを示すリンク高さを含む地図情報を、記憶手段から取得する地図情報取得部と、
通信手段により自車位置を検出する自車位置検出部と、
前記自車位置検出部で検出した自車位置を、前記地図情報取得部で取得した地図情報上に対応づけて補正前自車位置とする補正前自車位置演算部と、
自車にかかるトルクを検知することで、自車の進行方向における勾配ベクトルを演算する勾配演算部と、
自車周辺の各リンクについて、自車の勾配ベクトルをもとに計算した自車の高さと、リンク高さとを照合することにより、補正先の道路を示すリンクを選択する補正先道路選択部と、
前記補正先道路選択部で選択されたリンク上の位置を補正後自車位置として決定する補正後自車位置演算部と、
前記補正後自車位置演算部が決定した前記補正後自車位置を、前記地図情報取得部で取得した地図情報上に対応づけて表示する自車位置表示部と、を有することを特徴とする
自車位置演算装置。
【請求項３】
前記補正後自車位置演算部は、前記補正先道路選択部が選択したリンク上の位置の内、前記自車位置検出部で検出した自車位置に最も近い位置を、前記補正後自車位置として決定することを特徴とする
請求項１または請求項２に記載の自車位置演算装置。
【請求項４】
前記自車位置表示部は、前記補正前自車位置、または、前記補正後自車位置のうち、いずれか一方の自車位置を指定されると、その指定された自車位置を地図上に表示することを特徴とする
請求項１ないし請求項３のいずれか１項に記載の自車位置演算装置。
【請求項５】
前記自車位置表示部は、前記補正前自車位置から前記補正後自車位置までの距離の時間変化が大きいときに、自車がふらついている旨の警告を表示することを特徴とする
請求項１ないし請求項４のいずれか１項に記載の自車位置演算装置。
【請求項６】
ナビゲーション画面に表示する自車位置を補正する自車位置演算方法であって、
コンピュータが、
道路を示すリンクについて、リンクの長さ方向を示す方位ベクトルを含む地図情報を、記憶手段から取得し、
通信手段により自車位置を検出し、
前記検出した自車位置を、前記取得した地図情報上に対応づけて補正前自車位置とし、
自車への操舵操作を検知することで、自車の進行方向における方位ベクトルを演算し、
自車周辺の各リンクについて、前記自車の方位ベクトルと、前記リンクの方位ベクトルとのベクトル差分が最小となるリンクを、補正先の道路を示すリンクとして選択し、
前記選択されたリンク上の位置を補正後自車位置として決定し、
前記決定した補正後自車位置を、前記地図情報上に対応づけて表示することを特徴とする
自車位置演算方法。
【請求項７】
ナビゲーション画面に表示する自車位置を補正する自車位置演算方法であって、
コンピュータが、
道路を示すリンクについて、リンクの地上方向の高さを示すリンク高さを含む地図情報を、記憶手段から取得し、
通信手段により自車位置を検出し、
前記検出した自車位置を、取得した地図情報上に対応づけて補正前自車位置とし、
自車にかかるトルクを検知することで、自車の進行方向における勾配ベクトルを演算し、
自車周辺の各リンクについて、前記自車の勾配ベクトルをもとに計算した自車の高さと、前記リンク高さとを照合することにより、補正先の道路を示すリンクを選択し、
前記選択されたリンク上の位置を補正後自車位置として決定し、
前記決定した補正後自車位置を、前記取得した地図情報上に対応づけて表示することを特徴とする
自車位置演算方法。
【請求項８】
請求項６または請求項７に記載された自車位置演算方法を、コンピュータに実行させるための自車位置演算プログラム。
【請求項１】
ナビゲーション画面に表示する自車位置を補正する自車位置演算装置であって、
道路を示すリンクについて、リンクの長さ方向を示す方位ベクトルを含む地図情報を、記憶手段から取得する地図情報取得部と、
通信手段により自車位置を検出する自車位置検出部と、
前記自車位置検出部で検出した自車位置を、前記地図情報取得部で取得した地図情報上に対応づけて補正前自車位置とする補正前自車位置演算部と、
自車への操舵操作を検知することで、自車の進行方向における方位ベクトルを演算する方位演算部と、
自車周辺の各リンクについて、自車の方位ベクトルと、リンクの方位ベクトルとのベクトル差分が最小となるリンクを、補正先の道路を示すリンクとして選択する補正先道路選択部と、
前記補正先道路選択部で選択されたリンク上の位置を補正後自車位置として決定する補正後自車位置演算部と、
前記補正後自車位置演算部が決定した前記補正後自車位置を、前記地図情報取得部で取得した地図情報上に対応づけて表示する自車位置表示部と、を有することを特徴とする
自車位置演算装置。
【請求項２】
ナビゲーション画面に表示する自車位置を補正する自車位置演算装置であって、
道路を示すリンクについて、リンクの地上方向の高さを示すリンク高さを含む地図情報を、記憶手段から取得する地図情報取得部と、
通信手段により自車位置を検出する自車位置検出部と、
前記自車位置検出部で検出した自車位置を、前記地図情報取得部で取得した地図情報上に対応づけて補正前自車位置とする補正前自車位置演算部と、
自車にかかるトルクを検知することで、自車の進行方向における勾配ベクトルを演算する勾配演算部と、
自車周辺の各リンクについて、自車の勾配ベクトルをもとに計算した自車の高さと、リンク高さとを照合することにより、補正先の道路を示すリンクを選択する補正先道路選択部と、
前記補正先道路選択部で選択されたリンク上の位置を補正後自車位置として決定する補正後自車位置演算部と、
前記補正後自車位置演算部が決定した前記補正後自車位置を、前記地図情報取得部で取得した地図情報上に対応づけて表示する自車位置表示部と、を有することを特徴とする
自車位置演算装置。
【請求項３】
前記補正後自車位置演算部は、前記補正先道路選択部が選択したリンク上の位置の内、前記自車位置検出部で検出した自車位置に最も近い位置を、前記補正後自車位置として決定することを特徴とする
請求項１または請求項２に記載の自車位置演算装置。
【請求項４】
前記自車位置表示部は、前記補正前自車位置、または、前記補正後自車位置のうち、いずれか一方の自車位置を指定されると、その指定された自車位置を地図上に表示することを特徴とする
請求項１ないし請求項３のいずれか１項に記載の自車位置演算装置。
【請求項５】
前記自車位置表示部は、前記補正前自車位置から前記補正後自車位置までの距離の時間変化が大きいときに、自車がふらついている旨の警告を表示することを特徴とする
請求項１ないし請求項４のいずれか１項に記載の自車位置演算装置。
【請求項６】
ナビゲーション画面に表示する自車位置を補正する自車位置演算方法であって、
コンピュータが、
道路を示すリンクについて、リンクの長さ方向を示す方位ベクトルを含む地図情報を、記憶手段から取得し、
通信手段により自車位置を検出し、
前記検出した自車位置を、前記取得した地図情報上に対応づけて補正前自車位置とし、
自車への操舵操作を検知することで、自車の進行方向における方位ベクトルを演算し、
自車周辺の各リンクについて、前記自車の方位ベクトルと、前記リンクの方位ベクトルとのベクトル差分が最小となるリンクを、補正先の道路を示すリンクとして選択し、
前記選択されたリンク上の位置を補正後自車位置として決定し、
前記決定した補正後自車位置を、前記地図情報上に対応づけて表示することを特徴とする
自車位置演算方法。
【請求項７】
ナビゲーション画面に表示する自車位置を補正する自車位置演算方法であって、
コンピュータが、
道路を示すリンクについて、リンクの地上方向の高さを示すリンク高さを含む地図情報を、記憶手段から取得し、
通信手段により自車位置を検出し、
前記検出した自車位置を、取得した地図情報上に対応づけて補正前自車位置とし、
自車にかかるトルクを検知することで、自車の進行方向における勾配ベクトルを演算し、
自車周辺の各リンクについて、前記自車の勾配ベクトルをもとに計算した自車の高さと、前記リンク高さとを照合することにより、補正先の道路を示すリンクを選択し、
前記選択されたリンク上の位置を補正後自車位置として決定し、
前記決定した補正後自車位置を、前記取得した地図情報上に対応づけて表示することを特徴とする
自車位置演算方法。
【請求項８】
請求項６または請求項７に記載された自車位置演算方法を、コンピュータに実行させるための自車位置演算プログラム。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【公開番号】特開２００９−７４９８６（Ｐ２００９−７４９８６Ａ）
【公開日】平成２１年４月９日（２００９．４．９）
【国際特許分類】
【出願番号】特願２００７−２４５３１６（Ｐ２００７−２４５３１６）
【出願日】平成１９年９月２１日（２００７．９．２１）
【出願人】（５９１１３２３３５）株式会社ザナヴィ・インフォマティクス (745)
【Ｆターム（参考）】
【公開日】平成２１年４月９日（２００９．４．９）
【国際特許分類】
【出願日】平成１９年９月２１日（２００７．９．２１）
【出願人】（５９１１３２３３５）株式会社ザナヴィ・インフォマティクス (745)
【Ｆターム（参考）】
[ Back to top ]