JP5419665B2 - 位置標定装置、位置標定方法、位置標定プログラム、速度ベクトル算出装置、速度ベクトル算出方法および速度ベクトル算出プログラム - Google Patents
位置標定装置、位置標定方法、位置標定プログラム、速度ベクトル算出装置、速度ベクトル算出方法および速度ベクトル算出プログラム Download PDFInfo
- Publication number
- JP5419665B2 JP5419665B2 JP2009280370A JP2009280370A JP5419665B2 JP 5419665 B2 JP5419665 B2 JP 5419665B2 JP 2009280370 A JP2009280370 A JP 2009280370A JP 2009280370 A JP2009280370 A JP 2009280370A JP 5419665 B2 JP5419665 B2 JP 5419665B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- vector
- gps
- unit
- calculated
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Landscapes
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Description
このとき、車速パルスから得られる前後方向の車速が車両の進行方向の速度として扱われる。
さらに、車両がコーナーを曲がっているときには車両に横滑りが生じるため、車両の前後方向と車両の進行方向とは一致しない。
このため、車速パルスから得られる車速を車両の進行方向の速度として扱うと、実際の車両の進行方向の速度に対してジャイロの取り付け誤差と車両の横滑り誤差とが生じる。つまり、GPS衛星の不可視時に測位精度を維持することができなくなる。
GPS衛星の可視時に前記GPS受信機により取得された観測値に基づいて所定の情報を観測情報として生成する観測情報生成部と、
前記観測情報生成部により生成された観測情報を用いて前記慣性航法部の算出誤差の補正量をGPS可視時補正量として算出するカルマンフィルタと、
前記慣性航法部により算出された車両の座標値と車両の速度ベクトルとを前記カルマンフィルタにより算出されたGPS可視時補正量により補正する航法補正部と、
前記車速検出装置により検出された車速値に基づいて車両の速度スカラーを算出する速度スカラー算出部と、
GPS衛星の可視時に前記速度スカラー算出部により算出された速度スカラーと前記航法補正部により補正された速度ベクトルの左右方向成分とに基づいて車両の横滑り角を算出する横滑り角算出部と、
前記横滑り角算出部により算出された横滑り角と前記慣性装置により検出された加速度ベクトルの左右方向成分とを対応づけて蓄積する横滑り角蓄積部と、
前記横滑り角蓄積部に蓄積された横滑り角に基づいて車両の加速度ベクトルの左右方向成分と横滑り角との関係値をコーナリングパワーとして算出するコーナリングパワー算出部と、
GPS衛星が不可視であるGPS不可視時点に前記速度スカラー算出部により算出された速度スカラーと前記慣性装置により前記GPS不可視時点に検出された加速度ベクトルの左右方向成分と前記コーナリングパワー算出部により算出されたコーナリングパワーとに基づいて車両の速度ベクトルを算出する速度ベクトル算出部と、
前記慣性航法部により前記GPS不可視時点に算出された速度ベクトルと前記速度ベクトル算出部により算出された速度ベクトルとの差を速度ベクトル残差として算出する速度ベクトル残差算出部とを備え、
前記カルマンフィルタは、前記速度ベクトル残差算出部により算出された速度ベクトル残差を用いて前記慣性航法部の算出誤差の補正量をGPS不可視時補正量として算出し、
前記航法補正部は、GPS衛星の可視時に前記慣性航法部により算出された車両の座標値を前記GPS可視時補正量により補正することにより車両の座標値を標定し、GPS衛星の不可視時に前記慣性航法部により算出された車両の座標値を前記GPS不可視時補正量により補正することにより車両の座標値を標定する。
GPS衛星の可視時にGPS/INS(Inertial Navigation System)複合航法により車両の位置を標定し、GPS衛星の不可視時にODO(ODOmetry)/INS複合航法により車両の位置を標定する標定装置について説明する。
標定装置は、GPS衛星の可視時にGPS/INS複合航法により得られる車両の速度ベクトルに基づいて車両の横滑り特性を学習し、GPS衛星の不可視時に車両の横滑り特性を考慮してODO/INS複合航法により車両の位置を標定する。
実施の形態1における車両200の構成について、図1に基づいて以下に説明する。
車両200は自己位置姿勢標定装置100および車速検出装置230を備える。
各GPS受信機は、GPS衛星から定期的に発信されるGPSの測位信号を受信し、受信結果から特定の観測値を取得し、取得した観測値を出力する。以下、GPS受信機がGPSの測位信号を受信して観測値を得ることを「観測」という。また、GPSの測位信号を「搬送波」という。搬送波にはエフェメリスなどの航法メッセージが含まれる。
GPS受信機が出力する観測値には、受信した搬送波の位相(搬送波位相)、GPS受信機とGPS衛星との距離(疑似距離)、GPS受信機の座標値、航法メッセージなどがある。
ジャイロセンサは、周期的に、車両200の3軸(x,y,z)方向の角速度を検出して出力する。以下、3軸方向の角速度を「角速度ベクトル」という。
加速度センサは、周期的に、車両200の3軸方向の加速度を検出して出力する。以下、3軸方向の加速度を「加速度ベクトル」という。
x軸回りの角度を「ロール角φ(回転角)」、y軸回りの角度を「ピッチ角θ(仰角)」、z軸回りの角度を「ヨー角ψ(方位角)」という。
xyz軸で表される座標系(原点O)を「車両座標系」とする。
以下、車速検出装置230により検出された車速パルスから求まる速度を「速度スカラー」という。
速度ベクトルは速度を3軸成分に分けて表すデータである。
実施の形態1における自己位置姿勢標定装置100の機能構成について、図2に基づいて以下に説明する。
基準局GPS299とは、位置が固定であり座標値が既知であるGPS受信機(電子基準点ともいう)である。
各GPS受信機からGPS衛星が可視であるときに、各GPS受信機により搬送波位相が観測される。
以下、各GPS受信機から所定数以上のGPS衛星が可視であるときを「GPS可視時」といい、各GPS受信機から所定数以上のGPS衛星が可視でないとき(不可視であるとき)を「GPS不可視時」という。
IMU処理部140は、算出した位置、姿勢および速度ベクトルをカルマンフィルタ150により算出された誤差補正量を用いて補正し、補正後の位置、姿勢および速度を出力する。
以下、車両200の位置、姿勢および速度ベクトルを算出し、補正することを「標定」という。
また、標定された位置、姿勢および速度ベクトルを出力することを「航法出力」という。
ODO処理部130は、自己が算出した速度ベクトルとIMU処理部140により標定された速度ベクトルとの誤差(速度残差)を算出する。
各GPS受信機により観測された搬送波位相、車速検出装置230により検出された車速パルス、慣性装置220により検出された加速度ベクトルおよび角速度ベクトル、横滑り特性学習部110により学習された横滑りの特性値、IMU処理部140の航法出力値は標定装置記憶部190に記憶されるデータの一例である。
実施の形態1におけるODO処理部130およびIMU処理部140の機能構成について、図3に基づいて以下に説明する。
以下、慣性装置220の検出誤差の補正量を「IMU誤差補正量(慣性誤差補正量の一例)」といい、ストラップダウン演算部142の演算誤差の補正量を「航法誤差補正量(GPS可視時補正量の一例)」という。
IMU誤差補正量には、慣性装置220により検出された角速度ベクトルと加速度ベクトルとのそれぞれの誤差を補正する値が含まれる。
航法誤差補正量には、ストラップダウン演算部142により算出された車両200の位置、姿勢および速度ベクトルそれぞれの誤差を補正する値が含まれる。
ストラップダウン演算部142は、ストラップダウン演算により得られた車両200の位置、姿勢および速度ベクトルをカルマンフィルタ150により新たに算出された航法誤差補正量で補正する。このとき、ストラップダウン演算部142は、車両200の位置、姿勢および速度ベクトルにそれぞれの補正量を加算する。
ストラップダウン演算部142は、標定(算出および補正)した車両200の位置、姿勢および速度ベクトルを出力する。
速度/加速度計算部131は、算出した速度スカラーを微分して車両200の加速度(スカラー量)を算出する。
すなわち、「横滑り角β=速度ベクトルの左右方向成分値Vy/速度スカラーVodo」である。「Vy/Vodo」をタンジェント(tan)の値とする角度を横滑り角βとしてもよい。
ここで、速度スカラーと速度ベクトルとは同期が取られているものとする。つまり、速度スカラーと速度ベクトルとは同時刻に取得された元データ(速度パルス、加速度ベクトル)から算出されたもの、または同時刻に取得されたように加工した元データから算出されたものである。
図4において、車両200がコーナーを曲がっているとき(車両にヨーレートがあるとき)、車両200は横力を受けてタイヤの傾きよりも浅い角度の方向へ進む。つまり、車両200はコーナリング時に横滑りし、横滑り角βが生じる。このとき、タイヤの向きと車両200の進行方向とが成すヨー角が横滑り角βである。
横滑り特性学習部110は、この横滑り角βを上記のように算出する。
・定期的または新たな横滑り角と加速度ベクトルの左右方向成分値とが蓄積されたとき。
・GPS不可視時になったとき(各GPS受信機から搬送波位相が入力されなくなったとき)。
コーナリングフォースとは加速度ベクトルの左右方向成分値に質量(ここでは車両200の重量)を掛けた値であり、単位コーナリングフォースとは単位質量当たりのコーナリングフォースである。
すなわち、コーナリングフォースとは、加速度ベクトルの左右方向成分値である。
実施の形態1における慣性装置220のオフセットOSについて、図5に基づいて以下に説明する。
このため、慣性装置220は、車両200がx軸方向へ進んでいても、車両200がx軸方向からずれたV方向へ進んでいるような角速度ベクトルと加速度ベクトルとを検出する。
以下、慣性装置220のz軸方向(ピッチ角)のオフセットを「os[0]」と記し、慣性装置220のy軸方向(ヨー角)のオフセットを「os[1]」と記す。
実施の形態1におけるコーナリングパワーSslipとオフセットos[1]とを表すグラフについて、図6に基づいて以下に説明する。
横滑り特性学習部110は、プロットされた各点の平均をとって横滑り特性直線L(一次回帰直線)を算出する。
つまり、車両200に掛かる単位コーナリングフォースayが特定範囲内の大きさであるとき、車両200には単位コーナリングフォースayに比例した横滑り角βが生じる。しかし、車両200に掛かる単位コーナリングフォースayが特定範囲を超えた大きさになると、車両200に生じる横滑り角βは増大する。
例えば、横滑り特性学習部110は、ストラップダウン演算部142により標定された速度ベクトルの上下方向成分値を速度スカラーで割った値をオフセット角として算出し、オフセット角と慣性装置220により検出された加速度ベクトルの上下方向成分値とを対応づけて蓄積する。横滑り特性学習部110は、オフセット角と加速度ベクトルの上下方向成分値とに対応する点をプロットし、各点の平均をとった直線の切片をオフセットos[0]として算出する。
ここで、速度スカラーと加速度ベクトルとは同期が取られているものとする。
速度/加速度残差計算部133は、速度/加速度予測部132により算出された加速度ベクトルと補正計算部141により補正された加速度ベクトルとの差を「加速度ベクトル残差」として算出する。
ここで、2つの速度ベクトルおよび2つの加速度ベクトルは同期が取られているものとする。
ストラップダウン演算部142は、補正計算部141により補正された角速度ベクトルと加速度ベクトルとに基づいて車両200の位置、姿勢および速度ベクトルを算出し、算出した位置、姿勢および速度ベクトルをカルマンフィルタ150により新たに算出された航法誤差補正量で補正する。
ストラップダウン演算部142は、標定(算出および補正)した車両200の位置、姿勢および速度ベクトルを出力する。
実施の形態1におけるGPS処理部120の機能構成について、図7に基づいて以下に説明する。
並進系二重位相差計算部121は、基準局GPS299から入力したGPS衛星Aの搬送波位相と主局GPS210から入力したGPS衛星Aの搬送波位相との差をGPS衛星Aの搬送波位相差として算出する。並進系二重位相差計算部121は、GPS衛星Bについても同様に搬送波位相差を算出する。
並進系二重位相差計算部121は、GPS衛星Aの搬送波位相差とGPS衛星Bの搬送波位相差との差を「並進系二重位相差」として算出する。基準局GPS299と主局GPS210との距離から車両200の位置が定まるため、基準局GPS299と主局GPS210との観測値から求まる観測情報(ここでは、二重位相差)を「並進系」とする。
並進系デザイン行列とは、2つのGPS受信機の位置と並進系二重位相差との関係を表す所定の行列である。
姿勢系二重位相差計算部124は、主局GPS210から入力したGPS衛星Aの搬送波位相と従局GPS211から入力したGPS衛星Aの搬送波位相との差をGPS衛星Aの搬送波位相差として算出する。姿勢系二重位相差計算部124は、GPS衛星Bについても同様に搬送波位相差を算出する。
姿勢系二重位相差計算部124は、GPS衛星Aの搬送波位相差とGPS衛星Bの搬送波位相差との差を主局GPS210と従局GPS211とに対する「姿勢系二重位相差」として算出する。主局GPS210と従局GPS211(または従局GPS212)とを結ぶ基線ベクトルは車両200の姿勢を表すため、主局GPS210と従局GPS211(または従局GPS212)との観測値から求まる観測情報(ここでは、二重位相差)を「姿勢系」とする。
姿勢系二重位相差計算部124は、主局GPS210と従局GPS212とに対しても同様に姿勢系二重位相差を算出する。
姿勢系デザイン行列とは、2つのGPS受信機の位置と姿勢系二重位相差との関係を表す所定の行列である。主局GPS210、従局GPS211および従局GPS212の相対位置と車両200の姿勢とにより3つのGPS受信機の3次元の相対位置が求まる。
姿勢系二重位相差残差計算部126は、主局GPS210と従局GPS212とに対しても同様に姿勢系二重位相差残差を算出する。
カルマンフィルタ150は、モデル化された状態方程式と観測方程式とを用いて航法誤差補正量およびIMU誤差補正量を推定する。カルマンフィルタ150に入力される残差は観測方程式の変数として用いられる。
・xyz軸で値が異なる。
・単位コーナリングフォースayの大きさによってy軸の値が変化する。
・速度スカラーVodoの大きさによってxyz軸の値が変化する。
実施の形態1における自己位置姿勢標定方法の処理の流れについて、図8に基づいて以下に説明する。
例えば、自己位置姿勢標定装置100(図示省略する初期値決定部)は、各GPS受信機(299、210〜212)を用いてリアルタイムキネマティックGPS(RTK−GPS)により車両200の位置を測位する。そして、自己位置姿勢標定装置100は、車両200の3つのGPS受信機(210〜212)の位置関係に基づいて車両200の姿勢を算出する(GPSコンパス)。RTK−GPSの測位精度は高く、その誤差は2センチメートル程度である。但し、RTK−GPS以外の方法で位置を測位しても構わない。また、利用者が測量などにより得られた位置、姿勢を自己位置姿勢標定装置100に設定しても構わない。
初期位置姿勢決定処理(S110)の後、自己位置姿勢標定装置100は以下のように動作する。
実施の形態1におけるGPS/INS複合航法処理(S130)について、図9に基づいて以下に説明する。
また、ストラップダウン演算部142は、補正計算部141により補正された角速度ベクトルと加速度ベクトルとに基づいて車両200の位置、姿勢および速度ベクトルを算出する。
そして、ストラップダウン演算部142は、カルマンフィルタ150により算出された航法誤差補正量で補正して車両200の位置、姿勢および速度ベクトルを標定する。
実施の形態1における横滑り特性学習処理(S140)について、図10に基づいて以下に説明する。
実施の形態1におけるODO/INS複合航法処理(S150)について、図11に基づいて以下に説明する。
また、ストラップダウン演算部142は、補正計算部141により補正された角速度ベクトルと加速度ベクトルとに基づいて車両200の位置、姿勢および速度ベクトルを算出する。
そして、ストラップダウン演算部142は、カルマンフィルタ150により算出された航法誤差補正量で補正して車両200の位置、姿勢および速度ベクトルを標定する。
さらに、速度/加速度予測部132は、速度/加速度計算部131により算出された加速度スカラーに基づいて加速度ベクトルを算出する。
さらに、速度/加速度残差計算部133は、速度/加速度予測部132により算出された加速度ベクトルと補正計算部141により補正された加速度ベクトルとの差を加速度ベクトル残差として算出する。
また、ストラップダウン演算部142は、補正計算部141により補正された角速度ベクトルと加速度ベクトルとに基づいて車両200の位置、姿勢および速度ベクトルを算出する。
そして、ストラップダウン演算部142は、カルマンフィルタ150により新たに算出された航法誤差補正量で補正して車両200の位置、姿勢および速度ベクトルを標定する。
実施の形態1における自己位置姿勢標定装置100の標定精度について、図12に基づいて以下に説明する。
そして、収集したデータから以下の測位結果(a)〜(c)を得た。
(b)ODO/INS複合航法処理(S150)による測位結果
(c)ODO/INS複合航法処理(S150)においてコーナリングパワーSslipと単位コーナリングフォースayとを「0」にしたときの測位結果(従来手法に相当)
測位結果(a)をリファレンス値(真値)とする。
横軸は時間、縦軸は距離を示している。
そして、実施の形態1の手法は、GPS不可視時においても高い精度で位置、姿勢および速度ベクトルを標定することができる手法である。
図13において、自己位置姿勢標定装置100は、CPU911(Central・Processing・Unit)(マイクロプロセッサ、マイクロコンピュータともいう)を備えている。CPU911は、バス912を介してROM913、RAM914、通信ボード915、磁気ディスク装置920と接続され、これらのハードウェアデバイスを制御する。
自己位置姿勢標定装置100は、GPS、IMU、ODOといったセンサを用いて車両の自己位置姿勢を標定する装置である。
自己位置姿勢標定装置100は、車両のコーナリングフォースおよび横滑り角を考慮することによって高い精度で車両の自己位置姿勢を標定することを可能にする。
自己位置姿勢標定装置100は、都市部のようにGPSの衛星補足数が十分確保できないGPS不可視条件下でも標定精度の劣化を防ぐことを目的とする。
(1)GPS受信データなどのセンサデータによって計測できる車両の単位コーナリングフォースと横滑り角との1次相関を逐次学習する(図6参照)。
(2)車両に設置したセンサの設置ズレやタイヤの特性等によって走行時に発生する車両座標系からのズレ(ピッチ、ヨー両軸のオフセット)を補正する(式(1)参照)。
(3)カルマンフィルタへの観測情報の入力として、補正した車速と車両のコーナリングフォースとを考慮した観測ノイズ行列を用いる(式(2)参照)。
自己位置姿勢標定装置100は、車速値(例えば、車速パルス)が重要になるGPS不可視時の位置姿勢標定精度の維持手段として、極めて有効である。
車両のセンサデータは、乗車人数、雨や雪など天候による道路面状況、傾斜やカーブなどの道路形状などによって変化し、ノイズなど不確定な要素が存在する。また、車両のセンサデータは車速や横力の大きさに比例する。このため、車載を前提として簡略化し、スケールファクタ誤差(ホワイトノイズ)を考慮したノイズ成分のモデルでは、車両の状態を考慮したオフセットやノイズの成分が車速に十分に反映されない。そして、カルマンフィルタ演算における状態量そのものの信憑性(正確性)をなくし、位置標定精度の劣化要因の一因となる。
このように、オフセット値、コーナリングパワー、単位コーナリングフォースを考慮してGPS可視環境下で車速を逐次算出することで、GPSの可視環境から不可視環境になったときに、より高精度に車速を算出ができる。
そして、算出した車速をカルマンフィルタの観測更新演算の観測行列に利用し、位置標定精度を維持することができる。
また、その時の誤差の分散行列をカルマンフィルタにおける観測更新演算における観測ノイズ行列として用いる。コーナリングフォースを考慮したノイズを重畳することで、車両の状態をより正確に反映する速度を算出することができる。
また、車両の停止中はIMU処理部140やカルマンフィルタ150を停止してもよい。
Claims (11)
- GPS衛星(GPS:Global Positioning System)から発信される搬送波を観測するGPS受信機と加速度ベクトルを検出する慣性装置と車速値を検出する車速検出装置とが設置された車両の座標値を標定する位置標定装置において、
前記慣性装置により検出された加速度ベクトルに基づいて車両の座標値と車両の速度ベクトルとを算出する慣性航法部と、
GPS衛星の可視時に前記GPS受信機により取得された観測値に基づいて所定の情報を観測情報として生成する観測情報生成部と、
前記観測情報生成部により生成された観測情報を用いて前記慣性航法部の算出誤差の補正量をGPS可視時補正量として算出するカルマンフィルタと、
前記慣性航法部により算出された車両の座標値と車両の速度ベクトルとを前記カルマンフィルタにより算出されたGPS可視時補正量により補正する航法補正部と、
前記車速検出装置により検出された車速値に基づいて車両の速度スカラーを算出する速度スカラー算出部と、
GPS衛星の可視時に前記速度スカラー算出部により算出された速度スカラーと前記航法補正部により補正された速度ベクトルの左右方向成分とに基づいて車両の横滑り角を算出する横滑り角算出部と、
前記横滑り角算出部により算出された横滑り角と前記慣性装置により検出された加速度ベクトルの左右方向成分とを対応づけて蓄積する横滑り角蓄積部と、
前記横滑り角蓄積部に蓄積された横滑り角に基づいて車両の加速度ベクトルの左右方向成分と横滑り角との関係値をコーナリングパワーとして算出するコーナリングパワー算出部と、
GPS衛星が不可視であるGPS不可視時点に前記速度スカラー算出部により算出された速度スカラーと前記慣性装置により前記GPS不可視時点に検出された加速度ベクトルの左右方向成分と前記コーナリングパワー算出部により算出されたコーナリングパワーとに基づいて車両の速度ベクトルを算出する速度ベクトル算出部と、
前記慣性航法部により前記GPS不可視時点に算出された速度ベクトルと前記速度ベクトル算出部により算出された速度ベクトルとの差を速度ベクトル残差として算出する速度ベクトル残差算出部とを備え、
前記カルマンフィルタは、前記速度ベクトル残差算出部により算出された速度ベクトル残差を用いて前記慣性航法部の算出誤差の補正量をGPS不可視時補正量として算出し、
前記航法補正部は、GPS衛星の可視時に前記慣性航法部により算出された車両の座標値を前記GPS可視時補正量により補正することにより車両の座標値を標定し、GPS衛星の不可視時に前記慣性航法部により算出された車両の座標値を前記GPS不可視時補正量により補正することにより車両の座標値を標定する
ことを特徴とする位置標定装置。 - 前記カルマンフィルタで用いる観測ノイズ行列が、速度ベクトルの前後方向成分に対応する行と速度ベクトルの左右方向に対応する行と速度ベクトルの上下方向成分に対応する行とで値が異なる
ことを特徴とする請求項1記載の位置標定装置。 - 前記カルマンフィルタで用いる観測ノイズ行列において速度ベクトルの左右方向に対応する行の値が車両の加速度ベクトルの左右方向成分に応じて変化する
ことを特徴とする請求項1または請求項2記載の位置標定装置。 - 前記カルマンフィルタで用いる観測ノイズ行列において速度ベクトルの前後方向成分に対応する行と速度ベクトルの左右方向に対応する行と速度ベクトルの上下方向成分に対応する行とのそれぞれの値が車両の速度スカラーに応じて変化する
ことを特徴とする請求項1〜請求項3いずれかに記載の位置標定装置。 - 前記カルマンフィルタは、前記慣性装置の検出誤差の補正量を慣性誤差補正量として算出し、
前記位置標定装置は、さらに、
前記慣性装置により検出された加速度ベクトルを前記カルマンフィルタにより算出された慣性誤差補正量により補正する慣性誤差補正部を備え、
前記慣性航法部は、前記慣性誤差補正部により補正された加速度ベクトルに基づいて車両の座標値と車両の速度ベクトルとを算出する
ことを特徴とする請求項1〜請求項4いずれかに記載の位置標定装置。 - 前記観測情報生成部は、前記GPS受信機により観測値として取得された搬送波位相に基づいて搬送波位相の二重差の残差を観測情報として算出する
ことを特徴とする請求項1〜請求項5いずれかに記載の位置標定装置。 - GPS衛星(GPS:Global Positioning System)から発信される搬送波を観測するGPS受信機と加速度ベクトルを検出する慣性装置と車速値を検出する車速検出装置とが設置された車両の座標値を標定する位置標定方法において、
慣性航法部が、前記慣性装置により検出された加速度ベクトルに基づいて車両の座標値と車両の速度ベクトルとを算出し、
観測情報生成部が、GPS衛星の可視時に前記GPS受信機により取得された観測値に基づいて所定の情報を観測情報として生成し、
カルマンフィルタが、前記観測情報生成部により生成された観測情報を用いて前記慣性航法部の算出誤差の補正量をGPS可視時補正量として算出し、
航法補正部が、前記慣性航法部により算出された車両の座標値と車両の速度ベクトルとを前記カルマンフィルタにより算出されたGPS可視時補正量により補正し、
速度スカラー算出部が、前記車速検出装置により検出された車速値に基づいて車両の速度スカラーを算出し、
横滑り角算出部が、GPS衛星の可視時に前記速度スカラー算出部により算出された速度スカラーと前記航法補正部により補正された速度ベクトルの左右方向成分とに基づいて車両の横滑り角を算出し、
横滑り角蓄積部が、前記横滑り角算出部により算出された横滑り角と前記慣性装置により検出された加速度ベクトルの左右方向成分とを対応づけて蓄積し、
コーナリングパワー算出部が、前記横滑り角蓄積部に蓄積された横滑り角に基づいて車両の加速度ベクトルの左右方向成分と横滑り角との関係値をコーナリングパワーとして算出し、
速度ベクトル算出部が、GPS衛星が不可視であるGPS不可視時点に前記速度スカラー算出部により算出された速度スカラーと前記慣性装置により前記GPS不可視時点に検出された加速度ベクトルの左右方向成分と前記コーナリングパワー算出部により算出されたコーナリングパワーとに基づいて車両の速度ベクトルを算出し、
速度ベクトル残差算出部が、前記慣性航法部により前記GPS不可視時点に算出された速度ベクトルと前記速度ベクトル算出部により算出された速度ベクトルとの差を速度ベクトル残差として算出し、
前記カルマンフィルタが、前記速度ベクトル残差算出部により算出された速度ベクトル残差を用いて前記慣性航法部の算出誤差の補正量をGPS不可視時補正量として算出し、
前記航法補正部が、GPS衛星の可視時に前記慣性航法部により算出された車両の座標値を前記GPS可視時補正量により補正することにより車両の座標値を標定し、GPS衛星の不可視時に前記慣性航法部により算出された車両の座標値を前記GPS不可視時補正量により補正することにより車両の座標値を標定する
ことを特徴とする位置標定方法。 - 請求項7記載の位置標定方法をコンピュータに実行させる位置標定プログラム。
- GPS衛星(GPS:Global Positioning System)から発信される搬送波を観測するGPS受信機と加速度ベクトルを検出する慣性装置と車速値を検出する車速検出装置とが設置された車両の速度ベクトルを算出する速度ベクトル算出装置において、
GPS衛星の可視時に前記GPS受信機により取得された観測値を利用して車両の速度ベクトルを算出する第1の速度ベクトル算出部と、
前記車速検出装置により検出された車速値に基づいて車両の速度スカラーを算出する速度スカラー算出部と、
GPS衛星の可視時に前記速度スカラー算出部により算出された速度スカラーと前記第1の速度ベクトル算出部により算出された速度ベクトルの左右方向成分とに基づいて車両の横滑り角を算出する横滑り角算出部と、
前記横滑り角算出部により算出された横滑り角と前記慣性装置により検出された加速度ベクトルの左右方向成分とを対応づけて蓄積する横滑り角蓄積部と、
前記横滑り角蓄積部に蓄積された横滑り角に基づいて車両の加速度ベクトルの左右方向成分と横滑り角との関係値をコーナリングパワーとして算出するコーナリングパワー算出部と、
GPS衛星が不可視であるGPS不可視時点に前記速度スカラー算出部により算出された速度スカラーと前記慣性装置により前記GPS不可視時点に検出された加速度ベクトルの左右方向成分と前記コーナリングパワー算出部により算出されたコーナリングパワーとに基づいて車両の速度ベクトルを算出する第2の速度ベクトル算出部と
を備えることを特徴とする速度ベクトル算出装置。 - GPS衛星(GPS:Global Positioning System)から発信される搬送波を観測するGPS受信機と加速度ベクトルを検出する慣性装置と車速値を検出する車速検出装置とが設置された車両の速度ベクトルを算出する速度ベクトル算出方法において、
第1の速度ベクトル算出部が、GPS衛星の可視時に前記GPS受信機により取得された観測値を利用して車両の速度ベクトルを算出し、
速度スカラー算出部が、前記車速検出装置により検出された車速値に基づいて車両の速度スカラーを算出し、
横滑り角算出部が、GPS衛星の可視時に前記速度スカラー算出部により算出された速度スカラーと前記第1の速度ベクトル算出部により算出された速度ベクトルの左右方向成分とに基づいて車両の横滑り角を算出し、
横滑り角蓄積部が、前記横滑り角算出部により算出された横滑り角と前記慣性装置により検出された加速度ベクトルの左右方向成分とを対応づけて蓄積し、
コーナリングパワー算出部が、前記横滑り角蓄積部に蓄積された横滑り角に基づいて車両の加速度ベクトルの左右方向成分と横滑り角との関係値をコーナリングパワーとして算出し、
第2の速度ベクトル算出部が、GPS衛星が不可視であるGPS不可視時点に前記速度スカラー算出部により算出された速度スカラーと前記慣性装置により前記GPS不可視時点に検出された加速度ベクトルの左右方向成分と前記コーナリングパワー算出部により算出されたコーナリングパワーとに基づいて車両の速度ベクトルを算出する
ことを特徴とする速度ベクトル算出方法。 - 請求項10記載の速度ベクトル算出方法をコンピュータに実行させる速度ベクトル算出プログラム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009280370A JP5419665B2 (ja) | 2009-12-10 | 2009-12-10 | 位置標定装置、位置標定方法、位置標定プログラム、速度ベクトル算出装置、速度ベクトル算出方法および速度ベクトル算出プログラム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009280370A JP5419665B2 (ja) | 2009-12-10 | 2009-12-10 | 位置標定装置、位置標定方法、位置標定プログラム、速度ベクトル算出装置、速度ベクトル算出方法および速度ベクトル算出プログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2011122921A JP2011122921A (ja) | 2011-06-23 |
JP5419665B2 true JP5419665B2 (ja) | 2014-02-19 |
Family
ID=44286951
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2009280370A Active JP5419665B2 (ja) | 2009-12-10 | 2009-12-10 | 位置標定装置、位置標定方法、位置標定プログラム、速度ベクトル算出装置、速度ベクトル算出方法および速度ベクトル算出プログラム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5419665B2 (ja) |
Families Citing this family (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5602070B2 (ja) * | 2011-03-15 | 2014-10-08 | 三菱電機株式会社 | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム |
KR20130002086A (ko) * | 2011-06-28 | 2013-01-07 | 주식회사 선택인터내셔날 | 오차 보정을 통한 추측항법 시스템 및 그 방법 |
JP5455074B2 (ja) * | 2011-06-30 | 2014-03-26 | 富士重工業株式会社 | 車両用制御装置 |
KR101879821B1 (ko) * | 2011-12-28 | 2018-08-17 | 한국단자공업 주식회사 | Dr gps 모듈에서의 회전각 검출 오차 보정 방법 |
JP6008124B2 (ja) * | 2013-02-18 | 2016-10-19 | 株式会社デンソー | 車両方位検出方法および車両方位検出装置 |
GB2516066B (en) * | 2013-07-10 | 2020-07-01 | Atlantic Inertial Systems Ltd | Portable device for determining azimuth |
JP2016065769A (ja) * | 2014-09-24 | 2016-04-28 | 日立建機株式会社 | 運搬車両 |
JP6373223B2 (ja) * | 2015-04-08 | 2018-08-15 | 三菱電機株式会社 | 車両位置標定装置及び車両位置標定プログラム |
CN107918139B (zh) * | 2016-10-18 | 2021-05-11 | 郑州威科姆科技股份有限公司 | 一种角速度辅助的Kalman滤波定位方法 |
KR102622584B1 (ko) * | 2018-09-28 | 2024-01-08 | 현대오토에버 주식회사 | 차량의 위치 보정 장치 및 그 방법 |
JP7036080B2 (ja) | 2019-04-02 | 2022-03-15 | 株式会社豊田中央研究所 | 慣性航法装置 |
CN113631883B (zh) * | 2019-04-04 | 2024-04-30 | 三菱电机株式会社 | 车辆定位装置 |
CN110780326A (zh) * | 2019-09-26 | 2020-02-11 | 上海瀚所信息技术有限公司 | 一种车载组合导航系统和定位方法 |
CN110779521A (zh) * | 2019-11-12 | 2020-02-11 | 成都中科微信息技术研究院有限公司 | 一种多源融合的高精度定位方法与装置 |
CN112859132A (zh) * | 2019-11-27 | 2021-05-28 | 华为技术有限公司 | 导航的方法和装置 |
CN111795695B (zh) * | 2020-05-15 | 2022-06-03 | 阿波罗智联(北京)科技有限公司 | 位置信息确定方法、装置及设备 |
JP7420023B2 (ja) * | 2020-09-04 | 2024-01-23 | 株式会社デンソー | 慣性センサ較正装置および慣性センサ較正プログラム |
JP7491339B2 (ja) | 2022-04-22 | 2024-05-28 | 株式会社豊田中央研究所 | 位置推定装置、位置推定方法および位置推定プログラム |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080071476A1 (en) * | 2006-09-19 | 2008-03-20 | Takayuki Hoshizaki | Vehicle dynamics conditioning method on MEMS based integrated INS/GPS vehicle navigation system |
-
2009
- 2009-12-10 JP JP2009280370A patent/JP5419665B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2011122921A (ja) | 2011-06-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5419665B2 (ja) | 位置標定装置、位置標定方法、位置標定プログラム、速度ベクトル算出装置、速度ベクトル算出方法および速度ベクトル算出プログラム | |
JP5586994B2 (ja) | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム | |
JP4964047B2 (ja) | 位置検出装置及び位置検出方法 | |
CN106289275B (zh) | 用于改进定位精度的单元和方法 | |
JP4781300B2 (ja) | 位置検出装置および位置検出方法 | |
EP2664894B1 (en) | Navigation apparatus | |
JP5328252B2 (ja) | ナビゲーションシステムの位置検出装置および位置検出方法 | |
JP5602070B2 (ja) | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム | |
CN110779521A (zh) | 一种多源融合的高精度定位方法与装置 | |
EP4303630A2 (en) | Gnss and inertial navigation system utilizing relative yaw as an observable for an ins filter | |
JP6409346B2 (ja) | 移動距離推定装置 | |
JP6201762B2 (ja) | 速度推定装置 | |
JP2004239643A (ja) | ハイブリッド航法装置 | |
CN112432642B (zh) | 一种重力灯塔与惯性导航融合定位方法及系统 | |
WO2021112074A1 (ja) | 情報処理装置、制御方法、プログラム及び記憶媒体 | |
CN110914711A (zh) | 定位装置 | |
US20180172841A1 (en) | Positioning apparatus | |
JP6488860B2 (ja) | 勾配推定装置及びプログラム | |
JP2014077769A (ja) | センサ傾斜判定装置及びプログラム | |
JP2014240266A (ja) | センサドリフト量推定装置及びプログラム | |
JP5554560B2 (ja) | 測位信頼度評価装置、測位信頼度評価方法、および、測位信頼度評価プログラム | |
CN111307114A (zh) | 基于运动参考单元的水面舰船水平姿态测量方法 | |
JP7028223B2 (ja) | 自己位置推定装置 | |
JP5994237B2 (ja) | 測位装置及びプログラム | |
CN112292578B (zh) | 大地水准面测量方法、测量装置、估计装置、计算用数据采集装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20120913 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20131022 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20131119 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5419665 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |