Affine rotation modulation-based high-rotation roll angle air estimation method and device

By constructing a dual-spin trajectory model of a high-spinning flight body and combining affine rotation modulation inversion with an unscented Kalman filter algorithm, the problem of accurately obtaining the roll angle of a high-spinning flight body in a high-dynamic environment was solved, and high-precision attitude information calculation was achieved.

CN119043291APending Publication Date: 2024-11-29BEIJING INST OF TECH
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410798910.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Priority Date
2024-05-16
Filing Date
2024-06-20
Publication Date
2024-11-29

AI Technical Summary

Technical Problem

In highly dynamic motion environments, it is difficult to accurately obtain the roll angle of a high-rotation flying body. Existing technical methods involve large computational loads or low accuracy, which cannot meet the requirements of real-time performance and accuracy.

Method used

A dual-rotation ballistic model of a high-rotation flight body is constructed. Using preset ballistic data and angular rate gyroscope measurement information, the roll attitude is calculated by affine rotation modulation inversion, and the pitch and yaw attitude is calculated by combining the unscented Kalman filter algorithm.

Benefits of technology

It achieves high-precision calculation of roll, pitch and yaw attitude in highly dynamic environments, with errors of less than 1.84° and 0.22°, respectively, meeting the accuracy requirements of guidance and control systems.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119043291A_ABST
    Figure CN119043291A_ABST
Patent Text Reader

Abstract

The invention provides a high-rotation roll angle air estimation method and device based on affine rotation modulation, and the method comprises the steps: constructing a high-rotation flight body double-rotation trajectory model, obtaining preset trajectory data, and dividing trajectory intervals; the preset trajectory data and the angular rate gyroscope measurement information serve as input, according to kinematics model constraint, the rolling attitude of the high-rotation flying body is solved through affine rotation modulation inversion, and the rolling angle of the high-rotation flying body is obtained. The technical problem that it is difficult to accurately obtain the roll angle of the high-rotation flying body in a high-dynamic motion environment is solved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of high-dynamic navigation technology, and in particular to a method and device for estimating high roll angle in the air based on affine rotation modulation. Background Art

[0002] High-spinning flying objects refer to a type of flying object that continuously rolls around its own longitudinal axis at high speed during flight, including 105mm shells, 155mm shells and 122mm rockets. The premise for realizing intelligent transformation and precision strikes on them is to obtain accurate attitude information throughout the flight. Accurate attitude solution is the core technology for guided transformation of high-spinning flying objects. However, due to the strong coupling and complex nonlinear motion characteristics of high-spinning flying objects and the constraints of structural size, there are currently few measurement sensors available for adapting to their attitude information acquisition, including satellite navigation systems, inertial measurement units and geomagnetic sensors. In addition, when the above-mentioned means are used to obtain attitude information of high-spinning flying objects, there are problems such as incomplete information acquisition and low data measurement accuracy. Especially for the rolling information of high-spinning flying objects, the large solution error makes the subsequent guidance and control command actions greatly inaccurate. This also makes the attitude solution problem of high-spinning flying objects the difficulty and focus of their guidance and intelligent technology.

[0003] With the development of theoretical research and mathematical methods, many attitude solution theories and methods have been proposed at home and abroad. On the one hand, it is committed to improving the accuracy and availability of sensor measurement data. The existing technology proposes a fault-tolerant machine learning-assisted estimation algorithm, which can use the available data of normal Micro-Electro-Mechanical System (MEMS) sensors to effectively predict the missing data in the faulty MEMS sensors, and uses the Extended Kalman Filter (EKF) to calculate the attitude angle, but the algorithm has a large amount of calculation and cannot meet the real-time requirements. Another existing technology is based on the basic principle of solving the attitude of a rotating body based on the zero-point information of geomagnetic data, and uses geomagnetic data to solve the full ballistic flight attitude of a rotating missile. By correcting the installation angle of the magnetic sensor, the attitude solution accuracy is improved, but there is a limitation that the magnetic sensor is easily sensitive to disturbance errors. On the other hand, the improvement of the attitude solution method is also concerned. In view of the limitations of the traditional cone error compensation algorithm in a high-dynamic environment, the existing technology designs a high-precision attitude compensation improvement algorithm based on Taylor series expansion. The algorithm fully considers the trigonometric product of the non-commutative error and the cross product of the angular increment and gives the compensation coefficient, and then derives the multi-sample cone error compensation algorithm, which has higher accuracy in theory, but also has the defect of heavy algorithm calculation burden. The prior art also proposes a posture solution method based on array MEMS-IMU data fusion. The array MEMS chip quaternion vector averaging method is used for axis alignment, the array MEMS-IMU is fused, and then the improved dynamic Kalman filter method is used to solve the carrier posture in motion. It can effectively improve the attitude solution capability of MEMS-IMU in more complex dynamic motion, but the solution error still tends to diverge over time.

[0004] The above methods are too focused on the acquisition and fusion of sensor measurement data, without considering the kinematics and dynamics of the flying object itself, resulting in inaccurate navigation.

[0005] To address the above-mentioned problems, no effective solution has been proposed yet. Summary of the invention

[0006] The embodiments of the present invention provide a method and device for estimating the high-speed rolling angle in the air based on affine rotation modulation, so as to at least solve the technical problem that it is difficult to accurately obtain the rolling angle of a high-speed flying object in a high-dynamic motion environment.

[0007] According to one aspect of an embodiment of the present invention, there is provided a method for estimating a high-spin roll angle in the air based on affine rotation modulation, comprising: constructing a double-spin trajectory model of a high-spin flying object, acquiring preset trajectory data and dividing the trajectory interval; taking the preset trajectory data and angular rate gyroscope measurement information as input, and according to the kinematic model constraints, solving the roll posture of the high-spin flying object through affine rotation modulation inversion to obtain the roll angle of the high-spin flying object.

[0008] In some embodiments, the preset trajectory data and angular rate gyroscope measurement information are used as inputs, and according to the kinematic model constraints, the roll posture of the high-spinning flying body is solved by affine rotation modulation inversion to obtain the roll angle of the high-spinning flying body, including: constructing a first kinematic equation for the rotation of the high-spinning flying body around the center of mass in a quasi-projectile coordinate system; constructing a second kinematic equation for the rotation of the rear body of the high-spinning flying body around the center of mass in a projectile coordinate system; combining the first kinematic equation and the second kinematic equation to obtain an affine rotation modulation relationship equation for angular velocity information; using the preset trajectory data and angular rate gyroscope measurement information as inputs to the affine rotation modulation relationship equation, inverting the affine rotation modulation effect caused by the rolling motion of the rear body of the high-spinning flying body, so as to solve the roll angle of the rear body of the high-spinning flying body in real time during flight; wherein the kinematic model constraints include the first kinematic equation and the second kinematic equation.

[0009] In some embodiments, constructing a second kinematic equation for the rear body of the high-speed flying body to represent the rotation of the rear body around the center of mass in the projectile coordinate system includes: obtaining the angular rate gyroscope measurement information of the three-axis angular rate gyroscope strapped to the rear body; and constructing the second kinematic equation based on the angular rate gyroscope measurement information, the yaw angle, and the roll angle.

[0010] In some embodiments, the preset trajectory data and angular rate gyroscope measurement information are used as inputs to the affine rotation modulation relationship equation, and the affine rotation modulation effect caused by the rolling motion of the rear body of the high-spin flying body is inverted to obtain the roll angle of the rear body of the high-spin flying body in real time during the flight, including: deriving a geometric representation of the roll angle based on the affine rotation modulation relationship equation, and deriving a solution formula for the roll angle based on the geometric representation of the roll angle; inputting the preset trajectory data and angular rate gyroscope measurement information into the solution formula for the roll angle, and inverting the affine rotation modulation effect caused by the rolling motion of the rear body of the high-spin flying body, so as to obtain the roll angle of the rear body of the high-spin flying body in real time during the flight.

[0011] In some embodiments, the preset trajectory data is obtained by establishing a double-rotation mathematical model; the angular rate gyroscope measurement information includes the y-axis and z-axis components of the three-axis components of the angular velocity of the rear body of the high-rotation flying body relative to the inertial coordinate system in the projectile coordinate system.

[0012] In some embodiments, the affine rotation modulation relationship in the affine rotation modulation relationship equation is: the rear body of the high-speed flying body always rotates around its own longitudinal axis, and the measurement values ​​of the angular rate gyroscope strapped to the y-axis and z-axis of the rear body show a periodic change pattern after the affine rotation modulation of the rolling motion of the rear body.

[0013] In some embodiments, after obtaining the roll angle of the high-spinning flying object, the method further includes: based on the preset ballistic data, using unscented Kalman filtering to solve the pitch and yaw attitude of the high-spinning flying object to obtain the yaw angle and pitch angle of the high-spinning flying object.

[0014] According to another aspect of an embodiment of the present invention, there is provided an aerial estimation device for a high-spin roll angle based on affine rotation modulation, comprising: a construction module, configured to construct a double-spin trajectory model of a high-spin flying object, obtain preset trajectory data and divide the trajectory interval; a roll angle estimation module, configured to take the preset trajectory data and angular rate gyroscope measurement information as input, solve the roll posture of the high-spin flying object through affine rotation modulation inversion according to kinematic model constraints, and obtain the roll angle of the high-spin flying object.

[0015] According to another aspect of an embodiment of the present invention, there is provided a method for accurately calculating a high-spin attitude with embedded ballistic dynamics, comprising: constructing a double-spin trajectory model for a high-spin flying object, acquiring preset trajectory data and dividing the trajectory interval; based on the preset trajectory data, using an unscented Kalman filter algorithm to calculate the pitch and yaw attitude of the high-spin flying object, and obtaining the yaw angle and pitch angle of the high-spin flying object.

[0016] In some embodiments, based on the preset trajectory data, an unscented Kalman filter algorithm is used to solve the pitch and yaw posture of the high-spinning flying body to obtain the yaw angle and pitch angle of the high-spinning flying body, including: constructing a dynamic model constraint equation for the rotation of the high-spinning flying body around the center of mass, and constructing a state equation based on the dynamic model constraint equation; constructing a measurement equation based on the preset trajectory data and the measurement information output in real time by the angular rate gyroscope; based on the state equation and the measurement equation, an unscented Kalman filter algorithm is constructed using an unscented transformation method; and the unscented Kalman filter algorithm is used to solve the pitch and yaw posture of the high-spinning flying body to obtain the yaw angle and pitch angle of the high-spinning flying body.

[0017] In some embodiments, the unscented Kalman filter algorithm is used to solve the pitch and yaw attitude of the high-speed flying object to obtain the yaw angle and pitch angle of the high-speed flying object, including: determining the initial state value of the Kalman filter and the covariance matrix of the previous moment according to the initial state of the system; calculating a set of sigma points according to the initial state value and the covariance matrix of the previous moment, wherein the sigma points are used to approximate the distribution of the system state; based on the initial state value, the covariance matrix of the previous moment and the sigma points, the state equation and the measurement equation are processed in the prediction stage using an unscented transformation method, and in the correction stage, the covariance matrix of the current moment is solved based on the processed state equation and the measurement equation, and the unscented Kalman filter algorithm is iterated based on the covariance matrix of the current moment to obtain the yaw angle and pitch angle of the high-speed flying object.

[0018] In some embodiments, the unscented transform method approximates a Gaussian distribution with a fixed number of parameters, wherein the Gaussian distribution can achieve an accuracy equivalent to preserving the third-order term of a Taylor series.

[0019] In some embodiments, the untraceable transformation method includes: calculating multiple sigma point sets and weights of the sigma point sets; based on the sigma point sets and the weights of the sigma point sets, calculating sample points generated by nonlinear transformation for state prediction and correction; based on the sample points generated by the nonlinear transformation, determining the mean and variance matrix of the mapping for updating the system state estimate.

[0020] In some embodiments, after the state equation and the measurement equation are processed in the prediction stage using an unscented transformation method, the method further includes: discretizing the state equation using a fourth-order Runge-Kutta algorithm.

[0021] In some embodiments, a dynamic model constraint equation for the high-speed flying body rotating around its center of mass is constructed, including: constructing the dynamic model constraint equation based on the component of the static moment in the quasi-projectile coordinate system, the component of the equatorial damping moment in the quasi-projectile coordinate system, and ignoring the polar damping moment of the rolling channel and the Magnus moment whose influence is less than a threshold value of influence.

[0022] According to one aspect of the present invention, there is provided a device for accurately solving high-spin attitude with embedded ballistic dynamics, comprising: a construction module, configured to construct a double-spin trajectory model of a high-spin flying object, obtain preset trajectory data and divide the trajectory interval; an attitude solving module, configured to solve the pitch and yaw attitude of the high-spin flying object based on the preset trajectory data using an unscented Kalman filter algorithm to obtain the yaw angle and pitch angle of the high-spin flying object.

[0023] In an embodiment of the present invention, the preset ballistic data and angular rate gyroscope measurement information are used as input, and according to the kinematic model constraints, the roll posture of the high-rotating flying body is solved by affine rotation modulation inversion to obtain the roll angle of the high-rotating flying body, thereby solving the technical problem that it is difficult to accurately obtain the roll angle of the high-rotating flying body in a high-dynamic motion environment. BRIEF DESCRIPTION OF THE DRAWINGS

[0024] The drawings constituting part of the present application are used to provide a further understanding of the present application. The exemplary embodiments and descriptions of the present application are used to explain the present application and do not constitute an improper limitation on the present application. In the drawings:

[0025] Figure 1 is a flow chart of a high-spin roll angle aerial estimation method based on affine rotation modulation according to an embodiment of the present application;

[0026] Figure 2A is a schematic diagram of the composition of a high-speed flying body according to an embodiment of the present application;

[0027] Figure 2B is a schematic diagram of the relationship between the velocity coordinate system, the quasi-projectile coordinate system and the reference coordinate system according to an embodiment of the present application;

[0028] Figure 3 is a schematic diagram of converting a velocity coordinate system into a quasi-projectile coordinate system according to an embodiment of the present application;

[0029] Figure 4 (a) is a three-dimensional ballistic trajectory diagram according to an embodiment of the present application, and (b) is a schematic diagram of the change of height over time according to an embodiment of the present application;

[0030] Figure 5 is a graph showing the change of attitude angle over time according to an embodiment of the present application;

[0031] Figure 6 is a schematic diagram of converting a quasi-projectile coordinate system into a projectile coordinate system according to an embodiment of the present application;

[0032] Figure 7 is a flow chart of a method for accurately calculating a high-spin posture with built-in ballistic dynamics according to an embodiment of the present application;

[0033] Figure 8 is a roll attitude solution diagram for the entire flight according to an embodiment of the present application;

[0034] Fig. 9 1 is a diagram of the pitch and yaw attitude solution error during the entire flight according to an embodiment of the present application, wherein (a) is a schematic diagram of the gyroscope integral solution, and (b) is a schematic diagram of the UKF solution;

[0035] Fig.10is a comparison diagram of the mean values ​​of roll angle solution errors under four wind conditions according to an embodiment of the present application;

[0036] Fig.11 It is a comparison of the mean values ​​of the pitch angle and yaw angle solution errors under four wind conditions according to the embodiment of the present application;

[0037] Fig.12 is a structural schematic diagram of a high-spin roll angle aerial estimation device based on affine rotation modulation according to an embodiment of the present application;

[0038] Fig.13 A schematic diagram of the structure of an electronic device suitable for implementing the embodiments of the present disclosure is shown. DETAILED DESCRIPTION

[0039] It should be noted that, in the absence of conflict, the embodiments and features in the embodiments of the present application can be combined with each other. The present application will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.

[0040] It should be noted that the terms used herein are only for describing specific embodiments and are not intended to limit the exemplary embodiments according to the present application. As used herein, unless the context clearly indicates otherwise, the singular form is also intended to include the plural form. In addition, it should be understood that when the terms "comprise" and / or "include" are used in this specification, it indicates the presence of features, steps, operations, devices, components and / or combinations thereof.

[0041] Unless otherwise specifically stated, the relative arrangement, numerical expressions and numerical values ​​of the parts and steps set forth in these embodiments do not limit the scope of the application. Meanwhile, it should be understood that, for ease of description, the sizes of the various parts shown in the accompanying drawings are not drawn according to actual proportional relationships. The technology, methods and equipment known to those of ordinary skill in the relevant art may not be discussed in detail. In all examples shown and discussed here, any specific value should be interpreted as being merely exemplary, rather than as a limitation. Therefore, other examples of exemplary embodiments may have different values. It should be noted that similar reference numerals and letters represent similar items in the following drawings, and therefore, once a certain item is defined in an accompanying drawing, it does not need to be further discussed in subsequent drawings.

[0042] Overview

[0043] The motion of a high-spinning flying body in a high-dynamic environment has strong coupling and complex nonlinearity. It is difficult for the attitude sensor strapped to the flying body to obtain accurate attitude information. Therefore, this application proposes a trajectory-assisted high-spinning flying body attitude precision solution method. First, a high-spinning flying body double-spin trajectory model is constructed to obtain preset trajectory data and divide the trajectory interval. Secondly, the preset trajectory data and angular rate gyroscope measurement information are used as input, and the roll attitude is solved by affine rotation modulation inversion according to the kinematic model constraints. Finally, according to the dynamic model constraints, an unscented Kalman filter algorithm is designed for the solution of pitch and yaw attitude. The simulation experimental results of this application show that the trajectory-assisted attitude solution method has high accuracy. Under conventional wind disturbance, the average error of roll, pitch and yaw attitude does not exceed 1.84°, 0.21° and 0.22° throughout the process, which meets the accuracy requirements of the guidance control system. This application uses kinematic model and dynamic model constraints to propose a trajectory-assisted high-spinning flying body attitude precision solution method to achieve high-precision output of attitude information in a high-dynamic environment.

[0044] Example 1

[0045] The embodiment of the present application provides a high-speed roll angle estimation method based on affine rotation modulation, such as Figure 1 As shown, the method comprises the following steps:

[0046] Step S102, establishing a high-spinning flying object model and acquiring preset trajectory data.

[0047] The high-spinning flying body consists of two parts: the front body and the rear body. Figure 2A As shown, after launch, the front body rotates at high speed to maintain gyroscopic stability throughout the flight, and the rear body quickly despins to about 20r / s, and after the initial alignment is completed, attitude solution begins to provide input for the guidance and control system.

[0048] 1) Construct a double-spin trajectory model for a high-spin flying object

[0049] The mathematical model of the center of mass motion of a high-speed flying body is established in the velocity coordinate system OX V Y V Z V The mathematical model of rotation around the center of mass is established in the quasi-projectile coordinate system Oξηζ. The ground launch coordinate system is translated to the center of mass O of the flying body to obtain the reference coordinate system OX N Y N Z N , let θ V and They represent the velocity inclination and velocity deviation of the flying body respectively. and ψ represent the pitch angle and yaw angle of the flying body respectively, then the relationship between the velocity coordinate system, the quasi-projectile coordinate system and the reference coordinate system can be established as follows: Figure 2B shown.

[0050] The component of the flying body's own velocity v in the velocity coordinate system is [v,0,0] T When there is wind, the magnitude and direction of the aerodynamic force and torque on the flying body depend on its relative air velocity v r The magnitude and direction of the wind speed. Assume that the wind speed component in the launch coordinate system is w = [w x ,0,w z ], then the relative speed v r The component form in the velocity coordinate system is expressed as:

[0051]

[0052] In the formula, is the component of wind speed in the velocity coordinate system, and the calculation formula is:

[0053]

[0054] In the formula, Represents the transformation matrix from the reference coordinate system to the velocity coordinate system. The magnitude of the relative velocity v r It can be expressed as:

[0055]

[0056] Depend on Figure 2B It can be seen that the longitudinal axis of the flying body and the relative speed v r There is a relative angle of attack δ r , assuming that the unit vector in the longitudinal direction of the flying body is ξ, the relative angle of attack can be calculated as:

[0057]

[0058] In the formula, is the projection of the relative velocity on the longitudinal axis of the flying body, which can be expressed as:

[0059]

[0060] In the formula, α and β represent the altitude angle of attack and azimuth angle of attack of the flying body, respectively. Figure 3 As shown, the calculation formula is:

[0061]

[0062] Taking the reference coordinate system as the inertial system and the angular velocity vector Ω as the rotational angular velocity of the velocity coordinate system relative to the inertial system, the dynamic equation of the center of mass motion of the flying body can be expressed in the velocity coordinate system as follows:

[0063]

[0064] Where m is the mass of the flying object, v is the velocity vector of the center of mass of the flying object, and F X 、F Y 、F Z and G represent the drag, lift, Magnus force and gravity of the flying body during its motion. X 、F Y and F Z The expression is as follows:

[0065]

[0066] In the formula, ρ is the atmospheric density, S is the cross-sectional area of ​​the flying body, and c x 、c y With c z They are the drag coefficient, lift coefficient and Magnus force coefficient respectively.

[0067] The three-axis projection components of formula (7) in the velocity coordinate system are:

[0068]

[0069] According to the conversion relationship between the velocity coordinate system and the reference coordinate system, the kinematic equation of the center of mass motion of the flying body can be obtained as follows:

[0070]

[0071] The angular velocity vector ω represents the rotational angular velocity of the quasi-projectile coordinate system relative to the inertial system. Suppose the total angular vectors of the front and rear bodies of the flying body rotating around the center of mass are ω respectively. f and ω a , and the relationship between the angular velocity vector ω of the quasi-projectile coordinate system is:

[0072]

[0073] In the formula, γ f and γ a Respectively represent the roll angles of the front and rear bodies of the flying body. Then the dynamic equation of the flying body rotating around the center of mass can be expressed in the quasi-projectile coordinate system as follows:

[0074]

[0075] In the formula, J f and J a are the moment of inertia matrices of the front and rear bodies about the principal axis of inertia of the overall center of mass, M f and M a are the combined external moments acting on the front and rear bodies, F b and M b are the restraining force and restraining moment at the bearing connection, r bIt is the distance from the center of mass of the flying body to the bearing connection.

[0076] Assume that the masses of the front and rear bodies are m f and m a , the polar moments of inertia are C f and C a , and the equatorial moments of inertia are A f and A a , the distances from the center of mass of the front and rear bodies to the center of mass of the whole body are r f and r a Assuming that the principal axes of inertia of the front and rear bodies are parallel to the principal axis of inertia of the overall center of mass, then J f and J a Respectively expressed as:

[0077]

[0078]

[0079] The three-axis projection components of formula (12) in the quasi-projectile coordinate system are:

[0080]

[0081] Combining equations (15) and (16), we get the dynamic equations of the flying body rotating around the center of mass in the quasi-projectile coordinate system:

[0082]

[0083] In the formula, is the equivalent equatorial moment of inertia of the flying body, and are the equivalent pitch moment and equivalent yaw moment of the flying body in the quasi-projectile coordinate system, including the static moment M of the flying body during its motion. z , Equatorial damping moment M zz , extreme damping moment M xz and Magnus moment M y wait.

[0084] Projecting equation (11) into the quasi-projectile coordinate system, we can obtain the kinematic equations for the flying body rotating around its center of mass:

[0085]

[0086] 2) Acquisition of preset trajectory data and division of trajectory intervals

[0087] Under ideal initial conditions, the fourth-order Runge-Kutta numerical integration method is used to solve the mathematical model established above and obtain the preset trajectory data. The Runge-Kutta method can be regarded as a generalization of the Euler method. It has the advantages of high calculation accuracy and the ability to ensure stability in the process of solving the mathematical model. It has been widely used in engineering. Without considering the structural changes of the flying body, ignoring the influence of the deviation of atmospheric pressure, atmospheric density, and coordinate position on the motion, and without considering the initial disturbance and wind interference, the initial simulation conditions are set as shown in Table 1.

[0088] Tab1. Initial conditions for simulation under ideal conditions

[0089]

[0090] The numerical integration simulation results are as follows Figure 4 As shown, Figure 4 (a) is the three-dimensional ballistic trajectory of a high-spinning flying object at a shooting angle of 45°. Figure 4 (b) is the law of its altitude changing with time. Since the rear body of the flying body needs a certain amount of time to reduce the spin after launch, 0s to 10s is defined as the despinning section. According to the law of the flight altitude changing with time, 10s to 32s, 32s to 50s and 50s to 90s can be defined as the ascending arc section, the vicinity of the apex and the descending arc section respectively. Thus, the trajectory is divided into intervals, and the law of the change of the attitude information of the high-spinning flying body is discussed in stages.

[0091] The change law of attitude angle over time is as follows Figure 5 As shown. Figure 5 It can be seen that under the action of the despinning torque, the frequency of the roll angle change shows a sharp downward trend in the despinning section and gradually stabilizes. From the ascending arc section to the descending arc section, under the influence of the forebody guide torque, the frequency of the roll angle change undergoes a process of first increasing and then decreasing. The pitch angle shows a trend of gradually decreasing throughout the trajectory. It is worth noting that near the apex, the descent rate of the pitch angle is significantly accelerated. This change will have an adverse effect on the accuracy of attitude solution. The change pattern of the yaw angle is manifested as a gradual increase in the despinning section and the ascending arc section, reaching a maximum value near the apex, and then gradually decreasing in the descending arc section.

[0092] Step S104, using the preset trajectory data and the angular rate gyro measurement information as input, according to the kinematic model constraints, the roll attitude of the high-rotating flying body is solved by affine rotation modulation inversion to obtain the roll angle of the high-rotating flying body.

[0093] Projectile coordinate system OX B Y B Z BThe relationship between the quasi-projectile coordinate system Oξηζ is as follows Figure 6 As shown. Figure 6 It can be seen that the quasi-projectile coordinate system does not roll with the projectile, but only changes with the pitch and yaw of the projectile, and is connected to the projectile coordinate system through the rear body roll angle γ a The direct output of the angular rate gyro is the angular rate information of the flying body in the missile body coordinate system, and the attitude angle information can only be extracted through numerical integration. Due to the existence of its own drift and the accumulation of errors in the numerical integration process, the accuracy of the gyro attitude solution will gradually decrease until it completely diverges. In actual flight, the rear body speed of the flying body after the despin is still close to 20r / s. Although it meets the measurement range of some large-range gyroscopes, the data obtained by the solution is of low accuracy and even cannot be used.

[0094] The present application proposes a method for solving the rolling attitude based on affine rotation modulation inversion according to the kinematic model constraints of the high-speed flying body rotating around the center of mass.

[0095] For the rear body of a high-spinning flying body, the kinematic equation representing its rotation around the center of mass in the projectile coordinate system is:

[0096]

[0097] In the formula, They respectively represent the three-axis components of the angular velocity of the rear body of the high-spinning flying body relative to the inertial coordinate system in the projectile coordinate system, that is, the measurement values ​​of the angular rate gyroscope strapped to the three axes of the rear body.

[0098] Since the rear body of the high-speed flying body always rotates around its own longitudinal axis, the measurement values ​​of the angular rate gyroscopes strapped to the y-axis and z-axis of the rear body are modulated by the affine rotation of the rear body rolling motion, showing a periodic variation pattern. The latter two equations of equation (18) and the first two equations of equation (19) can be combined to express:

[0099]

[0100] Further expressed as:

[0101]

[0102] From formula (21), we can see that with the preset trajectory data ω η and ω ζ Gyro measurement data with angular rate and As input, the affine rotation modulation effect caused by the rear body rolling motion of the high-rotation flying body can be inverted, so that the rear body rolling attitude information of the flying body can be solved in real time during the flight:

[0103]

[0104] Example 2

[0105] The present application embodiment provides a method for accurately calculating high-spin postures with built-in ballistic dynamics, such as Figure 7 As shown, the method comprises the following steps:

[0106] Step S702, constructing a double-spin trajectory model for a high-spin flying object, obtaining preset trajectory data and dividing the trajectory intervals.

[0107] This step is similar to step S102 and will not be described again here.

[0108] Step S704: Based on the preset trajectory data, an unscented Kalman filter algorithm is used to solve the pitch and yaw attitude of the high-rotating flying object to obtain the yaw angle and pitch angle of the high-rotating flying object.

[0109] In practice, when studying the motion of the pitch and yaw channels of a high-speed flying body, the extreme damping moment that mainly affects the roll channel is often not considered, and the weaker Magnus moment effect is ignored. By transforming equations (17) and (18) and ignoring the higher-order terms, we can obtain:

[0110]

[0111] In the formula and are the components of the static moment in the quasi-projectile coordinate system, and are the components of the equatorial damping moment in the quasi-projectile coordinate system, as shown in Equations (24) and (25).

[0112]

[0113] In the formula, and The relative speed v is r Components in the quasi-projectile coordinate system. Since the attack angle of a stable flying body is very small during actual flight, the distance it deviates from the shooting surface is also very small compared to the range, so α, β, ψ, If both are small and the influence of wind is not considered, the following relationship holds:

[0114]

[0115] Let A z =ρSlm′ z / 2A, the static moment component can be expressed as:

[0116]

[0117] Also, ignoring the effect of wind, let A zz = -ρSldm′ zz / 2A, the equatorial damping component can be expressed as:

[0118]

[0119] Combining equations (26) to (28), we get the total external moment component:

[0120]

[0121] Substituting equation (29) into equation (23), we can obtain the constraint equation of the dynamic model of the high-speed flying body rotating around the center of mass as shown in equation (30).

[0122]

[0123] Where, the velocity inclination angle θ V , speed deflection angle Flight body front body speed The flight speed v is provided by the preset trajectory data, and the speed of the flying body is The rear body roll angle γ is calculated in real time by equation (22): a Then it is given by difference calculation.

[0124] Taking the constraint equation of the dynamic model as the state equation, this application designs a pitch and yaw attitude solution method based on the Unscented Kalman Filter (UKF). Compared with EKF, UKF has stronger robustness and is more suitable for processing complex models with strong nonlinearity and uncertainty.

[0125] UKF is essentially a linear minimum variance estimation. First, the sample point set is determined based on the state equation and the measurement equation, then the covariance matrix is ​​calculated from the sample point set, and finally the optimal gain matrix is ​​determined through the covariance matrix. During the entire calculation process, the algorithm does not do any processing on the state equation and the measurement equation. The unscented transform (UT) is the core of the UKF algorithm. The idea is to approximate a Gaussian distribution with a fixed number of parameters, which can achieve the same accuracy as retaining the third-order term of the Taylor series. Assume that the n-dimensional random vector After the nonlinear function y=f(x) is transformed, we get the n-dimensional random variable y. Then, the mean of y can be obtained through UT transformation. With variance P y The specific process is described as follows:

[0126] (1) Calculate 2n+1 Sigma point sets and their weights

[0127]

[0128] Where λ = p 2 (n+k)-n, where p determines the degree of spread of the Sigma point set, usually taking a small positive value, and k is usually 3-n; q is used to describe the distribution of the independent variable x, and when it is Gaussian distribution, β=2 is the optimal value; Represents the matrix (n+λ)P x The i-th column of the square root of the lower triangular decomposition of is an n-dimensional column vector; is the weight of the mean, is the weight of the variance.

[0129] (2) Calculate the sample points generated by nonlinear transformation

[0130] Y i =f(X i ), i=1,2,...,2n (33)

[0131] (3) Determine the mean and variance matrix of the mapping

[0132]

[0133] According to formula (29), the state variable

[0134] We can get:

[0135]

[0136] Since the above formula is only an approximate description of the dynamic model of the high-speed flying body rotating around the center of mass, there are some unmodeled errors, so a Gaussian white noise W is introduced, W~N(0,Q), where Q is the system noise covariance matrix.

[0137] Taking the preset trajectory data and the real-time output measurement information of the angular rate gyroscope as the quantity measurement, the measurement equation can be constructed as follows:

[0138]

[0139] Where V is the measurement noise, V~N(0,R), and R is the covariance matrix of the measurement noise.

[0140] In summary, the specific execution steps of the UKF algorithm are as follows:

[0141] (1) Determine the initial value of the filter

[0142]

[0143] (2) Calculate the Sigma point set

[0144]

[0145] (3) Prediction stage

[0146]

[0147] (4) Correction stage

[0148]

[0149] In order to be applicable in practice, the continuous state equation needs to be discretized. This application also uses the fourth-order Runge-Kutta algorithm to discretize the state prediction equation, that is, rewrite equation (39) as:

[0150]

[0151] Where t is the calculation step length. Simulation experiment and result analysis

[0152] In order to verify the effectiveness of the ballistic-assisted high-rotation flying object attitude accurate solution method proposed in this application, this application is launched at a 45° shooting angle under conventional level 3 wind disturbance. By setting different initial disturbances, 16 disturbed ballistic trajectories are obtained as actual flight conditions. The wind speed and direction settings of different wind conditions are shown in Table 2.

[0153] Tab2.Wind condition settings

[0154]

[0155] Taking wind condition 1 in Table 2 as an example, different initial disturbance conditions are set as shown in Table 3.

[0156] Tab3. Different Initial Disturbance Condition Settings for Wind Condition 1

[0157]

[0158] The error characteristics of the three-axis angular rate gyroscope are shown in Table 4. Taking trajectory 1 in Table 3 as the actual flight situation, the comparison of the roll attitude results calculated by gyroscope integral solution and affine rotation modulation inversion solution is as follows: Figure 8 As shown in the figure, compared with the pitch and yaw attitude results calculated based on UKF, Fig. 9 shown.

[0159] Tab4.Angular rate gyroscope error characteristics

[0160]

[0161] Depend on Figure 8 It can be seen that for the attitude information of the roll channel, the gyroscope integral solution error fluctuates greatly and gradually diverges over time, and the data availability is poor. However, the solution method of affine rotation modulation inversion only has a small oscillating error in the initial stage, and then converges quickly over time.

[0162] Depend on Fig. 9 (a) It can be seen that the pitch angle and yaw angle obtained by the gyroscope integral solution also show a law of gradually diverging over time. Fig. 9 (b) It can be obtained that the pitch angle error based on UKF solution shows a gradually decreasing trend in the ascending arc section and reaches a peak value near the apex. Since the pitch angle velocity changes rapidly near the apex, the solution error increases. The solution error begins to decrease after reaching a peak near the apex, and then continues to decrease gradually in the descending arc section, showing an overall convergence trend; the yaw angle error based on UKF solution first decreases in the ascending arc section, then increases and reaches a peak value, and gradually decreases near the apex and in the descending arc section, showing an overall convergence trend. The average errors of the two methods of gyro integral solution and trajectory-assisted attitude precision solution at different stages of the entire flight are shown in Table 5.

[0163] Tab. 5. Average error of attitude angle at different stages of the entire flight

[0164]

[0165] It can be seen from Table 5 that the attitude solution accuracy of the method proposed in this application is superior to that of the gyroscope integral solution in the three channels of roll, pitch and yaw, and can accurately obtain the full-process attitude information of the flying body in a high-dynamic flight environment, which is of great significance for effectively realizing the guidance and control of high-rotating flying bodies.

[0166] A total of 16 disturbed ballistic trajectories under four wind conditions were used as actual flight conditions. The method proposed in this application and the gyroscope integral solution method were applied to calculate the mean error of the roll, pitch and yaw attitude solution throughout the entire process. The results of the two methods were compared. Fig.10 and Fig.11 shown.

[0167] Depend on Fig.10 It can be seen that the roll attitude solution method based on affine rotation modulation inversion proposed in this application has significantly better attitude solution accuracy than the gyroscope integral solution under four wind disturbance conditions, and the average error of the roll angle throughout the process is the largest under wind condition 4, which is about 1.84°.

[0168] Depend on Fig.11 It can be seen that the pitch and yaw attitude solution method based on UKF proposed in this application is also significantly better than the gyro integral solution in the four wind disturbance conditions. The average error of the pitch angle is the largest in wind condition 3, about 0.21°, and the average error of the yaw angle is the largest in wind condition 4, about 0.22°. The attitude information obtained by the method proposed in this paper meets the accuracy requirements of the guidance and control system input, and provides effective support for the guidance and intelligent transformation of high-speed flight systems.

[0169] This application mainly aims at the problem that it is difficult to accurately obtain the attitude of a high-spinning flying object in a high-dynamic motion environment. By establishing a dual-spin mathematical model to obtain preset ballistic data, and combining the angular rate gyro measurement information, a trajectory-assisted attitude precision solution method is proposed. The method proposed in this application not only focuses on the fusion and processing of data levels, but also takes into account the dynamic and kinematic constraints of the flying object itself. According to the kinematic model, a roll attitude solution method based on affine rotation modulation inversion is constructed, and a pitch and yaw attitude solution method based on UKF is designed according to the dynamic model. Compared with the traditional gyroscope integral solution method, the accuracy of the solution of the three channels of attitude information of the flying object roll, pitch and yaw is significantly improved, which is conducive to the further research and optimization of the guidance and intelligent technology of high-spinning flying objects.

[0170] Example 3

[0171] The embodiment of the present application provides a high-speed roll angle estimation device based on affine rotation modulation, such as Fig.12 As shown, it includes: a construction module 122 is configured to construct a double-spin trajectory model of a high-spin flying object, obtain preset trajectory data and divide the trajectory interval; a roll angle estimation module 124 is configured to take the preset trajectory data and angular rate gyroscope measurement information as input, and according to the kinematic model constraints, solve the roll posture of the high-spin flying object through affine rotation modulation inversion to obtain the roll angle of the high-spin flying object.

[0172] An embodiment of the present application provides a high-spin attitude precision solution device with embedded ballistic dynamics, including: a construction module, configured to construct a double-spin trajectory model of a high-spin flying object, obtain preset trajectory data and divide the trajectory interval; an attitude solution module, configured to solve the pitch and yaw attitude of the high-spin flying object based on the preset trajectory data using an unscented Kalman filter algorithm to obtain the yaw angle and pitch angle of the high-spin flying object.

[0173] It should be noted that the device provided in the above embodiment is only illustrated by the division of the above functional modules. In actual applications, the above functions can be assigned to different functional modules as needed, that is, the internal structure of the device is divided into different functional modules to complete all or part of the functions described above. In addition, the corresponding method embodiments provided in the above embodiment belong to the same concept, and the specific implementation process is detailed in the method embodiment, which will not be repeated here.

[0174] Example 4

[0175] Fig.13 FIG. 1 shows a schematic diagram of the structure of an electronic device suitable for implementing the embodiment of the present disclosure. It should be noted that: Fig.13 The electronic device shown is only an example and should not bring any limitation to the functions and scope of use of the embodiments of the present disclosure.

[0176] like Fig.13 As shown, the electronic device includes a central processing unit (CPU) 1001, which can perform various appropriate actions and processes according to a program stored in a read-only memory (ROM) 1002 or a program loaded from a storage part 1008 into a random access memory (RAM) 1003. In the RAM 1003, various programs and data required for system operation are also stored. The CPU 1001, the ROM 1002, and the RAM 1003 are connected to each other via a bus 1004. An input / output (I / O) interface 1005 is also connected to the bus 1004.

[0177] The following components are connected to the I / O interface 1005: an input section 1006 including a keyboard, a mouse, etc.; an output section 1007 including a cathode ray tube (CRT), a liquid crystal display (LCD), etc., and a speaker, etc.; a storage section 1008 including a hard disk, etc.; and a communication section 1009 including a network interface card such as a LAN card, a modem, etc. The communication section 1009 performs communication processing via a network such as the Internet. A drive 1010 is also connected to the I / O interface 1005 as needed. A removable medium 1011, such as a magnetic disk, an optical disk, a magneto-optical disk, a semiconductor memory, etc., is installed on the drive 1010 as needed, so that a computer program read therefrom is installed into the storage section 1008 as needed.

[0178] In particular, according to an embodiment of the present disclosure, the process described below with reference to the flowchart can be implemented as a computer software program. For example, an embodiment of the present disclosure includes a computer program product, which includes a computer program carried on a computer-readable medium, and the computer program contains a program code for executing the method shown in the flowchart. In such an embodiment, the computer program can be downloaded and installed from the network through the communication part 1009, and / or installed from the removable medium 1011. When the computer program is executed by the central processing unit (CPU) 1001, various functions defined in the method and apparatus of the present application are executed. In some embodiments, the electronic device may also include an AI (Artificial Intelligence) processor, which is used to process computing operations related to machine learning.

[0179] It should be noted that the computer-readable medium shown in the present disclosure may be a computer-readable signal medium or a computer-readable storage medium or any combination of the above two. The computer-readable storage medium may be, for example, but not limited to, an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, device or device, or any combination of the above. More specific examples of computer-readable storage media may include, but are not limited to: an electrical connection with one or more wires, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above. In the present disclosure, a computer-readable storage medium may be any tangible medium containing or storing a program that can be used by or in combination with an instruction execution system, device or device. In the present disclosure, a computer-readable signal medium may include a data signal propagated in a baseband or as part of a carrier wave, in which a computer-readable program code is carried. This propagated data signal may take a variety of forms, including but not limited to electromagnetic signals, optical signals, or any suitable combination of the above. Computer-readable signal media may also be any computer-readable medium other than computer-readable storage media, which may send, propagate or transmit a program for use by or in conjunction with an instruction execution system, apparatus or device. The program code contained on the computer-readable medium may be transmitted using any appropriate medium, including but not limited to: wireless, wire, optical cable, RF, etc., or any suitable combination of the above.

[0180] The flow charts and block diagrams in the accompanying drawings illustrate the possible architecture, functions and operations of the systems, methods and computer program products according to various embodiments of the present disclosure. In this regard, each box in the flow chart or block diagram can represent a module, a program segment, or a part of a code, and the above-mentioned module, program segment, or a part of a code contains one or more executable instructions for realizing the specified logical function. It should also be noted that in some alternative implementations, the functions marked in the box can also occur in a different order from the order marked in the accompanying drawings. For example, two boxes represented in succession can actually be executed substantially in parallel, and they can sometimes be executed in the opposite order, depending on the functions involved. It should also be noted that each box in the block diagram or flow chart, and the combination of the boxes in the block diagram or flow chart can be implemented with a dedicated hardware-based system that performs a specified function or operation, or can be implemented with a combination of dedicated hardware and computer instructions.

[0181] The units involved in the embodiments described in the present disclosure may be implemented by software or hardware, and the units described may also be arranged in a processor. The names of these units do not, in some cases, constitute limitations on the units themselves.

[0182] As another aspect, the present application further provides a computer-readable medium, which may be included in the electronic device described in the above embodiment; or may exist independently without being assembled into the electronic device.

[0183] The computer-readable medium carries one or more programs, and when the one or more programs are executed by an electronic device, the electronic device implements the method described in the following embodiments. For example, the electronic device can implement each step of the method embodiment.

[0184] If the integrated units in the above embodiments are implemented in the form of software functional units and sold or used as independent products, they can be stored in the above computer-readable storage medium. Based on this understanding, the technical solution of the present application, or the part that contributes to the prior art, or all or part of the technical solution can be embodied in the form of a software product, which is stored in a storage medium and includes several instructions for enabling one or more computer devices (which may be personal computers, servers, or network devices, etc.) to execute all or part of the steps of the methods described in the various embodiments of the present application.

[0185] In the above embodiments of the present application, the description of each embodiment has its own emphasis. For parts that are not described in detail in a certain embodiment, please refer to the relevant description of other embodiments.

[0186] In the several embodiments provided in the present application, it should be understood that the disclosed terminal device can be implemented in other ways. Among them, the device embodiments described above are only schematic, for example, the division of the units is only a logical function division, and there may be other division methods in actual implementation, for example, multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of units or modules, which can be electrical or other forms.

[0187] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.

[0188] In addition, each functional unit in each embodiment of the present application may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit. The above-mentioned integrated unit may be implemented in the form of hardware or in the form of software functional units.

[0189] The above is only a preferred implementation of the present application. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principles of the present application. These improvements and modifications should also be regarded as the scope of protection of the present application.

Claims

1. A high-speed roll angle estimation method based on affine rotation modulation, characterized in that: include: Construct a double-spin trajectory model for a high-spin flying object, obtain preset trajectory data and divide the trajectory interval; The preset trajectory data and the angular rate gyro measurement information are used as inputs, and according to the kinematic model constraints, the roll attitude of the high-spinning flying body is solved through affine rotation modulation inversion to obtain the roll angle of the high-spinning flying body.

2. The method according to claim 1, characterized in that Taking the preset trajectory data and the angular rate gyro measurement information as input, according to the kinematic model constraints, the roll attitude of the high-spinning flying body is solved by affine rotation modulation inversion to obtain the roll angle of the high-spinning flying body, including: A first kinematic equation of the high-rotation flying body rotating around its center of mass is constructed in a quasi-projectile coordinate system; Constructing a second kinematic equation of the rear body of the high-rotating flying body in a projectile coordinate system to represent the rotation of the rear body around the center of mass; The first kinematics equation and the second kinematics equation are combined to obtain an affine rotation modulation relationship equation of angular velocity information; Using the preset trajectory data and the angular rate gyro measurement information as inputs to the affine rotation modulation relationship equation, the affine rotation modulation effect caused by the rear body rolling motion of the high-spinning flying body is inverted to obtain the rolling angle of the rear body of the high-spinning flying body in real time during the flight; The kinematic model constraints include the first kinematic equation and the second kinematic equation.

3. The method according to claim 2, characterized in that Constructing a second kinematic equation of the rear body of the high-rotating flying body in the body coordinate system to represent the rotation of the rear body around the center of mass includes: Acquiring the angular rate gyroscope measurement information of the three-axis angular rate gyroscope strapped to the rear body; The second kinematic equation is constructed based on the angular rate gyro measurement information, the yaw angle, and the roll angle.

4. The method according to claim 2, characterized in that: The preset trajectory data and the angular rate gyro measurement information are used as inputs of the affine rotation modulation relationship equation, and the affine rotation modulation effect caused by the rolling motion of the rear body of the high-rotating flying body is inverted to obtain the rolling angle of the rear body of the high-rotating flying body in real time during the flight, including: Derived a geometric representation of the roll angle based on the affine rotation modulation relationship equation, and derived a solution formula for the roll angle based on the geometric representation of the roll angle; The preset trajectory data and the angular rate gyro measurement information are input into the roll angle solution formula, and the affine rotation modulation effect caused by the rear body rolling motion of the high-spinning flying body is inverted to obtain the roll angle of the rear body of the high-spinning flying body in real time during the flight.

5. The method according to claim 4, characterized in that The preset trajectory data is obtained by establishing a double-rotation mathematical model; the angular rate gyroscope measurement information includes the y-axis and z-axis components of the three-axis components of the rotational angular velocity of the rear body of the high-rotation flying body relative to the inertial coordinate system in the projectile coordinate system.

6. The method according to claim 4, characterized in that The affine rotation modulation relationship in the affine rotation modulation relationship equation is: the rear body of the high-speed flying body always rotates around its own longitudinal axis, and the measurement value of the angular rate gyroscope strapped to the y-axis and z-axis of the rear body presents a periodic change pattern after the affine rotation modulation of the rolling motion of the rear body.

7. The method according to claim 4, characterized in that After obtaining the roll angle of the high-spinning flying object, the method further includes: based on the preset trajectory data, using unscented Kalman filtering to solve the pitch and yaw attitude of the high-spinning flying object to obtain the yaw angle and pitch angle of the high-spinning flying object.

8. A high-speed roll angle estimation device based on affine rotation modulation, characterized in that: include: A construction module is configured to construct a double-spin trajectory model for a high-spin flying object, obtain preset trajectory data, and divide the trajectory interval; The roll angle estimation module is configured to take the preset trajectory data and the angular rate gyroscope measurement information as input, and solve the roll attitude of the high-rotating flying body through affine rotation modulation inversion according to the kinematic model constraints to obtain the roll angle of the high-rotating flying body.

9. An electronic device, characterized in that: include: a memory configured to store a computer program; The processor is configured to make the computer execute the method according to any one of claims 1 to 7 when the program is executed.

10. A computer-readable storage medium having a program stored thereon, characterized in that: When the program is executed, the computer is caused to execute the method according to any one of claims 1 to 7.