JP2020193907A - 位置ずれ補正システム及びプログラム - Google Patents
位置ずれ補正システム及びプログラム Download PDFInfo
- Publication number
- JP2020193907A JP2020193907A JP2019100567A JP2019100567A JP2020193907A JP 2020193907 A JP2020193907 A JP 2020193907A JP 2019100567 A JP2019100567 A JP 2019100567A JP 2019100567 A JP2019100567 A JP 2019100567A JP 2020193907 A JP2020193907 A JP 2020193907A
- Authority
- JP
- Japan
- Prior art keywords
- target
- vehicle
- group
- unit
- average
- 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)
Abstract
Description
<本発明の第1の実施の形態に係る位置ずれ補正システム1の構成>
図1を用いて、本発明の実施の形態にかかる位置ずれ補正システム1について説明する。図1に示すように、本発明の実施の形態に係る位置ずれ補正システム1は、カメラ10と、第1測位装置11と、第2測位装置12と、位置ずれ補正装置20とを備えて構成される。
次に、図17を参照して、本実施形態の位置ずれ補正システム1の物標位置収集処理ルーチンについて説明する。物標位置収集処理ルーチンは、車両が走行する毎に、繰り返し実行される。
図19を用いて、本発明の第2の実施の形態に係る位置ずれ補正システム2の構成について説明する。なお、第1の実施の形態に係る位置ずれ補正システム1と同様の構成については、同一の符号を付して詳細な説明は省略する。
図23は、本発明の第2の実施の形態に係る物標位置収集処理ルーチンを示すフローチャートである。なお、第1の実施の形態に係る物標位置収集処理ルーチンと同様の処理については、同一の符号を付して詳細な説明は省略する。物標位置収集処理ルーチンは、車両の各々において、当該車両が走行する毎に、繰り返し実行される。
10 カメラ
11 第1測位装置
12 第2測位装置
20 位置ずれ補正装置
30 車載器
40 位置ずれ補正装置
50 基地局
60 ネットワーク
210 物標位置収集部
211 画像取得部
212 物標検出部
213 第1取得部
214 第1物標位置算出部
215 第2取得部
216 第2物標位置算出部
220 物標位置記憶部
230 位置ずれ補正部
231 第1物標群選択部
232 第1物標群平均位置算出部
233 第2物標群位置補正部
234 第2物標群平均位置算出部
240 出力部
300 送信部
400 受信部
433 第2物標群位置補正部
Claims (4)
- 車両に搭載された第1測位装置により検出された前記車両の世界座標系の位置である第1車両位置を取得する第1取得部と、
前記車両に搭載された第2測位装置により前記車両の位置の変化に基づいて検出された前記車両の世界座標系の位置である第2車両位置を取得する第2取得部と、
前記車両に搭載されたセンサを用いて検出された前記車両の周辺の物標の車両座標系における位置を取得する物標検出部と、
前記第1取得部が取得した前記第1車両位置と、前記第1車両位置の検出に対応して前記物標検出部により取得された物標の位置とに基づいて、前記物標の世界座標系における位置である第1物標位置を算出する第1物標位置算出部と、
前記第2取得部が取得した前記第2車両位置と、前記第2車両位置の検出に対応して前記物標検出部により取得された物標の位置とに基づいて、前記物標の世界座標系における位置である第2物標位置を算出する第2物標位置算出部と、
前記物標検出部によって検出された複数の物標の各々について、複数回の走行において前記第1物標位置算出部により算出された前記物標の前記第1物標位置に基づいて、同一物標に対する第1物標群を生成し、前記第1物標群内の前記物標の前記第1物標位置のばらつきを求め、前記複数の物標のうち前記ばらつきが所定の第1閾値以下である物標の前記第1物標群を選択する第1物標群選択部と、
前記第1物標群選択部により選択された前記第1物標群に含まれる物標の各々について、前記物標の前記第1物標位置の平均位置である第1平均位置を算出する第1物標群平均位置算出部と、
前記第1物標群に含まれる物標の各々の前記第1平均位置に基づいて、同一の走行において前記センサを用いて検出された前記物標の各々について算出された前記第2物標位置の各々を補正する第2物標群位置補正部と、
前記第1物標群に含まれる物標の各々について、前記第2物標群位置補正部により補正された前記物標の前記第2物標位置の平均位置である第2平均位置を算出する第2物標群平均位置算出部と、
を含む位置ずれ補正システム。 - 前記第2物標群位置補正部は、前記第1物標群に含まれる物標の前記第1平均位置と、同一の走行において前記センサを用いて検出された前記物標の各々の前記第2物標位置との対応付けを行い、前記物標の各々の前記第2物標位置を座標変換した結果と、前記物標の各々の前記第2物標位置と対応付けられた前記第1物標群に含まれる物標の前記第1平均位置の各々との位置ずれが最小となる第1座標変換行列を算出し、前記第1座標変換行列に基づいて、同一の走行において前記センサを用いて検出された前記物標の各々について算出された前記第2物標位置の各々を補正する
請求項1記載の位置ずれ補正システム。 - 前記第2物標群位置補正部は、前記第1座標変換行列を算出し、前記第1座標変換行列に基づいて前記物標の前記第2物標位置を座標変換した結果と、前記物標の前記第2物標位置と対応付けられた前記第1物標群に含まれる物標の前記第1平均位置との位置ずれである残差が所定の第2閾値より大きい物標を、同一の走行において前記センサを用いて検出された前記物標から除外し、
前記第1物標群に含まれる物標の前記第1平均位置と、同一の走行において前記センサを用いて検出された前記物標の各々の前記第2物標位置との対応付けを行い、前記位置ずれが最小となる第2座標変換行列を算出し、前記第2座標変換行列に基づいて、前記センサを用いて同時に検出された前記物標の各々について算出された前記第2物標位置の各々を補正する
請求項2記載の位置ずれ補正システム。 - コンピュータを、
車両に搭載された第1測位装置により検出された前記車両の世界座標系の位置である第1車両位置を取得する第1取得部、
前記車両に搭載された第2測位装置により前記車両の位置の変化に基づいて検出された前記車両の世界座標系の位置である第2車両位置を取得する第2取得部、
前記車両に搭載されたセンサを用いて検出された前記車両の周辺の物標の車両座標系における位置を取得する物標検出部、
前記第1取得部が取得した前記第1車両位置と、前記第1車両位置の検出に対応して前記物標検出部により取得された物標の位置とに基づいて、前記物標の世界座標系における位置である第1物標位置を算出する第1物標位置算出部、
前記第2取得部が取得した前記第2車両位置と、前記第2車両位置の検出に対応して前記物標検出部により取得された物標の位置とに基づいて、前記物標の世界座標系における位置である第2物標位置を算出する第2物標位置算出部、
前記物標検出部によって検出された複数の物標の各々について、複数回の走行において前記第1物標位置算出部により算出された前記物標の前記第1物標位置に基づいて、同一物標に対する第1物標群を生成し、前記第1物標群内の前記物標の前記第1物標位置のばらつきを求め、前記複数の物標のうち前記ばらつきが所定の第1閾値以下である物標の前記第1物標群を選択する第1物標群選択部、
前記第1物標群選択部により選択された前記第1物標群に含まれる物標の各々について、前記物標の前記第1物標位置の平均位置である第1平均位置を算出する第1物標群平均位置算出部、
前記第1物標群に含まれる物標の各々の前記第1平均位置に基づいて、同一の走行において前記センサを用いて検出された前記物標の各々について算出された前記第2物標位置の各々を補正する第2物標群位置補正部、及び
前記第1物標群に含まれる物標の各々について、前記第2物標群位置補正部により補正された前記物標の前記第2物標位置の平均位置である第2平均位置を算出する第2物標群平均位置算出部
として機能させるためのプログラム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019100567A JP7226714B2 (ja) | 2019-05-29 | 2019-05-29 | 位置ずれ補正システム及びプログラム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019100567A JP7226714B2 (ja) | 2019-05-29 | 2019-05-29 | 位置ずれ補正システム及びプログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2020193907A true JP2020193907A (ja) | 2020-12-03 |
JP7226714B2 JP7226714B2 (ja) | 2023-02-21 |
Family
ID=73547687
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019100567A Active JP7226714B2 (ja) | 2019-05-29 | 2019-05-29 | 位置ずれ補正システム及びプログラム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7226714B2 (ja) |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006330908A (ja) * | 2005-05-24 | 2006-12-07 | Toyota Motor Corp | 位置記録装置及び位置記録方法 |
-
2019
- 2019-05-29 JP JP2019100567A patent/JP7226714B2/ja active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006330908A (ja) * | 2005-05-24 | 2006-12-07 | Toyota Motor Corp | 位置記録装置及び位置記録方法 |
Also Published As
Publication number | Publication date |
---|---|
JP7226714B2 (ja) | 2023-02-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6821712B2 (ja) | 自然光景中での統合センサの較正 | |
US9965699B2 (en) | Methods and systems for enabling improved positioning of a vehicle | |
US10685571B2 (en) | Vehicle dispatch system, autonomous driving vehicle, and vehicle dispatch method | |
US8892331B2 (en) | Drive assist system and wireless communication device for vehicle | |
WO2019022912A1 (en) | SYSTEMS AND METHODS FOR DETERMINING A VEHICLE POSITION | |
WO2008001493A1 (fr) | Dispositif d'estimation de position pour véhicules, procédé d'estimation de position pour véhicules, et programme d'estimation de position pour véhicules | |
CN110795984A (zh) | 信息处理方法、信息处理装置及程序记录介质 | |
JP6142707B2 (ja) | 車両位置補正装置 | |
CN112166059A (zh) | 车辆的位置估计装置、车辆的位置估计方法以及存储被编程为执行该方法的计算机程序的计算机可读记录介质 | |
US20180347990A1 (en) | Travel Control Method and Travel Control Apparatus | |
US20200117921A1 (en) | Apparatus and method for recognizing road shapes | |
CN110458885B (zh) | 基于行程感知与视觉融合的定位***和移动终端 | |
KR20190040818A (ko) | 차량 내부 센서, 카메라, 및 gnss 단말기를 이용한 3차원 차량 항법 시스템 | |
US11287281B2 (en) | Analysis of localization errors in a mobile object | |
JP5593793B2 (ja) | 車両制御装置 | |
JP7456857B2 (ja) | 自己位置推定装置 | |
JP6988873B2 (ja) | 位置推定装置および位置推定用コンピュータプログラム | |
JP7503164B2 (ja) | 地図情報作成方法 | |
US11740103B2 (en) | Map creation device, map creation system, map creation method, and storage medium | |
CN112712563A (zh) | 相机取向估计 | |
WO2020230314A1 (ja) | 自己位置補正方法及び自己位置補正装置 | |
JP7226714B2 (ja) | 位置ずれ補正システム及びプログラム | |
JP2022138378A (ja) | 自律航法装置、自律航法装置の測位方法及び測位プログラム | |
CN110132258A (zh) | 一种汽车导航方法和***以及设备 | |
JP6907952B2 (ja) | 自己位置補正装置及び自己位置補正方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20210929 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20220825 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220906 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20221020 |
|
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: 20230110 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230131 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7226714 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |