JP5066367B2 - Position detection method - Google Patents
Position detection method Download PDFInfo
- Publication number
- JP5066367B2 JP5066367B2 JP2007003840A JP2007003840A JP5066367B2 JP 5066367 B2 JP5066367 B2 JP 5066367B2 JP 2007003840 A JP2007003840 A JP 2007003840A JP 2007003840 A JP2007003840 A JP 2007003840A JP 5066367 B2 JP5066367 B2 JP 5066367B2
- Authority
- JP
- Japan
- Prior art keywords
- position detection
- detection device
- relative position
- absolute position
- absolute
- 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
Images
Landscapes
- Navigation (AREA)
- Traffic Control Systems (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Description
本発明は、位置検知方法に係り、特に、GPSなどの測位衛星、無線LAN,無線ビーコン,無線通信網の基地局情報、RFIDなどを使い位置を検知する絶対位置検知方法と、移動物体の移動方向および移動距離を積分して相対的な位置を検知する相対位置検知方法とを融合し、位置をシームレスかつ高精度に検知する位置検知方法に関する。 The present invention relates to a position detection method, in particular, an absolute position detection method for detecting a position using a positioning satellite such as GPS, a wireless LAN, a wireless beacon, base station information of a wireless communication network, RFID, and the like, and movement of a moving object The present invention relates to a position detection method for detecting a position seamlessly and with high accuracy by integrating a relative position detection method for detecting a relative position by integrating a direction and a moving distance.
相対位置の自立測位手段とGPSによる絶対位置の測位手段とを用いて自立測位手段の測位位置を補正する方法が提案されている(例えば、特許文献1参照)。 There has been proposed a method of correcting the positioning position of the self-supporting positioning means by using the self-supporting positioning means of the relative position and the positioning means of the absolute position by GPS (for example, see Patent Document 1).
特許文献1の方法では、自立測位手段で検知した相対位置とGPSで検知した絶対位置との差分(距離)を観測し、この差分が予め決められた閾値を越えた場合に、自立測位の誤差が大きくなったと判断し、自立測位手段の相対位置をGPSにより測位した絶対位置に補正する。
In the method of
また、GPSで測位した計測点と自立測位により得られた計測点との誤差が最小になるようにする方法も提案されている(例えば、特許文献2参照)。 In addition, a method for minimizing an error between a measurement point measured by GPS and a measurement point obtained by independent positioning has been proposed (for example, see Patent Document 2).
特許文献2の方法では、まず、GPSの移動軌跡と自立測位で求めた移動軌跡との残差平方和が最小になるように、自立測位に使われている方位センサや速度センサのパラメータおよび初期位置/初期方位の値を求める。次に、求めたパラメータを用いて、自立測位の計算を再度実施し、自立測位で求めた移動軌跡の精度を高める。
In the method of
さらに、GPSの衛星が見えていない場合や、GPSで求めた絶対位置と自立測位で求めた相対位置との差(距離)が予め決められた閾値よりも大きい場合には、その点を除いて自立測位用センサのパラメータを求めることも提案されている。 Furthermore, when the GPS satellite is not visible, or when the difference (distance) between the absolute position obtained by GPS and the relative position obtained by independent positioning is larger than a predetermined threshold value, excluding that point It has also been proposed to determine the parameters of a self-supporting positioning sensor.
特許文献1の従来方法では、GPS測位と自立測位の位置との差分が大きくなった場合に、自立測位の測位点をGPS側の測位点に平行移動し補正している。したがって、切り換えた時点のGPSによる測位位置を自立測位の初期位置として位置計算をすることになる。
In the conventional method of
ところが、この位置でのGPSの位置精度に関しては十分な配慮が無く、切り換え時点のGPSの位置精度が悪い場合には、切り換え後の誤差が大きくなるおそれがある。 However, there is no sufficient consideration for the GPS position accuracy at this position, and if the GPS position accuracy at the time of switching is poor, the error after switching may increase.
なお、GPS誤差に関して一定時間GPSで測位できない場合、その後測位しても最初の測位位置を用いて補正しないとしている。しかし、この判断だけでは、GPSの精度を評価するには不十分である。 Note that if the GPS error cannot be determined by GPS for a certain period of time, the first positioning position is not corrected even if positioning is performed thereafter. However, this determination alone is insufficient to evaluate the accuracy of GPS.
特許文献2の従来方法では、GPSによる移動軌跡と自立測位による移動軌跡とより、方位センサのゲイン補正値,オフセット補正値,車速センサの距離変換係数,初期位置,初期方位を残差平方和が最小になるように求めている。
In the conventional method of
しかし、全てのパラメータを同時に求めることは困難であり、方位センサのゲイン補正値とオフセット補正値とは、パラメータ値を変化させて総当たり方式で値を求めている。したがって、計算コストの増大が懸念される。 However, it is difficult to obtain all the parameters at the same time, and the gain correction value and the offset correction value of the azimuth sensor are obtained by a brute force method by changing the parameter value. Therefore, there is a concern about an increase in calculation cost.
また、GPSの信頼性評価に関しては、特許文献1と同様に、GPS測位の測位点と自立測位の測位点との距離の差を評価関数として用いている。例えば、方位センサのオフセットの値が正しくない場合、GPSの誤差が少ない環境で直線上を移動したとしても、時間が経つにつれて、GPS測位値と自立測位値とは離れてしまう。
As for the reliability evaluation of GPS, as in
2つの測位方法の距離の差を評価関数とし、この距離の差が閾値を越えた場合、GPSの精度が悪くなっていると判定され、正しく補正されない場合が発生する。 If the difference between the distances of the two positioning methods is used as an evaluation function, and the difference between the distances exceeds a threshold value, it is determined that the accuracy of the GPS has deteriorated and correction may not be performed correctly.
また、特許文献2では、既に計測した区間において取得した補正パラメータを用いて、自立測位結果を内挿する処理を示している。
Further,
しかし、新たに取得した自立測位用のデータを用いて補正したパラメータにより測位位置を外挿する方法は示されていない。したがって、データ取得後の後処理により精度を高めることが主目的であり、GPS測位と自立測位とを実時間で並列処理し精度を上げる方法にはなっていない。 However, there is no method for extrapolating the positioning position using the parameters corrected using the newly acquired data for independent positioning. Therefore, the main purpose is to improve the accuracy by post-processing after data acquisition, and it is not a method for improving the accuracy by parallel processing GPS positioning and independent positioning in real time.
本発明の課題は、絶対位置検知装置による移動軌跡に相対位置検知装置による移動軌跡をフィッティングさせる際に、少ない種類のパラメータで相対位置検知装置の位置を高精度に決定し維持する位置検知方法を提供することである。 An object of the present invention is to provide a position detection method for accurately determining and maintaining the position of a relative position detection device with a small number of parameters when fitting a movement track by a relative position detection device to a movement track by an absolute position detection device. Is to provide.
本発明は、上記課題を解決するために、相対位置検知装置の出力値と絶対位置検知装置の出力値とを併用して位置を検知する位置検知方法において、任意の時間区間における前記相対位置検知装置の出力値および前記絶対位置検知装置の出力値の差分のばらつきが大きく、精度が低下していると判断したデータを除外し、絶対位置検知装置の移動軌跡に相対位置検知装置で求めた移動軌跡をフィッティングさせるための回転角および移動量を求め、相対的位置検知装置の最新位置を上記回転角および移動量で補正し、補正された位置から新たな移動軌跡の検知を開始する位置検知方法を提案する。 The present invention, in order to solve the above problems, in the position detecting method for detecting the position in combination with the output value of the output value of the absolute position detecting apparatus of the relative position detecting device, the relative position detection at any time interval The movement obtained by the relative position detection device in the movement locus of the absolute position detection device is excluded by excluding the data determined that the difference between the output value of the device and the output value of the absolute position detection device is large and the accuracy is lowered. A position detection method for obtaining a rotation angle and a movement amount for fitting a locus, correcting the latest position of the relative position detection device with the rotation angle and the movement amount, and starting detection of a new movement locus from the corrected position. Propose.
本発明は、また、相対位置検知装置の出力値と絶対位置検知装置の出力値とを併用して位置を検知する位置検知方法において、任意の時間区間における前記相対位置検知装置の出力値および前記絶対位置検知装置の出力値の差分のばらつきが大きく、精度が低下していると判断したデータを除外し、絶対位置検知装置の移動軌跡に相対位置検知装置で求めた移動軌跡をフィッティングさせるための回転角および移動量を求め、相対的位置検知装置の最新位置を上記回転角および移動量で補正し、補正された位置から新たな移動軌跡の検知を開始し、絶対位置検知装置の利用可能な新たな位置情報が得られるまでは、相対位置検知装置の出力値を上記回転角および移動量で補正し続ける位置検知方法を提案する。 The present invention also provides a position detection method for detecting a position by using an output value of a relative position detection device and an output value of an absolute position detection device in combination, the output value of the relative position detection device in an arbitrary time interval, and the Excludes data for which the difference in the output value of the absolute position detection device is large and the accuracy is reduced, and excludes the movement locus obtained by the relative position detection device from the movement locus of the absolute position detection device. Obtain the rotation angle and movement amount, correct the latest position of the relative position detection device with the rotation angle and movement amount, start detecting a new movement locus from the corrected position, and use the absolute position detection device Until new position information is obtained, a position detection method is proposed in which the output value of the relative position detection device is continuously corrected with the rotation angle and the movement amount.
より具体的には、相対位置検知装置の出力値と絶対位置検知装置の出力値とを併用して位置を検知する位置検知方法において、任意の時間区間における前記相対位置検知装置の出力値および前記絶対位置検知装置の出力値の差分のばらつきが大きく、精度が低下していると判断したデータを除外し、絶対位置検知装置の移動軌跡に相対位置検知装置で求めた移動軌跡をフィッティングさせるために、同じ時刻に測位した位置同士の距離が最小になるように、相対位置検知装置で検知した任意の時間区間における移動軌跡全体の回転角および平行移動量を求め、相対的位置検知装置の最新位置を上記回転角および平行移動量で補正し、補正された位置から新たな移動軌跡の検知を開始する。 More specifically, in the position detection method for detecting the position by using the output value of the relative position detection device and the output value of the absolute position detection device in combination, the output value of the relative position detection device in any time interval and the In order to fit the movement trajectory obtained by the relative position detection device to the movement trajectory of the absolute position detection device by excluding data judged that the difference in the output value of the absolute position detection device is large and the accuracy is lowered. In order to minimize the distance between the positions measured at the same time, the rotation angle and the parallel movement amount of the entire movement locus in an arbitrary time interval detected by the relative position detection device are obtained, and the latest position of the relative position detection device is obtained. Is corrected by the rotation angle and the parallel movement amount, and detection of a new movement locus is started from the corrected position.
さらに、相対位置検知装置の出力値と絶対位置検知装置の出力値とを併用して位置を検知する位置検知方法において、任意の時間区間における前記相対位置検知装置の出力値および前記絶対位置検知装置の出力値の差分のばらつきが大きく、精度が低下していると判断したデータを除外し、絶対位置検知装置の移動軌跡に相対位置検知装置で求めた移動軌跡をフィッティングさせるために、同じ時刻に測位した位置同士の距離が最小になるように、相対位置検知装置で検知した任意の時間区間における移動軌跡全体の回転角および平行移動量を求め、相対的位置検知装置の最新位置を上記回転角および平行移動量で補正し、補正された位置から新たな移動軌跡の検知を開始し、絶対位置検知装置の利用可能な新たな位置情報が得られるまでは、相対位置検知装置の出力値を上記回転角および平行移動量で補正し続け、相対位置検知装置による自立測位を延長する。 Further, in the position detection method for detecting the position by using the output value of the relative position detection device and the output value of the absolute position detection device together, the output value of the relative position detection device and the absolute position detection device in an arbitrary time interval In order to fit the movement trajectory obtained by the relative position detection device to the movement trajectory of the absolute position detection device at the same time, excluding data determined that the difference in output value difference is large and the accuracy is reduced. The rotation angle and the parallel movement amount of the entire movement trajectory in an arbitrary time interval detected by the relative position detection device are obtained so that the distance between the measured positions is minimized, and the latest position of the relative position detection device is determined as the rotation angle. Until the new position information that can be used by the absolute position detection device is obtained. The output value of the relative position detecting device continues corrected by the rotational angle and amount of translation, to extend the self-contained positioning by the relative position detecting apparatus.
本発明によれば、絶対位置検知装置による移動軌跡に相対位置検知装置による移動軌跡をフィッティングさせる際に、位置を高精度に検知できる。 ADVANTAGE OF THE INVENTION According to this invention, when fitting the movement locus | trajectory by a relative position detection apparatus to the movement locus | trajectory by an absolute position detection apparatus, a position can be detected with high precision.
また、絶対位置検知装置の誤差の評価が可能となり、その評価を利用して相対位置検知装置の補正パラメータを変更するか否かを判断し、位置を高精度に検知できる。 In addition, it is possible to evaluate the error of the absolute position detection device, and use the evaluation to determine whether to change the correction parameter of the relative position detection device and to detect the position with high accuracy.
次に、図1〜図15を参照して、本発明による位置検知装置の実施例を説明する。 Next, with reference to FIGS. 1-15, the Example of the position detection apparatus by this invention is described.
図1は、本発明による位置検知装置の一実施例の系統構成を示すブロック図である。 FIG. 1 is a block diagram showing a system configuration of an embodiment of a position detection apparatus according to the present invention.
位置検知装置100は、歩行者200や車両202などの位置を検知する。位置検知対象は、位置検知装置100を所持する歩行者200や、位置検知装置10を搭載する車両202に限らない。
The
位置検知装置100は、移動量検知装置101と、移動方向検知装置102と、相対位置検知装置103と、相対位置検知装置出力値履歴メモリ104と、絶対位置検知装置105と、絶対位置検知装置出力値履歴メモリと、処理手段17と、位置表示装置108と、処理後の移動軌跡記憶用メモリ109とを含んでいる。
The
相対位置検知装置103は、移動量検知装置101および移動方向検知装置102の出力に基づいて、相対移動量および相対移動方向を検知する。
The relative
相対位置検知装置履歴メモリ104は、相対位置検知装置103の出力値を記憶する。例えば、相対移動量や相対移動方向を時刻とともに記憶する。
The relative position detection
絶対位置検知装置履歴メモリ106は、絶対位置検知装置105の出力履歴を記憶する。例えば、位置検知実行サイクル毎に出力される位置情報や方位情報を位置検知時刻とともに記憶する。
The absolute position detection
処理手段107は、本実施例で説明する処理手順を実行する。
The
位置表示装置108は、処理手段107で処理され検知した位置情報を表示する。すなわち、検知した移動軌跡を表示したり、地図と重ねて自分の位置を表示したりする。
処理後移動軌跡メモリ109は、今までに通ってきた移動軌跡を記憶し、移動軌跡を再利用する場合に備える。
The
The post-processing
なお、位置表示装置108および処理後移動軌跡メモリ109は、必須ではない。例えばナビゲーションへの利用であれば、位置表示装置108は必要であるが、処理後移動軌跡メモリ109は無くてもよい。これとは逆に、行動履歴を検知する装置の場合は、位置表示装置108は必須ではなく、処理後移動軌跡メモリ109だけがあればよい。
Note that the
さらに、検知した位置情報を無線などを利用して外部装置に伝送し、外部装置側で検知対象の物体を監視する場合は、位置表示装置108や処理後移動軌跡メモリ109は要らない。
Further, when the detected position information is transmitted to an external device using wireless or the like, and the object to be detected is monitored on the external device side, the
本実施例1は、絶対位置検知装置105で求めたある区間の移動軌跡に対して、相対位置検知装置103で求めた移動軌跡の誤差が最小になるように座標変換し、フィッティングの位置精度を高める方法を採用する。
In the first embodiment, coordinate conversion is performed on the movement locus of a certain section obtained by the absolute
絶対位置検知装置105の代表例としては、GPSがある。絶対位置検知装置105としては、GPSの他に、GPS衛星以外の測位衛星を用いた衛星測位システム、無線LANや無線ビーコン等の無線伝送手段を使い複数の無線局(既知の位置)から移動物体までの距離を計測し位置を検知するシステム、位置が分かっているRFIDやビーコンの識別情報を読み込み識別情報と位置との対応より位置を検知するシステムなどがある。すなわち、絶対位置検知装置105は、どこかに固定された基準点からの位置関係を直接検知する手段を用いて自分の絶対位置を検知する。
A representative example of the absolute
これに対して、相対位置検知装置103は、基準になる位置から変位量の積算処理により位置を検知する装置である。相対位置検知装置103の代表例としては、慣性航法装置がある。相対位置検知装置103は、基準点からの単位時間当たりの移動量および移動方向の変化を積算して位置を検知する。
On the other hand, the relative
図2は、実施例1の位置検知装置で実行する位置検知処理手順の概要を示すフローチャートである。 FIG. 2 is a flowchart illustrating an outline of a position detection processing procedure executed by the position detection apparatus according to the first embodiment.
ステップ1:絶対位置検知装置105は、現在位置を検知し、絶対位置検知装置出力値履歴メモリ106に過去の移動軌跡および現在位置として各時刻における絶対位置を記憶させる。
Step 1: The absolute
ステップ2:相対位置検知装置103は、移動量検知装置101および移動方向検知装置102の出力を取り込み、相対位置検知装置履歴メモリ104に過去の移動軌跡および現在位置として各時刻における相対位置を記憶させる。相対移動軌跡は、一番古い時刻を初期位置とし記憶されている移動量および移動方向の変化を積算して求められる。
Step 2: The relative
ステップ3:処理手段107は、フィッティングパラメータ算出手順において、ステップ1およびステップ2の移動軌跡の同時刻における距離の合計が最小となるように、ステップ2の移動軌跡全体の回転角および平行移動量を求める。
Step 3: In the fitting parameter calculation procedure, the processing means 107 calculates the rotation angle and the parallel movement amount of the entire movement trajectory in
なお、相対位置検知装置103による位置検知において移動量や移動方向の検知誤差が大きい場合、最適にフィッティングできない。
In addition, when the detection error of the movement amount or the movement direction is large in the position detection by the relative
また、絶対位置検知装置105においても、部分的に測位誤差が発生している場合、最適にフィッティングできない。例えば、GPSでは、GPS衛星が見えなくなったり、マルチパスなどによる測位誤差が生じたりして、測位誤差が生じる。
Further, even in the absolute
ここでは、原理的動作を説明するために、誤差が少ないと仮定する。相対位置検知装置103で生じる移動量や移動方向の検知誤差を修正しながらフィッティングさせる方法や、絶対位置検知装置105で生じる部分的な誤差を修正しながらフィッティングさせる方法は、後の実施例で説明する。
Here, in order to explain the principle operation, it is assumed that the error is small. The method of fitting while correcting the detection error of the movement amount and the movement direction generated in the relative
このように最適にフィッティングできない場合を除けば、ステップ1の移動軌跡にステップ2の移動軌跡をフィッティングさせるための補正パラメータは、ステップ2の移動軌跡全体を回転させる回転角度と平行移動とになる。すなわち、ステップ2の移動軌跡の初期位置での進行方向および初期位置の絶対位置がフィッティングパラメータとして求められる。
Except for the case where the optimal fitting cannot be performed in this way, the correction parameter for fitting the movement locus of
ステップ4:ステップ2の移動軌跡をステップ1の移動軌跡にフィッティングさせるためにステップ3で求めた補正パラメータを用いて、ステップ2の移動軌跡を再計算する。具体的には、ステップ3で求めた初期位置の絶対位置および初期位置を用いて、ステップ2と同様に積算処理する。
Step 4: In order to fit the movement locus in
なお、移動軌跡が不要で現在位置だけを補正したいのであれば、ステップ3で求めた回転角および平行移動量を用いて、ステップ2で求めた相対位置検知装置103による現在の位置座標をアフィン変換により求めてもよい。
If the movement locus is unnecessary and only the current position is to be corrected, the current position coordinates obtained by the relative
ステップ4で求めた移動軌跡は、ステップ1の絶対位置検知装置105で求めた移動軌跡に含まれている検出誤差による位置のばらつきを平均化することになり、ステップ1で求めた位置と比べて、ステップ4で求めた位置の方が高精度と考えられる。
The movement trajectory obtained in
現在位置だけを修正するのであれば、この処理手順4で処理は終了となり、ステップ6にジャンプし、現在位置を出力する。
If only the current position is to be corrected, the process ends in this
以後、新たなデータを取得する毎にこの処理を繰り返し、現在位置を更新していく。 Thereafter, this process is repeated each time new data is acquired, and the current position is updated.
ステップ5:ステップ4の処理は、絶対位置検知装置105から絶対位置が出力された最新時刻までのステップ2の移動軌跡を再計算している。これに対し、ステップ5では、ステップ4で求めた初期情報を基準として、それ以後に相対位置検知装置103で取得した移動および進行方向の情報を積算し位置を更新し続ける。絶対位置検知装置105から新たな情報が出力されたときには、ステップ1〜ステップ4の処理に戻り、現在位置を更新し、その後の位置を再計算していく。このステップ5により、位置精度を高めるとともに、絶対位置検知装置105で検知した位置間の移動軌跡を計算できることになる。
Step 5: The process of
ステップ5は、絶対位置検知装置105の絶対位置データ取得間隔と比べて、相対位置検知装置103の相対位置データ取得間隔が短い場合、絶対位置データが取得されるまで、ステップ4の処理を持続する手順である。例えば、GPSの測位間隔は通常1秒である。これに比べ、慣性航法装置の測位間隔は短く、数十〜数ミリ秒間隔で測位している。すなわち、相対位置検知装置103の時間分解能が、絶対位置検知装置105の時間分解能よりも高くなっている。
In
また、GPSでは、GPS衛星が見えなくなった場合など測位位置を出力しない場合がある。ステップ5は、新たな測位値が出力されるまでの補間方法としも使用できる。
Further, in the GPS, there are cases where the positioning position is not output, for example, when the GPS satellite becomes invisible.
ステップ6:ステップ4またはステップ5で得られた位置を表示装置108に出力するとともに、処理後移動軌跡メモリ109に蓄積する。
Step 6: The position obtained in
図3は、絶対位置検知装置105で検出した位置と相対位置検知装置103で検出した位置との関係を示す図である。
FIG. 3 is a diagram illustrating the relationship between the position detected by the absolute
点301から順に点306までが絶対位置検知装置105で検知した時系列の位置である。点311から順に点316までが相対位置検知装置103で検知した時系列の位置である。
点301と点311と、点302と点312と、〜、306と316とは、同じ時刻に検知した位置である。
Time points from the
相対位置検知装置103は、座標軸308に示すように、点311を初期位置(0,0)とし、初期方位をY軸方向(方位角0度)とし、移動量の変化および移動方向の変化を積算し、位置311〜316を検知する。
The relative
点318および点319などは、絶対位置検知装置105の出力間隔よりも短い間隔で検知された位置である。通常、相対位置検知装置103は、絶対位置検知装置105の出力周期よりも短い間隔で位置を検出しているので、絶対位置検知装置105よりも時間分解能が高い。
サークル300は、絶対位置検知装置105が検知した点301の位置誤差の範囲を表している。
絶対位置検知装置105で検知する場合、点301〜点306のように、離散的な位置となり、また各点においても、ある誤差範囲を伴う位置精度となる。
A
When the absolute
相対位置検知装置103の場合は、絶対位置検知装置105と比べれば、離散値の幅は狭くなる。しかし、絶対位置を検知できないので、初期位置311からの相対的な位置を検知することになる。
In the case of the relative
上記特許文献1では、例えば、点306および点316で、GPSの測位位置との差が大きくなった場合、GPSの測位位置に自立測位の測位位置を合わせている。
In
しかし、GPSで測位した点306には、GPSの測位誤差が含まれている。したがって、自立測位の初期位置316がGPSの測位誤差分だけずれてしまい、以後は正しい位置を検知できなくなる場合が生じる。
However, the GPS positioning error is included in the
図4は、図3の絶対位置検知装置105で検出した位置と相対位置検知装置103で検出した位置とを本発明でフィッティングする方法を示す図である。
FIG. 4 is a diagram illustrating a method of fitting the position detected by the absolute
これに対して、本実施例1では、図4に示すように、同じ時刻に測位した複数の位置が最小誤差でフィッティングするように、相対位置検知装置103の初期位置座標308を点330のように回転させるとともに、平行移動する。この修正により、相対位置検知装置103で検知した位置316が位置326となり、相対位置検知の精度が高まるとともに、それ以後に検知する位置327,328などの位置精度も高めることできる。
On the other hand, in the first embodiment, as shown in FIG. 4, the initial position coordinates 308 of the relative
図5は、上記フィッティングパラメータの算出方法のより詳細な処理手順を示すフローチャートである。 FIG. 5 is a flowchart showing a more detailed processing procedure of the fitting parameter calculation method.
ステップ501:相対位置検知装置103は、移動量検知装置101および移動方向検知装置102からの最新の計測時刻Tn,角速度ΔΦn,前回計測した位置からの移動量Snを取得する。移動量Snは、速度すなわち単位時間の移動量に変換してから取り込んでもよい
ステップ502:相対位置検知装置103は、取得した値を相対位置検知装置履歴メモリ104に記憶させる。
Step 501: The relative
ステップ503:取り込み回数m回だけ遡った時刻Tn-mを初期方位とし、現在時刻Tnまでの各時刻Tn-(m-k)における進行方向をΦn-(m-k)を数式1により求める。
Step 503: Time Tn-m that is traced m times as the initial number of times is taken as the initial direction, and the traveling direction at each time Tn- (m-k) up to the current time Tn is obtained by
数式1のkを1からmまで変化させると、Tn-mからTnまでの各時刻における進行方向をΦn-(m-k)が得られる。
When k in
ステップ511:絶対位置検知装置105は、計測時刻Tn,絶対位置(Gxn,Gyn),絶対進行方位θnを取得する。
Step 511: The absolute
ステップ512:絶対位置検知装置105は、取得したそれぞれの値を絶対位置検知装置履歴メモリ106に記憶させる。
Step 512: The absolute
ステップ504:処理手段107は、絶対位置検知装置105および相対位置検知装置103で求めた各時刻における進行方向の差分を求める。
Step 504: The processing means 107 obtains a difference in traveling direction at each time obtained by the absolute
図6は、各時刻における進行方向の差分の一例を示す図である。図6の横軸601は、時刻Tを示し、縦軸602は、進行方向の差分を示し、点群603は、各時刻における差分の値を示している。
FIG. 6 is a diagram illustrating an example of a difference in traveling direction at each time. The
絶対位置検知装置105および相対位置検知装置103での方位検知に誤差が無ければ、時刻に関係なく、一定の値を示し、その値が、絶対位置検知装置105の初期方位および相対位置検知装置103の初期方位の差分の値となる。しかし、実際は、絶対位置検知装置105および相対位置検知装置103の計測誤差のために、点群603が示すように、ばらつきが生じている。
If there is no error in the azimuth detection in the absolute
本実施例1によれば、絶対位置検知装置105による移動軌跡に相対位置検知装置103による移動軌跡をフィッティングさせるパラメータを求め、このパラメータを用いて相対位置検知装置103で求めた移動軌跡を再計算し、位置精度を高め、絶対位置検知装置105により検知した複数の位置間における移動軌跡を計算できるようになる。
According to the first embodiment, a parameter for fitting the movement locus by the relative
ステップ505:処理手段107は、ばらつきの影響を排除するために、各時刻における方位差分αnの平均604を求める。この方位差分αnの平均は、最新時刻Tnのときの方位差分だけにより求めた値と比べて、高精度になっている。 Step 505: The processing means 107 obtains an average 604 of the azimuth difference αn at each time in order to eliminate the influence of variation. The average of the azimuth difference αn is more accurate than the value obtained only from the azimuth difference at the latest time Tn.
ステップ506:処理手段107は、求めた方位を初期方位として、数式2により、移動軌跡を計算する。
Step 506: The processing means 107 calculates a movement trajectory according to
数式2の処理により、絶対位置検知装置105で求めた移動軌跡の進行方向と相対位置検知装置103で求めた移動軌跡の進行方向とが一致することになる。
By the processing of
ステップ507:次に、平行移動量を求めるために、横方向(X方向)および縦方向(Y方向)独立に差分を取る。この差分も、図6と同様に、ばらつきはあるがほぼ一定の値となる。 Step 507: Next, in order to obtain the parallel movement amount, a difference is taken independently in the horizontal direction (X direction) and the vertical direction (Y direction). Similar to FIG. 6, this difference is also a substantially constant value with variations.
ステップ508:したがって、横方向(X方向)および縦方向(Y方向)の平均値は、相対位置検知装置103による移動軌跡を絶対位置検知装置105による移動軌跡に一致させるための平行移動量となる。
Step 508: Therefore, the average value in the horizontal direction (X direction) and the vertical direction (Y direction) is a parallel movement amount for making the movement locus by the relative
ステップ509:数式2で求めた移動軌跡を平行移動させると、相対位置検知装置103による移動軌跡を絶対位置検知装置105による移動軌跡に一致させることができる。なお、ステップ509では、最新計測値326だけを補正すればよいので、最新値のみを計算している。
Step 509: When the movement trajectory obtained by
以上の一連の処理により、初期状態での相対位置検知装置103による移動軌跡311〜316を図4の312〜326に変換し、絶対位置検知装置105による移動軌跡にフィッティングさせることができる。また、最新位置326の位置精度は、絶対位置検知装置105で求めた位置と比較して、過去の誤差を平均化した結果として得られるので、改善されている。
Through the series of processes described above, the
ステップ510:絶対位置検知装置105が次の計算サイクルで出力するTn+1までの間、ステップ506からステップ509までの処理を繰り返し、フィッティング処理を継続する。
Step 510: The processing from
ここまでは、絶対位置検知装置105と相対位置検知装置103とが、同じ時間間隔で検知情報を出力していると仮定してきた。実際には、累積誤差の縮小や時間分解能の改善のために、相対位置検知装置103の方が、絶対位置検知装置105よりも短い周期で位置を検知している。
So far, it has been assumed that the absolute
したがって、ステップ510は、Tn+1までフィッティング処理を延長する手順である。ステップ510においては、相対位置検知装置103から出力される移動量,移動方向を用いて、ステップ506からステップ509までの処理を繰り返す。その結果、例えば、図4の点327,328などの位置を高精度に検知できる。
Therefore,
なお、絶対位置検知装置105の計測時刻と相対位置検知装置103の計測時刻とは、サンプリング間隔の関係で、必ずしも一致するとは限らない。一致しない場合は、お互いに同じ時刻になるように前後の時刻のデータを補間し、同時刻の位置を推定してもよい。
Note that the measurement time of the absolute
これまで説明した処理は、絶対位置検知装置105による新たな位置出力が得られる毎に繰り返し、相対位置検知装置103による位置を補正していく。
The processing described so far is repeated every time a new position output is obtained by the absolute
本実施例1によれば、絶対位置検知装置105による移動軌跡に相対位置検知装置103による移動軌跡をフィッティングさせる際に、位置を高精度に検知できる。
According to the first embodiment, the position can be detected with high accuracy when the movement locus by the relative
次に、絶対位置検知装置105の精度が低下した場合でも、良好な精度を保って位置を検知する方法の実施例を説明する。
Next, an embodiment of a method for detecting a position with good accuracy even when the accuracy of the absolute
絶対位置検知装置105の精度低下の原因には、例えばGPSの場合、GPS測位衛星の見え方などが上げられる。空が開けていてGPS衛星が良く見える場所では、良好な精度で位置を検知できる。しかし、GPS衛星が見えなくなったり、GPS衛星は見えていても建物の反射などでマルチパスが生じ、GPS衛星までの距離が正しくない場合は、誤差が大きくなる。
The cause of the decrease in accuracy of the absolute
GPS衛星が見えない場合は、測位に使ったGPS衛星の数や衛星配置のばらつき度合いをGPS受信機が出力するので、これらのパラメータを精度の尺度として利用することも可能である。 When GPS satellites are not visible, the GPS receiver outputs the number of GPS satellites used for positioning and the degree of variation in the satellite arrangement, so these parameters can also be used as a measure of accuracy.
一方、マルチパスにより本来は建物の陰に隠れて見えないはずの衛生が見えてしまった場合などは、GPS受信機側でそれを判別することが難しく、測位衛星数や衛星配置のばらつきだけでは判断できない場合が生じる。建物の入口付近などは、マルチパスの影響を受けやすい場所であり、相対位置検知装置103の初期条件の精度が悪化する原因となる。
On the other hand, when the hygiene that should have been hidden by the multipath is supposed to be hidden, it is difficult to determine it on the GPS receiver side. There are cases where it cannot be determined. The vicinity of the entrance of the building and the like is a place that is easily affected by multipath, and causes the accuracy of the initial conditions of the relative
図7は、実施例2の位置検知装置で実行する位置検知処理手順の概要を示すフローチャートである。 FIG. 7 is a flowchart illustrating an outline of a position detection processing procedure executed by the position detection apparatus according to the second embodiment.
本実施例2においては、実施例1のフィッティングパラメータの算出処理に先立って、絶対位置検知装置105側の精度評価処理701と、フィッティングパラメータ算出対象の選択処理702とを追加している。その他の処理は、図1における処理と同じである。
In the second embodiment, prior to the fitting parameter calculation process of the first embodiment, an
絶対位置検知装置105側の精度評価処理701は、絶対位置検知装置105の出力と相対位置検知装置103の出力とにより、絶対位置出力装置105の精度を評価する手順である。
The
図8は、絶対位置検知装置105の出力値が低下した場合の出力の一例を示す図である。
点群801は、相対位置検知装置103から出力され、点群802は、絶対位置検知装置105から出力される。点群802のうちで区間803は、精度が低下した絶対位置出力装置105から出力されている。
FIG. 8 is a diagram illustrating an example of an output when the output value of the absolute
The
通常、短時間であれば、絶対位置検知装置105による軌跡形状よりも相対的位置検知装置103の軌跡形状の方が正確なので、区間803は、絶対位置検知装置105がまちがった位置を出力していることを示している。
Normally, since the trajectory shape of the relative
絶対位置検知装置105側の精度評価処理701は、方位の差分のばらつきまたは移動量のばらつきから、絶対位置検知装置105の出力値の精度を評価する。
The
図9は、相対位置検知装置103の初期方位の差とともに、絶対位置検知装置105側の方位差分のばらつきの一例を示す図である。図9の横軸は、時刻901を示し、縦軸は、方位差分902を示し、区間903が、図8で精度が低下した区間803に対応する。
FIG. 9 is a diagram illustrating an example of variation in the azimuth difference on the absolute
絶対位置検知装置105側の精度が低下していなければ、進行方向の差分は一定の値となるはずである。区間903では、精度が低下した区間803に対応して、方位の差分が乱れる。
If the accuracy on the absolute
ばらつき度合いを評価するため、所定の窓幅を持った区間を設定し、区間毎の分散を計算する。 In order to evaluate the degree of variation, a section having a predetermined window width is set, and the variance for each section is calculated.
図9の下の部分において、横軸905は、時刻を示し、縦軸906は、分散値を示している。例えば、908のように時刻Tn-m〜Tn-m+3までの区間の分散を取り、時刻915の分散値を計算し、次は時刻Tn-m+1〜Tn-m+4までの区間の分散を取り、時刻916の分散値値を得るような処理を時刻Tnまで繰り返す。
In the lower part of FIG. 9, the
図9の下の部分から明らかなように、絶対位置検知装置105の誤差が少ない場合には分散値が小さく、誤差が大きな区間は分散値が大きくなる。そこで、しきい値910を設定すると、絶対位置検知装置105の誤差を評価できる。
As is clear from the lower part of FIG. 9, the variance value is small when the error of the absolute
フィッティングパラメータ算出対象の選択処理702では、絶対位置検知装置105側の精度評価処理701の結果に基づいて、計測データをフィッティングパラメータの算出対象にするか否かを選択する。
In the fitting parameter calculation
図10は、フィッティングパラメータ算出対象の選択処理702の結果の一例を示す図である。白丸のデータ1001を除外し、黒丸のデータ1002をフィッティングパラメータの算出対象として残した。残したデータを用いれば、絶対位置検知装置105側のばらつきの影響を受けずに、方位の差分を計算し、相対位置検知装置103の初期方位を求めることができる。
FIG. 10 is a diagram illustrating an example of a result of the fitting parameter calculation
以後、この初期方位を用いて、処理4,5,6を実行すると、相対的位置検知装置103の出力を補正できる。
Thereafter, when the
本実施例2では、絶対位置検知装置105の出力値が低下を方位の差分で評価したが、各時刻の移動量の差分を採用しても、低下を評価できる。すなわち、精度の高い区間では所定時間の間に同じ距離だけ移動するが、精度が低下している場合は、同じ距離にならないことを利用する。
In the second embodiment, the decrease in the output value of the absolute
方位の差分と移動距離の差分とは、低下の評価の際に、一方を使ってもよいし両者を使ってもよい。 One of the azimuth difference and the movement distance difference may be used when evaluating the decrease.
また、処理対象として残ったデータの数が少ない場合には、フィッティングパラメータを更新しない処理を加えてもよい。残ったデータの数が少ないと、方位の差分を平均化しても、十分な精度が得られない場合がある。この場合、フィッティングパラメータをあえて更新しないで、前に求めたフィッティングパラメータを利用し、相対位置検知装置103による積算処理を延長し、位置を求めてもよい。
Further, when the number of data remaining as processing targets is small, a process for not updating the fitting parameters may be added. If the number of remaining data is small, sufficient accuracy may not be obtained even if the difference in orientation is averaged. In this case, the position may be obtained by updating the fitting parameter obtained before, using the fitting parameter obtained previously, and extending the integration processing by the relative
なお、本実施例2は、GPS受信機などで出力されている測位に使った測位衛星のばらつきなど、絶対位置検知装置105自体が出力している誤差推定値と組み合わせてもよい。
The second embodiment may be combined with an error estimation value output by the absolute
本実施例2によれば、絶対位置検知装置105の誤差の評価が可能となり、これを利用して相対位置検知装置103の補正パラメータの変更を制御し、位置を高精度に検知できる。
According to the second embodiment, the error of the absolute
次に、相対位置検知装置103の誤差の原因となる移動方向検知装置102の0点オフセット補正および移動量検知装置101のゲイン補正について説明する。
Next, the zero point offset correction of the movement
図11は、移動方向検知装置102および移動量検知装置101のパラメータを補正する手順を加えた位置検知方法の処理手順を示すフローチャートである。
FIG. 11 is a flowchart showing a processing procedure of the position detection method to which a procedure for correcting parameters of the movement
これまでの実施例では、説明を簡単にするために、移動方向検知装置102の0点オフセット値および移動量検知装置101のゲイン誤差に関する影響を考慮しなかった。これらの誤差による影響は、短時間であれば、非常に少なく、絶対位置検知装置105の移動軌跡により頻繁に補正できる場合は、無視してもよい。
In the embodiments described so far, in order to simplify the description, the influence on the zero-point offset value of the movement
しかし、屋内に入ってしまった場合など絶対位置検知装置105の移動軌跡による補正を頻繁には実行できない場合、誤差の蓄積が無視できなくなってくる。
However, if correction based on the movement locus of the absolute
そこで、本実施例3では、移動方向検知装置102の0点オフセット補正ステップ1101および移動量検知装置101の速度の補正ステップ1102を追加する。
Therefore, in the third embodiment, a zero point offset
まず、0点オフセット補正ステップ1101では、ジャイロセンサすなわち移動方向検知装置102のオフセットを補正し、初期方位を補正する。
First, in the zero point offset
ジャイロセンサのオフセット補正が正しくない場合、絶対位置検知装置105と相対位置検知装置103との差分は、図12に示すような関係になる。
When the offset correction of the gyro sensor is not correct, the difference between the absolute
図12は、移動方向検知装置102の0点オフセット誤差がある場合の方位差分の時間的変化を示す図である。角速度が0の場合、移動方向検知装置102の出力は、0となるはずである。雑音があっても平均値は0となる。0点オフセットとは、静止状態でも、移動方向検知装置102の出力の平均値が0とならない状態をいう。0点オフセットがあると、角速度の積算で方位を検知する移動方向検知装置102では、この誤差が、線1203で示すように蓄積して、大きな方位誤差となってしまう。
FIG. 12 is a diagram illustrating a temporal change in the azimuth difference when there is a zero-point offset error of the movement
図12のように単調増加または単調減少するのは、角速度が0のときにジャイロセンサのオフセットが0になっていないからである。したがって、時刻n-(m-1)からnまでのm個の点を最小二乗法を用いて求めた傾きΔα(1204)を求めると、ジャイロセンサのオフセット量のずれを求めることができる。求めた傾きΔαは、単位時間当たりのずれなので、このずれの量を取得した角速度から差し引けば、ジャイロセンサのオフセット補正が可能になる。 The reason why the monotonous increase or monotonous decrease as shown in FIG. 12 is because the offset of the gyro sensor is not zero when the angular velocity is zero. Therefore, when the slope Δα (1204) obtained by using the least square method for m points from time n− (m−1) to n is obtained, a deviation in the offset amount of the gyro sensor can be obtained. Since the obtained inclination Δα is a deviation per unit time, the offset correction of the gyro sensor can be performed by subtracting the deviation amount from the acquired angular velocity.
また、切片1205は絶対方位との差分を示している。したがって、この切片1205を用いると、絶対方位の補正も可能になる。
An
次に、速度の補正ステップ1102では、相対位置検知装置103から出力された速度を補正する。
Next, in a
図13は、相対位置検知装置103から出力された速度を補正する処理と絶対位置検知装置105の精度を評価する手順とを併せて実行する処理手順を示すフローチャートである。
FIG. 13 is a flowchart showing a processing procedure for executing a process for correcting the velocity output from the relative
図14は、相対位置検知装置103の速度ゲインに誤差がある場合の速度と絶対位置検知装置105から求めた速度と相対位置検知装置103から求めた速度との関係を示す図である。
FIG. 14 is a diagram illustrating a relationship between a speed when the speed gain of the relative
相対位置検知装置103の速度と絶対位置検知装置105の速度とがいかなる速度でも等しい場合は、線1505の傾きは、1となる。しかし、相対位置検知装置103の検知速度に誤差があると1にはならず、例えば線1504のような傾きを示す。
When the speed of the relative
そこで、相対位置検知装置103の速度と絶対位置検知装置105の速度とをパラメータとして描画した散布図の傾きが1となるように相対位置検知装置103の速度出力を補正し、速度の誤差を解消する。
Therefore, the speed output of the relative
相対位置検知装置103の速度と絶対位置検知装置105との速度とから、最小二乗法を用いて傾きを算出し、求めた傾きで相対位置検知装置103の速度を除算すると、速度を補正できる。
The speed can be corrected by calculating the inclination from the speed of the relative
移動方向検知装置102の0点オフセット補正ステップ1101および移動量検知装置101の速度の補正ステップ1102が完了したら、ステップ1103では、補正された方位および速度を用いて、フィッティングパラメータを算出する。
When the zero point offset
以後は、図1または図7と同様に、ステップ4およびステップ5を用いて、移動軌跡および位置を算出する。
Thereafter, similarly to FIG. 1 or FIG. 7, the movement trajectory and the position are calculated using
図15は、絶対位置検知装置105の精度が低下し、しかも、移動方向検知装置102の0点オフセットに誤差がある場合に、絶対位置検知装置105から出力された方位と相対位置検知装置103から出力された方位の差分の一例を示す図である。
FIG. 15 shows the azimuth output from the absolute
絶対位置検知装置105の精度低下による方位変動が点群1601として現れ、移動方向検知装置102の0点オフセットに誤差による傾きが1604として現れている。
An azimuth variation due to a decrease in accuracy of the absolute
図13のステップ1401では、分散を用いて、図9に示した手順と同様に、絶対位置検知装置105の精度低下部分の有無を判定する。
In
ステップ1402では、図10に示した手順と同様に、精度が低下したと判定された部分を処理対象から除外する。
In
これらの処理により、絶対位置検知装置105の精度が低下した部分のデータを除去できる。
By these processes, the data of the portion where the accuracy of the absolute
以後は、ステップ1101から1103で、図11で説明した方法と同様に、移動方向検知装置102の0点オフセット値および移動量検知装置101のゲイン誤差を補正する。
Thereafter, in
最後に、ステップ4および5の処理を実行し、相対的位置検知装置103で検知した位置を補正した位置を出力する。
Finally, the processes of
本実施例3によれば、本実施例3によれば、絶対位置検知装置105の出力値に精度の低下がある場合でも、その影響を除外し、しかも、移動方向検知装置102の0点オフセット補正および移動量検知装置101のゲインを補正し、位置を高精度に検知できる。
According to the third embodiment, according to the third embodiment, even if the output value of the absolute
100 位置検知装置
101 移動量検知装置
102 移動方向検知装置
103 相対位置検知装置
104 相対位置検知装置出力値履歴メモリ
105 絶対位置検知装置
106 絶対位置検知装置出力値履歴メモリ
107 処理手段
108 位置表示装置
109 処理後の移動軌跡記憶用メモリ
200 歩行者
202 車両
DESCRIPTION OF
Claims (8)
任意の時間区間における前記相対位置検知装置の出力値および前記絶対位置検知装置の出力値の差分のばらつきが大きく、精度が低下していると判断したデータを除外し、
前記絶対位置検知装置の移動軌跡に前記相対位置検知装置で求めた移動軌跡をフィッティングさせるための回転角および移動量を求め、
前記相対的位置検知装置の最新位置を上記回転角および移動量で補正し、補正された位置から新たな移動軌跡の検知を開始するものとし、
前記回転角および前記移動量を補正した後の前記相対位置検知装置で検知した位置座標と前記絶対位置検知装置で検知した位置座標に基づいて、精度が低下していると判断したデータを、利用可能な絶対位置検知装置の位置情報から除外することを特徴とする位置検知方法。 In the position detection method for detecting the position by using the output value of the relative position detection device and the output value of the absolute position detection device in combination,
Excludes data determined to have a large variation in the difference between the output value of the relative position detection device and the output value of the absolute position detection device in an arbitrary time interval, and the accuracy has decreased,
Obtaining a rotation angle and a movement amount for fitting the movement locus obtained by the relative position detection device to the movement locus of the absolute position detection device;
The latest position of the relative position detection device is corrected with the rotation angle and the movement amount, and detection of a new movement locus is started from the corrected position .
Based on the position coordinates detected by the relative position detection device after correcting the rotation angle and the movement amount and the position coordinates detected by the absolute position detection device, data that has been determined to have decreased accuracy is used. A position detection method characterized in that it is excluded from position information of a possible absolute position detection device .
前記絶対位置検知装置の利用可能な新たな位置情報が得られるまでは、前記相対位置検知装置の出力値を上記回転角および移動量で補正し続けることを特徴とする位置検知方法。 In the position detection method according to claim 1,
A position detection method characterized in that the output value of the relative position detection device is continuously corrected with the rotation angle and the movement amount until new position information that can be used by the absolute position detection device is obtained .
任意の時間区間における前記絶対位置検知装置で検知した方位と前記相対位置検知装置で検知した方位との差分を求め、
前記差分のばらつきが大きい部分を精度が低下していると判断し、
利用可能な絶対位置検知装置の位置情報から除外することを特徴とする位置検知方法。 The position detection method according to claim 1 or 2,
Find the difference between the direction detected by the absolute position detection device and the direction detected by the relative position detection device in an arbitrary time interval,
Judge that the accuracy of the portion where the variation of the difference is large is reduced,
A position detection method, characterized in that it is excluded from position information of an available absolute position detection device.
任意の時間区間における前記絶対位置検知装置で検知した速度と前記相対位置検知装置で検知した速度との差分を求め、
前記差分のばらつきが大きい部分を精度が低下していると判断し、
利用可能な絶対位置検知装置の位置情報から除外することを特徴とする位置検知方法。 The position detection method according to claim 1 or 2,
Find the difference between the speed detected by the absolute position detector and the speed detected by the relative position detector in an arbitrary time interval,
Judge that the accuracy of the portion where the variation of the difference is large is reduced,
A position detection method, characterized in that it is excluded from position information of an available absolute position detection device.
前記絶対位置検知装置の移動軌跡に前記相対位置検知装置で求めた移動軌跡をフィッティングさせるために、同じ時刻に測位した位置同士の距離が最小になるように、前記相対位置検知装置で検知した任意の時間区間における移動軌跡全体の回転角および平行移動量を求めることを特徴とする位置検知方法。 The position detection method according to claim 1 or 2,
For fitting the moving track obtained by the relative position detecting apparatus in the movement locus of the previous SL absolute position sensing device, so that the distance of the position each other and positioning the same time is minimized, and detected by the relative position detecting device position detecting method, wherein the determined Melco rotation angle and parallel movement amount of the entire movement locus at any time interval.
前記絶対位置検知装置の移動軌跡に前記相対位置検知装置で求めた移動軌跡をフィッティングさせるために、同じ時刻に測位した位置同士の距離が最小になるように、前記相対位置検知装置で検知した任意の時間区間における移動軌跡全体の回転角および平行移動量を求め、
前記絶対位置検知装置の利用可能な新たな位置情報が得られるまでは、前記相対位置検知装置の出力値を上記回転角および平行移動量で補正し続け、前記相対位置検知装置による自立測位を延長することを特徴とする位置検知方法。 The position detection method according to claim 2,
For fitting the moving track obtained by the relative position detecting apparatus in the movement locus of the previous SL absolute position sensing device, so that the distance of the position each other and positioning the same time is minimized, and detected by the relative position detecting device calculated Me rotation angle and parallel movement amount of the entire movement locus at any time interval,
Until new location information available before Symbol absolute position sensing device is obtained, the output value of said relative position detecting device continues to correction by the rotation angle and parallel movement amount, the self-contained positioning by the relative position detecting device A position detection method characterized by extending.
前記回転角を求める手順が、前記絶対位置検知装置による方位と前記相対位置検知装置で用いる方位との時系列差分データに基づいて最小二乗法により傾きおよび切片を求め、移動方向検知のオフセット補正値およびゲイン補正値を求める手順を含むことを特徴とする位置検知方法。 In the position detection method according to any one of claims 1 to 6 ,
The procedure for obtaining the rotation angle is to obtain an inclination and an intercept by a least square method based on time series difference data between an azimuth by the absolute position detector and an azimuth used by the relative position detector, and an offset correction value for moving direction detection And a position detection method characterized by including a procedure for obtaining a gain correction value.
前記移動量を求める手順が、前記絶対位置検知装置による速度と相対位置検知装置による速度との差に基づいて移動量検知のゲイン補正値を求める手順を含むことを特徴とする位置検知方法。 In the position detection method according to any one of claims 1 to 7 ,
The position detection method characterized in that the procedure for obtaining the movement amount includes a procedure for obtaining a gain correction value for movement amount detection based on a difference between a speed by the absolute position detection device and a speed by the relative position detection device.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007003840A JP5066367B2 (en) | 2007-01-11 | 2007-01-11 | Position detection method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007003840A JP5066367B2 (en) | 2007-01-11 | 2007-01-11 | Position detection method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2008170278A JP2008170278A (en) | 2008-07-24 |
JP5066367B2 true JP5066367B2 (en) | 2012-11-07 |
Family
ID=39698517
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007003840A Active JP5066367B2 (en) | 2007-01-11 | 2007-01-11 | Position detection method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5066367B2 (en) |
Families Citing this family (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010030404A (en) * | 2008-07-28 | 2010-02-12 | Visteon Global Technologies Inc | Position detection method and position detection apparatus for preceding vehicle and data filtering method |
JP5314502B2 (en) * | 2009-05-29 | 2013-10-16 | 三菱重工業株式会社 | Vehicle position measuring device and vehicle position measuring method |
US8843340B2 (en) | 2010-06-23 | 2014-09-23 | Aisin Aw Co., Ltd. | Track information generating device, track information generating method, and computer-readable storage medium |
JP5557015B2 (en) * | 2010-06-23 | 2014-07-23 | アイシン・エィ・ダブリュ株式会社 | Trajectory information generation apparatus, method, and program |
JP5601188B2 (en) * | 2010-12-17 | 2014-10-08 | いすゞ自動車株式会社 | Positioning accuracy judgment device |
JP5598342B2 (en) * | 2011-01-14 | 2014-10-01 | 株式会社デンソー | Vehicle data recording device |
JPWO2014156385A1 (en) | 2013-03-27 | 2017-02-16 | 日本電気株式会社 | POSITIONING DEVICE, ITS CONTROL METHOD, AND PROGRAM |
JP2015034775A (en) * | 2013-08-09 | 2015-02-19 | カシオ計算機株式会社 | Route setting device, route setting method, and program |
KR101596707B1 (en) * | 2014-07-24 | 2016-02-23 | 주식회사 벤플 | Method for providing communication service between mobile terminals using near wireless device |
JP6701642B2 (en) * | 2015-08-18 | 2020-05-27 | 沖電気工業株式会社 | Position estimation system, position estimation device, position estimation method, and position estimation program |
JP6852310B2 (en) * | 2015-11-30 | 2021-03-31 | 株式会社リコー | Inertial device, program, positioning method |
DE102016213893A1 (en) * | 2016-07-28 | 2018-02-01 | Robert Bosch Gmbh | Method and device for determining the absolute position of a motor vehicle, location system, motor vehicle |
JP6995518B2 (en) * | 2017-07-10 | 2022-01-14 | 東芝テック株式会社 | Positioning equipment and positioning system |
JP6984817B2 (en) * | 2017-08-28 | 2021-12-22 | 国立大学法人岩手大学 | Position estimation method using wireless communication device, position estimation device and mobile communication device |
US20190196025A1 (en) * | 2017-12-21 | 2019-06-27 | Honda Motor Co., Ltd. | System and method for vehicle path estimation using vehicular communication |
JP7074087B2 (en) | 2019-01-25 | 2022-05-24 | 株式会社デンソー | Travel route prediction device |
JP7125927B2 (en) * | 2019-09-24 | 2022-08-25 | Kddi株式会社 | Information terminal device, method and program |
JP7418196B2 (en) * | 2019-12-12 | 2024-01-19 | 日産自動車株式会社 | Travel trajectory estimation method and travel trajectory estimation device |
JPWO2023105595A1 (en) * | 2021-12-06 | 2023-06-15 | ||
CN114922646B (en) * | 2022-04-02 | 2024-05-14 | 中铁隧道局集团有限公司 | Ultra-small radius gentle curve segment shield cutting line starting construction method |
WO2024142158A1 (en) * | 2022-12-26 | 2024-07-04 | 株式会社ソニー・インタラクティブエンタテインメント | Positioning system and positioning method |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07301541A (en) * | 1994-05-06 | 1995-11-14 | Hitachi Ltd | Navigation device |
JP3431110B2 (en) * | 1995-02-27 | 2003-07-28 | 日本電信電話株式会社 | Moving object position detection device |
JPH08327360A (en) * | 1995-06-02 | 1996-12-13 | Toyo Umpanki Co Ltd | Method and device for correcting azimuth of vehicle |
JPH08334341A (en) * | 1995-06-09 | 1996-12-17 | Hitachi Ltd | Onboard navigation apparatus |
JPH09189564A (en) * | 1996-01-11 | 1997-07-22 | Matsushita Electric Ind Co Ltd | Traveling body position speed calculating device |
JP4703886B2 (en) * | 2001-04-27 | 2011-06-15 | 富士通テン株式会社 | Navigation device |
-
2007
- 2007-01-11 JP JP2007003840A patent/JP5066367B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2008170278A (en) | 2008-07-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5066367B2 (en) | Position detection method | |
US7337062B2 (en) | Walker navigation device and program | |
EP2400268B1 (en) | Track information generating device, track information generating method, and computer-readable storage medium | |
EP3701286B1 (en) | A method and system for combining sensor data | |
CN107735692B (en) | Method and device for locating a vehicle | |
US7848881B2 (en) | Automatic past error corrections for location and inventory tracking | |
EP1510832A1 (en) | GPS/dead reckoning combination system and operating method thereof | |
US5337243A (en) | Vehicle orientation calculating device | |
JPWO2018181974A1 (en) | Judgment device, judgment method, and program | |
US9285408B2 (en) | Determination of positions | |
US20140214316A1 (en) | Running condition detection device, running condition detection method, and recording medium | |
WO2012033807A1 (en) | Automatic correction of past position errors for location and inventory tracking | |
KR101878685B1 (en) | System and method for positioning vehicle using local dynamic map | |
JPH0868651A (en) | Current position detector for vehicle | |
KR100948089B1 (en) | Method for deciding car position by pseudo dead reckoning and car navigation system using the same | |
CN112762944A (en) | Zero-speed interval detection and zero-speed updating method | |
KR102583899B1 (en) | Apparatus and method for indoor positioning of pedestrians | |
KR102250107B1 (en) | Device for vehicle speed correction and method of calculating the wheel scale factor by the same | |
CN113063441B (en) | Data source correction method and device for accumulated calculation error of odometer | |
KR20210049761A (en) | Device for vehicle speed correction and method of calculating the wheel scale factor by the same | |
JPH07280575A (en) | Position detector for vehicle | |
KR101565485B1 (en) | Device for correcting the position error and method thereof | |
KR101593679B1 (en) | Method and device for estimating indoor location | |
KR101255024B1 (en) | Relative localization system and method using ultrasonic sensor | |
JP4376738B2 (en) | Apparatus and method for detecting zero point error of angular velocity sensor |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20081208 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20101209 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110118 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110817 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120117 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120315 |
|
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: 20120724 |
|
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: 20120813 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5066367 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150817 Year of fee payment: 3 |