(2) background technology
Inertial navigation utilizes inertance element to measure the line of motion acceleration and the angular velocity of carrier, goes out speed and the position of carrier with respect to the earth in prediction on such basis, and the information such as attitude of carrier.Strap-down inertial navigation system has omitted accurate stable platform and control gear, the design of system is greatly simplified, cost reduces significantly, compare with the platform inertial navigation that to have a volume little, in light weight, cost is low, the reliability height, be convenient to advantages such as maintenance, therefore obtain application more and more widely, the military inertial navigation system of the U.S. has just accounted for 90% strapdown in 1994.
In actual conditions, the influence of many factors such as the naval vessel is subjected to serviceable life, wave stroke, solar radiation, the operation of coming about, hull load, the capital causes the ship deck distortion, and the distortion meeting of ship deck produces very important influence to the fast initial alignment of each local inertial navigation equipment on the naval vessel.The deck distortion generally includes dynamic deformation and static deformation.Wherein the deck static angular distortion on naval vessel mainly is subjected to the influence of factors such as long, institute's cargo in serviceable life on naval vessel, fuel change and Exposure to Sunlight.Static angular is not constant all the time, just the cycle of angle variation is long, think constant in time at short aligning, according to the relevant afloat measuring reports in naval vessel, and show that in the measured experimental data of different sea condition sea trials the deflection among a day can reach 1 °~1.5 °.Therefore, how to measuring significant based on the ship deck static deformation of optical fibre gyro.
Alignment procedures exists the contradiction between rapidity and the accuracy, in order to solve steady, fast, the accurate coordination problem of alignment procedures, consider to make full use of the output information of the inertia assembly of the navigation information of naval vessel master's inertial navigation and carrier-borne equipment, carry out Transfer Alignment, can significantly reduce the aligning time and obtain good alignment precision, and distortion angle, deck has a strong impact on the effect of fast transfer alignment.Traditional method of utilizing optical correction instrument calibration distortion angle need provide expensive instrument, needs to lay the light path of calibration usefulness simultaneously, does not have practicality on large ship.
(3) summary of the invention
The object of the present invention is to provide a kind of a kind of method that ship deck static deformation angle is measured that can effectively measure for ship deck static deformation angle.
The object of the present invention is achieved like this: mainly comprise following steps:
(1) by the installation calibrating of machinery and optical instrument, the attitude and the center inertial navigation of the local inertial navigation in local deck are consistent, center, naval vessel strapdown inertial navitation system (SINS) pipeline start up by preheating also begins initial alignment;
(2) enter navigational state after center, naval vessel strapdown inertial navitation system (SINS) initial alignment finishes, the center inertial navigation system resolves by self, attitude, position, velocity information after obtaining resolving;
(3) the inertial navigation equipment pipeline start up by preheating of the carrier-borne equipment in local deck, the optical fibre gyro of the carrier-borne equipment in deck and quartz accelerometer begin to gather specific force and angular velocity information, and with the information that collects by the navigation calculation unit of cable transmission to self, the information transmission that the center strapdown inertial navitation system (SINS) is calculated by transmission cable is to the navigation calculation unit of the carrier-borne equipment in local deck simultaneously;
(4) the navigation calculation unit of the carrier-borne equipment in local deck receives the navigation data of storage center, naval vessel strapdown inertial navitation system (SINS), utilizes attitude data information to set up the carrier coordinate system of calculating carrier-borne equipment inertial navigation
And navigation coordinate is the transition matrix between the n, promptly initial strapdown matrix
, and be object with the dynamic deformation angle;
(5) setting up with the local deck static deformation angle error of two cover inertial navigation system misalignment sum of errors is the Kalman filtering state equation of state variable, is the measurement equation of measurement amount with both attitude differences, goes out deck static deformation angle by Kalman Filter Estimation.
Described Kalman filtering state equation is:
Wherein:
Be the velocity contrast of two cover inertial reference calculations, f is the specific force that the local inertial navigation in local deck records, w
IeBe the angular velocity of earth movements, w
EnFor navigation is the angular velocity that the relative earth is, φ is
And the angle between m system, ξ are the deck static deformation angle between s and m system, and η (t) is a dynamic deformation angular velocity, ω
NmThe angular velocity that the relative navigation of measuring for the center inertial navigation is; ε
sBe the local inertial navigation gyroscopic drift in local deck measuring error.
Described measurement equation is:
z=Hx+v(t)
Wherein: measurement amount z=[φ
xφ
yφ
y]
T, H is for measuring matrix, and v is the measurement noise battle array, and φ is
And the angle between m system.
The present invention utilizes the navigation information of naval vessel master's inertial navigation and the inertia assembly output information of carrier-borne equipment to carry out matched filtering, estimates distortion angle, deck.In the rapid alignment process, the present invention considers the deck is out of shape the angle as a state variable, and it is estimated to obtain being out of shape the angle, and is deformation-compensated to be used for.Method of the present invention has following advantage: (1) directly utilizes center, naval vessel inertial navigation system and local inertial navigation system information, does not need special change mounting structure; (2) can utilize the Kalman Filter Technology of present research comparative maturity to carry out Filtering Estimation, adopt numerical approach, have good reliability; (3) method does not require that the naval vessel at the uniform velocity sails through to motion, has more practicality.
Beneficial effect of the present invention is verified by following policy:
(1) Matlab emulation
Under following simulated conditions, this method is carried out emulation experiment:
Strapdown inertial navitation system (SINS) is done the three-axis swinging motion of different amplitudes.Carrier waves around yaw angle, pitch angle and roll angle with sinusoidal rule, and its mathematical model is:
pitch=pitchm·sin(ω
ψ+φ
ψ)
roll=rollm·sin(ω
θ+φ
θ)
yaw=yawm·sin(ω
γ+φ
γ)+yawk
Wherein: pitch, roll, yaw represent the angle variables around pitch angle, roll angle and yaw angle respectively; Pitchm, rollm, yawm represent to wave accordingly the angle amplitude respectively; ω
ψ, ω
θ, ω
γRepresent corresponding angle of oscillation frequency respectively; φ
ψ, φ
θ, φ
γRepresent corresponding initial phase respectively; And ω
i=2 π/T
i, i=ψ, θ, γ, T
iRepresent corresponding rolling period; Yawk is the angle, initial heading.
The correlation parameter of emulation:
Sampling period: 0.05s;
Under the orderly sea: pitchm=1 °, rollm=1.5 °, yawm=1 °;
Under the medium sea situation: pitchm=5 °, rollm=6 °, yawm=5 °;
Two kinds of sea situations all satisfy: T
ψ=6s, T
θ=9s, T
γ=8s, yawk=30 °;
Carrier initial position: 45.7796 ° of north latitude, 126.6705 ° of east longitudes;
Deck static deformation angle: 1 ° at lateral error angle, 1 ° at longitudinal error angle, 1.5 ° at course error angle;
Equatorial radius: R=6378393.0m;
Ellipsoid degree: e=3.367e-3;
Earth surface acceleration of gravity: g
0=9.78049;
Rotational-angular velocity of the earth (radian per second): 7.2921158e-5;
The gyroscope constant value drift: 0.01 degree/hour;
Gyroscope white noise error: 0.005 degree/hour;
Accelerometer bias: 10
-4g
0
Accelerometer white noise error: 5 * 10
-5g
0:
The vertical static deformation angle evaluated error of orderly sea lower decks, the horizontal static deformation angle in deck and deck bow to static deformation angle evaluated error curve respectively as Fig. 1, Fig. 2 and shown in Figure 3; The vertical static deformation angle error of medium sea situation lower decks, the horizontal static deformation angle in deck and deck bow to the static deformation angle graph of errors respectively as Fig. 4, Fig. 5 and shown in Figure 6.
Under two kinds of sea situations, it is the estimation procedure difference, estimated result much at one, can both Fast estimation go out distortion angle, deck, under the Ship Motion condition of reality, this method does not require at the uniform velocity direct route, only need carry out certain rolling, pitching and bow stern shakes motion, be easy to realize for the naval vessel, and can reduce distortion angle estimated time when amplitude suitably increases, the raising alignment precision when waving.Adopt method of the present invention can obtain higher deck static deformation angle estimated accuracy.
(2) three-axle table of fiber-optic gyroscope strapdown inertial navigation system experiment
Fiber-optic gyroscope strapdown inertial navigation system and certain high-precision inertial navigation system of development voluntarily are fixedly installed togather, are placed on afterwards and carry out three-axis swinging experiment on the three-axle table, the navigate device precision and the experimental situation of appearance system of used fiber-optic gyroscope strapdown is as follows in the experiment:
Measure deck static deformation angle before the experiment: vertical 0.0694 °, horizontal 0.0641 °, course-1.3340 °;
Gyroscope constant value drift: 0.01 °/h;
Gyroscope white noise error: 0.005 °/h;
Accelerometer bias: 10
-4g
0
Accelerometer white noise error: 5 * 10
-5g
0:
Turntable waves around pitch axis, axis of roll and course axle with sinusoidal rule, and its mathematical model is:
pitch=pitchm·sin(ω
ψ+φ
ψ)
roll=rollm·sin(ω
θ+φ
θ)
yaw=yawm·sin(ω
γ+φ
γ)+yawk
pitchm=5°,rollm=6°,yawm=5°;,T
ψ=4s,T
θ=4s,T
γ=4s
The true attitude of carrier: ψ=180 °, θ=0 °, γ=0 °
Utilize the described method of invention obtain three-axle table to quasi-experiment swinging condition pedestal course static deformation angle, vertically the pedestal static deformation angle and laterally pedestal static deformation angle estimation curve respectively as Fig. 7, Fig. 8 and shown in Figure 9.The result shows that the estimation effect that is out of shape the angle in the turntable test under this kind state can reach certain precision.
(5) embodiment
For example the present invention is done in more detail below and describes:
(1) by the installation calibrating of machinery and optical instrument, the attitude and the center inertial navigation of the local inertial navigation in local deck are consistent, this moment, the attitude difference of two cover inertial navigations was very little low-angles, center, naval vessel strapdown inertial navitation system (SINS) pipeline start up by preheating also begins initial alignment;
(2) enter navigational state after center, naval vessel strapdown inertial navitation system (SINS) initial alignment finishes, the center inertial navigation system resolves by self, attitude, position, velocity information after obtaining resolving;
(3) the inertial navigation equipment pipeline start up by preheating of the carrier-borne equipment in local deck, the optical fibre gyro of the carrier-borne equipment in deck and quartz accelerometer begin to gather specific force and angular velocity information, and with the information that collects by the navigation calculation unit of cable transmission to self, the information transmission that the center strapdown inertial navitation system (SINS) is calculated by transmission cable is to the navigation calculation unit of the carrier-borne equipment in local deck simultaneously;
(4) the navigation calculation unit of the carrier-borne equipment in local deck receives the navigation data of storage center, naval vessel strapdown inertial navitation system (SINS), utilizes attitude data information to set up the carrier coordinate system of calculating carrier-borne equipment inertial navigation
And navigation coordinate is the transition matrix between the n, promptly initial strapdown matrix
The attitude information that duplicates by the center inertial navigation and the true attitude on incomplete local deck, both carrier coordinate system are not in full accord, do not consider this moment because dynamic deformation angle and the lever arm that various factorss such as sea beat cause, need to revise the misalignment φ between the two cover inertial navigation coordinate systems so this moment, just the function of deck static deformation angle ξ and inertial navigation device error equal error;
(5) setting up with two cover inertial navigation system misalignment sum of errors deck static deformation angle errors is the Kalman filtering state equation of state variable, is the measurement equation of measurement amount with both attitude differences, by Kalman filtering deck static deformation angle is estimated:
At first provide the coordinate system that need use: i represents inertial coordinates system, and e represents terrestrial coordinate system, and n represents navigation coordinate system (local level refers to backlands reason coordinate system), and m represents center inertial navigation carrier coordinate system, and s represents the local inertial navigation carrier coordinate system in local deck,
The local inertial navigation carrier coordinate system in the local deck that expression is calculated.
1) the deck static deformation angle differential equation:
After the attitude initialization of local inertial navigation,
Wherein: ψ, θ, γ are respectively pitch angle, roll angle and the course angle of center inertial navigation system.
Promptly satisfy:
Initialization is φ (0)=0 constantly, after the initialization, is goal in research with the deck static deformation angle, and the differential arrangement can obtain comprising the differential equation of deck static deformation angle:
Wherein: φ is
And the angle between m system, ξ are the deck static deformation angle between s and m system, ω
Nm sThe projection of the angular velocity that the relative navigation of measuring for the center inertial navigation is in the local inertial navigation carrier coordinate system in local deck; ε
sBe the local inertial navigation gyroscopic drift in local deck measuring error.
2) set up Kalman filtering state equation:
She Ji wave filter is not considered the relative attitude error that gyroscope causes under study for action, by increasing the process noise in the relative attitude error equation, to compensate the gyrostatic measuring error of not modeling.The state variable of getting system is:
X=[δv
x?δv
y?φ
x?φ
y?φ
z?ξ
x?ξ
y?ξ
z]
T (3)
ξ=[ξ wherein
xξ
yξ
z]
TBe the deck static deformation angle of reality to be estimated, think that in filtering it is a constant, that is:
Here we are research emphasis with the deck static deformation angle, and think that lever arm compensates, so it is as follows directly to provide velocity error:
The comprehensive above various state equation that obtains Kalman filtering is:
3) set up Kalman filtering measurement equation:
With the measurement amount of the attitude difference between the two cover inertial navigation systems as Kalman filtering,
z=Hx+v(t)
Wherein: measurement amount z=[φ
xφ
yφ
z]
T, H is for measuring matrix, and v is the measurement noise battle array, and φ is
And the angle between m system.
The vector form that can obtain the system filter model of to sum up deriving is:
Wherein:
Be local latitude, c
IjThe direction cosine matrix of carrier coordinate system to navigation coordinate system calculated in carrier-borne equipment inertial navigation
Element.W=[w
Vxw
Vyw
φ xw
φ yw
φ zw
ξ xw
ξ yw
ξ z]
TBe the system noise acoustic matrix, V=[w
φ xw
φ yw
φ z]
TIt is the measurement noise battle array.
Given corresponding initial parameter condition can direct estimation go out deck static deformation angle by Kalman filtering, is used to revise the attitude matrix of local inertial navigation system.