JP7209918B2 - 補正データ生成装置、補正データ生成方法及び補正データ生成プログラム - Google Patents
補正データ生成装置、補正データ生成方法及び補正データ生成プログラム Download PDFInfo
- Publication number
- JP7209918B2 JP7209918B2 JP2022569617A JP2022569617A JP7209918B2 JP 7209918 B2 JP7209918 B2 JP 7209918B2 JP 2022569617 A JP2022569617 A JP 2022569617A JP 2022569617 A JP2022569617 A JP 2022569617A JP 7209918 B2 JP7209918 B2 JP 7209918B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- correction data
- measured
- positions
- predicted
- 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
- 238000012937 correction Methods 0.000 title claims description 276
- 238000000034 method Methods 0.000 title claims description 52
- 238000005259 measurement Methods 0.000 claims description 116
- 230000005540 biological transmission Effects 0.000 claims description 83
- 230000002093 peripheral effect Effects 0.000 claims description 58
- 238000012545 processing Methods 0.000 claims description 51
- 230000010354 integration Effects 0.000 claims description 9
- 238000004891 communication Methods 0.000 description 20
- 230000006870 function Effects 0.000 description 10
- 238000010586 diagram Methods 0.000 description 6
- 239000000284 extract Substances 0.000 description 3
- 238000012827 research and development Methods 0.000 description 3
- 238000003491 array Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 230000002250 progressing effect Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/0104—Measuring and analyzing of parameters relative to traffic conditions
- G08G1/0137—Measuring and analyzing of parameters relative to traffic conditions for specific applications
- G08G1/0141—Measuring and analyzing of parameters relative to traffic conditions for specific applications for traffic information dissemination
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/0104—Measuring and analyzing of parameters relative to traffic conditions
- G08G1/0108—Measuring and analyzing of parameters relative to traffic conditions based on the source of data
- G08G1/0112—Measuring and analyzing of parameters relative to traffic conditions based on the source of data from the vehicle, e.g. floating car data [FCD]
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/40—Correcting position, velocity or attitude
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/0104—Measuring and analyzing of parameters relative to traffic conditions
- G08G1/0125—Traffic data processing
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/09—Arrangements for giving variable traffic instructions
- G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
- G08G1/0967—Systems involving transmission of highway information, e.g. weather, speed limits
- G08G1/096766—Systems involving transmission of highway information, e.g. weather, speed limits where the system is characterised by the origin of the information transmission
- G08G1/096775—Systems involving transmission of highway information, e.g. weather, speed limits where the system is characterised by the origin of the information transmission where the origin of the information is a central station
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/09—Arrangements for giving variable traffic instructions
- G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
- G08G1/0967—Systems involving transmission of highway information, e.g. weather, speed limits
- G08G1/096766—Systems involving transmission of highway information, e.g. weather, speed limits where the system is characterised by the origin of the information transmission
- G08G1/096783—Systems involving transmission of highway information, e.g. weather, speed limits where the system is characterised by the origin of the information transmission where the origin of the information is a roadside individual element
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/40—Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P]
- H04W4/44—Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P] for communication between vehicles and infrastructures, e.g. vehicle-to-cloud [V2C] or vehicle-to-home [V2H]
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Analytical Chemistry (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Life Sciences & Earth Sciences (AREA)
- Atmospheric Sciences (AREA)
- Signal Processing (AREA)
- Traffic Control Systems (AREA)
Description
また、他車両に搭載されたセンサのセンサデータを車々間通信で受信し、受信したセンサデータを利用するシステムの研究開発も進んでいる。
更に、車両と路側サーバとの間の路車間通信を用いて車両と路側サーバ間でデータ処理を連携するシステムも研究開発が進んでいる。
つまり、車両aが測定した車両aの位置と車両bが測定した車両aの位置は一致するが、車両aが測定した車両cの位置と車両bが測定した車両cの位置は一致しないといった事態が生じ得る。
特許文献1では、車両αが自身の位置を測定し、また、周辺の車両βが測定した車両αの位置情報を取得する。そして、車両αは、車両αで測定した車両αの測定位置と車両βから取得した車両αの測定位置との誤差から車両αの範囲を求める。車両αは、同様の処理を複数の周辺の車両との間で実施する。そして、車両αは、複数の周辺車両との間で同様の処理を繰り返した後に重なり合った範囲が車両αの位置になるように車両αの位置を補正する。
このため、特許文献1の技術では、位置の補正に時間がかかるという課題がある。
複数の移動体の各移動体から、誤差が含まれ得る、各移動体で測定された各移動体の位置である各移動体の測定位置と、誤差が含まれ得る、各移動体で測定された各移動体の周辺物体の位置である各移動体の周辺物体の測定位置とが示される移動体データを受信する受信部と、
前記複数の移動体から受信された複数の移動体データに示される前記複数の移動体の測定位置と前記複数の移動体の周辺物体の測定位置とを用いて、各移動体の測定位置に含まれる得る誤差を補正するための補正データを移動体ごとに生成する補正データ生成部と、
前記補正データ生成部により生成された移動体ごとの前記補正データを各移動体に送信する送信部とを有する。
***構成の説明***
図1は、本実施の形態に係る位置補正システム500の構成例を示す。
本実施の形態に係る位置補正システム500は、補正データ生成装置100、車載装置A200a及び車載装置B200bを含む。
車両A300a、車両B300b、車両C300c、車両D300d及び歩行者400は、それぞれ移動体である。
また、車両A300aの周辺に存在する移動体である車両B300b、車両C300c、車両D300d及び歩行者400は、それぞれ車両A300aの周辺物体に相当する。同様に、車両B300bの周辺に存在する移動体である車両A300a、車両C300c、車両D300d及び歩行者400は、それぞれ車両B300bの周辺物体に相当する。
また、車載装置A200aと車載装置B200bを区別する必要がない場合は、これらをまとめて車載装置200と表記する。
車載装置A200aは、測定結果を車両データAとして補正データ生成装置100に送信する。車両データAは移動体データに相当する。車載装置A200aの測定結果は、車両A300aの測定位置、車両A300aの周辺物体の測定位置、車両A300aの速度、周辺物体の測定速度である。
車載装置A200aの測定結果には、測定誤差が含まれている可能性がある。
なお、本実施の形態では、車載装置A200aは、周辺物体のうち、車両B300b、車両C300c及び歩行者の位置及び速度のみの測定が可能と想定する。
車載装置B200bは測定結果を車両データBとして補正データ生成装置100に送信する。車両データBは移動体データに相当する。車載装置B200bの測定結果は、車両B300bの位置、車両B300bの周辺物体の位置、車両B300bの速度、周辺物体の速度である。
車載装置B200bの測定結果には、測定誤差が含まれている可能性がある。
なお、本実施の形態では、車載装置B200bは、周辺物体のうち、車両A300a、車両D300dの位置及び速度のみの測定が可能と想定する。
なお、補正データ生成装置100の動作手順は、補正データ生成方法に相当する。また、補正データ生成装置100の動作を実現するプログラムは、補正データ生成プログラムに相当する。
そして、補正データ生成装置100は、車両データAに含まれる測定結果と車両データBに含まれる測定結果を用いて車両A300a及び車両B300bの各々に対して補正データを生成する。
車両A300aへの補正データ(補正データAという)は、車載装置A200aでの測定結果に含まれる測定誤差を補正するためのデータである。つまり、補正データAは、車両A300aの測定位置に含まれ得る測定誤差及び車両A300aの周辺物体の測定位置に含まれ得る測定誤差を補正するためのデータである。
車両B300bへの補正データ(補正データBという)は、車載装置B200bでの測定結果に含まれる測定誤差を補正するためのデータである。つまり、補正データBは、車両B300bの測定位置に含まれ得る測定誤差及び車両B300bの周辺物体の測定位置に含まれ得る測定誤差を補正するためのデータである。
そして、補正データ生成装置100は、車載装置A200aに補正データAを送信し、車載装置B200bに補正データBを送信する。
同様に、車載装置B200bは補正データBを受信する。そして、車載装置B200bは、補正データBを用いて車両B300bの測定位置に含まれる測位誤差を補正する。更に、車載装置B200bは補正データBを用いて車両B300bの周辺物体の測定位置に含まれる測位誤差を補正する。
補正データ生成装置100及び車載装置200の詳細な構成を説明する前に、位置補正システム500での処理手順の概略を説明する。
以下では、車両データA及び車両データB以外の1つ以上の車両データをまとめて車両データN(図2には不図示)という。また、車両データNの送信元の車両を車両N300n(不図示)という。
また、車両データの送信元の車両300を送信元車両300ともいう。
なお、補正データ生成装置100は、車両データAに示される車両A300aが車両データAの送信元車両300であることを認識できるものとする。
補正データ生成装置100は、車両データBに示される車両B300bが車両データBの送信元車両300であることを認識できるものとする。
図2に示すように、車両データAでの測定時刻は時刻t1である。車両データBでの測定時刻は時刻t2(t1<t2)である。また、車両データNの測定時刻も送信元車両300に個別の時刻である。
このように、各送信元車両300で同じ時刻に測定がされているとは限らないため、車両データ間の測定時刻のずれが生じ得る。
補正データ生成装置100は、このような測定時刻のずれを除去する。補正データ生成装置100は、測定時刻のずれの除去のために、複数の送信元車両300での測定時刻以降の時刻であって、複数の送信元車両300に共通に適用される時刻(以下、基準時刻という)を設定する。そして、補正データ生成装置100は、基準時刻での各送信元車両300の予測位置及び各送信元車両300の周辺物体の予測位置を算出する。
つまり、補正データ生成装置100は、車両データAに示される車両A300aの測定位置と測定速度とに基づき、時刻t3での車両A300aの予測位置を算出する。また、補正データ生成装置100は、各周辺物体(車両X1、車両X2、歩行者)の測定位置と測定速度とに基づき、時刻t3での各周辺物体の予測位置を算出する。時刻t3での車両A300aと各周辺物体の予測位置が示されるデータを予測データAという。
補正データ生成装置100は、車両データBについても、同様にして、時刻t3での車両B300bと各周辺物体の予測位置を算出する。時刻t3での車両B300bと各周辺物体の予測位置が示されるデータを予測データBという。
また、補正データ生成装置100は、車両データNについても同様にして時刻t3での車両N300nと周辺物体の予測位置を算出する。時刻t3での車両N300nと各周辺物体の予測位置が示されるデータを予測データN(図2には不図示)という。
図2の統合データでは、車両A300aの予測位置と車両Y1の予測位置とが一部において重複している。また、車両B300bの予測位置と車両X2の予測位置とが一部において重複している。車両A300aと車両Y1とは同一の車両であるため、各々の予測位置は近接しているが、測定誤差及び予測誤差により完全には一致していない。同様に、車両B300bと車両X2とは同一の車両であるため、各々の予測位置は近接しているが、測定誤差及び予測誤差により完全には一致していない。
補正データ生成装置100は、統合により得られた予測位置の分布を解析し、基準時刻t3で送信元車両300が所在すると推定される位置を送信元車両300の推定位置として算出する。図2の例では、補正データ生成装置100は、車両A300aの予測位置と車両Y1の予測位置との分布を解析し、車両A300aの推定位置を算出する。同様に、補正データ生成装置100は、車両B300bの予測位置と車両X2の予測位置との分布を解析し、車両B300bの推定位置を算出する。
また、補正データ生成装置100は、基準時刻t3で周辺物体が所在すると推定される位置を周辺物体の推定位置として算出する。
例えば、補正データAでは、車両データAに示される車両X1、車両A300a、歩行者及び車両X2のそれぞれの補正値(δ11~δ14)が示される。同様に、補正データBでは、車両データBに示される車両Y1、車両B300b及び車両Y2のそれぞれの補正値(δ21~δ23)が示される。
補正データに示される補正値は、各車載装置200での測定誤差を解消する。つまり、補正データに示される補正値は各車載装置200での測定時刻における測定誤差に相当する。
図3は車載装置200の機能構成例を示し、図5は車載装置200のハードウェア構成例を示す。
車載装置200は、コンピュータである。車載装置200の動作手順は、誤差補正方法に相当する。また、車載装置200の動作を実現するプログラムは、誤差補正プログラムに相当する。
また、図3に示すように、車載装置200は、機能構成として、車両位置測定部201、周辺物体位置測定部202、送信部203、受信部204及び補正部205を備える。
補助記憶装置803には、車両位置測定部201、周辺物体位置測定部202、送信部203、受信部204及び補正部205の機能を実現するプログラムが記憶されている。
これらプログラムは、補助記憶装置803から主記憶装置802にロードされる。そして、プロセッサ801がこれらプログラムを実行して、後述する車両位置測定部201、周辺物体位置測定部202、送信部203、受信部204及び補正部205の動作を行う。
図5では、プロセッサ801が車両位置測定部201、周辺物体位置測定部202、送信部203、受信部204及び補正部205の機能を実現するプログラムを実行している状態を模式的に表している。
車両位置測定部201は、例えば、GPS(Global Positioning System)衛星からの測位信号を用いて車両300の位置を測定する。また、車両位置測定部201は、例えば、単位時間での測定位置の差を用いて速度を測定する。
そして、車両位置測定部201は、測定時刻、車両300の測定位置及び測定速度を送信部203に出力する。測定時刻は車両位置測定部201が車両300の位置及び速度を測定した時刻である。なお、車両位置測定部201は、測定時刻としてGPS時刻のような統一的な時刻を用いる。つまり、各車両300で一致した時刻が用いられる。すなわち、車両300間で測定タイミングが一致しない可能性はあるが、車両300間での時刻ずれは存在しないと考える。
また、車両位置測定部201は、車両300の測定位置を補正部205に出力する。
車両位置測定部201は、後述する周辺物体位置測定部202とともに測位部に相当する。また、車両位置測定部201により行われる処理は、周辺物体位置測定部202により行われる処理とともに測位処理に相当する。
周辺物体位置測定部202は、例えば、車両300に搭載されているセンサからのセンサデータを用いて周辺物体の位置及び速度を測定する。周辺物体位置測定部202は、周辺物体の位置及び速度として、車両300からの相対位置及び相対速度を測定する。本実施の形態では、センサによる周辺物体の検知手法は問わない。本実施の形態では、周辺物体位置測定部202が周辺物体の速度を測定する例を説明するが、周辺物体位置測定部202は周辺物体の速度を測定しなくてもよい。
周辺物体位置測定部202は、周辺物体の測定位置及び測定速度を送信部203に出力する。また、周辺物体位置測定部202は、周辺物体の測定位置を補正部205に出力する。
周辺物体位置測定部202は、車両位置測定部201とともに測位部に相当する。また、周辺物体位置測定部202により行われる処理は、車両位置測定部201により行われる処理とともに測位処理に相当する。
送信部203により行われる処理は送信処理に相当する。
そして、受信部204は受信した補正データを補正部205に出力する。
受信部204により行われる処理は受信処理に相当する。
図4は補正データ生成装置100の機能構成例を示し、図6は補正データ生成装置100のハードウェア構成例を示す。
補正データ生成装置100は、コンピュータである。補正データ生成装置100の動作手順は、補正データ生成方法に相当する。また、補正データ生成装置100の動作を実現するプログラムは、補正データ生成プログラムに相当する。
また、図4に示すように、補正データ生成装置100は、機能構成として、受信部101、補正データ生成部102及び送信部103を備える。
補助記憶装置903には、受信部101、補正データ生成部102及び送信部103の機能を実現するプログラムが記憶されている。
これらプログラムは、補助記憶装置903から主記憶装置902にロードされる。そして、プロセッサ901がこれらプログラムを実行して、後述する受信部101、補正データ生成部102及び送信部103の動作を行う。
図6では、プロセッサ901が受信部101、補正データ生成部102及び送信部103の機能を実現するプログラムを実行している状態を模式的に表している。
受信部101は、受信した車両データを補正データ生成部102に出力する。
受信部101により行われる処理は、受信処理に相当する。
補正データ生成部102により行われる処理は補正データ生成処理に相当する。
送信部103により行われる処理は送信処理に相当する。
次に、図7及び図8を参照して車載装置200の動作例を説明する。
最初に、図7を説明する。図7は、位置及び速度の測定処理と車両データの送信処理を示す。
前述したように、車両位置測定部201はGPS衛星からの測位信号を用いて車両300の位置を測定する。また、車両位置測定部201は、例えば、単位時間での測定位置の差を用いて速度を測定する。
なお、車両位置測定部201は、前回の測定タイミングでの車両300の測定位置の補正部205による補正値を用いて、車両300の位置及び速度を測定してもよい。
なお、周辺物体位置測定部202は、前回の測定タイミングでの周辺物体の測定位置の補正部205による補正値を用いて、周辺物体の位置及び速度を測定してもよい。
図7では、ステップS201の後にステップS202が行われるように記載されているが、ステップS201とステップS202は並行して行われる。
前述したように、送信部203は、測定時刻、車両300の測定位置及び測定速度と周辺物体の測定位置及び測定速度を車両データとして補正データ生成装置100に送信する。また、送信部203は、車両データに車載装置200の識別子を付与して車両データを補正データ生成装置100に送信する。
なお、本実施の形態では、送信部203は補正データ生成装置100の通信アドレスを取得済であるものとする。送信部203が補正データ生成装置100の通信アドレスを取得する手法は問わない。
図2に示したように、補正データには車両300の位置及び各周辺物体の位置を補正するための補正値が含まれる。補正部205は、例えば、車両300の測定位置及び各周辺物体の測定位置から対応する補正値を減算して補正後の車両300の位置及び各周辺物体の位置を得る。
そして、最初に受信した車両データの受信時刻から一定時間が経過するまで、受信部101は車両データの受信を待つ。
具体的には、補正データ生成部102は、補助記憶装置903に格納されている車両データの測定時刻のうち最も遅い測定時刻を基準時刻に設定する。
補正データ生成部102は、送信元車両300の測定位置及び測定速度と周辺物体の測定位置及び測定速度を用いて、基準時刻での送信元車両300の予測位置及び周辺物体の予測位置を算出する。
補正データ生成部102は、カルマンフィルタによる事前予測処理を行って、基準時刻での送信元車両300の予測位置及び周辺物体の予測位置を算出する。
補正データ生成部102は、過去の測定位置と当該測定位置に対応して算出された予測位置との誤差を算出する。例えば、補正データ生成部102は、測定時刻t0での車両A300aの測定位置と当該測定位置に対応して算出された予測位置との誤差を算出する。また、補正データ生成部102は、測定時刻t(-1)での車両A300aの測定位置と当該測定位置に対応して算出された予測位置との誤差を算出する。そして、補正データ生成部102は、算出した誤差と、測定時刻t1での車両A300aの測定位置と測定速度を用いて、カルマンフィルタにより、時刻t2での車両A300aの予測位置と時刻t3での車両A300aの予測位置を算出する。
補正データ生成部102は、同様にして、車両A300aの周辺物体の基準時刻t3での予測位置を算出する。
なお、カルマンフィルタの詳細は、以下の参考文献に記載されている。
[参考文献]
足立修一、丸田一郎 著、「カルマンフィルタの基礎」、東京電機大学出版局、2012年
具体的には、補正データ生成部102は、複数の予測データを統合する。そして、補正データ生成部102は、統合により得られた予測位置の分布を解析し、基準時刻で送信元車両300が所在すると推定される位置(推定位置)を算出する。
送信元車両300は、他の車両の周辺物体として検出されている場合がある。図2の例では、車両A300aは車両B300bの周辺物体(車両Y1)として検出されており、車両B300bは車両A300aの周辺物体(車両X2)として検出されている。
また、測定誤差及び予測誤差により、同一の送信元車両300であっても、複数の予測位置にずれが生じる可能性がある。つまり、図2の例では、車両A300aと車両Y1は同一車両であるから2つの予測位置は一致するはずであるが、測定誤差及び予測誤差により、車両A300aの予測位置と車両Y1の予測位置にずれが生じることがある。
また、ID情報等で送信元車両300と他の車両300の周辺物体との対応関係がとられているわけではない。このため、補正データ生成部102は、予測位置の分布から送信元車両300の推定位置を算出する必要がある。
なお、以下では、予測データの統合により得られた各予測位置をPiと表記する。予測位置Piは、送信元車両300の予測位置及び周辺物体の予測位置の双方を含む。また、予測位置Piのうち送信元車両300の予測位置をPo_iと表記する。
各々が同一の車両の予測位置GPiでなければ、複数の予測位置GPiが第1の距離σ1以内に近づくことはないと考えられる。換言すれば、第1の距離σ1以内にある複数の予測位置GPiは同一の車両の予測位置であると考えられる。図2の例では、予測データAの車両A300aの予測位置と予測データBの車両Y1(=車両A300a)の予測位置は第1の距離σ1以内となる。
なお、予測位置GPiに複数の送信元車両300の予測位置Po_iは含まれないものとする。前述のように、第1の距離σ1には車両長及び車両幅が反映されているため、同一のグループに複数の送信元車両300の予測位置Po_iが含まれる可能性は低い。
具体的には、補正データ生成部102は、ステップS105で算出された送信元車両300の予測位置と、ステップS106(処理117)で算出された送信元車両300の推定位置との差分を抽出する。また、補正データ生成部102は、ステップS105で算出された各周辺物体の予測位置と、ステップS106(処理118)で算出された各周辺物体の推定位置との差分を抽出する。
ステップS107で得られた位置差分は基準時刻における予測位置と推定位置との差分である。送信元車両300から送信された車両データに示される測定位置は測定時刻での位置である。このため、補正データ生成部102は、測定時刻と基準時刻との差分が反映されるように、ステップS107で得られた位置差分を調整する。
具体的には、補正データ生成部102は以下の処理を行う。
また、基準時刻tでの送信元車両300の予測位置(ステップS105で算出された予測位置)をPpre_iとする。
また、ステップS106で算出された送信元車両300の推定位置をPresult_iとする。
また、ステップS107で得られた送信元車両300の位置差分は、(Presult_i ― Ppre_i)である。
ステップS108では、補正データ生成部102は、「(Presult_i ― Ppre_i)*(1―(t―ti)/cycle)」により、位置差分を時刻差分で調整する。ただし、cycleはステップS103での待機時間である。
以上のように、本実施の形態によれば、位置の補正を短時間で行うことができる。
前述のように、特許文献1の技術では、車両αは、周辺車両からの測定位置の受信を複数回繰り返し、周辺車両からの測定位置と車両αでの測定位置との照合を複数回繰り返さないと位置の補正を行うことができない。このため、特許文献1の技術では、位置の補正に時間がかかる。
本実施の形態では、各車載装置200は、車両データの送信と補正データの受信のみで位置を補正することができる。つまり、本実施の形態によれば、各車載装置200は、複数回の通信及び複数回の照合を行わなくても位置の補正を行うことができる。
本実施の形態では、2つの車両が相互に他方の位置を測定することができない場合でも、別の車両が当該2つの車両の位置を測定できれば、当該2つの車両は各々の位置を補正することができる。例えば、車両Pは車両Qの位置を測定できない状態であり、車両Qは車両Pの位置を測定できない状態であるとする。また、車両Rは車両Pの位置と車両Qの位置を測定できる状態であるとする。この場合に、車両Pが車両Pの測定位置を補正データ生成装置100に送信する。また、車両Qが車両Qの測定位置を補正データ生成装置100に送信する。また、車両Rが車両Pの測定位置と車両Qの測定位置を周辺物体の測定位置として補正データ生成装置100に送信する。補正データ生成装置100は、車両Pからの車両Pの測定位置と、車両Rからの周辺物体の測定位置(車両Pの測定位置)を用いることで、車両Pの測定位置を補正するための補正データを車両Pに送信することができる。同様に、補正データ生成装置100は、車両Qからの車両Qの測定位置と、車両Rからの周辺物体の測定位置(車両Qの測定位置)を用いることで、車両Qの測定位置を補正するための補正データを車両Qに送信することができる。
本実施の形態によれば、周辺物体の位置の補正も可能である。
最後に、車載装置200のハードウェア構成と補正データ生成装置100のハードウェア構成の補足説明を行う。
プロセッサ801は、CPU(Central Processing Unit)、DSP(Digital Signal Processor)等である。
図5に示す主記憶装置802は、RAM(Random Access Memory)である。
図5に示す補助記憶装置803は、ROM(Read Only Memory)、フラッシュメモリ、HDD(Hard Disk Drive)等である。
図5に示す通信装置804は、データの通信処理を実行する電子回路である。
通信装置804は、例えば、通信チップ又はNIC(Network Interface Card)である。
そして、OSの少なくとも一部がプロセッサ801により実行される。
プロセッサ801はOSの少なくとも一部を実行しながら、車両位置測定部201、周辺物体位置測定部202、送信部203、受信部204及び205の機能を実現するプログラムを実行する。
プロセッサ801がOSを実行することで、タスク管理、メモリ管理、ファイル管理、通信制御等が行われる。
また、車両位置測定部201、周辺物体位置測定部202、送信部203、受信部204及び補正部205の処理の結果を示す情報、データ、信号値及び変数値の少なくともいずれかが、主記憶装置802、補助記憶装置803、プロセッサ801内のレジスタ及びキャッシュメモリの少なくともいずれかに記憶される。
また、車両位置測定部201、周辺物体位置測定部202、送信部203、受信部204及び補正部205の機能を実現するプログラムは、磁気ディスク、フレキシブルディスク、光ディスク、コンパクトディスク、ブルーレイ(登録商標)ディスク、DVD等の可搬記録媒体に格納されていてもよい。そして、車両位置測定部201、周辺物体位置測定部202、送信部203、受信部204及び補正部205の機能を実現するプログラムが格納された可搬記録媒体を流通させてもよい。
また、車載装置200は、処理回路により実現されてもよい。処理回路は、例えば、ロジックIC(Integrated Circuit)、GA(Gate Array)、ASIC(Application Specific Integrated Circuit)、FPGA(Field-Programmable Gate Array)である。
この場合は、車両位置測定部201、周辺物体位置測定部202、送信部203、受信部204及び補正部205は、それぞれ処理回路の一部として実現される。
プロセッサ901は、CPU、DSP等である。
図6に示す主記憶装置902は、RAMである。
図6に示す補助記憶装置903は、ROM、フラッシュメモリ、HDD等である。
図6に示す通信装置904は、データの通信処理を実行する電子回路である。
通信装置904は、例えば、通信チップ又はNICである。
そして、OSの少なくとも一部がプロセッサ901により実行される。
プロセッサ901はOSの少なくとも一部を実行しながら、受信部101、補正データ生成部102及び送信部103の機能を実現するプログラムを実行する。
プロセッサ901がOSを実行することで、タスク管理、メモリ管理、ファイル管理、通信制御等が行われる。
また、受信部101、補正データ生成部102及び送信部103の処理の結果を示す情報、データ、信号値及び変数値の少なくともいずれかが、主記憶装置902、補助記憶装置903、プロセッサ901内のレジスタ及びキャッシュメモリの少なくともいずれかに記憶される。
また、受信部101、補正データ生成部102及び送信部103の機能を実現するプログラムは、磁気ディスク、フレキシブルディスク、光ディスク、コンパクトディスク、ブルーレイ(登録商標)ディスク、DVD等の可搬記録媒体に格納されていてもよい。そして、受信部101、補正データ生成部102及び送信部103の機能を実現するプログラムが格納された可搬記録媒体を流通させてもよい。
また、補正データ生成装置100は、処理回路により実現されてもよい。処理回路は、例えば、ロジックIC、GA、ASIC、FPGAである。
この場合は、受信部101、補正データ生成部102及び送信部103は、それぞれ処理回路の一部として実現される。
つまり、プロセッサと処理回路とは、それぞれ「プロセッシングサーキットリー」の具体例である。
Claims (9)
- 複数の移動体の各移動体から、誤差が含まれ得る、各移動体で個別のタイミングで測定された各移動体の位置である各移動体の測定位置と、誤差が含まれ得る、各移動体で個別のタイミングで測定された各移動体の周辺物体の位置である各移動体の周辺物体の測定位置と、各移動体の測定位置と各移動体の周辺物体の測定位置とが測定された時刻である測定時刻とが示される移動体データを受信する受信部と、
前記複数の移動体から受信された複数の移動体データに示される各移動体の測定位置と各移動体の周辺物体の測定位置と各移動体の測定時刻とを用いて、前記複数の移動体の測定時刻以降の時刻であって前記複数の移動体に共通に適用される時刻である基準時刻での各移動体の予測位置を算出し、前記基準時刻での各移動体の周辺物体の予測位置を算出し、前記基準時刻での前記複数の移動体の予測位置と前記複数の移動体の周辺物体の予測位置とを統合し、統合により得られた予測位置の分布を解析し、前記基準時刻で各移動体が所在すると推定される位置を前記基準時刻での各移動体の推定位置として算出し、前記基準時刻での各移動体の推定位置を用いて、各移動体の測定位置に含まれる得る誤差を補正するための補正データを移動体ごとに生成する補正データ生成部と、
前記補正データ生成部により生成された移動体ごとの前記補正データを各移動体に送信する送信部とを有し、
前記補正データ生成部は、
統合により得られた予測位置の分布において相互に第1の距離以内にある予測位置をグルーピングし、
グルーピングにより得られた複数のグループの中から、いずれかの移動体の予測位置が含まれるグループである補正対象グループを抽出し、前記補正対象グループに予測位置が含まれる移動体の予測位置を除いた、前記補正対象グループに含まれる予測位置における平均位置を第1の平均位置として算出し、
前記補正対象グループに含まれる予測位置のうち前記第1の平均位置から第2の距離以内にある予測位置における平均位置を第2の平均位置として算出し、
前記第2の平均位置を、前記補正対象グループに予測位置が含まれる移動体の推定位置として用いる補正データ生成装置。 - 前記補正データ生成部は、
各移動体の測定位置に含まれる得る誤差と各移動体の周辺物体の測定位置に含まれる得る誤差とを補正するための補正データを移動体ごとに生成する請求項1に記載の補正データ生成装置。 - 前記補正データ生成部は、
前記補正対象グループに予測位置が含まれる移動体の推定位置と当該移動体の予測位置との差と、当該移動体からの移動体データに示される測定時刻と前記基準時刻との差とを用いて、当該移動体の前記補正データを生成する請求項1に記載の補正データ生成装置。 - 前記補正データ生成部は、
前記補正対象グループに予測位置が含まれる移動体の予測位置を除く、前記補正対象グループに含まれる予測位置における標準偏差を算出し、
前記標準偏差を用いて前記第2の距離を決定する請求項1に記載の補正データ生成装置。 - 前記受信部は、
前記複数の移動体の各移動体から、各移動体で測定された各移動体の速度である各移動体の測定速度が示される移動体データを受信し、
前記補正データ生成部は、
各移動体データに示される各移動体の測定位置と各移動体の測定速度と各移動体の周辺物体の測定位置と各移動体の測定時刻とを用いて、各移動体の予測位置と各移動体の周辺物体の予測位置とを算出する請求項1に記載の補正データ生成装置。 - 前記補正データ生成部は、
前記複数の移動体の測定時刻のうち最も遅い測定時刻を前記基準時刻として用いて、各移動体の予測位置と各移動体の周辺物体の予測位置とを算出する請求項1に記載の補正データ生成装置。 - 前記複数の移動体は、車道を走行する複数の車両であり、
前記補正データ生成装置は、
前記車道の路側に配置された路側サーバ装置である請求項1に記載の補正データ生成装置。 - コンピュータが、複数の移動体の各移動体から、誤差が含まれ得る、各移動体で個別のタイミングで測定された各移動体の位置である各移動体の測定位置と、誤差が含まれ得る、各移動体で個別のタイミングで測定された各移動体の周辺物体の位置である各移動体の周辺物体の測定位置と、各移動体の測定位置と各移動体の周辺物体の測定位置とが測定された時刻である測定時刻とが示される移動体データを受信し、
前記コンピュータが、前記複数の移動体から受信された複数の移動体データに示される各移動体の測定位置と各移動体の周辺物体の測定位置と各移動体の測定時刻とを用いて、前記複数の移動体の測定時刻以降の時刻であって前記複数の移動体に共通に適用される時刻である基準時刻での各移動体の予測位置を算出し、前記基準時刻での各移動体の周辺物体の予測位置を算出し、前記基準時刻での前記複数の移動体の予測位置と前記複数の移動体の周辺物体の予測位置とを統合し、統合により得られた予測位置の分布を解析し、前記基準時刻で各移動体が所在すると推定される位置を前記基準時刻での各移動体の推定位置として算出し、前記基準時刻での各移動体の推定位置を用いて、各移動体の測定位置に含まれる得る誤差を補正するための補正データを移動体ごとに生成し、
前記コンピュータが、生成された移動体ごとの前記補正データを各移動体に送信し、
前記補正データの生成において、前記コンピュータは、
統合により得られた予測位置の分布において相互に第1の距離以内にある予測位置をグルーピングし、
グルーピングにより得られた複数のグループの中から、いずれかの移動体の予測位置が含まれるグループである補正対象グループを抽出し、前記補正対象グループに予測位置が含まれる移動体の予測位置を除いた、前記補正対象グループに含まれる予測位置における平均位置を第1の平均位置として算出し、
前記補正対象グループに含まれる予測位置のうち前記第1の平均位置から第2の距離以内にある予測位置における平均位置を第2の平均位置として算出し、
前記第2の平均位置を、前記補正対象グループに予測位置が含まれる移動体の推定位置として用いる補正データ生成方法。 - 複数の移動体の各移動体から、誤差が含まれ得る、各移動体で個別のタイミングで測定された各移動体の位置である各移動体の測定位置と、誤差が含まれ得る、各移動体で個別のタイミングで測定された各移動体の周辺物体の位置である各移動体の周辺物体の測定位置と、各移動体の測定位置と各移動体の周辺物体の測定位置とが測定された時刻である測定時刻とが示される移動体データを受信する受信処理と、
前記複数の移動体から受信された複数の移動体データに示される各移動体の測定位置と各移動体の周辺物体の測定位置と各移動体の測定時刻とを用いて、前記複数の移動体の測定時刻以降の時刻であって前記複数の移動体に共通に適用される時刻である基準時刻での各移動体の予測位置を算出し、前記基準時刻での各移動体の周辺物体の予測位置を算出し、前記基準時刻での前記複数の移動体の予測位置と前記複数の移動体の周辺物体の予測位置とを統合し、統合により得られた予測位置の分布を解析し、前記基準時刻で各移動体が所在すると推定される位置を前記基準時刻での各移動体の推定位置として算出し、前記基準時刻での各移動体の推定位置を用いて、各移動体の測定位置に含まれる得る誤差を補正するための補正データを移動体ごとに生成する補正データ生成処理と、
前記補正データ生成処理により生成された移動体ごとの前記補正データを各移動体に送信する送信処理とをコンピュータに実行させ、
前記補正データ生成処理において、前記コンピュータに、
統合により得られた予測位置の分布において相互に第1の距離以内にある予測位置をグルーピングさせ、
グルーピングにより得られた複数のグループの中から、いずれかの移動体の予測位置が含まれるグループである補正対象グループを抽出させ、前記補正対象グループに予測位置が含まれる移動体の予測位置を除いた、前記補正対象グループに含まれる予測位置における平均位置を第1の平均位置として算出させ、
前記補正対象グループに含まれる予測位置のうち前記第1の平均位置から第2の距離以内にある予測位置における平均位置を第2の平均位置として算出させ、
前記第2の平均位置を、前記補正対象グループに予測位置が含まれる移動体の推定位置として用いらせる補正データ生成プログラム。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2020/047418 WO2022130619A1 (ja) | 2020-12-18 | 2020-12-18 | 補正データ生成装置、車載装置、補正データ生成方法、誤差補正方法、補正データ生成プログラム及び誤差補正プログラム |
Publications (3)
Publication Number | Publication Date |
---|---|
JPWO2022130619A1 JPWO2022130619A1 (ja) | 2022-06-23 |
JP7209918B2 true JP7209918B2 (ja) | 2023-01-20 |
JPWO2022130619A5 JPWO2022130619A5 (ja) | 2023-02-10 |
Family
ID=82059343
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2022569617A Active JP7209918B2 (ja) | 2020-12-18 | 2020-12-18 | 補正データ生成装置、補正データ生成方法及び補正データ生成プログラム |
Country Status (5)
Country | Link |
---|---|
US (1) | US20230260395A1 (ja) |
JP (1) | JP7209918B2 (ja) |
CN (1) | CN116569071A (ja) |
DE (1) | DE112020007695T5 (ja) |
WO (1) | WO2022130619A1 (ja) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100049376A1 (en) | 2008-08-19 | 2010-02-25 | Abraham Schultz | Method and system for providing a gps-based position |
US20180275282A1 (en) | 2017-03-23 | 2018-09-27 | Delphi Technologies, Inc. | Automated vehicle gps accuracy improvement using v2v communications |
JP2019086393A (ja) | 2017-11-07 | 2019-06-06 | トヨタ自動車株式会社 | 物体認識装置 |
US20190383950A1 (en) | 2018-06-18 | 2019-12-19 | Zenuity Ab | Method and arrangement for improving global positioning performance of a road vehicle |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6464978B2 (ja) | 2015-10-02 | 2019-02-06 | 株式会社デンソー | 位置推定装置 |
-
2020
- 2020-12-18 CN CN202080107841.6A patent/CN116569071A/zh active Pending
- 2020-12-18 DE DE112020007695.4T patent/DE112020007695T5/de active Pending
- 2020-12-18 WO PCT/JP2020/047418 patent/WO2022130619A1/ja active Application Filing
- 2020-12-18 JP JP2022569617A patent/JP7209918B2/ja active Active
-
2023
- 2023-04-25 US US18/139,009 patent/US20230260395A1/en active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100049376A1 (en) | 2008-08-19 | 2010-02-25 | Abraham Schultz | Method and system for providing a gps-based position |
US20180275282A1 (en) | 2017-03-23 | 2018-09-27 | Delphi Technologies, Inc. | Automated vehicle gps accuracy improvement using v2v communications |
JP2019086393A (ja) | 2017-11-07 | 2019-06-06 | トヨタ自動車株式会社 | 物体認識装置 |
US20190383950A1 (en) | 2018-06-18 | 2019-12-19 | Zenuity Ab | Method and arrangement for improving global positioning performance of a road vehicle |
Also Published As
Publication number | Publication date |
---|---|
DE112020007695T5 (de) | 2023-08-10 |
CN116569071A (zh) | 2023-08-08 |
US20230260395A1 (en) | 2023-08-17 |
JPWO2022130619A1 (ja) | 2022-06-23 |
WO2022130619A1 (ja) | 2022-06-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7191122B2 (ja) | センサデータを用いた、強化された位置の特定 | |
EP3491854B1 (en) | Methods and apparatuses relating to determination of locations of portable devices | |
US10775473B2 (en) | Correcting location data of connected vehicle | |
US9846977B1 (en) | Systems and methods for determining vehicle trip information | |
KR102399488B1 (ko) | 자율 주행 플랫폼의 센서 i/o 커버리지를 향상시키기 위한 플렉시블 테스트 보드 | |
US9794519B2 (en) | Positioning apparatus and positioning method regarding a position of mobile object | |
WO2017127446A1 (en) | Management of a distributed sensor system | |
JP7200897B2 (ja) | 占有グリッドマップ生成装置、占有グリッドマップ生成システム、占有グリッドマップ生成方法、およびプログラム | |
JP2013228804A (ja) | 先行車特定装置 | |
EP2769233A1 (en) | Time of arrival based wireless positioning system | |
US9191992B2 (en) | System and method for participants data retrieval post accident or event | |
CN110235189B (zh) | 信息处理装置、信息处理方法以及计算机能读取的存储介质 | |
WO2018198239A1 (ja) | 処理装置および物体識別情報の生成方法 | |
US11991608B2 (en) | Method and system for reliable detection of smartphones within vehicles | |
CN111624550B (zh) | 一种车辆定位方法、装置、设备及存储介质 | |
JP7119437B2 (ja) | 車両用マスタ電子制御装置、車両用スレーブ電子制御装置、車両用ログ収集システム及び車両用ログ収集プログラム | |
US20190369203A1 (en) | Bicycle tracking for bike-sharing system | |
JP7209918B2 (ja) | 補正データ生成装置、補正データ生成方法及び補正データ生成プログラム | |
US20200333429A1 (en) | Sonic pole position triangulation in a lighting system | |
CN109691063B (zh) | 用于接收、处理和传输数据的方法和设备 | |
JP2019161392A (ja) | 車両情報処理システム、管理装置、車両情報処理方法および車両情報処理プログラム | |
WO2019188429A1 (ja) | 動体管理装置、動体管理システム、動体管理方法、及びコンピュータプログラム | |
US20230140719A1 (en) | Information processing device, information processing method, and storage medium | |
CN116761255B (zh) | 一种车辆定位方法及装置 | |
CN116930994A (zh) | 车辆定位方法、装置、计算机设备和存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20221115 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20221115 |
|
A871 | Explanation of circumstances concerning accelerated examination |
Free format text: JAPANESE INTERMEDIATE CODE: A871 Effective date: 20221115 |
|
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: 20221213 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230110 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7209918 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |