JP2006275920A - Underwater position detection system, sound source device, underwater position detection device and underwater position detection method - Google Patents

Underwater position detection system, sound source device, underwater position detection device and underwater position detection method Download PDF

Info

Publication number
JP2006275920A
JP2006275920A JP2005098500A JP2005098500A JP2006275920A JP 2006275920 A JP2006275920 A JP 2006275920A JP 2005098500 A JP2005098500 A JP 2005098500A JP 2005098500 A JP2005098500 A JP 2005098500A JP 2006275920 A JP2006275920 A JP 2006275920A
Authority
JP
Japan
Prior art keywords
sound source
underwater
position detection
sound
water
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
Application number
JP2005098500A
Other languages
Japanese (ja)
Inventor
Masahiro Matsuzawa
正浩 松澤
Takayoshi Nishiyama
孝義 西山
Hidenobu Kodama
秀信 児玉
Shinpei Usui
晋平 碓井
Toyoaki Uchida
豊明 内田
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.)
Hitachi Ltd
Original Assignee
Hitachi 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 Hitachi Ltd filed Critical Hitachi Ltd
Priority to JP2005098500A priority Critical patent/JP2006275920A/en
Publication of JP2006275920A publication Critical patent/JP2006275920A/en
Pending legal-status Critical Current

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To provide an underwater position detection system and its device and method enabling each device to reduce time to receive and send signals, allowing a diver to move around while acquiring his own position wherein the devices are made compact and not required to be installed at water bottom. <P>SOLUTION: A sound source device is equipped with a means for acquiring positioning information from an external positioning means, a means for calculating its own position and a sound source for irradiating sound wave of predetermined intensity which is calculated by superposing its own position in the water. An underwater position detecting device is equipped with a means for acquiring the irradiated sound wave, a means for acquiring the positions of and the distances to the plurality of sound source devices by conducting the process for acquiring the positions of the sound source devices superposed by the acquired sound wave and a process for obtaining the distances to the sound source devices on the basis of the intensity of the sound wave and a means for acquiring the position of its own by conducting a predetermined positioning process on the basis of the acquired positions of and the distances to the plurality of sound source devices. <P>COPYRIGHT: (C)2007,JPO&INPIT

Description

本発明は、水中における位置検出システム、音源装置、水中位置検出装置、および水中位置検出方法、特にダイビングのナビゲータとして利用する水中位置検出システム、音源装置、水中位置検出装置、および水中位置検出方法に関する。   The present invention relates to an underwater position detection system, a sound source device, an underwater position detection device, and an underwater position detection method, and more particularly to an underwater position detection system, a sound source device, an underwater position detection device, and an underwater position detection method used as a diving navigator. .

ダイビング初心者またはポイントへの潜水経験の浅いダイバーには位置の把握に不安がある。そこで、安全にダイバーがダイビングコースの散策を行えるように、水中での位置検出が可能な装置の開発がすすめられている。
従来においては、ダイバーがコンパスを用いて方位を確認しながら、周囲の景色を頼りに散策する手法がある。また、ボートとダイバーとの間で超音波信号のやりとりを行い、ダイバーがボートの位置を確認しながら散策する手法もある。
Diving beginners or divers with little experience diving into points are worried about grasping the position. Therefore, development of a device that can detect the position in the water has been promoted so that divers can safely walk the diving course.
Conventionally, there is a technique in which a diver walks relying on surrounding scenery while confirming the direction using a compass. There is also a technique in which an ultrasonic signal is exchanged between a boat and a diver and the diver walks while checking the position of the boat.

また、他の手法として、超音波を発信する装置を複数水底に設置し、各装置から各装置固有の周波数の超音波を発信させ、ダイバーの携帯する装置が受信した複数の超音波の到達時間差からダイバーの位置を特定する技術が開示されている(特許文献1参照)。
さらに、他の手法として、誘導対象の水中航走体への音響測位用音源、電波測位装置、音響測位用音源からの音源信号を発信する音響トランスデューサ、および電波測位装置で得た測位情報を発信する水中音響部を有し、洋上に浮遊する複数のブイを備え、水中航走体は、複数のブイからの音響信号に基づく音響測位と、測位情報によるブイの絶対位置データとにより自己の絶対位置をリアルタイムに計測する技術が開示されている(特許文献2参照)。
特開2003−172629号公報(段落0010〜0018、図1〜2) 特開平10−111352号公報(段落0022〜0045、図1)
Also, as another method, a plurality of devices that transmit ultrasonic waves are installed on the bottom of the water, each device transmits ultrasonic waves with a frequency unique to each device, and the arrival time difference between the multiple ultrasonic waves received by the device carried by the diver Discloses a technique for identifying the position of a diver (see Patent Document 1).
In addition, as another method, sound source for acoustic positioning, radio positioning device, acoustic transducer for transmitting sound source signal from sound source for acoustic positioning, and positioning information obtained by radio positioning device are transmitted to underwater vehicle to be guided The underwater acoustic vehicle is equipped with a plurality of buoys that float on the ocean, and the underwater vehicle has its own absolute position based on the acoustic positioning based on the acoustic signals from the plurality of buoys and the absolute position data of the buoys based on the positioning information. A technique for measuring the position in real time is disclosed (see Patent Document 2).
JP 2003-172629 A (paragraphs 0010 to 0018, FIGS. 1 and 2) JP-A-10-111352 (paragraphs 0022 to 0045, FIG. 1)

しかしながら、従来の方法では、ダイバーがコンパスを用いて方位を確認しながら、周囲の景色を手掛かりとして自分の位置を確認する作業は、視界が悪いときには特に困難であり、初心者が安全に散策するのは難しいという問題がある。また、ボートとダイバー間の超音波信号のやりとりによって位置を確認する手法では、ダイバーが把握できるのは、ボートに対する相対位置であり、自分が水中のどの辺りを散策しているのかを把握できるものではないという問題がある。   However, with the conventional method, it is particularly difficult for divers to check their position using a compass and to check their position using the surrounding scenery as a clue. There is a problem that is difficult. In addition, in the method of confirming the position by exchanging ultrasonic signals between the boat and the diver, the diver can grasp the relative position with respect to the boat, and can grasp where the person is walking in the water. There is a problem that is not.

また、特許文献1で開示されている技術によれば、ダイバーは水中地図で自分の位置を確認しながら散策できるが、超音波を発信する装置を水底に設置する作業および回収する作業が煩雑であるという問題がある。さらには、水底にある岩礁などの障害物によって音波が反射してしまうと、位置の検出の精度が低下するという問題がある。   Further, according to the technique disclosed in Patent Document 1, a diver can walk while confirming his / her position on an underwater map, but the work of installing and collecting a device for transmitting ultrasonic waves on the bottom of the water is complicated. There is a problem that there is. Furthermore, if sound waves are reflected by obstacles such as reefs at the bottom of the water, there is a problem that the accuracy of position detection is reduced.

さらに、特許文献2で開示されている技術によれば、ブイからの相対位置を測定するために必要な時刻情報を含む音響信号の発信器と、ブイの絶対位置情報を含む測位信号の発信器とをブイに取り付ける必要があることから、ブイが大きくなってしまうという問題がある。また、水中航走体にもふたつの受信器が必要になることから、水中航走体が大きくなってしまうという問題がある。仮に、ひとつの発信器から信号を発信する構成にしたとしても、ひとつの発信器から時刻情報と絶対位置情報とを含む信号を発信する必要が生じ、信号を送受信するために多くの時間を費やしてしまうという問題がある。   Furthermore, according to the technique disclosed in Patent Document 2, an acoustic signal transmitter including time information necessary for measuring a relative position from a buoy and a positioning signal transmitter including absolute position information of the buoy. Since it is necessary to attach to the buoy, there is a problem that the buoy becomes large. Moreover, since two receivers are also required for the underwater vehicle, there is a problem that the underwater vehicle becomes large. Even if it is configured to transmit a signal from one transmitter, it is necessary to transmit a signal including time information and absolute position information from one transmitter, and a lot of time is spent to transmit and receive the signal. There is a problem that it ends up.

本発明は、以上のような問題点に鑑みてなされたものであり、ダイバーが水中のどの辺りを散策しているのかを把握しながら散策することが可能であり、水底に装置を設置する必要がなく、また、各装置の小型化を実現し、各装置が信号を送受信するために費やす時間を低減することが可能な水中位置検出システム、音源装置、水中位置検出装置、および水中位置検出方法を提供することを目的とする。   The present invention has been made in view of the above problems, and it is possible to walk while grasping which part of the diver is walking in the water, and it is necessary to install a device on the bottom of the water. Underwater position detection system, sound source device, underwater position detection device, and underwater position detection method capable of reducing the size of each device and reducing the time spent by each device to transmit and receive signals The purpose is to provide.

本発明は、前記目的を達成するために創案されたものであり、本発明の水中位置検出システムは、音源を備え、水中に向けて照射する音波により自己の位置を知らせる複数の音源装置と、水中に位置し、前記複数の音源装置からの音波を取得することで水中での自己の位置を検出する水中位置検出装置とを含んで構成される水中位置検出システムであって、前記音源装置は、水面上に設置され、外部の測位手段からの測位情報を取得する測位情報取得手段と、前記取得した測位情報に基づいて測位処理を行うことで、自己の位置を算出する自位置算出手段と、前記算出した自己の位置を重畳して所定強度の音波として水中に照射する音源とを備え、前記水中位置検出装置は、前記照射された音波を水中で取得する音波取得手段と、前記取得した音波からこれに重畳された音源装置の位置を得る処理と、前記音波の強度に基づいて前記音源装置までの距離を得る処理とを行うことで、前記複数の音源装置の位置および前記複数の音源装置までの距離を取得する位置・距離取得手段と、前記取得した前記複数の音源装置の位置および前記複数の音源装置までの距離に基づいて所定の測位処理を行うことで、水中での自己の位置を取得する水中位置算出手段と、を備える構成とした。   The present invention was devised to achieve the above-described object, and the underwater position detection system of the present invention includes a sound source, and a plurality of sound source devices that notify the position of the self by sound waves irradiated toward the water, An underwater position detection system that is located underwater and includes an underwater position detection device that detects its own position in water by acquiring sound waves from the plurality of sound source devices, the sound source device comprising: A positioning information acquisition unit installed on the water surface for acquiring positioning information from an external positioning unit, and a self-position calculation unit for calculating a self-position by performing a positioning process based on the acquired positioning information; A sound source that superimposes the calculated self position and irradiates the sound as a sound wave of a predetermined intensity in water, and the underwater position detection device includes sound wave acquisition means for acquiring the irradiated sound wave in water, and the acquisition By performing a process of obtaining the position of the sound source device superimposed on the sound wave from the sound wave and a process of obtaining a distance to the sound source device based on the intensity of the sound wave, the position of the plurality of sound source devices and the plurality of sound sources A position / distance acquisition unit for acquiring a distance to the device, and a predetermined positioning process based on the acquired positions of the plurality of sound source devices and the distances to the plurality of sound source devices; And an underwater position calculating means for acquiring a position.

かかる構成によれば、各音源装置は外部手段により、測位が可能で位置が明確に定まっているため、位置を重畳して、各音源装置で固有の周波数で音波を発生させ、水中位置検出装置において音波の強弱を検出できる装置によって音源装置までの距離を算出し、重畳された音源装置の位置と合わせて、水中の位置を検出することが可能である。したがってダイバーは、水中位置検出を携帯することによって、水中の位置を把握しながら散策することが可能となる。   According to such a configuration, each sound source device can be measured by an external means and the position is clearly determined. Therefore, the position is superimposed, and a sound wave is generated at a specific frequency in each sound source device. It is possible to calculate the distance to the sound source device by a device capable of detecting the strength of the sound wave and to detect the position in water together with the position of the superimposed sound source device. Therefore, the diver can take a walk while grasping the underwater position by carrying the underwater position detection.

また、音源装置を水面上に設けているため、水底に設置すべき装置が不要となり、煩雑な装置の設置作業および回収作業を行う手間がなくなる。また、水底にある岩礁などの障害物によって音波が反射することもないので、精度を下げずに位置の検出を行うことが可能である。   In addition, since the sound source device is provided on the water surface, a device to be installed on the bottom of the water is not necessary, and troublesome installation work and collection work for the device are eliminated. In addition, since sound waves are not reflected by obstacles such as reefs in the bottom of the water, it is possible to detect the position without reducing accuracy.

さらに、水中位置検出装置は、音波に重畳された音源装置の位置および音波強度に基づいて水中の位置を検出するため、水中位置検出装置が外部から時刻情報を取得する必要がなくなり、音源装置から水中位置検出装置に送信される信号に含まれる情報の量が低減される。   Furthermore, since the underwater position detection device detects the position in water based on the position of the sound source device superimposed on the sound wave and the sound wave intensity, it is not necessary for the underwater position detection device to acquire time information from the outside. The amount of information included in the signal transmitted to the underwater position detection device is reduced.

本発明によれば、ダイバーは水中の位置を把握しながら散策することが可能である。また、超音波発信装置などを水底に設置する作業および回収する作業が省略でき、岩礁などの水底障害物による位置検出精度の低下を防ぐことが可能である。さらに、音源装置から水中位置検出装置に送信される信号に含まれる情報が低減され、各装置の小型化を実現し、各装置が信号を送受信するために費やす時間を低減することが可能である。   According to the present invention, a diver can take a walk while grasping a position in water. In addition, it is possible to omit the work of installing and collecting an ultrasonic transmission device on the bottom of the water, and it is possible to prevent a decrease in position detection accuracy due to a water bottom obstacle such as a reef. Furthermore, the information contained in the signal transmitted from the sound source device to the underwater position detection device is reduced, the size of each device can be reduced, and the time spent by each device to transmit and receive signals can be reduced. .

次に、本発明を実施するための最良の形態(以下、「実施形態」という)について図面を参照して説明する。   Next, the best mode for carrying out the present invention (hereinafter referred to as “embodiment”) will be described with reference to the drawings.

(第1実施形態)
まず、図1を参照して、本発明の実施形態に係る水中位置検出システムの構成について説明する。図1は、本発明の第1実施形態に係る水中位置検出システムのブロック図である。水中位置検出システムは、GPSブイ10(10a,10b)と水中位置検出装置20とを含んで構成される。
(First embodiment)
First, with reference to FIG. 1, the structure of the underwater position detection system which concerns on embodiment of this invention is demonstrated. FIG. 1 is a block diagram of an underwater position detection system according to a first embodiment of the present invention. The underwater position detection system includes a GPS buoy 10 (10a, 10b) and an underwater position detection device 20.

図1に示すように、GPSブイ10(10a,10b)は、測位情報取得手段101(101a,101b)と自位置算出手段102(102a,102b)と音源103(103a,103b)とを備える。以下、GPSブイ10aおよびGPSブイ10bの両方を指す場合は、GPSブイ10を用いて表す。同様に、測位情報取得手段101aおよび101bは、測位情報取得手段101を用いて表し、自位置算出手段102aおよび102bは、自位置算出手段102を用いて表し、音源103aおよび103bは、音源103を用いて表す。以下、GPSブイ10の各手段について説明する。   As shown in FIG. 1, the GPS buoy 10 (10a, 10b) includes positioning information acquisition means 101 (101a, 101b), own position calculation means 102 (102a, 102b), and a sound source 103 (103a, 103b). Hereinafter, the GPS buoy 10 is used to indicate both the GPS buoy 10a and the GPS buoy 10b. Similarly, the positioning information acquisition means 101a and 101b are expressed using the positioning information acquisition means 101, the local position calculation means 102a and 102b are expressed using the local position calculation means 102, and the sound sources 103a and 103b are the sound sources 103. Use to represent. Hereinafter, each means of the GPS buoy 10 will be described.

[測位情報取得手段101の説明]
測位情報取得手段101は、GPS衛星2などの外部の測位手段から測位信号を受信する機能を有する。測位情報取得手段101は、測位信号を受信できるように、水面上などに設置されているのが好ましい。
[Description of Positioning Information Acquisition Unit 101]
The positioning information acquisition unit 101 has a function of receiving a positioning signal from an external positioning unit such as the GPS satellite 2. The positioning information acquisition means 101 is preferably installed on the water surface or the like so that it can receive positioning signals.

[自位置算出手段102の説明]
自位置算出手段102は、測位情報取得手段101で受信した測位信号から自己の位置を算出する機能を有する。算出する方法については、公知であるため、ここでは省略する。
[Explanation of Self-Position Calculation Unit 102]
The own position calculation means 102 has a function of calculating its own position from the positioning signal received by the positioning information acquisition means 101. Since the calculation method is known, it is omitted here.

[音源103の説明]
音源103は、固有の周波数を持った電気信号から自位置算出手段102で算出した位置情報を各ブイ固有の周波数で位相変調して電圧を加えることにより音波を発生させて、GPSブイ10の位相変調された位置情報を送信する。GPSブイ10aでは、周波数f1で位相変調された音波を発生させ、GPSブイ10bでは、周波数f2で位相変調された音波を発生させる。音波自体は、圧電素子に電圧信号を入力することにより、圧電素子を用いたスピーカで音波の出力ができる。音波の指向性はスピーカで調整できるが、ここでは無指向とする。これにより音源103を構成する。
なお、測位情報取得手段101と音源103との距離を小さくすることによって、測位精度を上げることが可能である。
また、本実施形態においては、音源装置としてGPSブイ10を用いることにするが、音源装置としてGPS搭載の船などを代わりに用いることも可能である。
[Description of the sound source 103]
The sound source 103 generates a sound wave by phase-modulating the position information calculated by the own position calculation means 102 from an electric signal having a specific frequency at a frequency specific to each buoy and applying a voltage to the phase of the GPS buoy 10. Transmit the modulated location information. The GPS buoy 10a generates a sound wave phase-modulated at the frequency f1, and the GPS buoy 10b generates a sound wave phase-modulated at the frequency f2. The sound wave itself can be output by a speaker using the piezoelectric element by inputting a voltage signal to the piezoelectric element. Although the directivity of the sound wave can be adjusted by a speaker, it is assumed to be omnidirectional here. Thus, the sound source 103 is configured.
Note that the positioning accuracy can be increased by reducing the distance between the positioning information acquisition means 101 and the sound source 103.
In the present embodiment, the GPS buoy 10 is used as a sound source device, but a GPS-equipped ship or the like can be used instead as a sound source device.

受信側の水中位置検出装置20は、音波取得手段210、位置・距離取得手段220、水中位置算出手段230、水圧測定手段240および表示手段250を含んで構成される。以下、それぞれの手段について説明する。なお、本発明は、複数のGPSブイ10を用いることによって実現されるが、水中位置の算出方法を簡略化するため、水圧測定手段240とGPSブイ10aおよび10bとを用いた場合を好適な例として取り上げて説明することにする。   The receiving-side underwater position detection device 20 includes a sound wave acquisition unit 210, a position / distance acquisition unit 220, an underwater position calculation unit 230, a water pressure measurement unit 240, and a display unit 250. Hereinafter, each means will be described. In addition, although this invention is implement | achieved by using the several GPS buoy 10, in order to simplify the calculation method of underwater position, the case where the water pressure measurement means 240 and GPS buoys 10a and 10b are used is a suitable example. Will be taken up and explained.

[音波取得手段210の説明]
音波取得手段210は、水中の音波を検出し、検出した音波信号を電気信号に変換する機能を有する。ここでは、音波取得手段210は、水中マイクなどを用いて音波を検出し、圧電素子などを用いて音波信号を電気信号に変換する。また、音波取得手段210は、変換した音波信号を位置・距離取得手段220の周波数判定部221に送信する。
[Description of Sound Wave Acquisition Unit 210]
The sound wave acquisition unit 210 has a function of detecting a sound wave in water and converting the detected sound wave signal into an electric signal. Here, the sound wave acquisition unit 210 detects a sound wave using an underwater microphone or the like, and converts the sound wave signal into an electric signal using a piezoelectric element or the like. The sound wave acquisition unit 210 transmits the converted sound wave signal to the frequency determination unit 221 of the position / distance acquisition unit 220.

[位置・距離取得手段220の説明]
位置・距離取得手段220は、周波数判定部221、音波強度検出部222、および復調部223を含んで構成される。
周波数判定部221は、音波取得手段210から受け取った音波信号の周波数がGPSブイ10aの周波数f1かGPSブイ10bの周波数f2かを判定する機能を有する。ここでは、周波数判定部221は、周波数回路フィルタなどにより周波数を識別し、音波強度検出部222に周波数の識別結果と音波信号とを送信する。
音波強度検出部222は、周波数判定部221から送られた音波信号から、音波の強度を検出する機能を有する。音波強度検出部222は、周波数の識別結果と音波強度と音波信号とを復調部223に送信する。
復調部223は、音波強度検出部222から受け取った変調された音波信号からGPSブイ10aまたは10bの位置情報を復調する機能を有する。周波数の識別結果と距離情報と位置情報とを水中位置算出手段230の測量計算部235に送信する。
[Description of Position / Distance Acquisition Unit 220]
The position / distance acquisition unit 220 includes a frequency determination unit 221, a sound wave intensity detection unit 222, and a demodulation unit 223.
The frequency determination unit 221 has a function of determining whether the frequency of the sound wave signal received from the sound wave acquisition unit 210 is the frequency f1 of the GPS buoy 10a or the frequency f2 of the GPS buoy 10b. Here, the frequency determination unit 221 identifies the frequency using a frequency circuit filter or the like, and transmits the frequency identification result and the sound wave signal to the sound wave intensity detection unit 222.
The sound wave intensity detection unit 222 has a function of detecting the sound wave intensity from the sound wave signal sent from the frequency determination unit 221. The sound wave intensity detection unit 222 transmits the frequency identification result, the sound wave intensity, and the sound wave signal to the demodulation unit 223.
The demodulator 223 has a function of demodulating the position information of the GPS buoy 10a or 10b from the modulated sound wave signal received from the sound wave intensity detector 222. The frequency identification result, distance information, and position information are transmitted to the survey calculation unit 235 of the underwater position calculation means 230.

[水圧測定手段240の説明]
水圧測定手段240は、水中位置検出装置20にかかる水圧を測定する機能を有する。水圧測定手段240は、水圧計などを含んで構成される。また、測定された水圧は、測量計算部235に送信される。
[Description of water pressure measuring means 240]
The water pressure measuring means 240 has a function of measuring the water pressure applied to the underwater position detection device 20. The water pressure measuring means 240 includes a water pressure gauge and the like. Further, the measured water pressure is transmitted to the survey calculation unit 235.

[水中位置算出手段230の説明]
水中位置算出手段230は、初期条件入力部231、設定部232、ROM233、RAM234、および測量計算部235を含んで構成される。
初期条件入力部231は、以下の計算処理に使用するパラメータの初期設定値を入力させる機能を有する。無線LANなどの技術を用いてハウジング200の外の端末装置310(図3参照)から入力することが可能である。
設定部232は、初期条件入力部231で入力されたパラメータの初期設定値をRAM234に設定する機能を有する。ここでは、設定部232は、端末装置310(図3参照)などから無線通信インタフェース311(図3参照)を介して、予め地上にいる間にパラメータを入力し、そのパラメータを設定部232によってRAM234に記録する。なお、パラメータの初期設定値をROM233の領域などに格納しておくことで、初期条件入力部231および設定部232を設けない構成とすることも可能である。
ROM233は、プログラムを格納しておく領域である。ROM233内の情報は必要に応じて、RAM234にロードされる。
RAM234は、測量計算部235において計算を行うために必要となる領域である。
測量計算部235は、復調部223から受け取った周波数の識別結果と音波強度と位置情報とを用いて、水中位置の算出を行う機能を有する。
[Description of Underwater Position Calculation Unit 230]
The underwater position calculation unit 230 includes an initial condition input unit 231, a setting unit 232, a ROM 233, a RAM 234, and a survey calculation unit 235.
The initial condition input unit 231 has a function of inputting initial setting values of parameters used in the following calculation processing. It is possible to input from a terminal device 310 (see FIG. 3) outside the housing 200 using a technique such as a wireless LAN.
The setting unit 232 has a function of setting the initial setting value of the parameter input by the initial condition input unit 231 in the RAM 234. Here, the setting unit 232 inputs parameters in advance while on the ground from the terminal device 310 (see FIG. 3) or the like via the wireless communication interface 311 (see FIG. 3), and the setting unit 232 inputs the parameters to the RAM 234. To record. It should be noted that the initial condition input unit 231 and the setting unit 232 may be omitted by storing the parameter initial setting values in the ROM 233 area or the like.
The ROM 233 is an area for storing a program. Information in the ROM 233 is loaded into the RAM 234 as necessary.
The RAM 234 is an area that is necessary for the calculation by the surveying calculation unit 235.
The survey calculation unit 235 has a function of calculating the underwater position using the frequency identification result, the sound wave intensity, and the position information received from the demodulation unit 223.

次に、図2を参照(適宜図1参照)して、測量計算部235における測量計算方法について説明する。図2は、本発明の第1実施形態に係る水中位置検出システムを構成する装置の位置関係を示す図である。
GPSブイ10aの位置(x1,y1,z1)とGPSブイ10bの位置(x2,y2,z2)とが復調部223によって既知となり、GPSブイ10aとGPSブイ10bとの距離r0は、次式(0)によって求められる。
Next, a survey calculation method in the survey calculation unit 235 will be described with reference to FIG. 2 (refer to FIG. 1 as appropriate). FIG. 2 is a diagram showing a positional relationship of devices constituting the underwater position detection system according to the first embodiment of the present invention.
Position of the GPS buoys 10a (x 1, y 1, z 1) and become known by the GPS position of the buoy 10b (x 2, y 2, z 2) and the demodulation unit 223, the distance between the GPS buoys 10a and GPS buoys 10b r 0 is obtained by the following equation (0).

Figure 2006275920
Figure 2006275920

また、図2に示すように、GPSブイ10aの位置(x1,y1,z1)と水中位置検出装置20の位置(X,Y,Z)との距離をr1、GPSブイ10bの位置(x2,y2,z2)と水中位置検出装置20の位置(X,Y,Z)との距離をr2とし、線分r0への水中位置検出装置20(X,Y,Z)からの垂線に対する、r1とのなす角度をθ1、r2とのなす角度をθ2とすると、幾何的に次式(1)および(2)が成り立つ。 In addition, as shown in FIG. 2, the distance between the position (x 1 , y 1 , z 1 ) of the GPS buoy 10a and the position (X, Y, Z) of the underwater position detection device 20 is r 1 , and the GPS buoy 10b position (x 2, y 2, z 2) and the position of the underwater position detecting device 20 (X, Y, Z) the distance between the r 2, underwater position detecting device to segment r 0 20 (X, Y, When the angle between r 1 and the perpendicular from Z) is θ 1 and the angle between r 2 is θ 2 , the following equations (1) and (2) are geometrically satisfied.

r0 = r1 * sinθ1+ r2 * sinθ2 …式(1)
r1 * cosθ1 = r2 * cosθ2 …式(2)
r 0 = r 1 * sinθ 1 + r 2 * sinθ 2 ... Formula (1)
r 1 * cosθ 1 = r 2 * cosθ 2 ... Formula (2)

また、r1, r2について、「水工研技報 漁船工学 2,1980 pp.11〜29 水中衝撃音の分析について、畠山、石井」の実験報告より、音源との距離が100m程度までは音波強度は距離に反比例し、100m以上では距離の2乗に反比例するとあるため、ここでは簡易測位として100m以下の距離を対象とし、次式(3)および(4)が成立する。 In addition, for r 1 and r 2 , the “Technical Report of Fisheries Engineering 2,1980 pp.11-29 About the analysis of underwater impact sound, Hiyama, Ishii”, the distance from the sound source is about 100m. Since the sound wave intensity is inversely proportional to the distance and is inversely proportional to the square of the distance when the distance is 100 m or more, the following expressions (3) and (4) are satisfied for a distance of 100 m or less as a simple positioning.

r1 = K1 * A1 / a1 …式(3)
r2 = K2 * A2 / a2 …式(4)
r 1 = K 1 * A 1 / a 1 ... Formula (3)
r 2 = K 2 * A 2 / a 2 ... Formula (4)

a1,a2はそれぞれGPSブイ10aおよびGPSブイ10bの各ブイ固有の周波数における水中位置検出装置20(X,Y,Z)での観測音波検出強度を表し、K1,K2,A1,A2はそれぞれ定数であり、100m以内の音波伝播では、次式(5)および(6)で示された値を用いて初期設定パラメータとする。 a 1 and a 2 represent the intensity of sound waves detected by the underwater position detection device 20 (X, Y, Z) at frequencies specific to each of the buoys of the GPS buoy 10a and the GPS buoy 10b, and K 1 , K 2 , A 1 , a 2 are each constant, the wave propagation within 100 m, and the default parameters using the values shown in the following formula (5) and (6).

K = K1 = K2 …式(5)
A = A1 = A2 …式(6)
K = K 1 = K 2 ... Formula (5)
A = A 1 = A 2 ... Formula (6)

本関係(5)および(6)により、GPSブイ10aまたはGPSブイ10bからの水中位置検出装置20との距離r1, r2は計算できる。
これにより、θ1は式(2)より、次式(7)が成立する。
From the relationships (5) and (6), the distances r 1 and r 2 from the underwater position detection device 20 from the GPS buoy 10a or the GPS buoy 10b can be calculated.
Thereby, the following formula (7) is established for θ 1 from formula (2).

θ1 = arccos((r2/r1) * cosθ2) …式(7) θ 1 = arccos ((r 2 / r 1 ) * cos θ 2 ) (7)

また、式(1)と式(2)より、次式(8)が成立する。   Moreover, following Formula (8) is materialized from Formula (1) and Formula (2).

0 = r0 - r1 * sin[ arccos ((r2/r1)*cosθ2) ] + r2 * sinθ2 …式(8) 0 = r 0 -r 1 * sin [arccos ((r 2 / r 1 ) * cosθ 2 )] + r 2 * sinθ 2 … (8)

式(8)から次の方法でθ2を求める。
arccosθ、cosθ、およびsinθについて、θが0から2πまでの間の計算結果を予め水中位置検出装置20のROM233に記録しておき、r0は予め式(0)の計算結果をRAM234に記録しておく。次に、水中位置検出装置20(X,Y,Z)の測量計算部235で、r1,r2は検出結果を元に式(3)と式(4)により計算し、θ2はROM233に記録してあるθの分解能で0から2πまで式(8)の右辺に代入しながら、値が予め設定した許容値Threshold以下となるθをθ2の候補とする。GPSブイが2つの場合は幾何的に対称となる解があるため、θ2の候補は2つ出るので、前回記録したθ2に近い方の解を新しいθ2として用いる。
また、r1,r2を計算する際に式(3)、式(4)に使用する定数 K * A は、次のように求める。
Θ 2 is obtained from equation (8) by the following method.
For arccos θ, cos θ, and sin θ, the calculation results between θ from 0 to 2π are recorded in advance in the ROM 233 of the underwater position detection device 20, and r 0 is recorded in advance in the RAM 234 as the calculation result of equation (0). Keep it. Next, in the survey calculation unit 235 of the underwater position detection device 20 (X, Y, Z), r 1 and r 2 are calculated by the equations (3) and (4) based on the detection results, and θ 2 is the ROM 233. Substituting into the right side of Equation (8) from 0 to 2π with the resolution of θ recorded in θ, θ that is equal to or smaller than the preset allowable value Threshold is set as a candidate for θ 2 . When there are two GPS buoys, there are two geometrically symmetric solutions, so two candidates for θ 2 appear. Therefore, the solution closest to θ 2 recorded last time is used as the new θ 2 .
Further, the constant K * A used in the equations (3) and (4) when calculating r 1 and r 2 is obtained as follows.

r0 = K * A / b …式(9) r 0 = K * A / b (9)

ここで、GPSブイ10aから固有の周波数の音波を発生し、GPSブイ10bで受信した際の音波強度の測定値をbとして用いることにする。そして、次式により定数K * Aを求め、式(3)と式(4)に代入して用いる。   Here, a sound wave having a specific frequency is generated from the GPS buoy 10a, and the measured value of the sound wave intensity when received by the GPS buoy 10b is used as b. Then, a constant K * A is obtained by the following equation, and is substituted into Equations (3) and (4) for use.

K * A = r0 * b …式(10) K * A = r 0 * b ... Formula (10)

以上によりr1,r22が求まり、次にθ1を式(7)から計算できる。
また、図2により、三角形の辺r0と辺r1とのなす角をα、辺r0と辺r2とのなす角をβとすると、次式(11)および(12)が成り立つ。
Thus, r 1 , r 2 , θ 2 can be obtained, and then θ 1 can be calculated from equation (7).
Further, according to FIG. 2, when the angle formed between the side r 0 and the side r 1 of the triangle is α and the angle formed between the side r 0 and the side r 2 is β, the following equations (11) and (12) are established.

α=π/2 -θ1 …式(11)
β=π/2 -θ2 …式(12)
α = π / 2 −θ 1 Formula (11)
β = π / 2 -θ 2 Formula (12)

従って、(x1,y1,z1)102,(x2,y2,z2)112,(θ12),α,βが求まるので、三角測量から水中位置検出装置20の位置(X,Y,Z)を求めることができる。(X,Y,Z)の計算例を次に示す。 Accordingly, (x 1 , y 1 , z 1 ) 102, (x 2 , y 2 , z 2 ) 112, (θ 1 + θ 2 ), α, β can be obtained. The position (X, Y, Z) can be determined. A calculation example of (X, Y, Z) is shown below.

図2に示した三角形の位置関係から、以下の式(13)〜(15)が成り立つ。   From the triangular positional relationship shown in FIG. 2, the following formulas (13) to (15) hold.

Figure 2006275920
Figure 2006275920

いま、GPSブイ10aとGPSブイ10bは水面付近に存在し、ほぼ高さ位置z1 = z2 = 0 とみなし、水圧測定手段240での気圧値をATM[atm]として、Z = ATM - 1として、Zについては既知とする。そして、式(14)より、次式(16)を得る。 Now, the GPS buoy 10a and the GPS buoy 10b exist in the vicinity of the water surface, and it is assumed that the height position z 1 = z 2 = 0, and the atmospheric pressure value at the water pressure measuring means 240 is ATM [atm], and Z = ATM −1 As for Z, it is assumed to be known. Then, the following equation (16) is obtained from the equation (14).

Figure 2006275920
Figure 2006275920

これを式(15)に代入すると、次式(17)となる。   Substituting this into equation (15) yields the following equation (17).

Figure 2006275920
Figure 2006275920

これはXについての2次方程式であり、式(18)〜式(20)を   This is a quadratic equation for X. Equations (18) to (20)

Figure 2006275920
とすると、式(17)は、次式(21)となる。
Figure 2006275920
Then, Expression (17) becomes the following Expression (21).

Figure 2006275920
Figure 2006275920

従って、この2次方程式を解いて次式(22)に示す解を得る。   Therefore, a solution shown in the following equation (22) is obtained by solving this quadratic equation.

Figure 2006275920
Figure 2006275920

プラスマイナスで2つの解が得られるが、前回計算結果のXの値に近い方を、新しいXとして用いる。
これを式(16)に代入して、水中位置検出装置20の現在地(X,Y,Z)が求まる。
Two solutions can be obtained with plus or minus, but the one closer to the X value of the previous calculation result is used as the new X.
By substituting this into equation (16), the current location (X, Y, Z) of the underwater position detection device 20 is obtained.

次に、図1に戻って、表示手段250の構成について説明する。
[表示手段250の説明]
図1に示すように、表示手段250は、電子コンパス251、表示部252、倍率計算部253、水中地図254、および内部時計255から構成される。
電子コンパス251は、方位を測定するために備えられている。電子コンパス251によって測定された方位は、倍率計算部253に出力される。
水中地図254には、ポイントに特化して予め熟練ダイバーによって作成された、緯度、経度および深度情報を有する電子地図が利用される。また、水中地図254には、場所による海流の流れに関する情報も含めて記述され、緯度、経度、深度、流れの方位、流れの強さおよび時刻などの組合せで電子データ化されており、倍率計算部253に出力される。また、地図の内容としては、地形の深度・スケール・危険箇所および魚などの見ものとダイビングルートの情報なども記載可能である。なお、本データは、ダイビングポイントにより、情報が収集可能である。また、本発明において「海流」とは、海の干満によっておこる海水の流れである「潮流」も含むものとする。
内部時計255は、ダイバーの利用時刻により、海流の方向や大きさなどを表示するためなどに使用される。ここでは、内部時計255は、時刻を倍率計算部253に出力し、倍率計算部253は、受け取った時刻に合った水中地図254を読み込む構成にするのが好ましい。
倍率計算部253は、可変のパラメータLを用いて、任意の位置(x,y)を次式(23)〜(24)により変換して、任意の表示座標点(x’,y’)を算出するものである。
Next, returning to FIG. 1, the configuration of the display means 250 will be described.
[Description of Display Means 250]
As shown in FIG. 1, the display unit 250 includes an electronic compass 251, a display unit 252, a magnification calculator 253, an underwater map 254, and an internal clock 255.
An electronic compass 251 is provided for measuring the orientation. The orientation measured by the electronic compass 251 is output to the magnification calculator 253.
For the underwater map 254, an electronic map having latitude, longitude, and depth information, which is created in advance by an expert diver specializing in points, is used. In addition, the underwater map 254 is described including information on the flow of the ocean current depending on the location, and is converted into electronic data using a combination of latitude, longitude, depth, flow direction, flow strength, time, and the like. Is output to the unit 253. In addition, as the contents of the map, it is possible to describe the depth of the terrain, the scale, the dangerous spots, fish and other information, and information on the diving route. This data can be collected by diving points. Further, in the present invention, “sea current” includes “tidal current” which is a flow of seawater caused by tidal seas.
The internal clock 255 is used to display the direction and size of the ocean current according to the diver's use time. Here, it is preferable that the internal clock 255 outputs the time to the magnification calculator 253, and the magnification calculator 253 reads the underwater map 254 that matches the received time.
The magnification calculator 253 converts an arbitrary position (x, y) by the following equations (23) to (24) using a variable parameter L, and converts an arbitrary display coordinate point (x ′, y ′). Is to be calculated.

x’ = L * x …式(23)
y’ = L * y …式(24)
x ′ = L * x Expression (23)
y '= L * y ... Formula (24)

次に、図3を参照(適宜図1参照)して、水中位置検出装置20のインタフェースについて説明する。図3は、本発明の第1実施形態に係る水中位置検出装置の模式図である。
図3の水中位置検出装置20には、ハウジング200、水中地図254、表示部252、表示倍率ボタン303、初期条件入力部231、音波取得手段210、現在地306、流れの方向307、端末装置310、および無線通信インタフェース311が示されている。
表示部252上には、水中位置検出装置20の現在地306が示されている。現在地306を示すことによって、ダイバーは水中における自分の位置を把握することができる。
また、流れの方向307は、季節や時刻によって変化するので、初心者がダイビングなどを行った場合、流れの方向307が分からなくなる状況に陥りやすい。流れの方向307は、内部時計255の利用時刻に合わせて、海流の方向と強さを表示できるので、初心者は、安全なダイビングを行うことが可能となる。
更に、ナビゲートの補助として、画面に電子コンパス251のデータによる方位表示、内部時計255による時刻表示が可能である。
Next, the interface of the underwater position detection device 20 will be described with reference to FIG. FIG. 3 is a schematic diagram of the underwater position detection device according to the first embodiment of the present invention.
3 includes a housing 200, an underwater map 254, a display unit 252, a display magnification button 303, an initial condition input unit 231, a sound wave acquisition unit 210, a current location 306, a flow direction 307, a terminal device 310, And a wireless communication interface 311 is shown.
On the display unit 252, the current location 306 of the underwater position detection device 20 is shown. By indicating the current location 306, the diver can grasp his / her position in the water.
In addition, since the flow direction 307 changes depending on the season and time, when a beginner performs diving or the like, the flow direction 307 is easily lost. Since the flow direction 307 can display the direction and strength of the ocean current according to the use time of the internal clock 255, a beginner can perform safe diving.
Further, as a navigation aid, a azimuth display based on the data of the electronic compass 251 and a time display using the internal clock 255 are possible on the screen.

表示するコントローラを持った液晶パネルなどの表示部252と倍率計算部253とを一体化して、透明なプラスチックなどのハウジング200により防水性を持たせる。防水性はゴムパッキンなどで実現可能であり、倍率設定ボタン301などの操作ボタンの外部との機械的インタフェースはゴムのシーリングで実現可能である。   A display unit 252 such as a liquid crystal panel having a controller for display and a magnification calculation unit 253 are integrated to provide waterproofness by a housing 200 made of transparent plastic or the like. The waterproof property can be realized by rubber packing or the like, and the mechanical interface with the outside of the operation buttons such as the magnification setting button 301 can be realized by rubber sealing.

電子コンパス251を内蔵し、水中地図254の北方向γmを電子コンパス251の北方向γnに合わせるために、描画点を   An electronic compass 251 is incorporated, and in order to match the north direction γm of the underwater map 254 with the north direction γn of the electronic compass 251, the drawing point is

γ = (γn −γm) …式(25)
とおいて、表示倍率ボタン303で設定された表示座標(x’,y’)を回転行列により、現在地306(x”,y”)へ変換して表示する。
γ = (γn−γm) Equation (25)
The display coordinates (x ′, y ′) set by the display magnification button 303 are converted into the current location 306 (x ″, y ″) by the rotation matrix and displayed.

x” = x’* cosγ− y’* sinγ …式(26)
y” = x’* sinγ + y’* cosγ …式(27)
x ”= x ′ * cos γ−y ′ * sin γ Equation (26)
y ”= x ′ * sinγ + y ′ * cosγ Equation (27)

また、水中地図254と現在地306の3次元座標を元に、3次元座標変換行列を用いて、容易に3次元表示方向を変更する機能を拡張することも可能である。   In addition, it is possible to extend the function of easily changing the three-dimensional display direction based on the three-dimensional coordinates of the underwater map 254 and the current location 306 using a three-dimensional coordinate transformation matrix.

次に、図4を参照(適宜図1参照)して、ダイビングルートの記録方法について説明する。図4は、本発明の第1実施形態に係るダイビングルートの記録方法を示す模式図であり、(a)は履歴経路、(b)は現在経路を示す。   Next, referring to FIG. 4 (refer to FIG. 1 as appropriate), a method for recording a diving route will be described. 4A and 4B are schematic diagrams showing a dive route recording method according to the first embodiment of the present invention, where FIG. 4A shows a history route and FIG. 4B shows a current route.

図4(a)に示すように、ダイビングのインストラクターやダイブマスターなどの上級者である利用者Aが、予め安全な経路を散策する。利用者Aの第1の履歴経路501および第2の履歴経路502などがRAM234などの記憶手段に一連の位置データとして記録される。
図4(b)に示すように、利用者Bは、現在経路511を通って散策を行っている。初期設定により、利用者Aによる第1の履歴経路501または第2の履歴経路502を選択すると、第1の履歴経路501または第2の履歴経路502などから割り出した安全なエリアの中にいる間は、安全とみなされる。
As shown in FIG. 4A, a user A who is an advanced person such as a diving instructor or a dive master walks in advance on a safe route. The first history path 501 and the second history path 502 of the user A are recorded in a storage unit such as the RAM 234 as a series of position data.
As shown in FIG. 4B, the user B is taking a walk through the current route 511. When the first history route 501 or the second history route 502 by the user A is selected by the initial setting, the user A is in a safe area determined from the first history route 501 or the second history route 502 or the like. Is considered safe.

次に、図5を参照(適宜図1参照)して、ダイバーが安全とみなされるエリアについて説明する。図5は、本発明の第1実施形態に係るダイバーが安全とみなされるエリアを示す図である。
ここで、第1の履歴経路501または第2の履歴経路502などの記録位置データを(XX,YY,ZZ)とし、予め設定する許容クリアランスをパラメータ(Tx,Ty,Tz)とする。
図5は、第1の履歴経路501の記録位置データを(XX,YY,ZZ)とした場合の利用者Bが安全とみなされるエリアを図示したものである。ここでは、後記する式(28)〜(30)を満たすx,y,zが許容範囲601として示されている。図5において、例えば、利用者Bが許容範囲601で示された範囲外にいる場合は、利用者Bは危険とみなされ、警告時の処理などが行われる。
Next, referring to FIG. 5 (refer to FIG. 1 as appropriate), an area where a diver is regarded as safe will be described. FIG. 5 is a diagram illustrating an area in which a diver according to the first embodiment of the present invention is regarded as safe.
Here, it is assumed that the recording position data of the first history path 501 or the second history path 502 is (XX, YY, ZZ), and a preset allowable clearance is a parameter (Tx, Ty, Tz).
FIG. 5 illustrates an area in which user B is considered safe when the recording position data of the first history path 501 is (XX, YY, ZZ). Here, x, y, z satisfying equations (28) to (30) described later are shown as the allowable range 601. In FIG. 5, for example, when the user B is outside the range indicated by the allowable range 601, the user B is regarded as dangerous, and processing at the time of warning or the like is performed.

次に、図6を参照(適宜図1参照)して、水中位置検出装置20の利用方法について説明する。図6は、本発明の第1実施形態に係る水中位置検出装置の利用方法を表すフローチャートである。   Next, a method of using the underwater position detection device 20 will be described with reference to FIG. 6 (refer to FIG. 1 as appropriate). FIG. 6 is a flowchart showing a method of using the underwater position detection device according to the first embodiment of the present invention.

まず、水中位置検出装置20は、電源をONにされる(S101)。続いて、水中位置検出装置20は、水中位置検出処理すなわち、定期的に自己の位置を算出する処理を開始する(S102)。   First, the underwater position detection device 20 is turned on (S101). Subsequently, the underwater position detection device 20 starts an underwater position detection process, that is, a process of periodically calculating its own position (S102).

続いてダイバーは、ダイビング経路をRAM234に記録するかどうかを選択する(S103)。記録する場合(S103でYesの場合)、ダイビングルート記録処理を行い、ダイビングルートにS102で算出した自己の位置を記録する(S104)。S104のダイビングルート記録処理は、記録を終了すると選択されるまで、繰り返し行われる(S105)。記録を終了すると選択された場合(S105でYesの場合)、S113の終了判定に進む。   Subsequently, the diver selects whether to record the diving route in the RAM 234 (S103). In the case of recording (Yes in S103), the diving route recording process is performed, and the self position calculated in S102 is recorded in the diving route (S104). The diving route recording process in S104 is repeatedly performed until it is selected to end the recording (S105). If it is selected to end the recording (Yes in S105), the process proceeds to S113.

S103で、記録しないと選択された場合(S103でNoの場合)、履歴ルートデータ読込み処理を行い、S104で記録した履歴経路を読込む(S107)。続けて、式(28)〜(30)を満たすかどうかを判定する処理を行い、利用者が安全なエリアにいるかどうかを判定する処理を行う(S108)。S108の判定処理に関する詳しい説明は後記する。安全なエリアにいると判定された場合(S109でYesの場合)、S113の終了判定に進む。安全なエリアにいないと判定された場合(S109でNoの場合)、S106で読み込んだ履歴経路を継続して読み込む(S110)。履歴ルートデータが終了した場合(S111でYesの場合)、警告処理を行い(S111)、S112の終了判定に進む。S111の警告処理に関する詳しい説明は後記する。履歴ルートデータの継続読込みが行われた場合(S110でNoの場合)、S107の判定計算処理に戻る。   If it is selected not to record in S103 (No in S103), history route data reading processing is performed, and the history route recorded in S104 is read (S107). Subsequently, a process for determining whether the expressions (28) to (30) are satisfied is performed, and a process for determining whether the user is in a safe area is performed (S108). Detailed description regarding the determination processing in S108 will be described later. When it is determined that the user is in a safe area (Yes in S109), the process proceeds to S113. If it is determined that it is not in the safe area (No in S109), the history route read in S106 is continuously read (S110). When the history route data is completed (Yes in S111), a warning process is performed (S111), and the process proceeds to S112. Detailed explanation regarding the warning processing in S111 will be described later. When the history route data is continuously read (No in S110), the process returns to the determination calculation process in S107.

S112の終了判定においては、終了するかどうかの選択を行い、終了する選択がされた場合(S112でYesの場合)は、終了処理を行う。終了しない選択がされた場合(S112でNoの場合)は、S103の記録を開始するかどうかの判定処理に戻る。   In the end determination of S112, whether or not to end is selected, and when the end is selected (Yes in S112), the end process is performed. If the selection is made not to end (No in S112), the process returns to the determination process of whether to start recording in S103.

[S107の判定計算の説明]
S107では、測量計算部235で位置の計算と並行して次の処理を行う。
利用者Bの現在地を(x,y,z)とした場合、利用者Aによる第1の履歴経路501および第2の履歴経路502などについてのデータを読み込み、次式(28)〜(30)に示す判定を行う。
XX - Tx < x < XX + Tx …式(28)
YY - Ty < y < YY + Ty …式(29)
ZZ - Tz < z < ZZ + Tz …式(30)
[Description of determination calculation in S107]
In S107, the survey calculation unit 235 performs the following process in parallel with the position calculation.
When the current location of the user B is (x, y, z), data about the first history route 501 and the second history route 502 by the user A is read, and the following equations (28) to (30) Make the determination shown in.
XX-Tx <x <XX + Tx ... Formula (28)
YY-Ty <y <YY + Ty (29)
ZZ-Tz <z <ZZ + Tz ... Formula (30)

利用者Bの現在地が、全履歴データ(XX,YY,ZZ)において、式(28)〜(30)の全ての判定式を、同時に満たす(x,y,z)が一つも存在しなかったときは警告とする。このとき、式(28)〜(30)の全ての判定式を、同時に満たす(x,y,z)が1つでも存在したときは、利用者は安全なエリアにいるとみなされる。履歴ルートデータの続きを読込み、判定処理を行う処理を繰り返す。こうすることにより、測量計算部235の処理負荷を軽減し、また、利用者が潜水開始ポイントをずらす場合、または逆ルートを辿る場合についても履歴データを有効に利用することが可能となる。   There was no (x, y, z) that the present location of user B satisfies all the judgment formulas (28) to (30) at the same time in all history data (XX, YY, ZZ). When it is a warning. At this time, if at least one (x, y, z) satisfying all the judgment formulas (28) to (30) exists at the same time, the user is considered to be in a safe area. The continuation of the history route data is read and the process of performing the determination process is repeated. By doing so, it is possible to reduce the processing load of the surveying calculation unit 235 and to effectively use the history data even when the user shifts the dive start point or follows the reverse route.

[S111の警告処理の説明]
警告処理S111は、水中位置検出装置20内にブザーを持たせ警告音を鳴らすか、または表示部252に文字などで警告表示をすることで実現できる。
[Description of warning processing in S111]
The warning process S111 can be realized by holding a buzzer in the underwater position detection device 20 to sound a warning sound, or displaying a warning on the display unit 252 with characters or the like.

水中位置検出装置20に、救命の目的で予め定めた特定の周波数Fで、水中位置(x,y,z)の情報を位相変調して発信し、位相復調音波受信機で受信中の他の水中移動体または船で救命位置を検出することも可能である。   Information on the underwater position (x, y, z) is phase-modulated and transmitted to the underwater position detection device 20 at a specific frequency F predetermined for lifesaving purposes, and received by the phase-demodulated sound wave receiver. It is also possible to detect a lifesaving position with an underwater vehicle or a ship.

この第1実施形態によれば、表示倍率ボタン303の操作によって指定された倍率に基づいて、水中地図254を表示部に出力することが可能となる。また、内部時計255と連動させれば、ダイバーの利用時刻に合った海流方向や海流の大きさなどの情報も出力することが可能となるので、ダイバーは安全に水中を散策することができる。   According to the first embodiment, the underwater map 254 can be output to the display unit based on the magnification specified by the operation of the display magnification button 303. Further, when linked with the internal clock 255, it is possible to output information such as the direction of the ocean current and the size of the ocean current according to the diver's use time, so that the diver can safely walk in the water.

(第2実施形態)
次に、図7を参照(適宜図1参照)して、第2実施形態を説明する。この第2実施形態は、水中位置検出装置20のインタフェースに関するものである。したがって、それ以外の第1実施形態と共通する部分については、同じ符号を付し、説明を省略する。図7は、本発明の第2実施形態に係る水中位置検出装置の模式図である。
ハウジング200には水中地図セル401を固定できるようなガイド403をつけ、水中地図セル401を固定する。
ハウジング200に設定する水中地図セル401として透明なプラスチックシートを用意し、マジックで予め簡易地図を描き、確認できる魚などの情報も書き加えたシートを作り、ガイド403に入れて固定する。現在地306の表示倍率パラメータLは、既知のポイント水面下で、表示倍率ボタン303の操作により水中地図セル401と比較しながら手動で調整する。これにより、水中地図セル401が透けて見えるため、表示部252に表示された現在地306の倍率を任意に調整可能とする。
このとき、描く地図の方向は方向マーキング402を明確にして予め定めておき、水中位置確認時にはダイビング機材のゲージの方位磁針と水中地図セル401の方向を一致させて使用する。
(Second Embodiment)
Next, a second embodiment will be described with reference to FIG. 7 (refer to FIG. 1 as appropriate). The second embodiment relates to an interface of the underwater position detection device 20. Accordingly, the same parts as those in the first embodiment are denoted by the same reference numerals and description thereof is omitted. FIG. 7 is a schematic diagram of an underwater position detection device according to the second embodiment of the present invention.
A guide 403 that can fix the underwater map cell 401 is attached to the housing 200, and the underwater map cell 401 is fixed.
A transparent plastic sheet is prepared as the underwater map cell 401 to be set in the housing 200, a simple map is drawn in advance with magic, a sheet on which information such as fish that can be confirmed is added, and the sheet is placed in a guide 403 and fixed. The display magnification parameter L of the current location 306 is manually adjusted while comparing with the underwater map cell 401 by operating the display magnification button 303 under the known point water surface. Thereby, since the underwater map cell 401 can be seen through, the magnification of the current location 306 displayed on the display unit 252 can be arbitrarily adjusted.
At this time, the direction of the drawn map is determined in advance by clarifying the direction marking 402, and when checking the underwater position, the direction magnetic needle of the diving equipment gauge and the direction of the underwater map cell 401 are used.

この第2実施形態によれば、表示倍率ボタン303の操作によって指定された倍率に基づいて、現在地306の倍率を調整し、水中地図セル401の方向を方位磁針の方向と一致させることで、ダイバーは、水中地図254のデータの代わりに簡易地図を利用して、表示部252に出力された自分の位置を把握しながら、散策することができる。   According to the second embodiment, the diver is adjusted by adjusting the magnification of the current location 306 based on the magnification designated by the operation of the display magnification button 303 and matching the direction of the underwater map cell 401 with the direction of the compass. Can take a walk while grasping his / her position output on the display unit 252 by using a simple map instead of the data of the underwater map 254.

本発明の第1実施形態に係る水中位置検出システムのブロック図である。1 is a block diagram of an underwater position detection system according to a first embodiment of the present invention. 本発明の第1実施形態に係る水中位置検出システムを構成する装置の位置関係を示す図である。It is a figure which shows the positional relationship of the apparatus which comprises the underwater position detection system which concerns on 1st Embodiment of this invention. 本発明の第1実施形態に係る水中位置検出装置の模式図である。1 is a schematic diagram of an underwater position detection device according to a first embodiment of the present invention. 本発明の第1実施形態に係るダイビングルートの記録方法を示す模式図であり、(a)は履歴経路、(b)は現在経路を示す。It is a schematic diagram which shows the recording method of the diving route which concerns on 1st Embodiment of this invention, (a) shows a log | history route, (b) shows a present route. 本発明の第1実施形態に係るダイバーが安全とみなされるエリアを示す図である。It is a figure which shows the area where the diver which concerns on 1st Embodiment of this invention is considered safe. 本発明の第1実施形態に係る水中位置検出装置の利用方法を表すフローチャートである。It is a flowchart showing the utilization method of the underwater position detection apparatus which concerns on 1st Embodiment of this invention. 本発明の第2実施形態に係る水中位置検出装置の模式図である。It is a schematic diagram of the underwater position detection apparatus which concerns on 2nd Embodiment of this invention.

符号の説明Explanation of symbols

1 水中位置検出システム
2 GPS衛星
10(10a,10b) GPSブイ
20 水中位置検出装置
101(101a,101b) 測位情報取得手段
102(102a,102b) 自位置算出手段
103(103a,102b) 音源
200 ハウジング
210 音波取得手段
220 位置・距離取得手段
221 周波数判定部
222 音波強度検出部
223 復調部
230 水中位置算出手段
231 初期条件入力部
232 設定部
233 ROM
234 RAM
235 測量計算部
240 水圧測定手段
250 表示手段
251 電子コンパス
252 表示部
253 倍率計算部
254 水中地図
255 内部時計
DESCRIPTION OF SYMBOLS 1 Underwater position detection system 2 GPS satellite 10 (10a, 10b) GPS buoy 20 Underwater position detection apparatus 101 (101a, 101b) Positioning information acquisition means 102 (102a, 102b) Own position calculation means 103 (103a, 102b) Sound source 200 Housing 210 Sound wave acquisition unit 220 Position / distance acquisition unit 221 Frequency determination unit 222 Sound wave intensity detection unit 223 Demodulation unit 230 Underwater position calculation unit 231 Initial condition input unit 232 Setting unit 233 ROM
234 RAM
235 Survey calculation unit 240 Water pressure measurement unit 250 Display unit 251 Electronic compass 252 Display unit 253 Magnification calculation unit 254 Underwater map 255 Internal clock

Claims (14)

音源を備え、水中に向けて照射する音波により自己の位置を知らせる複数の音源装置と、水中に位置し、前記複数の音源装置からの音波を取得することで水中での自己の位置を検出する水中位置検出装置とを含んで構成される水中位置検出システムであって、
前記音源装置は、
水面上に設置され、外部の測位手段からの測位情報を取得する測位情報取得手段と、
前記取得した測位情報に基づいて測位処理を行うことで、自己の位置を算出する自位置算出手段と、
前記算出した自己の位置を重畳して所定強度の音波として水中に照射する音源と
を備え、
前記水中位置検出装置は、
前記照射された音波を水中で取得する音波取得手段と、
前記取得した音波からこれに重畳された音源装置の位置を得る処理と、前記音波の強度に基づいて前記音源装置までの距離を得る処理とを行うことで、前記複数の音源装置の位置および前記複数の音源装置までの距離を取得する位置・距離取得手段と、
前記取得した前記複数の音源装置の位置および前記複数の音源装置までの距離に基づいて所定の測位処理を行うことで、水中での自己の位置を算出する水中位置算出手段と
を備えたことを特徴とする水中位置検出システム。
A plurality of sound source devices including a sound source and informing the position of the self by sound waves irradiated toward the water, and detecting the position of the self in the water by acquiring sound waves from the plurality of sound source devices located in the water An underwater position detection system including an underwater position detection device,
The sound source device is
Positioning information acquisition means installed on the surface of the water to acquire positioning information from an external positioning means;
By performing a positioning process based on the obtained positioning information, own position calculating means for calculating the own position;
A sound source that superimposes the calculated self position and irradiates the sound as a sound wave of a predetermined intensity,
The underwater position detection device includes:
Sound wave acquisition means for acquiring the irradiated sound wave in water;
By performing the process of obtaining the position of the sound source device superimposed on the acquired sound wave and the process of obtaining the distance to the sound source device based on the intensity of the sound wave, the positions of the plurality of sound source devices and the Position / distance acquisition means for acquiring distances to a plurality of sound source devices;
Underwater position calculation means for calculating a position in water by performing a predetermined positioning process based on the acquired positions of the plurality of sound source devices and distances to the plurality of sound source devices. Features an underwater position detection system.
請求項1において、前記水中位置検出装置は、
水圧を測定する水圧測定手段をさらに備え、
前記水中位置算出手段は、前記複数の音源装置のうちふたつの音源装置の位置、前記ふたつの音源装置までの距離、および前記水圧測定手段によって測定された水圧に基づいて所定の測位処理を行うこと
を特徴とする水中位置検出システム。
The underwater position detection device according to claim 1,
A water pressure measuring means for measuring the water pressure;
The underwater position calculating means performs a predetermined positioning process based on the positions of two sound source devices of the plurality of sound source devices, the distance to the two sound source devices, and the water pressure measured by the water pressure measuring means. Underwater position detection system.
請求項1または請求項2において、前記音源装置のうち、すくなくともひとつをブイとしたことを特徴とする水中位置検出システム。   The underwater position detection system according to claim 1 or 2, wherein at least one of the sound source devices is a buoy. 請求項1または請求項2において、前記音源装置のうち、すくなくともひとつをGPS搭載の船としたことを特徴とする水中位置検出システム。   The underwater position detection system according to claim 1 or 2, wherein at least one of the sound source devices is a ship equipped with a GPS. 請求項1または請求項2において、前記水中位置検出装置は、表示手段、水中地図、および電子コンパスを備え、
前記表示手段に水中地図および方位を表示させることを特徴とする水中位置検出システム。
In Claim 1 or Claim 2, the said underwater position detection device is provided with a display means, an underwater map, and an electronic compass,
An underwater position detection system that displays an underwater map and direction on the display means.
請求項1または請求項2において、前記水中位置検出装置は、表示手段および電子コンパスを備え、
前記表示手段に手書きの水中地図を取り付け、取り付けた地図上に方位を表示させることを特徴とする水中位置検出システム。
In Claim 1 or Claim 2, the said underwater position detection device is provided with a display means and an electronic compass,
An underwater position detection system, wherein a handwritten underwater map is attached to the display means, and an orientation is displayed on the attached map.
請求項1または請求項2において、前記水中位置検出装置は、表示手段、水中の海流方向が記された水中地図、および電子コンパスを備え、
前記表示手段に水中地図、水中の海流方向、および方位を表示させることを特徴とする水中位置検出システム。
The underwater position detection device according to claim 1 or 2, further comprising display means, an underwater map in which an underwater current direction is written, and an electronic compass.
An underwater position detection system that displays an underwater map, an underwater current direction, and a direction on the display means.
請求項1または請求項2において、前記水中位置検出装置は、水中移動体の過去の移動履歴をガイドルートとして、許容移動ルート逸脱を判定し、逸脱時に警告処理を行う水中位置検出システム。   3. The underwater position detection system according to claim 1 or 2, wherein the underwater position detection device determines a deviation from an allowable movement route by using a past movement history of the underwater moving body as a guide route, and performs a warning process at the time of departure. 請求項1または請求項2において、前記水中位置検出装置は、救命の目的で設定された周波数帯の音波によって、当該装置の位置情報を送信可能とした水中位置検出システム。   3. The underwater position detection system according to claim 1 or 2, wherein the underwater position detection device is capable of transmitting position information of the device using sound waves in a frequency band set for lifesaving purposes. 音源を備え、水中に向けて照射する音波により自己の位置を知らせる音源装置であって、
水面上に設置され、外部の測位手段からの測位情報を取得する測位情報取得手段と、
前記取得した測位情報に基づいて測位処理を行うことで、自己の位置を算出する自位置算出手段と、
前記算出した自己の位置を重畳して所定強度の音波として水中に照射する音源と
を備えること
を特徴とする音源装置。
A sound source device equipped with a sound source and informing the position of itself by sound waves irradiated toward the water,
Positioning information acquisition means installed on the surface of the water to acquire positioning information from an external positioning means;
By performing a positioning process based on the obtained positioning information, own position calculating means for calculating the own position;
A sound source device comprising: a sound source that superimposes the calculated self position and irradiates the sound as a sound wave having a predetermined intensity.
水中に位置し、複数の音源装置からの音波を取得することで水中での自己の位置を検出する水中位置検出装置であって、
前記水中位置検出装置は、
前記照射された音波を水中で取得する音波取得手段と、
前記取得した音波からこれに重畳された音源装置の位置を得る処理と、前記音波の強度に基づいて前記音源装置までの距離を得る処理とを行うことで、前記複数の音源装置の位置および前記複数の音源装置までの距離を取得する位置・距離取得手段と、
前記取得した前記複数の音源装置の位置および前記複数の音源装置までの距離に基づいて所定の測位処理を行うことで、水中での自己の位置を算出する水中位置算出手段と
を備えたことを特徴とする水中位置検出装置。
An underwater position detection device that is located in water and detects its own position in water by acquiring sound waves from a plurality of sound source devices,
The underwater position detection device includes:
Sound wave acquisition means for acquiring the irradiated sound wave in water;
By performing the process of obtaining the position of the sound source device superimposed on the acquired sound wave and the process of obtaining the distance to the sound source device based on the intensity of the sound wave, the positions of the plurality of sound source devices and the Position / distance acquisition means for acquiring distances to a plurality of sound source devices;
Underwater position calculation means for calculating a position in water by performing a predetermined positioning process based on the acquired positions of the plurality of sound source devices and distances to the plurality of sound source devices. An underwater position detection device.
水中に位置し、ふたつの音源装置からの音波を取得することで水中での自己の位置を検出する水中位置検出装置であって、
前記水中位置検出装置は、
前記照射された音波を水中で取得する音波取得手段と、
前記取得した音波からこれに重畳された音源装置の位置を得る処理と、前記音波の強度に基づいて前記音源装置までの距離を得る処理とを行うことで、前記ふたつの音源装置の位置および前記ふたつの音源装置までの距離を取得する位置・距離取得手段と、
水圧を測定する水圧測定手段と、
前記取得した前記ふたつの音源装置の位置、前記ふたつの音源装置までの距離、および前記水圧に基づいて所定の測位処理を行うことで、水中での自己の位置を算出する水中位置算出手段と
を備えたことを特徴とする水中位置検出装置。
An underwater position detection device that is located in water and detects its own position in water by acquiring sound waves from two sound source devices,
The underwater position detection device includes:
Sound wave acquisition means for acquiring the irradiated sound wave in water;
By performing the process of obtaining the position of the sound source device superimposed on the acquired sound wave and the process of obtaining the distance to the sound source device based on the intensity of the sound wave, the positions of the two sound source devices and the Position / distance acquisition means for acquiring the distance to the two sound source devices;
Water pressure measuring means for measuring water pressure;
Underwater position calculation means for calculating the position of the device in water by performing a predetermined positioning process based on the acquired positions of the two sound source devices, the distance to the two sound source devices, and the water pressure. An underwater position detection device comprising:
複数の音源装置からの音波を取得することで、水中の装置の位置を検出する水中位置検出方法であって、
前記水中位置検出方法は、
音波取得手段が、前記照射された音波を水中で取得する第1ステップと、
位置・距離取得手段が、前記取得した音波からこれに重畳された音源装置の位置を得る処理と、前記音波の強度に基づいて前記音源装置までの距離を得る処理とを行うことで、前記複数の音源装置の位置および前記複数の音源装置までの距離を取得する第2ステップと、
水中位置算出手段が、前記取得した前記複数の音源装置の位置および前記複数の音源装置までの距離に基づいて所定の測位処理を行うことで、水中での装置の位置を算出する第3ステップと
を含むことを特徴とする水中位置検出方法。
An underwater position detection method for detecting the position of an underwater device by acquiring sound waves from a plurality of sound source devices,
The underwater position detection method includes:
A first step in which sound wave acquisition means acquires the irradiated sound wave in water;
The position / distance acquisition means performs the process of obtaining the position of the sound source device superimposed on the acquired sound wave and the process of obtaining the distance to the sound source device based on the intensity of the sound wave. A second step of acquiring a position of the sound source device and a distance to the plurality of sound source devices;
A third step in which the underwater position calculating means calculates a position of the device in water by performing a predetermined positioning process based on the acquired positions of the plurality of sound source devices and the distances to the plurality of sound source devices; The underwater position detection method characterized by including.
ふたつの音源装置からの音波を取得することで、水中の装置の位置を検出する水中位置検出方法であって、
前記水中位置検出方法は、
音波取得手段が、前記照射された音波を水中で取得する第1ステップと、
位置・距離取得手段が、前記取得した音波からこれに重畳された音源装置の位置を得る処理と、前記音波の強度に基づいて前記音源装置までの距離を得る処理とを行うことで、前記ふたつの音源装置の位置および前記ふたつの音源装置までの距離を取得する第2ステップと、
水圧測定手段が、水圧を測定する第3ステップと、
水中位置算出手段が、前記取得した前記ふたつの音源装置の位置、前記ふたつの音源装置までの距離、および前記水圧に基づいて所定の測位処理を行うことで、水中での装置の位置を算出する第4ステップと
を備えたことを特徴とする水中位置検出方法。
An underwater position detection method for detecting the position of an underwater device by acquiring sound waves from two sound source devices,
The underwater position detection method includes:
A first step in which sound wave acquisition means acquires the irradiated sound wave in water;
The position / distance acquisition means performs the process of obtaining the position of the sound source device superimposed on the acquired sound wave and the process of obtaining the distance to the sound source device based on the intensity of the sound wave. A second step of obtaining a position of the sound source device and a distance to the two sound source devices;
A third step in which the water pressure measuring means measures the water pressure;
Underwater position calculation means calculates the position of the device in water by performing a predetermined positioning process based on the acquired positions of the two sound source devices, the distance to the two sound source devices, and the water pressure. An underwater position detection method comprising: a fourth step.
JP2005098500A 2005-03-30 2005-03-30 Underwater position detection system, sound source device, underwater position detection device and underwater position detection method Pending JP2006275920A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2005098500A JP2006275920A (en) 2005-03-30 2005-03-30 Underwater position detection system, sound source device, underwater position detection device and underwater position detection method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2005098500A JP2006275920A (en) 2005-03-30 2005-03-30 Underwater position detection system, sound source device, underwater position detection device and underwater position detection method

Publications (1)

Publication Number Publication Date
JP2006275920A true JP2006275920A (en) 2006-10-12

Family

ID=37210832

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2005098500A Pending JP2006275920A (en) 2005-03-30 2005-03-30 Underwater position detection system, sound source device, underwater position detection device and underwater position detection method

Country Status (1)

Country Link
JP (1) JP2006275920A (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011245887A (en) * 2010-05-21 2011-12-08 Honmagumi:Kk Diver position control system
JP2012194443A (en) * 2011-03-17 2012-10-11 Yamaha Corp Positional information system, portable terminal device and program
CN107479029A (en) * 2017-08-10 2017-12-15 中国计量大学 Umbrella-type underwater sound source detection means and its calibration and detection method
JP2018008537A (en) * 2016-07-11 2018-01-18 株式会社Ihi Sailing guide device and method
JP2019527364A (en) * 2016-06-09 2019-09-26 サブマリン・オープン・テクノロジーズ Apparatus and method for positioning underwater device

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011245887A (en) * 2010-05-21 2011-12-08 Honmagumi:Kk Diver position control system
JP2012194443A (en) * 2011-03-17 2012-10-11 Yamaha Corp Positional information system, portable terminal device and program
JP2019527364A (en) * 2016-06-09 2019-09-26 サブマリン・オープン・テクノロジーズ Apparatus and method for positioning underwater device
JP2018008537A (en) * 2016-07-11 2018-01-18 株式会社Ihi Sailing guide device and method
CN107479029A (en) * 2017-08-10 2017-12-15 中国计量大学 Umbrella-type underwater sound source detection means and its calibration and detection method

Similar Documents

Publication Publication Date Title
US9223002B2 (en) System and method for determining the position of an underwater vehicle
US8195395B2 (en) System for monitoring, determining, and reporting directional spectra of ocean surface waves in near real-time from a moored buoy
EP3058388B1 (en) Underwater tracking system
US10597128B2 (en) Diver navigation, information and safety buoy
RU2563332C2 (en) Navigation method for autonomous unmanned underwater vehicle
KR100972024B1 (en) A Position Search Apparatus of Underwater Movement Body attaching Ultrasonic Wave Transmitter
JP2006275920A (en) Underwater position detection system, sound source device, underwater position detection device and underwater position detection method
JP2008213687A (en) Highly functional buoy with a built-in gps
JP3615737B2 (en) System and method for detecting position of moving object in water
JP2009017241A (en) Highly functional buoy incorporating gps
Stateczny et al. Precise bathymetry as a step towards producing bathymetric electronic navigational charts for comparative (terrain reference) navigation
US8700323B1 (en) Underwater navigation system
JP2004245779A (en) System for determining position of submerging vessel and sonobuoy
KR102132488B1 (en) The System for Providing High Density Depth of Water Information Based on Cloud Sourcing and The Method of Supposing Depth of Water Observed Position and Depth of Water Information Using The System for Providing High Density Depth of Water Information
JP7133196B2 (en) Underwater equipment recovery method and underwater equipment recovery system
CN114114361B (en) Offshore platform precise positioning auxiliary system based on GNSS and working method
KR102157300B1 (en) The System for Providing High Density Depth of Water Information Based on Cloud Sourcing
JP2016065807A (en) Creature position information acquisition system for diver
Kim et al. Bathymetric Survey for Seabed Topography using Multibeam Echo Sounder in Wando, Korea
JPH10115522A (en) Method for guiding and mounting box body, etc.
Mufti et al. AN OPEN-SOURCE, DATA-LOGGING DEVICE FOR MARINE-BASED SURVEYS
KR101704603B1 (en) Method for estimating a position using geometrically coordinate and direction of sound detection
McKeown et al. GAPS: Grab acoustic positioning system
JPH0381682A (en) Mobile underwater target tracking device
AU2012200886A1 (en) System and method for determining the position of an underwater vehicle