阅读说明：本技术 一种水下机器人定位监测系统 (Underwater robot positioning monitoring system ) 是由 杨飞 杨歌 于 2020-04-21 设计创作，主要内容包括：本发明公开了一种水下机器人定位监测系统,通过采用短基线与超短基线结合以及即时GPS定位信息构成的时差定位算法,来对被施救黄标进行定位,且岸上监控设备进行数据无线通讯时,分别采用信道均衡器滤波处理、门限内搜索和归一化处理,本发明涉及水下机器人水下监测技术领域。该水下机器人水下定位监测系统,可实现精确确定水下机器人的实时位置、对水下机器人生命体征实时掌控以及确定被施救对象位置,减轻消防部门的水上救援任务,无需在水下机器人身上系安全绳进行水下救援作业,避免了安全绳发生缠绕危及水下机器人安全的情况发生,降低实施救援的难度,使地上指挥人员能够实时掌控水下机器人在水下实施救援的情况,来方便对于是否增派或调动水下救援力量进行快速决策。(The invention discloses a positioning and monitoring system of an underwater robot, which is used for positioning a rescued yellow mark by adopting a time difference positioning algorithm formed by combining a short baseline and an ultra-short baseline and instant GPS (global positioning system) positioning information, and respectively adopting channel equalizer filtering processing, threshold internal search and normalization processing when shore monitoring equipment carries out data wireless communication. The underwater robot underwater positioning monitoring system can accurately determine the real-time position of the underwater robot, control the vital signs of the underwater robot in real time and determine the position of a rescued object, relieves the overwater rescue task of a fire department, does not need to tie a safety rope on the underwater robot to carry out underwater rescue operation, avoids the situation that the safety rope is wound to endanger the safety of the underwater robot, reduces the difficulty of rescue implementation, enables onshore commanders to control the situation that the underwater robot carries out rescue underwater in real time, and facilitates quick decision on whether to increase or mobilize underwater rescue force.)

1. The utility model provides an underwater robot positioning monitoring system which characterized in that: the system comprises an underwater sound beacon (1), a relay buoy (2), onshore monitoring equipment (3) and a portable handheld accessory box, wherein the underwater sound beacon (1) comprises an underwater robot red beacon (11) and a rescued yellow beacon (12), the relay buoy (2) consists of a retractable matrix frame, a transmitting transducer, four receiving hydrophones, a GPS, a magnetic compass, a data receiving and transmitting unit, a wireless antenna and a junction box, the onshore monitoring equipment (3) is a waterproof terminal, the portable handheld accessory box is used for storing a power supply module and charger accessories, the onshore monitoring equipment (3) adopts a time difference positioning algorithm formed by combining a short baseline and an ultra-short baseline and instant GPS positioning information to position the rescued yellow beacon (12), and when the onshore monitoring equipment (3) carries out data wireless communication, channel equalizer filtering processing, intra-threshold searching and normalization processing are respectively adopted, the positioning method is used for improving positioning accuracy, the underwater sound beacon (1) and the relay buoy (2) are communicated through an underwater sound signal, and the relay buoy (3) and the onshore monitoring equipment (3) are communicated through a Zigbee local area network protocol.

2. The underwater robot positioning and monitoring system of claim 1, wherein: the shore monitoring equipment (3) is communicated with the emergency rescue command center (4) through a 5G network, the waterproof terminal is internally provided with display and control software and an interface for uploading remote monitoring data, and the waterproof terminal is in wireless communication connection with the emergency rescue command center (4) through the interface for uploading the remote monitoring data and receiving rescue information instructions.

3. The underwater robot positioning and monitoring system of claim 1, wherein: four receiving signal conditioning circuits and an FSK signal transmitting circuit are arranged in a junction box of the relay buoy (2).

4. The underwater robot positioning and monitoring system of claim 1, wherein: the time difference positioning algorithm is that the position of a radiation source at an unknown position is determined according to signals of the radiation source at the unknown position received by receivers at three known positions, namely a red marker (11), a rescued yellow marker (12) and a relay buoy (2), of an underwater robot, the arrival time difference of signals acquired by two signal points determines a pair of hyperbolas, and the target position can be obtained by intersecting a plurality of hyperbolas.

5. The underwater robot positioning and monitoring system of claim 1, wherein: the channel equalizer filtering process is to adopt the minimum mean square error algorithm of the self-adaptive filtering to carry out the channel equalization process.

6. The underwater robot positioning and monitoring system of claim 1, wherein: the continuous working time of the underwater robot red beacon (11) is more than or equal to 2h, and the continuous working time of the rescued yellow beacon (12) is more than or equal to 72 h.

7. The underwater robot positioning and monitoring system of claim 1, wherein: the display mode of the waterproof terminal is to display the motion trail information and the vital sign information of the underwater robot in real time, the motion trail of the underwater robot is unchanged for 1min, and the waterproof terminal immediately gives an alarm.

8. The underwater robot positioning and monitoring system of claim 1, wherein: the working temperatures of the underwater sound beacon (1) and the relay buoy (2) are both 0-60 ℃, and the working temperature of the onshore monitoring equipment (3) is-20-60 ℃.

Technical Field

The invention relates to the technical field of underwater robot underwater monitoring, in particular to an underwater robot positioning and monitoring system.

Background

The underwater robot is an amphibious army which swims underwater for a long time and is provided with special tasks such as a mask, a flipper, a rubber coat, an oxygen cylinder and the like, the selection of team members is extremely strict, the tasks carried by the army of the underwater robot on the shoulders are extremely hidden and dangerous, reconnaissance is carried out in the sea area and the area behind the enemy to eliminate a maneuvering launching device, an air defense facility, a hydraulic engineering, a command post and the like, for this reason, the underwater robot is required to have skillful professional technical skills and superman physical quality, more and more extreme sports enthusiasts start to experience the diving of the underwater robot along with the continuous improvement of the living standard of people, so the diving of the underwater robot is more and more popular among people, in underwater robot diving, need install many safety equipment on experience person's body, guarantee experience person's life safety, 12 players of thailand's wild boar's football team and train lose the federation when the cave is visited. GPS positioning in the cave can not be used for causing great difficulty for search and rescue, and a search and rescue worker can be killed in the rescue.

The existing underwater robot diving safety equipment has the following defects:

1) and the real-time position of the underwater robot is unknown: the overwater rescue task of a fire department is heavy, the existing underwater robot is mainly tied to a safety rope for fixing in the underwater rescue operation, the ground commander cannot judge the position of the underwater robot in real time, and the safety rope is easy to be wound to endanger the safety of the underwater robot;

2) and the vital signs of the underwater robot are unknown: the underwater walking path is unknown, the conditions such as water depth and the like are unknown, and great difficulty is caused to rescue;

3) and the position of the object to be rescued is unknown: under the condition that the underwater robot carries out rescue underwater, a commander on the ground can not control the situation completely, and great difficulty is caused on whether to increase or mobilize underwater rescue force;

4) the underwater positioning device suitable for lakes, reservoirs and karst caves is blank at home, the underwater positioning device similar to underwater robot navigation is available at foreign countries, but a large amount of equipment is not available, part of underwater sound positioning technology is used for blocking and banning China, the price is high, and similar products at home are blank at present.

Disclosure of Invention

Technical problem to be solved

Aiming at the defects of the prior art, the invention provides an underwater robot positioning and monitoring system, which solves the problems that the real-time position of an underwater robot is unknown, the vital signs of the underwater robot are unknown, the position of a rescued object is unknown and the blank underwater positioning products suitable for lakes, reservoirs and karst caves in China in the conventional underwater robot diving safety equipment.

(II) technical scheme

In order to achieve the purpose, the invention is realized by the following technical scheme: an underwater robot positioning and monitoring system comprises an underwater sound beacon, a relay buoy, onshore monitoring equipment and a portable handheld accessory box, wherein the underwater sound beacon comprises an underwater robot red beacon and a rescued yellow beacon, the relay buoy consists of a retractable base array frame, a transmitting transducer, four receiving hydrophones, a GPS (global positioning system), a magnetic compass, a data transceiving unit, a wireless antenna and a junction box, the onshore monitoring equipment is a waterproof terminal, the portable handheld accessory box is used for storing a power supply module and charger accessories, the onshore monitoring equipment is used for positioning the rescued yellow beacon by adopting a time difference positioning algorithm formed by combining a short base line and an ultra-short base line and instant GPS positioning information, and when the onshore monitoring equipment is in data wireless communication, the onshore monitoring equipment is respectively subjected to channel equalizer filtering processing, in-threshold searching and normalization processing for improving the positioning precision, the underwater sound beacon is communicated with the relay buoy through an underwater sound signal, and the relay buoy is communicated with the onshore monitoring equipment through a Zigbee local area network protocol.

Preferably, the onshore monitoring equipment is communicated with the emergency rescue command center through a 5G network, the waterproof terminal is internally provided with display and control software and an interface for uploading remote monitoring data, and the waterproof terminal is in wireless communication connection with the emergency rescue command center through the interface for uploading data information of the underwater robot and receiving rescue information instructions.

Preferably, four receiving signal conditioning circuits and an FSK signal transmitting circuit are arranged in a junction box of the relay buoy.

Preferably, the time difference positioning algorithm is that the position of a radiation source at an unknown position is determined according to signals of the radiation source at the unknown position received by receivers at three known positions, namely a red marker, a rescued yellow marker and a relay buoy, of the underwater robot, the arrival time difference of the signals acquired by two signal points determines a pair of hyperbolas, and the target position can be obtained by intersecting a plurality of hyperbolas.

Preferably, the channel equalizer filtering process is a minimum mean square error algorithm using adaptive filtering to perform channel equalization.

Preferably, the continuous working time of the underwater robot red mark is more than or equal to 2h, and the continuous working time of the rescued yellow mark is more than or equal to 72 h.

Preferably, the display mode of the waterproof terminal is to display the motion track information (distance, direction and depth) and the vital sign information (pulse) of the underwater robot in real time, the motion track of the underwater robot is unchanged for 1min, and the waterproof terminal immediately gives an alarm.

Preferably, the working temperatures of the underwater acoustic beacon and the relay buoy are both 0-60 ℃, and the working temperature of the onshore monitoring equipment is-20-60 ℃.

(III) advantageous effects

The invention provides an underwater robot positioning and monitoring system. Compared with the prior art, the method has the following beneficial effects:

(1) the underwater robot underwater positioning monitoring system comprises an underwater sound beacon, a relay buoy, onshore monitoring equipment and a portable handheld accessory box, wherein the underwater sound beacon comprises an underwater robot red beacon and a rescued yellow beacon, the relay buoy consists of a retractable base array frame, a transmitting transducer, four receiving hydrophones, a GPS (global positioning system), a magnetic compass, a data transceiving unit, a wireless antenna and a junction box, the onshore monitoring equipment is a waterproof terminal, the portable handheld accessory box is used for storing a power supply module and charger accessories, the onshore monitoring equipment is used for positioning the rescued yellow beacon by adopting a time difference positioning algorithm formed by combining a short baseline and an ultra-short baseline and instant GPS positioning information, and when the onshore monitoring equipment is in data wireless communication, channel equalizer filtering processing, threshold internal searching and normalization processing are respectively adopted for improving the positioning accuracy, the underwater acoustic beacon and the relay buoy are communicated through an underwater acoustic signal, the relay buoy and the onshore monitoring equipment are communicated through a Zigbee local area network protocol, the situation that the safety of the underwater robot is endangered due to the fact that the safety rope is wound can be well avoided, and the short base line and the ultra-short base line are combined and a time difference positioning algorithm formed by instant GPS positioning information is adopted to position the yellow mark to be rescued, and when the onshore monitoring equipment is in data wireless communication, channel equalizer filtering processing, threshold internal searching and normalization processing are respectively adopted to improve positioning accuracy so as to determine the real-time position of the underwater robot, control the vital signs of the underwater robot in real time and determine the position of a rescued object, thereby greatly lightening the overwater rescue task of a fire department, avoiding the underwater rescue operation by tying the safety rope on the underwater robot and well avoiding the situation that the safety rope is wound to endanger, the difficulty of rescue implementation is greatly reduced, and ground commanders can control the underwater rescue implementation condition of the underwater robot in real time, so that whether underwater rescue force is increased or mobilized is conveniently and quickly decided.

(2) This underwater robot is positioning monitoring system under water through high reliability and miniaturized array type design, reaches the purpose that reduces the system volume and be convenient for lay, and positioning accuracy is high, and the base line length is long, need not the calibration before the use, makes underwater robot can track fast and monitor, and the succinct high efficiency of remote control commander.

Drawings

FIG. 1 is a schematic diagram of the system of the present invention;

FIG. 2 is a schematic diagram of a simulation of the moveout location algorithm of the present invention;

fig. 3 is a block diagram of the working principle of the system of the present invention.

In the figure, 1 underwater sound beacon, 11 underwater robot red beacon, 12 rescued yellow beacon, 2 relay buoy, 3 onshore monitoring equipment and 4 emergency rescue command center.

Detailed Description

The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.

Referring to fig. 1-2, an embodiment of the present invention provides a technical solution: an underwater robot positioning monitoring system comprises an underwater sound beacon 1, a relay buoy 2, an onshore monitoring device 3 and a portable handheld accessory box, wherein the size of the relay buoy 2 is 600 x 1800mm, the weight of the relay buoy is 15kg (air), the underwater sound beacon 1 comprises an underwater robot red mark 11 and a rescued yellow mark 12, the weight of the underwater robot red mark 11 is 120g, the diameter of the underwater robot red mark is 60mm, the length of the underwater robot red mark is 280mm, the working time > =3 hours, the charging time is 2 hours, the charging interval is at least once per month, the weight of the rescued yellow mark 12 is 640g, the diameter of the rescued yellow mark is 45mm, the length of the rescued yellow mark is 240mm, the underwater standby time > =7 days, the working time > =10 hours, the charging time is 2 hours, the charging interval is at least once per month, and the relay buoy 2 is composed of a retractable base array frame, a transmitting transducer, four receiving water, a GPS, a magnetic compass, a data transceiver, The shore monitoring equipment 3 is a waterproof terminal, a portable accessory box is used for storing a power supply module and charger accessories, the shore monitoring equipment 3 adopts a time difference positioning algorithm formed by combining a short baseline and an ultra-short baseline and instant GPS positioning information to position the yellow buoy 12 to be rescued, and when the shore monitoring equipment 3 carries out data wireless communication, channel equalizer filtering processing, threshold internal search and normalization processing are respectively adopted to improve the positioning precision, the underwater sound beacon 1 and the relay buoy 2 are communicated through an underwater sound signal, the relay buoy 3 and the shore monitoring equipment 3 are communicated through a Zigbee local area network protocol, the shore monitoring equipment 3 and the emergency rescue command center 4 are communicated through a 5G network, and the waterproof terminal comprises display and control software and an interface for uploading remote monitoring data, the waterproof terminal is in wireless communication connection with the emergency rescue command center 4 through an interface for uploading remote monitoring data and is used for uploading data information of an underwater robot and receiving a rescue information instruction, four paths of receiving signal conditioning circuits and an FSK signal transmitting circuit are arranged in a junction box of the relay buoy 2, a time difference positioning algorithm is used for receiving signals of a radiation source at an unknown position according to receivers at three known positions of an underwater robot red mark 11, a rescued yellow mark 12 and the relay buoy 2 to determine the position of the radiation source, a pair of hyperbolas is determined according to the arrival time difference of signals collected by two signal points, the target position can be obtained by intersecting a plurality of hyperbolas, the filtering processing of a channel equalizer is carried out by adopting a minimum mean square error algorithm of self-adaptive filtering, the continuous working time of the underwater robot red mark 11 is not less than 2h, and the continuous working time of the rescued yellow mark 12 is not less than 72h, the display mode of the waterproof terminal is to display the motion track information (distance, direction and depth) and the vital sign information (pulse) of the underwater robot in real time, the motion track of the underwater robot is unchanged for 1min, the waterproof terminal immediately gives an alarm, the working temperatures of the underwater sound beacon 1 and the relay buoy 2 are both 0-60 ℃, the working temperature of the onshore monitoring equipment 3 is-20-60 ℃, and the main technical indexes of the underwater positioning system of the underwater robot are as follows: acting distance D: the water depth is more than or equal to 2km (the water depth is more than or equal to 5 m) and more than or equal to 1km (the water depth is 3-5 m); the underwater positioning precision is less than or equal to 2m + 1% D; the laying time is less than or equal to 5 min; the working water depth is less than or equal to 50 m.

As shown in fig. 2, the time difference positioning algorithm specifically includes: the yellow label 12 to be rescued is a target T with the position of (x, y), S₀(x₀，y₀) For onshore monitoring equipment 3, S₁(x₁，y₁) And S₂(x₂，y₂) Respectively an underwater robot red buoy 11 and a relay buoy 2, r₀、r₁、r₂Respectively being targets T to S₀、S₁And S₂Is △ r, i =1, 2, the localization equation is:

r₀ ²=(x-x₀)²+(y-y₀)²（1）

r_i ²=(x-x_i)+(y-y_i)²，(i=1，2) （2）

c△t_i=c(t_i-t₀)=r_i-r₀（3）

the finishing of the above formulas (1), (2) and (3) is simplified to obtain:

(x₀-x_i)x+(y_o-y_i)y=ki+c△t_ir₀(4)

wherein k is_i=1/2[(c△t_i)²+(x₀ ²+y₀ ²)-(x_i ²+y_i ²)]，(i=1，2)，c=3*10⁸And m/s, solving the equation set to obtain the target position.

When the steepest descent method in the minimum mean square error algorithm is used, the iterative formula used by us is as follows:

e(n)=4(n)-x(n)W(n)（6）

W(n+1)=W(n)+2ue(n)X(n)（7）

let step factor μ, weight vector w (n) at time n of adaptive filter, let signal vector at input end at time n be represented by x (n) = [ x (n) x (n-1).. times.x (n-L +1) ], let adaptive filter length be L, define desired signal as d (n), error signal as e (n), and noise signal as v (n).

The conditions known to achieve convergence using this algorithm are: 0<μ<1/λ_maxDefining the maximum eigenvalue λ of the autocorrelation matrix_maxIs the maximum eigenvalue of the system input signal. The adaptive filtering algorithm has three most important indexes: the time-varying system is used to measure the error and to determine whether it is possible to continue tracking after the initial convergence speed and the steady state is obtained, the noise signal is mostly generated at the input end, the algorithm generates parameter offset noise for effectively processing the noise, the offset noise depends on the noise signal, the steady state error is related to the step factor, and the convergence speed is the same if a large step factor is setIf a small step factor is taken, the convergence speed is correspondingly slowed down, and then a faster R steady-state error is obtained.

In conclusion, the invention can realize that the rescued yellow mark 12 is positioned by adopting a time difference positioning algorithm formed by combining a short baseline and an ultra-short baseline and instant GPS positioning information, and when the onshore monitoring equipment 3 carries out data wireless communication, channel equalizer filtering processing, threshold internal search and normalization processing are respectively adopted to improve positioning precision, determine the real-time position of the underwater robot, control the vital signs of the underwater robot in real time and determine the position of a rescued object, thereby greatly lightening the overwater rescue task of a fire department, avoiding the underwater rescue operation without tying a safety rope on the underwater robot, well avoiding the situation that the safety rope is wound to endanger the safety of the underwater robot, greatly reducing the difficulty of rescue, leading an onshore commander to be capable of controlling the underwater robot to carry out rescue underwater rescue in real time, come the convenience and carry out quick decision-making to whether increasing and dispatching or mobilizing rescue strength under water, through high reliability and miniaturized array type design, reach the purpose that reduces the system volume and be convenient for lay, and positioning accuracy is high, and the base line length is long, need not the calibration before the use, makes underwater robot can track fast and monitor.

It is noted that, herein, relational terms such as first and second, and the like may be used solely to distinguish one entity or action from another entity or action without necessarily requiring or implying any actual such relationship or order between such entities or actions. Also, the terms "comprises," "comprising," or any other variation thereof, are intended to cover a non-exclusive inclusion, such that a process, method, article, or apparatus that comprises a list of elements does not include only those elements but may include other elements not expressly listed or inherent to such process, method, article, or apparatus.

Although embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that changes, modifications, substitutions and alterations can be made in these embodiments without departing from the principles and spirit of the invention, the scope of which is defined in the appended claims and their equivalents.