阅读说明：本技术 一种基于原子自旋陀螺仪的单轴惯性平台系统 (Uniaxial inertial platform system based on atomic spin gyroscope ) 是由 魏宗康 徐白描 石猛 于 2019-08-22 设计创作，主要内容包括：本发明公开了一种基于原子自旋陀螺仪的单轴惯性平台系统,包括：基座、台体、陀螺仪组合和控制器；其中,所述陀螺仪组合设置于所述台体的上部；所述基座通过轴与所述台体相连接,轴的一端与轴端力矩电机相连接,轴的另一端设置有轴端角度传感器；所述陀螺仪组合包括1个速率陀螺仪和1个原子自旋陀螺仪,该平台的陀螺仪组合采用1个速率陀螺仪和1个两自由度原子自旋陀螺仪,其中速率陀螺仪用来控制平台台体轴稳定,原子自旋陀螺仪用来控制台体另外两个轴的角速率；本发明采用平台与捷联相结合的混合式工作方式,可满足载体的全姿态运动和高精度的使用要求。(The invention discloses a single-axis inertial platform system based on an atomic spin gyroscope, which comprises: the device comprises a base, a table body, a gyroscope assembly and a controller; the gyroscope combination is arranged at the upper part of the table body; the base is connected with the table body through a shaft, one end of the shaft is connected with a shaft end torque motor, and the other end of the shaft is provided with a shaft end angle sensor; the gyroscope combination of the platform comprises 1 rate gyroscope and 1 atomic spin gyroscope, the gyroscope combination of the platform adopts 1 rate gyroscope and 1 two-degree-of-freedom atomic spin gyroscope, wherein the rate gyroscope is used for controlling the stability of the platform body axis, and the atomic spin gyroscope is used for controlling the angular rates of the other two axes of the platform body; the invention adopts a hybrid working mode of combining the platform and the strapdown, and can meet the use requirements of full-attitude motion and high precision of the carrier.)

1. A single axis inertial platform system based on an atomic spin gyroscope, comprising: the device comprises a base (1), a table body (2), a gyroscope assembly and a controller; wherein the content of the first and second substances,

the gyroscope combination is arranged at the upper part of the table body (2); the base (1) is connected with the table body (2) through a shaft (3), one end of the shaft (3) is connected with a shaft end torque motor, and the other end of the shaft (3) is provided with a shaft end angle sensor;

the gyroscope combination comprises 1 rate gyroscope and 1 atomic spin gyroscope, 2 sensitive axes of the atomic spin gyroscope are vertical to the sensitive axis of the rate gyroscope, the controller is respectively connected with the rate gyroscope and the shaft end torque motor, and the rate gyroscopeThe angular speed of the platform body around the platform body axis is zero by controlling the shaft end torque motor through the controller, and 2 axes of the atomic spin gyroscope respectively measure the angular speed of the platform body around the platform body axis Y_pAnd Z_pObtaining attitude information of the platform body in the space through mathematical calculation according to the angular velocity of the shaft;

wherein, the body coordinate system corresponding to the base is the base body coordinate system X₁Y₁Z₁The body coordinate system corresponding to the table body is the table body coordinate system X_pY_pZ_p(ii) a The origins of the two coordinate systems are coincident, Z of the coordinate system of the table body_pZ of axis and base body coordinate system₁The axes are overlapped; wherein, when the single-shaft inertial platform system rotates relatively internally, the base rotates around the Z of the platform body coordinate system_pThe shaft rotates.

2. The atomic spin gyroscope based single axis inertial platform system of claim 1, wherein: input shaft of rate gyroscope and table body coordinate system OX_pY_pZ_pMiddle table body axis Z_pParallel, 2 input axes of the atomic spin gyroscope and the table body axis Z_pThe 2 input shafts of the vertical atomic spin gyroscope are mutually vertical, and the 2 input shafts of the atomic spin gyroscope are respectively in mutual vertical with a table body coordinate system OX_pY_pZ_pAxis X of the table body_pTable body axis Y_pParallel.

3. The atomic spin gyroscope based single axis inertial platform system of claim 1, wherein: the atomic spin gyroscope is provided with a magnetic shielding structure, so that the atomic spin gyroscope works in a nonmagnetic state, and the kinematic equation of the atomic spin gyroscope in the nonmagnetic state is as follows:

in the formula (I), the compound is shown in the specification,is the projection component of the electron spin polarizability of the alkali metal atom on the X axis;

4. The atomic spin gyroscope based single axis inertial platform system of claim 3, wherein: the atomic spin gyroscope is characterized in that a pump light source is arranged in the atomic spin gyroscope, the polarization state is realized through the drive laser of the pump light source, and the kinematic equation of the atomic spin gyroscope in the polarization state is as follows:

wherein the content of the first and second substances,

5. the atomic spin gyroscope based single axis inertial platform system of claim 4, wherein: the controller consists of a first-order integral link and an advance link, and the transfer function of the controller is as follows:

wherein, K_czIs the magnification of the controller;

6. The atomic spin gyroscope based single axis inertial platform system of claim 5, wherein: the kinematic equation of the atomic spin gyroscope when the Z-axis angular rate of the table body is zero is as follows:

based on measurements at steady state

7. the atomic spin gyroscope based single axis inertial platform system of claim 6, wherein: the coordinate transformation matrix of the base relative to the table body is as follows:

wherein, beta_zkZ of the coordinate system of the base around the table body_pThe angle of rotation of the shaft.

8. The atomic spin gyroscope based single axis inertial platform system of claim 7, wherein: 2 axes of the atomic spin gyroscope are used for respectively measuring the rotation of the stage body around the stage body Y_pAnd Z_pObtaining an attitude information packet of the platform body in the space through mathematical calculation according to the angular velocity of the shaft, and the method comprises the following steps:

(1) giving initial values of quaternion λ, ρ₁、ρ₂、ρ₃；

(2) When the table body is stabilized in the inertial space, take

wherein:

(3) obtaining a new set of quaternions lambda and rho by the following attitude update equation₁、ρ₂、ρ₃：

(4) According to the new set of quaternions lambda, rho₁、ρ₂、ρ₃Obtaining a coordinate change matrix of the table body relative to an inertial coordinate system

(5) at the next navigation time, a group of new quaternion numbers lambda and rho obtained in the step (3) are used₁、ρ₂、ρ₃And (5) returning to the step (2) again as the initial value of the quaternion, and repeating the steps until the navigation task is finished.

9. The atomic spin gyroscope based single axis inertial platform system of claim 1, wherein: the table body further comprises an accelerometer assembly, the accelerometer assembly comprises 4 quartz accelerometers, wherein 3 quartz accelerometers are orthogonally arranged to form an accelerometer input shaft coordinate system, the 4 th quartz accelerometer is obliquely arranged in the accelerometer input shaft coordinate system, and included angles between the input shaft of the 4 th quartz accelerometer and the input shafts of the other 3 quartz accelerometers are the same; and the accelerometer input axis coordinate system is coincided with the table body coordinate system OXYZ.

10. The atomic spin gyroscope based single axis inertial platform system of claim 9, wherein: the cosine value of the included angle has an absolute value of

Technical Field

The invention belongs to the technical field of inertia measurement, and particularly relates to a single-shaft inertial platform system based on an atomic spin gyroscope, which is suitable for nuclear submarines, ballistic missiles, cruise missiles and fighters requiring full postures.

Background

The gyroscope as an angular velocity sensor is a core device in an inertial navigation system, and the performance of the gyroscope is a key factor for restricting the precision of the navigation system. The gyroscope experiences the firstThe gyroscope is a fourth generation atomic gyroscope currently researched and is a substitute for mechanical gyroscopes (air-floating gyroscopes, liquid-floating gyroscopes, three-floating gyroscopes, dynamically tuned gyroscopes, electrostatic gyroscopes and the like), second generation optical gyroscopes (laser gyroscopes, optical fiber gyroscopes and the like), third generation micro-electromechanical MEMS gyroscopes. The atomic spin gyroscope without spin exchange relaxation has ultrahigh theoretical precision, and the theoretical precision can reach 10^-8And (4) DEG/h. Therefore, the atomic spin gyroscope has a good application prospect in inertial navigation during long-term navigation.

The atomic spin gyroscope measures the rotation of a carrier by utilizing the electronic spin axis-fixing property, the basic principle is similar to an electromechanical rotor type gyroscope, but a structure for driving a rotor to rotate is not needed, and a frame and a bearing for maintaining the rotation of the rotor are also not needed, so that the atomic spin gyroscope can measure angular velocity information in two directions while realizing high precision and miniaturization, but the atomic spin gyroscope has the defect that if the angular velocity is generated in the direction perpendicular to two input axes, the measurement error is brought, and the use precision of the atomic spin gyroscope is influenced.

Therefore, an inertia system using scheme based on the atomic spin gyroscope needs to be researched, the precision potential of the atomic spin gyroscope is exerted to the maximum extent, and the requirements of the future inertia system on full attitude and high precision are met.

Disclosure of Invention

The technical problem solved by the invention is as follows: the single-axis inertial platform system based on the atomic spin gyroscope has the advantages of being full in posture, large in maneuvering and high in precision, and meets the requirements of the future inertial platform for full posture and high precision.

The purpose of the invention is realized by the following technical scheme: a single axis inertial platform system based on an atomic spin gyroscope, comprising: the device comprises a base, a table body, a gyroscope assembly and a controller; the gyroscope combination is arranged at the upper part of the table body; the base is connected with the table body through a shaft, one end of the shaft is connected with a shaft end torque motor, and the other end of the shaft is provided with a shaft end angle sensor; the gyroscope combination comprises 1 rate gyroscope and 1 rate gyroscopeThe table body rotation speed measurement device comprises an atomic spin gyroscope, wherein 2 sensitive axes of the atomic spin gyroscope are perpendicular to the sensitive axis of a rate gyroscope, a controller is respectively connected with the rate gyroscope and a shaft end torque motor, the rate gyroscope controls the shaft end torque motor through the controller to enable the angular speed of the table body around a table body shaft to be zero, and the 2 axes of the atomic spin gyroscope respectively measure the angle of the table body around the table body Y_pAnd Z_pObtaining attitude information of the platform body in space through mathematical calculation of the angular velocity of the shaft; wherein, the body coordinate system corresponding to the base is the base body coordinate system X₁Y₁Z₁The body coordinate system corresponding to the table body is the table body coordinate system X_pY_pZ_p(ii) a The origins of the two coordinate systems are coincident, Z of the coordinate system of the table body_pZ of axis and base body coordinate system₁The axes are overlapped; wherein, when the single-shaft inertial platform system rotates relatively internally, the base rotates around the Z of the platform body coordinate system_pThe shaft rotates.

In the single-axis inertial platform system based on the atomic spin gyroscope, the input axis of the rate gyroscope and the table coordinate system OX_pY_pZ_pMiddle table body axis Z_pParallel, 2 input axes of the atomic spin gyroscope and the table body axis Z_pThe 2 input shafts of the vertical atomic spin gyroscope are mutually vertical, and the 2 input shafts of the atomic spin gyroscope are respectively in mutual vertical with a table body coordinate system OX_pY_pZ_pAxis X of the table body_pTable body axis Y_pParallel.

In the uniaxial inertial platform system based on the atomic spin gyroscope, the atomic spin gyroscope is provided with a magnetic shielding structure, so that the atomic spin gyroscope works in a nonmagnetic state, and the kinematic equation of the atomic spin gyroscope in the nonmagnetic state is as follows:

in the formula (I), the compound is shown in the specification,

is a baseA projection component of the electron spin polarizability of the metal atom on the X-axis;

is the projection component of the electron spin polarizability of the alkali metal atom on the Y axis;is the projection component of the electron spin polarizability of the alkali metal atom on the Z axis;

is the total relaxation rate of the alkali electron spin; q is a slowing factor representing the ratio of the total angular momentum of the atomic spins to the angular momentum occupied by the electron spins;

is the angular velocity of the atomic spin gyroscope around the X axis;

is the angular velocity of the atomic spin gyroscope about the Y-axis;

is the angular velocity of the atomic spin gyroscope around the Z axis; r_pThe polarization of the driving laser on the electron spin is reflected in order to drive the optical pumping rate of the laser.

In the uniaxial inertial platform system based on the atomic spin gyroscope, the atomic spin gyroscope is internally provided with the pump light source, the polarization state is realized by the drive laser of the pump light source, and the kinematic equation of the atomic spin gyroscope in the polarization state is as follows:

wherein the content of the first and second substances,

in the uniaxial inertial platform system based on the atomic spin gyroscope, the controller consists of a first-order integral link and an advance link, and the transfer function of the controller is as follows:

wherein, K_czIs the magnification of the controller;

a transfer function of a first-order integral link; t is_zs +1 is the transfer function of the lead link, T_zIs a time constant.

In the single-axis inertial platform system based on the atomic spin gyroscope, the kinematic equation of the atomic spin gyroscope when the angular rate of the Z-axis of the platform body is zero is as follows:

based on measurements at steady state

And

obtaining:

in the uniaxial inertial platform system based on the atomic spin gyroscope, the coordinate transformation matrix of the base relative to the platform body is as follows:

wherein, beta_zkFor the base around the body of the tableZ of series_pThe angle of rotation of the shaft.

In the uniaxial inertial platform system based on the atomic spin gyroscope, 2 axes of the atomic spin gyroscope respectively measure the platform body around the platform body Y_pAnd Z_pObtaining an attitude information packet of the platform body in the space through mathematical calculation according to the angular velocity of the shaft, and the method comprises the following steps:

(1) giving initial values of quaternion λ, ρ₁、ρ₂、ρ₃；

(2) When the table body is stabilized in the inertial space, take

And is

When the table body rotates relative to the inertial space, take

And

measured by a two-degree-of-freedom atomic spin gyroscope;

wherein:

as a coordinate system OX of the table body_PY_PZ_PMiddle platform body Z_PThe angular velocity of the shaft is such that,

as a coordinate system OX of the table body_PY_PZ_PMiddle stage body X_PThe angular velocity of the shaft is such that,

as a coordinate system OX of the table body_PY_PZ_PMiddle table body Y_PAngular velocity of the shaft;

(3) obtaining a new set of quaternions lambda and rho by the following attitude update equation₁、ρ₂、ρ₃：

(4) According to the new set of quaternions lambda, rho₁、ρ₂、ρ₃Obtaining a coordinate change matrix of the table body relative to an inertial coordinate system

The method comprises the following specific steps:

(5) at the next navigation time, a group of new quaternion numbers lambda and rho obtained in the step (3) are used₁、ρ₂、ρ₃And (5) returning to the step (2) again as the initial value of the quaternion, and repeating the steps until the navigation task is finished.

In the uniaxial inertial platform system based on the atomic spin gyroscope, the platform body further comprises an accelerometer assembly, the accelerometer assembly comprises 4 quartz accelerometers, wherein 3 quartz accelerometers are orthogonally arranged to form an accelerometer input shaft coordinate system, a 4 th quartz accelerometer is obliquely arranged in the accelerometer input shaft coordinate system, and included angles between an input shaft of the 4 th quartz accelerometer and input shafts of the other 3 quartz accelerometers are the same; and the accelerometer input axis coordinate system is coincided with the table body coordinate system OXYZ.

In the single-axis inertial platform system based on the atomic spin gyroscope, the cosine value of the included angle has an absolute value of

In the uniaxial inertial platform system based on the atomic spin gyroscope, when any one quartz accelerometer of the 4 quartz accelerometers on the platform body fails, the rest 3 quartz accelerometers are matched to realize the measurement of the apparent acceleration of the platform body relative to an inertial space.

In the uniaxial inertial platform system based on the atomic spin gyroscope, the rate gyroscope is a laser gyroscope, an optical fiber gyroscope, a nuclear magnetic resonance gyroscope or a micromechanical gyroscope.

In the uniaxial inertial platform system based on the atomic spin gyroscope, in the step (2), the rotation angle beta_zkThe value range of the angle is-180 degrees to +180 degrees.

In the single-axis inertial platform system based on the atomic spin gyroscope, the sensor adopts a photoelectric encoder or a sine-cosine rotary encoder.

Compared with the prior art, the invention has the following beneficial effects:

(1) the hybrid single-axis inertial platform system based on the atomic spin gyroscope and the rate gyroscope has the advantages that the coupling error related to the angular speed of the Z axis in the atomic spin gyroscope is 0, the decoupling between the measured values of the two input axes of the atomic spin gyroscope is realized, and the use precision is improved;

(2) according to the hybrid single-axis inertial platform system based on the atomic spin gyroscope and the rate gyroscope, 1 rate gyroscope and 1 atomic spin gyroscope are adopted, so that the miniaturization of the system can be realized on the premise of ensuring the accuracy of the atomic spin gyroscope, and the effective load of a carrier can be improved;

(3) the invention adopts a quartz accelerometer redundancy method, adds an obliquely installed accelerometer on the basis of the original three accelerometers, and when any 1 accelerometer has a fault, the other 3 quartz accelerometers are reconstructed and matched to realize the measurement of the apparent acceleration of the platform body relative to the inertial space.

(4) The high-precision inertial platform system based on the atomic spin gyroscope can be suitable for nuclear submarines, ballistic missiles, cruise missiles, fighters and the like which require full-attitude, long endurance and high-precision application occasions, and has wide application fields and application prospects.

Drawings

Various other advantages and benefits will become apparent to those of ordinary skill in the art upon reading the following detailed description of the preferred embodiments. The drawings are only for purposes of illustrating the preferred embodiments and are not to be construed as limiting the invention. Also, like reference numerals are used to refer to like parts throughout the drawings. In the drawings:

FIG. 1 is a schematic diagram of the system components of a hybrid single-axis inertial platform based on an atomic spin gyroscope according to the present invention;

FIG. 2 is a schematic view showing the arrangement of the polarities of each gyroscope and accelerometer of the inertial platform body according to the present invention;

FIG. 3 is a flow chart of a Z-axis servo loop of a stage based on a rate gyroscope according to the present invention.

Detailed Description

Exemplary embodiments of the present disclosure will be described in more detail below with reference to the accompanying drawings. While exemplary embodiments of the present disclosure are shown in the drawings, it should be understood that the present disclosure may be embodied in various forms and should not be limited to the embodiments set forth herein. Rather, these embodiments are provided so that this disclosure will be thorough and complete, and will fully convey the scope of the disclosure to those skilled in the art. It should be noted that the embodiments and features of the embodiments may be combined with each other without conflict. The present invention will be described in detail below with reference to the embodiments with reference to the attached drawings.

Fig. 1 is a schematic composition diagram of a hybrid single-axis inertial platform system based on an atomic spin gyroscope according to the present invention. As shown in fig. 1, the single-axis inertial platform system based on the atomic spin gyroscope comprises: the device comprises a base 1, a table body 2, a gyroscope assembly and a controller; wherein the content of the first and second substances,

the gyroscope combination is arranged at the upper part of the table body 2; base 1 is connected with stage body 2 through axle 3, and the one end and the axle head torque motor of axle 3 are connected, and the other end of axle 3 is provided with axle head angle sensor.

The gyroscope combination comprises 1 rate gyroscope 4 and 1 atomic spin gyroscope 5, 2 sensitive axes of the atomic spin gyroscopes are perpendicular to the sensitive axis of the rate gyroscopes, the controller is respectively connected with the rate gyroscopes and the shaft end torque motors, the rate gyroscopes control the shaft end torque motors through the controllers to enable the angular speeds of the table bodies around the table body axes to be zero, and the 2 axes of the atomic spin gyroscopes respectively measure the Y values of the table bodies around the table bodies_pAnd Z_pObtaining attitude information of the platform body in space through mathematical calculation of the angular velocity of the shaft;

wherein, the body coordinate system corresponding to the base is the base body coordinate system X₁Y₁Z₁The body coordinate system corresponding to the table body is the table body coordinate system X_pY_pZ_p(ii) a The origins of the two coordinate systems are coincident, Z of the coordinate system of the table body_pZ of axis and base body coordinate system₁The axes are overlapped; wherein, when the single-shaft inertial platform system rotates relatively internally, the base rotates around the Z of the platform body coordinate system_pThe shaft rotates.

Input shaft and table body coordinate system OX of rate gyroscope_pY_pZ_pMiddle table body axis Z_pParallel, 2 input axes of the atomic spin gyroscope and the table body axis Z_pPerpendicular to each other and respectively connected with the table body coordinate system OX_pY_pZ_pAxis X of the table body_p、Y_pAnd forming a gyroscope combined input shaft coordinate system in parallel.

The atomic spin gyroscope is provided with a magnetic shielding structure, so that the atomic spin gyroscope works in a nonmagnetic state, and the kinematic equation of the atomic spin gyroscope in the nonmagnetic state is as follows:

in the formula (I), the compound is shown in the specification,

is the projection component of the electron spin polarizability of the alkali metal atom on the X axis;

is the projection component of the electron spin polarizability of the alkali metal atom on the Y axis;is the projection component of the electron spin polarizability of the alkali metal atom on the Z axis;

is the total relaxation rate of the alkali electron spin; q is a slowing factor representing the ratio of the total angular momentum of the atomic spins to the angular momentum occupied by the electron spins;

is the angular velocity of the atomic spin gyroscope around the X axis;

is the angular velocity of the atomic spin gyroscope about the Y-axis;

is the angular velocity of the atomic spin gyroscope around the Z axis; r_pThe polarization of the driving laser on the electron spin is reflected in order to drive the optical pumping rate of the laser.

The atomic spin gyroscope is internally provided with a pumping light source, the polarization state is realized by driving laser of the pumping light source, and the kinematic equation of the atomic spin gyroscope in the polarization state is as follows:

wherein the content of the first and second substances,

a rate gyroscope for sensing the Z-axis angular rate of the platform body is used as a sensing element, and the Z-axis angular rate of the platform body is ensured to be zero through a shaft end motor acted on the platform body shaft by a controller. The controller consists of a first-order integral link and an advance link, and the transfer function of the controller is as follows:

wherein, K_czIs the magnification of the controller;

a transfer function of a first-order integral link; t is_zs +1 is the transfer function of the lead link, T_zIs a time constant.

The kinematic equation of the atomic spin gyroscope when the Z-axis angular rate of the table body is zero is as follows:

based on measurements at steady state

And

obtaining:

the coordinate transformation matrix of the base relative to the table body is as follows:

wherein, beta_zkZ of the coordinate system of the base around the table body_pAngle of rotation of the shaft。

The two-degree-of-freedom atomic spin gyroscope measures the angular velocity of a table body relative to an inertial space, and the specific method for giving the attitude of the table body relative to the inertial space in real time after attitude update comprises the following steps:

(1) giving initial values of quaternion λ, ρ₁、ρ₂、ρ₃；

(2) When the table body is stabilized in the inertial space, take

And is

When the table body rotates relative to the inertial space, take

And

measured by a two-degree-of-freedom atomic spin gyroscope;

wherein:

as a coordinate system OX of the table body_PY_PZ_PMiddle platform body Z_PThe angular velocity of the shaft is such that,

as a coordinate system OX of the table body_PY_PZ_PMiddle stage body X_PThe angular velocity of the shaft is such that,

as a coordinate system OX of the table body_PY_PZ_PMiddle table body Y_PAngular velocity of the shaft;

(3) obtaining a new set of quaternions lambda and rho by the following attitude update equation₁、ρ₂、ρ₃：

(4) According to the new set of quaternions lambda, rho₁、ρ₂、ρ₃Obtaining a coordinate change matrix of the table body relative to an inertial coordinate system

The method comprises the following specific steps:

(5) at the next navigation time, a group of new quaternion numbers lambda and rho obtained in the step (3) are used₁、ρ₂、ρ₃And (5) returning to the step (2) again as the initial value of the quaternion, and repeating the steps until the navigation task is finished.

The table body further comprises an accelerometer assembly, the accelerometer assembly comprises 4 quartz accelerometers, wherein 3 quartz accelerometers are orthogonally arranged to form an accelerometer input shaft coordinate system, and the 4 th quartz accelerometer is obliquely arranged in the accelerometer input shaft coordinate system; and the accelerometer input axis coordinate system is coincided with the table body coordinate system OXYZ. The input axis of the 4 th obliquely-installed quartz accelerometer is at the same angle with the input axes of the other 3 quartz accelerometers. The cosine of the angle has an absolute value of 1/3.

4 quartz accelerometer on the stage body, when any one quartz accelerometer of them breaks down, the measurement of the relative inertial space's of stage body apparent acceleration is realized to other 3 quartz accelerometer cooperations.

The rate gyroscope is a laser gyroscope, an optical fiber gyroscope, a nuclear magnetic resonance gyroscope or a micromechanical gyroscope.

Specifically, as shown in fig. 1, the inertial platform system includes a platform and a gyroscope assembly mounted on the platform, where the gyroscope assembly includes 1 rate gyroscope G_zAnd 1 atomic spin gyro G_y. Sensitive platformThe single-freedom-degree rate gyroscope of the Z axis of the platform body is used as a platform body angular motion sensing element of a Z axis servo loop of the inertial platform system, controls a shaft end motor of the platform body shaft, and enables the Z axis of the platform body to be stable when a stabilizing loop works. Two-degree-of-freedom atomic spin gyroscopes of the X axis and the Y axis of the platform body of the sensitive platform are used as angular motion sensitive elements to measure the angular speed of the inertial platform system around the X axis and the Y axis of the platform body.

Fig. 2 is a schematic diagram showing the polarity configuration of each gyroscope and accelerometer of the inertial platform body according to the present invention. 1 rate gyroscope G_zInput shaft I_zThe output of the rate gyroscope is acted on a platform body shaft end motor of the platform through a control link to form a platform system Z-axis servo loop; another 1 atomic spin gyro G_yInput shaft I_x、I_yThe two are respectively vertical to the platform axis Z and mutually vertical to form a combined input axis coordinate system of the gyroscope, and the output of the atomic spin gyroscope can give the direction of the platform body relative to an inertia space through mathematical calculation. The OZ axis in the table coordinate system OXYZ coincides with the rotation axis of the table.

As shown in fig. 1, the hybrid inertial platform system includes a stage, frames, and a base. The table body also comprises an accelerometer combination, the accelerometer combination is used for measuring the acceleration information of the table body, the accelerometer combination comprises 4 quartz accelerometers, wherein 3 quartz accelerometers A_x、A_yAnd A_zOrthogonal installation forms accelerometer input axis coordinate system, 4 th quartz accelerometer A_dThe accelerometer is mounted obliquely in the input axis coordinate system as shown in figure 2. And the accelerometer input axis coordinate system is coincided with the table body coordinate system OXYZ. Obliquely mounted quartz accelerometer A_dCan realize the monitoring function, when the accelerometer which is orthogonally installed has faults, the fault phenomenon is timely judged, and the quartz accelerometer A which is obliquely installed is utilized_dThe failure accelerometer is replaced to output specific force information, and continuous and stable output of carrier navigation information is guaranteed. As shown in FIG. 2, 3 quartz accelerometers A_x、A_yAnd A_zAre respectively I_x、I_y、I_zOutput ofThe shafts are respectively O_x、O_y、O_zThe pendulum axes are respectively P_x、P_y、P_zQuartz accelerometer A_dThe input shaft, the output shaft and the pendulum shaft are respectively I_R、O_R、P_R。

The 4 th obliquely-installed quartz accelerometer A in the invention_dWith 3 other quartz accelerometers a_x、A_yAnd A_zPreferably the cosine of the angle of the input axis of (a) is 1/3 in absolute value.

As shown in fig. 1, in order to keep the table body stable relative to the inertial space, it is necessary to utilize the output information of the rate gyroscope to the torque motor applied to the shaft end of the table body shaft by the controller to realize feedback, as shown in fig. 3. Setting the desired angular velocity ω_zdIs 0, assuming that the table body has an angular velocity ω along the Z-axis_zThe rate gyro is sensitive to this angular velocity and is compared with the desired value ω_zdComparing the two values, and inputting the difference to the controller C_z(s) controller output u_zActing on a torque motor to generate motor torque M_DzDrive the platform body to rotate along the Z axis in the opposite direction to offset omega_zSo that the platform body is stable along the Z axis relative to the inertia space.

The transfer function of the controller may be selected

Wherein, K_czIs the magnification of the controller;

a transfer function of a first-order integral link; t is_zs +1 is the transfer function of the lead link, T_zIs a time constant.

The embodiment of the invention adopts the angular rate of the rotating shaft (Z axis) of the sensitive table body of the rate gyroscope, and the angular motion around the axis can be isolated through the servo loop, and the scheme has the advantages that the coupling error related to the angular speed of the Z axis in the atomic spin gyroscope is 0, so that the decoupling between the measured values of the two input axes of the atomic spin gyroscope is realized, and the use precision is improved;

in the embodiment, 1 rate gyroscope and 1 atomic spin gyroscope are adopted, which is beneficial to realizing the miniaturization of the system on the premise of ensuring the accuracy of the atomic spin gyroscope and can improve the effective load of the carrier;

in the embodiment, a quartz accelerometer redundancy method is adopted, an obliquely-installed accelerometer is added on the basis of the original three accelerometers, when any 1 accelerometer has a fault, the other 3 quartz accelerometers are reconstructed and matched to realize the measurement of the apparent acceleration of the platform body relative to the inertial space, the method realizes the fault diagnosis and fault tolerance processing of the quartz accelerometer, and improves the reliability level of the system.

The embodiment can be suitable for nuclear submarines, ballistic missiles, cruise missiles, fighters and the like which require full-attitude, long endurance and high-precision application occasions, and has wide application fields and application prospects.

The above-described embodiments are merely preferred embodiments of the present invention, and general changes and substitutions by those skilled in the art within the technical scope of the present invention are included in the protection scope of the present invention.