Alignment method of an underwater large misalignment angle based on SINS (Strapdown Inertial Navigation System)/DVL (Doppler Velocity Log) of SRQKF (Square-root Quadrature Kalman Filter)

A technology with a large misalignment angle and a configuration method, which is applied in the field of strapdown inertial navigation and integrated navigation, and can solve the problems of low accuracy, slow convergence speed, and inability to obtain high accuracy.

Active Publication Date: 2016-07-27
SOUTHEAST UNIV
View PDF7 Cites 13 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0003] However, since the hull is always in a state of large misalignment angle and shaking, the conventional linear error model cannot accurately describe the error propagation characteristics of SINS. It is necessary to establish a more accurate nonlinear error model, and use the nonlinear filtering method to complete the initial alignment
[0004] In recent years, various nonlinear filtering methods - Extended K

Method used

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
View more

Image

Smart Image Click on the blue labels to locate them in the text.
Viewing Examples
Smart Image
  • Alignment method of an underwater large misalignment angle based on SINS (Strapdown Inertial Navigation System)/DVL (Doppler Velocity Log) of SRQKF (Square-root Quadrature Kalman Filter)
  • Alignment method of an underwater large misalignment angle based on SINS (Strapdown Inertial Navigation System)/DVL (Doppler Velocity Log) of SRQKF (Square-root Quadrature Kalman Filter)
  • Alignment method of an underwater large misalignment angle based on SINS (Strapdown Inertial Navigation System)/DVL (Doppler Velocity Log) of SRQKF (Square-root Quadrature Kalman Filter)

Examples

Experimental program
Comparison scheme
Effect test

Embodiment Construction

[0112] The present invention will be further described below in conjunction with the accompanying drawings.

[0113] Such as figure 1 with figure 2 Shown is the system scheme diagram and alignment principle diagram of the present invention.

[0114]The SINS strapdown settlement module collects the gyroscope output value and the accelerometer output value output by the inertial measurement unit (IMU) module for strapdown calculation, and obtains attitude angle, attitude matrix, speed, position and other information; DVL equipment works underwater, Output the speed information of the carrier; the information output by SINS and DVL is input to the SRQKF filter at the same time, and the information is filtered. The filtering process is as follows:

[0115] 1. According to the characteristics of SINS / DVL under the condition of large misalignment angle underwater, select a 10-bit state vector:

[0116]

[0117] The nonlinear state filter equation is established:

[0118] ...

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

PUM

No PUM Login to view more

Abstract

The invention discloses an alignment method of an underwater large misalignment angle based on SINS (Strapdown Inertial Navigation System)/DVL (Doppler Velocity Log) of SRQKF (Square-root Quadrature Kalman Filter). The alignment method comprises the following steps: step 1: establishing a nonlinear error model and a nonlinear filtering equation of the SINS under the large misalignment angle; step 2: constructing the SRQKF by utilizing a multivariate Gauss point and coefficient configuration method and a square-root filtering method in Gauss-Hermite quadrature; and step 3: estimating the misalignment angle by utilizing the SRQKF, and correcting a strapdown attitude matrix, thus obtaining accurate strapdown attitude matrix and attitude angle. The alignment method disclosed by the invention has the advantage that the underwater alignment accuracy and alignment speed of the carrier strapdown system are improved.

Description

technical field [0001] The invention relates to the technical field of strapdown inertial navigation and integrated navigation, in particular to an SRQKF-based SINS / DVL underwater large misalignment angle alignment method. Background technique [0002] Initial alignment is related to the working accuracy of the inertial system, and is one of the key technologies in the strapdown inertial navigation system (SINS). Due to the complex sea conditions, the hull of the underwater vehicle is generally in a state of large shaking, so that the strapdown inertial navigation system cannot quickly complete self-alignment, and is in a state of large misalignment angle for a long time. In this case, it is necessary to use external information assistance to complete the initial alignment of the moving base and large misalignment angles. Underwater vehicles usually accomplish this task with the aid of Doppler Logs (DVL). [0003] However, since the hull is always in a state of large misal...

Claims

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

Application Information

Patent Timeline
no application Login to view more
IPC IPC(8): G01C25/00
CPCG01C25/005
Inventor 徐晓苏杨博徐祥周峰王捍兵田泽鑫
Owner SOUTHEAST UNIV
Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Try Eureka
PatSnap group products