Invention Grant
- Patent Title: Motion constraint-aided underwater integrated navigation method employing improved Sage-Husa adaptive filtering
-
Application No.: US17779167Application Date: 2021-07-28
-
Publication No.: US11754400B2Publication Date: 2023-09-12
- Inventor: Xiyuan Chen , Siyi Zhang , Xiaotian Zhang , Junwei Wang
- Applicant: SOUTHEAST UNIVERSITY
- Applicant Address: CN Nanjing
- Assignee: SOUTHEAST UNIVERSITY
- Current Assignee: SOUTHEAST UNIVERSITY
- Current Assignee Address: CN Nanjing
- Agency: BAYRAMOGLU LAW OFFICES, LLC
- Priority: CN 2010772026.3 2020.08.04
- International Application: PCT/CN2021/108862 2021.07.28
- International Announcement: WO2022/028286A 2022.02.10
- Date entered country: 2022-05-24
- Main IPC: G01C21/20
- IPC: 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.
Public/Granted literature
Information query
IPC分类: