# US 2022/0033100 A1 · Dual-filter-based transfer alignment method under dynamic deformation

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2022/0033100 A1
- Document ID: US20220033100A1
- Status: Published application
- Kind: A1
- Application number: 17/275,506
- Filed: 2020-04-15
- Published: 2022-02-03
- Earliest claimed: 2019-05-17
- Assignees: Southeast University
- Applicants: Southeast University
- Inventors: Xiyuan CHEN; Ping YANG; Lin FANG; Junwei WANG
- Web page: https://patentgrep.com/patent/US20220033100A1

## CPC

- B64D 45/00: Aircraft indicators or protectors not otherwise provided for
- B64D 45/0005: {Devices specially adapted to indicate the position of a movable element of the aircraft, e.g. landing gear}
- G01C 21/16: by integrating acceleration or speed, i.e. inertial navigation
- G01C 25/005: {initial alignment, calibration or starting-up of inertial devices}
- B64D 2045/0085: {Devices for aircraft health monitoring, e.g. monitoring flutter or vibration}
- B64D: EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- G01C: MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY (measuring liquid level G01F; radio navigation, determining distance or velocity by use of propagation effects, e.g. Doppler effects, propagation time, of radio waves, analogous arrangements using other waves G01S)

## Abstract

A dual-filter-based transfer alignment method under dynamic deformation. A dynamic deformation angle generated under dynamic deformation and a coupling angle between dynamic deformation and body motion will reduce the accuracy of transfer alignment; and a transfer alignment filter is divided into two parts, the first part estimates a bending deformation angle and the coupling angle, and uses an attitude matching method, and the second part estimates a dynamic lever arm, and uses a “speed plus angular speed” matching method.

## Claims

### Claim 1

A dual-filter-based transfer alignment method under dynamic deformation, applied to an aircraft wing deformation measurement system, in which a main inertial navigation system is installed in a cabin and inertial navigation subsystems are installed on the wings, wherein the method comprises the following steps:
generating attitude, speed and position information of the main inertial navigation system and outputs of a gyro and an accelerometer by using a trajectory generator, simulating flexural deformation angle {right arrow over (θ)} and flexural deformation angular speed {dot over ({right arrow over (θ)})} between the main inertial navigation system and the inertial navigation subsystems by using a second-order Markov, carrying out geometric analysis on the flexural deformation, and deriving an expression of coupling angle Δ{right arrow over (ϕ)} resulted from dynamic deformation of the carrier and movement of the carrier;
using the flexural deformation angle, the flexural deformation angular speed and the coupling angle as state quantities, and establishing a model of filter 1 with an attitude matching method;
establishing a dynamic lever arm model by using the flexural deformation angle and the coupling angle estimated in step (2), and deriving an expression of speed error and an expression of angular speed error;
establishing a model of filter 2 by using the expression of speed error and expression of angular speed error derived in step (3) with a “speed+angular speed” matching method, estimating the initial attitude error of the inertial navigation subsystems, and using this error for initial attitude calibration of the inertial navigation subsystems, so as to accomplish a transfer alignment process.

### Claim 2 (depends on 1)

The dual-filter-based transfer alignment method under dynamic deformation according to claim 1, wherein in step (1), the geometrical analysis on the flexural deformation is carried out and the expression of coupling angle Δ{right arrow over (ϕ)} resulted from the dynamic deformation of the carrier and movement of the carrier is derived as follows:
Δ{right arrow over (ϕ)}=M{right arrow over (ω)}θ,
wherein, {right arrow over (ω)}θ={dot over ({right arrow over (θ)})}, and M is expressed as:
⁢
M
=
[
0
0
-
1
ω
⁢
?
-
1
ω
⁢
?
0
0
0
-
1
ω
⁢
?
0
]
,
⁢
?
⁢
indicates text missing or illegible when filed
wherein, ωisxs, ωisys′ and ωiszs′ represent the ideal angular speeds of the inertial navigation subsystems in east, north, and sky directions respectively.

### Claim 3 (depends on 2)

The dual-filter-based transfer alignment method under dynamic deformation according to claim 2, wherein in step (2), the flexural deformation angle, the flexural deformation angular speed and the coupling angle are used as state quantities and the model of filter 1 is established with an attitude matching method as follows:
the state quantities of the filter 1 are selected as follows:
x1=[δ{right arrow over (ϕ)} {right arrow over (ε)}y {right arrow over (ρ)}0 {right arrow over (θ)} {dot over ({right arrow over (θ)})} Δ{right arrow over (ϕ)}]r,
wherein, δ{right arrow over (ϕ)} represents attitude error, {right arrow over (ε)}y represents zero drift of gyro measurement in the subsystem, and {right arrow over (ρ)}0 represents initial installation angle error between the main system and the subsystem;
the state equation of filter 1 is:
{dot over (x)}1=F1x1+G1w1,
wherein, F1 represents the state transition matrix of filter 1, G1 represents the system noise distribution matrix of filter 1, w1 represents the system noise of filter 1, the state transition matrix F1 is expressed as:
⁢
F
1
=
[
(
-
ω
⁢
?
×
)
-
C
⁢
?
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
I
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
B
1
B
2
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
F
64
F
65
0
3
×
3
]
,
⁢
?
⁢
indicates text missing or illegible when filed
wherein, {right arrow over (ω)}inn represents the rotation of the navigation system with respect to the inertial system, {right arrow over (ω)}innx represents an antisymmetric matrix, Cs′m represents a transformation matrix between the ideal coordinate system of the subsystem and the navigation coordinate system, and
B
1
=
[
0
-
2
⁢
β
y
0
0
0
-
2
⁢
β
z
-
2
⁢
β
x
0
0
]
B
2
=
[
0
-
β
y
2
0
0
0
-
β
z
2
-
β
x
2
0
0
]
,
βi(i=x, y, z) represent the coefficients of the second-order Markov model in east, north, and sky directions, P=MB2, F65=MB1;
the system measurement equation is:
y
1
=
H
1
⁢
x
1
+
μ
1
,
wherein, y1 represents the difference between the true value of attitude and the estimated value from the filter, H1 represents the measurement matrix of the filter 1, and μ1 represents the measurement noise in the filter 1.

### Claim 4 (depends on 2)

The dual-filter-based transfer alignment method under dynamic deformation according to claim 2, wherein the expression of speed error and the expression of angular speed error are derived in step (3) as follows:
the expression of angular speed error is as follows:
Δ
⁢
⁢
ω
→
=
(
ω
→
⁢
?
×
)
⁢
φ
→
+
(
ω
→
⁢
?
×
)
⁢
Δ
⁢
⁢
ϕ
→
+
A
⁡
(
ω
→
⁢
?
)
⁢
u
→
⁢
?
-
A
⁡
(
ω
→
⁢
?
)
⁡
[
(
π
2
⁢
U
-
Δ
⁢
⁢
ϕ
→
)
×
]
⁢
u
→
⁢
?
,
⁢
?
⁢
indicates text missing or illegible when filed
wherein, θimm represents the angular speed of the main system in the coordinate system of the main system, {right arrow over (φ)} represents the ideal error angle between the main system and the subsystem, A({right arrow over (ω)}0) represent an amplitude matrix, {right arrow over (u)}iss represents the identity matrix in the direction of {right arrow over (ω)}iss, and {right arrow over (ω)}iss represents the angular speed of the subsystem under the coordinate system of the subsystem, U=[1 1 1]T;
the expression of speed error is as follows:
δ
⁢
⁢
v
→
.
=
-
(
2
⁢
ω
⁢
?
+
ω
⁢
?
)
×
δ
⁢
⁢
v
→
+
R
0
⁢
B
0
⁢
θ
+
(
2
⁢
(
ω
⁢
?
×
)
⁢
R
0
+
R
0
⁢
B
1
)
⁢
θ
→
~
+
C
⁢
?
⁢
∇
i
⁢
+
R
0
⁢
Δ
⁢
⁢
ϕ
→
~
+
[
(
ω
→
⁢
?
×
)
⁢
(
ω
→
⁢
?
×
)
+
(
ω
→
⁢
?
×
)
]
⁢
δ
⁢
⁢
r
→
+
(
f
⁢
?
×
)
⁢
Δ
⁢
⁢
ϕ
→
+
[
(
ω
→
⁢
?
×
)
⁢
(
ω
→
⁢
?
×
)
+
(
ω
→
.
×
)
]
⁢
r
→
θ
,
⁢
?
⁢
indicates text missing or illegible when filed
{right arrow over (ω)}inn wherein, represents the rotation of the navigation system caused by the rotation of the earth, {right arrow over (ω)}imn represents the rotation of the navigation system caused by the curvature of the surface of the earth as the subsystem moves on the surface of the earth, θ{right arrow over (ν)}={right arrow over (ν)}sn−{right arrow over (ν)}mn, {right arrow over (ν)}mn and {right arrow over (ν)}sn represent the speed vectors of the main system and the subsystem in the navigation coordinate system, {right arrow over (θ)} represents the flexural deformation angle between the main inertial navigation system and the inertial navigation subsystem, Δ{right arrow over (ϕ)} represents the coupling angle between the main inertial navigation system and the inertial navigation subsystem, {right arrow over (ω)}imn represents the angular speed of the main system in the navigation system, Crm represents the transformation matrix between the subsystem and the navigation coordinate system, {right arrow over (∇)}s′ represents the zero drift of accelerometer measurement of the subsystem, ftN represents the specific force of the subsystem in the navigation coordinate system, β{right arrow over (r)} represents dynamic lever arm, {right arrow over (r)}0=[x0 y0 z0]r represents static lever arm, x0 y0 z0 represent static lever arms in east, north, and sky directions respectively, and R0 can be expressed as:
R
0
=
[
0
z
0
0
0
0
x
0
y
0
0
0
]
.

### Claim 5 (depends on 4)

The dual-filter-based transfer alignment method under dynamic deformation according to claim 4, wherein in step (4), the model of filter 2 is established with a “speed+angular speed” matching method, the equation of measurement quantities is established by using the expression of speed error and the expression of angular speed error derived in step (3), and a Kalman filter model is established as follows:
the state quantities of the Kalman filter 2 are selected as follows:
x2=[β{right arrow over (ν)} {right arrow over (∇)}λ {right arrow over (θ)} {dot over ({right arrow over (θ)})} δ{right arrow over (r)}]r,
wherein, β{right arrow over (ν)} represents the speed error, and {right arrow over (∇)}λ represents the zero drift of accelerometer measurement of the subsystem;
the state equation of the filter is:
x
.
2
=
F
2
⁢
x
2
+
G
2
⁢
w
2
,
wherein, G2 represents the system noise distribution matrix of filter 2, w2 represents the system noise of filter 2, and the state transition matrix F2 is expressed as:
F
2
=
[
F
11
C
3
n
F
13
F
14
F
15
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
I
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
B
1
B
2
0
3
×
3
0
3
×
3
0
3
×
3
F
53
F
54
0
3
×
3
]
,
wherein, F11=−[(2ωn+ωn)x], F13=R0B2+R0M(B1B2+B2), F14=(2(ωnx)R0+R0B1)+R0MB12, F15=[({right arrow over (ω)}nx)({right arrow over (ω)}nx)+({dot over ({right arrow over (ω)})}nx)], F53=R0MB2, F54=R0+R0MB3, and the system measurement equation is as follows:
y
2
=
H
2
⁢
x
2
+
μ
2
,
wherein, y2 represents the difference between the true value of speed or angular speed and the estimated value from the filter, μ2 represents the measurement noise in the filter 2, and
⁢
H
2
=
[
I
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
0
3
×
3
(
ω
→
⁢
?
×
)
I
3
×
3
0
3
×
3
]
.
⁢
?
⁢
indicates text missing or illegible when filed
