JP7107820B2 - Positioning device, positioning method - Google Patents

Positioning device, positioning method Download PDF

Info

Publication number
JP7107820B2
JP7107820B2 JP2018213134A JP2018213134A JP7107820B2 JP 7107820 B2 JP7107820 B2 JP 7107820B2 JP 2018213134 A JP2018213134 A JP 2018213134A JP 2018213134 A JP2018213134 A JP 2018213134A JP 7107820 B2 JP7107820 B2 JP 7107820B2
Authority
JP
Japan
Prior art keywords
positioning
coordinate system
area
positioning device
shielding
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
Application number
JP2018213134A
Other languages
Japanese (ja)
Other versions
JP2020079748A (en
Inventor
瑛 樋山
匡 杉本
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Furuno Electric Co Ltd
Original Assignee
Furuno Electric Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Furuno Electric Co Ltd filed Critical Furuno Electric Co Ltd
Priority to JP2018213134A priority Critical patent/JP7107820B2/en
Publication of JP2020079748A publication Critical patent/JP2020079748A/en
Application granted granted Critical
Publication of JP7107820B2 publication Critical patent/JP7107820B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Position Fixing By Use Of Radio Waves (AREA)

Description

本発明は、測位に用いる測位信号(測位衛星)を選択するための技術に関する。 The present invention relates to a technology for selecting positioning signals (positioning satellites) used for positioning.

特許文献1に記載の装置は、移動体にレーザスキャナやステレオカメラ等の構造物検出装置を備える。特許文献1に記載の装置は、構造物検出装置によって検出した周囲の構造物の位置を用いて、仰角マスクを設定する。特許文献1に記載の装置は、この仰角マスクを用いて、特定の航法衛星からの航法信号の利用を制限して、測位を行う。 The device described in Patent Literature 1 includes a structure detection device such as a laser scanner or a stereo camera on a moving body. The device described in Patent Literature 1 sets an elevation mask using the positions of surrounding structures detected by a structure detection device. The device described in Patent Document 1 uses this elevation mask to limit the use of navigation signals from specific navigation satellites and performs positioning.

特許文献2に記載の装置は、魚眼レンズを備える。特許文献2に記載の装置は、魚眼レンズによって検出した周囲の風景から障害物を検出する。特許文献2に記載の装置は、障害物の方向から、遮蔽領域を設定する。特許文献2に記載の装置は、この遮蔽領域の方向の衛星からの電波の利用を制限して、測位を行う。 The device described in Patent Literature 2 includes a fisheye lens. The device described in Patent Literature 2 detects obstacles from the surrounding scenery detected by a fisheye lens. The device described in Patent Literature 2 sets the shielding area from the direction of the obstacle. The device described in Patent Document 2 performs positioning by restricting the use of radio waves from satellites in the direction of this shielded area.

特開2017-15585号公報JP 2017-15585 A 特開2002-357422号公報Japanese Patent Application Laid-Open No. 2002-357422

しかしながら、特許文献1や特許文献2に示すように、従来の構成では、測位に直接利用するデータを出力する機能部以外に、仰角マスクや遮蔽領域を設定するための他の装置を用いなければならない。 However, as shown in Patent Document 1 and Patent Document 2, in the conventional configuration, in addition to the functional unit that outputs the data directly used for positioning, another device for setting the elevation mask and the shielding area must be used. not.

したがって、本発明の目的は、測位に用いるデータを用いて、遮蔽領域を設定することにある。 Therefore, an object of the present invention is to set a shielded area using data used for positioning.

この発明の測位装置は、衛星方向算出部、分布生成部、および、遮蔽領域設定部を備える。衛星方向算出部は、測位信号に重畳された航法メッセージから得られるNED座標系での測位衛星の位置と、測位信号の受信結果から得られる測位装置の姿勢角と、を用いて、測位衛星の測位装置におけるボディ座標系での仰角および方位角を算出する。分布生成部は、測位衛星のボディ座標系での仰角および方位角と測位信号の信号受信強度と、を用いて、信号受信強度のボディ座標系での分布を生成する。遮蔽領域設定部は、ボディ座標系での分布を用いて、測位への影響を低くまたはゼロに設定する測位信号の決定に用いる遮蔽領域を設定する。 A positioning device according to the present invention includes a satellite direction calculator, a distribution generator, and a shielded area setter. The satellite direction calculation unit uses the position of the positioning satellite in the NED coordinate system obtained from the navigation message superimposed on the positioning signal and the attitude angle of the positioning device obtained from the reception result of the positioning signal to calculate the position of the positioning satellite. Elevation and azimuth angles in the body coordinate system of the positioning device are calculated. The distribution generation unit generates a distribution of signal reception strength in the body coordinate system using the elevation angle and azimuth angle of the positioning satellite in the body coordinate system and the signal reception strength of the positioning signal. The shielded area setting unit uses the distribution in the body coordinate system to set a shielded area used for determining a positioning signal that has a low or zero influence on positioning.

この構成では、測位に用いる機能部以外を用いなくても遮蔽領域が設定される。さらに、ボディ座標系で遮蔽領域が設定されることによって、自装置(測位装置)、および、自装置が搭載された物体(例えば、船舶等の移動体)に起因する遮蔽領域が設定される。 With this configuration, the shielded area is set without using any functional units other than those used for positioning. Furthermore, by setting a shielded area in the body coordinate system, a shielded area caused by the own device (positioning device) and an object (for example, a moving body such as a ship) on which the own device is mounted is set.

この発明によれば、測位に用いるデータを用いて、遮蔽領域を設定できる。 According to this invention, the shielded area can be set using data used for positioning.

本発明の第1の実施形態に係る測位装置における遮蔽情報設定部の構成を示す機能ブロック図である。4 is a functional block diagram showing the configuration of a shielding information setting unit in the positioning device according to the first embodiment of the present invention; FIG. 本発明の第1の実施形態に係る測位装置の構成を示す機能ブロック図である。1 is a functional block diagram showing the configuration of a positioning device according to a first embodiment of the present invention; FIG. (A)、(B)、(C)は、ボディ座標系でのスカイプロットにおける測位衛星の位置をプロットする概念を説明するための図である。(A), (B), and (C) are diagrams for explaining the concept of plotting the positions of positioning satellites in a sky plot in a body coordinate system. スカイプロットにおける遮蔽判定用領域の設定の概念を表す図である。FIG. 10 is a diagram showing a concept of setting a shielding determination area in a sky plot; (A)、(B)、(C)は、投影点の分類の概念の一例を示す図である。(A), (B), and (C) are diagrams showing an example of the concept of classification of projection points. 信号レベルの一例を示す図である。It is a figure which shows an example of a signal level. (A)、(B)は、遮蔽領域の設定の一例を示したものである。(A) and (B) show an example of setting a shielded area. 測位装置で実行されるメインの処理(測位方法)を示すフローチャートである。4 is a flowchart showing main processing (positioning method) executed by the positioning device; 測位衛星の方向を算出する処理を示すフローチャートである。4 is a flowchart showing processing for calculating the direction of a positioning satellite; 遮蔽領域を設定する処理を示すフローチャートである。9 is a flowchart showing processing for setting a shielded area; 慣性センサを用いた測位装置の構成を示す機能ブロック図である。1 is a functional block diagram showing the configuration of a positioning device using inertial sensors; FIG.

本発明の第1の実施形態に係る測位装置、測位方法について、図を参照して説明する。なお、以下では、測位装置が装着される物体として、移動体、特に、船舶を用いる態様を示すが、他の移動体、例えば、水中移動体、陸上移動体、または、空中移動体にも、本願発明の構成は適用でき、静止する物体にも適用できる。ただし、物体が移動体である時に、本願発明の構成は、より有効である。 A positioning device and a positioning method according to a first embodiment of the present invention will be described with reference to the drawings. In the following description, a mobile object, especially a ship, is used as an object to which the positioning device is attached. The configuration of the present invention can be applied, and it can also be applied to stationary objects. However, the configuration of the present invention is more effective when the object is a moving object.

図1は、本発明の実施形態に係る測位装置における遮蔽情報設定部の構成を示す機能ブロック図である。図2は、本発明の実施形態に係る測位装置の構成を示す機能ブロック図である。 FIG. 1 is a functional block diagram showing the configuration of the shielding information setting section in the positioning device according to the embodiment of the present invention. FIG. 2 is a functional block diagram showing the configuration of the positioning device according to the embodiment of the present invention.

(測位装置10の構成)
図2に示すように、測位装置10は、演算部20、および、アンテナ装置30を備える。アンテナ装置30は、演算部20に接続している。
(Configuration of positioning device 10)
As shown in FIG. 2 , the positioning device 10 has a computing section 20 and an antenna device 30 . The antenna device 30 is connected to the computing section 20 .

アンテナ装置30は、測位装置10が装着される移動体に設置されている。アンテナ装置30は、例えば、3個以上のGNSSアンテナ(図示を省略する。)によって構成されている。3個以上のGNSSアンテナは、全てのGNSSアンテナが一直線上に並ばないように、配置されていない。 Antenna device 30 is installed in a moving object to which positioning device 10 is attached. The antenna device 30 is composed of, for example, three or more GNSS antennas (not shown). Three or more GNSS antennas are not arranged such that all GNSS antennas are not aligned.

3個以上のGNSSアンテナは、それぞれに、複数の測位衛星(図示を省略する。)から送信される測位信号を受信し、演算部20に出力する。 The three or more GNSS antennas respectively receive positioning signals transmitted from a plurality of positioning satellites (not shown) and output them to the computing section 20 .

測位信号(GNSS(Grobal Navigation Satellite Sysytems)信号)は、所定の周波数からなる搬送波信号に、PRN(擬似ランダムノイズ)コード、および、航法メッセージが重畳された信号である。PRNコードは、送信元の測位衛星を識別するコードである。航法メッセージは、測位衛星の軌道情報、補正情報等を含むデータである。 A positioning signal (GNSS (Global Navigation Satellite Systems) signal) is a signal obtained by superimposing a PRN (Pseudo Random Noise) code and a navigation message on a carrier wave signal of a predetermined frequency. The PRN code is a code for identifying the positioning satellite of the transmission source. A navigation message is data including orbit information of a positioning satellite, correction information, and the like.

演算部20は、測位演算部21、および、遮蔽情報設定部22を備える。演算部20は、例えば、測位演算部21および遮蔽情報設定部22の機能を実現するプログラム、このプログラムを記憶する記憶部、および、このプログラムを記憶部から読み出して実行するCPU等の演算装置によって実現される。または、演算部20は、このプログラムが内蔵され、このプログラムを実行するIC等の演算素子によって実現される。 The computing unit 20 includes a positioning computing unit 21 and a shielding information setting unit 22 . The calculation unit 20 is, for example, a program that realizes the functions of the positioning calculation unit 21 and the shielding information setting unit 22, a storage unit that stores this program, and a calculation device such as a CPU that reads and executes this program from the storage unit. Realized. Alternatively, the arithmetic unit 20 is realized by an arithmetic element such as an IC that incorporates this program and executes this program.

測位信号は、測位演算部21に入力される。測位演算部21は、測位信号毎に、受信信号の強度(信号受信強度)SSを観測する。測位演算部21は、既知の方法を用いて、測位信号(測位衛星)毎に、コードおよび搬送波信号(キャリア信号)を捕捉、追尾する。 The positioning signal is input to the positioning calculator 21 . The positioning calculator 21 observes the received signal strength (signal reception strength) SS for each positioning signal. The positioning calculation unit 21 acquires and tracks the code and carrier wave signal (carrier signal) for each positioning signal (positioning satellite) using a known method.

測位演算部21は、アンテナ装置30の2個以上のGNSSアンテナで受信した測位信号のコードおよび搬送波信号の追尾結果(例えば、搬送波位相差や基線ベクトル等)を用いて、既知の方法から、姿勢角(ロール角、ピッチ角、ヨー角)R,P,Yを算出する。位置Psnは、NED座標系で算出される。この際、測位演算部21は、搬送波信号の位相の積算値を用いて、姿勢角R,P,Yを算出する。このように、搬送波信号の位相の積算値を用いることによって、姿勢角R,P,Yは、高精度に算出される。 The positioning calculation unit 21 uses the code of the positioning signals received by the two or more GNSS antennas of the antenna device 30 and the tracking result of the carrier wave signal (for example, the carrier wave phase difference, the baseline vector, etc.) to determine the attitude from a known method. Angles (roll angle, pitch angle, yaw angle) R, P, Y are calculated. The position Psn is calculated in the NED coordinate system. At this time, the positioning calculation unit 21 calculates the posture angles R, P, and Y using the integrated value of the phase of the carrier wave signal. In this manner, the posture angles R, P, and Y are calculated with high accuracy by using the integrated value of the phase of the carrier wave signal.

また、測位演算部21は、アンテナ装置30の2個以上のGNSSアンテナの少なくとも1個のGNSSアンテナで受信した測位信号のコードの追尾結果(例えば、コード擬似距離等)を用いて、既知の方法から、自装置の位置Psnを算出する。なお、自装置の位置Psnは、アンテナ装置30の2個以上のGNSSアンテナのいずれかの位置、または、2個以上のGNSSアンテナの幾何学的な中心位置で算出される。2個以上のGNSSアンテナのいずれかの位置を用いる場合には、自装置の位置PsnとするGNSSアンテナで受信した測位信号を用いた単独測位によって、自装置の位置Psnは算出できる。また、2個以上のGNSSアンテナの幾何学的な中心位置を用いる場合には、各GNSSアンテナの測位結果の平均値の算出によって、自装置の位置Psnは算出できる。 In addition, the positioning calculation unit 21 uses a code tracking result (for example, code pseudorange etc.) of the positioning signal received by at least one GNSS antenna among the two or more GNSS antennas of the antenna device 30 to perform a known method. , the position Psn of the own device is calculated. In addition, the position Psn of the own device is calculated at the position of any one of the two or more GNSS antennas of the antenna device 30 or the geometric center position of the two or more GNSS antennas. When using any position of two or more GNSS antennas, the position Psn of the own device can be calculated by independent positioning using the positioning signal received by the GNSS antenna as the position Psn of the own device. Also, when using the geometric center positions of two or more GNSS antennas, the position Psn of the own device can be calculated by calculating the average value of the positioning results of each GNSS antenna.

測位演算部21は、追尾結果に基づいて、搬送波信号に重畳された航法メッセージを復調する。 The positioning calculation unit 21 demodulates the navigation message superimposed on the carrier wave signal based on the tracking result.

測位演算部21は、追尾している測位衛星の識別情報SatN、この測位衛星からの測位信号の信号受信強度SS、自装置の位置Psn、自装置の姿勢角R,P,Y、および、航法メッセージNMを、遮蔽情報設定部22に出力する。なお、測位演算部21は、これらの情報の内の必要なものを、測位演算部21の後段に接続される各種の機能部(例えば、表示画像生成部等:図示せず)に出力する。 The positioning calculation unit 21 calculates the identification information SatN of the tracking satellite, the signal reception strength SS of the positioning signal from this positioning satellite, the position Psn of the device itself, the attitude angles R, P, Y of the device itself, and the navigation A message NM is output to the shielding information setting unit 22 . The positioning calculation unit 21 outputs necessary information among these pieces of information to various functional units (for example, a display image generation unit: not shown) connected after the positioning calculation unit 21 .

遮蔽情報設定部22は、概略的には、上述の測位演算部21から入力される測位に用いる各種のデータを用いて、遮蔽領域を設定する。遮蔽領域とは、測位に利用しない測位信号を判別するために設定された領域である。 Schematically, the shielding information setting unit 22 sets a shielding area using various data used for positioning input from the positioning calculation unit 21 described above. A shielded area is an area set to discriminate positioning signals that are not used for positioning.

遮蔽情報設定部22は、遮蔽領域を、測位演算部21に出力する。測位演算部21は、遮蔽領域を参照し、遮蔽領域内にある測位衛星の測位信号を用いることなく(測位への影響をゼロにして)、位置Psn、姿勢角R,P,Yを算出する。言い換えれば、測位演算部21は、遮蔽領域外にある測位衛星の測位信号を選択して、位置Psn、姿勢角R,P,Yを算出する。これにより、位置Psnおよび姿勢角R,P,Yの算出精度は向上する。 The shielding information setting section 22 outputs the shielding area to the positioning calculation section 21 . The positioning calculation unit 21 refers to the shielded area, and calculates the position Psn and the attitude angles R, P, and Y without using the positioning signals of the positioning satellites in the shielded area (zeroing the influence on the positioning). . In other words, the positioning calculator 21 selects positioning signals from positioning satellites outside the shielded area and calculates the position Psn and the attitude angles R, P, and Y. Thereby, the calculation accuracy of the position Psn and the attitude angles R, P, and Y is improved.

(遮蔽情報設定部22の具体的な構成)
図1に示すように、遮蔽情報設定部22は、衛星方向算出部221、分布生成部222、および、遮蔽領域設定部223を備える。
(Specific configuration of shielding information setting unit 22)
As shown in FIG. 1 , the shielding information setting unit 22 includes a satellite direction calculator 221 , a distribution generator 222 , and a shielded area setting unit 223 .

位置Psn、姿勢角R,P,Y、航法メッセージNM、および、測位衛星の識別情報SatNは、衛星方向算出部221に入力される。また、信号受信強度SSは、測位衛星の識別情報SatNに関連つけられた状態で、分布生成部222に入力される。 The position Psn, the attitude angles R, P, Y, the navigation message NM, and the identification information SatN of the positioning satellite are input to the satellite direction calculator 221 . In addition, the signal reception strength SS is input to the distribution generator 222 while being associated with the identification information SatN of the positioning satellite.

衛星方向算出部221は、測位衛星の識別情報SatNを参照して、航法メッセージNMから、追尾中の測位衛星の軌道情報を抽出する。衛星方向算出部221は、この軌道情報と自装置の位置Psnとを用いて、自装置の位置Psnを原点(中心)とした測位衛星の位置PsatNを算出する。測位衛星の位置PsatNは、NED座標系で得られる。 The satellite direction calculator 221 refers to the identification information SatN of the positioning satellite and extracts orbit information of the tracking satellite from the navigation message NM. The satellite direction calculator 221 uses this orbit information and the position Psn of the device itself to calculate the position PsatN of the positioning satellite with the position Psn of the device itself as the origin (center). The positioning satellite positions PsatN are obtained in the NED coordinate system.

衛星方向算出部221は、姿勢角R,P,Yを用いて、変換行列を算出する。変換行列は、自装置位置を基準とするNED座標系と自装置のボディ座標系との座標変換を行う行列である。姿勢角R,P,Yが分かれば、既知の方法によって、変換行列は算出可能である。 The satellite direction calculator 221 uses the attitude angles R, P, and Y to calculate a conversion matrix. The conversion matrix is a matrix that performs coordinate conversion between the NED coordinate system based on the position of the device itself and the body coordinate system of the device itself. If the attitude angles R, P, and Y are known, the transformation matrix can be calculated by a known method.

衛星方向算出部221は、自装置の位置を原点とした測位衛星の位置PsatNと、変換行列と、を用いて、自装置の位置を原点(中心)としたボディ座標系での測位衛星の仰角Φbおよび方位角θbを算出する。この演算は、既知の幾何学的な演算式によって実現可能である。衛星方向算出部221は、追尾中の複数の測位衛星、好ましくは、追尾中の全ての測位衛星に対して、仰角Φbおよび方位角θbを算出する。この処理は、1つの測位衛星に対して1回に限るものではなく、1つの測位衛星に対して複数回、すなわち所定の時間長に亘って実行される。 The satellite direction calculation unit 221 calculates the elevation angle of the positioning satellite in the body coordinate system with the position of the device itself as the origin (center) using the position PsatN of the positioning satellite with the position of the device itself as the origin and the conversion matrix. Φb and azimuth angle θb are calculated. This calculation can be realized by a known geometric calculation formula. The satellite direction calculator 221 calculates elevation angles Φb and azimuth angles θb for a plurality of tracking satellites, preferably all tracking satellites. This process is not limited to once for one positioning satellite, but is performed multiple times for one positioning satellite, that is, over a predetermined length of time.

衛星方向算出部221は、追尾中の測位衛星の識別情報SatNに関連づけして、この測位衛星の仰角Φbおよび方位角θbを、分布生成部222に出力する。 The satellite direction calculation unit 221 outputs the elevation angle Φb and the azimuth angle θb of the positioning satellite being tracked to the distribution generation unit 222 in association with the identification information SatN of the positioning satellite being tracked.

分布生成部222は、ボディ座標系でのスカイプロット800を生成する。図3(A)、図3(B)、図3(C)は、ボディ座標系でのスカイプロットにおける測位衛星の位置をプロットする概念を説明するための図である。 The distribution generator 222 generates a skyplot 800 in the body coordinate system. FIGS. 3(A), 3(B), and 3(C) are diagrams for explaining the concept of plotting the positions of the positioning satellites in the sky plot in the body coordinate system.

図3(A)、図3(B)、図3(C)に示すように、スカイプロット800とは、自装置の位置を中心としてボディ座標系によって定義された天頂側の半球の領域CObを、ボディ座標系における基準面(半球の底となる面)RPに二次元投影したものである。スカイプロット800は、自装置の位置を中心として、外方を向く放射方向に仰角Φbを設定し、円周方向に方位角θbを設定している。仰角Φbは、スカイプロット800の中心において90°であり、中心から離れるのにしたがって、小さくなる。方位角θbは、例えば、図3(A)に示すように、中心に対して特定の方向(例えば、船体90の中心を基準として船首を向く方向)をθb=0°として、1周で360°となるように設定されている。 As shown in FIGS. 3(A), 3(B), and 3(C), the sky plot 800 is a hemispherical area COb on the zenith side defined by the body coordinate system centering on the position of the apparatus itself. , is two-dimensionally projected onto the reference plane (the plane that forms the bottom of the hemisphere) RP in the body coordinate system. The skyplot 800 has an elevation angle Φb set in the outward radial direction and an azimuth angle θb set in the circumferential direction, centered on the position of the device itself. The elevation angle Φb is 90° at the center of the skyplot 800 and decreases away from the center. For example, as shown in FIG. 3A, the azimuth angle θb is 360 degrees in one revolution, with a specific direction (for example, the direction toward the bow with respect to the center of the hull 90 as a reference) being θb=0° with respect to the center. °.

図3(A)に示すように、スカイプロット800には、各測位衛星の投影点811B、811C、812B、812Cがプロットされている。これらの投影点811B、811C、812B、812Cは、上述のボディ座標系で得られた測位衛星の仰角Φbおよび方位角θbによってプロットされている。 As shown in FIG. 3A, a sky plot 800 plots projection points 811B, 811C, 812B, and 812C of each positioning satellite. These projection points 811B, 811C, 812B, 812C are plotted by the positioning satellite elevation angle Φb and azimuth angle θb obtained in the body coordinate system described above.

例えば、投影点811Bは、図3(B)に示す船体(測位装置10が搭載された移動体)90の姿勢(Pitch=0°)における測位衛星SAT1のボディ座標系での仰角Φbおよび方位角θbによってプロットされる。一方、投影点811Cは、図3(C)に示す船体90の姿勢(Pitch=5°)における測位衛星SAT1のボディ座標系での仰角Φbおよび方位角θbによってプロットされる。 For example, the projection point 811B is the elevation angle Φb and the azimuth angle in the body coordinate system of the positioning satellite SAT1 in the posture (Pitch=0°) of the hull (mobile body on which the positioning device 10 is mounted) 90 shown in FIG. Plotted by θb. On the other hand, the projection point 811C is plotted by the elevation angle Φb and the azimuth angle θb in the body coordinate system of the positioning satellite SAT1 at the attitude (Pitch=5°) of the hull 90 shown in FIG. 3(C).

また、投影点812Bは、図3(B)に示す船体90の姿勢(Pitch=0°)における測位衛星SAT2のボディ座標系での仰角Φbおよび方位角θbによってプロットされる。一方、投影点812Cは、図3(C)に示す船体90の姿勢(Pitch=5°)における測位衛星SAT2のボディ座標系での仰角Φbおよび方位角θbによってプロットされる。 Also, the projection point 812B is plotted by the elevation angle Φb and the azimuth angle θb in the body coordinate system of the positioning satellite SAT2 at the attitude (Pitch=0°) of the hull 90 shown in FIG. 3(B). On the other hand, the projection point 812C is plotted by the elevation angle Φb and the azimuth angle θb in the body coordinate system of the positioning satellite SAT2 at the attitude (Pitch=5°) of the hull 90 shown in FIG. 3(C).

仰角Φbおよび方位角θbがボディ座標系で算出されていることによって、図3(B)、図3(C)に示すように、船体90の姿勢が一定でなく、例えば、揺動等をしていても、各測位衛星の方向は、船体90を基準(中心)としたスカイプロットに、精度良くプロットされる。 Since the elevation angle Φb and the azimuth angle θb are calculated in the body coordinate system, the attitude of the hull 90 is not constant as shown in FIGS. However, the direction of each positioning satellite is accurately plotted on the sky plot with the hull 90 as the reference (center).

なお、図3(A)、図3(B)、図3(C)では、ピッチ角(Pitch)が変化する場合を示したが、ロール角(Roll)、および、ヨー角(Yaw)が変化する場合にも、同様に、測位衛星の方向(投影点)は、ボディ座標系のスカイプロット800に、精度良くプロットされる。 3(A), 3(B), and 3(C) show the case where the pitch angle (Pitch) changes, but the roll angle (Roll) and the yaw angle (Yaw) change. In this case, the directions (projection points) of the positioning satellites are also accurately plotted on the sky plot 800 of the body coordinate system.

分布生成部222は、仰角Φbおよび方位角θbが算出されている全ての測位衛星に対して、スカイプロット800に対する投影点のプロットを行う。分布生成部222は、複数の時刻で、仰角Φbおよび方位角θbが得られていれば、これら複数の時刻のそれぞれの仰角Φbおよび方位角θbを用いて、プロットを行う。この際、分布生成部222は、スカイプロット800における各投影点に対して、信号受信強度SSを関連付けする。 The distribution generator 222 plots projection points on the sky plot 800 for all positioning satellites for which elevation angles Φb and azimuth angles θb have been calculated. If the elevation angle Φb and the azimuth angle θb are obtained at a plurality of times, the distribution generator 222 plots using the elevation angle Φb and the azimuth angle θb at each of the plurality of times. At this time, the distribution generator 222 associates each projection point on the sky plot 800 with the received signal strength SS.

分布生成部222は、スカイプロット800を、遮蔽領域設定部223に出力する。 The distribution generation section 222 outputs the sky plot 800 to the shielded area setting section 223 .

遮蔽領域設定部223は、信号受信強度SSが関連付けされたスカイプロット800から、遮蔽領域を設定する。具体的には、例えば、遮蔽領域設定部223は、次に示す方法によって、遮蔽領域を設定する。 The shielded area setting unit 223 sets the shielded area from the sky plot 800 associated with the signal reception strength SS. Specifically, for example, the shielded area setting unit 223 sets the shielded area by the following method.

遮蔽領域設定部223は、スカイプロット800の全体領域を、図4に示すように、複数の遮蔽判定用領域aijに分割する。図4は、スカイプロットにおける遮蔽判定用領域の設定の概念を表す図である。 The shielding area setting unit 223 divides the entire area of the sky plot 800 into a plurality of shielding determination areas aij, as shown in FIG. FIG. 4 is a diagram showing the concept of setting the shielding determination area in the sky plot.

図4に示すように、スカイプロット800は、仰角Φbを用いて、複数の領域に分割される。さらに、スカイプロット800は、方位角θbを用いて、複数の領域に分割される。この仰角Φbおよび方位角θbによって分割される領域が遮蔽判定用領域aijとなる。 As shown in FIG. 4, the skyplot 800 is divided into multiple regions using the elevation angle Φb. Furthermore, the skyplot 800 is divided into multiple regions using the azimuth angle θb. A region divided by the elevation angle Φb and the azimuth angle θb is a shielding determination region aij.

例えば、図4の例であれば、スカイプロット800は、仰角Φbが0°から90°の間において、それぞれが18°の仰角Φbの範囲を有する領域に分割される。さらに、スカイプロット800は、方位角θbが0°から360°の間において、それぞれが30°の方位角θbの範囲を有する領域に分割される。すなわち、仰角Φbにおいて18°の範囲、且つ、方位角θbにおいて30°の範囲が、遮蔽判定用領域aijとなる。遮蔽判定用領域aijは、仰角Φbの方向には、i(=1,2,・・・)によって、識別可能であり、方位角θbの方向には、j(=1,2,・・・)によって、識別可能である。 For example, in the example of FIG. 4, the skyplot 800 is divided into regions each having an elevation angle Φb of 18° between 0° and 90°. Further, the skyplot 800 is divided into regions each having a range of azimuth angles θb of 30° between 0° and 360°. That is, a range of 18° in the elevation angle Φb and a range of 30° in the azimuth angle θb becomes the shielding determination area aij. The shielding judgment area aij can be identified by i (=1, 2, . . . ) in the direction of the elevation angle Φb, and j (=1, 2, . ).

遮蔽領域設定部223は、スカイプロット800にプロットされている全ての投影点を、遮蔽判定用領域aijの単位で分類する。図5(A)、図5(B)、図5(C)は、投影点の分類の概念の一例を示す図である。なお、図5(A)、図5(B)、図5(C)において、ハッチングされた領域は、信号受信強度SSが得られた遮蔽判定用領域aijを示し、ハッチングされていない領域は、信号受信強度SSが得られない遮蔽判定用領域aijを示す。 The shielding area setting unit 223 classifies all projection points plotted on the sky plot 800 in units of shielding determination areas aij. FIGS. 5A, 5B, and 5C are diagrams showing an example of the concept of classification of projection points. 5(A), 5(B), and 5(C), the hatched area indicates the shielding determination area aij where the signal reception strength SS is obtained, and the unhatched area is A shielding determination area aij in which no signal reception strength SS is obtained is shown.

図5(A)、図5(B)に示すように、遮蔽領域設定部223は、測位衛星の識別情報SatNを参照して、複数の測位衛星SAT1-SATm(mは2以上の整数)の投影点を、遮蔽判定用領域aij毎に分類し、信号受信強度SSに関連付けして記憶する。なお、図5(B)に示すように、1つの遮蔽判定用領域aijに複数の投影点がある場合には、これらの全ての投影点の信号受信強度SSを、遮蔽判定用領域aijに関連付けして記憶する。 As shown in FIGS. 5A and 5B, the shielding area setting unit 223 refers to the identification information SatN of the positioning satellites, and refers to the positioning satellites SAT1 to SATm (m is an integer of 2 or more). The projection points are classified for each shielding determination area aij, and stored in association with the signal reception strength SS. As shown in FIG. 5B, when there are a plurality of projection points in one shielding determination area aij, the signal reception strengths SS of all these projection points are associated with the shielding determination area aij. and memorize it.

遮蔽領域設定部223は、投影点と信号受信強度SSとを、遮蔽判定用領域aijに分類する(関連付けする)処理を、全ての測位衛星に対して行う。これにより、遮蔽領域設定部223は、図5(C)に示すような、遮蔽判定用領域aij毎に信号受信強度SSが関連付けされた分布を得る。 The shielded area setting unit 223 performs a process of classifying (associating) the projection points and the signal reception strengths SS with the shielding determination areas aij for all the positioning satellites. As a result, the shielding area setting unit 223 obtains a distribution in which the signal reception strength SS is associated with each shielding determination area aij, as shown in FIG. 5(C).

遮蔽領域設定部223は、それぞれの遮蔽判定用領域aijに対して、信号受信強度SSの代表値を設定する。具体的には、遮蔽領域設定部223は、遮蔽判定用領域aijに関連付けされた信号受信強度SSが1個の場合には、当該信号受信強度SSを、信号受信強度SSの代表値に設定する。また、遮蔽領域設定部223は、遮蔽判定用領域aijに関連付けされた信号受信強度SSが複数個の場合には、これら複数の信号受信強度SSの統計的算出値を、信号受信強度SSの代表値に設定する。統計的算出値とは、例えば、平均値、中央値等の1つを用いればよい。 The shielding area setting unit 223 sets a representative value of the signal reception strength SS for each shielding determination area aij. Specifically, when the number of signal reception strengths SS associated with the shielding determination area aij is one, the shielding area setting unit 223 sets the signal reception strength SS to the representative value of the signal reception strengths SS. . Further, when there are a plurality of signal reception strengths SS associated with the shielding determination area aij, the shielding region setting unit 223 sets the statistically calculated values of the plurality of signal reception strengths SS to a representative signal reception strength SS. set to a value. As the statistically calculated value, for example, one of an average value, a median value, and the like may be used.

遮蔽領域設定部223は、遮蔽判定用領域aij毎の信号受信強度SSの代表値から、遮蔽判定用領域aij毎の信号レベルを設定する。図6は、信号レベルの一例を示す図である。図6に示すように、遮蔽領域設定部223は、信号レベルを複数のレベルに設定する。各信号レベルは、複数の信号受信強度SSの代表値を、高さに応じて段階的に分類するものであり、1つの信号レベルに含まれる信号受信強度SSの代表値の強度には幅を有する。図6の例では、遮蔽領域設定部223は、Level0からLevel5の6段階に設定している。Level0は、信号受信強度SSが得られない場合に設定される。Level1からLevel5は、信号受信強度SSの代表値の高さにしたがって、代表値が低い順に設定される。 The shielding area setting unit 223 sets the signal level for each shielding determination area aij from the representative value of the signal reception strength SS for each shielding determination area aij. FIG. 6 is a diagram showing an example of signal levels. As shown in FIG. 6, the shielded area setting unit 223 sets the signal level to a plurality of levels. Each signal level classifies the representative values of a plurality of signal reception strengths SS in stages according to the height, and the strength of the representative value of the signal reception strengths SS included in one signal level has a width. have. In the example of FIG. 6, the shielding area setting unit 223 sets six levels from Level0 to Level5. Level 0 is set when the signal reception strength SS cannot be obtained. Level1 to Level5 are set in descending order of the representative value of the signal reception strength SS according to the height of the representative value.

遮蔽領域設定部223は、この信号レベルの分布を用いて、遮蔽判定用領域aijの単位で、遮蔽領域を設定する。図7(A)、図7(B)は、遮蔽領域の設定の一例を示したものである。図7(A)は、仰角毎に遮蔽領域の設定を行う場合を示し、図7(B)はスカイプロットの全体領域で遮蔽領域の設定を行う場合を示す。 The shielded area setting unit 223 uses this signal level distribution to set a shielded area for each shielding determination area aij. FIGS. 7A and 7B show an example of setting of the shielded area. FIG. 7A shows a case where the shielding area is set for each elevation angle, and FIG. 7B shows a case where the shielding area is set for the entire area of the sky plot.

(仰角毎に遮蔽領域を設定する場合)
遮蔽領域設定部223は、仰角Φb毎に、遮蔽領域を設定する。具体的には、遮蔽領域設定部223は、同じ仰角Φbにあり、方位角θbの方向に並ぶ複数の遮蔽判定用領域aijに対して、信号レベルの相対的な差から、遮蔽領域を設定する。
(When setting the shielding area for each elevation angle)
The shielded area setting unit 223 sets a shielded area for each elevation angle Φb. Specifically, the shielded area setting unit 223 sets the shielded area based on the relative difference in signal level with respect to a plurality of shielding determination areas aij which are at the same elevation angle Φb and are arranged in the direction of the azimuth angle θb. .

例えば、図6のような信号レベルの分布であれば、図7(A)に示すように、遮蔽領域設定部223は、仰角Φbが72°から90°の間の領域では、Level4以下を遮蔽領域であるとし、level5を遮蔽領域でないとする。遮蔽領域設定部223は、仰角Φbが54°から72°の間の領域では、Level3以下を遮蔽領域であるとし、level4以上を遮蔽領域でないとする。遮蔽領域設定部223は、仰角Φbが36°から54°の間の領域、仰角Φbが18°から36°の間の領域、および、仰角Φbが0°から18°の間の領域では、Level2以下を遮蔽領域であるとし、level3以上を遮蔽領域でないとする。 For example, if the distribution of signal levels is as shown in FIG. 6, as shown in FIG. area, and level 5 is not an occluded area. In the area where the elevation angle Φb is between 54° and 72°, the shielding area setting unit 223 determines that Level 3 and below is a shielding area, and Level 4 and above is not a shielding area. The shielding region setting unit 223 selects Level 2 for the region where the elevation angle Φb is between 36° and 54°, the region where the elevation angle Φb is between 18° and 36°, and the region where the elevation angle Φb is between 0° and 18°. It is assumed that the following areas are shielded areas, and the areas above level 3 are not shielded areas.

なお、この判定基準は一例であり、適宜設定が可能であるが、基本的には、仰角Φbが高いほど、遮蔽領域の判定基準となるレベルを高く設定することが考えられる。 This determination criterion is an example and can be set as appropriate. Basically, it is conceivable that the higher the elevation angle Φb is, the higher the level used as the determination criterion for the shielded area is set.

(全体領域で遮蔽領域を設定する場合)
遮蔽領域設定部223は、遮蔽領域の判定基準の信号レベルを設定する。そして、遮蔽領域設定部223は、判定基準以下の信号レベルの遮蔽判定用領域aijは遮蔽領域であると、判定する。また、遮蔽領域設定部223は、判定基準よりも高い信号レベルの遮蔽判定用領域aijは遮蔽領域でない、と判定する。
(When setting the shielding area in the entire area)
The shielded area setting unit 223 sets the signal level of the shielded area determination reference. Then, the shielded area setting unit 223 determines that the shielding determination area aij having a signal level equal to or lower than the determination standard is a shielded area. Also, the shielded area setting unit 223 determines that the shielding determination area aij having a signal level higher than the determination criterion is not a shielded area.

例えば、図6のような信号レベルの分布であり、判定基準の信号レベルをLevel3とすれば、遮蔽領域設定部223は、図7(B)に示すような遮蔽領域を設定する。 For example, if the distribution of signal levels is as shown in FIG. 6 and the signal level as the criterion is Level 3, the shielded area setting unit 223 sets the shielded area as shown in FIG. 7B.

これらのような処理を行うことによって、遮蔽領域設定部223は、ボディ座標系において遮蔽領域を設定できる。これにより、遮蔽領域設定部223は、測位装置10が装着される移動体の構造に依存する遮蔽領域を、設定できる。 By performing such processing, the shielded area setting unit 223 can set the shielded area in the body coordinate system. Thereby, the shielded area setting unit 223 can set a shielded area that depends on the structure of the moving body on which the positioning device 10 is mounted.

この構成および処理によって、遮蔽領域設定部223は、測位に用いるデータだけで、遮蔽領域を設定できる。すなわち、魚眼レンズ、レーザスキャナ、ステレオカメラのような、測位に直接関係しない装置を用いなくても、測位装置10は、遮蔽領域を設定できる。 With this configuration and processing, the shielded area setting unit 223 can set the shielded area using only the data used for positioning. That is, the positioning device 10 can set the shielded area without using a device that is not directly related to positioning, such as a fisheye lens, laser scanner, or stereo camera.

この際、仰角Φb毎の遮蔽領域を設定する態様であれば、仰角Φb毎に遮蔽領域および非遮蔽領域(遮蔽領域外の領域)を設定できる。したがって、仰角Φbの高い領域に対して相対的に信号受信強度SSが低いことが多い仰角Φbの低い領域においても、測位に利用できる領域と測位に利用できない領域とを適切に設定できる。 At this time, if the shielded area is set for each elevation angle Φb, the shielded area and the non-shielded area (area outside the shielded area) can be set for each elevation angle Φb. Therefore, it is possible to appropriately set an area that can be used for positioning and an area that cannot be used for positioning even in a low elevation angle Φb area in which the signal reception strength SS is often relatively low compared to a high elevation angle Φb area.

また、全体領域において遮断領域を設定する態様であれば、仰角Φbに関係なく、所定の信号受信強度SS以上の測位信号のみを測位に用いることができる。 Further, in the case of setting the blocking area in the entire area, only positioning signals having a predetermined signal reception strength SS or higher can be used for positioning regardless of the elevation angle Φb.

そして、このように遮蔽領域が設定され、遮蔽領域に存在する測位衛星の測位信号を用いずに、測位演算部21が測位演算を行うことによって、測位精度は向上する。すなわち、上述の測位演算部21で算出される自装置の位置Psn、姿勢角R,P,Yは、高精度になる。 Then, the shielded area is set in this way, and the positioning calculation unit 21 performs the positioning calculation without using the positioning signals of the positioning satellites existing in the shielded area, thereby improving the positioning accuracy. That is, the position Psn and attitude angles R, P, and Y of the device itself calculated by the positioning calculation unit 21 described above are highly accurate.

上述の説明では、測位装置で実行する遮蔽領域の設定等の処理を複数の機能部で実現する態様を示したが、これらの処理をプログラム化して実行してもよい。この場合、このプログラムを記憶する記憶部、および、このプログラムを記憶部から読み出して実行するCPU等の演算装置によって、実現可能である。そして、この場合、図8、図9、図10に示す方法をプログラム化して用いればよい。図8は、測位装置で実行されるメインの処理(測位方法)を示すフローチャートである。図9は、測位衛星の方向を算出する処理を示すフローチャートである。図10は、遮蔽領域を設定する処理を示すフローチャートである。なお、各処理の具体的な内容は上述しているので、その具体的な説明は省略する。 In the above description, the processing such as setting of the shielded area executed by the positioning device is realized by a plurality of functional units, but these processing may be programmed and executed. In this case, it can be realized by a storage unit that stores this program and an arithmetic device such as a CPU that reads and executes this program from the storage unit. In this case, the methods shown in FIGS. 8, 9 and 10 may be programmed and used. FIG. 8 is a flowchart showing main processing (positioning method) executed by the positioning device. FIG. 9 is a flowchart showing processing for calculating the direction of a positioning satellite. FIG. 10 is a flowchart showing processing for setting a shielded area. Since the specific contents of each process have been described above, the specific description thereof will be omitted.

図8に示すように、演算装置は、測位演算に利用する各種情報、各種データから、ボディ座標系での測位衛星の方向を算出する(S11)。具体的には、図9に示すように、演算装置は、測位信号から得られる自装置位置と航法メッセージから、NED座標系での測位衛星の位置を算出する(S111)。演算装置は、測位信号から得られる自装置の姿勢角から、NED座標系とボディ座標系と変換行列を算出する(S112)。演算装置は、測位衛星の位置と変換行列とから、ボディ座標系における測位衛星の仰角Φbおよび方位角θbを算出する(S113)。 As shown in FIG. 8, the calculation device calculates the direction of the positioning satellite in the body coordinate system from various information and data used for positioning calculation (S11). Specifically, as shown in FIG. 9, the computing device calculates the position of the positioning satellite in the NED coordinate system from the own device position obtained from the positioning signal and the navigation message (S111). The computing device calculates the NED coordinate system, the body coordinate system, and the transformation matrix from the attitude angle of the device itself obtained from the positioning signal (S112). The computing device calculates the elevation angle Φb and the azimuth angle θb of the positioning satellite in the body coordinate system from the position of the positioning satellite and the transformation matrix (S113).

図8に示すように、演算装置は、仰角Φbおよび方位角θbを用いて、信号受信強度SSの分布であるスカイプロットを生成する(S12)。 As shown in FIG. 8, the computing device uses the elevation angle Φb and the azimuth angle θb to generate a sky plot, which is the distribution of the received signal strength SS (S12).

図8に示すように、演算装置は、スカイプロットを用いて、遮蔽領域を設定する(S13)。具体的には、図10に示すように、演算装置は、仰角Φbおよび方位角θbを基準にして、スカイプロットの全体領域を、複数の遮蔽判定用領域aijに分割する(S31)。演算装置は、複数の遮蔽判定用領域aijの信号受信強度SSから、遮蔽領域を、遮蔽判定用領域aijの単位で設定する(S32)。 As shown in FIG. 8, the computing device uses the sky plot to set the shielded area (S13). Specifically, as shown in FIG. 10, the computing device divides the entire skyplot area into a plurality of shielding determination areas aij based on the elevation angle Φb and the azimuth angle θb (S31). The computing device sets a shielding area in units of shielding determination areas aij from the signal reception strengths SS of the plurality of shielding determination areas aij (S32).

図8に示すように、演算装置は、遮蔽領域を用いて、測位に利用する測位衛星(測位信号)を選択し(S14)、測位演算を行う(S15)。 As shown in FIG. 8, the calculation device uses the shielded area to select a positioning satellite (positioning signal) to be used for positioning (S14), and performs positioning calculation (S15).

なお、上述の説明では、測位演算に、測位信号のみを用いる態様を示した。しかしながら、加速度センサ、角速度センサ等の慣性センサの出力を用いる態様であってもよい。図11は、慣性センサを用いた測位装置の構成を示す機能ブロック図である。 In addition, in the above description, the aspect of using only the positioning signal for the positioning calculation has been shown. However, it is also possible to use the output of an inertial sensor such as an acceleration sensor or an angular velocity sensor. FIG. 11 is a functional block diagram showing the configuration of a positioning device using inertial sensors.

図11に示すように、測位装置10Aは、演算部20A、アンテナ装置30A、慣性センサ40を備える。演算部20Aは、測位演算部21Aおよび遮蔽情報設定部22を備える。なお、遮蔽情報設定部22の構成および処理は、上述の通りであり、説明は省略する。 As shown in FIG. 11, the positioning device 10A includes a computing section 20A, an antenna device 30A, and an inertial sensor 40. As shown in FIG. The calculation unit 20A includes a positioning calculation unit 21A and a shielding information setting unit 22. FIG. Note that the configuration and processing of the shielding information setting unit 22 are as described above, and a description thereof will be omitted.

アンテナ装置30Aおよび慣性センサ40は、測位演算部21Aに接続している。 The antenna device 30A and the inertial sensor 40 are connected to the positioning calculation section 21A.

アンテナ装置30Aは、2個以上のGNSSアンテナ(図示を省略する。)によって構成されている。慣性センサ40は、直交三軸の加速度センサおよび角速度センサを備える。慣性センサ40は、計測した加速度および角速度を、測位演算部21Aに出力する。 The antenna device 30A is composed of two or more GNSS antennas (not shown). The inertial sensor 40 includes an orthogonal triaxial acceleration sensor and an angular velocity sensor. The inertial sensor 40 outputs the measured acceleration and angular velocity to the positioning calculator 21A.

測位演算部21Aは、アンテナ装置30Aで受信した測位信号の捕捉、追尾の結果と、慣性センサ40で計測された加速度および角速度とを用いて、既知の方法から、位置Psn、姿勢角R,P,Yを算出する。また、測位演算部21Aは、測位信号の追尾の結果から、航法メッセージNMを復調する。 The positioning calculation unit 21A calculates the position Psn, the attitude angles R, P, and , Y are calculated. Also, the positioning calculation unit 21A demodulates the navigation message NM from the tracking result of the positioning signal.

このようなアンテナ装置30Aと慣性センサ40とを用いる態様であっても、上述のアンテナ装置30のみを用いる態様と同様に、遮蔽領域を設定できる。 Even in the mode using the antenna device 30A and the inertial sensor 40, the shielding area can be set in the same manner as in the mode using only the antenna device 30 described above.

なお、上述の説明では、遮蔽領域設定部223は、離散的に設定された信号レベルに基づいて、遮蔽領域の判定を行う態様を示した。しかしながら、遮蔽領域設定部223は、遮蔽判定用領域aijに割り当てられた信号受信強度SSの代表値を直接用いて、遮蔽領域と非遮蔽領域とを設定することもできる。この場合、遮蔽領域設定部223は、代表値に対する閾値を設定し、閾値以下であれば、遮蔽領域であると判定し、閾値を超えていれば、遮蔽領域でない(非遮蔽領域である)と判定すればよい。この場合、遮蔽領域設定部223は、信号受信強度SSが得られない遮蔽判定用領域aijについては遮蔽領域である、と判定すればよい。 In the above description, the shielded area setting unit 223 determines the shielded area based on discretely set signal levels. However, the shielded area setting unit 223 can also set the shielded area and the non-shielded area by directly using the representative value of the signal reception strength SS assigned to the shielding determination area aij. In this case, the shielded area setting unit 223 sets a threshold for the representative value, determines that it is a shielded area if it is equal to or less than the threshold, and determines that it is not a shielded area (is a non-shielded area) if it exceeds the threshold. Judge. In this case, the shielded area setting unit 223 may determine that the shielding determination area aij for which the signal reception strength SS is not obtained is a shielded area.

また、上述の説明では、スカイプロット800の全体領域を複数の遮蔽判定用領域aijに分割した状態にて、遮蔽領域を設定している。しかしながら、遮蔽判定用領域を設定せずに、信号受信強度SSの分布をそのまま用いて、信号受信強度SSの大小差から遮蔽領域を設定してもよい。 Also, in the above description, the shielding area is set in a state in which the entire area of the sky plot 800 is divided into a plurality of shielding determination areas aij. However, without setting the shielding determination area, the distribution of the signal reception strength SS may be used as it is to set the shielding area based on the magnitude difference of the signal reception strength SS.

また、上述の説明では、遮蔽領域内に存在する測位衛星の測位信号を、測位演算に用いない態様を示した。しかしながら、遮蔽領域内に存在する測位衛星の測位信号と、遮蔽領域に存在しない測位衛星の測位信号とで、測位演算時の重み付けを異ならせてもよい。具体的には、遮蔽領域内に存在する測位衛星の測位信号については、測位精度に与える影響を小さく(重み付けを小さく)し、遮蔽領域に存在しない測位衛星の測位信号については、測位精度に与える影響を大きく(重み付けを大きく)する。これにより、例えば、追尾中の測位衛星数が少ない場合に、遮蔽領域に存在する測位衛星の測位信号を用いながらも、これらの測位信号による測位精度の劣化を抑制できる。 Also, in the above description, a mode was shown in which the positioning signals of the positioning satellites existing within the shielded area are not used for the positioning calculation. However, the positioning signals of the positioning satellites present in the shielded area and the positioning signals of the positioning satellites not present in the shielded area may be weighted differently during the positioning calculation. Specifically, the positioning signals of positioning satellites that exist within the shielded area have less impact on the positioning accuracy (lower weighting), and the positioning signals of positioning satellites that do not exist in the shielded area have less impact on the positioning accuracy. Increase impact (increase weighting). As a result, for example, when the number of positioning satellites being tracked is small, it is possible to suppress the deterioration of the positioning accuracy due to these positioning signals while using the positioning signals of the positioning satellites existing in the shielded area.

また、上述の説明では、仰角Φbおよび方位角θbの双方を、一定の角度間隔で分割して、遮蔽判定用領域aijを設定する態様を示した。しかしながら、これらの間隔は一定の角度間隔でなくてもよい。例えば、仰角Φbに関しては、低いほど角度間隔を広くしたり、逆に、低いほど角度間隔を狭くしてもよい。また、例えば、方位角θbに関しては、船首側すなわちθb=0°に近いほど角度間隔を広くし、θb=180°に近いほど角度間隔を狭くしてもよい。さらに、1度目の遮蔽領域の判定において、遮蔽領域と非遮蔽領域との境界になる方位角θbの近傍について、遮蔽判定用領域aijをさらに細かく分割して、上記の判定を行ってもよい。 Also, in the above description, both the elevation angle Φb and the azimuth angle θb are divided at regular angular intervals to set the shielding determination areas aij. However, these intervals need not be constant angular intervals. For example, with respect to the elevation angle Φb, the lower the angle, the wider the angle interval, or conversely, the lower the angle, the narrower the angle interval. Further, for example, regarding the azimuth angle θb, the angle interval may be widened as the bow side, that is, closer to θb=0°, and narrower as θb=180° is approached. Furthermore, in the first determination of the shielded area, the above determination may be performed by further dividing the shielded determination area aij in the vicinity of the azimuth angle θb, which is the boundary between the shielded area and the non-shielded area.

また、上述の説明では、信号受信強度SSを用いて遮蔽領域の判定を行う態様を示した。しかしながら、測位信号の受信回数を用いて、遮蔽領域の判定を行ってもよい。ここで、測位信号の受信回数とは、追尾可能な信号受信強度で受信した回数を意味する。 Also, in the above description, the manner in which the shielded area is determined using the signal reception strength SS has been described. However, the shielded area may be determined using the number of receptions of the positioning signal. Here, the number of receptions of the positioning signal means the number of receptions with signal reception strength that allows tracking.

また、上述の説明では、信号受信強度SSの大小から遮蔽領域を設定する態様を示した。しかしながら、信号受信強度SSのバラツキの大小関係から遮蔽領域を設定することもできる。この場合、バラツキが大きい方が遮蔽領域に設定され、バラツキが小さい方が非遮蔽領域に設定される。 Also, in the above description, the manner in which the shielding area is set according to the magnitude of the signal reception strength SS has been shown. However, it is also possible to set the shielding area based on the magnitude relationship of the variation in the signal reception strength SS. In this case, the area with the larger variation is set as the shielded area, and the area with the smaller variation is set as the non-shielded area.

また、上述の説明では、遮蔽領域の設定タイミングについて、詳細に記載していない。遮蔽領域の設定タイミングは、例えば、実使用する測位演算を開始する前、すなわち、測位装置の使用の初期であればよい。さらに、遮蔽領域は、所定の時間間隔で設定され、その都度、測位演算にフィードバックされてもよい。また、遮蔽領域の設定のため、すなわち、スカイプロット800の生成のための、信号受信強度SSの観測、仰角Φbおよび方位角θbの取得は、可能な限り長い時間をかけた方が好ましい。これにより、船体90外に存在する遮蔽要素(外乱による遮蔽)の影響を抑制できる。 Also, in the above description, the timing for setting the shielded area is not described in detail. The setting timing of the shielded area may be, for example, before the actual positioning calculation is started, that is, at the beginning of the use of the positioning device. Furthermore, the shielded area may be set at predetermined time intervals and fed back to the positioning calculation each time. Further, it is preferable to spend as long as possible the observation of the signal reception strength SS and the acquisition of the elevation angle Φb and the azimuth angle θb for setting the shielded area, that is, for generating the sky plot 800 . Thereby, the influence of shielding elements (shielding due to disturbance) existing outside the hull 90 can be suppressed.

10、10A:測位装置
20、20A:演算部
21、21A:測位演算部
22:遮蔽情報設定部
30、30A:アンテナ装置
40:慣性センサ
90:船体
221:衛星方向算出部
222:分布生成部
223:遮蔽領域設定部
800:スカイプロット
811B、811C、812B、812C:投影点
aij:遮蔽判定用領域
COb:ボディ座標系によって定義された天頂側の半球の領域
NM:航法メッセージ
SAT1、SAT2、SATm:測位衛星
SatN:識別情報
SS:信号受信強度
10, 10A: Positioning devices 20, 20A: Calculation units 21, 21A: Positioning calculation unit 22: Shield information setting unit 30, 30A: Antenna device 40: Inertial sensor 90: Hull 221: Satellite direction calculation unit 222: Distribution generation unit 223 : Shielding area setting unit 800: Sky plots 811B, 811C, 812B, 812C: Projection point aij: Shielding determination area COb: Area of zenith side hemisphere defined by body coordinate system NM: Navigation messages SAT1, SAT2, SATm: Positioning satellite SatN: identification information SS: signal reception strength

Claims (16)

測位信号に重畳された航法メッセージから得られるNED座標系での測位衛星の位置と、前記測位信号の受信結果から得られる測位装置の姿勢角と、を用いて、前記測位衛星の前記測位装置におけるボディ座標系での仰角および方位角を算出する衛星方向算出部と、
前記測位衛星の前記ボディ座標系での仰角および方位角と前記測位信号の信号受信強度と、を用いて、前記信号受信強度の前記ボディ座標系での分布を生成する分布生成部と、
前記ボディ座標系での分布を用いて、測位への影響を低くまたはゼロに設定する測位信号の決定に用いる遮蔽領域を設定する遮蔽領域設定部と、
を備える、測位装置。
Using the position of the positioning satellite in the NED coordinate system obtained from the navigation message superimposed on the positioning signal and the attitude angle of the positioning device obtained from the reception result of the positioning signal, the position of the positioning satellite in the positioning device a satellite direction calculator that calculates elevation and azimuth angles in a body coordinate system;
a distribution generation unit that generates a distribution of the signal reception strength in the body coordinate system using the elevation angle and the azimuth angle of the positioning satellite in the body coordinate system and the signal reception strength of the positioning signal;
a shielded area setting unit that sets a shielded area used for determining a positioning signal that sets the influence on positioning to low or zero, using the distribution in the body coordinate system;
A positioning device.
請求項1に記載の測位装置であって、
前記分布生成部は、
前記測位装置を中心として前記ボディ座標系によって定義された天頂側の半球の領域を、前記ボディ座標系における基準面に二次元投影した全体領域を設定し、
前記遮蔽領域設定部は、
前記全体領域における前記ボディ座標系での分布を用いて、前記遮蔽領域を設定する、
測位装置。
The positioning device according to claim 1,
The distribution generation unit
setting an entire area obtained by two-dimensionally projecting a hemispherical area on the zenith side defined by the body coordinate system centered on the positioning device onto a reference plane in the body coordinate system;
The shielding area setting unit
setting the shielding area using the distribution in the body coordinate system in the entire area;
Positioning device.
請求項2に記載の測位装置であって、
前記遮蔽領域設定部は、
前記ボディ座標系での仰角と方位角とを基準にして、前記全体領域を複数の遮蔽判定用領域に分割し、
前記複数の遮蔽判定用領域の単位で前記遮蔽領域を設定する、
測位装置。
The positioning device according to claim 2,
The shielding area setting unit
dividing the entire area into a plurality of shielding determination areas based on the elevation angle and the azimuth angle in the body coordinate system;
setting the shielding area in units of the plurality of shielding determination areas;
Positioning device.
請求項3に記載の測位装置であって、
前記遮蔽領域設定部は、
前記ボディ座標系での仰角毎に、方位角方向に並ぶ複数の前記遮蔽判定用領域の前記信号受信強度の大きさまたは前記信号受信強度の大きさのバラツキから、前記遮蔽領域を設定する、
測位装置。
The positioning device according to claim 3,
The shielding area setting unit
setting the shielding region based on the magnitude of the signal reception intensity of the plurality of shielding determination regions aligned in the azimuth direction or the variation in the magnitude of the signal reception intensity for each elevation angle in the body coordinate system;
Positioning device.
請求項3に記載の測位装置であって、
前記遮蔽領域設定部は、
前記全体領域における前記複数の遮蔽判定用領域の前記信号受信強度の大きさまたは前記信号受信強度の大きさのバラツキから、前記遮蔽領域を設定する、
測位装置。
The positioning device according to claim 3,
The shielding area setting unit
setting the shielded region based on the magnitude of the signal reception intensity of the plurality of shielding determination regions in the entire region or the variation in the magnitude of the signal reception intensity;
Positioning device.
請求項1乃至請求項5のいずれかに記載の測位装置であって、
複数のGNSSアンテナで受信した前記測位信号の搬送波信号を用いて、前記測位装置の姿勢角を算出し、複数のGNSSアンテナの少なくとも1個のGNSSアンテナで受信した前記測位信号のコードを用いて、前記測位装置の位置を算出する測位演算部を備える、
測位装置。
The positioning device according to any one of claims 1 to 5,
Using carrier signals of the positioning signals received by a plurality of GNSS antennas, calculating an attitude angle of the positioning device, and using a code of the positioning signals received by at least one GNSS antenna of the plurality of GNSS antennas, A positioning calculation unit that calculates the position of the positioning device,
Positioning device.
請求項6に記載の測位装置であって、
前記測位演算部は、
前記遮蔽領域設定部で設定された前記遮蔽領域に含まれるか否かによって、前記測位衛星の前記測位信号に対する重みつけを異ならせて、前記姿勢角および前記位置を算出する、
測位装置。
The positioning device according to claim 6,
The positioning calculation unit
calculating the attitude angle and the position by weighting the positioning signal of the positioning satellite differently depending on whether it is included in the shielded area set by the shielded area setting unit;
Positioning device.
請求項6または請求項7に記載の測位装置であって、
前記測位装置の位置は、前記複数のGNSSアンテナのいずれかのGNSSアンテナの位置、または、前記複数のGNSSアンテナの幾何学的な中心位置である、
測位装置。
The positioning device according to claim 6 or claim 7,
The position of the positioning device is the position of any one of the plurality of GNSS antennas, or the geometric center position of the plurality of GNSS antennas.
Positioning device.
測位信号に重畳された航法メッセージから得られるNED座標系での測位衛星の位置と、前記測位信号の受信結果から得られる測位装置の姿勢角と、を用いて、前記測位衛星の前記測位装置におけるボディ座標系での仰角および方位角を算出し、
前記測位衛星の前記ボディ座標系での仰角および方位角と前記測位信号の信号受信強度と、を用いて、前記信号受信強度の前記ボディ座標系での分布を生成し、
前記ボディ座標系での分布を用いて、測位への影響を低くまたはゼロに設定する測位信号の決定に用いる遮蔽領域を設定する、
測位方法。
Using the position of the positioning satellite in the NED coordinate system obtained from the navigation message superimposed on the positioning signal and the attitude angle of the positioning device obtained from the reception result of the positioning signal, the position of the positioning satellite in the positioning device Calculate the elevation and azimuth angles in the body coordinate system,
using the elevation angle and azimuth angle of the positioning satellite in the body coordinate system and the signal reception strength of the positioning signal to generate a distribution of the signal reception strength in the body coordinate system;
Using the distribution in the body coordinate system to set a shielded region used to determine a positioning signal that has a low or zero impact on positioning;
Positioning method.
請求項9に記載の測位方法であって、
前記測位装置を中心として前記ボディ座標系によって定義された天頂側の半球の領域を、前記ボディ座標系における基準面に二次元投影した全体領域を設定し、
前記全体領域における前記ボディ座標系での分布を用いて、前記遮蔽領域を設定する、
測位方法。
The positioning method according to claim 9,
setting an entire area obtained by two-dimensionally projecting a hemispherical area on the zenith side defined by the body coordinate system centered on the positioning device onto a reference plane in the body coordinate system;
setting the shielding area using the distribution in the body coordinate system in the entire area;
Positioning method.
請求項10に記載の測位方法であって、
前記ボディ座標系での仰角と方位角とを基準にして、前記全体領域を複数の遮蔽判定用領域に分割し、
前記複数の遮蔽判定用領域の単位で前記遮蔽領域を設定する、
測位方法。
The positioning method according to claim 10,
dividing the entire area into a plurality of shielding determination areas based on the elevation angle and the azimuth angle in the body coordinate system;
setting the shielding area in units of the plurality of shielding determination areas;
Positioning method.
請求項11に記載の測位方法であって、
前記ボディ座標系での仰角毎に、方位角方向に並ぶ複数の前記遮蔽判定用領域の前記信号受信強度の大きさまたは前記信号受信強度の大きさのバラツキから、前記遮蔽領域を設定する
測位方法。
The positioning method according to claim 11,
setting the shielded area based on the magnitude of the received signal intensity of the plurality of shielded determination areas arranged in the azimuth direction or the variation in the magnitude of the received signal strength for each elevation angle in the body coordinate system; .
請求項11に記載の測位方法であって、
前記全体領域における前記複数の遮蔽判定用領域の前記信号受信強度の大きさまたは前記信号受信強度の大きさのバラツキから、前記遮蔽領域を設定する、
測位方法。
The positioning method according to claim 11,
setting the shielded region based on the magnitude of the signal reception intensity of the plurality of shielding determination regions in the entire region or the variation in the magnitude of the signal reception intensity;
Positioning method.
請求項9乃至請求項13のいずれかに記載の測位方法であって、
複数のGNSSアンテナで受信した前記測位信号の搬送波信号を用いて、前記測位装置の姿勢角を算出し、複数のGNSSアンテナの少なくとも1個のGNSSアンテナで受信した前記測位信号のコードを用いて、前記測位装置の位置を算出する、
測位方法。
The positioning method according to any one of claims 9 to 13,
Using carrier signals of the positioning signals received by a plurality of GNSS antennas, calculating an attitude angle of the positioning device, and using a code of the positioning signals received by at least one GNSS antenna of the plurality of GNSS antennas, calculating the position of the positioning device;
Positioning method.
請求項14に記載の測位方法であって、
前記遮蔽領域に含まれるか否かによって、前記測位衛星の前記測位信号に対する重みつけを異ならせて、前記姿勢角および前記位置を算出する、
測位方法。
The positioning method according to claim 14,
calculating the attitude angle and the position by giving different weights to the positioning signals of the positioning satellites depending on whether they are included in the shielded area;
Positioning method.
請求項14または請求項15に記載の測位方法であって、
前記測位装置の位置は、前記複数のGNSSアンテナのいずれかのGNSSアンテナの位置、または、前記複数のGNSSアンテナの幾何学的な中心位置である、
測位方法。
The positioning method according to claim 14 or 15,
The position of the positioning device is the position of any one of the plurality of GNSS antennas, or the geometric center position of the plurality of GNSS antennas.
Positioning method.
JP2018213134A 2018-11-13 2018-11-13 Positioning device, positioning method Active JP7107820B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2018213134A JP7107820B2 (en) 2018-11-13 2018-11-13 Positioning device, positioning method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018213134A JP7107820B2 (en) 2018-11-13 2018-11-13 Positioning device, positioning method

Publications (2)

Publication Number Publication Date
JP2020079748A JP2020079748A (en) 2020-05-28
JP7107820B2 true JP7107820B2 (en) 2022-07-27

Family

ID=70801706

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018213134A Active JP7107820B2 (en) 2018-11-13 2018-11-13 Positioning device, positioning method

Country Status (1)

Country Link
JP (1) JP7107820B2 (en)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000075010A (en) 1998-09-02 2000-03-14 Communication Research Laboratory Mpt Method for preparation of optical range in upper high according to spot
JP2002158525A (en) 2000-11-22 2002-05-31 Mitsubishi Electric Corp Antenna controller for satellite tracking
JP2004184121A (en) 2002-11-29 2004-07-02 Denso Corp Controller and server unit for gps receiver
JP2007093483A (en) 2005-09-29 2007-04-12 Mitsubishi Electric Corp Positioning system, positioning method, and positioning program
JP2012098158A (en) 2010-11-02 2012-05-24 Toyota Central R&D Labs Inc Satellite signal determination device and program
US20140336929A1 (en) 2010-05-24 2014-11-13 Robert J. Wellington Determining Spatial Orientation Information of a Body from Multiple Electromagnetic Signals
JP2017015585A (en) 2015-07-02 2017-01-19 株式会社トプコン Navigation signal processing device, navigation signal processing method and navigation signal processing program

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10111137A (en) * 1996-10-07 1998-04-28 Hitachi Ltd Gps navigator

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000075010A (en) 1998-09-02 2000-03-14 Communication Research Laboratory Mpt Method for preparation of optical range in upper high according to spot
JP2002158525A (en) 2000-11-22 2002-05-31 Mitsubishi Electric Corp Antenna controller for satellite tracking
JP2004184121A (en) 2002-11-29 2004-07-02 Denso Corp Controller and server unit for gps receiver
JP2007093483A (en) 2005-09-29 2007-04-12 Mitsubishi Electric Corp Positioning system, positioning method, and positioning program
US20140336929A1 (en) 2010-05-24 2014-11-13 Robert J. Wellington Determining Spatial Orientation Information of a Body from Multiple Electromagnetic Signals
JP2012098158A (en) 2010-11-02 2012-05-24 Toyota Central R&D Labs Inc Satellite signal determination device and program
JP2017015585A (en) 2015-07-02 2017-01-19 株式会社トプコン Navigation signal processing device, navigation signal processing method and navigation signal processing program

Also Published As

Publication number Publication date
JP2020079748A (en) 2020-05-28

Similar Documents

Publication Publication Date Title
JP6242794B2 (en) GNSS positioning system including anti-jamming antenna and use of phase center corrected carrier
CN106560728B (en) Radar vision fusion for target velocity estimation
JP6865521B2 (en) Navigation signal processing device, navigation signal processing method and navigation signal processing program
US10429500B2 (en) Tracking apparatus, tracking method, and computer-readable storage medium
US20120032835A1 (en) Three-dimensional target tracking
JP6484512B2 (en) Laser scanner control device, laser scanner control method, and laser scanner control program
US10514469B2 (en) Attitude angle calculating device, method of calculating attitude angle, and attitude angle calculating program
CN112415502B (en) Radar apparatus
JP6469357B2 (en) Underwater detection device, underwater detection method, and underwater detection program
US20200256974A1 (en) Apparatus and method for tracking object based on radar image reconstruction
JP2006292518A (en) Object detection apparatus for vehicle
JP6616961B2 (en) Component positioning using electromagnetic identification (EMID) tags for contextual visualization
US20140180580A1 (en) Module, device and method for positioning
JP7107820B2 (en) Positioning device, positioning method
JP2001280997A (en) Gnss, inertial navigation system
US10877163B2 (en) Method and device for calculating attitude angle
Kumar et al. Identifying reflected gps signals and improving position estimation using 3d map simultaneously built with laser range scanner
US10976447B2 (en) Azimuth angle calculating device, and method of calculating azimuth angle
WO2023013160A1 (en) Distance estimation device, antena device, power feeding system, power feeding device, and power feeding method
US20150212195A1 (en) Method and apparatus for determining spread sequence for generating spread spectrum radar signal
JP2019132713A (en) Velocity computation device, velocity computation method, and program
JP6383817B2 (en) Flying object position measuring device, flying object position measuring method and flying object position measuring program
JPH07280931A (en) Apparatus for displaying target position
WO2017130510A1 (en) Positioning device, positioning method, and positioning system
JP7015929B2 (en) Methods and devices for assessing the angular position of objects, as well as driver assistance systems

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210726

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220622

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: 20220712

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220714

R150 Certificate of patent or registration of utility model

Ref document number: 7107820

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150