JP2018084445A - Underwater acoustic positioning system - Google Patents
Underwater acoustic positioning system Download PDFInfo
- Publication number
- JP2018084445A JP2018084445A JP2016226469A JP2016226469A JP2018084445A JP 2018084445 A JP2018084445 A JP 2018084445A JP 2016226469 A JP2016226469 A JP 2016226469A JP 2016226469 A JP2016226469 A JP 2016226469A JP 2018084445 A JP2018084445 A JP 2018084445A
- Authority
- JP
- Japan
- Prior art keywords
- acoustic
- underwater
- signal
- positioning system
- underwater robot
- 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.)
- Pending
Links
Abstract
Description
本発明は、水中を移動する、たとえば自律式水中ロボットの位置をオペレーションフリーで高精度に補正することができる水中音響測位システムに関するものである。 The present invention relates to an underwater acoustic positioning system that can move underwater, for example, an operation-free and highly accurate correction of the position of an autonomous underwater robot.
たとえば、水上で移動できる自律式水中ロボットは、GPSからの信号により、自身の位置を取得できる。しかし、水中を移動する自律式水中ロボットは、GPSからの信号が届かない場合があるため、自分自身の速度と方位データを組み合わせることにより、推定で位置を計算する慣性航法という手法がよく用いられている。前記自律式水中ロボットの速度は、対地速度計から、方位は、磁気コンパスもしくはジャイロセンサーから、それぞれ算出される場合が多い。しかし、以下の問題点があった。 For example, an autonomous underwater robot that can move on the water can acquire its position from a signal from GPS. However, autonomous underwater robots that move underwater may not receive signals from GPS, so inertial navigation is often used to calculate position by estimation by combining your own speed and heading data. ing. In many cases, the speed of the autonomous underwater robot is calculated from a ground speedometer, and the direction is calculated from a magnetic compass or a gyro sensor. However, there were the following problems.
前記対地速度計は、前記自律式水中ロボット自身から海底に向けて音波を発信し、その反射波を受信し、ドップラー効果の原理に基づいて、速度を算出している。しかし、前記自律式水中ロボットの機種や発信する音波の周波数によって反射波を受信できる海底までの距離に制限がある。したがって、前記算出方法は、制限距離を超えるような海域中において、速度を算出することができず、結果的に正確な位置を計算することができなかった。 The ground speedometer emits sound waves from the autonomous underwater robot itself toward the seabed, receives the reflected waves, and calculates the speed based on the principle of the Doppler effect. However, there is a limit to the distance to the seabed where the reflected wave can be received depending on the model of the autonomous underwater robot and the frequency of sound waves transmitted. Therefore, the calculation method cannot calculate the speed in the sea area exceeding the limit distance, and as a result, cannot calculate an accurate position.
方位について、磁気コンパスを使用する方式は、製品自体が低価格であるため、調達コストを低く抑えることができるが、方位精度があまり良くないという欠点があった。ジャイロセンサーを使用する方式は、高精度な方位を得ることができる一方で、購入価格が非常に高価である。また、ジャイロセンサーの物理的な取り付け誤差は、微小にすることができても、完全にゼロにすることは難しい。このため、長距離航行時には、微細な誤差が蓄積され、結果的に大きな航法誤差となる。この蓄積された誤差をリセットするためには、自律式水中ロボットが浮上し、GPSからの位置データを再度受信する必要があった。 Regarding the orientation, the method using a magnetic compass has a disadvantage that the orientation accuracy is not so good, although the cost of the product itself can be kept low because the product itself is inexpensive. The method using the gyro sensor can obtain a highly accurate bearing, but the purchase price is very expensive. Also, even if the physical attachment error of the gyro sensor can be made minute, it is difficult to make it completely zero. For this reason, during long-distance navigation, fine errors are accumulated, resulting in a large navigation error. In order to reset this accumulated error, the autonomous underwater robot had to rise and received position data from GPS again.
図３は従来の自律式水中ロボットの位置を決める際の一例を説明するための図である。図３において、たとえば、自律式水中ロボット31は、水中30を自由に航行することができるものである。また、水中30には、所定の間隔を置いて、たとえば、２個の水中部トランスボンー32、33が設けられている。たとえば、海底に設置された前記２個の水中部トランスポンダー32、33は、基準局とし、音響質問信号311、312対する音響応答信号321、331を前記自律式水中ロボット31に返信する。前記自律式水中ロボット31は、前記音響質問信号311、312に基づいて自分自身の位置を算出することができる。その他の音響測位システムには、基線音響測位システム（LBL航法）、あるいは水上の支援船のGPSによる位置と、トランスポンダーを搭載した自律式水中ロボットとの相対的な位置を音波の到達時間と方位で算出する短基線音響測位システム（SSBL航法）、または超短基線音響測位システム（USBL航法）等がある。しかし、これらについても以下のような問題点がある。 FIG. 3 is a diagram for explaining an example of determining the position of a conventional autonomous underwater robot. In FIG. 3, for example, the autonomous underwater robot 31 can navigate the underwater 30 freely. The underwater 30 is provided with, for example, two underwater transboners 32 and 33 at a predetermined interval. For example, the two underwater transponders 32 and 33 installed on the seabed serve as reference stations and return acoustic response signals 321 and 331 to the acoustic interrogation signals 311 and 312 to the autonomous underwater robot 31. The autonomous underwater robot 31 can calculate its own position based on the acoustic interrogation signals 311 and 312. Other acoustic positioning systems include the baseline acoustic positioning system (LBL navigation) or the GPS position of a support vessel on the water and the relative position of the autonomous underwater robot equipped with a transponder in terms of arrival time and direction of sound waves. There is a short baseline acoustic positioning system (SSBL navigation) to calculate, or an ultrashort baseline acoustic positioning system (USBL navigation). However, these also have the following problems.
前記長基線音響測位システムは、トランスポンダーを2カ所設置する必要があり、運用前の準備と費用に多くを要するという欠点があった。また、設置する場所は、投入した時のGPSの位置情報を用いることになるが、投入してから着底するまでに海流等により位置がずれるという欠点があった。前記方法は、着底した発信機の正確な位置を判断することは難しい。また、トランスポンダーは、設置する海域の水深が大きければ大きいほど誤差が顕著になるという欠点があった。 The long baseline acoustic positioning system has the disadvantage that it requires two transponders to be installed, which requires a lot of preparation and cost before operation. In addition, the location of the installation uses the position information of the GPS at the time of input, but there is a disadvantage that the position is shifted by the ocean current or the like from the time of input to the time of landing. In this method, it is difficult to determine the exact position of the transmitter that has landed. In addition, the transponder has a drawback that the error becomes more prominent as the water depth of the sea area is larger.
図４は従来の自律式水中ロボットの位置を決める際に支援船を利用した一例を説明するための図である。図４において、自律式水中ロボット41は、支援船42からの音響質問信号421に基づいた音響応答信号411が送り返され、船上部音響受波器422によって受信される。前記船上部音響送受波器422は、図示のような構成に配置されている。前記短基線音響測位システムあるいは超短基線音響測位システムの場合は、支援船42に送受波用の船上部を設置するだけなので長基線音響測位システムと比較して運用前の準備にあまり時間がかからない。しかし、図４に記載されているシステムは、支援船42から発信される音響質問信号421を自律式水中ロボット41の搭載トランスポンダーが応答し、その応答信号が音響応答信号として支援船42で受信している。前記システムは、伝播時間および受信アレイ間の位相差から位置を計算しているため、自律式水中ロボット41のスラスター回転や外部ノイズ環境によって自律式水中ロボット搭載トランスポンダーが支援船42からの音響質問信号421を正しく受信することができない。その結果、前記システムは、正確な位置を得ることが不可能になる。 FIG. 4 is a diagram for explaining an example of using a support ship when determining the position of a conventional autonomous underwater robot. In FIG. 4, the autonomous underwater robot 41 sends back an acoustic response signal 411 based on the acoustic interrogation signal 421 from the support ship 42, and is received by the upper ship acoustic receiver 422. The ship upper acoustic transducer 422 is arranged as shown in the figure. In the case of the short baseline acoustic positioning system or the ultra-short baseline acoustic positioning system, only the upper part for wave transmission / reception is installed on the support ship 42, so it takes less time for preparation before operation than the long baseline acoustic positioning system. . However, in the system shown in FIG. 4, the acoustic interrogation signal 421 transmitted from the support vessel 42 responds to the transponder mounted on the autonomous underwater robot 41, and the response signal is received as an acoustic response signal by the support vessel 42. ing. Since the system calculates the position from the propagation time and the phase difference between the receiving arrays, the transponder equipped with the autonomous underwater robot 41 receives the acoustic interrogation signal from the support ship 42 depending on the thruster rotation of the autonomous underwater robot 41 and the external noise environment. 421 cannot be received correctly. As a result, the system cannot obtain an accurate position.
また、測位と測位の間、あるいは測位が不可となった場合、自律式水中ロボット自身の慣性航法となるが、測位間の時間間隔あるいは測位不可能時間が大きくなると、自律式水中ロボットの位置誤差は、慣性航法誤差に準ずることになる。特に、ジャイロセンサーを使用しない磁気コンパスを使用する方式を採用する自律式水中ロボットにとっては、慣性誤差がもともと大きいため、精度よく航走させるためには、これらの外部位置補正の時間間隔が短いほど望ましい。また、前記システムは、位置補正を行う場合、逐一オペレイターが介在して送信作業を行う必要がある。 Also, if positioning is impossible, or if positioning becomes impossible, the autonomous underwater robot's own inertial navigation will be used.However, if the time interval between positioning or the positioning impossible time increases, the position error of the autonomous underwater robot will increase. Is equivalent to inertial navigation error. In particular, for autonomous underwater robots that use a magnetic compass that does not use a gyro sensor, inertia errors are inherently large, so the time interval between these external position corrections is shorter in order to navigate accurately. desirable. Further, when performing position correction, the system needs to perform transmission work with each operator intervening.
また、ＧＰＳの電波あるいは光は、海底に正確に届かないため、浅い海底においても、変異あるいは地殻変動の程度を観測することが困難であった。前記海底における構造物の変異あるいは地殻変動は、支援船42の位置をＧＰＳ等で決定し、支援船42から自律式水中ロボット41に質問した音響質問信号421に対する音響応答信号411によって情報を得ることが可能である。しかし、前記音響信号の海中における音速は、海水温度、塩分濃度等によって、時々刻々と変化するため、時間的および空間的に正確に把握することが困難であった。一方、支援船42に設置された観測装置は、船自体がローリング、ピッチング、およびヨーイングの少なくとも３方向の動きをしており、音響信号を発射する支援船42の音響トランスデューサ422の位置を正確に決定することが困難であった。 In addition, since GPS radio waves or light do not reach the seabed accurately, it is difficult to observe the degree of variation or crustal deformation even in shallow seabeds. The structure change or crustal movement on the sea floor is obtained by determining the position of the support ship 42 by GPS or the like, and obtaining information by the acoustic response signal 411 to the acoustic question signal 421 from the support ship 42 to the autonomous underwater robot 41. Is possible. However, since the speed of sound of the acoustic signal in the sea changes from time to time depending on seawater temperature, salinity concentration, etc., it has been difficult to accurately grasp in time and space. On the other hand, the observation device installed on the support ship 42 moves in at least three directions of rolling, pitching, and yawing, and the position of the acoustic transducer 422 of the support ship 42 that emits an acoustic signal is accurately determined. It was difficult to decide.
前記例は、前記支援船42からＩＤコードおよび測距信号を送信した後、自律式水中ロボット41で受信し、前記測距信号に全て同じＩＤコードを付けて返信するようになっていた。前記データのやり取りに対する送受信時間は、長くかかるため、海水温度および塩分濃度の変化が一定でない場合、正確なデータを得ることができなかった。 In the above example, an ID code and a ranging signal are transmitted from the support vessel 42, and then received by the autonomous underwater robot 41, and all the ranging signals are returned with the same ID code. Since the transmission / reception time for the exchange of data takes a long time, accurate data could not be obtained when changes in seawater temperature and salinity concentration are not constant.
そこで、本出願人の提案した特願２０１３−１０２０９７号（平成２５年５月１４日出願）にかかる発明において、支援船は、自律式水中ロボットに対して、同じＩＤコードと同じ測距信号を一斉に送り、前記自律式水中ロボットからそれぞれ別々のＩＤコードと前記同じ測距信号を支援船に返信していた。 Therefore, in the invention according to Japanese Patent Application No. 2013-102097 (filed on May 14, 2013) proposed by the present applicant, the support ship sends the same ranging signal to the autonomous underwater robot with the same ID code. The autonomous underwater robot sent the ID code and the same distance measurement signal to the support ship.
前記出願に記載された発明において、支援船は、自律式水中ロボットの一つに向けてＩＤコードＳ１および測距信号Ｍを送信する。自律式水中ロボットは、応答信号として、ＩＤコードＳ６（海上保安庁によって予め決められている）および測距信号Ｍを前記支援船に送信する。同様にして、前記支援船は、他の自律式水中ロボットへと順次送受信をそれぞれ行う。前記ＩＤコードＳ６および測距信号Ｍは、たとえば、１０秒の時間差をもって各水中部から前記船上部に送信される。このような支援船と自律式水中ロボットとのデータの送受信は、時間がかかるだけでなく、最初の自律式水中ロボットで得たデータと、最後の自律式水中ロボットで得たデータとが海水温度および塩分濃度と、船の位置および傾き（ピッチング等）等により異なる状態であるため、正確性を欠くという欠点があった。 In the invention described in the application, the support ship transmits the ID code S1 and the ranging signal M toward one of the autonomous underwater robots. The autonomous underwater robot transmits an ID code S6 (predetermined by the Japan Coast Guard) and a ranging signal M as response signals to the support ship. Similarly, the support ship sequentially transmits and receives to other autonomous underwater robots. The ID code S6 and the ranging signal M are transmitted from each underwater part to the upper part of the ship with a time difference of 10 seconds, for example. Sending and receiving data between such support vessels and autonomous underwater robots is not only time consuming, but the data obtained with the first autonomous underwater robot and the data obtained with the last autonomous underwater robot are the seawater temperatures. In addition, since it is in a different state depending on the salinity concentration, the position and inclination of the ship (pitching, etc.), there is a drawback that accuracy is lacking.
前記自律式水中ロボットから前記返信された音響信号は、前記音響トランスデューサによって受信された後、前記支援船に設けられているＧＰＳ等によって、前記自律式水中ロボットの位置を算出する。なお、前記ＧＰＳ等は、陸上におけるＧＰＳ観測データを基準としているものとする。前記観測は、たとえば、数カ月置きに行うことにより、前記自律式水中ロボットの位置がどの様に変化したかを判断することができるものである。 The acoustic signal returned from the autonomous underwater robot is received by the acoustic transducer, and then the position of the autonomous underwater robot is calculated by GPS or the like provided in the support ship. The GPS and the like are based on GPS observation data on land. The observation can be performed every few months, for example, to determine how the position of the autonomous underwater robot has changed.
前記水中音響測位システムは、前記支援船から海底に設置された複数の自律式水中ロボットに向かって、前記音響トランスデューサから一斉に音響信号を送信する。その後、前記トランスデューサからの前記音響信号を受信した自律式水中ロボットは、支援船に向かってほぼ一斉に応答データを送る。前記支援船で受信した各自律式水中ロボットの音響信号は、それぞれの位置（距離）により少し違う時間差をもってそれぞれ収集される。前記各データは、図示されていないデータ処理装置により処理することにより、前記自律式水中ロボットの位置情報を得ることができる。前記従来例の水中音響測位システムは、支援船からの一回の呼び出しで、各自律式水中ロボットから測定結果がほぼ一斉に戻って来るため、海水温度、塩分濃度等の条件が時々刻々と変わる前のデータを効率良く得ることができる。 The underwater acoustic positioning system transmits acoustic signals all at once from the acoustic transducer toward a plurality of autonomous underwater robots installed on the sea floor from the support vessel. Thereafter, the autonomous underwater robot that has received the acoustic signal from the transducer sends response data almost simultaneously toward the support ship. The acoustic signals of each autonomous underwater robot received by the support ship are collected with a slightly different time difference depending on the position (distance). The data can be processed by a data processor (not shown) to obtain position information of the autonomous underwater robot. In the conventional underwater acoustic positioning system, the measurement results return almost simultaneously from each autonomous underwater robot with a single call from the support vessel, so conditions such as seawater temperature and salinity change from moment to moment. Previous data can be obtained efficiently.
近年（東北大震災の後）、大地震の発生する確率が大きくなっている。前記大地震は、海底の地殻変動を正確に観察することにより、予想することが近い将来可能になって来ている。前記浅海における海底の地殻変動は、電波あるいは光による観測が不可能であるため、音響信号を使用する以外に手段が無かった。しかし、前記音響信号の速度は、前述のように、海水温度、塩分濃度、船上局の状態等によって変化するだけでなく、時間的および空間的に派生するいろいろな雑音を拾い易い状況にある。 In recent years (after the Great Tohoku Earthquake), the probability of a large earthquake occurring has increased. It is possible to predict the earthquake in the near future by accurately observing the crustal deformation of the seabed. The crustal movement of the sea floor in the shallow water cannot be observed by radio waves or light, and therefore there is no means other than using an acoustic signal. However, as described above, the speed of the acoustic signal not only changes depending on the seawater temperature, the salinity concentration, the state of the shipboard station, etc., but it is easy to pick up various noises that are derived temporally and spatially.
以上のような課題を解決するために、本発明は、水中部にいるたとえば、自律式水中ロボットから支援船に質問信号を送信することができるシステムとすることで、ノイズ環境に強い安定した測位を可能にするとともに、探査中、オペレーターが介在しない完全に自立した無人機システムを構築するものである。 In order to solve the problems as described above, the present invention provides a stable positioning resistant to a noise environment by, for example, a system that can transmit a question signal from an autonomous underwater robot to a support ship in an underwater part. It is possible to construct a completely self-supporting drone system that does not involve an operator during exploration.
（第１発明）
第１発明の水中音響測位システムは、水中部から音響質問信号を水上部へ送信することによって、ＧＰＳに基づく前記水中部の位置情報を正確に得ることができるものであり、前記水上部に音響質問信号を送信し、前記音響質問信号に基づく位置情報を音響応答信号として受信する水中部と、前記水中部からの音響質問信号を受信し、水中部に向かって位置情報からなる音響応答信号を送信する水上部と、前記水中部からの前記音響質問信号を基にして、前記ＧＰＳから前記水中部に向かって送信された前記位置信号を基にして水中部の正確な位置を演算するための処理を行う前記水中部に設けられているデータ処理装置と、から少なくとも構成されていることを特徴する。
(First invention)
The underwater acoustic positioning system according to the first aspect of the present invention can accurately obtain position information of the underwater part based on GPS by transmitting an acoustic interrogation signal from the underwater part to the upper part of the water. An underwater portion that transmits a question signal and receives position information based on the acoustic question signal as an acoustic response signal; an acoustic response signal from the underwater portion that receives an acoustic question signal from the underwater portion; Based on the transmitted water upper part and the acoustic interrogation signal from the underwater part, for calculating the exact position of the underwater part based on the position signal transmitted from the GPS toward the underwater part It comprises at least a data processing device provided in the underwater part that performs processing.
（第２発明）
第２発明の水中音響測位システムは、水中部が自律式水中ロボットであることを特徴とする。
(Second invention)
The underwater acoustic positioning system of the second invention is characterized in that the underwater part is an autonomous underwater robot.
（第３発明）
第３発明の水中音響測位システムは、水上部が少なくともイリジウムアンテナおよび/またはＧＰＳアンテナを有する無人のサーフェイスステイションからなることを特徴とする。
(Third invention)
The underwater acoustic positioning system of the third invention is characterized in that the upper part of the water is composed of an unmanned surface station having at least an iridium antenna and / or a GPS antenna.
（第４発明）
第４発明の水中音響測位システムは、データ処理装置にカルマンフィルターを備えていることを特徴とする。
(Fourth invention)
The underwater acoustic positioning system of the fourth invention is characterized in that the data processing device includes a Kalman filter.
本発明によれば、音響受波アレイおよび信号処理機能を水中部、たとえば、自律式水中ロボット側に持たせることで、支援船から帰ってきた音響応答信号に基づいて自律式水中ロボット自身で補正用位置データを生成することができるため、オペレーターが送信作業を行うことが不要となり、支援船での作業の自由度を高めることができる。 According to the present invention, the autonomous underwater robot itself corrects based on the acoustic response signal returned from the support ship by providing the acoustic receiving array and the signal processing function on the underwater part, for example, the autonomous underwater robot side. Since position data can be generated, it is not necessary for the operator to perform transmission work, and the degree of freedom of work on the support ship can be increased.
本発明によれば、たとえば、自律式水中ロボット側から質問信号を送り、その応答信号から自身の位置を計算する方式は、前記基線音響測位（LBL航法）と同じであるが、位置方位演算処理結果をカルマンフィルターに通すことにより、マルチパス等による誤測位情報を除去することができ、より高精度に補正用位置データを算出することができる。 According to the present invention, for example, a method of sending a question signal from the autonomous underwater robot side and calculating its own position from the response signal is the same as the baseline acoustic positioning (LBL navigation). By passing the result through a Kalman filter, it is possible to remove erroneous positioning information due to multipath or the like, and it is possible to calculate correction position data with higher accuracy.
（第１発明）
本発明の水中音響測位システムは、水中部から音響質問信号が水上部へ送信されることによって、初めて、前記水中部の位置情報を正確に得るための処理が行われる。前記水中部は、前記水上部に向かって音響質問信号を送信する。前記水上部は、前記音響質問信号に基づいて位置情報を音響応答信号として水中部に返信する。前記水上部は、前記音響質問信号を基にして、ＧＰＳに基づく位置情報を前記水中部に向かって送信するための処理を行う。前記水中部は、前記位置情報を基にして、自律的に演算処理を行うことにより、自分の位置を正確に知ることができる。すなわち、前記水中部は、水上部に音響質問信号を送信し、前記水上部から応答される位置情報を含むモデムメッセージを受信することにより、水上部の人為的、あるいは機械的助け借りることなく、自分自身の演算処理によって位置補正を行うことができる。本明細書において、自律とは、外部から制御されることなく、自ら立てたプログラムによって制御されることである。
(First invention)
In the underwater acoustic positioning system of the present invention, a process for accurately obtaining the position information of the underwater part is performed for the first time by transmitting an acoustic interrogation signal from the underwater part to the upper part of the water. The underwater part transmits an acoustic interrogation signal toward the upper part of the water. The upper part of the water returns position information as an acoustic response signal to the underwater part based on the acoustic interrogation signal. The upper part performs processing for transmitting position information based on GPS toward the underwater part based on the acoustic interrogation signal. The underwater portion can know its position accurately by autonomously performing a calculation process based on the position information. That is, the underwater part transmits an acoustic interrogation signal to the upper part of the water, and receives a modem message including position information responded from the upper part of the water, without human or mechanical assistance of the upper part, Position correction can be performed by own calculation processing. In this specification, autonomous means that it is controlled by a program set up by itself without being controlled from the outside.
（第２発明）
第２発明の水中音響測位システムは、水中部が自律式水中ロボットからなり、前記自律式水中ロボット側からの位置要求に従って、自分自身の位置を正確に自分自身で演算処理することが可能である。
(Second invention)
In the underwater acoustic positioning system of the second invention, the underwater part is composed of an autonomous underwater robot, and it is possible to accurately calculate the position of itself according to the position request from the autonomous underwater robot side. .
（第３発明）
第３発明の水中音響測位システムは、前記水上部に少なくともイリジウムアンテナおよび/またはＧＰＳアンテナを有する無人のサーフェイスステイションから構成されている。前記無人のサーフェイスステイションは、水中部からの音響質問信号によってGPS等に基づく位置情報を送り返すだけの単純作業で済むため、安価なステーションとすることができる。前記サーフェイスステイションは、イリジウム・ＧＰＳの衛星信号を途切れなく受信することが可能で、前記アンテナに電源を供給することができる。
(Third invention)
The underwater acoustic positioning system according to a third aspect of the present invention includes an unmanned surface station having at least an iridium antenna and / or a GPS antenna on the water. The unmanned surface station can be an inexpensive station because it requires only a simple operation of sending back position information based on GPS or the like by an acoustic interrogation signal from the underwater part. The surface station can receive satellite signals of Iridium / GPS without interruption, and can supply power to the antenna.
（第４発明）
第４発明の水中音響測位システムは、水中部にカルマンフィルターを備えている。自律式水中ロボットは、位置情報を初め、被測定対象が離散的な誤差のある観測から、時々刻々と変化する量を推定する場合に使用される。前記離散的な誤差のある情報は、自律式水中ロボットに備えられているカルマンフィルターを使用することにより時々刻々と変化する水中の中で効果を発揮する。すなわち、前記カルマンフィルターは、自律式水中ロボット内において、前の時刻の推定状態から今の時刻の推定状態を計算することができる。
(Fourth invention)
The underwater acoustic positioning system of the fourth invention includes a Kalman filter in the underwater part. Autonomous underwater robots are used when estimating the amount of change from moment to moment based on observations with discrete errors, such as position information. The information with discrete errors exhibits an effect in the water that changes every moment by using a Kalman filter provided in the autonomous underwater robot. That is, the Kalman filter can calculate the estimated state of the current time from the estimated state of the previous time in the autonomous underwater robot.
図１は本発明の実施例で、自律式水中ロボットからの音響質問信号により位置信号からなる音響応答信号を返信する例を説明するための概略図である。図１において、サーフェイスステーション11は、水面に水上部111があり、その上にイリジウム・ＧＰＳアンテナ112が少なくとも備えられている無人のステーションからなる。本明細書で言うイリジウム・ＧＰＳアンテナ112は、イリジウム衛星を使用した衛星通信のことである。前記サーフェイスステーション11は、前記イリジウム・ＧＰＳアンテナ112を搭載しており、前記自律式水中ロボット12が水面に浮上した際に、衛星通信経由でデータを転送することができる。一方、GPSは、衛星を使用して受信アンテナを搭載する機器に対して地球座標における位置を提供する。前記サーフェイスステイション11は、正浮力を持っているため、水面上では常時浮上しており、このため、GPSおよびイリジウムの衛星信号を途切れなく受信することが可能である。また、前記アンテナに電源を供給することができる。 FIG. 1 is a schematic diagram for explaining an example in which an acoustic response signal composed of a position signal is returned in response to an acoustic interrogation signal from an autonomous underwater robot according to an embodiment of the present invention. In FIG. 1, the surface station 11 is an unmanned station having a water surface 111 on the water surface and at least an iridium / GPS antenna 112 provided thereon. The Iridium / GPS antenna 112 referred to in this specification refers to satellite communication using an Iridium satellite. The surface station 11 is equipped with the iridium / GPS antenna 112, and can transfer data via satellite communication when the autonomous underwater robot 12 floats on the water surface. GPS, on the other hand, provides a position in earth coordinates to a device equipped with a receiving antenna using a satellite. Since the surface station 11 has a positive buoyancy, the surface station 11 always floats on the surface of the water. Therefore, it is possible to receive GPS and Iridium satellite signals without interruption. In addition, power can be supplied to the antenna.
たとえば、自律式水中ロボット12は、水中または水上を走行または浮遊している。前記自律式水中ロボット12は、音響質問信号122をサーフェイスステーション11に送出するとともに、前記サーフェイスステーション11から送信される音響応答信号123を受信する送受波器125を備えている。前記送受波器125は、少なくとも3個の音響受信アレイが備えられている。すなわち、本実施例は、水中部にいる自律式水中ロボット12に音響通信用の送受波器125を持たせ、水上部である無人のサーフェイスステーション11にイリジウム・ＧＰＳアンテナ112を設置している。 For example, the autonomous underwater robot 12 travels or floats underwater or on water. The autonomous underwater robot 12 includes a transducer 125 that transmits an acoustic interrogation signal 122 to the surface station 11 and receives an acoustic response signal 123 transmitted from the surface station 11. The transducer 125 is provided with at least three acoustic receiving arrays. In other words, in this embodiment, the autonomous underwater robot 12 in the underwater has the transducer 125 for acoustic communication, and the iridium / GPS antenna 112 is installed in the unmanned surface station 11 that is above the water.
前記自律式水中ロボット12は、前記無人のサーフェイスステーション11に音響質問信号122を送り、前記サーフェイスステーション11から応答される位置情報を含むモデムメッセージを受信することにより、前記自律式水中ロボット12が自律的に位置補正を行うことができるようになっている。 The autonomous underwater robot 12 sends an acoustic interrogation signal 122 to the unmanned surface station 11 and receives a modem message including position information responded from the surface station 11, whereby the autonomous underwater robot 12 autonomously Position correction can be performed.
図２は本発明の実施例で、自律式水中ロボットとサーフェイスステイションの例を説明するための概略ブロック構成図である。
図２において、サーフェイスステーション11は、音響通信送受波器113、音響信号受信回路114、音響応答信号生成回路115、ＧＰＳ位置・時刻信号発生回路116、音響信号送信回路117から少なくとも構成されている。前記自律式水中ロボット12からの音響質問信号122は、音響通信送受波器113により受信される。前記音響通信送受波器113によって受信された前記音響質問信号122は、音響信号受信回路114を通り、ＧＰＳ位置・時刻信号発生回路116の信号と一緒になり、音響応答信号生成回路115において、音響応答信号が生成される。前記音響応答信号は、音響信号送信回路117を介して、音響通信送受波器113から音響応答信号123として自律式水中ロボット12に向けて送信される。
FIG. 2 is a schematic block diagram for explaining an example of an autonomous underwater robot and a surface station in the embodiment of the present invention.
2, the surface station 11 includes at least an acoustic communication transducer 113, an acoustic signal receiving circuit 114, an acoustic response signal generating circuit 115, a GPS position / time signal generating circuit 116, and an acoustic signal transmitting circuit 117. The acoustic interrogation signal 122 from the autonomous underwater robot 12 is received by the acoustic communication transducer 113. The acoustic interrogation signal 122 received by the acoustic communication transducer 113 passes through the acoustic signal reception circuit 114 and is combined with the signal of the GPS position / time signal generation circuit 116, and the acoustic response signal generation circuit 115 A response signal is generated. The acoustic response signal is transmitted to the autonomous underwater robot 12 as the acoustic response signal 123 from the acoustic communication transducer 113 via the acoustic signal transmission circuit 117.
前記自律式水中ロボット12は、音響受波アレイ125、音響信号受信回路126、音響信号処理回路（距離・到達角度の算出）127、位置・方位演算処理回路（緯度/経度、処理）128、カルマンフィルター129、補正用位置データ130、タイミング制御回路131、音響信号送信回路132、音響通信送受波器133から少なくとも構成されている。前記サーフェイスステーション11からの音響応答信号123は、前記音響受波アレイ125によって受信される。前記音響受波アレイ125は、たとえば、図示のように、４個からなり、図示されていない防磁性方位磁石を座標の中心点に置き、それぞれが直角となるように接続されている。また、前記防磁性方位磁石は、図示されていない防水ケーブル等によって、自律式水中ロボットに接続されている。 The autonomous underwater robot 12 includes an acoustic receiving array 125, an acoustic signal receiving circuit 126, an acoustic signal processing circuit (distance / arrival angle calculation) 127, a position / azimuth arithmetic processing circuit (latitude / longitude, processing) 128, and a Kalman. It comprises at least a filter 129, correction position data 130, a timing control circuit 131, an acoustic signal transmission circuit 132, and an acoustic communication transducer 133. The acoustic response signal 123 from the surface station 11 is received by the acoustic receiving array 125. The acoustic receiving array 125 is composed of, for example, four pieces as shown in the figure, and a magnetically shielded azimuth magnet (not shown) is placed at the center point of the coordinates, and they are connected so as to be perpendicular to each other. Moreover, the said magnetic-shielding direction magnet is connected to the autonomous underwater robot by the waterproof cable etc. which are not shown in figure.
音響受波アレイ125は、防磁性方位磁石の中心にそれぞれが直角となるように接続されているため、水中において、正確な方位および方角を知ることができる。本明細書において、方位は、水平面上の角度で、方角は、水面の深さ方向の角度であると定義する。 Since the acoustic receiving array 125 is connected so as to be perpendicular to the center of the magnetic-proof azimuth magnet, it is possible to know an accurate azimuth and direction in water. In this specification, an azimuth is defined as an angle on a horizontal plane, and a direction is defined as an angle in the depth direction of the water surface.
図２において、音響受波アレイ125は、距離Ｌを有するものとする。音源からの音波は、到達角度θをもって、それぞれ音響受波アレイ125によってそれぞれ受信される。自律式水中ロボット12は、到達角度θと到達時間差δＴによって距離が計算される。
δＴ×音速（Ｃ）＝距離（Ｌ）×cos θ
θ＝arccos( δＴ×Ｃ／Ｌ）
として計算できる。
前記演算は、説明を容易にするために、水平面の方位だけであるが、同様な計算処理により、深さ方向の方角を計算することができる。
In FIG. 2, the acoustic receiving array 125 is assumed to have a distance L. Sound waves from the sound source are respectively received by the acoustic receiving array 125 with an arrival angle θ. The distance of the autonomous underwater robot 12 is calculated based on the arrival angle θ and the arrival time difference δT.
δT × sonic velocity (C) = distance (L) × cos θ
θ = arccos (δT × C / L)
Can be calculated as
For the sake of easy explanation, the calculation is only the orientation of the horizontal plane, but the direction in the depth direction can be calculated by a similar calculation process.
図２において、音響受波アレイ125によって受信された音響応答信号は、音響信号受信回路126によって受信さてる。前記音響信号受信回路126によって受信された音響信号は、音響信号処理回路（距離・到達角度の算出）127によって処理される。前記算出された距離および到達角度は、位置・方位演算処理回路（緯度/経度、方位）128によって処理される。 In FIG. 2, the acoustic response signal received by the acoustic receiving array 125 is received by the acoustic signal receiving circuit 126. The acoustic signal received by the acoustic signal receiving circuit 126 is processed by an acoustic signal processing circuit (distance / arrival angle calculation) 127. The calculated distance and arrival angle are processed by a position / orientation calculation processing circuit (latitude / longitude, azimuth) 128.
前記位置・方位演算処理回路（緯度/経度、方位）128によって処理されたるデータは、カルマンフィルター129によって修正された後、補正用位置データとして出力する。一方、タイミング制御回路131は、前記音響信号処理回路（距離・到達角度の算出）127および音響信号送信回路132にタイミング信号を送出する。音響通信送受波器133は、前記タイミングに基づいて音響質問信号122を送出する。 Data processed by the position / orientation calculation processing circuit (latitude / longitude, azimuth) 128 is corrected by the Kalman filter 129 and then output as correction position data. On the other hand, the timing control circuit 131 sends a timing signal to the acoustic signal processing circuit (distance / arrival angle calculation) 127 and the acoustic signal transmission circuit 132. The acoustic communication transducer 133 transmits the acoustic interrogation signal 122 based on the timing.
本発明で言うカルマンフィルターは、ルドルフ・カルマンによって提案されたものであり、離散的な誤差のある観測から、時々刻々と時間変化する量を推定するために用いられる。本発明において、用いられているカルマンフィルターは、たとえば、自律式水中ロボットに内蔵されているジャイロセンサーあるいは対地速度計からの誤さのある情報を統合して、時々刻々と変化する水中での自律式水中ロボットの位置等を推定するのに用いることにより大きな効果を有することが判った。 The Kalman filter referred to in the present invention has been proposed by Rudolf Kalman, and is used to estimate an amount that changes with time from observations having discrete errors. In the present invention, the Kalman filter used, for example, integrates erroneous information from a gyro sensor or a ground speed meter built in an autonomous underwater robot, and changes autonomously in water. It has been found that it has a great effect when used to estimate the position of the underwater robot.
以上、本発明の実施例を詳述したが、本発明は、前記実施例に限定されるものではない。そして、本発明は、特許請求の範囲に記載された事項を逸脱することがなければ、種々の設計変更を行うことが可能である。本発明の船上部、サーフェイスステイション、あるいは水中部、自律式水中ロボット、または送受信装置、あるいはデータ処理装置等は、公知の機械工学、通信工学および音響工学技術から構成されるもので、特許請求の範囲を逸脱しない限り変形することが可能である。 As mentioned above, although the Example of this invention was explained in full detail, this invention is not limited to the said Example. The present invention can be modified in various ways without departing from the scope of the claims. The ship upper part, surface station or underwater part, autonomous underwater robot, transmission / reception device, data processing device, etc. of the present invention are composed of known mechanical engineering, communication engineering, and acoustic engineering technology. Modifications can be made without departing from the above range.
１１・・・サーフェイスステイション
１１１・・水上部
１１２・・イリジウム・GPSアンテナ
１２・・・自律式水中ロボット
１２２・・音響質問信号
１２３・・音響応答信号
１２５・・送受波器
11 ··· Surface Station 111 ··· Upper part 112 · · Iridium · GPS antenna 12 · · · Autonomous underwater robot 122 · · Acoustic interrogation signal 123 · · Acoustic response signal 125 · · Transceiver
Claims (4)
前記水上部に音響質問信号を送信し、前記音響質問信号に基づく位置情報を音響応答信号として受信する水中部と、
前記水中部からの音響質問信号を受信し、水中部に向かって位置情報からなる音響応答信号を送信する水上部と、
前記水中部からの前記音響質問信号を基にして、前記ＧＰＳから前記水中部に向かって送信された前記位置信号を基にして水中部の正確な位置を演算するための処理を行う前記水中部に設けられているデータ処理装置と、
から少なくとも構成されていることを特徴とする水中音響測位システム。 In the underwater acoustic positioning system that can accurately obtain the position information of the underwater part based on GPS by transmitting an acoustic interrogation signal from the underwater part to the upper part of the water,
An underwater portion for transmitting an acoustic interrogation signal to the upper part of the water, and receiving position information based on the acoustic interrogation signal as an acoustic response signal;
The water upper part that receives the acoustic interrogation signal from the underwater part and transmits an acoustic response signal composed of position information toward the underwater part,
Based on the acoustic interrogation signal from the underwater part, the underwater part performs processing for calculating an accurate position of the underwater part based on the position signal transmitted from the GPS toward the underwater part. A data processing device provided in
An underwater acoustic positioning system characterized by comprising at least.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2016226469A JP2018084445A (en) | 2016-11-22 | 2016-11-22 | Underwater acoustic positioning system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2016226469A JP2018084445A (en) | 2016-11-22 | 2016-11-22 | Underwater acoustic positioning system |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2018084445A true JP2018084445A (en) | 2018-05-31 |
Family
ID=62237021
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2016226469A Pending JP2018084445A (en) | 2016-11-22 | 2016-11-22 | Underwater acoustic positioning system |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2018084445A (en) |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109669186A (en) * | 2018-12-24 | 2019-04-23 | 中国船舶重工集团公司第七0研究所 | A kind of underwater sailing body acoustic-magnatic joint measuring system and method |
| CN109782289A (en) * | 2018-12-26 | 2019-05-21 | 中国电子科技集团公司第二十研究所 | A kind of submarine navigation device localization method based on the constraint of baseline geometry |
| CN110487282A (en) * | 2019-09-11 | 2019-11-22 | 中国电子科技集团公司第三研究所 | A kind of time delay estimation modification method and system positioning robustness for improving baseline |
| CN111812694B (en) * | 2020-06-28 | 2021-05-18 | 中国科学院地质与地球物理研究所 | Long-baseline shipborne positioning device and positioning method thereof |
| CN112965032A (en) * | 2021-03-03 | 2021-06-15 | 山东省科学院海洋仪器仪表研究所 | Ultra-short baseline underwater sound positioning system for simulation based on digital model and debugging method |
| CN113895580A (en) * | 2021-11-17 | 2022-01-07 | 国网智能科技股份有限公司 | Communication positioning device and method for cableless autonomous underwater robot |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6336174A (en) * | 1986-07-30 | 1988-02-16 | Nec Corp | Buoy for underwater position measurement |
| JPH09145821A (en) * | 1995-11-20 | 1997-06-06 | Akihide Sakitani | Underwater object position measuring device |
| JPH10111352A (en) * | 1996-10-08 | 1998-04-28 | Mitsubishi Heavy Ind Ltd | Guidance device for underwater navigating object and its method |
| JP2002250766A (en) * | 2001-02-22 | 2002-09-06 | Nec Corp | Method and system for underwater towed body position measurement |
| US20070297289A1 (en) * | 2006-06-22 | 2007-12-27 | Northrop Grumman Corporation | Underwater navigation by aided light sensor |
| CN102829777A (en) * | 2012-09-10 | 2012-12-19 | 江苏科技大学 | Integrated navigation system for autonomous underwater robot and method |
-
2016
- 2016-11-22 JP JP2016226469A patent/JP2018084445A/en active Pending
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6336174A (en) * | 1986-07-30 | 1988-02-16 | Nec Corp | Buoy for underwater position measurement |
| JPH09145821A (en) * | 1995-11-20 | 1997-06-06 | Akihide Sakitani | Underwater object position measuring device |
| JPH10111352A (en) * | 1996-10-08 | 1998-04-28 | Mitsubishi Heavy Ind Ltd | Guidance device for underwater navigating object and its method |
| JP2002250766A (en) * | 2001-02-22 | 2002-09-06 | Nec Corp | Method and system for underwater towed body position measurement |
| US20070297289A1 (en) * | 2006-06-22 | 2007-12-27 | Northrop Grumman Corporation | Underwater navigation by aided light sensor |
| CN102829777A (en) * | 2012-09-10 | 2012-12-19 | 江苏科技大学 | Integrated navigation system for autonomous underwater robot and method |
Cited By (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109669186A (en) * | 2018-12-24 | 2019-04-23 | 中国船舶重工集团公司第七0研究所 | A kind of underwater sailing body acoustic-magnatic joint measuring system and method |
| CN109669186B (en) * | 2018-12-24 | 2024-01-23 | 中国船舶重工集团公司第七一0研究所 | Acoustic-magnetic combined measurement system and method for underwater navigation body |
| CN109782289A (en) * | 2018-12-26 | 2019-05-21 | 中国电子科技集团公司第二十研究所 | A kind of submarine navigation device localization method based on the constraint of baseline geometry |
| CN109782289B (en) * | 2018-12-26 | 2022-07-05 | 中国电子科技集团公司第二十研究所 | Underwater vehicle positioning method based on baseline geometric structure constraint |
| CN110487282A (en) * | 2019-09-11 | 2019-11-22 | 中国电子科技集团公司第三研究所 | A kind of time delay estimation modification method and system positioning robustness for improving baseline |
| CN110487282B (en) * | 2019-09-11 | 2021-04-06 | 中国电子科技集团公司第三研究所 | Time delay estimation correction method and system for improving baseline positioning robustness |
| CN111812694B (en) * | 2020-06-28 | 2021-05-18 | 中国科学院地质与地球物理研究所 | Long-baseline shipborne positioning device and positioning method thereof |
| CN112965032A (en) * | 2021-03-03 | 2021-06-15 | 山东省科学院海洋仪器仪表研究所 | Ultra-short baseline underwater sound positioning system for simulation based on digital model and debugging method |
| CN112965032B (en) * | 2021-03-03 | 2022-10-18 | 山东省科学院海洋仪器仪表研究所 | Ultra-short baseline underwater sound positioning system based on digital model and debugging method |
| CN113895580A (en) * | 2021-11-17 | 2022-01-07 | 国网智能科技股份有限公司 | Communication positioning device and method for cableless autonomous underwater robot |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US9372255B2 (en) | Determining a position of a submersible vehicle within a body of water | |
| JP2018084445A (en) | Underwater acoustic positioning system | |
| US7139647B2 (en) | Methods and systems for navigating under water | |
| US7512036B2 (en) | Underwater acoustic positioning system and method | |
| JP4968827B2 (en) | Underwater positioning system and underwater positioning method | |
| Kebkal et al. | AUV acoustic positioning methods | |
| KR100906362B1 (en) | Underwater Navigation System for a Platoon of Multiple Unmanned Underwater Vehicles Using Range Measurements on Two Reference Stations and Inertial Sensors | |
| CN104316045A (en) | AUV (autonomous underwater vehicle) interactive auxiliary positioning system and AUV interactive auxiliary positioning method based on SINS (strapdown inertial navigation system)/LBL (long base line) | |
| JP6987854B2 (en) | Devices and methods for positioning underwater devices | |
| JP2011163930A (en) | Position calibration method of underwater vessel | |
| US20060178829A1 (en) | Global acoustic positioning system and device | |
| JP6675118B2 (en) | Underwater localization system | |
| JP2003215230A (en) | Position detection system for underwater moving body and its method | |
| JP2017165333A (en) | Sailing assisting device of underwater sailing body, and method of assisting sailing of sailing body and underwater sailing body | |
| CN115390012B (en) | Multi-transponder coordinate measuring method, device and system for HOV (Hov) accurate positioning | |
| JP5381773B2 (en) | Position calibration method and apparatus for underwater vehicle | |
| JP2019043289A (en) | Cruising controller and cruising control method | |
| JPH09145821A (en) | Underwater object position measuring device | |
| WO2020096495A1 (en) | Method for positioning underwater objects | |
| Quraishi et al. | Easily deployable underwater acoustic navigation system for multi-vehicle environmental sampling applications | |
| JP5381772B2 (en) | Position calibration method for underwater vehicle | |
| Devassykutty et al. | Evaluation of high precision localization approach for a fleet of unmanned deep ocean vehicles | |
| Watanabe et al. | Conceptual design of navigation of an AUV for Monitoring CCS site at deep sea bottom | |
| Sekimori et al. | Acoustic Passive BEDD Self-localization for A Fleet of AUVs: A Sea Experiment Validation | |
| Xiang et al. | A novel acoustic navigation scheme for coordinated heterogenous autonomous vehicles |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20180807 |