JP6403704B2 - Positioning device - Google Patents
Positioning device Download PDFInfo
- Publication number
- JP6403704B2 JP6403704B2 JP2016035567A JP2016035567A JP6403704B2 JP 6403704 B2 JP6403704 B2 JP 6403704B2 JP 2016035567 A JP2016035567 A JP 2016035567A JP 2016035567 A JP2016035567 A JP 2016035567A JP 6403704 B2 JP6403704 B2 JP 6403704B2
- Authority
- JP
- Japan
- Prior art keywords
- radio wave
- phase
- wave transmitter
- calculation unit
- receiver group
- 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
- Position Fixing By Use Of Radio Waves (AREA)
Description
本発明は、複数の電波発信機の各位置を計測する測位装置および測位方法に関するものである。 The present invention relates to a positioning device and a positioning method for measuring each position of a plurality of radio wave transmitters.
従来、地滑りの恐れのある斜面の変位を計測する方法（以下、変位計測法と称す）として、ＧＰＳ測位装置を利用する方法がある（例えば、特許文献１参照）。特許文献１に記載の方法では、基準点と観測点の双方に高精度ＧＰＳ受信機を設置し、基準点と観測点の測位結果の差分を取ることにより観測点の変位を計測するように構成されている。 Conventionally, there is a method of using a GPS positioning device as a method of measuring the displacement of a slope that may cause a landslide (hereinafter referred to as a displacement measurement method) (see, for example, Patent Document 1). In the method described in Patent Document 1, a high-accuracy GPS receiver is installed at both the reference point and the observation point, and the displacement of the observation point is measured by taking the difference between the positioning results of the reference point and the observation point. Has been.
しかしながら、従来のＧＰＳを利用した変位計測法では、電離層シンチレーション等の影響により観測値がばらつくので、ミリメートルオーダーの精度を得るためには、一定の観測時間、例えば１日程度のデータを平均する必要がある。そのため、例えば数分程度といった短い時間内で急激な変位が発生した場合に、そのような過渡応答が発見することができず、その結果、急激な地滑りの変化の兆候の発見には供することができないという問題点がある。 However, in the conventional displacement measurement method using GPS, the observation values vary due to the influence of ionospheric scintillation and the like, and in order to obtain millimeter order accuracy, it is necessary to average data for a certain observation time, for example, about one day. There is. Therefore, for example, when a sudden displacement occurs within a short time such as several minutes, such a transient response cannot be found, and as a result, it can be used for finding a sign of a sudden landslide change. There is a problem that it is not possible.
また、変位計測法として、電波の伝搬時間を利用する方法がある（例えば、特許文献２参照）。特許文献２に記載の方法では、斜面の複数観測点に電波送受信機を設置し、複数観測点間でパルス状の電波を送受信して観測点間の距離を求めることにより変位を計測するように構成されている。 In addition, as a displacement measurement method, there is a method of using radio wave propagation time (see, for example, Patent Document 2). In the method described in Patent Document 2, a radio wave transmitter / receiver is installed at a plurality of observation points on a slope, and a displacement is measured by transmitting and receiving pulsed radio waves between the plurality of observation points to obtain a distance between the observation points. It is configured.
しかしながら、従来の電波の伝搬時間を利用した変位計測法では、ミリメートルオーダーの精度を得るためには、ナノセカンドオーダーのパルス幅の信号を送受信する必要があり、それに伴いギガヘルツ級の広帯域信号を扱うことから高価なシステムになってしまうという問題点がある。また、このようなギガヘルツ級の帯域幅の電波で遠距離の送受信を行うためには比較的大きな送信電力を必要とし、電波法上の問題で現実的には困難であるという問題点もある。 However, in the conventional displacement measurement method using radio wave propagation time, it is necessary to transmit and receive a signal with a pulse width of nanosecond order in order to obtain millimeter-order accuracy, and accordingly, a gigahertz-class wideband signal is handled. Therefore, there is a problem that it becomes an expensive system. In addition, in order to perform transmission / reception over long distances using radio waves of such a gigahertz-class bandwidth, relatively large transmission power is required, and there is a problem that it is practically difficult due to problems in the radio law.
さらに、変位計測法として、電波の位相差を用いて変位を計測する方法がある（例えば、特許文献３参照）。特許文献３に記載の方法では、変位計測点に電波発信機を設置し、固定点に設置した受信機間で電波の位相を比較することにより発信機位置の変位を計測するように構成されている。また、長期間における計測の安定性を保証し得る方法として、位置が既知の点に基準発信機を設けて、その発信機からの電波の位相により受信系の位相量を補正する方法がある。 Furthermore, as a displacement measurement method, there is a method of measuring displacement using a phase difference of radio waves (see, for example, Patent Document 3). In the method described in Patent Document 3, a radio wave transmitter is installed at a displacement measurement point, and the displacement of the transmitter position is measured by comparing the phase of the radio wave between receivers installed at fixed points. Yes. Further, as a method that can guarantee the stability of measurement over a long period of time, there is a method in which a reference transmitter is provided at a point where the position is known, and the phase amount of the receiving system is corrected by the phase of the radio wave from the transmitter.
しかしながら、従来の電波の位相差を用いる変位計測法では、全ての受信アンテナを同軸ケーブル等で接続して同期させる必要がある。ここで、電波発信機の測位精度は、受信アンテナとの相対位置関係が支配的であり、測位精度改善のためには電波発信機の周りを取り囲むように受信アンテナを設置することが望ましい。例えば、このような変位計測法を地滑り監視に適用する場合には、地滑りの可能性のある斜面に電波発信機を設置し、その電波発信機の周りに受信アンテナを設置することになり、その結果、受信アンテナ間をケーブルで接続することが困難となる場合が多い。 However, in the conventional displacement measurement method using the phase difference of radio waves, it is necessary to synchronize all receiving antennas by connecting them with a coaxial cable or the like. Here, the positioning accuracy of the radio wave transmitter is dominated by the relative positional relationship with the receiving antenna. In order to improve the positioning accuracy, it is desirable to install the receiving antenna so as to surround the radio wave transmitter. For example, when such a displacement measurement method is applied to landslide monitoring, a radio wave transmitter is installed on a slope where there is a possibility of landslide, and a receiving antenna is installed around the radio wave transmitter. As a result, it is often difficult to connect the receiving antennas with a cable.
ここで、位相または時刻の同期誤差を持つ複数の基地局からの信号を複数のハンドセットで受信し、連立方程式を解くことで各ハンドセットの位置および同期誤差を計測する方法がある（例えば、特許文献４参照）。 Here, there is a method in which signals from a plurality of base stations having a phase or time synchronization error are received by a plurality of handsets, and the positions and synchronization errors of each handset are measured by solving simultaneous equations (for example, Patent Documents) 4).
特許文献４に記載の方法では、複数の基地局が互いに同期していなくても各ハンドセットの位置を推定することができる。しかしながら、特許文献４に記載の方法を、従来の電波の位相差を用いる変位計測法に応用する場合、受信機ごとの位相誤差が未知数となるとともに、これらの位相誤差がランダムに動くことが予想されるので、測位方程式が発散して正しく解が求まらず、その結果、高精度な測位を実現することができないという問題がある。 With the method described in Patent Document 4, the position of each handset can be estimated even if a plurality of base stations are not synchronized with each other. However, when the method described in Patent Document 4 is applied to a conventional displacement measurement method using the phase difference of radio waves, the phase error for each receiver becomes an unknown and it is expected that these phase errors will move randomly. Therefore, the positioning equation diverges and a correct solution cannot be obtained, and as a result, there is a problem that highly accurate positioning cannot be realized.
本発明は、上記のような課題を解決するためになされたものであり、高精度な測位を実現することのできる測位装置および測位方法を得ることを目的とする。 The present invention has been made to solve the above-described problems, and an object of the present invention is to obtain a positioning device and a positioning method that can realize highly accurate positioning.
本発明における測位装置は、複数の電波発信機と、それぞれの間で互いに時刻同期誤差が存在する複数の受信機群と、各電波発信機の位置座標を演算する測位演算部と、を備え、各受信機群は、位置が既知の固定点に設置されており、各電波発信機からの電波を受信する複数の受信アンテナと、各受信アンテナの受信信号から各受信アンテナに対応した各電波発信機の電波位相を算出する位相算出部と、を有し、測位演算部は、各受信機群の位相算出部から出力された各電波発信機の電波位相と、各受信機群の各受信アンテナの位置座標を既知数とし、各電波発信機の位置座標と、各電波発信機の初期位相と、各受信機群の各受信アンテナの受信系遅延位相とを未知数とした連立測位方程式を解くことで、各電波発信機の位置座標を演算し、各受信機群は、位相算出部から出力された各電波発信機の電波位相と、各受信アンテナの位置座標を既知数とし、各電波発信機の位置座標と、各電波発信機の初期位相と、各受信アンテナの受信系遅延位相とを未知数とした連立測位方程式を解くことで、各受信アンテナの受信系遅延位相の暫定値を演算して出力する副測位演算部をさらに有し、各受信機群の副測位演算部から出力された各受信アンテナの受信系遅延位相の暫定値から、受信機群間の位相同期誤差を推定して出力する位相同期誤差推定部をさらに備え、測位演算部は、各受信機群の位相算出部から出力された各電波発信機の電波位相と、各受信機群の各受信アンテナの位置座標と、位相同期誤差推定部から出力された位相同期誤差とを既知数とし、各電波発信機の位置座標と、各電波発信機の初期位相と、各受信機群の各受信アンテナの受信系遅延位相とを未知数とした連立測位方程式を解くことで、各電波発信機の位置座標を演算するものである。 The positioning device according to the present invention includes a plurality of radio wave transmitters, a plurality of receiver groups in which time synchronization errors exist between each other, and a positioning calculation unit that calculates the position coordinates of each radio wave transmitter, Each receiver group is installed at a fixed point with a known position, and each receiving radio wave corresponding to each receiving antenna is received from a plurality of receiving antennas that receive the radio wave from each radio wave transmitter. A phase calculation unit that calculates a radio wave phase of the machine, and a positioning calculation unit that outputs the radio wave phase of each radio wave transmitter output from the phase calculation unit of each receiver group and each receiving antenna of each receiver group Solve the simultaneous positioning equation with unknown position coordinates of each radio wave transmitter, the initial phase of each radio wave transmitter, and the reception system delay phase of each receiving antenna of each receiver group. in, and calculates the position coordinates of each radio transmitter, The receiver group is a known number of the radio wave phase of each radio wave transmitter output from the phase calculation unit and the position coordinates of each receiving antenna, the position coordinate of each radio wave transmitter, the initial phase of each radio wave transmitter, The receiver further includes a sub-positioning calculation unit that calculates and outputs a provisional value of the reception system delay phase of each reception antenna by solving a simultaneous positioning equation with the reception system delay phase of each reception antenna as an unknown. A phase synchronization error estimator that estimates and outputs the phase synchronization error between the receiver groups from the provisional value of the reception system delay phase of each receiving antenna output from the sub-positioning calculator of the group, and the positioning calculator The radio wave phase of each radio wave transmitter output from the phase calculation unit of each receiver group, the position coordinates of each receiving antenna of each receiver group, and the phase synchronization error output from the phase synchronization error estimation unit are known. And the position coordinates of each radio wave transmitter By solving the initial phase of each radio wave transmitter, the simultaneous positioning equations and unknowns and reception system delays the phase of the receiving antennas of each receiver group is for calculating the position coordinates of the respective radio transmitter.
本発明によれば、互いに時刻が同期するように構成されている複数の受信機群の各受信機群の位相算出部から出力された各電波発信機の電波位相と、各受信機群の各受信アンテナの位置座標を既知数とし、各電波発信機の位置座標と、各電波発信機の初期位相と、各受信機群の各受信アンテナの受信系遅延位相とを未知数とした連立測位方程式を解くことで、各電波発信機の位置座標を演算するように構成されている。これにより、高精度な測位を実現することのできる測位装置および測位方法を得ることができる。 According to the present invention, the radio wave phase of each radio wave transmitter output from the phase calculation unit of each receiver group of a plurality of receiver groups configured to synchronize time with each other, and each of the receiver groups A simultaneous positioning equation where the position coordinates of the receiving antenna are known numbers, and the position coordinates of each radio wave transmitter, the initial phase of each radio wave transmitter, and the reception system delay phase of each receiving antenna of each receiver group are unknown. By solving, it is configured to calculate the position coordinates of each radio wave transmitter. Thereby, it is possible to obtain a positioning device and a positioning method that can realize highly accurate positioning.
以下、本発明による測位装置および測位方法を、好適な実施の形態にしたがって図面を用いて説明する。なお、図面の説明においては、同一部分または相当部分には同一符号を付し、重複する説明を省略する。また、本願発明は、例えば、地滑りの恐れのある斜面の変位計測等への適用が可能である。 Hereinafter, a positioning device and a positioning method according to the present invention will be described with reference to the drawings according to a preferred embodiment. In the description of the drawings, the same portions or corresponding portions are denoted by the same reference numerals, and redundant description is omitted. In addition, the present invention can be applied to, for example, displacement measurement of a slope that may cause landslide.
実施の形態１．
図１は、本発明の実施の形態１における測位装置を示す構成図である。図１において、本実施の形態１における測位装置は、複数の電波発信機１０と、それぞれの間で互いに時刻が同期するように構成されている受信機群Ｇ１および受信機群Ｇ２と、測位演算部５０とを備える。
Embodiment 1 FIG.
FIG. 1 is a configuration diagram showing a positioning apparatus according to Embodiment 1 of the present invention. In FIG. 1, the positioning device according to the first embodiment includes a plurality of
受信機群Ｇ１は、複数の受信アンテナ１１と、周波数変換部１２と、基準信号生成部１３と、Ａ／Ｄ変換部１４と、位相算出部１５とを有する。また、信号処理回路３０は、位相算出部１５および測位演算部５０によって構成される。受信機群Ｇ２は、複数の受信アンテナ２１と、周波数変換部２２と、基準信号生成部２３と、Ａ／Ｄ変換部２４と、位相算出部２５とを有する。また、信号処理回路４０は、位相算出部２５によって構成される。なお、図１では、受信機群が２つある場合を例示しているが、受信機群が３つ以上あっても構わない。
The receiver group G1 includes a plurality of
各電波発信機１０は、ある周波数の電波を測位用の電波として放射するものである。各電波発信機１０の具体例としては、携帯端末、無線ＬＡＮ端末およびＷｉ−ＳＵＮ対応の端末等が挙げられる。各電波発信機１０は、ある一定の間隔、例えば数分毎にビーコン電波を放射するように構成されていてもよいし、別途制御用の端末を設けて、任意のタイミングで電波を放射するように構成されていてもよい。なお、ここでは、９２０ＭＨｚ帯のＷｉ−ＳＵＮ対応の端末を各電波発信機１０として用いて、各電波発信機１０は、一定間隔でビーコン電波を送信するように構成される場合について説明する。
Each
続いて、受信機群Ｇ１の各構成要素について説明する。なお、受信機群Ｇ２の各構成要素は、受信機群Ｇ１の各構成要素と同様であることから、受信機群Ｇ２の各構成要素の説明を省略する。 Subsequently, each component of the receiver group G1 will be described. In addition, since each component of the receiver group G2 is the same as each component of the receiver group G1, description of each component of the receiver group G2 is abbreviate | omitted.
各受信アンテナ１１は、位置が既知の固定点に設置されており、各電波発信機１０から送信された電波を受信する。必要に応じて、増幅器または帯域制限フィルタが設置され、各受信アンテナ１１の受信信号の増幅および雑音除去が行われるように構成される。各受信アンテナ１１の受信信号は、同軸ケーブル等を通して周波数変換部１２に入力される。
Each receiving
周波数変換部１２は、Ａ／Ｄ変換部１４でのサンプリングレートを低く抑えるために、各受信アンテナ１１から入力された受信信号の周波数を低い周波数に変換する。例えば、各受信アンテナ１１から９２０ＭＨｚ帯の受信信号が周波数変換部１２に入力された場合、各受信信号は、中心周波数が数Ｍ〜数十ＭＨｚの信号に変換される。
The
基準信号生成部１３は、基準信号を生成し、その基準信号を周波数変換部１２に出力する。周波数変換部１２は、基準信号生成部１３から入力された基準信号と、各受信アンテナ１１から入力された受信信号とを乗算することで、周波数変換を実現する。各受信信号を周波数変換した後の信号は、Ａ／Ｄ変換部１４に入力される。このように、周波数変換部１２は、基準信号生成部１３から出力された基準信号と、各受信アンテナ１１の受信信号とから、各受信アンテナ１１の受信信号の周波数を変換し、周波数変換後の信号を出力する。
The reference
Ａ／Ｄ変換部１４は、周波数変換部１２から入力された各信号をディジタル信号に変換する。Ａ／Ｄ変換部１４は、中間周波数＋信号帯域の２倍程度でサンプリングを行う。このように、Ａ／Ｄ変換部１４は、周波数変換部１２から出力された周波数変換後の信号をＡ／Ｄ変換し、Ａ／Ｄ変換後のディジタル信号を出力する。
The A /
位相算出部１５は、位相算出処理を実行することで、Ａ／Ｄ変換部１４から入力された各ディジタル信号から、各ディジタル信号の位相、すなわち、各受信アンテナ１１に対応した各電波発信機１０の電波位相を算出する。このように、位相算出部１５は、各受信アンテナ１１の受信信号から、各受信アンテナ１１に対応した各電波発信機１０の電波位相を算出する。より具体的には、位相算出部１５は、Ａ／Ｄ変換部１４から出力されたディジタル信号から各電波発信機１０の電波位相を算出する。
The
ここで、各電波発信機１０の電波位相を算出する方法としては、以下のような方法が挙げられる。
Here, as a method of calculating the radio wave phase of each
すなわち、各電波発信機１０から送信される電波信号が変調信号であり、変調データ系列が事前に分かっている場合には、各受信アンテナ１１の受信信号と変調データ系列との相互相関を計算し、相互相関がピークとなる遅延時間の位相を計算する方法が一般的である。このような方法は、ＧＰＳ等において用いられている方法である。一方、変調データ系列が未知の場合には、同時刻における複数の受信信号を平均することで変調データ系列を推定し、変調データ系列の影響を取り除いた位相を算出することも可能である。
That is, when the radio signal transmitted from each
測位演算部５０は、位相算出部１５から入力された各受信アンテナ１１に対応した各電波発信機１０の電波位相と、位相算出部２５から入力された各受信アンテナ２１に対応した各電波発信機１０の電波位相とを用いて、後述する測位演算処理を実行することで、各電波発信機１０の位置座標を演算する。
The
次に、信号処理回路３０および信号処理回路４０のＨ／Ｗ構成について、図２を参照しながら説明する。図２は、本発明の実施の形態１における測位装置の信号処理回路３０，４０のＨ／Ｗ構成図である。
Next, the H / W configuration of the
図２において、信号処理回路３０は、メモリ３１、プロセッサ３２、クロック３３、Ａ／Ｄ変換制御インターフェース３４、データ送受信インターフェース３５および表示器３６を有する。信号処理回路４０は、メモリ４１、プロセッサ４２、クロック４３、Ａ／Ｄ変換制御インターフェース４４およびデータ送受信インターフェース４５を有する。
In FIG. 2, the
位相算出部１５および測位演算部５０のそれぞれのアルゴリズムは、信号処理回路３０にＳ／Ｗとして実装され、メモリ３１に保存される。プロセッサ３２は、メモリ３１に保存したＳ／Ｗを読み出し、Ａ／Ｄ変換制御インターフェース３４を通して入力されたディジタルデータに対して、位相算出処理および測位演算処理を実行する。
Each algorithm of the
クロック３３は、プロセッサ３２の時刻を管理する時計である。クロック３３の具体例としては、リアルタイムクロック等が挙げられる。Ａ／Ｄ変換制御インターフェース３４は、Ａ／Ｄ変換部１４に対して信号取得タイミングおよび信号取得時間等に係る制御信号を送信することで、Ａ／Ｄ変換部１４を制御する機能を有する。
The
データ送受信インターフェース３５は、信号処理回路４０に対してＡ／Ｄ変換の信号取得タイミングおよび信号取得時間等に係る制御信号を送信し、さらに、信号処理回路４０から送信されたデータを受信する機能を有する。表示器３６は、測位演算部５０の測位結果を表示するものである。
The data transmission /
位相算出部２５のアルゴリズムは、信号処理回路４０にＳ／Ｗとして実装され、メモリ４１に保存される。プロセッサ４２は、メモリ４１に保存したＳ／Ｗを読み出し、Ａ／Ｄ変換制御インターフェース４４を通して入力されたディジタルデータに対して、位相算出処理を実行する。
The algorithm of the
クロック４３は、プロセッサ４２の時刻を管理する時計である。クロック４３の具体例としては、リアルタイムクロック等が挙げられる。Ａ／Ｄ変換制御インターフェース４４は、Ａ／Ｄ変換部２４に対して信号取得タイミングおよび信号取得時間等に係る制御信号を送信することで、Ａ／Ｄ変換部２４を制御する機能を有する。
The
データ送受信インターフェース４５は、信号処理回路３０から送信されたＡ／Ｄ変換の信号取得タイミングおよび信号取得時間等に係る制御信号を受信し、さらに、位相算出部２５から出力されたデータを信号処理回路３０に送信する機能を有する。
The data transmission /
次に、本実施の形態１における測位装置の全体の動作について、図３を参照しながら説明する。図３は、本発明の実施の形態１における測位装置の一連の動作を示すフローチャートである。 Next, the overall operation of the positioning device according to the first embodiment will be described with reference to FIG. FIG. 3 is a flowchart showing a series of operations of the positioning device according to Embodiment 1 of the present invention.
各電波発信機１０は、前述したとおり、一定間隔で測位用の電波を放射する。各電波発信機１０は、９２０ＭＨｚ帯の電波を放射するように構成される場合を想定しているが、各電波発信機１０から放射される電波の周波数帯は、２．４ＧＨｚ帯であってもよく、ＭＨｚ〜ＧＨｚの他の周波数帯であっても構わない。また、電波発信機制御用のＨ／Ｗを設けて、これによって電波送信タイミングを任意に制御できる構成としてもよい。
As described above, each
信号処理回路３０および信号処理回路４０は、無線でデータを送受信できる機能を有する。このようなデータ送受信の機能は、主に２．４ＧＨｚ帯の電波および９２０ＭＨｚ帯の電波によって実現することを想定しているが、可視光通信等によって実現しても構わない。
The
図３に示すように、信号処理回路３０は、同期信号およびＡ／Ｄタイミング信号を信号処理回路４０に送信する（ステップＳ１０１）。タイミング信号は、各電波発信機１０の送信タイミングに合わせて発生し、信号処理回路３０は、そのタイミングに基づいて一定間隔で受信した各電波発信機１０の信号のＡ／Ｄ変換をＡ／Ｄ変換部１４が行うように制御する（ステップＳ１０２）。
As shown in FIG. 3, the
ステップＳ１０１およびステップＳ１０２の処理は、すべての電波発信機１０からの電波をすべての受信アンテナ１１が受信完了となるまで繰り返される（ステップＳ１０３）。ステップＳ１０３で受信完了となれば、信号処理回路３０は、各受信アンテナ１１に対応した各電波発信機１０の電波位相を計算する（ステップＳ１０４）。
The processes in step S101 and step S102 are repeated until all the receiving
信号処理回路４０は、信号処理回路３０から送信された同期信号およびＡ／Ｄタイミング信号を受信する（ステップＳ２０１）。信号処理回路４０は、ステップＳ２０１で受信した同期信号に基づいて、クロック４３を補正し、信号処理回路３０のクロック３３と同期させる（ステップＳ２０２）。つまり、ステップＳ２０２では、受信機群Ｇ１と受信機群Ｇ２との間で互いに時刻が同期した状態となるように調整される。
The
しかしながら、クロック３３およびクロック４３を完全には同期させることはできず、ある程度の誤差を持つ。つまり、受信機群Ｇ１と受信機群Ｇ２との間で時刻同期誤差が存在する。例えば、クロックの精度が１０ｐｐｍであれば、１０μｓの時間誤差に相当し、距離で約３ｋｍの誤差になる。したがって、このような誤差を補償して、測位演算処理を実行する必要がある。
However, the
信号処理回路４０は、ステップＳ２０１で受信したＡ／Ｄタイミング信号に基づいて、各電波発信機１０の信号のＡ／Ｄ変換をＡ／Ｄ変換部２４が行うように制御する（ステップＳ２０３）。
Based on the A / D timing signal received at step S201, the
ステップＳ２０１〜ステップＳ２０３の処理は、すべての電波発信機１０からの電波をすべての受信アンテナ２１が受信完了となるまで繰り返される（ステップＳ２０４）。ステップＳ２０４で受信完了となれば、信号処理回路４０は、各受信アンテナ２１に対応した各電波発信機１０の電波位相を計算する（ステップＳ２０５）。
The processes in steps S201 to S203 are repeated until all the receiving
信号処理回路４０は、ステップＳ２０５で計算した各受信アンテナ２１に対応した各電波発信機１０の電波位相を位相データとして信号処理回路３０に送信する（ステップＳ２０６）。
The
信号処理回路３０内の測位演算部５０は、信号処理回路４０から送信された位相データを受信する（ステップＳ１０５）。測位演算部５０は、ステップＳ１０４で計算した位相データと、ステップＳ１０６で受信した位相データとを用いて、クロック誤差を精密に補償して、測位演算処理を実行する（ステップＳ１０６）。信号処理回路３０は、ステップＳ１０６で実行された測位演算処理の結果を測位結果として表示する（ステップＳ１０７）。
The
次に、測位演算部５０による測位演算処理について説明する。なお、以下では、複数の電波発信機１０の数がＬであり、各電波発信機１０は、ｌ（ｌ＝１，２，・・Ｌ）によって番号付けされているものとする。また、複数の受信アンテナ１１の数がＭであり、各受信アンテナ１１は、ｍ（ｍ＝１，２，・・・Ｍ）によって番号付けされ、複数の受信アンテナ２１の数がＭ’であり、各受信アンテナ２１は、ｍ’（ｍ’＝１，２，・・・Ｍ’）によって番号付けされているものとする。
Next, the positioning calculation process by the
位相算出部１５によって算出される各受信アンテナ１１に対応した各電波発信機１０の電波位相を式で表すと、以下の式（１）のようになる。
When the radio wave phase of each
ただし、φ１，ｌ，ｍは、ｌ番目の電波発信機およびｍ番目の受信アンテナに対応した電波位相を示す。ｘｌ、ｙｌ、ｚｌは、ｌ番目の電波発信機の位置座標、すなわち、ｘ、ｙ、ｚ座標を示し、Ｘ１，ｍ、Ｙ１，ｍ、Ｚ１，ｍは、ｍ番目の受信アンテナの位置座標、すなわち、ｘ、ｙ、ｚ座標を示す。λは、電波の波長、ψｌは、ｌ番目の電波発信機の初期位相を示す。ξ１，ｍは、ｍ番目の受信アンテナの受信系遅延位相を示す。 Here, φ 1, l, m indicates the radio wave phase corresponding to the l th radio wave transmitter and the m th receive antenna. x l , y l , z l indicate the position coordinates of the l-th radio wave transmitter, that is, x, y, z-coordinates, and X 1, m , Y 1, m , Z 1, m are the m th The position coordinates of the receiving antenna, that is, x, y, z coordinates are shown. λ is the wavelength of the radio wave, and ψ l is the initial phase of the l-th radio wave transmitter. ξ 1, m represents the reception system delay phase of the m-th reception antenna.
なお、通常、式（１）には、位相整数値バイアスが含まれるが、観測間隔毎に各電波発信機１０の変位が波長程度以下であることを前提とし、前回観測時に求めておいた整数値バイアスをそのまま用いることを想定する。
In general, equation (1) includes a phase integer bias, but it is assumed that the displacement of each
また、位相算出部２５によって算出される各受信アンテナ２１に対応した各電波発信機１０の電波位相を式で表すと、以下の式（２）のようになる。
Further, when the radio wave phase of each
ただし、φ２，ｌ，ｍ’は、ｌ番目の電波発信機およびｍ’番目の受信アンテナに対応した電波位相を示す。Ｘ２，ｍ’、Ｙ２，ｍ’、Ｚ２，ｍ’は、ｍ’番目の受信アンテナのｘ、ｙ、ｚ座標を示す。ξ２，ｍ’は、ｍ’番目の受信アンテナの受信系遅延位相を示す。 Here, φ 2, l, m ′ indicates the radio wave phase corresponding to the l th radio wave transmitter and the m ′ th receiving antenna. X 2, m ′ , Y 2, m ′ , Z 2, m ′ indicate the x, y, and z coordinates of the m′-th receiving antenna. ξ 2, m ′ indicates the reception system delay phase of the m′-th reception antenna.
ここで、式（１）のξ１，ｍについて、例えばｍ＝１の受信アンテナを基準とした位相差として問題ないので、ξ１，１＝０とおくことができる。この場合、受信機群Ｇ１と受信機群Ｇ２との間の時刻同期誤差に伴う位相同期誤差をΔξとし、位相同期誤差Δξを受信機群Ｇ１と受信機群Ｇ２の基準アンテナ間の遅延位相差とみなすことで、以下の式（３）のような連立測位方程式を立てることができる。測位演算部５０は、式（３）で示す連立測位方程式を解くことで、各電波発信機１０の位置座標を演算する。
Here, with respect to ξ 1, m in the expression (1), for example, there is no problem as a phase difference based on the receiving antenna of m = 1, so that ξ 1,1 = 0 can be set. In this case, the phase synchronization error accompanying the time synchronization error between the receiver group G1 and the receiver group G2 is Δξ, and the phase synchronization error Δξ is the delay phase difference between the reference antennas of the receiver group G1 and the receiver group G2. Therefore, simultaneous positioning equations such as the following equation (3) can be established. The
式（３）における未知数は、各電波発信機１０の位置座標および初期位相と、基準となる１番目を除く各受信アンテナ１１の受信系遅延位相と、基準となる１番目を除く各受信アンテナ２１の受信系遅延位相と、受信機群Ｇ１，Ｇ２間の位相同期誤差である。なお、各電波発信機１０の位置座標および初期位相の数がＬ×４であり、１番目を除く各受信アンテナ１１の受信系遅延位相の数がＭ−１であり、１番目を除く各受信アンテナ２１の受信系遅延位相の数がＭ’−１であり、受信機群Ｇ１，Ｇ２間の位相同期誤差の数が１であり、これらの数の総和が式（３）における未知数の数となる。
The unknowns in Equation (3) are the position coordinates and initial phase of each
また、連立測位方程式の方程式数は、各受信アンテナ１１，２１に対応した各電波発信機１０の電波位相の数と同数、すなわち、Ｌ×（Ｍ＋Ｍ’）であり、連立測位方程式において、以下の式（４）の関係が成立する。つまり、電波発信機１０の数Ｌ、受信アンテナ１１の数Ｍおよび受信アンテナ２１の数Ｍ’は、式（４）を満たすように設定される。
The number of simultaneous positioning equations is the same as the number of radio wave phases of the
したがって、式（３）に示すように、受信機群Ｇ１，Ｇ２間の時刻同期誤差に伴う位相同期誤差をモデル化することによって、受信機群Ｇ１，Ｇ２間が互いに同期している場合と同等の未知数で構成される連立測位方程式を解法することができる。また、式（３）では、位相同期誤差Δξを受信機群Ｇ１と受信機群Ｇ２の基準アンテナ間の遅延位相差とみなし、ξ２，１＝Δξとして連立測位方程式を立てたが、ξ２，１＝ξ２，１＋Δξとして解法することもできる。この場合、未知数が１つ増えて、連立測位方程式において、以下の式（５）の関係が成立する。 Therefore, as shown in Expression (3), modeling the phase synchronization error accompanying the time synchronization error between the receiver groups G1 and G2 is equivalent to the case where the receiver groups G1 and G2 are synchronized with each other. It is possible to solve simultaneous positioning equations composed of unknown numbers. Further, in Formula (3), regarded as the phase synchronization error .DELTA..xi the delay phase difference between the reference antenna and receiver unit G1 receiver group G2, but made a simultaneous positioning equations as ξ 2,1 = Δξ, ξ 2 , 1 = ξ 2,1 + Δξ. In this case, the unknown number increases by one, and the following equation (5) is established in the simultaneous positioning equations.
なお、式（３）で示す連立測位方程式の解法については、様々な方法が知られており、例えば非特許文献１に示すように近似解近傍でのテイラー展開によって線形方程式に変換して解く方法等があるが、ここでは、詳細な説明を省略する。 Various methods are known for solving the simultaneous positioning equations shown in Equation (3). For example, as shown in Non-Patent Document 1, a method of solving by converting to linear equations by Taylor expansion in the vicinity of an approximate solution However, detailed description is omitted here.
このように、測位演算部５０は、各受信機群Ｇ１，Ｇ２の位相算出部１５，２５から出力された各電波発信機１０の電波位相と、各受信機群Ｇ１，Ｇ２の各受信アンテナ１１，２１の位置座標とを既知数とし、各電波発信機１０の位置座標と、各電波発信機１０の初期位相と、各受信機群Ｇ１，Ｇ２の各受信アンテナ１１，２１の受信系遅延位相と、受信機群Ｇ１，Ｇ２間の位相同期誤差とを未知数とした連立測位方程式を解くことで、各電波発信機１０の位置座標を演算する。
As described above, the
なお、本実施の形態１では、受信機群Ｇ１，Ｇ２間の位相同期誤差を考慮して式（３）で示す連立測位方程式を解くことで各電波発信機１０の位置座標を演算するように構成する場合を例示したが、その位相同期誤差を考慮しない形の連立測位方程式を解くことで各電波発信機１０の位置座標を演算するように構成してもよい。
In the first embodiment, the position coordinates of each
この場合、測位演算部５０は、各受信機群Ｇ１，Ｇ２の位相算出部１５，２５から出力された各電波発信機１０の電波位相と、各受信機群Ｇ１，Ｇ２の各受信アンテナ１１，２１の位置座標を既知数とし、各電波発信機１０の位置座標と、各電波発信機１０の初期位相と、各受信機群Ｇ１，Ｇ２の各受信アンテナ１１，２１の受信系遅延位相とを未知数とした連立測位方程式を解くことで、各電波発信機１０の位置座標を演算するように構成される。
In this case, the
ただし、前述したとおり、受信機群Ｇ１，Ｇ２間の時刻同期誤差が実際には存在するので、このことを考慮すると、受信機群Ｇ１，Ｇ２間の位相同期誤差を考慮して式（３）で示す連立測位方程式を解くことで各電波発信機１０の位置座標を演算するように構成する方が好ましい。
However, as described above, since the time synchronization error between the receiver groups G1 and G2 actually exists, in consideration of this, the phase synchronization error between the receiver groups G1 and G2 is taken into consideration in the equation (3). It is preferable to configure so that the position coordinates of each
以上、本実施の形態１によれば、互いに時刻が同期するように構成されている複数の受信機群の各受信機群の位相算出部から出力された各電波発信機の電波位相と、各受信機群の各受信アンテナの位置座標を既知数とし、各電波発信機の位置座標と、各電波発信機の初期位相と、各受信機群の各受信アンテナの受信系遅延位相とを未知数とした連立測位方程式を解くことで、各電波発信機の位置座標を演算するように構成されている。 As described above, according to the first embodiment, the radio wave phase of each radio wave transmitter output from the phase calculation unit of each receiver group of a plurality of receiver groups configured to synchronize time with each other, The position coordinates of each receiving antenna in the receiver group are known numbers, and the position coordinates of each radio wave transmitter, the initial phase of each radio wave transmitter, and the reception system delay phase of each receiving antenna in each receiver group are defined as unknowns. By solving the simultaneous positioning equations, the position coordinates of each radio wave transmitter are calculated.
このように構成することで、互いに同期させたすべての受信機群の測位方程式を連立させた方程式を解いて測位することとなるので、１つの受信機群によって測位する場合と比較して高精度な測位を実現することができる。また、受信機群間を無線によって同期させることで同軸ケーブルの敷設を低減させ、その結果、システム全体の規模の低減およびシステム全体の設置工事費の低減が可能となる。 By configuring in this way, positioning is performed by solving an equation in which the positioning equations of all the receiver groups synchronized with each other are combined, so that the accuracy is higher than in the case of positioning by one receiver group. Accurate positioning can be realized. In addition, by laying down the receiver groups wirelessly, the laying of the coaxial cable is reduced. As a result, it is possible to reduce the scale of the entire system and the installation cost of the entire system.
また、上記の構成に対して、各受信機群の位相算出部から出力された各電波発信機の電波位相と、各受信機群の各受信アンテナの位置座標を既知数とし、各電波発信機の位置座標と、各電波発信機の初期位相と、各受信機群の各受信アンテナの受信系遅延位相と、受信機群間の位相同期誤差とを未知数とした連立測位方程式を解くことで、各電波発信機の位置座標を演算するようにさらに構成されている。 For the above configuration, the radio wave phase of each radio wave transmitter output from the phase calculation unit of each receiver group and the position coordinates of each receive antenna of each receiver group are known numbers, and each radio wave transmitter By solving the simultaneous positioning equation with unknown position coordinates, initial phase of each radio wave transmitter, reception system delay phase of each receiving antenna of each receiver group, and phase synchronization error between receiver groups, It is further configured to calculate the position coordinates of each radio wave transmitter.
このように構成することで、上記の構成と比べてさらに高精度な測位を実現することができる。また、受信機群間の時刻同期誤差に伴う位相同期誤差を、各受信機群の基準アンテナにおける受信系遅延位相の差としてモデル化しているので、未知数を増やすことなく高精度な測位を実現することが可能となる。 By configuring in this way, it is possible to realize positioning with higher accuracy than the above configuration. In addition, the phase synchronization error that accompanies the time synchronization error between the receiver groups is modeled as the difference in the reception system delay phase at the reference antenna of each receiver group, so high-accuracy positioning is achieved without increasing the unknowns. It becomes possible.
実施の形態２．
先の実施の形態１では、受信機群Ｇ１，Ｇ２間の位相同期誤差を各受信機群Ｇ１，Ｇ２の基準アンテナ間の位相差としてモデル化することによって、未知数を増加させることなく解法可能な連立測位方程式について説明した。
Embodiment 2. FIG.
In the first embodiment, the phase synchronization error between the receiver groups G1 and G2 is modeled as a phase difference between the reference antennas of the receiver groups G1 and G2, so that it can be solved without increasing the unknowns. The simultaneous positioning equations were explained.
ここで、連立測位方程式の解法として、非特許文献１に記載の方法を採用し、テイラー級数展開に基づき非線形方程式を線形化して行列演算を解く手法がある。非線形方程式を線形化する際には未知数、すなわち、各電波発信機１０の位置座標、各電波発信機１０の初期位相および各受信アンテナ１１，２１の受信系遅延位相について、何らかの暫定値が必要となる。
Here, as a method of solving simultaneous positioning equations, there is a method of adopting the method described in Non-Patent Document 1 and linearizing a nonlinear equation based on Taylor series expansion to solve a matrix operation. When linearizing the nonlinear equation, some provisional value is required for the unknown, that is, the position coordinates of each
上記のような暫定値の計算法としては、例えば以下のような方法が考えられる。すなわち、各電波発信機１０の位置座標は、時間経過に伴い連続的に変位するはずであるので、追尾フィルタ等の処理により、前回観測時の計測値を基に予測値が計算可能である。この場合、例えば、式（１）における残りの未知数は、各電波発信機１０の初期位相および各受信アンテナ１１の受信系遅延位相となる。各電波発信機１０の初期位相に関しては、各受信アンテナ１１で同一であるので、１つの受信アンテナを基準した位相の差分を計算することにより、この初期位相をキャンセルすることができる。したがって、受信アンテナ１１の受信系遅延位相、すなわち、式（１）におけるξｌ，ｍが推定可能である。また、ξｌ，ｍの推定値には誤差が含まれるので、基準となる受信アンテナを除く受信アンテナ数（Ｍ−１）個分の受信系遅延位相の平均を計算することで誤差を抑圧する。
As a method for calculating the provisional value as described above, for example, the following method can be considered. That is, since the position coordinates of each
上記のような方法によって、各電波発信機１０の位置座標、各電波発信機１０の初期位相および各受信アンテナ１１，２１の受信系遅延位相について、暫定値をそれぞれ計算することができる。
By the method as described above, provisional values can be calculated for the position coordinates of each
しかしながら、１つの受信アンテナを基準とした位相の差分を計算する際の前提として、受信アンテナ毎に波長の整数倍の不確定性（以下、整数値バイアスと呼ぶ）は存在しないということがある。なぜなら、整数値バイアスが存在すると位相の差分を計算した際に正しく位相差が計算されないためである。 However, as a premise for calculating the phase difference with respect to one receiving antenna, there is no uncertainty of an integral multiple of the wavelength (hereinafter referred to as an integer value bias) for each receiving antenna. This is because when there is an integer value bias, the phase difference is not correctly calculated when the phase difference is calculated.
ケーブルまたは各受信機群Ｇ１，Ｇ２内のＲＦ部で発生する遅延位相は、数秒から数時間内の観測間隔では比較的に安定しており、波長オーダーの誤差が生じる可能性が小さい。例えば、９２０ＭＨｚの電波の場合、３３ｃｍ程度の誤差が生じる。また、受信機群Ｇ１，Ｇ２間で時刻同期していない場合、各受信機群Ｇ１，Ｇ２で個別に、例えばＲＴＣ（リアルタイムクロック）等のクロックを持っておき、これらのクロックを無線で同期させる方法が考えられる。 The delay phase generated in the cable or the RF section in each of the receiver groups G1 and G2 is relatively stable at an observation interval within a few seconds to a few hours, and there is little possibility that an error in wavelength order will occur. For example, in the case of a 920 MHz radio wave, an error of about 33 cm occurs. In addition, when time synchronization is not performed between the receiver groups G1 and G2, each receiver group G1 and G2 individually has a clock such as an RTC (real time clock) and synchronizes these clocks wirelessly. A method is conceivable.
しかしながら、一般的なＲＴＣの精度は、１０−６オーダー程度であり、９２０ＭＨｚの電波の場合、１秒間に位相が９２０回転することになる。すなわち、受信機群Ｇ１，Ｇ２間で観測毎に位相回転が生じないようにするためには、１／９２０秒毎に同期をする必要があるが、各電波発信機１０の消費電力、および１観測時に必要な処理時間等の観点からも現実には困難である。
However, the accuracy of general RTC is on the order of 10 −6 , and in the case of a 920 MHz radio wave, the phase rotates 920 per second. That is, in order to prevent phase rotation between the receiver groups G1 and G2 from occurring every observation, it is necessary to synchronize every 1/920 seconds, but the power consumption of each
そこで実施の形態２では、各受信機群Ｇ１，Ｇ２において後述する副測位演算処理を実行し、その処理によって得られた各受信アンテナ１１，２１の受信系遅延位相を用いて、受信機群Ｇ１，Ｇ２間の位相同期誤差を推定し、その推定された位相同期誤差を用いて立てた連立測位方程式を解くように構成されている。
Therefore, in the second embodiment, sub-positioning calculation processing described later is executed in each of the receiver groups G1 and G2, and the receiver group G1 is used by using the reception system delay phase of each of the receiving
次に、本実施の形態２における測位装置について、図４を参照しながら説明する。図４は、本発明の実施の形態２における測位装置を示す構成図である。なお、本実施の形態２では、先の実施の形態１と同様である点の説明を省略し、先の実施の形態１と異なる点を中心に説明する。 Next, the positioning device in the second embodiment will be described with reference to FIG. FIG. 4 is a configuration diagram showing a positioning device according to Embodiment 2 of the present invention. In the second embodiment, description of points that are the same as those of the first embodiment will be omitted, and points different from the first embodiment will be mainly described.
受信機群Ｇ１は、先の実施の形態１の構成に対して、副測位演算部１６をさらに有し、副測位演算部１６は、信号処理回路３０に含まれる。受信機群Ｇ２は、先の実施の形態１の構成に対して、副測位演算部２６をさらに有し、副測位演算部２６は、信号処理回路４０に含まれる。
The receiver group G1 further includes a
信号処理回路３０は、先の実施の形態１の構成に対して、副測位演算部１６および位相同期誤差推定部６０をさらに有する。信号処理回路４０は、先の実施の形態１の構成に対して、副測位演算部２６をさらに有する。
The
副測位演算部１６は、以下の式（６）で示す連立測位方程式を解くことで、各受信アンテナ１１の受信系遅延位相の暫定値を演算する。なお、式（６）では、受信機群Ｇ１の位相算出部１５から出力された各電波発信機１０の電波位相と、受信機群Ｇ１の各受信アンテナ１１の位置座標とを既知数とし、各電波発信機１０の位置座標と、各電波発信機１０の初期位相と、受信機群Ｇ１の各受信アンテナ１１の受信系遅延位相を未知数としている。
The
なお、通常では、各受信アンテナ１１の受信系遅延位相は、各受信アンテナ１１間の相対値でよいので、ξ１，１＝０とできるが、本実施の形態２では、受信機群Ｇ１，Ｇ２間の位相同期誤差を推定するために、ξ１，１についても未知数として、連立測位方程式を解くように構成されている。
Normally, the reception system delay phase of each
副測位演算部２６は、以下の式（７）で示す連立測位方程式を解くことで、各受信アンテナ２１の受信系遅延位相の暫定値を演算する。なお、式（７）では、受信機群Ｇ２の位相算出部２５から出力された各電波発信機１０の電波位相と、受信機群Ｇ２の各受信アンテナ２１の位置座標とを既知数とし、各電波発信機１０の位置座標と、各電波発信機１０の初期位相と、受信機群Ｇ２の各受信アンテナ２１の受信系遅延位相を未知数としている。
The
位相同期誤差推定部６０は、副測位演算部１６によって演算された各受信アンテナ１１の受信系遅延位相の暫定値と、副測位演算部２６によって演算された各受信アンテナ２１の受信系遅延位相の暫定値とから、受信機群Ｇ１，Ｇ２間の位相同期誤差を推定する。具体的には、位相同期誤差推定部６０は、以下の式（８）に従って、位相同期誤差を推定する。
The phase synchronization
このように、位相同期誤差推定部６０は、各受信機群Ｇ１，Ｇ２の副測位演算部１６，２６から出力された各受信アンテナ１１，２１の受信系遅延位相の暫定値の平均値を受信機群Ｇ１，Ｇ２ごとに演算し、各受信機群Ｇ１，Ｇ２の平均値の差分値を、位相同期誤差として推定する。
As described above, the phase synchronization
測位演算部５０は、式（３）に示す連立測位方程式を解くことで、各電波発信機１０の位置座標を演算する。なお、本実施の形態２における測位演算部５０が解く、式（３）に示す連立測位方程式では、各受信機群Ｇ１，Ｇ２の位相算出部１５，２５から出力された各電波発信機１０の電波位相と、各受信機群Ｇ１，Ｇ２の各受信アンテナ１１，２１の位置座標と、位相同期誤差推定部６０から出力された位相同期誤差とを既知数とし、各電波発信機１０の位置座標と、各電波発信機１０の初期位相と、各受信機群Ｇ１，Ｇ２の各受信アンテナ１１，２１の受信系遅延位相を未知数としている。
The
次に、本実施の形態２における測位装置の全体の動作について、図５を参照しながら説明する。図５は、本発明の実施の形態２における測位装置の一連の動作を示すフローチャートである。 Next, the overall operation of the positioning device according to the second embodiment will be described with reference to FIG. FIG. 5 is a flowchart showing a series of operations of the positioning device according to Embodiment 2 of the present invention.
図５に示すように、ステップＳ３０１〜ステップＳ３０４は、先の図３のステップＳ１０１〜ステップＳ１０４と同様の処理である。また、ステップＳ４０１〜ステップＳ４０５は、先の図３のステップＳ２０１〜ステップＳ２０５と同様の処理である。 As shown in FIG. 5, steps S301 to S304 are the same processes as steps S101 to S104 in FIG. Steps S401 to S405 are the same processes as steps S201 to S205 in FIG.
ステップＳ３０４の処理が実行された後、信号処理回路３０は、副測位演算処理を実行することで、各受信アンテナ１１の受信系遅延位相の暫定値を演算する（ステップＳ３０５）。
After the process of step S304 is executed, the
ステップＳ４０５の処理が実行された後、信号処理回路４０は、副測位演算処理を実行することで、各受信アンテナ２１の受信系遅延位相の暫定値を演算する（ステップＳ４０６）。
After the process of step S405 is executed, the
続いて、信号処理回路４０は、ステップＳ４０５で計算した各受信アンテナ２１に対応した各電波発信機１０の電波位相と、ステップＳ４０６で計算した各受信アンテナ２１の受信系遅延位相の暫定値とを、副測位データとして信号処理回路３０に送信する（ステップＳ４０７）。
Subsequently, the
信号処理回路３０は、信号処理回路４０から送信された副測位データを受信する（ステップＳ３０６）。位相同期誤差推定部６０は、ステップＳ３０５で計算した各受信アンテナ１１の受信系遅延位相の暫定値と、ステップＳ３０６で受信した各受信アンテナ２１の受信系遅延位相の暫定値とから、位相同期誤差を推定する（ステップＳ３０７）。
The
測位演算部５０は、ステップＳ３０４で計算した各受信アンテナ１１に対応した各電波発信機１０の電波位相と、ステップＳ３０６で受信した各受信アンテナ２１に対応した各電波発信機１０の電波位相と、ステップＳ３０７で推定した位相同期誤差とを用いて、測位演算処理を実行する（ステップＳ３０８）。信号処理回路３０は、ステップＳ３０８で実行された測位演算処理の結果を測位結果として表示する（ステップＳ３０９）。
The
以上、本実施の形態２によれば、先の実施の形態１の構成に対して、各受信機群の位相算出部から出力された各電波発信機の電波位相と、各受信機群の各受信アンテナの位置座標と、位相同期誤差推定部から出力された位相同期誤差とを既知数とし、各電波発信機の位置座標と、各電波発信機の初期位相と、各受信機群の各受信アンテナの受信系遅延位相とを未知数とした連立測位方程式を解くことで、各電波発信機の位置座標を演算するように構成されている。 As described above, according to the second embodiment, with respect to the configuration of the first embodiment, the radio wave phase of each radio wave transmitter output from the phase calculation unit of each receiver group, and each receiver group The position coordinates of the receiving antenna and the phase synchronization error output from the phase synchronization error estimator are assumed to be known numbers, the position coordinates of each radio wave transmitter, the initial phase of each radio wave transmitter, and each reception of each receiver group It is configured to calculate the position coordinates of each radio wave transmitter by solving a simultaneous positioning equation with an unknown reception system delay phase of the antenna.
このように構成することで、各受信機群で副測位演算処理が実行された後に受信機群間の位相同期誤差を推定し、その推定した位相同期誤差を用いて測位演算処理が実行されるので、整数値バイアスを取り除き、安定した測位演算が可能となる。 With this configuration, after the sub-positioning calculation process is executed in each receiver group, the phase synchronization error between the receiver groups is estimated, and the positioning calculation process is executed using the estimated phase synchronization error. Therefore, it is possible to remove the integer value bias and perform stable positioning calculation.
なお、上記の構成に対して、各受信機群の位相算出部から出力された各電波発信機の電波位相と、各受信機群の各受信アンテナの位置座標と、位相同期誤差推定部から出力された位相同期誤差と、各受信機群の副測位演算部から出力された各受信アンテナの受信系遅延位相の暫定値とを既知数とし、各電波発信機の位置座標と、各電波発信機の初期位相とを未知数とした連立測位方程式を解くことで、各電波発信機の位置座標を演算するように構成してもよい。このように構成した場合であっても、上記と同様の効果が得られる。 For the above configuration, the radio wave phase of each radio wave transmitter output from the phase calculation unit of each receiver group, the position coordinates of each receiving antenna of each receiver group, and the output from the phase synchronization error estimation unit And the provisional value of the reception system delay phase of each receiving antenna output from the sub-positioning calculation unit of each receiver group is a known number, the position coordinates of each radio wave transmitter, and each radio wave transmitter The position coordinates of each radio wave transmitter may be calculated by solving a simultaneous positioning equation with the initial phase as an unknown. Even in this case, the same effect as described above can be obtained.
実施の形態３．
先の実施の形態１、２では、周波数変換部１２，２２および基準信号生成部１３，２３を設け、各受信アンテナ１１，２１から入力された受信信号の周波数を低い周波数に変換した後、その変換後の信号をＡ／Ｄ変換部１４，２４によってＡ／Ｄ変換するように構成する場合について説明した。これに対して、本発明の実施の形態３では、先の実施の形態１、２の構成に対して、周波数変換部１２，２２および基準信号生成部１３，２３を設けない場合について説明する。なお、本実施の形態３では、先の実施の形態１、２と同様である点の説明を省略し、先の実施の形態１、２と異なる点を中心に説明する。
Embodiment 3 FIG.
In the first and second embodiments, the
図６は、本発明の実施の形態３における測位装置を示す構成図である。なお、図６では、先の実施の形態１の構成、すなわち、図１の構成に対して、周波数変換部１２，２２および基準信号生成部１３，２３を設けない場合を例示している。
FIG. 6 is a configuration diagram showing a positioning device according to Embodiment 3 of the present invention. 6 illustrates a case where the
このように、各受信アンテナ１１，２１から入力された受信信号の周波数を低い周波数に変換せずに、その受信信号をＡ／Ｄ変換部１４，２４によってＡ／Ｄ変換するように構成した場合であっても、位相算出部１５，２５は、Ａ／Ｄ変換部１４，２４から出力されたディジタル信号から各電波発信機１０の電波位相を算出することができる。したがって、先の実施の形態１、２の構成に対して、周波数変換部１２，２２および基準信号生成部１３，２３を設けない場合であっても、先の実施の形態１、２と同様の効果が得られる。
As described above, the A /
以上、本実施の形態３によれば、先の実施の形態１、２の構成に対して、各受信アンテナの受信信号を周波数変換することなくＡ／Ｄ変換し、Ａ／Ｄ変換後のディジタル信号を出力し、Ａ／Ｄ変換後のディジタル信号から各電波発信機の電波位相を算出するように構成されている。これにより、先の実施の形態１、２と同様の効果が得られる。 As described above, according to the third embodiment, the received signal of each receiving antenna is A / D converted without frequency conversion to the configuration of the first and second embodiments, and the digital signal after A / D conversion is performed. A signal is output, and the radio wave phase of each radio wave transmitter is calculated from the digital signal after A / D conversion. Thereby, the same effect as in the first and second embodiments can be obtained.
なお、本願発明は、その発明の範囲内において、各実施の形態の自由な組み合わせ、あるいは各実施の形態の任意の構成要素の変形、もしくは各実施の形態において任意の構成要素の省略が可能である。 In the present invention, within the scope of the invention, a free combination of each embodiment, a modification of an arbitrary component of each embodiment, or an omission of any component in each embodiment is possible. is there.
１０ 電波発信機、１１ 受信アンテナ、１２ 周波数変換部、１３ 基準信号生成部、１４ Ａ／Ｄ変換部、１５ 位相算出部、１６ 副測位演算部、２１ 受信アンテナ、２２ 周波数変換部、２３ 基準信号生成部、２４ Ａ／Ｄ変換部、２５ 位相算出部、２６ 副測位演算部、３０ 信号処理回路、３１ メモリ、３２ プロセッサ、３３ クロック、３４ Ａ／Ｄ変換制御インターフェース、３５ データ送受信インターフェース、３６ 表示器、４０ 信号処理回路、４１ メモリ、４２ プロセッサ、４３ クロック、４４ Ａ／Ｄ変換制御インターフェース、４５ データ送受信インターフェース、５０ 測位演算部、６０ 位相同期誤差推定部、Ｇ１ 受信機群、Ｇ２ 受信機群。
DESCRIPTION OF
Claims (5)
それぞれの間で互いに時刻同期誤差が存在する複数の受信機群と、
各電波発信機の位置座標を演算する測位演算部と、
を備え、
各受信機群は、
位置が既知の固定点に設置されており、各電波発信機からの電波を受信する複数の受信アンテナと、
各受信アンテナの受信信号から各受信アンテナに対応した各電波発信機の電波位相を算出する位相算出部と、
を有し、
前記測位演算部は、
各受信機群の前記位相算出部から出力された各電波発信機の前記電波位相と、各受信機群の各受信アンテナの位置座標を既知数とし、各電波発信機の前記位置座標と、各電波発信機の初期位相と、各受信機群の各受信アンテナの受信系遅延位相とを未知数とした連立測位方程式を解くことで、各電波発信機の前記位置座標を演算し、
各受信機群は、
前記位相算出部から出力された各電波発信機の前記電波位相と、各受信アンテナの位置座標を既知数とし、各電波発信機の前記位置座標と、各電波発信機の前記初期位相と、各受信アンテナの前記受信系遅延位相とを未知数とした連立測位方程式を解くことで、各受信アンテナの前記受信系遅延位相の暫定値を演算して出力する副測位演算部をさらに有し、
各受信機群の前記副測位演算部から出力された各受信アンテナの前記受信系遅延位相の前記暫定値から、受信機群間の位相同期誤差を推定して出力する位相同期誤差推定部をさらに備え、
前記測位演算部は、
各受信機群の前記位相算出部から出力された各電波発信機の前記電波位相と、各受信機群の各受信アンテナの位置座標と、前記位相同期誤差推定部から出力された前記位相同期誤差とを既知数とし、各電波発信機の前記位置座標と、各電波発信機の前記初期位相と、各受信機群の各受信アンテナの前記受信系遅延位相とを未知数とした連立測位方程式を解くことで、各電波発信機の前記位置座標を演算する
測位装置。 Multiple radio transmitters,
A plurality of receiver groups each having a time synchronization error between each other;
A positioning calculation unit for calculating the position coordinates of each radio wave transmitter,
With
Each receiver group
A plurality of receiving antennas installed at fixed points whose positions are known and receiving radio waves from each radio wave transmitter,
A phase calculation unit that calculates a radio wave phase of each radio wave transmitter corresponding to each reception antenna from a reception signal of each reception antenna;
Have
The positioning calculation unit
The radio wave phase of each radio wave transmitter output from the phase calculation unit of each receiver group and the position coordinates of each receiving antenna of each receiver group are known numbers, the position coordinates of each radio wave transmitter, and each By solving the simultaneous positioning equation with the initial phase of the radio wave transmitter and the reception system delay phase of each receiving antenna of each receiver group as unknowns, the position coordinates of each radio wave transmitter are calculated,
Each receiver group
The radio wave phase of each radio wave transmitter output from the phase calculation unit and the position coordinates of each receiving antenna are known numbers, the position coordinates of each radio wave transmitter, the initial phase of each radio wave transmitter, and By further solving a simultaneous positioning equation with the reception system delay phase of the reception antenna as an unknown, a sub-positioning calculation unit that calculates and outputs a provisional value of the reception system delay phase of each reception antenna,
A phase synchronization error estimation unit that estimates and outputs a phase synchronization error between the receiver groups from the provisional value of the reception system delay phase of each reception antenna output from the sub-positioning calculation unit of each receiver group; Prepared,
The positioning calculation unit
The radio wave phase of each radio wave transmitter output from the phase calculation unit of each receiver group, the position coordinates of each receiving antenna of each receiver group, and the phase synchronization error output from the phase synchronization error estimation unit Is a known number, and solves simultaneous positioning equations where the position coordinates of each radio wave transmitter, the initial phase of each radio wave transmitter, and the reception system delay phase of each receiving antenna of each receiver group are unknown. By calculating the position coordinates of each radio wave transmitter
Measuring position equipment.
それぞれの間で互いに時刻同期誤差が存在する複数の受信機群と、
各電波発信機の位置座標を演算する測位演算部と、
を備え、
各受信機群は、
位置が既知の固定点に設置されており、各電波発信機からの電波を受信する複数の受信アンテナと、
各受信アンテナの受信信号から各受信アンテナに対応した各電波発信機の電波位相を算出する位相算出部と、
を有し、
前記測位演算部は、
各受信機群の前記位相算出部から出力された各電波発信機の前記電波位相と、各受信機群の各受信アンテナの位置座標を既知数とし、各電波発信機の前記位置座標と、各電波発信機の初期位相と、各受信機群の各受信アンテナの受信系遅延位相とを未知数とした連立測位方程式を解くことで、各電波発信機の前記位置座標を演算し、
各受信機群は、
前記位相算出部から出力された各電波発信機の前記電波位相と、各受信アンテナの位置座標を既知数とし、各電波発信機の前記位置座標と、各電波発信機の前記初期位相と、各受信アンテナの前記受信系遅延位相とを未知数とした連立測位方程式を解くことで、各受信アンテナの前記受信系遅延位相の暫定値を演算して出力する副測位演算部をさらに有し、
各受信機群の前記副測位演算部から出力された各受信アンテナの前記受信系遅延位相の前記暫定値から、受信機群間の位相同期誤差を推定して出力する位相同期誤差推定部をさらに備え、
前記測位演算部は、
各受信機群の前記位相算出部から出力された各電波発信機の前記電波位相と、各受信機群の各受信アンテナの位置座標と、前記位相同期誤差推定部から出力された前記位相同期誤差と、各受信機群の前記副測位演算部から出力された各受信アンテナの前記受信系遅延位相の前記暫定値とを既知数とし、各電波発信機の前記位置座標と、各電波発信機の前記初期位相とを未知数とした連立測位方程式を解くことで、各電波発信機の前記位置座標を演算する
測位装置。 Multiple radio transmitters,
A plurality of receiver groups each having a time synchronization error between each other;
A positioning calculation unit for calculating the position coordinates of each radio wave transmitter,
With
Each receiver group
A plurality of receiving antennas installed at fixed points whose positions are known and receiving radio waves from each radio wave transmitter,
A phase calculation unit that calculates a radio wave phase of each radio wave transmitter corresponding to each reception antenna from a reception signal of each reception antenna;
Have
The positioning calculation unit
The radio wave phase of each radio wave transmitter output from the phase calculation unit of each receiver group and the position coordinates of each receiving antenna of each receiver group are known numbers, the position coordinates of each radio wave transmitter, and each By solving the simultaneous positioning equation with the initial phase of the radio wave transmitter and the reception system delay phase of each receiving antenna of each receiver group as unknowns, the position coordinates of each radio wave transmitter are calculated,
Each receiver group
The radio wave phase of each radio wave transmitter output from the phase calculation unit and the position coordinates of each receiving antenna are known numbers, the position coordinates of each radio wave transmitter, the initial phase of each radio wave transmitter, and By further solving a simultaneous positioning equation with the reception system delay phase of the reception antenna as an unknown, a sub-positioning calculation unit that calculates and outputs a provisional value of the reception system delay phase of each reception antenna,
A phase synchronization error estimation unit that estimates and outputs a phase synchronization error between the receiver groups from the provisional value of the reception system delay phase of each reception antenna output from the sub-positioning calculation unit of each receiver group; Prepared,
The positioning calculation unit
The radio wave phase of each radio wave transmitter output from the phase calculation unit of each receiver group, the position coordinates of each receiving antenna of each receiver group, and the phase synchronization error output from the phase synchronization error estimation unit And the provisional value of the reception system delay phase of each reception antenna output from the sub-positioning calculation unit of each receiver group as a known number, the position coordinates of each radio wave transmitter, and each radio wave transmitter Calculate the position coordinates of each radio wave transmitter by solving simultaneous positioning equations with the initial phase as an unknown
Measuring position equipment.
各受信機群の前記副測位演算部から出力された各受信アンテナの前記受信系遅延位相の前記暫定値の平均値を受信機群ごとに演算し、各受信機群の前記平均値の差分値を、前記位相同期誤差として推定する
請求項１または２に記載の測位装置。 The phase synchronization error estimator is
The average value of the provisional value of the reception system delay phase of each receiving antenna output from the sub-positioning calculation unit of each receiver group is calculated for each receiver group, and the difference value of the average value of each receiver group the positioning device according to claim 1 or 2, estimated as the phase synchronization error.
基準信号を生成して出力する基準信号生成部と、
前記基準信号生成部から出力された前記基準信号と、各受信アンテナの前記受信信号とから、各受信アンテナの前記受信信号の周波数を変換し、周波数変換後の信号を出力する周波数変換部と、
前記周波数変換部から出力された前記周波数変換後の信号をＡ／Ｄ変換し、Ａ／Ｄ変換後のディジタル信号を出力するＡ／Ｄ変換部と、
をさらに有し、
前記位相算出部は、
前記Ａ／Ｄ変換部から出力された前記ディジタル信号から各電波発信機の前記電波位相を算出する
請求項１から３のいずれか１項に記載の測位装置。 Each receiver group
A reference signal generator for generating and outputting a reference signal;
A frequency converter that converts the frequency of the reception signal of each reception antenna from the reference signal output from the reference signal generation unit and the reception signal of each reception antenna, and outputs a signal after frequency conversion;
An A / D converter that performs A / D conversion on the frequency-converted signal output from the frequency converter and outputs a digital signal after A / D conversion;
Further comprising
The phase calculation unit includes:
The positioning device according to any one of claims 1 to 3 , wherein the radio wave phase of each radio wave transmitter is calculated from the digital signal output from the A / D converter.
各受信アンテナの前記受信信号をＡ／Ｄ変換し、Ａ／Ｄ変換後のディジタル信号を出力するＡ／Ｄ変換部をさらに有し、
前記位相算出部は、
前記Ａ／Ｄ変換部から出力された前記ディジタル信号から各電波発信機の前記電波位相を算出する
請求項１から３のいずれか１項に記載の測位装置。 Each receiver group
An A / D converter that A / D converts the received signal of each receiving antenna and outputs a digital signal after A / D conversion;
The phase calculation unit includes:
The positioning device according to any one of claims 1 to 3 , wherein the radio wave phase of each radio wave transmitter is calculated from the digital signal output from the A / D converter.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2016035567A JP6403704B2 (en) | 2016-02-26 | 2016-02-26 | Positioning device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2016035567A JP6403704B2 (en) | 2016-02-26 | 2016-02-26 | Positioning device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2017151022A JP2017151022A (en) | 2017-08-31 |
| JP6403704B2 true JP6403704B2 (en) | 2018-10-10 |
Family
ID=59741901
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2016035567A Active JP6403704B2 (en) | 2016-02-26 | 2016-02-26 | Positioning device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP6403704B2 (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108663680B (en) * | 2018-04-10 | 2021-02-09 | 北京凌宇智控科技有限公司 | Three-dimensional space positioning method, device and system for reducing time synchronization |
| CN108896984B (en) * | 2018-04-20 | 2020-11-24 | 浙江大学 | Moving object positioning and tracking method based on radio frequency single-frequency continuous wave |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2006349515A (en) * | 2005-06-16 | 2006-12-28 | Mitsubishi Electric Corp | System and method for measuring displacement |
| JP4980094B2 (en) * | 2007-02-16 | 2012-07-18 | 三菱電機株式会社 | Displacement measuring device |
| JP2010230467A (en) * | 2009-03-27 | 2010-10-14 | Nec Corp | Positioning system, positioning device, positioning method, and program |
| KR101220794B1 (en) * | 2011-05-16 | 2013-01-15 | 엘에스산전 주식회사 | Rtls system using tdoa |
-
2016
- 2016-02-26 JP JP2016035567A patent/JP6403704B2/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP2017151022A (en) | 2017-08-31 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US11632226B1 (en) | Frequency and gain calibration for time synchronization in a network | |
| EP2118675B1 (en) | Determining a position of a tag | |
| CN110168396B (en) | Time of arrival (TOA) measurements | |
| US8543132B2 (en) | Method of estimating position of mobile node in wireless sensor network | |
| JP6877438B2 (en) | Methods and systems for reducing interference caused by phase noise in radar systems | |
| US10859666B1 (en) | Method and system for radiofrequency localization of transmitting devices via a mesh network | |
| EP1994425B1 (en) | System and method for performing time difference of arrival location without requiring a common time base or clock calibration | |
| US11804871B2 (en) | Systems and methods for synchronizing time, frequency, and phase among a plurality of devices | |
| KR101234177B1 (en) | Method for estimating position of user device | |
| JP5450790B2 (en) | Geostationary satellite positioning system | |
| JP2006349515A (en) | System and method for measuring displacement | |
| Bidigare et al. | Initial over-the-air performance assessment of ranging and clock synchronization using radio frequency signal exchange | |
| JP6760592B2 (en) | Beacon device, direction estimation method using the beacon device, position estimation method, and communication terminal device | |
| JP6403704B2 (en) | Positioning device | |
| AU2015337595A1 (en) | Positioning Device | |
| US11792049B2 (en) | Positioning using synthesized wideband channel estimation and synchronized receivers | |
| CN112399329B (en) | Method, equipment and device for synthesizing, sending and receiving reference signals | |
| US9733352B2 (en) | Positioning system and method | |
| JP6130195B2 (en) | Radar system | |
| US20240205853A1 (en) | Method and arrangement for determining a clock offset between at least two radio units | |
| US11686805B1 (en) | Method and system for radiofrequency localization of transmitting devices via a mesh network | |
| JP2009122045A (en) | Positioning device | |
| RU2383914C1 (en) | Method of synchronising watches and device for realising said method | |
| JP2015212655A (en) | Radar system | |
| KR102041470B1 (en) | METHOD AND APPARATUS FOR eLoran-BASED TIME SYNCHRONIZATION |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20170711 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20180523 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20180529 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20180723 |
|
| 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: 20180814 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20180911 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 6403704 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 |