CN114689039A - Navigation method and system for short-time positioning missing of wave glider - Google Patents

Navigation method and system for short-time positioning missing of wave glider Download PDF

Info

Publication number
CN114689039A
CN114689039A CN202210610414.0A CN202210610414A CN114689039A CN 114689039 A CN114689039 A CN 114689039A CN 202210610414 A CN202210610414 A CN 202210610414A CN 114689039 A CN114689039 A CN 114689039A
Authority
CN
China
Prior art keywords
navigation
wave glider
order
time
matrix
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
CN202210610414.0A
Other languages
Chinese (zh)
Inventor
孙秀军
桑宏强
周莹
于佩元
张帅
孙超
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Qingdao Haizhou Technology Co ltd
Original Assignee
Qingdao Haizhou Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Qingdao Haizhou Technology Co ltd filed Critical Qingdao Haizhou Technology Co ltd
Priority to CN202210610414.0A priority Critical patent/CN114689039A/en
Publication of CN114689039A publication Critical patent/CN114689039A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement

Abstract

The invention discloses a navigation method and a system for short-time positioning loss of a wave glider, which relate to the field of navigation and control, and the navigation method comprises the following steps: judging whether the GPS positioning module works normally or not; if so, resolving the navigation path according to the position information provided by the GPS positioning module to obtain the navigation path; if not, respectively acquiring the last effective position information provided by the GPS positioning module, the navigation speed information provided by the Doppler log and the attitude information and the angular speed information provided by the navigation attitude reference module; carrying out dead reckoning on the final effective position information, speed information, attitude information and angular speed information by adopting a filtering algorithm to obtain the current position information of the wave glider; and resolving the navigation path according to the current position information of the wave glider to obtain the navigation path. The wave glider navigation method can realize the functions of position calculation and navigation of the wave glider under the condition that the positioning information is temporarily lost, and ensure the navigation safety of the wave glider.

Description

Navigation method and system for short-time positioning missing of wave glider
Technical Field
The invention relates to the field of navigation and control, in particular to a navigation method and a system for short-time positioning loss of a wave glider.
Background
The wave glider is a novel ocean mobile observation platform which utilizes wave energy to provide power and solar energy to provide electric energy required by each sensor. The wave glider mainly obtains position information through a GPS and then carries out navigation path calculation.
The marine environment in which the wave glider is located is complex and changeable, and particularly, when extremely severe weather and unknown interference influence are met, temporary loss of a shipborne GPS system signal can be caused, and navigation safety is seriously influenced. At present, there is no mention in the prior art of how to achieve navigation in the absence of wave glider positioning information.
Disclosure of Invention
The invention aims to provide a navigation method and a navigation system for short-time positioning loss of a wave glider.
In order to achieve the purpose, the invention provides the following scheme:
a navigation method for short-time positioning loss of a wave glider, wherein the wave glider carries a GPS positioning module, a Doppler log and a navigation attitude reference module, and the navigation method comprises the following steps:
judging whether the GPS positioning module works normally or not;
if so, resolving a navigation path according to the position information provided by the GPS positioning module to obtain the navigation path;
if not, respectively acquiring the last effective position information provided by the GPS positioning module, the navigation speed information provided by the Doppler log, and the attitude information and the angular speed information provided by the navigation attitude reference module;
carrying out dead reckoning on the last effective position information, the speed information, the attitude information and the angular speed information by adopting a filtering algorithm to obtain the current position information of the wave glider;
and resolving a navigation path according to the current position information of the wave glider to obtain the navigation path.
The invention also provides a navigation system for short-time positioning loss of the wave glider, which comprises: carry on GPS orientation module, Doppler log and the reference module of attitude and heading on wave glider to and data processing unit, data processing unit includes:
the judging subunit is used for judging whether the GPS positioning module works normally or not;
the first navigation path resolving subunit is used for resolving a navigation path according to the position information provided by the GPS positioning module to obtain the navigation path when the GPS positioning module works normally;
the information acquisition subunit is used for respectively acquiring the last effective position information provided by the GPS positioning module, the navigation speed information provided by the Doppler log and the attitude information and the angular speed information provided by the navigation attitude reference module when the GPS positioning module works abnormally;
the dead reckoning operator unit is used for carrying out dead reckoning on the last effective position information, the speed information, the attitude information and the angular speed information by adopting a filtering algorithm to obtain the current position information of the wave glider;
and the second navigation path resolving subunit is used for resolving the navigation path according to the current position information of the wave glider to obtain the navigation path.
According to the specific embodiment provided by the invention, the invention discloses the following technical effects:
the invention provides a navigation method and a system for short-time positioning loss of a wave glider, wherein the wave glider is loaded with a GPS positioning module, a Doppler log and a navigation attitude reference module, and the navigation method comprises the following steps: judging whether the GPS positioning module works normally or not; if so, resolving a navigation path according to the position information provided by the GPS positioning module to obtain the navigation path; if not, respectively acquiring the last effective position information provided by the GPS positioning module, the navigation speed information provided by the Doppler log and the attitude information and the angular speed information provided by the navigation attitude reference module; carrying out dead reckoning on the last effective position information, the speed information, the attitude information and the angular speed information by adopting a filtering algorithm to obtain the current position information of the wave glider; and resolving a navigation path according to the current position information of the wave glider to obtain the navigation path. Compared with the prior art, the method can realize the functions of position calculation and navigation of the wave glider under the condition of temporary loss of positioning information, and ensure the navigation safety of the wave glider.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings needed in the embodiments will be briefly described below, and it is obvious that the drawings in the following description are only some embodiments of the present invention, and it is obvious for those skilled in the art to obtain other drawings without creative efforts.
Fig. 1 is a flowchart of a navigation method for short-term missing positioning of a wave glider according to embodiment 1 of the present invention;
FIG. 2 is a schematic view of a wave glider short-time positioning missing navigation;
fig. 3 is a block diagram of a data processing unit in a navigation system for short-term missing wave glider positioning according to embodiment 2 of the present invention.
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.
The invention aims to provide a navigation method and a navigation system for short-time positioning loss of a wave glider. Of course, the navigation method for the short-time positioning missing of the wave glider, which is disclosed by the invention, can also be extended to other aircrafts similar to the wave glide control principle.
In order to make the aforementioned objects, features and advantages of the present invention comprehensible, embodiments accompanied with figures are described in further detail below.
Example 1:
the invention provides a navigation method for short-time positioning loss of a wave glider, as shown in figure 2, the wave glider carries a GPS positioning module, a Doppler log and a navigation attitude reference module, as shown in figure 1, the navigation method comprises the following steps:
s1: judging whether the GPS positioning module works normally or not;
s2: if so, resolving a navigation path according to the position information provided by the GPS positioning module to obtain the navigation path;
s3: if not, respectively acquiring the last effective position information provided by the GPS positioning module, the navigation speed information provided by the Doppler log, and the attitude information and the angular speed information provided by the navigation attitude reference module; taking the last effective position as an initial position of dead reckoning;
s4: carrying out dead reckoning on the last effective position information, the speed information, the attitude information and the angular speed information by adopting a filtering algorithm to obtain the current position information of the wave glider;
s5: and resolving a navigation path according to the current position information of the wave glider to obtain the navigation path.
The navigation method further comprises the following steps:
and carrying out coordinate transformation on the navigation speed information provided by the Doppler log to obtain east speed information and north speed information. Attitude information and angular velocity information required by coordinate transformation are provided by the attitude and heading reference module.
In step S4, the performing dead reckoning on the last valid position information, the speed information, the attitude information, and the angular velocity information by using a filtering algorithm to obtain the position information of the wave glider specifically includes:
s41: constructing a discrete state equation and an observation equation of wave glider dead reckoning; the discrete state equation is:
x(k+1)=A k k+1, x(k)+B k+1,k w(k)
wherein the content of the first and second substances,x(k+1) is a matrix of discrete state equations,kin order to update the number of times,A k k+1,in order to be a state transition matrix,A k k+1, = diag[A e k k(+1,),A n k k(+1,)],
Figure 790587DEST_PATH_IMAGE001
A e k k(+1,)in order to be an east-oriented state transition matrix,A n k k(+1,)is a matrix of state transitions in the north direction,
Figure 890261DEST_PATH_IMAGE002
in order to be the time of sampling,τin order to be a constant value,x(k) In order to be a quantity of state,B k k+1,in order to control the input matrix, the input matrix is,
Figure 764807DEST_PATH_IMAGE003
w(k) In order to be a noise of the process,
Figure 190103DEST_PATH_IMAGE004
Figure 71472DEST_PATH_IMAGE005
is the standard deviation of the acceleration;
the observation equation is:
z(k+1)=h(x(k))+v(k)
wherein the content of the first and second substances,z(k+1) is the matrix of the observation equations,h(x(k) Is a matrix of state observations,
Figure 771574DEST_PATH_IMAGE006
Figure 828523DEST_PATH_IMAGE007
xfor the definition of the observed quantity,x e in the east-oriented position, the position of the foot,
Figure 870125DEST_PATH_IMAGE008
in order to be the east-direction speed,
Figure 114155DEST_PATH_IMAGE009
in order to be an east-direction acceleration,x n the position of the north direction is the position of the north direction,
Figure 149107DEST_PATH_IMAGE010
in order to determine the speed in the north direction,
Figure 591721DEST_PATH_IMAGE011
the acceleration in the north direction is taken as the acceleration,v(k) In order to measure the noise matrix,
Figure 624399DEST_PATH_IMAGE012
a 1for the first measurement noise of the GPS positioning module,a 2for the second measurement noise of the GPS positioning module,
Figure 824568DEST_PATH_IMAGE013
Figure 741839DEST_PATH_IMAGE014
is the noise value of the GPS positioning module,v 1is the first measurement noise of the doppler log,v 2is the second measurement noise of the doppler log,
Figure 101276DEST_PATH_IMAGE015
Figure 508118DEST_PATH_IMAGE016
is the noise value of the doppler log,w 1noise is measured for the angular velocity of the attitude reference module,
Figure 461162DEST_PATH_IMAGE017
Figure 103496DEST_PATH_IMAGE018
a noise value of the angular velocity of the attitude reference module;
s42: and determining the position information of the wave glider according to the discrete state equation and the observation equation.
In step S4, the filtering algorithm is an extended kalman filter, and a recurrence formula of the extended kalman filter is:
Figure 458385DEST_PATH_IMAGE019
Figure 832865DEST_PATH_IMAGE020
wherein the content of the first and second substances,
Figure 538784DEST_PATH_IMAGE021
is composed ofk-1 time pairkThe estimation of the state value at the moment of time,fin order to be a function of the state transition,P k k|-1is composed ofkPredicted at-1 timekThe covariance of the error at the time of day,
Figure 719230DEST_PATH_IMAGE022
is composed ofkTime 1 tokThe one-step transition matrix of the time of day,
Figure 663046DEST_PATH_IMAGE023
Figure 942849DEST_PATH_IMAGE024
is composed ofk-a state estimate at time 1,P k-1is composed ofk-the mean square error of the system guess at time 1,
Figure 729539DEST_PATH_IMAGE025
x k in order to be a state equation,
Figure 995567DEST_PATH_IMAGE026
is composed ofkTime 1 tokThe one step of the time instant shifts the transpose of the matrix,R wk-1in order to be the process noise covariance,K kin order to be a matrix of gains, the gain matrix,H k in order to measure the matrix, the measurement matrix is,
Figure 590627DEST_PATH_IMAGE027
hin order to measure the function of the measurement,
Figure 41331DEST_PATH_IMAGE028
in order to transpose the measurement matrix,R vk is composed ofkThe measured noise covariance at the time of day,
Figure 456263DEST_PATH_IMAGE029
is composed ofkThe state estimate for the time of day is,y k is composed ofkThe measured value of the time of day is,P k is composed ofkThe covariance of the error at the time of day,
Figure 181774DEST_PATH_IMAGE030
Iis a matrix of the units,w k-1is the first zero-mean white noise,v k-1is the second zero-mean white noise.
In conclusion, the wave glider carries a GPS positioning module, a Doppler log and a navigation attitude reference module; when the GPS positioning module works normally, the GPS positioning module provides positioning information for a navigation system; when the GPS positioning module fails in a short time and positioning information is lost, the Doppler log provides navigation speed information, and the navigation attitude reference module provides attitude information and angular speed information. And directly taking each piece of information as a direct filtering method of a target state to perform data fusion processing, wherein a filtering algorithm used by dead reckoning is extended Kalman filtering, and the dead reckoning is used for obtaining the position information of the wave glider for path calculation in navigation. The invention can realize the functions of position calculation and navigation of the wave glider under the condition of temporary loss of positioning information and ensure the navigation safety of the wave glider.
Example 2:
referring to fig. 3, the present invention provides a navigation system for short-term missing positioning of a wave glider, comprising: carry on GPS orientation module, Doppler log and the reference module of attitude and heading on wave glider to and data processing unit, data processing unit includes:
the judging subunit 1 is used for judging whether the GPS positioning module works normally;
the first navigation path resolving subunit 2 is configured to, when the GPS positioning module operates normally, perform navigation path resolving according to the position information provided by the GPS positioning module to obtain a navigation path;
an information obtaining subunit 3, configured to, when the GPS positioning module works abnormally, obtain last valid position information provided by the GPS positioning module, speed information of navigation provided by the doppler log, and attitude information and angular speed information provided by the navigation attitude reference module, respectively;
a dead reckoning operator unit 4, configured to perform dead reckoning on the last valid position information, the speed information, the attitude information, and the angular speed information by using a filtering algorithm, so as to obtain current position information of the wave glider;
and the second navigation path resolving subunit 5 is used for resolving the navigation path according to the current position information of the wave glider to obtain the navigation path.
The data processing unit further comprises:
and the coordinate conversion subunit 6 is used for performing coordinate conversion on the speed information provided by the doppler log to obtain east speed information and north speed information.
The dead reckoning operator unit 4 includes:
the equation building module 41 is used for building a discrete state equation and an observation equation of wave glider dead reckoning; the discrete state equation is:
x(k+1)=A k k+1, x(k)+B k+1,k w(k)
wherein the content of the first and second substances,x(k+1) is a matrix of discrete state equations,kin order to update the number of times,A k k+1,in order to be a state transition matrix,A k k+1, = diag[A e k k(+1,),A n k k(+1,)],
Figure 100182DEST_PATH_IMAGE031
A e k k(+1,)in order to be an east-oriented state transition matrix,A n k k(+1,)is a matrix of state transitions in the north direction,
Figure 252946DEST_PATH_IMAGE002
in order to be the time of sampling,τin order to be a constant value,x(k) In order to be a state quantity,B k k+1,in order to control the input matrix,
Figure 14229DEST_PATH_IMAGE032
w(k) In order to be a noise of the process,
Figure 481113DEST_PATH_IMAGE004
Figure 644242DEST_PATH_IMAGE005
is the standard deviation of the acceleration;
the observation equation is:
z(k+1)=h(x(k))+v(k)
wherein the content of the first and second substances,z(k+1) is the matrix of the observation equations,h(x(k) Is a matrix of state observations,
Figure 967907DEST_PATH_IMAGE033
Figure 623010DEST_PATH_IMAGE007
xfor the definition of the observed quantity,x e in the east-oriented position, the position of the foot,
Figure 690323DEST_PATH_IMAGE008
in order to be the east-direction speed,
Figure 973537DEST_PATH_IMAGE009
in order to be an east-direction acceleration,x n the position of the magnetic pole is the north position,
Figure 405786DEST_PATH_IMAGE010
the speed of the vehicle is determined as the north direction speed,
Figure 344924DEST_PATH_IMAGE011
the acceleration is the acceleration in the north direction,v(k) In order to measure the noise matrix,
Figure 12665DEST_PATH_IMAGE012
a 1for the first measurement noise of the GPS positioning module,a 2for the second measurement noise of the GPS positioning module,
Figure 25752DEST_PATH_IMAGE013
Figure 222378DEST_PATH_IMAGE014
is the noise value of the GPS positioning module,v 1is the first measurement noise of the doppler log,v 2is the second measurement noise of the doppler log,
Figure 445549DEST_PATH_IMAGE015
Figure 854665DEST_PATH_IMAGE016
is the noise level of the doppler log and,w 1noise is measured for the angular velocity of the attitude reference module,
Figure 558195DEST_PATH_IMAGE034
Figure 925722DEST_PATH_IMAGE018
a noise value of the angular velocity of the attitude reference module;
and the position information determining module 42 is used for determining the position information of the wave glider according to the discrete state equation and the observation equation. A block diagram of the data processing unit is shown in fig. 3.
The filtering algorithm is extended Kalman filtering, and the recursion formula of the extended Kalman filtering is as follows:
Figure 370610DEST_PATH_IMAGE019
Figure 255521DEST_PATH_IMAGE020
wherein the content of the first and second substances,
Figure 367833DEST_PATH_IMAGE021
is composed ofk-1 time pairkThe estimation of the state value at the moment of time,fin order to be a function of the state transition,P k k|-1is composed ofkPredicted at-1 timekThe covariance of the error at the time of day,
Figure 312787DEST_PATH_IMAGE022
is composed ofkTime 1 tokThe one-step transition matrix of the time of day,
Figure 713812DEST_PATH_IMAGE023
Figure 261468DEST_PATH_IMAGE024
is composed ofk-a state estimate at time 1,P k-1is composed ofk-the mean square error of the system guess at time 1,
Figure 103653DEST_PATH_IMAGE025
x k in order to be a state equation,
Figure 547404DEST_PATH_IMAGE026
is composed ofkTime 1 tokThe one step of the time instant shifts the transpose of the matrix,R wk-1in order to be the process noise covariance,K kin order to be a matrix of gains, the gain matrix,H k in order to measure the matrix, the measurement matrix is,
Figure 498043DEST_PATH_IMAGE027
hin order to measure the function of the measurement,
Figure 318231DEST_PATH_IMAGE028
in order to transpose the measurement matrix,R vk is composed ofkThe measured noise covariance at the time of day,
Figure 749344DEST_PATH_IMAGE029
is composed ofkThe state estimate for the time of day is,y k is composed ofkThe measured value of the time of day is,P k is composed ofkThe covariance of the error at the time of day,
Figure 426313DEST_PATH_IMAGE030
Iis a matrix of the units,w k-1is the first zero-mean white noise,v k-1is the second zero mean white noise.
The embodiments in the present description are described in a progressive manner, each embodiment focuses on differences from other embodiments, and the same and similar parts among the embodiments are referred to each other. For the system disclosed by the embodiment, the description is relatively simple because the system corresponds to the method disclosed by the embodiment, and the relevant points can be referred to the method part for description.
The principles and embodiments of the present invention have been described herein using specific examples, which are provided only to help understand the method and the core concept of the present invention; meanwhile, for a person skilled in the art, according to the idea of the present invention, the specific embodiments and the application range may be changed. In view of the above, the present disclosure should not be construed as limiting the invention.

Claims (7)

1. The navigation method for the short-time positioning loss of the wave glider is characterized in that the wave glider carries a GPS positioning module, a Doppler log and a navigation attitude reference module, and comprises the following steps:
judging whether the GPS positioning module works normally or not;
if so, resolving a navigation path according to the position information provided by the GPS positioning module to obtain the navigation path;
if not, respectively acquiring the last effective position information provided by the GPS positioning module, the navigation speed information provided by the Doppler log, and the attitude information and the angular speed information provided by the navigation attitude reference module;
carrying out dead reckoning on the last effective position information, the speed information, the attitude information and the angular speed information by adopting a filtering algorithm to obtain the current position information of the wave glider;
and resolving a navigation path according to the current position information of the wave glider to obtain the navigation path.
2. The navigation method for the short-term missing positioning of the wave glider according to claim 1, characterized in that the navigation method further comprises:
and carrying out coordinate transformation on the navigation speed information provided by the Doppler log to obtain east speed information and north speed information.
3. The method as claimed in claim 1, wherein the dead reckoning the last valid position information, the velocity information, the attitude information and the angular velocity information by using a filtering algorithm to obtain the position information of the wave glider comprises:
constructing a discrete state equation and an observation equation of wave glider dead reckoning; the discrete state equation is:
x(k+1)=A k k+1, x(k)+B k+1,k w(k)
wherein the content of the first and second substances,x(k+1) is a matrix of discrete state equations,kin order to update the number of times,A k k+1,in order to be a state transition matrix,A k k+1, =diag[A e k k(+1,),A n k k(+1,)],
Figure 74810DEST_PATH_IMAGE001
A e k k(+1,)in order to be an east-oriented state transition matrix,A n k k(+1,)in the form of a northbound state transition matrix,
Figure 726371DEST_PATH_IMAGE002
in order to be the time of the sampling,τin order to be a constant value,x(k) In order to be a state quantity,B k k+1,in order to control the input matrix,
Figure 178212DEST_PATH_IMAGE003
w(k) In order to be a noise of the process,
Figure 511105DEST_PATH_IMAGE004
Figure 935264DEST_PATH_IMAGE005
is the standard deviation of the acceleration;
the observation equation is:
z(k+1)=h(x(k))+v(k)
wherein the content of the first and second substances,z(k+1) is the matrix of the observation equations,h(x(k) Is a matrix of state observations,
Figure 429830DEST_PATH_IMAGE006
Figure 634547DEST_PATH_IMAGE007
xfor the definition of the observed quantity,x e in the east-oriented position, the position of the foot,
Figure 567868DEST_PATH_IMAGE008
in order to be the east-direction speed,
Figure 908850DEST_PATH_IMAGE009
in order to be an east-direction acceleration,x n the position of the north direction is the position of the north direction,
Figure 488564DEST_PATH_IMAGE010
in order to determine the speed in the north direction,
Figure 914997DEST_PATH_IMAGE011
the acceleration in the north direction is taken as the acceleration,v(k) In order to measure the noise matrix,
Figure 589692DEST_PATH_IMAGE012
a 1for the first measurement noise of the GPS positioning module,a 2for the second measurement noise of the GPS positioning module,
Figure 50760DEST_PATH_IMAGE013
Figure 418288DEST_PATH_IMAGE014
is the noise value of the GPS positioning module,v 1is the first measurement noise of the doppler log,v 2as a second Doppler logThe noise is measured and, in addition,
Figure 597596DEST_PATH_IMAGE015
Figure 810403DEST_PATH_IMAGE016
is the noise value of the doppler log,w 1noise is measured for the angular velocity of the attitude reference module,
Figure 391557DEST_PATH_IMAGE017
Figure 664406DEST_PATH_IMAGE018
a noise value of the angular velocity of the attitude reference module;
and determining the position information of the wave glider according to the discrete state equation and the observation equation.
4. The method for navigating missing wave glider short-term localization according to claim 1, wherein the filtering algorithm is extended kalman filtering.
5. The navigation method for short-term missing positioning of a wave glider according to claim 4, wherein the recurrence formula of the extended Kalman filter is:
Figure 127749DEST_PATH_IMAGE019
Figure 144246DEST_PATH_IMAGE020
wherein the content of the first and second substances,
Figure 314328DEST_PATH_IMAGE021
is composed ofk-1 time pairkThe estimation of the state value at the moment of time,fis changed to a stateThe function of the shift is carried out,P k k|-1is composed ofkPredicted at-1 timekThe covariance of the error at the time of day,
Figure 23658DEST_PATH_IMAGE022
is composed ofkTime 1 tokThe one-step transition matrix of the time of day,
Figure 911979DEST_PATH_IMAGE023
Figure 732168DEST_PATH_IMAGE024
is composed ofk-a state estimate at time 1,P k-1is composed ofk-the mean square error of the system guess at time 1,
Figure 22335DEST_PATH_IMAGE025
x k in order to be a state equation,
Figure 902566DEST_PATH_IMAGE026
is composed ofkTime 1 tokThe one step of time instants shifts the transpose of the matrix,R wk-1in order to be the process noise covariance,K kin order to be a matrix of gains, the gain matrix,H k in order to measure the matrix, the measurement matrix is,
Figure 278184DEST_PATH_IMAGE027
hin order to measure the function of the measurement,
Figure 636484DEST_PATH_IMAGE028
in order to transpose the measurement matrix,R vk is composed ofkThe measured noise covariance at the time of day,
Figure 718841DEST_PATH_IMAGE029
is composed ofkThe state estimate for the time of day is,y k is composed ofkThe measured value of the time of day is,P k is composed ofkThe covariance of the error at the time of day,
Figure 504394DEST_PATH_IMAGE030
Iis a matrix of the units,w k-1is the first zero-mean white noise,v k-1is the second zero-mean white noise.
6. A wave glider short-time missing-fix navigation system, comprising: carry on GPS orientation module, Doppler log and the reference module of attitude and heading on wave glider to and data processing unit, data processing unit includes:
the judging subunit is used for judging whether the GPS positioning module works normally or not;
the first navigation path resolving subunit is used for resolving a navigation path according to the position information provided by the GPS positioning module to obtain the navigation path when the GPS positioning module works normally;
the information acquisition subunit is used for respectively acquiring the last effective position information provided by the GPS positioning module, the navigation speed information provided by the Doppler log and the attitude information and the angular speed information provided by the navigation attitude reference module when the GPS positioning module works abnormally;
the dead reckoning operator unit is used for carrying out dead reckoning on the last effective position information, the speed information, the attitude information and the angular speed information by adopting a filtering algorithm to obtain the current position information of the wave glider;
and the second navigation path resolving subunit is used for resolving the navigation path according to the current position information of the wave glider to obtain the navigation path.
7. The wave glider short-time missing-fix navigation system of claim 6, wherein the data processing unit further comprises:
and the coordinate conversion subunit is used for carrying out coordinate conversion on the speed information provided by the Doppler log for navigation to obtain east speed information and north speed information.
CN202210610414.0A 2022-06-01 2022-06-01 Navigation method and system for short-time positioning missing of wave glider Pending CN114689039A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210610414.0A CN114689039A (en) 2022-06-01 2022-06-01 Navigation method and system for short-time positioning missing of wave glider

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210610414.0A CN114689039A (en) 2022-06-01 2022-06-01 Navigation method and system for short-time positioning missing of wave glider

Publications (1)

Publication Number Publication Date
CN114689039A true CN114689039A (en) 2022-07-01

Family

ID=82131257

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210610414.0A Pending CN114689039A (en) 2022-06-01 2022-06-01 Navigation method and system for short-time positioning missing of wave glider

Country Status (1)

Country Link
CN (1) CN114689039A (en)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110906933A (en) * 2019-11-06 2020-03-24 中国海洋大学 AUV (autonomous Underwater vehicle) auxiliary navigation method based on deep neural network
CN111829512A (en) * 2020-06-08 2020-10-27 中国航天空气动力技术研究院 AUV navigation positioning method and system based on multi-sensor data fusion

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110906933A (en) * 2019-11-06 2020-03-24 中国海洋大学 AUV (autonomous Underwater vehicle) auxiliary navigation method based on deep neural network
CN111829512A (en) * 2020-06-08 2020-10-27 中国航天空气动力技术研究院 AUV navigation positioning method and system based on multi-sensor data fusion

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
于佩元: "水下滑翔机航位推算与自适应控制研究", 《中国优秀硕士学位论文全文数据库工程科技II辑》 *

Similar Documents

Publication Publication Date Title
CN106767752B (en) Combined navigation method based on polarization information
CN112505737B (en) GNSS/INS integrated navigation method
CN108594271B (en) Composite layered filtering-based anti-deception-interference combined navigation method
CN111060943B (en) Weight determining method conforming to practical GNSS observation value
CN104154916A (en) Vehicle positioning device based on laser gyroscope strapdown inertial measurement unit
US10194269B2 (en) Systems and methods for using doppler measurements to estimate a position of a receiver
CN110823215A (en) Unmanned aerial vehicle relative navigation information fusion method
CN112859133B (en) Ship depth fusion positioning method based on radar and Beidou data
CN114488230A (en) Doppler positioning method and device, electronic equipment and storage medium
CN111750865A (en) Self-adaptive filtering navigation method for dual-function deep sea unmanned submersible vehicle navigation system
Sirikonda et al. Integration of low-cost IMU with MEMS and NAVIC/IRNSS receiver for land vehicle navigation
KR20110114039A (en) Dr/gps data fusion method
CN112083425A (en) SINS/LBL tight combination navigation method introducing radial velocity
CN112229406A (en) Redundancy guide full-automatic landing information fusion method and system
CN114689039A (en) Navigation method and system for short-time positioning missing of wave glider
CN111256708A (en) Vehicle-mounted integrated navigation method based on radio frequency identification
Kaewket et al. Investigate GPS signal loss handling strategies for a low cost multi-GPS system based Kalman filter
Liu et al. A covariance shaping filtering method for tightly-coupled MIMU/GNSS of UAV
RU2202102C2 (en) Procedure establishing positions of mobile objects and device for its realization
CN110187377B (en) Method and device for navigation and positioning of mobile device
CN112904382B (en) Laser odometer-assisted rapid optimization satellite selection method under urban canyon environment
CN112229401B (en) Measurement information synchronous extrapolation method and system suitable for INS-GPS pseudo range fusion
Kis et al. Development of state estimation system with INS, magnetometer and carrier phase GPS for vehicle navigation
Kim et al. Kalman–Hatch dual‐filter integrating global navigation satellite system/inertial navigation system/on‐board diagnostics/altimeter for precise positioning in urban canyons
Luo et al. Combined Positioning Method of Port AGV based on Beidou Difference and Inertial Navigation Technology

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication

Application publication date: 20220701

RJ01 Rejection of invention patent application after publication