方位特定装置、方位特定方法及びコンピュータプログラム
【課題】車両の進行方位を高精度に特定することができる方位特定装置を提供する。
【解決手段】算出した車両の方位角度に基づいて車両の進行方位を特定する方位特定装置において、まず、ジャイロセンサで車両の旋回角度を検出する。GPS信号に基づいて方位角度θn(n=0,1,2,)を算出する。方位角度θn及び旋回角度の所定時間内における変化量を算出する。算出した変化量に基づいて、算出した方位角度に対する信頼性を判定する。判定した信頼性に応じて、算出した方位角度及びジャイロセンサで検出した旋回角度に基づいて車両の進行方位を特定する。
【解決手段】算出した車両の方位角度に基づいて車両の進行方位を特定する方位特定装置において、まず、ジャイロセンサで車両の旋回角度を検出する。GPS信号に基づいて方位角度θn(n=0,1,2,)を算出する。方位角度θn及び旋回角度の所定時間内における変化量を算出する。算出した変化量に基づいて、算出した方位角度に対する信頼性を判定する。判定した信頼性に応じて、算出した方位角度及びジャイロセンサで検出した旋回角度に基づいて車両の進行方位を特定する。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、例えばGPS(Global Positioning System)及びジャイロセンサを利用して車両の進行方位を特定する方位特定装置、方位特定方法及びコンピュータプログラムに関する。
【背景技術】
【0002】
車両の位置を検出するカーナビゲーション装置には、距離センサ、方位センサ及びジャイロセンサ(角速度センサ)などを用いて測位する自立航法、及び人工衛星からの電波を受信して測位するGPS(Global Positioning System)航法の一方又は両方を用いて自車位置を測位するものがある。
【0003】
自立航法では、車速センサ及びジャイロセンサを用いて測位を行う。車速センサは、車両の単位時間当たりの移動距離を精度よく取得することができるセンサである。ジャイロセンサは、相対的な角度の変化量を精度よく測定するセンサであり、周囲の状況に拘わらず、短時間においては変位量を安定して測定できる。自立航法では、ジャイロセンサにより車両の進行方向を検出し、車速センサにより検出した車速を用いて走行距離を算出する。そして、ある時点での位置及び進行方位を取得し、取得した地点からどのように走行したかを、検出した進行方向及び算出した走行距離を用いて随時測位していくことにより、自車位置を測位する。
【0004】
GPS航法では、定期的に人工衛星からの電波(GPS信号)を受信して自車位置を測位する。GPS航法では、定期的にGPS信号を受信して測位を行う。このGPS航法において得られる位置は絶対位置であり、各時刻における測位精度は過去の測位精度の影響を受けない。つまり、誤差が蓄積することなく、自車位置を測位することができる。
【0005】
このGPS航法において、高層ビルが密集している都市部などGPS信号を受信できない場所では自車位置を測位できない場合がある。そこで、一般的にカーナビゲーション装置では、自立航法とGPS航法とを融合させて、車両位置及び車両の進行方位を特定している。自立航法とGPS航法とを融合させたナビゲーション装置として、特許文献1には、人工衛星の配置状態を検出し、配置状態に応じてGPSにより算出した方位の誤差を推定し、その結果に基づいて算出した方位を車両の進行方位の検出に採用するか否かの判定を行うナビゲーション装置が記載されている。GPS信号の受信状態が悪い場合にはGPS航法による測位の精度が低下するため、受信状態が悪い状況でGPS航法による測位を行うことで、却って不正確な位置及び方位を検出する場合がある。このため、特許文献1のように、算出した方位の誤差が大きく、精度が低いと推定される場合には、その方位を採用しないことで、方位の検出精度を向上させることができる。
【特許文献1】特許第2921413号公報
【発明の開示】
【発明が解決しようとする課題】
【0006】
しかしながら、人工衛星の配置状態が良いと判断し、GPS信号により算出した方位の誤差が小さいと推定した場合であっても、実際には衛星から直接受信した電波のみならず、建物に反射して受信した電波も受信していることが多く、このようなときには大きな誤差が発生することがある。つまり、特許文献1の方法において、算出結果に大きな誤差が含まれているにも拘らず、誤差が小さいと判定して進行方位の検出に採用してしまう場合がある。
【0007】
一方、ジャイロセンサを用いて行った測位結果には、時間及び旋回角度と共に誤差が蓄積する。図12は、自立航法による測位結果の一例を示す図である。図12は、出発地点から周回し、元の出発地点へと戻ってきた場合の測位結果であるが、図に示すように、出発地点と到達地点とが一致していない。自立航法では、前回測位した位置に基づいて新たな位置を測位するため、前回の測位した位置に誤差がある場合、新たに測位する位置にも誤差が生じる。このように、自立航法では、誤差が蓄積するため、随時、絶対位置及び絶対方位角度を計測できるセンサを用いて位置及び方位角度を補正する必要がある。さらに、自律航法では初期位置と初期の方位角度を取得することができないので、これらを別途取得する必要がある。
【0008】
本発明は斯かる事情に鑑みてなされたものであり、その目的とするところは、状況に応じて信頼性が左右される方位特定方法、及び経過時間と共に誤差が蓄積する方位特定方法を適切に組み合わせることで、車両の進行方位を高精度に特定することができる方位特定装置、方位特定方法及びコンピュータプログラムを提供することにある。
【課題を解決するための手段】
【0009】
第1発明に係る方位特定装置は、第1方位角度算出手段が算出した車両の方位角度に基づいて、車両の進行方位を特定する方位特定装置であって、車両の旋回角度を検出する角度検出手段と、前記第1方位角度算出手段が算出した方位角度の所定時間内における変化量を算出する第1算出手段と、前記角度検出手段が検出した前記所定時間内における旋回角度を算出する第2算出手段と、前記第1算出手段が算出した変化量及び第2算出手段が算出した旋回角度に基づいて、前記第1方位角度算出手段の算出結果に対する信頼性を判定する信頼性判定手段と、該信頼性判定手段による信頼性の判定結果に応じて、前記第1方位角度算出手段が算出した方位角度及び前記角度検出手段が検出した旋回角度に基づいて、車両の進行方位を特定する特定手段とを備えることを特徴とする。
【0010】
第2発明に係る方位特定装置は、第1発明において、車速を検出する車速検出手段と、該車速検出手段が検出した車速が所定速度以上であるか否かを判定する速度判定手段とをさらに備え、前記信頼性判定手段は、前記速度判定手段が所定速度以上であると判定した場合に信頼性を判定する構成としてあることを特徴とする。
【0011】
第3発明に係る方位特定装置は、過去の車両の進行方位を記憶する進行方位記憶手段と、前記角度検出手段が検出した旋回角度と前記進行方位記憶手段に記憶した車両の進行方位とに基づいて車両の方位角度を算出する第2方位角度算出手段とをさらに備え、前記特定手段は、前記第1方位角度算出手段及び第2方位角度算出手段の算出結果の少なくとも一方に重み付けをし、重み付けをした算出結果に基づいて車両の進行方位を特定する際に、前記信頼性判定手段が判定した信頼性が高いほど、前記第1方位角度算出手段の算出結果に相対的に大きな重み付けをし、車両の進行方位を特定する構成としてあることを特徴とする。
【0012】
第4発明に係る方位特定装置は、第3発明において、前記特定手段は、所定期間が経過するまで及び/又は所定角度を旋回するまで、前記第2方位角度算出手段の算出結果のみに基づいて車両の進行方位を特定する構成としてあることを特徴とする。
【0013】
第5発明に係る方位特定装置は、第1発明乃至第4発明の何れか一つにおいて、人工衛星信号が人工衛星から送信されており、前記人工衛星信号を異なるタイミングで受信する第1受信手段と、該第1受信手段が異なるタイミングで受信した人工衛星信号それぞれに基づいて車両位置を検出する第1車両位置検出手段とをさらに備え、前記第1方位角度算出手段は、前記第1車両位置検出手段が検出した各車両位置を用いて方位角度を算出する構成としてあることを特徴とする。
【0014】
第6発明に係る方位特定装置は、第5発明において、前記人工衛星は複数配置され、前記第1受信手段は、複数の人工衛星から人工衛星信号を受信する構成としてあり、前記第1受信手段が受信した人工衛星信号に基づいて、人工衛星の配置状態、受信した人工衛星信号を送信した人工衛星の数、各人工衛星信号の強度、及び各人工衛星信号の強度とノイズとの比の少なくとも一つ以上の人工衛星状態情報を取得する状態情報取得手段をさらに備え、前記特定手段は、前記状態情報取得手段が取得した人工衛星状態情報に基づいて、前記第1方位角度算出手段及び第2方位角度算出手段の算出結果に重み付けをし、車両の進行方位を特定する構成としてあることを特徴とする。
【0015】
第7発明に係る方位特定装置は、第1発明乃至第4発明の何れか一つにおいて、異なる地点から送信された信号を受信する第2受信手段と、該第2受信手段が受信した信号の到達時間及び到達時間差の少なくとも一方を取得する時間取得手段と、前記第2受信手段が受信した信号及び前記時間取得手段が取得した到達時間及び到達時間差の少なくとも一方を用いて車両位置を検出する第2車両位置検出手段とをさらに備え、前記第1方位角度算出手段は、前記第2車両位置検出手段が検出した車両位置を用いて方位角度を算出する構成としてあることを特徴とする。
【0016】
第8発明に係る方位特定装置は、第1発明乃至第4発明の何れか一つにおいて、信号が複数の人工衛星又は異なる地点から送信されており、前記信号を受信する第3受信手段をさらに備え、前記第1方位角度算出手段は、前記第3受信手段が受信する信号のドップラーシフトを用いて方位角度を算出する構成としてあることを特徴とする。
【0017】
第9発明に係る方位特定装置は、第5発明又は第6発明において、人工衛星が送信した人工衛星信号の周波数を取得する第1周波数取得手段と、前記第1受信手段が受信した人工衛星信号の周波数を取得する第2周波数取得手段と、前記第1受信手段が受信した人工衛星信号に基づいて、人工衛星の位置、人工衛星の速度、及び人工衛星の進行方位を取得する軌道情報取得手段とをさらに備え、前記第1方位角度算出手段は、前記第1及び第2周波数取得手段が取得した周波数に基づいて前記人工衛星信号のドップラーシフトを算出し、該ドップラーシフト、前記第1車両位置検出手段が検出した車両位置、及び、前記軌跡情報取得手段による取得結果を用いて方位角度を算出する構成としてあることを特徴とする。
【0018】
第10発明に係る方位特定方法は、第1方位角度算出手段が算出した車両の方位角度に基づいて、方位特定装置で車両の進行方位を特定する方位特定方法であって、角度検出手段で車両の旋回角度を検出するステップと、前記第1方位角度算出手段が算出した方位角度の所定時間内における変化量を算出するステップと、前記角度検出手段が検出した前記所定時間内における旋回角度を算出するステップと、算出した変化量及び算出した旋回角度に基づいて、前記第1方位角度算出手段の算出結果に対する信頼性を判定するステップと、信頼性の判定結果に応じて、前記第1方位角度算出手段が算出した方位角度及び前記角度検出手段が検出した旋回角度に基づいて、車両の進行方位を特定するステップとを備えることを特徴とする。
【0019】
第11発明に係るコンピュータプログラムは、車両の旋回角度が取得できるコンピュータに、算出させた車両の方位角度に基づいて、車両の進行方位を特定させるコンピュータプログラムであって、前記コンピュータを、算出した方位角度の所定時間内における変化量を算出する第1算出手段、取得した前記所定時間内における旋回角度を算出する第2算出手段、前記第1算出手段が算出した変化量及び第2算出手段が算出した旋回角度に基づいて、算出した車両の方位角度に対する信頼性を判定する信頼性判定手段、及び、該信頼性判定手段による信頼性の判定結果に応じて、算出した車両の方位角度及び取得した旋回角度に基づいて、車両の進行方位を特定する特定手段として機能させることを特徴とする。
【0020】
第1発明、第10発明及び第11発明においては、方位特定装置は、車両の方位角度を算出する。方位角度は、例えばGPS信号又は無線送信機などの路上機器からの信号などを用いて2地点で車両位置を求めることで算出することができる。また、GPS信号のドップラーシフトに基づいても算出できる。方位特定装置は、車両の角度検出手段(ジャイロセンサ)により車両の旋回角度を検出する。そして、方位特定装置は、算出した方位角度の所定時間内の変化量と、所定時間内に角度検出手段が検出した旋回角度の変化量とをそれぞれ算出する。方位特定装置は、算出したそれぞれの変化量に基づいて、算出した方位角度に対する信頼性を判定する。信頼性の判定結果に応じて、算出した方位角度及び角度検出手段が検出した角度に基づいて、車両の進行方位を特定する。
【0021】
ジャイロセンサなどの角度検出手段では、精度よく車両の旋回角度を検出でき、その結果を積算して算出する車両の進行方位は短時間では精度が高い一方で、経過時間と共に誤差が蓄積する。一方、GPS信号などから算出した方位角度は、経過時間に関係なく誤差が蓄積しないが、周囲の状況によって測位の精度が左右される。そこで、上述のように、算出した方位角度の信頼性に応じて、角度検出手段で検出した旋回角度と、算出した方位角度とを適切に組み合わせることで、精度よく車両の進行方位を特定することができる。
【0022】
第2発明においては、方位特定装置は、車速を検出し、検出した車速が所定速度以上であるか否かを判定する。車速は、例えば車輪の回転数を検出する車輪速センサの出力値により検出することができる。そして、検出した車速が所定速度以上であると判定した場合に、算出した方位角度に対する信頼性を判定する。低速で走行している場合には、進行方向に対する変位角度にバラつきが発生するため、検出した変位角度の精度が低くなる。このため、低速走行の場合には、算出した方位角度の信頼性の判定を行わない。これにより、信頼性の判定結果の精度を高めることができるので、精度よく車両の進行方位を特定することができる。
【0023】
第3発明においては、方位特定装置は、過去の車両の進行方位及び旋回角度に基づいて方位角度を算出する。過去の車両の進行方位は、直前に検出した進行方位であってもよいし、複数回前に検出した進行方位であってもよい。算出した方位角度と、GPS信号又は路上機器からの信号などから算出した車両位置を用いて算出した方位角度とに基づいて車両の進行方位を特定する。このとき、方位特定装置は、算出したそれぞれの方位角度の少なくとも何れか一方に重み付けをし、重み付けをした算出結果に基づいて車両の進行方位を特定する際に、算出した方位角度に対する信頼性が高いほど、GPS信号又は路上機器からの信号などから算出した方位角度を用いて算出した算出結果に相対的に大きな重み付けをし、車両の進行方位を特定する。算出した方位角度の信頼性が高ければ、GPS信号又は路上機器からの信号等から算出した方位角度に含まれる誤差は小さいと判断できるからである。これにより、精度よく車両の進行方位を特定することができる。
【0024】
第4発明においては、方位特定装置は、例えば高い精度で車両の進行方位を取得できた後、所定期間が経過するまで及び/又は所定角度を旋回するまで、角度検出手段が検出した旋回角度と過去の車両の進行方位とに基づいて算出した車両の方位角度のみを用いて車両の進行方位を特定する。ジャイロセンサなどの角度検出手段では、短時間では精度の高い測位を行える一方で、走行距離と共に誤差が蓄積する。このため、蓄積する誤差が例えば閾値よりも大きくなるまで、検出した旋回角度のみにより車両の進行方位を特定することで、精度の高い結果を得ることができる。旋回角度のみを用いる期間は、上述のように誤差の蓄積量で区切ってもよいし、時間で区切ってもよい。
【0025】
第5発明においては、人工衛星から信号が送信されており、方位特定装置は、信号を異なるタイミングで受信し、受信した信号それぞれに基づいて車両位置を検出する。そして、方位特定装置は、検出したそれぞれの車両位置を用いて方位角度を算出する。例えば、一のタイミングでGPSを利用して走行中の車両の絶対位置(経度及び緯度など)を取得し、所定時間走行後さらにGPSを利用して車両の絶対位置を取得する。そして、前後2つの地点の絶対位置から方位角度を算出することができる。このようにして求めた車両の進行方位は、時間の経過により誤差の蓄積がなく、求めた車両の進行方位とジャイロセンサなどにより求めた旋回角度とを組み合わせることで、車両方位を精度よく特定することができる。
【0026】
第6発明においては、人工衛星は複数配置され、方位特定装置は、複数の人工衛星から信号を受信し、人工衛星の配置状態、人工衛星の数、各人工衛星信号の強度、及び各人工衛星信号の強度とノイズとの比の少なくとも一つ以上の人工衛星状態情報を検出する。そして、方位特定装置は、検出した人工衛星状態情報に基づいて、方位角度に重み付けをし、進行方位を特定する。例えば、信号を受信できた人工衛星の数が多いほど、特に信号強度が基準値以上の信号を受信できた人工衛星の数が多いほど、又は、信号を受信できた人工衛星の位置の散りばり具合が大きいほど(DOP:Dilution Of Precisionが小さいほど)、GPS信号から算出した方位角度に相対的に大きな重み付けをし、車両の進行方位を特定する。DOPは、精度低下率であり、単独測位における、衛星配置による測位精度の低下率を数字で表したものである。DOPは数値が大きくなるほど精度が低くなる(測位誤差が大きくなる)。これにより、精度良く車両の進行方位を特定することができる。
【0027】
第7発明においては、例えば、路側に無線の送信装置を設置し、方位特定装置は、これらの送信装置から送信された信号を受信し、各信号の到達時間及び到達時間差の少なくとも一方を取得する。そして、方位特定装置は、車両の走行地点で取得した各信号の到達時間又は到達時間差に基づいて、車両位置を検出する。方位特定装置は、検出した車両位置を用いて方位角度を算出する。例えば、2つの車両位置を検出することで方位角度を算出することができる。このようにして求めた車両の進行方位は、時間の経過により誤差の蓄積がなく、求めた車両の進行方位とジャイロセンサなどにより求めた旋回角度とを組み合わせることで、精度よく車両方位を特定することができる。
【0028】
第8発明においては、方位特定装置は、受信する信号のドップラーシフトを用いて方位角度を算出する。近年、位相同期回路(PLL:Phase-locked loop)の高精度化などに伴い、電波の周波数を測定する精度が大きく向上しており、その結果、現在のGPS受信機においてはドップラー周波数を利用することでも正確な方位を得ることができる。このようにして求めた車両の進行方位は、時間の経過により誤差の蓄積がなく、求めた車両の進行方位とジャイロセンサなどにより求めた旋回角度とを組み合わせることで、精度よく車両方位を特定することができる。
【0029】
第9発明においては、方位特定装置は、人工衛星が送信した人工衛星信号の周波数、及び受信した人工衛星信号の周波数を取得し、それぞれの周波数に基づいて人工衛星信号のドップラーシフトを算出する。そして、算出したドップラーシフト、検出した車両位置、人工衛星の位置、人工衛星の速度、及び人工衛星の進行方位を用いて方位角度を算出する。このようにして求めた車両の進行方位は、時間の経過により誤差の蓄積がない。この結果と、ジャイロセンサなどにより求めた旋回角度を組み合わせることで、精度よく車両方位を特定することができる。
【発明の効果】
【0030】
本発明によれば、車両の旋回角度を検出する角度検出手段による検出結果を用いて、算出した車両の方位角度の信頼性を判定し、判定結果に応じて、算出した方位角度と、角度検出手段が検出した旋回角度に基づいて、車両の進行方位を特定する。これにより、精度よく車両の進行方位を特定することができる。
【発明を実施するための最良の形態】
【0031】
以下、本発明をその実施の形態を示す図面に基づいて詳述する。
【0032】
本発明に係る方位特定装置である車載機は、車両に搭載され、複数のGPS衛星からの電波を受信する。GPS衛星は、原子時計及び基準発信器などを搭載し、信号を送信する。送信される信号には、原子時計により正確なタイミングで発信される測位用の所定のコード(符号)が含まれ、そのコードが受信機に到達するまでにどれだけの時間(伝播時間)を要したかを測定することにより、GPS衛星との距離(伝播時間×光速)を測定することができる。3つの衛星との距離を求められれば、各衛星を中心とする球の交点を算出することにより自車の位置を決定できる。しかし、実際には車載機の時計に含まれる誤差をキャンセルするために、4つの衛星からの信号を用いて自車の位置を決定する。
【0033】
図1は、本実施の形態に係る車載機の構成を示すブロック図である。車載機30は、車両に搭載され、路側装置との通信機能を有する通信部31、GPS受信機能を有するGPS受信部32、車載機30の動作を制御する制御部33、記憶部34、表示部35、操作部36、ジャイロセンサ371及び車速センサ372などの車載センサを備えるセンサ部37及びナビゲーション部38などを備えている。
【0034】
通信部31は、路側装置との通信機能を有する。通信部31と通信する路上装置は、光ビーコン、電波ビーコン又はDSRC(Dedicated Short Range Communication)などの狭域通信に限定されるものではなく、例えば、中域通信としてUHF帯又はVHF帯などの無線LAN機能を備えるものでもよく、あるいは、広域通信として携帯電話、PHS、多重FM放送及びインターネット通信などの通信機能を備えるものでもよい。
【0035】
GPS受信部32は、DGPS(ディファレンシャルGPS)又はRTK−GPS(Real-Time Kinematic GPS)などのGPS受信機能を備え、複数のGPS衛星20からのGPS信号を所定時間(例えば1秒)毎に受信する。GPS信号には、時刻情報、GPS衛星20の軌道情報及び測位情報などを含んでおり、制御部33は、GPS受信部32で受信したGPS信号により、自車がどの範囲内に存在するかを示す領域情報(緯度、経度及び高度)を取得することができる。なお、GPS受信部32の精度及び受信電波の状況などに応じて自車の存在領域は変動する可能性がある。
【0036】
記憶部34は、通信部31及びGPS受信部32を通じて受信した情報を記憶する。受信して記憶する情報は、例えば、道路形状に関する道路形状情報、信号を受信した際の受信時点、その信号の送信時点を示す送信時点情報、及び光ビーコンなどの路側装置の位置情報(通信地点の位置情報)などである。また、記憶部34は、予め方位特定装置の搭載位置の高さ情報及び地図情報などを記憶してある。
【0037】
表示部35は、ヘッドアップディスプレイ、カーナビゲーションシステム又は監視モニタなどの液晶表示パネルであり、運転者に対して、各種交通情報を表示することができる。例えば、交差点又は停止線までの距離、又は交差点を安全に走行できない場合の警告などを表示する。
【0038】
操作部36は、各種操作パネルを備え、運転者と車載機30とのユーザインタフェースとして機能する。例えば、操作部36は、運転者の操作により車載機30の動作の開始又は停止の操作を受け付ける。
【0039】
センサ部37は、ジャイロセンサ371及び車速センサ372などの自立航法センサを備え、自立航法に必要な自立航法データを制御部33に出力する。ジャイロセンサ371は、カーブした道路の走行時、又は交差点での右左折時に、自車に生じる旋回速度(角速度)を検出する。なお、車両が直線走行している場合には、ジャイロセンサ371はゼロ付近の値を出力する。車速センサ372は、自車の速度を検出する。車速センサは、例えば、車輪に設けられ、車輪の凹凸を検知する車輪速センサである。凹凸の周期は車輪に応じて1周当たり50程度である。車輪速センサは、(タイヤの回転数)×(1周当たりの凹凸)に応じたパルスを出力する。なお、車輪速センサの場合、車輪の回転数に一対一の関係で対応する如何なるパラメータを検出するセンサにより代替されてもよく、例えば、トランスミッションの出力軸の回転数を検出するセンサにより代替されてもよい。
【0040】
ナビゲーション部38は、地図データベースなどを内蔵し、GPS受信部32からの情報及びセンサ部37からの情報に基づいて、自車の走行履歴(例えば、時刻とともに記録された走行距離、走行方位、走行速度、及び加減速度など)を記憶している。
【0041】
制御部33は、GPS受信部32が受信したGPS信号により自車位置を測位する。制御部33は、同時に3つのGPS衛星20からのGPS信号を受信し解析することで二次元の測位(緯度及び経度)を行うことができ、同時に4つのGPS衛星20からのGPS信号を受信し解析することで三次元の測位(緯度、経度及び高度)を行うことができる。3つの衛星との距離を求められれば、各衛星を中心とする球の交点を算出することにより自車の位置を決定できる。しかし、実際には車載機の時計に含まれる誤差をキャンセルするために、4つの衛星からの信号を用いて自車の位置を決定する。制御部33は、GPS衛星20からGPS信号が送信された時刻とそのGPS信号を受信した時刻とから時間差を算出し、この時間差に光速度を乗じることでGPS衛星20と車載機30との距離(疑似距離)を求め、求めた距離に基づいて自車位置(緯度、経度及び高度)を測位する。GPS信号は定期的にGPS衛星20から送信されており、制御部33は、GPS受信部32で所定時間(例えば1秒)毎にGPS信号を受信する都度、自車位置を測位する。
【0042】
制御部33は、測位した自車位置から方位を算出する。図2は、GPS信号に基づく方位の算出方法を説明するための模式図である。図2は、異なる時刻に受信したGPS信号により、それぞれ地点R1(X1,Y1)及び地点R2(X2,Y2)を自車位置として測位した場合を示している。X1,X2及びY1,Y2は、それぞれ緯度及び経度を表している。そして、地点R1及び地点R2を繋ぐ線分と、東西方向とがなす角度θは、(X1,Y1)及び(X2,Y2)に基づいて算出することができる。また、(X1,Y1)及び(X2,Y2)により、地点R1及び地点R2間の距離を算出できると共に、移動に要した時間(この場合、GPS信号の受信間隔)を用いて車速を算出できる。これにより、車両がR1からR2に向かう際の進行方位及び車速を推定することができる。
【0043】
なお、自車位置を測位する際にドップラーシフトをもとに測位するようにしてもよい。図3は、ドップラーシフトをもとに自車位置を測位する場合について説明するための図である。図では一つのGPS衛星のみ表示しているが、3つのGPS衛星からGPS信号を受信した場合について説明する。
【0044】
GPS衛星が送信する信号周波数をfsn(n=1,2,3)、車載機30が受信する信号周波数をfrn(n=1,2,3)、車両の速度ベクトルをVcar 、GPS衛星の速度ベクトルをVgpsn (n=1,2,3)とする。なお、Vcar は(Vx、Vy、Vz)、Vgpsn は(Vxn,Vyx,Vzn)とする。この場合、車両のGPS衛星に対する相対的な速度ベクトルVnは(Vx−Vxn、Vy−Vyx、Vz−Vzn)となる。また、車両のGPS衛星に対する相対速度Vnの方向と、車両からGPS衛星に向かう方向とのなす角度をαn(n=1,2,3)とした場合、以下の式が成り立つ。
【0045】
【数1】
【0046】
前記式において、cは光速である。そして、車両からGPS衛星20に向かう方向の単位ベクトルeを(ex,ey,ez)とした場合、式(1)は、以下の式となる。
【0047】
【数2】
【0048】
この結果、車両の速度ベクトルVcar (Vx、Vy、Vz)以外は既知又はGPS衛星20から受信するGPS信号により得られるため、3つ以上のGPS衛星からのGPS信号の周波数を測定することができた場合に車両の速度と角度とを算出することができる。
【0049】
また、制御部33は、センサ部37により出力された自立航法データに基づいて自立航法による測位を行う。制御部33は、車速センサ372が検出した車速を用いて車両の走行距離をそれぞれ算出することができる。また、制御部33は、ジャイロセンサ371が検出した角速度に基づいて、車両の旋回角度を算出し、車両の進行方向を推定することができる。そして、制御部33は、ジャイロセンサ371及び車速センサ372、及び測位した自車位置等に基づいて測位を行う。
【0050】
図4は、ジャイロセンサ371が検出する角度について説明するための模式図である。ジャイロセンサ371は、角速度を検出する。車両が進行方向に対して旋回した場合、制御部33は、ジャイロセンサ371により検出された、旋回時に車両に生じた角速度を用いて旋回角度φを算出する。
【0051】
図5は、実際の走行軌跡とGPS航法による測位結果とを示す模式図である。図6は、GPS航法により算出した方位角度を説明するための模式図である。
【0052】
図5の実線は、車両の実際の走行軌跡を表している。また、図5の黒丸は、制御部33が、所定時間(例えば1秒)毎の時刻tn(n=0,1,2,3,,)において受信したGPS信号に基づいて測位した地点を示し、点線は測位した各地点から推定した走行軌跡を表している。上述した算出方法により、制御部33は、GPS航法による測位結果から、各地点の方位角度θ0,θ1,θ2,,,θn(n=0,1,2,3,,)を算出する。例えば、時刻t1において算出した方位角度θ0は、40[deg] であり、時刻t2において算出した方位角度θ0は、87[deg] が算出される。
【0053】
制御部33は、算出した方位角度θnと、ジャイロセンサ371による検出結果から算出した旋回角度とに基づいてGPS航法による測位結果に対する信頼性を判定する。
【0054】
図7は、信頼性を判定する際に用いる算出結果を説明するための模式図である。
【0055】
制御部33は、各時刻間の方位角度の変位量及び旋回角度を算出する。時刻t0からt2の間に変化した角度の変化量Δθは、方位角度θ1及びθ0の差分により算出することができる。例えば、時刻t1における方位角度θ0は40[deg] であり、時刻t2における方位角度θ0は87[deg] であるため、変化量Δθは47[deg] となる。同時に、ジャイロセンサ371により、時刻t0からt2の間の旋回角度φを算出する。そして、方位角度の変化量Δθと旋回角度φとの差分を算出する。なお、図7では、算出した結果の絶対値で示している。
【0056】
制御部33は、方位角度の変化量Δθと旋回角度φとの差分が閾値(例えば3[deg] )以下であれば、GPS航法による測位結果に対して信頼性があると判定する。例えば、時刻t0からt2の間において、方位角度の変化量Δθと旋回角度φとの差分は、32[deg] であり、閾値3[deg] 以上である。この場合、制御部33は、時刻t0からt2の間に行ったGPS航法による測位結果には信頼性がない(低い)と判定する。一方、時刻t2からt4の間において、方位角度の変化量Δθと旋回角度φとの差分は2[deg] であり、閾値3[deg] 以下である。この場合、制御部33は、時刻t2からt4の間に行ったGPS航法による測位結果には信頼性がある(高い)と判定する。
【0057】
以上のように、GPS航法による測位結果から算出した方位角度の変化量Δθの信頼性を、ジャイロセンサ371の検出結果に基づいて判定している。これは、ジャイロセンサ371が、周囲の状況に関係なく、短時間においては旋回角度を安定して測定できることを利用した方法である。すなわち、GPS航法による方位角度の変化量Δθが、常に精度が高いと考えられるジャイロセンサ371による旋回角度φと略一致するならば、その時間においてはGPS航法による方位角度の精度も高かったと判断できる、との考えに基づいた信頼性の判定法である。
【0058】
なお、車両が低速で走行している場合、測定する方位角度又は旋回角度の分散が大きくなるため、制御部33は、車速が所定速度(例えば5[m/s])以上の場合に、GPS航法による測位結果に対する信頼性の判定を行う。また、制御部33は、方位角度の変化量Δθと旋回角度φとの差分が閾値以下となる場合が所定回数(例えば5回)連続となった場合に、GPS航法による測位結果に信頼性がある(高い)と判定してもよく、一度だけの判定で信頼性があると判定してもよい。一度偶然に信頼性があると判定される場合もあるため、所定回数(例えば5回)連続となった場合に信頼性がある(高い)と判定することで、判定結果に対する信頼性を高くすることができる。
【0059】
信頼性がある(高い)と判定した場合、制御部33は、GPS信号に基づいて算出した方位角度に重みをおいて進行方位を特定する。また、信頼性がない(低い)と判定した場合、制御部33は、GPS信号により算出した方位角度に対するジャイロセンサ371の検出結果から算出した旋回角度の重み付けを大きくする。
【0060】
図8は、自車位置を補正する際の制御部33による測位結果を示す模式図である。
【0061】
例えば、図8に示すように、GPS信号を受信できず、ジャイロセンサ371などによる自立航法による測位のみで自車測位を行っている途中でGPS信号を受信できたとき、GPS信号に基づいて算出した方位角度と、ジャイロセンサ371で検出した旋回角度とに基づいてGPS信号の信頼性を判定する。そして、信頼性があると判定した場合、GPS信号に基づいて算出した方位角度に重みをおいて測位を行う。これにより、自律航法により誤差が蓄積している場合であっても、精度よく車両の進行方位を特定することができ、その結果、自車位置を適切な位置に補正することができる(図中斜線部)。
【0062】
自車位置を特定した場合、ジャイロセンサ371は短時間において安定した旋回角度を測定できるため、所定期間内は、ジャイロセンサ371が検出した旋回角度のみを用いて車両の進行方位を特定するようにしてもよい。またこの場合、時間の経過と共に、ジャイロセンサ371で検出した旋回角度の重みを徐々に小さくしていくなどしてもよく、重み付けは適宜変更することができる。
【0063】
なお、GPS航法による測位結果に対する信頼性の判定、及び方位角度と旋回角度とに重み付けを行う際に、GPS衛星20の配置状態、受信できたGPS信号の数、各GPS信号の強度、及び各GPS信号の強度とノイズとの比(SN比)等のGPS衛星20の情報を考慮するようにしてもよい。なお、受信できたGPS信号の数が多いほど、特に信号強度が基準値以上の信号を受信できたGPS衛星20の数が多いほど、信号を受信できたGPS衛星20の位置の散りばり具合が大きいほど(DOPが小さいほど)、又はGPS信号から算出した方位角度に相対的に大きな重み付けをし、車両の進行方位を特定する。これにより、精度良く車両の進行方位を特定することができる。
【0064】
上述したGPS衛星20の情報は、GPS信号を受信することで取得される。例えば、時刻T1において受信したGPS信号を送信したGPS衛星20の数が6で、SN比がそれぞれ45[dB]、48[dB]、37[dB]、50[dB]、44[dB]、46[dB]であった場合、各GPS衛星20をSN比の閾値を基準に信頼性の判定に有効なGPS衛星が選択される。SN比が40[dB]以上であれば有効とした場合、有効なGPS衛星の数は5となる。なお、有効なGPS衛星を選択する際に、SN比ではなくGPS信号の信号強度を用いてもよい。また、時刻T2において受信したGPS信号を送信したGPS衛星20の数が8で、SN比がそれぞれ43[dB]、45[dB]、30[dB]、50[dB]、38[dB]、45[dB]、37[dB]、38[dB]であった場合、有効なGPS衛星の数は4となる。この場合において、時刻T1より時刻T2の方が、GPS信号を受信できたGPS衛星20の数は多いが、有効とされたGPS衛星20の数は時刻T1の方が多い。
【0065】
制御部33は、有効なGPS衛星20の数に基づいて、GPS信号により算出した方位角度の重み付けを行う。例えば上述の例において、時刻T2より時刻T1における有効なGPS衛星20の数は多い。従って、制御部33は、時刻T1におけるGPS信号により算出した方位角度の重み付けを、時刻T2における重み付けよりも大きくする。このように、GPS航法による測位結果に対する信頼性が高くなれば、車両の進行方位を特定する際に、GPS信号により算出した方位角度の重み付けを大きくすることにより、精度よく車両の進行方位を特定することができる。
【0066】
制御部33は、DOPを用いて重み付けを行ってもよい。DOPは、GPS衛星20の配置による測位精度の低下率であり、大きくなるほど精度が低くなる(測位誤差が大きくなる)。従って、制御部33は、GPS衛星20の配置状態に基づいてDOPを算出し、DOPが大きくなるほど、GPS信号により算出した方位角度の重み付けを小さくする。このように、GPS航法による測位結果に対する信頼性が低くなれば、車両の進行方位を特定する際に、GPS信号により算出した方位角度の重み付けを小さくすることにより、精度よく車両の進行方位を特定することができる。
【0067】
次に、上述のように構成される車載機30の動作について説明する。図9は、進行方位を特定する処理手順を示すフローチャートである。
【0068】
制御部33は、GPS、光ビーコン又はナビゲーションシステムなどから自車が存在すると推定できる範囲を示す領域情報を取得し(S101)、自車位置を測位する(S102)。GPS受信部32がGPS衛星20からGPS信号を受信できたか否かを判定する(S103)。GPS信号を受信できた場合(S103:YES)、制御部33は、方位角度θnを算出する(S104)。具体的には、制御部33は、S103で受信したGPS信号により自車位置を算出し、その直前に受信したGPS信号により算出した自車位置との二点に基づき、方位角度θnを算出する。なお、制御部33は、二点の位置に基づいて方位角度θnを算出せず、上述のように、制御部33は、ドップラーシフトを用いてもよい。
【0069】
GPS信号を受信できなかった場合(S103:NO)、制御部33は、ジャイロセンサ371による検出結果から特定した車両の進行方位を採用する(S114)。その後、制御部33は、処理をS113に移す。制御部33は、ジャイロセンサ371による検出結果から車両の進行方位を常時算出している。そして、GPS信号を受信できない場合には、制御部33は、ジャイロセンサ371による検出結果から特定した進行方位を用いて測位する。
【0070】
次に、制御部33は、GPS受信部32がGPS衛星20からGPS信号を受信できたか否かを判定する(S105)。GPS信号を受信できなかった場合(S105:NO)、制御部33は、処理をS114に移す。
【0071】
GPS信号を受信できた場合(S105:YES)、制御部33は、方位角度θn+1を算出する(S106)。ジャイロセンサ371による検出結果から車両の旋回角度φを算出する(S107)。制御部33は、S104で算出した方位角度θnと方位角度θn+1とに基づいて、方位角度の変化量Δθを算出する(S108)。
【0072】
制御部33は、算出した変化量Δθと、旋回角度φとの差が閾値(3[deg] )以下であるか否かを判定する(S109)。算出した変化量Δθと、旋回角度φとの差が閾値(3[deg] )以下である場合(S109:YES)、制御部33は、信頼性があるか否かを判定する(S110)。例えば、制御部33は、算出した変化量Δθと、旋回角度φとの差が閾値以下となる場合が所定回数(例えば5回)連続したときに信頼性があると判定する。信頼性があると判定した場合(S110:YES)、制御部33は、受信したGPS信号に基づいて算出した方位角度の重み付けを相対的に大きくして進行方位を特定する(S111)。信頼性がないと判定した場合(S110:NO)、制御部33は、ジャイロセンサ371による検出結果から算出した旋回角度φの重み付けを相対的に大きくして進行方位を特定する(S112)。
【0073】
また、S109において算出した変化量Δθと、旋回角度φとの差が閾値(3[deg] )以下でない場合(S109:NO)、制御部33は、ジャイロセンサ371による検出結果から算出した旋回角度φの重み付けを相対的に大きくして進行方位を特定する(S112)。
【0074】
その後、制御部33は、処理の終了指示の有無を判定し(S113)、終了指示がない場合(S113:NO)、S103以降の処理を続ける。終了指示がある場合(S113:YES)、制御部33は、本処理を終了する。
【0075】
なお、本実施の形態では、GPS衛星20から受信するGPS信号に基づいて自車位置及び方位角度を算出し、進行方位を特定する構成であったが、2台の送信機の信号の信頼性を判定し、信号それぞれの到達時間差により自車位置を特定し、二つの自車位置から車両の方位角度を算出することもできる。
【0076】
図10は、自車位置を特定する他の例を示す説明図である。送信機40,50は、例えば交差点に設置される信号機に設置される。送信機40,50は、例えば、VHF/UHF帯の周波数帯域の電波を車載機30に対して送信する。なお、送信機40,50が使用する周波数帯域は、一例であって、VHF/UHF帯に限定されるものではなく、他の周波数帯域でもよい。例えば、自動車専用として割り当てられている5.8GHz帯を使用してもよく、また、携帯電話、PHS等で使用する周波数帯域を使用することも可能である。車両が停止線に向かって走行する場合、車載機30は、送信機40,50から送信された信号を受信し、受信した信号の到達時間に基づいて自車位置を特定する。送信機40,50が繰り返し信号を送信することで、車載機30は信号を受信する都度自車位置を特定することができる。
【0077】
図10において、道路上のある地点P1において、送信機40及び送信機50からの信号(測位用信号)を受信した場合、制御部33は、それぞれの送信機40及び送信機50の信号の受信時点と送信時点との差により、信号が送信機40及び送信機50それぞれから車載機30へ到達するまでの到達時間を算出する。この場合、信号の送信時点は、その信号に含まれる送信時点情報から取得することができる。制御部33は、各信号の到達時間の差分である到達時間差を算出する。
【0078】
自車から送信機40までの距離と、自車から送信機50までの距離との差は、信号の到達時間差ΔT1に光速を積算することで算出できる。すなわち、自車の位置は、送信機40及び送信機50の位置を焦点とする回転双曲面W1上であることがわかる。
【0079】
一方、制御部33は、送信機40及び送信機50から信号を受信した場合、自車両が走行する道路(リンク:交差点間の道路)の道路形状情報と車載機30の高さ情報により、自車の仮想的な走行面を特定する。なお、道路が直線道路である場合には、走行面は平面であり、道路がカーブしている場合には、走行面は曲面となる。
【0080】
制御部33は、自車位置を回転双曲面W1と走行面と交わる交線として特定する。これにより、2台の送信機40及び送信機50からの信号を受信するだけで、自車位置を精度良く特定することが可能となる。
【0081】
車両がさらに走行を続け、道路上の地点P2で送信機40及び送信機50から信号を受信したとすると、地点P1の場合と同様に、制御部33は、信号の到達時間差ΔT2に光速を積算することにより、到達時間差ΔT2に対応する距離を算出し、送信機40及び送信機50の位置を焦点とし、算出した距離が等しくなる回転双曲面W2を特定する。
【0082】
一方、制御部33は、送信機40及び送信機50から信号を受信した場合、自車両が走行する道路の道路形状情報と車載機30の高さ情報により、自車の仮想的な走行面を特定する。
【0083】
制御部33は、自車位置を回転双曲面W2と走行面と交わる交線として特定する。以降、同様の動作を繰り返すことにより、制御部33は、送信機40及び送信機50から信号を受信する都度、自車位置を精度良く特定し続けることができる。
【0084】
図11は、2台の送信機を用いた場合の自車位置の特定方法の概念を示す説明図である。図11の例では、2台の送信機からの信号の到達時間差が判明している場合の特定方法を示す。図11に示すように、まず、自車位置は、送信機40及び送信機50の位置を焦点とし、送信機40及び送信機50から車載機30までの各信号の到達時間差に光速を積算した距離が等しい回転双曲面W上に存在する。次に回転双曲面W上のどこに自車位置が存在するかを求める。
【0085】
制御部33は、自車両が走行する道路の道路形状情報と車載機30の高さ情報とにより、自車の仮想的な走行面を特定し、自車位置を回転双曲面Wと走行面と交わる交線として特定する。これにより、2台の送信機40及び送信機50からの信号を受信するだけで、自車位置を精度良く特定することが可能となる。
【0086】
以上説明したように、本発明にあっては、受信したGPS信号の信頼性を判定することで、進行方位を特定する際の精度を向上させることができる。信頼性がある(高い)場合に、GPS信号に基づいて算出した方位角度の重み付けを相対的に大きくし進行方位を特定することで、より正確な測位を行うことができる。また、信頼性がない(低い)場合には、ジャイロセンサ371の検出結果から算出した旋回角度の重み付けを大きくし進行方位を特定することで、できる限り誤差の含んだ測位が行われないようにできる。
【0087】
開示された実施の形態は、すべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれることが意図される。
【図面の簡単な説明】
【0088】
【図1】実施の形態に係る車載機の構成を示すブロック図である。
【図2】GPS信号に基づく方位の算出方法を説明するための模式図である。
【図3】ドップラーシフトをもとに自車位置を測位する場合について説明するための図である。
【図4】ジャイロセンサが検出する角度について説明するための模式図である。
【図5】実際の走行軌跡とGPS航法による測位結果とを示す模式図である。
【図6】GPS航法により算出した方位角度を説明するための模式図である。
【図7】信頼性を判定する際に用いる算出結果を説明するための模式図である。
【図8】自車位置を補正する際の制御部による測位結果を示す模式図である。
【図9】進行方位を特定する処理手順を示すフローチャートである。
【図10】自車位置を特定する他の例を示す説明図である。
【図11】2台の送信機を用いた場合の自車位置の特定方法の概念を示す説明図である。
【図12】自立航法による測位結果の一例を示す図である。
【符号の説明】
【0089】
20 GPS衛星
30 車載機
31 通信部
32 GPS受信部
33 制御部
34 記憶部
37 センサ部
371 ジャイロセンサ
372 車速センサ
【技術分野】
【0001】
本発明は、例えばGPS(Global Positioning System)及びジャイロセンサを利用して車両の進行方位を特定する方位特定装置、方位特定方法及びコンピュータプログラムに関する。
【背景技術】
【0002】
車両の位置を検出するカーナビゲーション装置には、距離センサ、方位センサ及びジャイロセンサ(角速度センサ)などを用いて測位する自立航法、及び人工衛星からの電波を受信して測位するGPS(Global Positioning System)航法の一方又は両方を用いて自車位置を測位するものがある。
【0003】
自立航法では、車速センサ及びジャイロセンサを用いて測位を行う。車速センサは、車両の単位時間当たりの移動距離を精度よく取得することができるセンサである。ジャイロセンサは、相対的な角度の変化量を精度よく測定するセンサであり、周囲の状況に拘わらず、短時間においては変位量を安定して測定できる。自立航法では、ジャイロセンサにより車両の進行方向を検出し、車速センサにより検出した車速を用いて走行距離を算出する。そして、ある時点での位置及び進行方位を取得し、取得した地点からどのように走行したかを、検出した進行方向及び算出した走行距離を用いて随時測位していくことにより、自車位置を測位する。
【0004】
GPS航法では、定期的に人工衛星からの電波(GPS信号)を受信して自車位置を測位する。GPS航法では、定期的にGPS信号を受信して測位を行う。このGPS航法において得られる位置は絶対位置であり、各時刻における測位精度は過去の測位精度の影響を受けない。つまり、誤差が蓄積することなく、自車位置を測位することができる。
【0005】
このGPS航法において、高層ビルが密集している都市部などGPS信号を受信できない場所では自車位置を測位できない場合がある。そこで、一般的にカーナビゲーション装置では、自立航法とGPS航法とを融合させて、車両位置及び車両の進行方位を特定している。自立航法とGPS航法とを融合させたナビゲーション装置として、特許文献1には、人工衛星の配置状態を検出し、配置状態に応じてGPSにより算出した方位の誤差を推定し、その結果に基づいて算出した方位を車両の進行方位の検出に採用するか否かの判定を行うナビゲーション装置が記載されている。GPS信号の受信状態が悪い場合にはGPS航法による測位の精度が低下するため、受信状態が悪い状況でGPS航法による測位を行うことで、却って不正確な位置及び方位を検出する場合がある。このため、特許文献1のように、算出した方位の誤差が大きく、精度が低いと推定される場合には、その方位を採用しないことで、方位の検出精度を向上させることができる。
【特許文献1】特許第2921413号公報
【発明の開示】
【発明が解決しようとする課題】
【0006】
しかしながら、人工衛星の配置状態が良いと判断し、GPS信号により算出した方位の誤差が小さいと推定した場合であっても、実際には衛星から直接受信した電波のみならず、建物に反射して受信した電波も受信していることが多く、このようなときには大きな誤差が発生することがある。つまり、特許文献1の方法において、算出結果に大きな誤差が含まれているにも拘らず、誤差が小さいと判定して進行方位の検出に採用してしまう場合がある。
【0007】
一方、ジャイロセンサを用いて行った測位結果には、時間及び旋回角度と共に誤差が蓄積する。図12は、自立航法による測位結果の一例を示す図である。図12は、出発地点から周回し、元の出発地点へと戻ってきた場合の測位結果であるが、図に示すように、出発地点と到達地点とが一致していない。自立航法では、前回測位した位置に基づいて新たな位置を測位するため、前回の測位した位置に誤差がある場合、新たに測位する位置にも誤差が生じる。このように、自立航法では、誤差が蓄積するため、随時、絶対位置及び絶対方位角度を計測できるセンサを用いて位置及び方位角度を補正する必要がある。さらに、自律航法では初期位置と初期の方位角度を取得することができないので、これらを別途取得する必要がある。
【0008】
本発明は斯かる事情に鑑みてなされたものであり、その目的とするところは、状況に応じて信頼性が左右される方位特定方法、及び経過時間と共に誤差が蓄積する方位特定方法を適切に組み合わせることで、車両の進行方位を高精度に特定することができる方位特定装置、方位特定方法及びコンピュータプログラムを提供することにある。
【課題を解決するための手段】
【0009】
第1発明に係る方位特定装置は、第1方位角度算出手段が算出した車両の方位角度に基づいて、車両の進行方位を特定する方位特定装置であって、車両の旋回角度を検出する角度検出手段と、前記第1方位角度算出手段が算出した方位角度の所定時間内における変化量を算出する第1算出手段と、前記角度検出手段が検出した前記所定時間内における旋回角度を算出する第2算出手段と、前記第1算出手段が算出した変化量及び第2算出手段が算出した旋回角度に基づいて、前記第1方位角度算出手段の算出結果に対する信頼性を判定する信頼性判定手段と、該信頼性判定手段による信頼性の判定結果に応じて、前記第1方位角度算出手段が算出した方位角度及び前記角度検出手段が検出した旋回角度に基づいて、車両の進行方位を特定する特定手段とを備えることを特徴とする。
【0010】
第2発明に係る方位特定装置は、第1発明において、車速を検出する車速検出手段と、該車速検出手段が検出した車速が所定速度以上であるか否かを判定する速度判定手段とをさらに備え、前記信頼性判定手段は、前記速度判定手段が所定速度以上であると判定した場合に信頼性を判定する構成としてあることを特徴とする。
【0011】
第3発明に係る方位特定装置は、過去の車両の進行方位を記憶する進行方位記憶手段と、前記角度検出手段が検出した旋回角度と前記進行方位記憶手段に記憶した車両の進行方位とに基づいて車両の方位角度を算出する第2方位角度算出手段とをさらに備え、前記特定手段は、前記第1方位角度算出手段及び第2方位角度算出手段の算出結果の少なくとも一方に重み付けをし、重み付けをした算出結果に基づいて車両の進行方位を特定する際に、前記信頼性判定手段が判定した信頼性が高いほど、前記第1方位角度算出手段の算出結果に相対的に大きな重み付けをし、車両の進行方位を特定する構成としてあることを特徴とする。
【0012】
第4発明に係る方位特定装置は、第3発明において、前記特定手段は、所定期間が経過するまで及び/又は所定角度を旋回するまで、前記第2方位角度算出手段の算出結果のみに基づいて車両の進行方位を特定する構成としてあることを特徴とする。
【0013】
第5発明に係る方位特定装置は、第1発明乃至第4発明の何れか一つにおいて、人工衛星信号が人工衛星から送信されており、前記人工衛星信号を異なるタイミングで受信する第1受信手段と、該第1受信手段が異なるタイミングで受信した人工衛星信号それぞれに基づいて車両位置を検出する第1車両位置検出手段とをさらに備え、前記第1方位角度算出手段は、前記第1車両位置検出手段が検出した各車両位置を用いて方位角度を算出する構成としてあることを特徴とする。
【0014】
第6発明に係る方位特定装置は、第5発明において、前記人工衛星は複数配置され、前記第1受信手段は、複数の人工衛星から人工衛星信号を受信する構成としてあり、前記第1受信手段が受信した人工衛星信号に基づいて、人工衛星の配置状態、受信した人工衛星信号を送信した人工衛星の数、各人工衛星信号の強度、及び各人工衛星信号の強度とノイズとの比の少なくとも一つ以上の人工衛星状態情報を取得する状態情報取得手段をさらに備え、前記特定手段は、前記状態情報取得手段が取得した人工衛星状態情報に基づいて、前記第1方位角度算出手段及び第2方位角度算出手段の算出結果に重み付けをし、車両の進行方位を特定する構成としてあることを特徴とする。
【0015】
第7発明に係る方位特定装置は、第1発明乃至第4発明の何れか一つにおいて、異なる地点から送信された信号を受信する第2受信手段と、該第2受信手段が受信した信号の到達時間及び到達時間差の少なくとも一方を取得する時間取得手段と、前記第2受信手段が受信した信号及び前記時間取得手段が取得した到達時間及び到達時間差の少なくとも一方を用いて車両位置を検出する第2車両位置検出手段とをさらに備え、前記第1方位角度算出手段は、前記第2車両位置検出手段が検出した車両位置を用いて方位角度を算出する構成としてあることを特徴とする。
【0016】
第8発明に係る方位特定装置は、第1発明乃至第4発明の何れか一つにおいて、信号が複数の人工衛星又は異なる地点から送信されており、前記信号を受信する第3受信手段をさらに備え、前記第1方位角度算出手段は、前記第3受信手段が受信する信号のドップラーシフトを用いて方位角度を算出する構成としてあることを特徴とする。
【0017】
第9発明に係る方位特定装置は、第5発明又は第6発明において、人工衛星が送信した人工衛星信号の周波数を取得する第1周波数取得手段と、前記第1受信手段が受信した人工衛星信号の周波数を取得する第2周波数取得手段と、前記第1受信手段が受信した人工衛星信号に基づいて、人工衛星の位置、人工衛星の速度、及び人工衛星の進行方位を取得する軌道情報取得手段とをさらに備え、前記第1方位角度算出手段は、前記第1及び第2周波数取得手段が取得した周波数に基づいて前記人工衛星信号のドップラーシフトを算出し、該ドップラーシフト、前記第1車両位置検出手段が検出した車両位置、及び、前記軌跡情報取得手段による取得結果を用いて方位角度を算出する構成としてあることを特徴とする。
【0018】
第10発明に係る方位特定方法は、第1方位角度算出手段が算出した車両の方位角度に基づいて、方位特定装置で車両の進行方位を特定する方位特定方法であって、角度検出手段で車両の旋回角度を検出するステップと、前記第1方位角度算出手段が算出した方位角度の所定時間内における変化量を算出するステップと、前記角度検出手段が検出した前記所定時間内における旋回角度を算出するステップと、算出した変化量及び算出した旋回角度に基づいて、前記第1方位角度算出手段の算出結果に対する信頼性を判定するステップと、信頼性の判定結果に応じて、前記第1方位角度算出手段が算出した方位角度及び前記角度検出手段が検出した旋回角度に基づいて、車両の進行方位を特定するステップとを備えることを特徴とする。
【0019】
第11発明に係るコンピュータプログラムは、車両の旋回角度が取得できるコンピュータに、算出させた車両の方位角度に基づいて、車両の進行方位を特定させるコンピュータプログラムであって、前記コンピュータを、算出した方位角度の所定時間内における変化量を算出する第1算出手段、取得した前記所定時間内における旋回角度を算出する第2算出手段、前記第1算出手段が算出した変化量及び第2算出手段が算出した旋回角度に基づいて、算出した車両の方位角度に対する信頼性を判定する信頼性判定手段、及び、該信頼性判定手段による信頼性の判定結果に応じて、算出した車両の方位角度及び取得した旋回角度に基づいて、車両の進行方位を特定する特定手段として機能させることを特徴とする。
【0020】
第1発明、第10発明及び第11発明においては、方位特定装置は、車両の方位角度を算出する。方位角度は、例えばGPS信号又は無線送信機などの路上機器からの信号などを用いて2地点で車両位置を求めることで算出することができる。また、GPS信号のドップラーシフトに基づいても算出できる。方位特定装置は、車両の角度検出手段(ジャイロセンサ)により車両の旋回角度を検出する。そして、方位特定装置は、算出した方位角度の所定時間内の変化量と、所定時間内に角度検出手段が検出した旋回角度の変化量とをそれぞれ算出する。方位特定装置は、算出したそれぞれの変化量に基づいて、算出した方位角度に対する信頼性を判定する。信頼性の判定結果に応じて、算出した方位角度及び角度検出手段が検出した角度に基づいて、車両の進行方位を特定する。
【0021】
ジャイロセンサなどの角度検出手段では、精度よく車両の旋回角度を検出でき、その結果を積算して算出する車両の進行方位は短時間では精度が高い一方で、経過時間と共に誤差が蓄積する。一方、GPS信号などから算出した方位角度は、経過時間に関係なく誤差が蓄積しないが、周囲の状況によって測位の精度が左右される。そこで、上述のように、算出した方位角度の信頼性に応じて、角度検出手段で検出した旋回角度と、算出した方位角度とを適切に組み合わせることで、精度よく車両の進行方位を特定することができる。
【0022】
第2発明においては、方位特定装置は、車速を検出し、検出した車速が所定速度以上であるか否かを判定する。車速は、例えば車輪の回転数を検出する車輪速センサの出力値により検出することができる。そして、検出した車速が所定速度以上であると判定した場合に、算出した方位角度に対する信頼性を判定する。低速で走行している場合には、進行方向に対する変位角度にバラつきが発生するため、検出した変位角度の精度が低くなる。このため、低速走行の場合には、算出した方位角度の信頼性の判定を行わない。これにより、信頼性の判定結果の精度を高めることができるので、精度よく車両の進行方位を特定することができる。
【0023】
第3発明においては、方位特定装置は、過去の車両の進行方位及び旋回角度に基づいて方位角度を算出する。過去の車両の進行方位は、直前に検出した進行方位であってもよいし、複数回前に検出した進行方位であってもよい。算出した方位角度と、GPS信号又は路上機器からの信号などから算出した車両位置を用いて算出した方位角度とに基づいて車両の進行方位を特定する。このとき、方位特定装置は、算出したそれぞれの方位角度の少なくとも何れか一方に重み付けをし、重み付けをした算出結果に基づいて車両の進行方位を特定する際に、算出した方位角度に対する信頼性が高いほど、GPS信号又は路上機器からの信号などから算出した方位角度を用いて算出した算出結果に相対的に大きな重み付けをし、車両の進行方位を特定する。算出した方位角度の信頼性が高ければ、GPS信号又は路上機器からの信号等から算出した方位角度に含まれる誤差は小さいと判断できるからである。これにより、精度よく車両の進行方位を特定することができる。
【0024】
第4発明においては、方位特定装置は、例えば高い精度で車両の進行方位を取得できた後、所定期間が経過するまで及び/又は所定角度を旋回するまで、角度検出手段が検出した旋回角度と過去の車両の進行方位とに基づいて算出した車両の方位角度のみを用いて車両の進行方位を特定する。ジャイロセンサなどの角度検出手段では、短時間では精度の高い測位を行える一方で、走行距離と共に誤差が蓄積する。このため、蓄積する誤差が例えば閾値よりも大きくなるまで、検出した旋回角度のみにより車両の進行方位を特定することで、精度の高い結果を得ることができる。旋回角度のみを用いる期間は、上述のように誤差の蓄積量で区切ってもよいし、時間で区切ってもよい。
【0025】
第5発明においては、人工衛星から信号が送信されており、方位特定装置は、信号を異なるタイミングで受信し、受信した信号それぞれに基づいて車両位置を検出する。そして、方位特定装置は、検出したそれぞれの車両位置を用いて方位角度を算出する。例えば、一のタイミングでGPSを利用して走行中の車両の絶対位置(経度及び緯度など)を取得し、所定時間走行後さらにGPSを利用して車両の絶対位置を取得する。そして、前後2つの地点の絶対位置から方位角度を算出することができる。このようにして求めた車両の進行方位は、時間の経過により誤差の蓄積がなく、求めた車両の進行方位とジャイロセンサなどにより求めた旋回角度とを組み合わせることで、車両方位を精度よく特定することができる。
【0026】
第6発明においては、人工衛星は複数配置され、方位特定装置は、複数の人工衛星から信号を受信し、人工衛星の配置状態、人工衛星の数、各人工衛星信号の強度、及び各人工衛星信号の強度とノイズとの比の少なくとも一つ以上の人工衛星状態情報を検出する。そして、方位特定装置は、検出した人工衛星状態情報に基づいて、方位角度に重み付けをし、進行方位を特定する。例えば、信号を受信できた人工衛星の数が多いほど、特に信号強度が基準値以上の信号を受信できた人工衛星の数が多いほど、又は、信号を受信できた人工衛星の位置の散りばり具合が大きいほど(DOP:Dilution Of Precisionが小さいほど)、GPS信号から算出した方位角度に相対的に大きな重み付けをし、車両の進行方位を特定する。DOPは、精度低下率であり、単独測位における、衛星配置による測位精度の低下率を数字で表したものである。DOPは数値が大きくなるほど精度が低くなる(測位誤差が大きくなる)。これにより、精度良く車両の進行方位を特定することができる。
【0027】
第7発明においては、例えば、路側に無線の送信装置を設置し、方位特定装置は、これらの送信装置から送信された信号を受信し、各信号の到達時間及び到達時間差の少なくとも一方を取得する。そして、方位特定装置は、車両の走行地点で取得した各信号の到達時間又は到達時間差に基づいて、車両位置を検出する。方位特定装置は、検出した車両位置を用いて方位角度を算出する。例えば、2つの車両位置を検出することで方位角度を算出することができる。このようにして求めた車両の進行方位は、時間の経過により誤差の蓄積がなく、求めた車両の進行方位とジャイロセンサなどにより求めた旋回角度とを組み合わせることで、精度よく車両方位を特定することができる。
【0028】
第8発明においては、方位特定装置は、受信する信号のドップラーシフトを用いて方位角度を算出する。近年、位相同期回路(PLL:Phase-locked loop)の高精度化などに伴い、電波の周波数を測定する精度が大きく向上しており、その結果、現在のGPS受信機においてはドップラー周波数を利用することでも正確な方位を得ることができる。このようにして求めた車両の進行方位は、時間の経過により誤差の蓄積がなく、求めた車両の進行方位とジャイロセンサなどにより求めた旋回角度とを組み合わせることで、精度よく車両方位を特定することができる。
【0029】
第9発明においては、方位特定装置は、人工衛星が送信した人工衛星信号の周波数、及び受信した人工衛星信号の周波数を取得し、それぞれの周波数に基づいて人工衛星信号のドップラーシフトを算出する。そして、算出したドップラーシフト、検出した車両位置、人工衛星の位置、人工衛星の速度、及び人工衛星の進行方位を用いて方位角度を算出する。このようにして求めた車両の進行方位は、時間の経過により誤差の蓄積がない。この結果と、ジャイロセンサなどにより求めた旋回角度を組み合わせることで、精度よく車両方位を特定することができる。
【発明の効果】
【0030】
本発明によれば、車両の旋回角度を検出する角度検出手段による検出結果を用いて、算出した車両の方位角度の信頼性を判定し、判定結果に応じて、算出した方位角度と、角度検出手段が検出した旋回角度に基づいて、車両の進行方位を特定する。これにより、精度よく車両の進行方位を特定することができる。
【発明を実施するための最良の形態】
【0031】
以下、本発明をその実施の形態を示す図面に基づいて詳述する。
【0032】
本発明に係る方位特定装置である車載機は、車両に搭載され、複数のGPS衛星からの電波を受信する。GPS衛星は、原子時計及び基準発信器などを搭載し、信号を送信する。送信される信号には、原子時計により正確なタイミングで発信される測位用の所定のコード(符号)が含まれ、そのコードが受信機に到達するまでにどれだけの時間(伝播時間)を要したかを測定することにより、GPS衛星との距離(伝播時間×光速)を測定することができる。3つの衛星との距離を求められれば、各衛星を中心とする球の交点を算出することにより自車の位置を決定できる。しかし、実際には車載機の時計に含まれる誤差をキャンセルするために、4つの衛星からの信号を用いて自車の位置を決定する。
【0033】
図1は、本実施の形態に係る車載機の構成を示すブロック図である。車載機30は、車両に搭載され、路側装置との通信機能を有する通信部31、GPS受信機能を有するGPS受信部32、車載機30の動作を制御する制御部33、記憶部34、表示部35、操作部36、ジャイロセンサ371及び車速センサ372などの車載センサを備えるセンサ部37及びナビゲーション部38などを備えている。
【0034】
通信部31は、路側装置との通信機能を有する。通信部31と通信する路上装置は、光ビーコン、電波ビーコン又はDSRC(Dedicated Short Range Communication)などの狭域通信に限定されるものではなく、例えば、中域通信としてUHF帯又はVHF帯などの無線LAN機能を備えるものでもよく、あるいは、広域通信として携帯電話、PHS、多重FM放送及びインターネット通信などの通信機能を備えるものでもよい。
【0035】
GPS受信部32は、DGPS(ディファレンシャルGPS)又はRTK−GPS(Real-Time Kinematic GPS)などのGPS受信機能を備え、複数のGPS衛星20からのGPS信号を所定時間(例えば1秒)毎に受信する。GPS信号には、時刻情報、GPS衛星20の軌道情報及び測位情報などを含んでおり、制御部33は、GPS受信部32で受信したGPS信号により、自車がどの範囲内に存在するかを示す領域情報(緯度、経度及び高度)を取得することができる。なお、GPS受信部32の精度及び受信電波の状況などに応じて自車の存在領域は変動する可能性がある。
【0036】
記憶部34は、通信部31及びGPS受信部32を通じて受信した情報を記憶する。受信して記憶する情報は、例えば、道路形状に関する道路形状情報、信号を受信した際の受信時点、その信号の送信時点を示す送信時点情報、及び光ビーコンなどの路側装置の位置情報(通信地点の位置情報)などである。また、記憶部34は、予め方位特定装置の搭載位置の高さ情報及び地図情報などを記憶してある。
【0037】
表示部35は、ヘッドアップディスプレイ、カーナビゲーションシステム又は監視モニタなどの液晶表示パネルであり、運転者に対して、各種交通情報を表示することができる。例えば、交差点又は停止線までの距離、又は交差点を安全に走行できない場合の警告などを表示する。
【0038】
操作部36は、各種操作パネルを備え、運転者と車載機30とのユーザインタフェースとして機能する。例えば、操作部36は、運転者の操作により車載機30の動作の開始又は停止の操作を受け付ける。
【0039】
センサ部37は、ジャイロセンサ371及び車速センサ372などの自立航法センサを備え、自立航法に必要な自立航法データを制御部33に出力する。ジャイロセンサ371は、カーブした道路の走行時、又は交差点での右左折時に、自車に生じる旋回速度(角速度)を検出する。なお、車両が直線走行している場合には、ジャイロセンサ371はゼロ付近の値を出力する。車速センサ372は、自車の速度を検出する。車速センサは、例えば、車輪に設けられ、車輪の凹凸を検知する車輪速センサである。凹凸の周期は車輪に応じて1周当たり50程度である。車輪速センサは、(タイヤの回転数)×(1周当たりの凹凸)に応じたパルスを出力する。なお、車輪速センサの場合、車輪の回転数に一対一の関係で対応する如何なるパラメータを検出するセンサにより代替されてもよく、例えば、トランスミッションの出力軸の回転数を検出するセンサにより代替されてもよい。
【0040】
ナビゲーション部38は、地図データベースなどを内蔵し、GPS受信部32からの情報及びセンサ部37からの情報に基づいて、自車の走行履歴(例えば、時刻とともに記録された走行距離、走行方位、走行速度、及び加減速度など)を記憶している。
【0041】
制御部33は、GPS受信部32が受信したGPS信号により自車位置を測位する。制御部33は、同時に3つのGPS衛星20からのGPS信号を受信し解析することで二次元の測位(緯度及び経度)を行うことができ、同時に4つのGPS衛星20からのGPS信号を受信し解析することで三次元の測位(緯度、経度及び高度)を行うことができる。3つの衛星との距離を求められれば、各衛星を中心とする球の交点を算出することにより自車の位置を決定できる。しかし、実際には車載機の時計に含まれる誤差をキャンセルするために、4つの衛星からの信号を用いて自車の位置を決定する。制御部33は、GPS衛星20からGPS信号が送信された時刻とそのGPS信号を受信した時刻とから時間差を算出し、この時間差に光速度を乗じることでGPS衛星20と車載機30との距離(疑似距離)を求め、求めた距離に基づいて自車位置(緯度、経度及び高度)を測位する。GPS信号は定期的にGPS衛星20から送信されており、制御部33は、GPS受信部32で所定時間(例えば1秒)毎にGPS信号を受信する都度、自車位置を測位する。
【0042】
制御部33は、測位した自車位置から方位を算出する。図2は、GPS信号に基づく方位の算出方法を説明するための模式図である。図2は、異なる時刻に受信したGPS信号により、それぞれ地点R1(X1,Y1)及び地点R2(X2,Y2)を自車位置として測位した場合を示している。X1,X2及びY1,Y2は、それぞれ緯度及び経度を表している。そして、地点R1及び地点R2を繋ぐ線分と、東西方向とがなす角度θは、(X1,Y1)及び(X2,Y2)に基づいて算出することができる。また、(X1,Y1)及び(X2,Y2)により、地点R1及び地点R2間の距離を算出できると共に、移動に要した時間(この場合、GPS信号の受信間隔)を用いて車速を算出できる。これにより、車両がR1からR2に向かう際の進行方位及び車速を推定することができる。
【0043】
なお、自車位置を測位する際にドップラーシフトをもとに測位するようにしてもよい。図3は、ドップラーシフトをもとに自車位置を測位する場合について説明するための図である。図では一つのGPS衛星のみ表示しているが、3つのGPS衛星からGPS信号を受信した場合について説明する。
【0044】
GPS衛星が送信する信号周波数をfsn(n=1,2,3)、車載機30が受信する信号周波数をfrn(n=1,2,3)、車両の速度ベクトルをVcar 、GPS衛星の速度ベクトルをVgpsn (n=1,2,3)とする。なお、Vcar は(Vx、Vy、Vz)、Vgpsn は(Vxn,Vyx,Vzn)とする。この場合、車両のGPS衛星に対する相対的な速度ベクトルVnは(Vx−Vxn、Vy−Vyx、Vz−Vzn)となる。また、車両のGPS衛星に対する相対速度Vnの方向と、車両からGPS衛星に向かう方向とのなす角度をαn(n=1,2,3)とした場合、以下の式が成り立つ。
【0045】
【数1】
【0046】
前記式において、cは光速である。そして、車両からGPS衛星20に向かう方向の単位ベクトルeを(ex,ey,ez)とした場合、式(1)は、以下の式となる。
【0047】
【数2】
【0048】
この結果、車両の速度ベクトルVcar (Vx、Vy、Vz)以外は既知又はGPS衛星20から受信するGPS信号により得られるため、3つ以上のGPS衛星からのGPS信号の周波数を測定することができた場合に車両の速度と角度とを算出することができる。
【0049】
また、制御部33は、センサ部37により出力された自立航法データに基づいて自立航法による測位を行う。制御部33は、車速センサ372が検出した車速を用いて車両の走行距離をそれぞれ算出することができる。また、制御部33は、ジャイロセンサ371が検出した角速度に基づいて、車両の旋回角度を算出し、車両の進行方向を推定することができる。そして、制御部33は、ジャイロセンサ371及び車速センサ372、及び測位した自車位置等に基づいて測位を行う。
【0050】
図4は、ジャイロセンサ371が検出する角度について説明するための模式図である。ジャイロセンサ371は、角速度を検出する。車両が進行方向に対して旋回した場合、制御部33は、ジャイロセンサ371により検出された、旋回時に車両に生じた角速度を用いて旋回角度φを算出する。
【0051】
図5は、実際の走行軌跡とGPS航法による測位結果とを示す模式図である。図6は、GPS航法により算出した方位角度を説明するための模式図である。
【0052】
図5の実線は、車両の実際の走行軌跡を表している。また、図5の黒丸は、制御部33が、所定時間(例えば1秒)毎の時刻tn(n=0,1,2,3,,)において受信したGPS信号に基づいて測位した地点を示し、点線は測位した各地点から推定した走行軌跡を表している。上述した算出方法により、制御部33は、GPS航法による測位結果から、各地点の方位角度θ0,θ1,θ2,,,θn(n=0,1,2,3,,)を算出する。例えば、時刻t1において算出した方位角度θ0は、40[deg] であり、時刻t2において算出した方位角度θ0は、87[deg] が算出される。
【0053】
制御部33は、算出した方位角度θnと、ジャイロセンサ371による検出結果から算出した旋回角度とに基づいてGPS航法による測位結果に対する信頼性を判定する。
【0054】
図7は、信頼性を判定する際に用いる算出結果を説明するための模式図である。
【0055】
制御部33は、各時刻間の方位角度の変位量及び旋回角度を算出する。時刻t0からt2の間に変化した角度の変化量Δθは、方位角度θ1及びθ0の差分により算出することができる。例えば、時刻t1における方位角度θ0は40[deg] であり、時刻t2における方位角度θ0は87[deg] であるため、変化量Δθは47[deg] となる。同時に、ジャイロセンサ371により、時刻t0からt2の間の旋回角度φを算出する。そして、方位角度の変化量Δθと旋回角度φとの差分を算出する。なお、図7では、算出した結果の絶対値で示している。
【0056】
制御部33は、方位角度の変化量Δθと旋回角度φとの差分が閾値(例えば3[deg] )以下であれば、GPS航法による測位結果に対して信頼性があると判定する。例えば、時刻t0からt2の間において、方位角度の変化量Δθと旋回角度φとの差分は、32[deg] であり、閾値3[deg] 以上である。この場合、制御部33は、時刻t0からt2の間に行ったGPS航法による測位結果には信頼性がない(低い)と判定する。一方、時刻t2からt4の間において、方位角度の変化量Δθと旋回角度φとの差分は2[deg] であり、閾値3[deg] 以下である。この場合、制御部33は、時刻t2からt4の間に行ったGPS航法による測位結果には信頼性がある(高い)と判定する。
【0057】
以上のように、GPS航法による測位結果から算出した方位角度の変化量Δθの信頼性を、ジャイロセンサ371の検出結果に基づいて判定している。これは、ジャイロセンサ371が、周囲の状況に関係なく、短時間においては旋回角度を安定して測定できることを利用した方法である。すなわち、GPS航法による方位角度の変化量Δθが、常に精度が高いと考えられるジャイロセンサ371による旋回角度φと略一致するならば、その時間においてはGPS航法による方位角度の精度も高かったと判断できる、との考えに基づいた信頼性の判定法である。
【0058】
なお、車両が低速で走行している場合、測定する方位角度又は旋回角度の分散が大きくなるため、制御部33は、車速が所定速度(例えば5[m/s])以上の場合に、GPS航法による測位結果に対する信頼性の判定を行う。また、制御部33は、方位角度の変化量Δθと旋回角度φとの差分が閾値以下となる場合が所定回数(例えば5回)連続となった場合に、GPS航法による測位結果に信頼性がある(高い)と判定してもよく、一度だけの判定で信頼性があると判定してもよい。一度偶然に信頼性があると判定される場合もあるため、所定回数(例えば5回)連続となった場合に信頼性がある(高い)と判定することで、判定結果に対する信頼性を高くすることができる。
【0059】
信頼性がある(高い)と判定した場合、制御部33は、GPS信号に基づいて算出した方位角度に重みをおいて進行方位を特定する。また、信頼性がない(低い)と判定した場合、制御部33は、GPS信号により算出した方位角度に対するジャイロセンサ371の検出結果から算出した旋回角度の重み付けを大きくする。
【0060】
図8は、自車位置を補正する際の制御部33による測位結果を示す模式図である。
【0061】
例えば、図8に示すように、GPS信号を受信できず、ジャイロセンサ371などによる自立航法による測位のみで自車測位を行っている途中でGPS信号を受信できたとき、GPS信号に基づいて算出した方位角度と、ジャイロセンサ371で検出した旋回角度とに基づいてGPS信号の信頼性を判定する。そして、信頼性があると判定した場合、GPS信号に基づいて算出した方位角度に重みをおいて測位を行う。これにより、自律航法により誤差が蓄積している場合であっても、精度よく車両の進行方位を特定することができ、その結果、自車位置を適切な位置に補正することができる(図中斜線部)。
【0062】
自車位置を特定した場合、ジャイロセンサ371は短時間において安定した旋回角度を測定できるため、所定期間内は、ジャイロセンサ371が検出した旋回角度のみを用いて車両の進行方位を特定するようにしてもよい。またこの場合、時間の経過と共に、ジャイロセンサ371で検出した旋回角度の重みを徐々に小さくしていくなどしてもよく、重み付けは適宜変更することができる。
【0063】
なお、GPS航法による測位結果に対する信頼性の判定、及び方位角度と旋回角度とに重み付けを行う際に、GPS衛星20の配置状態、受信できたGPS信号の数、各GPS信号の強度、及び各GPS信号の強度とノイズとの比(SN比)等のGPS衛星20の情報を考慮するようにしてもよい。なお、受信できたGPS信号の数が多いほど、特に信号強度が基準値以上の信号を受信できたGPS衛星20の数が多いほど、信号を受信できたGPS衛星20の位置の散りばり具合が大きいほど(DOPが小さいほど)、又はGPS信号から算出した方位角度に相対的に大きな重み付けをし、車両の進行方位を特定する。これにより、精度良く車両の進行方位を特定することができる。
【0064】
上述したGPS衛星20の情報は、GPS信号を受信することで取得される。例えば、時刻T1において受信したGPS信号を送信したGPS衛星20の数が6で、SN比がそれぞれ45[dB]、48[dB]、37[dB]、50[dB]、44[dB]、46[dB]であった場合、各GPS衛星20をSN比の閾値を基準に信頼性の判定に有効なGPS衛星が選択される。SN比が40[dB]以上であれば有効とした場合、有効なGPS衛星の数は5となる。なお、有効なGPS衛星を選択する際に、SN比ではなくGPS信号の信号強度を用いてもよい。また、時刻T2において受信したGPS信号を送信したGPS衛星20の数が8で、SN比がそれぞれ43[dB]、45[dB]、30[dB]、50[dB]、38[dB]、45[dB]、37[dB]、38[dB]であった場合、有効なGPS衛星の数は4となる。この場合において、時刻T1より時刻T2の方が、GPS信号を受信できたGPS衛星20の数は多いが、有効とされたGPS衛星20の数は時刻T1の方が多い。
【0065】
制御部33は、有効なGPS衛星20の数に基づいて、GPS信号により算出した方位角度の重み付けを行う。例えば上述の例において、時刻T2より時刻T1における有効なGPS衛星20の数は多い。従って、制御部33は、時刻T1におけるGPS信号により算出した方位角度の重み付けを、時刻T2における重み付けよりも大きくする。このように、GPS航法による測位結果に対する信頼性が高くなれば、車両の進行方位を特定する際に、GPS信号により算出した方位角度の重み付けを大きくすることにより、精度よく車両の進行方位を特定することができる。
【0066】
制御部33は、DOPを用いて重み付けを行ってもよい。DOPは、GPS衛星20の配置による測位精度の低下率であり、大きくなるほど精度が低くなる(測位誤差が大きくなる)。従って、制御部33は、GPS衛星20の配置状態に基づいてDOPを算出し、DOPが大きくなるほど、GPS信号により算出した方位角度の重み付けを小さくする。このように、GPS航法による測位結果に対する信頼性が低くなれば、車両の進行方位を特定する際に、GPS信号により算出した方位角度の重み付けを小さくすることにより、精度よく車両の進行方位を特定することができる。
【0067】
次に、上述のように構成される車載機30の動作について説明する。図9は、進行方位を特定する処理手順を示すフローチャートである。
【0068】
制御部33は、GPS、光ビーコン又はナビゲーションシステムなどから自車が存在すると推定できる範囲を示す領域情報を取得し(S101)、自車位置を測位する(S102)。GPS受信部32がGPS衛星20からGPS信号を受信できたか否かを判定する(S103)。GPS信号を受信できた場合(S103:YES)、制御部33は、方位角度θnを算出する(S104)。具体的には、制御部33は、S103で受信したGPS信号により自車位置を算出し、その直前に受信したGPS信号により算出した自車位置との二点に基づき、方位角度θnを算出する。なお、制御部33は、二点の位置に基づいて方位角度θnを算出せず、上述のように、制御部33は、ドップラーシフトを用いてもよい。
【0069】
GPS信号を受信できなかった場合(S103:NO)、制御部33は、ジャイロセンサ371による検出結果から特定した車両の進行方位を採用する(S114)。その後、制御部33は、処理をS113に移す。制御部33は、ジャイロセンサ371による検出結果から車両の進行方位を常時算出している。そして、GPS信号を受信できない場合には、制御部33は、ジャイロセンサ371による検出結果から特定した進行方位を用いて測位する。
【0070】
次に、制御部33は、GPS受信部32がGPS衛星20からGPS信号を受信できたか否かを判定する(S105)。GPS信号を受信できなかった場合(S105:NO)、制御部33は、処理をS114に移す。
【0071】
GPS信号を受信できた場合(S105:YES)、制御部33は、方位角度θn+1を算出する(S106)。ジャイロセンサ371による検出結果から車両の旋回角度φを算出する(S107)。制御部33は、S104で算出した方位角度θnと方位角度θn+1とに基づいて、方位角度の変化量Δθを算出する(S108)。
【0072】
制御部33は、算出した変化量Δθと、旋回角度φとの差が閾値(3[deg] )以下であるか否かを判定する(S109)。算出した変化量Δθと、旋回角度φとの差が閾値(3[deg] )以下である場合(S109:YES)、制御部33は、信頼性があるか否かを判定する(S110)。例えば、制御部33は、算出した変化量Δθと、旋回角度φとの差が閾値以下となる場合が所定回数(例えば5回)連続したときに信頼性があると判定する。信頼性があると判定した場合(S110:YES)、制御部33は、受信したGPS信号に基づいて算出した方位角度の重み付けを相対的に大きくして進行方位を特定する(S111)。信頼性がないと判定した場合(S110:NO)、制御部33は、ジャイロセンサ371による検出結果から算出した旋回角度φの重み付けを相対的に大きくして進行方位を特定する(S112)。
【0073】
また、S109において算出した変化量Δθと、旋回角度φとの差が閾値(3[deg] )以下でない場合(S109:NO)、制御部33は、ジャイロセンサ371による検出結果から算出した旋回角度φの重み付けを相対的に大きくして進行方位を特定する(S112)。
【0074】
その後、制御部33は、処理の終了指示の有無を判定し(S113)、終了指示がない場合(S113:NO)、S103以降の処理を続ける。終了指示がある場合(S113:YES)、制御部33は、本処理を終了する。
【0075】
なお、本実施の形態では、GPS衛星20から受信するGPS信号に基づいて自車位置及び方位角度を算出し、進行方位を特定する構成であったが、2台の送信機の信号の信頼性を判定し、信号それぞれの到達時間差により自車位置を特定し、二つの自車位置から車両の方位角度を算出することもできる。
【0076】
図10は、自車位置を特定する他の例を示す説明図である。送信機40,50は、例えば交差点に設置される信号機に設置される。送信機40,50は、例えば、VHF/UHF帯の周波数帯域の電波を車載機30に対して送信する。なお、送信機40,50が使用する周波数帯域は、一例であって、VHF/UHF帯に限定されるものではなく、他の周波数帯域でもよい。例えば、自動車専用として割り当てられている5.8GHz帯を使用してもよく、また、携帯電話、PHS等で使用する周波数帯域を使用することも可能である。車両が停止線に向かって走行する場合、車載機30は、送信機40,50から送信された信号を受信し、受信した信号の到達時間に基づいて自車位置を特定する。送信機40,50が繰り返し信号を送信することで、車載機30は信号を受信する都度自車位置を特定することができる。
【0077】
図10において、道路上のある地点P1において、送信機40及び送信機50からの信号(測位用信号)を受信した場合、制御部33は、それぞれの送信機40及び送信機50の信号の受信時点と送信時点との差により、信号が送信機40及び送信機50それぞれから車載機30へ到達するまでの到達時間を算出する。この場合、信号の送信時点は、その信号に含まれる送信時点情報から取得することができる。制御部33は、各信号の到達時間の差分である到達時間差を算出する。
【0078】
自車から送信機40までの距離と、自車から送信機50までの距離との差は、信号の到達時間差ΔT1に光速を積算することで算出できる。すなわち、自車の位置は、送信機40及び送信機50の位置を焦点とする回転双曲面W1上であることがわかる。
【0079】
一方、制御部33は、送信機40及び送信機50から信号を受信した場合、自車両が走行する道路(リンク:交差点間の道路)の道路形状情報と車載機30の高さ情報により、自車の仮想的な走行面を特定する。なお、道路が直線道路である場合には、走行面は平面であり、道路がカーブしている場合には、走行面は曲面となる。
【0080】
制御部33は、自車位置を回転双曲面W1と走行面と交わる交線として特定する。これにより、2台の送信機40及び送信機50からの信号を受信するだけで、自車位置を精度良く特定することが可能となる。
【0081】
車両がさらに走行を続け、道路上の地点P2で送信機40及び送信機50から信号を受信したとすると、地点P1の場合と同様に、制御部33は、信号の到達時間差ΔT2に光速を積算することにより、到達時間差ΔT2に対応する距離を算出し、送信機40及び送信機50の位置を焦点とし、算出した距離が等しくなる回転双曲面W2を特定する。
【0082】
一方、制御部33は、送信機40及び送信機50から信号を受信した場合、自車両が走行する道路の道路形状情報と車載機30の高さ情報により、自車の仮想的な走行面を特定する。
【0083】
制御部33は、自車位置を回転双曲面W2と走行面と交わる交線として特定する。以降、同様の動作を繰り返すことにより、制御部33は、送信機40及び送信機50から信号を受信する都度、自車位置を精度良く特定し続けることができる。
【0084】
図11は、2台の送信機を用いた場合の自車位置の特定方法の概念を示す説明図である。図11の例では、2台の送信機からの信号の到達時間差が判明している場合の特定方法を示す。図11に示すように、まず、自車位置は、送信機40及び送信機50の位置を焦点とし、送信機40及び送信機50から車載機30までの各信号の到達時間差に光速を積算した距離が等しい回転双曲面W上に存在する。次に回転双曲面W上のどこに自車位置が存在するかを求める。
【0085】
制御部33は、自車両が走行する道路の道路形状情報と車載機30の高さ情報とにより、自車の仮想的な走行面を特定し、自車位置を回転双曲面Wと走行面と交わる交線として特定する。これにより、2台の送信機40及び送信機50からの信号を受信するだけで、自車位置を精度良く特定することが可能となる。
【0086】
以上説明したように、本発明にあっては、受信したGPS信号の信頼性を判定することで、進行方位を特定する際の精度を向上させることができる。信頼性がある(高い)場合に、GPS信号に基づいて算出した方位角度の重み付けを相対的に大きくし進行方位を特定することで、より正確な測位を行うことができる。また、信頼性がない(低い)場合には、ジャイロセンサ371の検出結果から算出した旋回角度の重み付けを大きくし進行方位を特定することで、できる限り誤差の含んだ測位が行われないようにできる。
【0087】
開示された実施の形態は、すべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれることが意図される。
【図面の簡単な説明】
【0088】
【図1】実施の形態に係る車載機の構成を示すブロック図である。
【図2】GPS信号に基づく方位の算出方法を説明するための模式図である。
【図3】ドップラーシフトをもとに自車位置を測位する場合について説明するための図である。
【図4】ジャイロセンサが検出する角度について説明するための模式図である。
【図5】実際の走行軌跡とGPS航法による測位結果とを示す模式図である。
【図6】GPS航法により算出した方位角度を説明するための模式図である。
【図7】信頼性を判定する際に用いる算出結果を説明するための模式図である。
【図8】自車位置を補正する際の制御部による測位結果を示す模式図である。
【図9】進行方位を特定する処理手順を示すフローチャートである。
【図10】自車位置を特定する他の例を示す説明図である。
【図11】2台の送信機を用いた場合の自車位置の特定方法の概念を示す説明図である。
【図12】自立航法による測位結果の一例を示す図である。
【符号の説明】
【0089】
20 GPS衛星
30 車載機
31 通信部
32 GPS受信部
33 制御部
34 記憶部
37 センサ部
371 ジャイロセンサ
372 車速センサ
【特許請求の範囲】
【請求項1】
第1方位角度算出手段が算出した車両の方位角度に基づいて、車両の進行方位を特定する方位特定装置であって、
車両の旋回角度を検出する角度検出手段と、
前記第1方位角度算出手段が算出した方位角度の所定時間内における変化量を算出する第1算出手段と、
前記角度検出手段が検出した前記所定時間内における旋回角度を算出する第2算出手段と、
前記第1算出手段が算出した変化量及び第2算出手段が算出した旋回角度に基づいて、前記第1方位角度算出手段の算出結果に対する信頼性を判定する信頼性判定手段と、
該信頼性判定手段による信頼性の判定結果に応じて、前記第1方位角度算出手段が算出した方位角度及び前記角度検出手段が検出した旋回角度に基づいて、車両の進行方位を特定する特定手段と
を備えることを特徴とする方位特定装置。
【請求項2】
車速を検出する車速検出手段と、
該車速検出手段が検出した車速が所定速度以上であるか否かを判定する速度判定手段と
をさらに備え、
前記信頼性判定手段は、
前記速度判定手段が所定速度以上であると判定した場合に信頼性を判定する構成としてある
ことを特徴とする請求項1に記載の方位特定装置。
【請求項3】
過去の車両の進行方位を記憶する進行方位記憶手段と、
前記角度検出手段が検出した旋回角度と前記進行方位記憶手段に記憶した車両の進行方位とに基づいて車両の方位角度を算出する第2方位角度算出手段と
をさらに備え、
前記特定手段は、
前記第1方位角度算出手段及び第2方位角度算出手段の算出結果の少なくとも一方に重み付けをし、重み付けをした算出結果に基づいて車両の進行方位を特定する際に、
前記信頼性判定手段が判定した信頼性が高いほど、前記第1方位角度算出手段の算出結果に相対的に大きな重み付けをし、車両の進行方位を特定する構成としてある
ことを特徴とする請求項1又は請求項2に記載の方位特定装置。
【請求項4】
前記特定手段は、
所定期間が経過するまで及び/又は所定角度を旋回するまで、前記第2方位角度算出手段の算出結果のみに基づいて車両の進行方位を特定する構成としてある
ことを特徴とする請求項3に記載の方位特定装置。
【請求項5】
人工衛星信号が人工衛星から送信されており、
前記人工衛星信号を異なるタイミングで受信する第1受信手段と、
該第1受信手段が異なるタイミングで受信した人工衛星信号それぞれに基づいて車両位置を検出する第1車両位置検出手段と
をさらに備え、
前記第1方位角度算出手段は、
前記第1車両位置検出手段が検出した各車両位置を用いて方位角度を算出する構成としてある
ことを特徴とする請求項1乃至請求項4の何れか一つに記載の方位特定装置。
【請求項6】
前記人工衛星は複数配置され、
前記第1受信手段は、
複数の人工衛星から人工衛星信号を受信する構成としてあり、
前記第1受信手段が受信した人工衛星信号に基づいて、人工衛星の配置状態、受信した人工衛星信号を送信した人工衛星の数、各人工衛星信号の強度、及び各人工衛星信号の強度とノイズとの比の少なくとも一つ以上の人工衛星状態情報を取得する状態情報取得手段
をさらに備え、
前記特定手段は、
前記状態情報取得手段が取得した人工衛星状態情報に基づいて、前記第1方位角度算出手段及び第2方位角度算出手段の算出結果に重み付けをし、車両の進行方位を特定する構成としてある
ことを特徴とする請求項5に記載の方位特定装置。
【請求項7】
異なる地点から送信された信号を受信する第2受信手段と、
該第2受信手段が受信した信号の到達時間及び到達時間差の少なくとも一方を取得する時間取得手段と、
前記第2受信手段が受信した信号及び前記時間取得手段が取得した到達時間及び到達時間差の少なくとも一方を用いて車両位置を検出する第2車両位置検出手段と
をさらに備え、
前記第1方位角度算出手段は、
前記第2車両位置検出手段が検出した車両位置を用いて方位角度を算出する構成としてある
ことを特徴とする請求項1乃至請求項4の何れか一つに記載の方位特定装置。
【請求項8】
複数の人工衛星又は異なる地点から信号が送信されており、
前記信号を受信する第3受信手段
をさらに備え、
前記第1方位角度算出手段は、
前記第3受信手段が受信する信号のドップラーシフトを用いて方位角度を算出する構成としてある
ことを特徴とする請求項1乃至請求項4の何れか一つに記載の方位特定装置。
【請求項9】
人工衛星が送信した人工衛星信号の周波数を取得する第1周波数取得手段と、
前記第1受信手段が受信した人工衛星信号の周波数を取得する第2周波数取得手段と、
前記第1受信手段が受信した人工衛星信号に基づいて、人工衛星の位置、人工衛星の速度、及び人工衛星の進行方位を取得する軌道情報取得手段と
をさらに備え、
前記第1方位角度算出手段は、
前記第1及び第2周波数取得手段が取得した周波数に基づいて前記人工衛星信号のドップラーシフトを算出し、
該ドップラーシフト、前記第1車両位置検出手段が検出した車両位置、及び、前記軌跡情報取得手段による取得結果を用いて方位角度を算出する構成としてある
ことを特徴とする請求項5又は請求項6に記載の方位特定装置。
【請求項10】
第1方位角度算出手段が算出した車両の方位角度に基づいて、方位特定装置で車両の進行方位を特定する方位特定方法であって、
角度検出手段で車両の旋回角度を検出するステップと、
前記第1方位角度算出手段が算出した方位角度の所定時間内における変化量を算出するステップと、
前記角度検出手段が検出した前記所定時間内における旋回角度を算出するステップと、
算出した変化量及び算出した旋回角度に基づいて、前記第1方位角度算出手段の算出結果に対する信頼性を判定するステップと、
信頼性の判定結果に応じて、前記第1方位角度算出手段が算出した方位角度及び前記角度検出手段が検出した旋回角度に基づいて、車両の進行方位を特定するステップと
を備えることを特徴とする方位特定方法。
【請求項11】
車両の旋回角度が取得できるコンピュータに、算出させた車両の方位角度に基づいて、車両の進行方位を特定させるコンピュータプログラムであって、
前記コンピュータを、
算出した方位角度の所定時間内における変化量を算出する第1算出手段、
取得した前記所定時間内における旋回角度を算出する第2算出手段、
前記第1算出手段が算出した変化量及び第2算出手段が算出した旋回角度に基づいて、算出した車両の方位角度に対する信頼性を判定する信頼性判定手段、及び、
該信頼性判定手段による信頼性の判定結果に応じて、算出した車両の方位角度及び取得した旋回角度に基づいて、車両の進行方位を特定する特定手段
として機能させることを特徴とするコンピュータプログラム。
【請求項1】
第1方位角度算出手段が算出した車両の方位角度に基づいて、車両の進行方位を特定する方位特定装置であって、
車両の旋回角度を検出する角度検出手段と、
前記第1方位角度算出手段が算出した方位角度の所定時間内における変化量を算出する第1算出手段と、
前記角度検出手段が検出した前記所定時間内における旋回角度を算出する第2算出手段と、
前記第1算出手段が算出した変化量及び第2算出手段が算出した旋回角度に基づいて、前記第1方位角度算出手段の算出結果に対する信頼性を判定する信頼性判定手段と、
該信頼性判定手段による信頼性の判定結果に応じて、前記第1方位角度算出手段が算出した方位角度及び前記角度検出手段が検出した旋回角度に基づいて、車両の進行方位を特定する特定手段と
を備えることを特徴とする方位特定装置。
【請求項2】
車速を検出する車速検出手段と、
該車速検出手段が検出した車速が所定速度以上であるか否かを判定する速度判定手段と
をさらに備え、
前記信頼性判定手段は、
前記速度判定手段が所定速度以上であると判定した場合に信頼性を判定する構成としてある
ことを特徴とする請求項1に記載の方位特定装置。
【請求項3】
過去の車両の進行方位を記憶する進行方位記憶手段と、
前記角度検出手段が検出した旋回角度と前記進行方位記憶手段に記憶した車両の進行方位とに基づいて車両の方位角度を算出する第2方位角度算出手段と
をさらに備え、
前記特定手段は、
前記第1方位角度算出手段及び第2方位角度算出手段の算出結果の少なくとも一方に重み付けをし、重み付けをした算出結果に基づいて車両の進行方位を特定する際に、
前記信頼性判定手段が判定した信頼性が高いほど、前記第1方位角度算出手段の算出結果に相対的に大きな重み付けをし、車両の進行方位を特定する構成としてある
ことを特徴とする請求項1又は請求項2に記載の方位特定装置。
【請求項4】
前記特定手段は、
所定期間が経過するまで及び/又は所定角度を旋回するまで、前記第2方位角度算出手段の算出結果のみに基づいて車両の進行方位を特定する構成としてある
ことを特徴とする請求項3に記載の方位特定装置。
【請求項5】
人工衛星信号が人工衛星から送信されており、
前記人工衛星信号を異なるタイミングで受信する第1受信手段と、
該第1受信手段が異なるタイミングで受信した人工衛星信号それぞれに基づいて車両位置を検出する第1車両位置検出手段と
をさらに備え、
前記第1方位角度算出手段は、
前記第1車両位置検出手段が検出した各車両位置を用いて方位角度を算出する構成としてある
ことを特徴とする請求項1乃至請求項4の何れか一つに記載の方位特定装置。
【請求項6】
前記人工衛星は複数配置され、
前記第1受信手段は、
複数の人工衛星から人工衛星信号を受信する構成としてあり、
前記第1受信手段が受信した人工衛星信号に基づいて、人工衛星の配置状態、受信した人工衛星信号を送信した人工衛星の数、各人工衛星信号の強度、及び各人工衛星信号の強度とノイズとの比の少なくとも一つ以上の人工衛星状態情報を取得する状態情報取得手段
をさらに備え、
前記特定手段は、
前記状態情報取得手段が取得した人工衛星状態情報に基づいて、前記第1方位角度算出手段及び第2方位角度算出手段の算出結果に重み付けをし、車両の進行方位を特定する構成としてある
ことを特徴とする請求項5に記載の方位特定装置。
【請求項7】
異なる地点から送信された信号を受信する第2受信手段と、
該第2受信手段が受信した信号の到達時間及び到達時間差の少なくとも一方を取得する時間取得手段と、
前記第2受信手段が受信した信号及び前記時間取得手段が取得した到達時間及び到達時間差の少なくとも一方を用いて車両位置を検出する第2車両位置検出手段と
をさらに備え、
前記第1方位角度算出手段は、
前記第2車両位置検出手段が検出した車両位置を用いて方位角度を算出する構成としてある
ことを特徴とする請求項1乃至請求項4の何れか一つに記載の方位特定装置。
【請求項8】
複数の人工衛星又は異なる地点から信号が送信されており、
前記信号を受信する第3受信手段
をさらに備え、
前記第1方位角度算出手段は、
前記第3受信手段が受信する信号のドップラーシフトを用いて方位角度を算出する構成としてある
ことを特徴とする請求項1乃至請求項4の何れか一つに記載の方位特定装置。
【請求項9】
人工衛星が送信した人工衛星信号の周波数を取得する第1周波数取得手段と、
前記第1受信手段が受信した人工衛星信号の周波数を取得する第2周波数取得手段と、
前記第1受信手段が受信した人工衛星信号に基づいて、人工衛星の位置、人工衛星の速度、及び人工衛星の進行方位を取得する軌道情報取得手段と
をさらに備え、
前記第1方位角度算出手段は、
前記第1及び第2周波数取得手段が取得した周波数に基づいて前記人工衛星信号のドップラーシフトを算出し、
該ドップラーシフト、前記第1車両位置検出手段が検出した車両位置、及び、前記軌跡情報取得手段による取得結果を用いて方位角度を算出する構成としてある
ことを特徴とする請求項5又は請求項6に記載の方位特定装置。
【請求項10】
第1方位角度算出手段が算出した車両の方位角度に基づいて、方位特定装置で車両の進行方位を特定する方位特定方法であって、
角度検出手段で車両の旋回角度を検出するステップと、
前記第1方位角度算出手段が算出した方位角度の所定時間内における変化量を算出するステップと、
前記角度検出手段が検出した前記所定時間内における旋回角度を算出するステップと、
算出した変化量及び算出した旋回角度に基づいて、前記第1方位角度算出手段の算出結果に対する信頼性を判定するステップと、
信頼性の判定結果に応じて、前記第1方位角度算出手段が算出した方位角度及び前記角度検出手段が検出した旋回角度に基づいて、車両の進行方位を特定するステップと
を備えることを特徴とする方位特定方法。
【請求項11】
車両の旋回角度が取得できるコンピュータに、算出させた車両の方位角度に基づいて、車両の進行方位を特定させるコンピュータプログラムであって、
前記コンピュータを、
算出した方位角度の所定時間内における変化量を算出する第1算出手段、
取得した前記所定時間内における旋回角度を算出する第2算出手段、
前記第1算出手段が算出した変化量及び第2算出手段が算出した旋回角度に基づいて、算出した車両の方位角度に対する信頼性を判定する信頼性判定手段、及び、
該信頼性判定手段による信頼性の判定結果に応じて、算出した車両の方位角度及び取得した旋回角度に基づいて、車両の進行方位を特定する特定手段
として機能させることを特徴とするコンピュータプログラム。
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】
【図11】
【図12】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】
【図11】
【図12】
【公開番号】特開2009−250895(P2009−250895A)
【公開日】平成21年10月29日(2009.10.29)
【国際特許分類】
【出願番号】特願2008−101719(P2008−101719)
【出願日】平成20年4月9日(2008.4.9)
【出願人】(000002130)住友電気工業株式会社 (12,747)
【Fターム(参考)】
【公開日】平成21年10月29日(2009.10.29)
【国際特許分類】
【出願日】平成20年4月9日(2008.4.9)
【出願人】(000002130)住友電気工業株式会社 (12,747)
【Fターム(参考)】
[ Back to top ]