JP2008216226A - ナビゲーション装置、傾斜角を用いた角速度補正装置および方法 - Google Patents
ナビゲーション装置、傾斜角を用いた角速度補正装置および方法 Download PDFInfo
- Publication number
- JP2008216226A JP2008216226A JP2007058131A JP2007058131A JP2008216226A JP 2008216226 A JP2008216226 A JP 2008216226A JP 2007058131 A JP2007058131 A JP 2007058131A JP 2007058131 A JP2007058131 A JP 2007058131A JP 2008216226 A JP2008216226 A JP 2008216226A
- Authority
- JP
- Japan
- Prior art keywords
- sensor
- inclination angle
- tilt angle
- gps
- acceleration
- 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
Landscapes
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
【解決手段】加速度傾斜角θaccおよびGPS傾斜角θgpsからセンサ傾斜角θsensorと車両傾斜角θcarとを算出し、この2つの傾斜角θsensor,θcarに基づいて角速度ωgyroを補正することにより、車両が傾いているときでも、角速度センサ4の感度補正と同時に加速度センサ1のゼロ点補正を行うことができるようにする。また、このように同じ演算の中で角速度センサ4の感度補正と加速度センサ1のゼロ点補正とを行うことにより、簡単なアルゴリズムで感度補正とゼロ点補正を行うことができるようにする。
【選択図】 図2
Description
また、本発明は、車両の傾きが存在し、GPS電波を受信できない環境においても、簡単なアルゴリズムで感度補正とゼロ点補正を行うことができ、それによって自律航法精度を向上させることができるようにすることを目的とする。
1.GPS速度Vgpsが10km/h以上であること
2.算出したGPS傾斜角θgpsの絶対値が10度以下であること
3.算出したGPS傾斜角θgpsの標準偏差が3度以下であること
2 車速センサ
3 GPS受信機
4 角速度センサ
11 加速度傾斜角算出部
12 GPS傾斜角算出部
13 センサ傾斜角算出部
14 車両傾斜角算出部
15 角速度補正部
16 走行距離補正部
21 加速度傾斜角信頼性判定部
22 GPS傾斜角信頼性判定部
23 センサ傾斜角記憶部
24 センサ傾斜角信頼性判定部
25 車両傾斜角信頼性判定部
Claims (19)
- GPS受信機と角速度センサと加速度センサと車速センサとを備え、これらの出力値を用いて車両の位置および方位を検出する機能を備えたナビゲーション装置であって、上記角速度センサと上記加速度センサとが同じ傾斜角で車両内に設置されており、
上記加速度センサより出力される加速度、上記車速センサより出力される車速の変化量から求められる加速度および重力加速度に基づいて、水平方向に対する上記加速度センサの傾斜角を表した加速度傾斜角を算出する加速度傾斜角算出部と、
上記GPS受信機で複数のGPS衛星から受信する電波のドップラー効果による周波数の変化に基づいて、水平方向に対する車両の傾斜角を表したGPS傾斜角を算出するGPS傾斜角算出部と、
上記加速度傾斜角および上記GPS傾斜角に基づいて、上記車両の走行方向に対する上記角速度センサの傾斜角を表したセンサ傾斜角を算出するセンサ傾斜角算出部と、
上記加速度傾斜角および上記センサ傾斜角に基づいて、水平方向に対する上記車両の傾斜角を表した車両傾斜角を算出する車両傾斜角算出部と、
上記センサ傾斜角および上記車両傾斜角に基づいて、上記角速度センサより出力される角速度を補正する角速度補正部とを備えたことを特徴とするナビゲーション装置。 - 上記車両傾斜角に基づいて、上記車速センサの出力値から計算される車両の走行距離を補正する走行距離補正部を更に備えたことを特徴とする請求項1に記載のナビゲーション装置。
- 上記車速センサより出力される車速に基づいて、上記加速度傾斜角算出部により算出される上記加速度傾斜角の信頼性を判定する加速度傾斜角信頼性判定部を備え、
上記加速度傾斜角算出部は、上記加速度傾斜角信頼性判定部により信頼性ありと判定されたときに、上記加速度傾斜角を算出することを特徴とする請求項1に記載のナビゲーション装置。 - 上記GPS受信機による電波の受信の受信状態に基づいて、上記GPS傾斜角算出部により算出される上記GPS傾斜角の信頼性を判定するGPS傾斜角信頼性判定部を備え、
上記GPS傾斜角算出部は、上記GPS傾斜角信頼性判定部により信頼性ありと判定されたときに、上記GPS傾斜角を算出することを特徴とする請求項1に記載のナビゲーション装置。 - 上記GPS受信機で複数のGPS衛星から受信する電波のドップラー効果による周波数の変化から計算した上記車両の速度に基づいて、上記GPS傾斜角算出部により算出される上記GPS傾斜角の信頼性を判定するGPS傾斜角信頼性判定部を備え、
上記センサ傾斜角算出部は、上記GPS傾斜角信頼性判定部により信頼性ありと判定されたときに、上記センサ傾斜角を算出することを特徴とする請求項1に記載のナビゲーション装置。 - 上記GPS傾斜角が所定値以下か否かで上記GPS傾斜角の信頼性を判定するGPS傾斜角信頼性判定部を備え、
上記センサ傾斜角算出部は、上記GPS傾斜角信頼性判定部により信頼性ありと判定されたときに、上記センサ傾斜角を算出することを特徴とする請求項1に記載のナビゲーション装置。 - 上記GPS傾斜角の標準偏差が所定値以下か否かで上記GPS傾斜角の信頼性を判定するGPS傾斜角信頼性判定部を備え、
上記センサ傾斜角算出部は、上記GPS傾斜角信頼性判定部により信頼性ありと判定されたときに、上記センサ傾斜角を算出することを特徴とする請求項1に記載のナビゲーション装置。 - 上記車速センサより出力される車速に基づいて、上記加速度傾斜角算出部により算出される上記加速度傾斜角の信頼性を判定する加速度傾斜角信頼性判定部を備え、
上記センサ傾斜角算出部は、上記加速度傾斜角信頼性判定部により信頼性ありと判定され、かつ、上記GPS傾斜角信頼性判定部により信頼性ありと判定されたときに、上記センサ傾斜角を算出することを特徴とする請求項4〜7の何れか1項に記載のナビゲーション装置。 - 上記センサ傾斜角算出部により算出された上記センサ傾斜角を記憶しておくセンサ傾斜角記憶部を備え、
上記センサ傾斜角算出部は、上記GPS傾斜角信頼性判定部により信頼性なしと判定され、かつ、上記センサ傾斜角記憶部に上記センサ傾斜角の過去の算出値が記憶されているときに、上記センサ傾斜角記憶部に記憶されている上記センサ傾斜角を出力することを特徴とする請求項8に記載のナビゲーション装置。 - 上記センサ傾斜角算出部により算出された上記センサ傾斜角を記憶しておくセンサ傾斜角記憶部を備え、
上記センサ傾斜角算出部は、上記加速度傾斜角信頼性判定部および上記GPS傾斜角信頼性判定部の少なくとも一方により信頼性なしと判定され、かつ、上記センサ傾斜角記憶部に上記センサ傾斜角の過去の算出値が記憶されているときに、上記センサ傾斜角記憶部に記憶されている上記センサ傾斜角を出力することを特徴とする請求項8に記載のナビゲーション装置。 - 上記センサ傾斜角算出部より上記センサ傾斜角が出力されたか否かで上記センサ傾斜角の信頼性を判定するセンサ傾斜角信頼性判定部を備え、
上記車両傾斜角算出部は、上記センサ傾斜角信頼性判定部により信頼性ありと判定されたときに、上記車両傾斜角を算出することを特徴とする請求項9または10に記載のナビゲーション装置。 - 上記車両傾斜角算出部は、上記加速度傾斜角信頼性判定部により信頼性ありと判定され、かつ、上記センサ傾斜角信頼性判定部により信頼性ありと判定されたときに、上記車両傾斜角を算出することを特徴とする請求項11に記載のナビゲーション装置。
- 上記車両傾斜角算出部より上記車両傾斜角が算出されたか否かで上記車両傾斜角の信頼性を判定する車両傾斜角信頼性判定部を備え、
上記角速度補正部は、上記センサ傾斜角信頼性判定部により信頼性ありと判定され、かつ、上記車両傾斜角信頼性判定部により信頼性ありと判定されたときに、上記センサ傾斜角および上記車両傾斜角に基づいて、上記角速度センサより出力される角速度を補正することを特徴とする請求項11に記載のナビゲーション装置。 - 上記角速度補正部は、上記センサ傾斜角信頼性判定部により信頼性ありと判定され、かつ、上記車両傾斜角信頼性判定部により信頼性なしと判定されたときに、上記センサ傾斜角に基づいて、上記角速度センサより出力される角速度を補正することを特徴とする請求項11に記載のナビゲーション装置。
- 加速度センサより出力される加速度、車速センサより出力される車速の変化量から求められる加速度および重力加速度に基づいて、水平方向に対する上記加速度センサの傾斜角を表した加速度傾斜角を算出する加速度傾斜角算出部と、
GPS受信機で複数のGPS衛星から受信する電波のドップラー効果による周波数の変化に基づいて、水平方向に対する車両の傾斜角を表したGPS傾斜角を算出するGPS傾斜角算出部と、
上記加速度傾斜角および上記GPS傾斜角に基づいて、上記加速度センサと同じ傾斜角で車両内に設置された角速度センサの、上記車両の走行方向に対する傾斜角を表したセンサ傾斜角を算出するセンサ傾斜角算出部と、
上記加速度傾斜角および上記センサ傾斜角に基づいて、水平方向に対する上記車両の傾斜角を表した車両傾斜角を算出する車両傾斜角算出部と、
上記センサ傾斜角および上記車両傾斜角に基づいて、上記角速度センサより出力される角速度を補正する角速度補正部とを備えたことを特徴とする傾斜角を用いた角速度補正装置。 - 上記センサ傾斜角算出部により算出された上記センサ傾斜角を記憶しておくセンサ傾斜角記憶部と、
上記GPS傾斜角算出部により算出される上記GPS傾斜角の信頼性を判定するGPS傾斜角信頼性判定部とを備え、
上記センサ傾斜角算出部は、上記GPS傾斜角信頼性判定部により信頼性なしと判定され、かつ、上記センサ傾斜角記憶部に上記センサ傾斜角の過去の算出値が記憶されているときに、上記センサ傾斜角記憶部に記憶されている上記センサ傾斜角を出力することを特徴とする請求項15に記載の傾斜角を用いた角速度補正装置。 - 上記センサ傾斜角算出部により算出された上記センサ傾斜角を記憶しておくセンサ傾斜角記憶部と、
上記加速度傾斜角算出部により算出される上記加速度傾斜角の信頼性を判定する加速度傾斜角信頼性判定部と、
上記GPS傾斜角算出部により算出される上記GPS傾斜角の信頼性を判定するGPS傾斜角信頼性判定部とを備え、
上記センサ傾斜角算出部は、上記加速度傾斜角信頼性判定部および上記GPS傾斜角信頼性判定部の少なくとも一方により信頼性なしと判定され、かつ、上記センサ傾斜角記憶部に上記センサ傾斜角の過去の算出値が記憶されているときに、上記センサ傾斜角記憶部に記憶されている上記センサ傾斜角を出力することを特徴とする請求項15に記載の傾斜角を用いた角速度補正装置。 - 加速度センサより出力される加速度、車速センサより出力される車速の変化量から求められる加速度および重力加速度に基づいて、水平方向に対する上記加速度センサの傾斜角を表した加速度傾斜角を算出する第1のステップと、
GPS受信機で複数のGPS衛星から受信する電波のドップラー効果による周波数の変化に基づいて、水平方向に対する車両の傾斜角を表したGPS傾斜角を算出する第2のステップと、
上記加速度傾斜角および上記GPS傾斜角に基づいて、上記加速度センサと同じ傾斜角で車両内に設置された角速度センサの、上記車両の走行方向に対する傾斜角を表したセンサ傾斜角を算出する第3のステップと、
上記加速度傾斜角および上記センサ傾斜角に基づいて、水平方向に対する上記車両の傾斜角を表した車両傾斜角を算出する第4のステップと、
上記上記センサ傾斜角および上記車両傾斜角に基づいて、上記角速度センサより出力される角速度を補正する第5のステップとを有することを特徴とする傾斜角を用いた角速度補正方法。 - 上記第3のステップは、上記第1のステップで算出される上記加速度傾斜角の信頼性を判定する第6のステップと、
上記第2のステップで算出される上記GPS傾斜角の信頼性を判定する第7のステップと、
上記加速度傾斜角および上記GPS傾斜角の双方とも信頼性ありと判定されたときに、上記センサ傾斜角を算出する第8のステップと、
上記第8のステップで計算された上記センサ傾斜角をセンサ傾斜角記憶部に記憶する第9のステップと、
上記加速度傾斜角および上記GPS傾斜角の少なくとも一方について信頼性なしと判定され、かつ、上記センサ傾斜角記憶部に上記センサ傾斜角の過去の算出値が記憶されているときに、上記センサ傾斜角記憶部に記憶されている上記センサ傾斜角を出力する第10のステップとを有することを特徴とする請求項18に記載の傾斜角を用いた角速度補正方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007058131A JP4776570B2 (ja) | 2007-03-08 | 2007-03-08 | ナビゲーション装置、傾斜角を用いた角速度補正装置および方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007058131A JP4776570B2 (ja) | 2007-03-08 | 2007-03-08 | ナビゲーション装置、傾斜角を用いた角速度補正装置および方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2008216226A true JP2008216226A (ja) | 2008-09-18 |
JP4776570B2 JP4776570B2 (ja) | 2011-09-21 |
Family
ID=39836417
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007058131A Active JP4776570B2 (ja) | 2007-03-08 | 2007-03-08 | ナビゲーション装置、傾斜角を用いた角速度補正装置および方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4776570B2 (ja) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011003003A (ja) * | 2009-06-18 | 2011-01-06 | Mitsubishi Motors Corp | 運転支援装置 |
US8185308B2 (en) | 2007-12-06 | 2012-05-22 | Alpine Electronics Inc. | Angular velocity correcting device, angular velocity correcting method, and navigation device |
JP2013044562A (ja) * | 2011-08-22 | 2013-03-04 | Ono Sokki Co Ltd | 路面勾配算出装置及び方法 |
JP2013540325A (ja) * | 2010-10-11 | 2013-10-31 | ゼネラル・エレクトリック・カンパニイ | 不規則なセンサ信号ノイズを検出するためのシステム、方法、及び装置 |
US8744643B2 (en) | 2009-05-18 | 2014-06-03 | Toyota Jidosha Kabushiki Kaisha | Vehicle controller |
US9151786B2 (en) | 2010-10-11 | 2015-10-06 | General Electric Company | Systems, methods, and apparatus for detecting shifts in redundant sensor signals |
KR20150120868A (ko) * | 2014-04-18 | 2015-10-28 | 이세키노우키가부시키가이샤 | 작업 정보 기록 장치 |
JP2018048985A (ja) * | 2016-09-23 | 2018-03-29 | 株式会社Jvcケンウッド | 取付角算出装置、取付角評価装置、取付角算出方法および取付角評価方法 |
JP2019219396A (ja) * | 2018-06-18 | 2019-12-26 | バイドゥ ユーエスエイ エルエルシーBaidu USA LLC | 自動運転車両におけるセンサー故障を処理するための方法 |
CN114802054A (zh) * | 2022-04-25 | 2022-07-29 | 九江精密测试技术研究所 | 一种应用于车载高精度线速度激励装置的控制*** |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5606656B2 (ja) | 2012-06-27 | 2014-10-15 | 三菱電機株式会社 | 測位装置 |
WO2014002211A1 (ja) | 2012-06-27 | 2014-01-03 | 三菱電機株式会社 | 測位装置 |
KR20180061686A (ko) | 2016-11-30 | 2018-06-08 | 삼성전자주식회사 | 자율 주행 경로 생성 방법 및 그 장치 |
-
2007
- 2007-03-08 JP JP2007058131A patent/JP4776570B2/ja active Active
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8185308B2 (en) | 2007-12-06 | 2012-05-22 | Alpine Electronics Inc. | Angular velocity correcting device, angular velocity correcting method, and navigation device |
US8744643B2 (en) | 2009-05-18 | 2014-06-03 | Toyota Jidosha Kabushiki Kaisha | Vehicle controller |
JP2011003003A (ja) * | 2009-06-18 | 2011-01-06 | Mitsubishi Motors Corp | 運転支援装置 |
JP2013540325A (ja) * | 2010-10-11 | 2013-10-31 | ゼネラル・エレクトリック・カンパニイ | 不規則なセンサ信号ノイズを検出するためのシステム、方法、及び装置 |
US9151786B2 (en) | 2010-10-11 | 2015-10-06 | General Electric Company | Systems, methods, and apparatus for detecting shifts in redundant sensor signals |
JP2013044562A (ja) * | 2011-08-22 | 2013-03-04 | Ono Sokki Co Ltd | 路面勾配算出装置及び方法 |
KR101672771B1 (ko) * | 2014-04-18 | 2016-11-04 | 이세키노우키가부시키가이샤 | 작업 정보 기록 장치 |
JP2015207098A (ja) * | 2014-04-18 | 2015-11-19 | 井関農機株式会社 | 作業情報記録装置 |
KR20150120868A (ko) * | 2014-04-18 | 2015-10-28 | 이세키노우키가부시키가이샤 | 작업 정보 기록 장치 |
JP2018048985A (ja) * | 2016-09-23 | 2018-03-29 | 株式会社Jvcケンウッド | 取付角算出装置、取付角評価装置、取付角算出方法および取付角評価方法 |
JP2019219396A (ja) * | 2018-06-18 | 2019-12-26 | バイドゥ ユーエスエイ エルエルシーBaidu USA LLC | 自動運転車両におけるセンサー故障を処理するための方法 |
CN110667598A (zh) * | 2018-06-18 | 2020-01-10 | 百度(美国)有限责任公司 | 用于处理自动驾驶车辆中的传感器故障的方法 |
US11427211B2 (en) | 2018-06-18 | 2022-08-30 | Baidu Usa Llc | Methods for handling sensor failures in autonomous driving vehicles |
CN110667598B (zh) * | 2018-06-18 | 2023-03-24 | 百度(美国)有限责任公司 | 用于处理自动驾驶车辆中的传感器故障的方法 |
CN114802054A (zh) * | 2022-04-25 | 2022-07-29 | 九江精密测试技术研究所 | 一种应用于车载高精度线速度激励装置的控制*** |
CN114802054B (zh) * | 2022-04-25 | 2023-06-13 | 九江精密测试技术研究所 | 一种应用于车载高精度线速度激励装置的控制*** |
Also Published As
Publication number | Publication date |
---|---|
JP4776570B2 (ja) | 2011-09-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4776570B2 (ja) | ナビゲーション装置、傾斜角を用いた角速度補正装置および方法 | |
JP5057952B2 (ja) | 角速度補正装置及びその補正方法並びにナビゲーション装置 | |
JP4466705B2 (ja) | ナビゲーション装置 | |
JP4781096B2 (ja) | 車両位置推定装置及び車両位置推定方法 | |
JP4889272B2 (ja) | ナビゲーション装置及び車両位置推定方法 | |
US20090063051A1 (en) | Method And Apparatus Of Updating Vehicle Position And Orientation | |
JP2009025012A (ja) | 加速度センサオフセット補正装置および方法 | |
JPH0518774A (ja) | 車両位置方位算出装置 | |
JP2011013204A (ja) | ナビゲーション地図に基づく誤差修正機能を備えた慣性ナビゲーションシステム | |
JP4931113B2 (ja) | 自車位置決定装置 | |
JP3868416B2 (ja) | 角速度補正装置 | |
JP4063149B2 (ja) | 車両角速度検出装置 | |
JP4848931B2 (ja) | 角速度センサの信号補正装置 | |
JP2001194169A (ja) | 車両姿勢角度検出装置 | |
JP4376738B2 (ja) | 角速度センサのゼロ点誤差検出装置および方法 | |
US20110126647A1 (en) | Rate of turn signal generator with drift compensation | |
JP2577160B2 (ja) | 車両位置検出装置 | |
JP2006153714A (ja) | カーナビゲーション装置のマップマッチング方法およびカーナビゲーション装置 | |
JP2008014810A (ja) | 移動軌跡算出方法、移動軌跡算出装置及び地図データ生成方法 | |
JP2008032598A (ja) | 標高検出装置および自車位置判定装置 | |
JP2001264091A (ja) | ナビゲーション装置 | |
JP3251705B2 (ja) | 車両位置修正方式 | |
JP2011112591A (ja) | 移動体搭載用機器 | |
JP3210483B2 (ja) | 車両位置修正方式 | |
JP3104457U (ja) | Gpsによる測位異常検出装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20090929 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20101126 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20110601 |
|
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: 20110628 |
|
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: 20110628 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 4776570 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140708 Year of fee payment: 3 |