JP2021018112A - 自己位置推定装置 - Google Patents
自己位置推定装置 Download PDFInfo
- Publication number
- JP2021018112A JP2021018112A JP2019132950A JP2019132950A JP2021018112A JP 2021018112 A JP2021018112 A JP 2021018112A JP 2019132950 A JP2019132950 A JP 2019132950A JP 2019132950 A JP2019132950 A JP 2019132950A JP 2021018112 A JP2021018112 A JP 2021018112A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- value
- unit
- observed
- sensor
- 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)
- Position Fixing By Use Of Radio Waves (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
Description
12 入力装置
14 演算装置
16 表示装置
18 記憶装置
20 画像情報処理部
22 撮像装置
24 車速センサ
28 操舵角センサ
30 GPS
32 LIDAR
34 V2X通信部
42 事前推定部
44 センサ異常判定部
46 フィルタリング部
48 更新部
200 車両
202 後輪車軸中心
210 前輪車軸中心
220 目標経路
Claims (5)
- 車両の位置推定に必要な観測量を検出して出力する複数の各々異なる検出部と、
前記車両の位置を含む状態量の予測値を算出し、前記状態量の予測値に基づいて、前記複数の検出部の各々が検出した観測量の予測値を算出する事前推定部と、
前記複数の検出部の各々について、前記検出部が新たに検出して出力した観測量と前記事前推定部が算出した観測量の予測値とに基づいて、異常値を出力する検出部であるか否かを識別する異常識別部と、
前記異常識別部で異常値を出力する検出部でないと識別された前記検出部の各々によって検出して出力した前記観測量と、前記事前推定部が算出した前記検出部の各々の前記観測量の予測値との差分に基づいて、前記事前推定部によって算出した前記状態量の予測値を補正する位置推定部と、
を含む自己位置推定装置。 - 前記事前推定部は、更に、前記状態量の誤差の広がりを算出し、前記状態量の誤差の広がりに基づいて前記複数の検出部の各々が検出する観測量の誤差の広がりを算出し、
前記異常識別部は、前記複数の検出部の各々について、前記検出部が新たに検出して出力した観測量と、前記事前推定部が算出した観測量の予測値と、前記検出部が検出する前記観測量の誤差の広がりとに基づいて、異常値を出力する検出部であるか否かを識別する請求項1に記載の自己位置推定装置。 - 所定時間前から現在までの、異常値を出力する検出部でないと識別された前記複数の検出部の各々についての、前記補正された前記状態量の予測値から観測方程式を用いて計算される前記観測量と、前記検出部が新たに検出して出力した観測量との誤差に基づいて、観測方程式の誤差の広がりを更新する更新部をさらに備え、
前記位置推定部は、観測方程式の誤差の広がりを更に用いて、前記事前推定部によって算出した前記状態量の予測値を補正する請求項1又は2に記載の自己位置推定装置。 - 前記異常識別部は、更に、異常値を出力する検出部でないと識別された前記検出部の各々によって検出して出力した前記観測量からなる観測値を構成し、
異常値を出力する検出部でないと識別された前記検出部の各々の前記観測量の予測値からなる観測値の予測値を構成し、
異常値を出力する検出部でないと識別された前記検出部の各々が検出する前記観測量の誤差の広がりからなる観測量の誤差共分散行列を構成し、
異常値を出力する検出部でないと識別された前記検出部の各々が検出する前記観測量と、前記状態量との共分散からなる、状態量と観測量との共分散行列を構成し、
前記位置推定部は、前記構成された前記観測量の誤差共分散行列、及び前記状態量と観測量との共分散行列に基づいて、ゲインを計算し、
前記ゲイン、及び前記構成された前記観測値と前記観測値の予測値との差分に基づいて、前記状態量の予測値を補正する請求項1又は2記載の自己位置推定装置。 - 前記検出部は、走行時の車両の挙動を示す角速度及び加速度、前記車両の前後速度、前記車両の操舵角、車両周辺に照射した電磁波の反射に基づいて前記車両の周辺の情報、前記車両の周辺の画像情報、並びに衛星から測位に係る情報を各々取得し、
前記位置推定部は、前記検出部で取得した各々の情報のいずれかに基づいて測位する請求項1〜4のいずれか1項に記載の自己位置推定装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019132950A JP7028223B2 (ja) | 2019-07-18 | 2019-07-18 | 自己位置推定装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019132950A JP7028223B2 (ja) | 2019-07-18 | 2019-07-18 | 自己位置推定装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2021018112A true JP2021018112A (ja) | 2021-02-15 |
JP7028223B2 JP7028223B2 (ja) | 2022-03-02 |
Family
ID=74564209
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019132950A Active JP7028223B2 (ja) | 2019-07-18 | 2019-07-18 | 自己位置推定装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7028223B2 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115792796A (zh) * | 2023-02-13 | 2023-03-14 | 鹏城实验室 | 基于相对观测等效模型的协同定位方法、装置及终端 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001245335A (ja) * | 2000-02-28 | 2001-09-07 | Nippon Telegr & Teleph Corp <Ntt> | 位置検出システム |
JP2014228495A (ja) * | 2013-05-24 | 2014-12-08 | 株式会社Ihi | 自己位置推定装置及び方法 |
JP2019082328A (ja) * | 2016-02-16 | 2019-05-30 | 株式会社日立製作所 | 位置推定装置 |
-
2019
- 2019-07-18 JP JP2019132950A patent/JP7028223B2/ja active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001245335A (ja) * | 2000-02-28 | 2001-09-07 | Nippon Telegr & Teleph Corp <Ntt> | 位置検出システム |
JP2014228495A (ja) * | 2013-05-24 | 2014-12-08 | 株式会社Ihi | 自己位置推定装置及び方法 |
JP2019082328A (ja) * | 2016-02-16 | 2019-05-30 | 株式会社日立製作所 | 位置推定装置 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115792796A (zh) * | 2023-02-13 | 2023-03-14 | 鹏城实验室 | 基于相对观测等效模型的协同定位方法、装置及终端 |
Also Published As
Publication number | Publication date |
---|---|
JP7028223B2 (ja) | 2022-03-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106289275B (zh) | 用于改进定位精度的单元和方法 | |
US9183463B2 (en) | Orientation model for a sensor system | |
US9753144B1 (en) | Bias and misalignment compensation for 6-DOF IMU using GNSS/INS data | |
JP4964047B2 (ja) | 位置検出装置及び位置検出方法 | |
US9645250B2 (en) | Fail operational vehicle speed estimation through data fusion of 6-DOF IMU, GPS, and radar | |
JP4781300B2 (ja) | 位置検出装置および位置検出方法 | |
JP5419665B2 (ja) | 位置標定装置、位置標定方法、位置標定プログラム、速度ベクトル算出装置、速度ベクトル算出方法および速度ベクトル算出プログラム | |
KR102432116B1 (ko) | 항법 시스템 | |
JP7036080B2 (ja) | 慣性航法装置 | |
US20100007550A1 (en) | Positioning apparatus for a mobile object | |
CN110031019B (zh) | 一种用于自动驾驶车辆的打滑检测处理方法 | |
JP5586994B2 (ja) | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム | |
KR102441073B1 (ko) | 자이로 센싱값 보상 장치, 그를 포함한 시스템 및 그 방법 | |
CN107076559B (zh) | 用于匹配导航系统的方法和系统 | |
CN114167470A (zh) | 一种数据处理方法和装置 | |
JP5164645B2 (ja) | カルマンフィルタ処理における繰り返し演算制御方法及び装置 | |
CN115060257B (zh) | 一种基于民用级惯性测量单元的车辆变道检测方法 | |
CN111751857A (zh) | 一种车辆位姿的估算方法、装置、存储介质及系统 | |
CN110637209A (zh) | 估计机动车的姿势的方法、设备和具有指令的计算机可读存储介质 | |
JP7028223B2 (ja) | 自己位置推定装置 | |
JP7206883B2 (ja) | ヨーレート補正装置 | |
JP6939759B2 (ja) | 車両状態推定装置 | |
CN112577513A (zh) | 一种状态量误差确定方法及车载终端 | |
JP6981459B2 (ja) | センサ誤差補正装置 | |
CN111284496B (zh) | 用于自动驾驶车辆的车道追踪方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20201008 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20210928 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20211012 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20211126 |
|
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: 20220118 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220131 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7028223 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |