JP2018165658A - 移動距離測定装置、移動距離測定方法、及び移動距離測定プログラム - Google Patents
移動距離測定装置、移動距離測定方法、及び移動距離測定プログラム Download PDFInfo
- Publication number
- JP2018165658A JP2018165658A JP2017062862A JP2017062862A JP2018165658A JP 2018165658 A JP2018165658 A JP 2018165658A JP 2017062862 A JP2017062862 A JP 2017062862A JP 2017062862 A JP2017062862 A JP 2017062862A JP 2018165658 A JP2018165658 A JP 2018165658A
- Authority
- JP
- Japan
- Prior art keywords
- detection
- detected
- trajectory
- motion vector
- 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.)
- Granted
Links
- 238000005259 measurement Methods 0.000 title claims description 11
- 238000000691 measurement method Methods 0.000 title claims 2
- 238000001514 detection method Methods 0.000 claims abstract description 152
- 230000001133 acceleration Effects 0.000 claims abstract description 12
- 238000000034 method Methods 0.000 claims description 42
- 230000005856 abnormality Effects 0.000 claims description 24
- 238000006073 displacement reaction Methods 0.000 claims description 7
- 238000012545 processing Methods 0.000 claims description 6
- 238000010586 diagram Methods 0.000 description 3
- 238000004891 communication Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
Images
Landscapes
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Navigation (AREA)
- Measurement Of Distances Traversed On The Ground (AREA)
Abstract
Description
実施の形態1.
図1はこの発明の実施の形態1による移動距離測定装置を示すブロック図であり、この例では、移動体としての車両の移動距離を測定する装置を示している。図1において、移動距離測定装置100は、計測機器10、制御部20及びディスプレイ30を備えている。
また、ある時刻tnの運動ベクトルの変化量が変化量閾値以上であっても、時刻tnの予測位置に対する検出位置のずれが位置ずれ閾値よりも小さい場合、時刻tnの検出位置をそのまま採用し、時刻tnで次回の予測位置を予測するための運動ベクトルを、時刻tnよりも前の運動ベクトルとする方法もある。
さらにまた、移動体は、人が乗らずに無人で移動するものであってもよい。
また、移動距離測定装置を、移動体に搭載せず、移動体の外部に設置してもよい。この場合、例えば、移動体に搭載した計測機器と、移動体の外部の移動距離測定装置との間を、無線通信で接続することが考えられる。
さらに、実施の形態1では、高度計12を用いて車両の高さ方向の位置を検出したが、GPS受信機からの信号に基づいて移動体の高度を算出してもよい。また、高度計12に代えて、レーザ式又はレーダ方式の高度センサを用いてもよい。
Claims (9)
- 移動体の3次元位置を検出する位置検出部、
前記位置検出部で検出された3次元位置である検出位置に基づいて、前記移動体の3次元の移動軌跡を作成する軌跡作成部、及び
前記軌跡作成部で作成された前記移動体の移動軌跡に基づいて、前記移動体の移動距離を求める距離測定部
を備え、
前記軌跡作成部は、
前記移動体の運動に応じた信号を発生する運動センサからの信号に基づいて、前記移動体の運動ベクトルを検出する運動ベクトル検出部、
前記運動ベクトル検出部で検出された運動ベクトルと、検出位置とに基づいて、設定時間後の移動体の3次元位置である予測位置を予測する位置予測部、及び
検出位置と、その検出位置が検出された時刻に対応する予測位置である対応予測位置とを比較し、対応予測位置に対する検出位置のずれが位置ずれ閾値よりも小さいかどうかを判定する比較判定部
を有しており、
さらに前記軌跡作成部は、
検出位置の検出、予測位置の予測、及び位置ずれの判定を前記設定時間毎に繰り返し実施しながら前記移動体の移動軌跡を作成し、
対応予測位置に対する検出位置のずれが位置ずれ閾値以上である場合には、位置ずれ閾値以上の検出位置である不採用検出位置を移動軌跡の一部として用いず、不採用検出位置が検出された時刻である異常検出時刻よりも前に予測した予測位置を、異常検出時刻の移動軌跡として用いる移動距離測定装置。 - 前記位置予測部は、予測位置を移動軌跡の一部とした場合、その予測位置を異常検出時刻の検出位置とし、不採用検出位置が検出されるよりも前の運動ベクトルを用いて次の予測位置を予測する請求項1記載の移動距離測定装置。
- 前記比較判定部は、設定時間あたりの前記移動体の運動ベクトルの変化量が変化量閾値よりも小さいかどうかを判定し、
前記軌跡作成部は、運動ベクトルの変化量が変化量閾値以上である場合には、変化量閾値以上の運動ベクトルが検出されるよりも前の運動ベクトルを用いて次の予測位置を予測する請求項1又は請求項2に記載の移動距離測定装置。 - 前記軌跡作成部は、変化量閾値以上の運動ベクトルが検出された時刻に対応する検出位置も不採用検出位置とする請求項3記載の移動距離測定装置。
- 前記運動センサは、前記移動体の加速度の大きさ及び方向に応じた信号を発生する加速度センサを含む請求項1から請求項4までのいずれか1項に記載の移動距離測定装置。
- 前記位置検出部は、GPS受信機からの信号に基づいて前記移動体の3次元位置を検出し、
前記軌跡作成部は、前記位置検出部によりGPS衛星からの電波が受信できない区間では、予測位置を繋いだ軌跡を仮軌跡として確定する請求項1から請求項5までのいずれか1項に記載の移動距離測定装置。 - 前記軌跡作成部は、仮軌跡を確定した後、GPS衛星からの電波を受信した場合に、前記位置検出部で検出された検出位置に基づいて、前記仮軌跡を補正する請求項6記載の移動距離測定装置。
- 移動体の3次元位置を検出する位置検出ステップ、
前記位置検出ステップで検出された3次元位置である検出位置に基づいて、前記移動体の3次元の移動軌跡を作成する軌跡作成ステップ、及び
前記軌跡作成ステップで作成された前記移動体の移動軌跡に基づいて、前記移動体の移動距離を求める距離測定ステップ
を含む移動距離測定方法であって
前記軌跡作成ステップは、
前記移動体の運動に応じた信号を発生する運動センサからの信号に基づいて、前記移動体の運動ベクトルを検出する運動ベクトル検出ステップ、
前記運動ベクトル検出ステップで検出された運動ベクトルと、検出位置とに基づいて、設定時間後の移動体の3次元位置である予測位置を予測する位置予測ステップ、及び
検出位置と、その検出位置が検出された時刻に対応する予測位置である対応予測位置とを比較し、対応予測位置に対する検出位置のずれが位置ずれ閾値よりも小さいかどうかを判定する比較判定ステップ
を含み、
さらに前記軌跡作成ステップでは、
検出位置の検出、予測位置の予測、及び位置ずれの判定を前記設定時間毎に繰り返し実施しながら前記移動体の移動軌跡を作成し、
対応予測位置に対する検出位置のずれが位置ずれ閾値以上である場合には、位置ずれ閾値以上の検出位置である不採用検出位置を移動軌跡の一部として用いず、不採用検出位置が検出された時刻である異常検出時刻よりも前に予測した予測位置を、異常検出時刻の移動軌跡として用いる移動距離測定方法。 - 移動体の3次元位置を算出する位置検出処理、
前記位置検出処理で算出された3次元位置である検出位置に基づいて、前記移動体の3次元の移動軌跡を作成する軌跡作成処理、及び
前記軌跡作成処理で作成された前記移動体の移動軌跡に基づいて、前記移動体の移動距離を算出する距離測定処理
をコンピュータに実行させるための移動距離測定プログラムであって、
前記軌跡作成処理では、
前記移動体の運動に応じた信号を発生する運動センサからの信号に基づいて、前記移動体の運動ベクトルを算出する運動ベクトル検出処理、
前記運動ベクトル検出処理で算出された運動ベクトルと、検出位置とに基づいて、設定時間後の移動体の3次元位置である予測位置を算出する位置予測処理、
検出位置と、その検出位置が検出された時刻に対応する予測位置である対応予測位置とを比較し、対応予測位置に対する検出位置のずれが位置ずれ閾値よりも小さいかどうかを判定する比較判定処理、
検出位置の算出、予測位置の算出、及び位置ずれの判定を前記設定時間毎に繰り返し実施しながら前記移動体の移動軌跡を作成する処理、及び
対応予測位置に対する検出位置のずれが位置ずれ閾値以上である場合には、位置ずれ閾値以上の検出位置である不採用検出位置を移動軌跡の一部として用いず、不採用検出位置が検出された時刻である異常検出時刻よりも前に予測した予測位置を、異常検出時刻の移動軌跡として用いる処理
を前記コンピュータに実行させるための移動距離測定プログラム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017062862A JP6419242B2 (ja) | 2017-03-28 | 2017-03-28 | 移動距離測定装置、移動距離測定方法、及び移動距離測定プログラム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017062862A JP6419242B2 (ja) | 2017-03-28 | 2017-03-28 | 移動距離測定装置、移動距離測定方法、及び移動距離測定プログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2018165658A true JP2018165658A (ja) | 2018-10-25 |
JP6419242B2 JP6419242B2 (ja) | 2018-11-07 |
Family
ID=63922839
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2017062862A Active JP6419242B2 (ja) | 2017-03-28 | 2017-03-28 | 移動距離測定装置、移動距離測定方法、及び移動距離測定プログラム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6419242B2 (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109885943A (zh) * | 2019-02-26 | 2019-06-14 | 百度在线网络技术(北京)有限公司 | 行车决策的预测方法、装置、存储介质和终端设备 |
KR102208405B1 (ko) * | 2019-12-17 | 2021-01-27 | 주식회사 에스유아이씨티 | 열차 위치 추적 장치 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH064023A (ja) * | 1992-06-19 | 1994-01-14 | Sharp Corp | ナビゲーションシステム用軌跡表示装置 |
JPH08313278A (ja) * | 1995-05-19 | 1996-11-29 | Pioneer Electron Corp | 測位データ補正装置及び測位データ補正方法 |
JPH09243388A (ja) * | 1996-03-08 | 1997-09-19 | Kenwood Corp | ナビゲーション装置 |
JPH11119647A (ja) * | 1997-10-16 | 1999-04-30 | Toyota Motor Corp | 道路データメンテナンスシステム、および、そのシステムに適した車載端末装置 |
JP2008082883A (ja) * | 2006-09-27 | 2008-04-10 | Funai Electric Co Ltd | Gps距離測定装置 |
-
2017
- 2017-03-28 JP JP2017062862A patent/JP6419242B2/ja active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH064023A (ja) * | 1992-06-19 | 1994-01-14 | Sharp Corp | ナビゲーションシステム用軌跡表示装置 |
JPH08313278A (ja) * | 1995-05-19 | 1996-11-29 | Pioneer Electron Corp | 測位データ補正装置及び測位データ補正方法 |
JPH09243388A (ja) * | 1996-03-08 | 1997-09-19 | Kenwood Corp | ナビゲーション装置 |
JPH11119647A (ja) * | 1997-10-16 | 1999-04-30 | Toyota Motor Corp | 道路データメンテナンスシステム、および、そのシステムに適した車載端末装置 |
JP2008082883A (ja) * | 2006-09-27 | 2008-04-10 | Funai Electric Co Ltd | Gps距離測定装置 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109885943A (zh) * | 2019-02-26 | 2019-06-14 | 百度在线网络技术(北京)有限公司 | 行车决策的预测方法、装置、存储介质和终端设备 |
KR102208405B1 (ko) * | 2019-12-17 | 2021-01-27 | 주식회사 에스유아이씨티 | 열차 위치 추적 장치 |
Also Published As
Publication number | Publication date |
---|---|
JP6419242B2 (ja) | 2018-11-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9921065B2 (en) | Unit and method for improving positioning accuracy | |
JP5855249B2 (ja) | 測位装置 | |
JP4716886B2 (ja) | 位置算出装置の進行角決定方法 | |
JP5929936B2 (ja) | 特異走行箇所検出装置及び特異走行箇所検出方法 | |
CN104412066B (zh) | 定位装置 | |
KR102086270B1 (ko) | 주행 제어 장치의 제어 방법 및 주행 제어 장치 | |
JP6395771B2 (ja) | 車両位置検出装置、自動操舵制御装置、車両位置検出方法および自動操舵制御方法 | |
JP5602070B2 (ja) | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム | |
US10809390B2 (en) | Positioning apparatus | |
WO2019009103A1 (ja) | 測位装置 | |
KR100525517B1 (ko) | 차량 항법 시스템 및 그 제어방법 | |
JP5164645B2 (ja) | カルマンフィルタ処理における繰り返し演算制御方法及び装置 | |
JP6419242B2 (ja) | 移動距離測定装置、移動距離測定方法、及び移動距離測定プログラム | |
TW202229818A (zh) | 使用週期性地更新的錨座標系進行車道映射和定位 | |
JP6901584B2 (ja) | 移動体の姿勢センサ装置 | |
CN110869808B (zh) | 方位推定装置 | |
JP7407947B2 (ja) | 車両制御装置 | |
JP7464113B2 (ja) | 位置計測装置、位置計測方法、及びプログラム | |
JP6173714B2 (ja) | 車載装置及びその位置補正方法並びに位置補正プログラム | |
JP3731686B2 (ja) | 位置算出装置 | |
JPH0875479A (ja) | 電波航法装置 | |
CN114008488A (zh) | 用于在定位时进行误差评估的方法 | |
JP2019039767A (ja) | 位置推定装置および自動運転システム | |
JP6839677B2 (ja) | 移動距離測定装置、移動距離測定方法、及び移動距離測定プログラム | |
JP4530929B2 (ja) | 現在位置算出装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20180731 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20180828 |
|
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: 20181002 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20181009 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6419242 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |