Motion constraint-aided underwater integrated navigation method employing improved Sage-Husa adaptive filtering

    公开(公告)号:US11754400B2

    公开(公告)日:2023-09-12

    申请号:US17779167

    申请日:2021-07-28

    CPC classification number: G01C21/20 G01C21/16

    Abstract: A motion constraint-aided underwater integrated navigation method employing improved Sage-Husa adaptive filtering includes establishing a Doppler log error model; constructing a state equation for an underwater integrated navigation system employing Kalman filtering; according to a relationship between a centripetal acceleration and a forward velocity of an underwater vehicle, establishing a constraint condition, and constructing a complete motion constraint model; establishing two measurement equations; and establishing a filter equation, conducting calculation by using a standard Kalman filtering algorithm when an underwater glider normally runs, and conducting time updating, measurement updating and filtering updating by using an improved Sage-Husa adaptive filtering algorithm when a measurement noise varies. The motion constraint-aided underwater integrated navigation method improves a filtering accuracy of the underwater integrated navigation system, restrains a filter divergence and has robustness and reliability.

    Method for decoupling angular velocity in transfer alignment process under dynamic deformation

    公开(公告)号:US11293759B2

    公开(公告)日:2022-04-05

    申请号:US16980860

    申请日:2019-03-12

    Abstract: A method for decoupling an angular velocity in a transfer alignment process under a dynamic deformation includes: (1) generating, by a trajectory generator, information about an attitude, a velocity, and a position of a main inertial navigation system and an output of an inertial device, and simulating a bending deformation angle {right arrow over (θ)} between the main inertial navigation system and a slave inertial navigation system and a bending deformation angular velocity {right arrow over (ω)}θ by using second-order Markov; (2) decomposing the dynamic deformation into a vibration deformation and a bending deformation, and establishing an angular velocity model under the dynamic deformation of a wing; (3) deducing an error angle Δ{right arrow over (ϕ)} between the main inertial navigation system and the slave inertial navigation system; and (4) deducing an expression Δ{right arrow over (ω)} of a coupling error angular velocity, and applying that to an angular velocity matching process of transfer alignment to improve the precision of the transfer alignment.

    Strict reverse navigation method for optimal estimation of fine alignment

    公开(公告)号:US11650077B2

    公开(公告)日:2023-05-16

    申请号:US17289737

    申请日:2020-12-02

    Abstract: A strict reverse navigation method for optimal estimation of fine alignment is provided. The strict reverse navigation method including: establishing an adaptive control function; performing a forward navigation calculation process; performing a reverse navigation calculation process; and performing the adaptive control for a number of forward and reverse calculations. The strict reverse navigation method shortens an alignment time for the optimal estimation of fine alignment while ensuring an alignment accuracy. The strict reverse navigation method provided effectively solves a problem that an error of an initial value of filtering in an initial stage of the optimal estimation of fine alignment affects convergence speeds of subsequent stages. In the initial stage, a larger number of the forward and reverse navigation calculations are adopted to reduce an error of the initial value as much as possible and increase a convergence speed of the filtering.

    Joint non-coherent integral vector tracking method based on spatial domain

    公开(公告)号:US10663599B2

    公开(公告)日:2020-05-26

    申请号:US15511046

    申请日:2016-06-27

    Abstract: The present invention discloses a joint non-coherent integral vector tracking method based on a spatial domain, which is used for further improving the performance of a vector tracking GPS (Global Positioning System) receiver. In a new vector tracking strategy design, a phase discriminator/a frequency discriminator in a traditional vector tracking loop is discarded, and baseband signals of visible satellites in each channel are taken as an observation value after performing non-coherent integration, and EKF (abbreviation of Extended Kalman Filter) is used to estimate directly and to solve the position, the velocity, a clock error, etc. of the GPS receiver. Because of the existence of non-coherent integral calculation, when GPS satellite signals are relatively weak, a carrier to noise ratio of an observation value may be effectively improved, and the tracking sensitivity is improved.

Patent Agency Ranking