A kind of localization method of underwater glider
Technical field
The present invention relates to engineering calculating method field more particularly to a kind of localization methods of underwater glider.
Background technique
Underwater glider is a kind of novel underwater robot.Since it is promoted using net buoyancy and attitude angle adjustment
Power, energy consumption is minimum, a small amount of energy is only consumed when adjusting net buoyancy and attitude angle, and with high-efficient, endurance is big
The characteristics of (up to thousands of kilometers).Although the route speed of underwater glider is slower, its manufacturing cost and maintenance cost it is low, can
The features such as reusing and can largely launching meets long-time, the needs that a wide range of ocean is explored.
However underwater glider is after entering water, it is desirable to monitor in real time to it extremely difficult, country's underwater sound is logical at present
Believe it is immature, be unable to satisfy to aerodone real time monitoring needs.But underwater glider can entirely be cutd open by underwater acoustic technology
Underwater 3 D position during face is recorded, and is of great significance for research underwater glider gliding.It is underwater sliding
Xiang machine underwater position fixing technique is the key points and difficulties studied both at home and abroad, and overwhelming majority underwater glider is all underwater without carrying out at present
The ability of positioning, and it is because of underwater sound communication energy possessed by itself that only a few, which has the aerodone of the ability of Underwater Navigation,
Power.Underwater sound Modem is carried on aerodone under water, Underwater Navigation is carried out to aerodone based on ultra-short baseline.Based on underwater sound Modem
Ultra-short baseline positioning have energy consumption high, be not easy to carry on aerodone, and complicated, at high cost etc. with control section connection line
Problem.
Summary of the invention
It is an object of the invention to propose a kind of localization method of underwater glider, asked with solving the positioning of underwater glider
Topic.
The present invention to achieve the goals above, adopts the following technical scheme that:
A kind of localization method of underwater glider, includes the following steps:
S1. when underwater glider is in marine gliding, the sound source energy converter carried on mother ship carrier makes a sound letter at a certain moment
Number;
S2. it is mounted in the sound letter that sound source energy converter issues in the vector hydrophone receiving step s1 on underwater glider
Number, and the program that underwater glider is navigated by water generates interruption;
Obtain the time that underwater glider submerged depth, attitude angle and underwater glider receive voice signal;
S3. the GPS latitude and longitude information of mother ship carrier when mother ship carrier makes a sound signal is recorded on the coast and makes a sound signal
Time;
S4. underwater glider in step s2 is received into mother ship carrier in the time and step s3 of voice signal and makes a sound signal
It is poor that time is made, and obtains the propagation time of voice signal;
S5. according to the speed that the propagation time of the step s4 voice signal obtained and voice signal propagate in water, into
One step obtains the relative distance between mother ship carrier and underwater glider;
S6. after the relative distance for obtaining underwater glider and mother ship carrier by step s5, further according to the GPS longitude and latitude of mother ship carrier
Information is spent, three-dimensional data calculating, the final three-dimensional position for determining underwater glider are carried out.
Preferably, in the step s6, three-dimensional data calculating includes the following steps:
S6.1. the positional relationship of the sound source and underwater glider under three-dimensional system of coordinate is established;
The sound source of definition voice signal is p (x in marine absolute position0,y0,z0);
Wherein, x0,y0,z0The respectively longitude coordinate, latitude coordinate of sound source and in marine depth coordinate;
Underwater glider is in a marine vertical plane π1Interior gliding, sound source are in another vertical plane π2It is interior;
By formula L=c (t2-t1), calculate the relative distance between underwater glider and mother ship carrier;Wherein:
t1At the time of making a sound signal for sound source;
t2At the time of receiving voice signal for vector hydrophone;
C is the spread speed of voice signal in water;
S6.2. the underwater glider and sound source relative position equation under three-dimensional system of coordinate are derived;Side depending on the relative position
Journey from which further follows that the relative position of underwater glider and mother ship carrier;
S6.3. terrestrial coordinate system is established, obtains the three-dimensional absolute position of underwater glider.
Preferably, in the step s6.2, the underwater glider and sound source relative position equation under three-dimensional system of coordinate are as follows:
Wherein, L is sound source and underwater glider relative distance;
x1,y1,z1For three relative position coordinates of underwater glider, i.e. longitude, latitude and in marine depth coordinate;
L=c Δ t (2)
Wherein, Δ t indicates the propagation time of voice signal;
Wherein, α is the underwater glider angle of attack, and β is underwater glider pitch angle,For underwater glider gliding speed direction
Angle;
Δ Depth=Depthg-Depths (4)
Wherein, DepthgFor underwater glider depth, DepthsFor sound source depth;
Wherein, θ angle between L and Δ Depth;
L=Lsin θ (6)
y1=lcos η (7)
x1=lsin η (8)
z1=Depthg (9)
Wherein, η is vertical plane π where underwater glider1With vertical plane π where sound source2Between angle;
Simultaneous equations (1)-(9) obtain the relative position coordinates g (x of underwater glider1,y1,z1)。
Preferably, in the step s6.3, the calculating process of the three-dimensional absolute position of underwater glider is as follows:
Terrestrial coordinate system is established, if the absolute position of underwater glider is g (xg,yg,zg);
Wherein, xgIndicate longitude coordinate, ygIndicate latitude coordinates, zgIndicate depth coordinate;
Two points (A (λ A, φ A), B (λ B, φ B)) being located on earth spherical surface, relative distance is by following equation (10)
It acquires:
Wherein, λ A, φ A respectively indicate the longitude of A point, latitude, and λ B, φ B respectively indicate the longitude of B point, latitude;
In conjunction with the relative position coordinates x of underwater glider1,y1Value, sound source coordinate x0,y0Value and formula (10) calculate
The latitude and longitude value x of underwater gliderg,yg, underwater glider depth DepthgIt is obtained by pressure sensor;
To sum up, absolute position g (x of the underwater glider under terrestrial coordinate system can be obtainedg,yg,Depthg)。
The invention has the advantages that:
Underwater glider receives sound source information by vector hydrophone in the present invention, and passes through underwater acoustic modem real-time Transmission
Aerodone underwater three is calculated after host computer obtains data in underwater glider submerged depth, attitude parameter to bank station host computer
Dimension space position has the characteristics that precision is high, real-time is good;In addition, the vector that underwater glider hydrolocation uses in the present invention
Hydrophone has many advantages, such as low energy consumption, at low cost, and when designing internal structure, between each sensor of reasonable arrangement mutually
Connection and the position carried.Further, since underwater glider three-dimensional localization only need to obtain aerodone submerged depth, attitude angle and
Underwater sound transmission time information, three parameters can obtain three dimensional local information by calculation formula, technically simple, and feasibility is high.
Detailed description of the invention
Fig. 1 is a kind of flow diagram of the localization method of underwater glider in the present invention;
Fig. 2 is position view of the underwater glider in three-dimensional system of coordinate in the present invention.
Fig. 3 is that the relative position of underwater glider in the present invention calculates schematic diagram.
Specific embodiment
With reference to the accompanying drawing and specific embodiment the invention will be further described:
As shown in connection with fig. 1, a kind of localization method of underwater glider, includes the following steps:
S1. when underwater glider is in marine gliding, the sound source energy converter carried on mother ship carrier makes a sound letter at a certain moment
Number.
S2. it is mounted in the sound letter that sound source energy converter issues in the vector hydrophone receiving step s1 on underwater glider
Number, and the program that underwater glider is navigated by water generates interruption.
Since the break period is in Millisecond, it will not influence entire navigation process.
Obtain the time that underwater glider submerged depth, attitude angle and underwater glider receive voice signal.
The submerged depth of underwater glider is obtained by the pressure sensor on underwater glider in the present embodiment.In addition,
The system record underwater glider of underwater glider receives the time of voice signal and the attitude parameter of underwater glider.
S3. the GPS latitude and longitude information of mother ship carrier when mother ship carrier makes a sound signal is recorded on the coast and makes a sound signal
Time.
S4. underwater glider in step s2 is received into mother ship carrier in the time and step s3 of voice signal and makes a sound signal
It is poor that time is made, and obtains the propagation time of voice signal.
S5. according to the speed that the propagation time of the step s4 voice signal obtained and voice signal propagate in water, into
One step obtains the relative distance between mother ship carrier and underwater glider.
S6. after the relative distance for obtaining underwater glider and mother ship carrier by step s5, further according to the GPS longitude and latitude of mother ship carrier
Information is spent, three-dimensional data calculating, the final three-dimensional position for determining underwater glider are carried out.
The determination method of the three-dimensional position of underwater glider is illustrated below with reference to formula:
Wherein, three-dimensional data calculating includes the following steps:
S6.1. the positional relationship of the sound source and underwater glider under three-dimensional system of coordinate is established, as shown in Figure 2:
The sound source of definition voice signal is p (x in marine absolute position0,y0,z0)。
Wherein, x0,y0,z0The respectively longitude coordinate, latitude coordinate of sound source and in marine depth coordinate.
Sound source latitude and longitude coordinates x in the present embodiment0,y0, it can be obtained by handhold GPS or boat-carrying GPS, and sound source exists
Marine depth coordinate z0It can be obtained by the water length that enters of measurement mounting sound source hawser.
Sound source in the present embodiment refers to the position for making a sound signal, i.e., the sound source energy converter carried on mother ship carrier.
Underwater glider is in a marine vertical plane π1Interior gliding, sound source are in another vertical plane π2It is interior.
By formula L=c (t2-t1), calculate the relative distance between underwater glider and mother ship carrier;Wherein:
t1At the time of making a sound signal for sound source;
t2At the time of receiving voice signal for vector hydrophone;
C is the spread speed of voice signal in water.
S6.2. the underwater glider and sound source relative position equation under three-dimensional system of coordinate are derived;Side depending on the relative position
Journey from which further follows that the relative position of underwater glider and mother ship carrier, as shown in Figure 3.
Underwater glider and sound source relative position equation under three-dimensional system of coordinate is as follows:
Wherein, L is sound source and underwater glider relative distance;
x1,y1,z1For three relative position coordinates of underwater glider, i.e. longitude, latitude and in marine depth coordinate;
L=c Δ t (2)
Wherein, Δ t indicates the propagation time of voice signal;
Wherein, α is the underwater glider angle of attack, and β is underwater glider pitch angle,For underwater glider gliding speed direction
Angle;
Δ Depth=Depthg-Depths (4)
Wherein, DepthgFor underwater glider depth, DepthsFor sound source depth;
Wherein, θ angle between L and Δ Depth;
L=Lsin θ (6)
y1=lcos η (7)
x1=lsin η (8)
z1=Depthg (9)
Wherein, η is vertical plane π where underwater glider1With vertical plane π where sound source2Between angle;η can pass through mother ship carrier
Course angle and underwater glider course angle are made difference and are obtained.
Simultaneous equations (1)-(9) obtain the relative position coordinates g (x of underwater glider1,y1,z1)。
S6.3. terrestrial coordinate system is established, obtains the three-dimensional absolute position of underwater glider, specific calculating process is as follows:
Terrestrial coordinate system is established, if the absolute position of underwater glider is g (xg,yg,zg);
Wherein, xgIndicate longitude coordinate, ygIndicate latitude coordinates, zgIndicate depth coordinate.
Two points (A (λ A, φ A), B (λ B, φ B)) being located on earth spherical surface, relative distance is by following equation (10)
It acquires:
Wherein, λ A, φ A respectively indicate the longitude of A point, latitude, and λ B, φ B respectively indicate the longitude of B point, latitude.
In conjunction with the relative position coordinates x of underwater glider1,y1Value, sound source coordinate x0,y0Value and formula (10) calculate
The latitude and longitude value x of underwater gliderg,yg, underwater glider depth DepthgIt is obtained by pressure sensor.
To sum up, absolute position g (x of the underwater glider under terrestrial coordinate system can be obtainedg,yg,Depthg)。
Certainly, described above is only that presently preferred embodiments of the present invention is answered the present invention is not limited to enumerate above-described embodiment
When explanation, anyone skilled in the art is all equivalent substitutes for being made, bright under the introduction of this specification
Aobvious variant, all falls within the essential scope of this specification, ought to be by protection of the invention.