JP2006071474A - 角速度センサの感度誤差検出装置および方法 - Google Patents
角速度センサの感度誤差検出装置および方法 Download PDFInfo
- Publication number
- JP2006071474A JP2006071474A JP2004255592A JP2004255592A JP2006071474A JP 2006071474 A JP2006071474 A JP 2006071474A JP 2004255592 A JP2004255592 A JP 2004255592A JP 2004255592 A JP2004255592 A JP 2004255592A JP 2006071474 A JP2006071474 A JP 2006071474A
- Authority
- JP
- Japan
- Prior art keywords
- azimuth
- angular velocity
- sensitivity error
- velocity sensor
- signal
- 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.)
- Granted
Links
Images
Landscapes
- Navigation (AREA)
- Gyroscopes (AREA)
Abstract
【解決手段】 角速度センサ1の出力から一定時間ごとに得られるジャイロ方位およびGPS受信機3の出力から一定時間ごとに得られるGPS方位の中から、所定の条件を満たすときに出力された方位信号の組み合わせのみを選択的に抽出する一次サンプリング部6aと、抽出した方位信号の組を用いて角速度センサ1の感度誤差を演算する感度誤差サンプル演算部6cおよび統計処理部6dとを備え、GPS誤差を含む可能性が高い方位情報は破棄し、所定の条件を満たす精度のよい方位情報だけを選んで感度誤差を求めるようにすることにより、精度の高い感度誤差を算出することができるようにする。
【選択図】 図1
Description
なお、ここでは位置・方位演算部2により一定時間ごとに求められるジャイロ方位とGPS受信機3により一定時間毎に求められるGPS方位とを全てRAM5に一旦格納し、その中から条件に合致するものを抽出する例について説明したが、これに限定されない。例えば、ジャイロ方位およびGPS方位をRAM5に格納する際に一次サンプリングを行い、条件に合致するものだけを選択的にRAM5に格納するようにしても良い。
GPS変化角度=θgpsN−θgpsi・・・(式1)
GPS変化角度が小さすぎたり大きすぎたりすると、角速度センサ1bの感度誤差が顕在化されず、当該感度誤差を演算によって正しく求めることが困難になるからである。
ジャイロ変化角度=θgyrN−θgyri・・・(式2)
さらに、感度誤差サンプルは、次の(式3)によって求める。
感度誤差サンプル=GPS変化角度/ジャイロ変化角度・・・(式3)
ここでは、ジャイロ変化角度およびGPS変化角度がそれぞれ複数求められており、それぞれについて(式3)の演算を行うことにより、複数の感度誤差サンプルを求める。
1a 距離センサ
1b 角速度センサ
2 位置・方位演算部
3 GPS受信機
4 メモリコントローラ
5 RAM(走行履歴格納部)
6 プロセッサ
6a 一次サンプリング部
6b 二次サンプリング部
6c 感度誤差サンプル演算部
6d 統計処理部
Claims (17)
- 角速度を検出し、検出した角速度を積分して相対方位信号を出力する角速度センサを含み、上記相対方位信号から第1の方位信号を求めて一定時間ごとに出力する方位センサと、
GPS衛星からの電波を受信して測位処理を行うことにより、上記方位センサと同じ一定時間ごとに第2の方位信号を出力するGPS受信機と、
上記一定時間ごとに出力される上記第1の方位信号および上記第2の方位信号の中から、第1の所定の条件を満たすときに出力された上記第1の方位信号および上記第2の方位信号を選択的に抽出する一次サンプリング手段と、
上記一次サンプリング手段によって抽出された上記第1の方位信号および上記第2の方位信号を用いて、上記角速度センサの感度誤差を演算する感度誤差演算手段とを備えたことを特徴とする角速度センサの感度誤差検出装置。 - 上記第1の所定の条件は、上記角速度センサを搭載している車両の速度がしきい値以上であることを特徴とする請求項1に記載の角速度センサの感度誤差検出装置。
- 上記第1の所定の条件は、自立航法センサにより得られるある区間の自立航法走行距離と、上記GPS受信機により得られる上記ある区間に相当する区間のGPS測位点間距離との差がしきい値以下であることを特徴とする請求項1に記載の角速度センサの感度誤差検出装置。
- 上記第1の所定の条件は、上記方位センサにより得られる上記第1の方位信号の過去一定期間における変化量がしきい値以下であることを特徴とする請求項1に記載の角速度センサの感度誤差検出装置。
- 上記第1の所定の条件は、上記角速度センサを搭載している車両の速度がしきい値以上であること、自立航法センサにより得られるある区間の自立航法走行距離と、上記GPS受信機により得られる上記ある区間に相当する区間のGPS測位点間距離との差がしきい値以下であること、および上記方位センサにより得られる上記第1の方位信号の過去一定期間における変化量がしきい値以下であることの少なくとも1つであることを特徴とする請求項1に記載の角速度センサの感度誤差検出装置。
- 上記感度誤差演算手段は、上記一次サンプリング手段によって抽出された第1の方位信号どうしの差分を表す第1の方位変化角度と、上記一次サンプリング手段によって抽出された第2の方位信号どうしの差分を表す第2の方位変化角度とから感度誤差の瞬時値である感度誤差サンプルを複数算出し、上記複数の感度誤差サンプルを統計処理することによって上記感度誤差を算出することを特徴とする請求項1に記載の角速度センサの感度誤差検出装置。
- 上記一次サンプリング手段によって抽出された第1の方位信号および第2の方位信号の中から第2の所定の条件を満たすものを選択的に抽出する二次サンプリング手段を備え、
上記感度誤差演算手段は、上記二次サンプリング手段により抽出された第1の方位信号および第2の方位信号を使って上記複数の感度誤差サンプルを算出することを特徴とする請求項6に記載の角速度センサの感度誤差検出装置。 - 上記第2の所定の条件は、上記第2の方位変化角度がしきい値以上であることを特徴とする請求項7に記載の角速度センサの感度誤差検出装置。
- 上記第2の所定の条件は、上記第1の方位変化角度および上記第2の方位変化角度を求める際に対象とする一次サンプルの時間差がしきい値以下であることを特徴とする請求項7に記載の角速度センサの感度誤差検出装置。
- 上記第2の所定の条件は、上記第2の方位変化角度がしきい値以下であること、および上記第1の方位変化角度および上記第2の方位変化角度を求める際に対象とする一次サンプルの時間差がしきい値以下であることの少なくとも1つであることを特徴とする請求項7に記載の角速度センサの感度誤差検出装置。
- 角速度を検出し、検出した角速度を積分して相対方位信号を出力する角速度センサを含み、上記相対方位信号から第1の方位信号を求めて一定時間ごとに出力する方位センサと、
GPS衛星からの電波を受信して測位処理を行うことにより、上記方位センサと同じ一定時間ごとに第2の方位信号を出力するGPS受信機と、
上記方位センサから一定時間ごとに出力される上記第1の方位信号および上記GPS受信機から一定時間ごとに出力される上記第2の方位信号の中から所定の条件を満たすものを選択的に抽出するサンプリング手段と、
上記サンプリング手段により抽出された上記第1の方位信号どうしの差分を表す第1の方位変化角度と、上記サンプリング手段により抽出された上記第2の方位信号どうしの差分を表す第2の方位変化角度とから感度誤差の瞬時値である感度誤差サンプルを複数算出する感度誤差サンプル演算手段と、
上記感度誤差サンプル演算手段によって算出された複数の感度誤差サンプルを統計処理することによって、上記角速度センサの感度誤差を算出する統計処理手段とを備えたことを特徴とする角速度センサの感度誤差検出装置。 - 上記所定の条件は、上記第2の方位変化角度がしきい値以下であることを特徴とする請求項11に記載の角速度センサの感度誤差検出装置。
- 上記所定の条件は、上記第1の方位変化角度および上記第2の方位変化角度を求める際に対象とする一次サンプルの時間差がしきい値以下であることを特徴とする請求項11に記載の角速度センサの感度誤差検出装置。
- 上記所定の条件は、上記第2の方位変化角度がしきい値以下であること、および上記第1の方位変化角度および上記第2の方位変化角度を求める際に対象とする一次サンプルの時間差がしきい値以下であることの少なくとも1つであることを特徴とする請求項11に記載の角速度センサの感度誤差検出装置。
- 角速度センサによって角速度を検出し、検出した角速度を積分して相対方位信号を出力し、上記相対方位信号から更に第1の方位信号を求めて一定時間ごとに出力するとともに、GPS受信機によってGPS衛星からの電波を受信して測位処理を行うことにより、上記角速度センサと同じ一定時間ごとに第2の方位信号を出力する第1のステップと、
上記一定時間ごとに出力される上記第1の方位信号および上記第2の方位信号の中から、第1の所定の条件を満たすときに出力された上記第1の方位信号および上記第2の方位信号を選択的に抽出する第2のステップと、
上記第2のステップで抽出された上記第1の方位信号および上記第2の方位信号を用いて、上記角速度センサの感度誤差を演算する第3のステップとを有することを特徴とする角速度センサの感度誤差検出方法。 - 上記第3のステップは、上記第2のステップで抽出された第1の方位信号および第2の方位信号の中から第2の所定の条件を満たすものを選択的に抽出する第4のステップと、
上記第4のステップで抽出された第1の方位信号どうしの差分を表す第1の方位変化角度と、上記第4のステップで抽出された第2の方位信号どうしの差分を表す第2の方位変化角度とから感度誤差の瞬時値である感度誤差サンプルを複数算出する第5のステップと、
上記第5のステップで抽出された複数の感度誤差サンプルを統計処理することによって上記感度誤差を算出する第6のステップとから成ることを特徴とする請求項15に記載の角速度センサの感度誤差検出方法。 - 角速度センサによって角速度を検出し、検出した角速度を積分して相対方位信号を出力し、上記相対方位信号から更に第1の方位信号を求めて一定時間ごとに出力するとともに、GPS受信機によってGPS衛星からの電波を受信して測位処理を行うことにより、上記角速度センサと同じ一定時間ごとに第2の方位信号を出力する第1のステップと、
上記一定時間ごとに出力される上記第1の方位信号および上記第2の方位信号の中から所定の条件を満たすものを選択的に抽出する第2のステップと、
上記第2のステップで抽出された上記第1の方位信号どうしの差分を表す第1の方位変化角度と、上記第2のステップで抽出された上記第2の方位信号どうしの差分を表す第2の方位変化角度とから感度誤差の瞬時値である感度誤差サンプルを複数算出する第3のステップと、
上記第3のステップで抽出された複数の感度誤差サンプルを統計処理することによって、上記角速度センサの感度誤差を算出する第4のステップとを有することを特徴とする角速度センサの感度誤差検出方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004255592A JP4454442B2 (ja) | 2004-09-02 | 2004-09-02 | 角速度センサの感度誤差検出装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004255592A JP4454442B2 (ja) | 2004-09-02 | 2004-09-02 | 角速度センサの感度誤差検出装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2006071474A true JP2006071474A (ja) | 2006-03-16 |
JP4454442B2 JP4454442B2 (ja) | 2010-04-21 |
Family
ID=36152266
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004255592A Active JP4454442B2 (ja) | 2004-09-02 | 2004-09-02 | 角速度センサの感度誤差検出装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4454442B2 (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009139227A (ja) * | 2007-12-06 | 2009-06-25 | Alpine Electronics Inc | 角速度補正装置及びその補正方法並びにナビゲーション装置 |
WO2009107424A1 (ja) * | 2008-02-29 | 2009-09-03 | 古野電気株式会社 | 衛星航法/推測航法統合測位装置 |
WO2014125769A1 (ja) * | 2013-02-18 | 2014-08-21 | 株式会社デンソー | 車両方位検出方法および車両方位検出装置 |
-
2004
- 2004-09-02 JP JP2004255592A patent/JP4454442B2/ja active Active
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009139227A (ja) * | 2007-12-06 | 2009-06-25 | Alpine Electronics Inc | 角速度補正装置及びその補正方法並びにナビゲーション装置 |
US8185308B2 (en) | 2007-12-06 | 2012-05-22 | Alpine Electronics Inc. | Angular velocity correcting device, angular velocity correcting method, and navigation device |
WO2009107424A1 (ja) * | 2008-02-29 | 2009-09-03 | 古野電気株式会社 | 衛星航法/推測航法統合測位装置 |
US8965690B2 (en) | 2008-02-29 | 2015-02-24 | Furuno Electrics Co., Ltd. | Satellite navigation/dead-reckoning navigation integrated positioning device |
WO2014125769A1 (ja) * | 2013-02-18 | 2014-08-21 | 株式会社デンソー | 車両方位検出方法および車両方位検出装置 |
JP2014157113A (ja) * | 2013-02-18 | 2014-08-28 | Denso Corp | 車両方位検出方法および車両方位検出装置 |
US9638529B2 (en) | 2013-02-18 | 2017-05-02 | Denso Corporation | Vehicle orientation detection method and vehicle orientation detection apparatus |
Also Published As
Publication number | Publication date |
---|---|
JP4454442B2 (ja) | 2010-04-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8185308B2 (en) | Angular velocity correcting device, angular velocity correcting method, and navigation device | |
JP4466705B2 (ja) | ナビゲーション装置 | |
US7337062B2 (en) | Walker navigation device and program | |
US8200424B2 (en) | Navigation device | |
US6253154B1 (en) | Method and apparatus for navigating with correction of angular speed using azimuth detection sensor | |
JP4776570B2 (ja) | ナビゲーション装置、傾斜角を用いた角速度補正装置および方法 | |
US20090063051A1 (en) | Method And Apparatus Of Updating Vehicle Position And Orientation | |
JPH0518774A (ja) | 車両位置方位算出装置 | |
JP2007033368A (ja) | ナビゲーション装置 | |
JP2007155471A (ja) | 車両位置推定装置及び車両位置推定方法 | |
JP2015083930A (ja) | ナビゲーション装置および高架上下道判定方法 | |
JP2009025012A (ja) | 加速度センサオフセット補正装置および方法 | |
JP4931113B2 (ja) | 自車位置決定装置 | |
JPH10185600A (ja) | 車両位置補正装置 | |
JP4376738B2 (ja) | 角速度センサのゼロ点誤差検出装置および方法 | |
JP4454442B2 (ja) | 角速度センサの感度誤差検出装置 | |
JP2004354160A (ja) | 移動体角速度検出装置 | |
JP2577160B2 (ja) | 車両位置検出装置 | |
KR100586894B1 (ko) | 차량의 정지상태 판단방법과 이를 이용한 차량 항법정보생성방법 및 차량항법장치 | |
JP2008249614A (ja) | 車載ナビゲーション装置、ナビゲーションシステム及びコンピュータプログラム | |
JP3210483B2 (ja) | 車両位置修正方式 | |
JPH05312933A (ja) | ナビゲーション方式 | |
KR100341801B1 (ko) | 다중안테나를이용한도시형차량항법시스템 | |
JP2001264091A (ja) | ナビゲーション装置 | |
US8413931B2 (en) | System and method for reducing attitude errors for exoatmospheric devices |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20070227 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090519 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20090521 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090713 |
|
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: 20100202 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20100202 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130212 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4454442 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130212 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140212 Year of fee payment: 4 |