Carrier rocket load regulation and attitude control method and device based on radar wind measurement, medium and product
By acquiring wind speed and attitude information through radar wind measurement, and combining it with model predictive control and extended state observer, the control sequence is optimized, solving the problem of inaccurate load reduction control in existing technologies, and realizing refined load reduction and improved stability of launch vehicles.
Patent Information
- Application Number
- CN202411178074.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-26
- Publication Date
- 2024-11-29
- Estimated Expiration
- 2044-08-26
AI Technical Summary
Existing active load reduction control methods cannot accurately reduce load, resulting in reduced stability of the control system and an inability to finely adjust the load on the rocket body structure.
A radar-based wind measurement method is adopted to obtain information on the launch vehicle's wind speed, angle of attack, and engine pitch angle. This information is then combined with a model predictive controller and an extended state observer to optimize the control sequence and achieve accurate load reduction.
It enabled accurate load reduction of the launch vehicle, improved the stability of the control system and the precision of load adjustment of the rocket body structure, and enhanced anti-interference capabilities.
Smart Images

Figure CN119045439A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of launch vehicle load reduction control, and in particular to a launch vehicle load regulation and attitude control method, equipment, medium and product based on radar wind measurement. Background Art
[0002] The main function of the launch vehicle control system is to ensure attitude stability and tracking under various disturbances. When flying in the high dynamic pressure area, the aerodynamic load generated by the wind will exert an impact on the rocket. In order to maintain attitude stability and tracking, the attitude control system must generate a control torque that is balanced with the aerodynamic load, which will cause the rocket body structure to bear the bending moment generated by the interaction between the two, so it is necessary to increase the structural strength. With the increasing complexity of rocket launch missions, the requirements for structural efficiency and carrying capacity are constantly increasing. In order to smoothly pass through the high dynamic pressure area under limited structural strength indicators, active load reduction control technology has been widely studied.
[0003] The idea of the existing active load reduction control method is to reduce the static bending moment load of the rocket body structure. The usual practice is to introduce feedback about the normal overload in the attitude control loop. This will bring the following problems: 1. Since the lateral acceleration information contains redundant information such as the normal component of thrust and rotational inertia force in addition to the aerodynamic load, direct feedback of the acceleration will reduce the stability of the control system and thus limit the load reduction ratio; 2. For the control system, load reduction only focuses on the characteristic quantity qα that reflects the load information, while the actual influence on the upper limit of the rocket body structure is the internal force bending moment, and the upper limit of the bending moment borne by each section of the rocket body is inconsistent, and the structural load cannot be finely adjusted.
[0004] In summary, the existing active load reduction control method cannot accurately reduce load. Summary of the invention
[0005] The purpose of this application is to provide a method, equipment, medium and product for load regulation and attitude control of a launch vehicle based on radar wind measurement, so as to accurately reduce the load of the launch vehicle.
[0006] To achieve the above objectives, this application provides the following solutions:
[0007] In a first aspect, the present application provides a method for load regulation and attitude control of a launch vehicle based on radar wind measurement, which is characterized by comprising:
[0008] Obtaining the one-dimensional wind speed measurement result, the angle of attack, the engine swing angle and the attitude information of the current moment of the laser radar at the current position of the carrier rocket; the one-dimensional wind speed measurement result is the projection of the wind speed measured by the laser radar in different measurement directions at the set position; the attitude information includes the attitude angle and the attitude angular velocity;
[0009] Determine the wind field information of the current position of the launch vehicle at a preset time according to the one-dimensional wind speed measurement result of the laser radar at the current time; the wind field information includes horizontal wind speed and horizontal wind direction;
[0010] According to the wind field information at the preset time, the angle of attack at the current time and the engine swing angle at the current time, determining the influence of the angle of attack and the engine swing angle on the body bending moment of the carrier rocket; the body bending moment is determined according to the bending moment generated by the aerodynamic force, the bending moment generated by the control force and the bending moment generated by the inertial force;
[0011] According to the attitude angle and the attitude angular velocity, the model predictive controller is solved to determine the optimized control quantity sequence; the model predictive controller includes a system output equation and a cost function; the system output equation is a linear equation about state quantity, control quantity and interference quantity determined according to the influence of the angle of attack and the engine swing angle on the arrow body bending moment of the carrier rocket; the state quantity is the attitude angle and the attitude angular velocity; the control quantity is the engine swing angle at the next moment; the cost function is determined according to the system output equation;
[0012] Determine the interference compensation amount by using an extended state observer according to the wind field information at the preset time, the angle of attack at the current time, the engine swing angle at the current time, the attitude angle and the attitude angular velocity;
[0013] A final control amount is determined according to the optimized control amount sequence and the interference compensation amount, and the launch vehicle is deloaded based on the final control amount.
[0014] In a second aspect, the present application provides a computer device, comprising: a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes the computer program to implement any of the above-mentioned methods for payload regulation and attitude control of a launch vehicle based on radar wind measurement.
[0015] In a third aspect, the present application provides a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements any of the above-mentioned methods for payload regulation and attitude control of a launch vehicle based on radar wind measurement.
[0016] In a fourth aspect, the present application provides a computer program product, including a computer program, which, when executed by a processor, implements any of the above-mentioned methods for payload regulation and attitude control of a launch vehicle based on radar wind measurement.
[0017] According to the specific embodiments provided in this application, this application discloses the following technical effects:
[0018] The present application provides a method, device, medium and product for load regulation and attitude control of a launch vehicle based on radar wind measurement, which obtains the wind field information at a preset time, the angle of attack at the current time, the engine swing angle at the current time and the attitude information of the current position of the launch vehicle; the attitude information includes the attitude angle and the attitude angular velocity; according to the wind field information at the preset time, the angle of attack at the current time and the engine swing angle at the current time, the influence of the angle of attack and the engine swing angle on the bending moment of the rocket body of the launch vehicle is determined; according to the attitude angle and the attitude angular velocity, the model predictive controller is solved to determine the optimized control quantity sequence; the model predictive controller includes a system output equation and a cost function; the system output equation is a linear equation about state quantity, control quantity and interference quantity determined according to the influence of the angle of attack and the engine swing angle on the bending moment of the rocket body of the launch vehicle; the cost function is determined according to the system output equation; according to the wind field information at the preset time, the angle of attack at the current time, the engine swing angle at the current time, the attitude angle and the attitude angular velocity, the interference compensation quantity is determined by using an extended state observer; according to the optimized control quantity sequence and the interference compensation quantity, the final control quantity is determined, and the launch vehicle is unloaded based on the final control quantity. This application realizes accurate load reduction of the launch vehicle. BRIEF DESCRIPTION OF THE DRAWINGS
[0019] In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings required for use in the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.
[0020] Figure 1 A schematic flow chart of a method for load regulation and attitude control of a launch vehicle based on radar wind measurement provided in one embodiment of the present application;
[0021] Figure 2 A flowchart of the actual application of the launch vehicle load regulation and attitude control method based on radar wind measurement in this application;
[0022] Figure 3 This is a control block diagram of the launch vehicle load regulation and attitude control method based on radar wind measurement in this application;
[0023] Figure 4 This is a schematic diagram of the arrow-borne radar;
[0024] Figure 5 It is a radar coordinate system, i.e. a schematic diagram of the measurement points;
[0025] Figure 6 Design payload schematics for rockets;
[0026] Figure 7 It is the load shedding control effect curve diagram;
[0027] Figure 8 It is a schematic diagram of the attitude angle deviation curve caused by load reduction;
[0028] Fig. 9 The model predicts the load reduction control error and the product of dynamic pressure and angle of attack for the disturbance compensation model;
[0029] Fig.10 The load shedding control error and qα curve diagram predicted by the model;
[0030] Fig.11 A schematic diagram of the structure of a computer device provided in one embodiment of the present application. DETAILED DESCRIPTION
[0031] The following will be combined with the drawings in the embodiments of the present application to clearly and completely describe the technical solutions in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.
[0032] In order to make the above-mentioned objects, features and advantages of the present application more obvious and easy to understand, the present application is further described in detail below with reference to the accompanying drawings and specific implementation methods.
[0033] This application models and predicts future wind fields through LiDAR measurements, and integrates future wind field information into model predictive control to optimize indicators such as structural loads and attitude tracking. At the same time, an extended state observer is used to estimate and compensate for disturbances, thereby improving the overall control effect.
[0034] In an exemplary embodiment, Figure 1-Figure 3 As shown, a method for load regulation and attitude control of a launch vehicle based on radar wind measurement is provided, comprising the following steps:
[0035] S1: Obtain the one-dimensional wind speed measurement result, the current angle of attack, the current engine swing angle and the current attitude information of the current position of the launch vehicle by the laser radar at the current moment; the one-dimensional wind speed measurement result is the projection of the wind speed measured by the laser radar in different measurement directions at the set position; the attitude information includes the attitude angle and the attitude angular velocity.
[0036] S2: Determine the wind field information of the current position of the launch vehicle at a preset time according to the one-dimensional wind speed measurement result of the laser radar at the current time; the wind field information includes horizontal wind speed and horizontal wind direction.
[0037] As an optional implementation, S2 specifically includes:
[0038] S21: According to the one-dimensional wind speed measurement result of the lidar at the current moment, combined with the position, speed and attitude information of the carrier rocket at the current moment, determine the projection of the wind speed at the preset moment in the lidar coordinate system.
[0039] S22: According to the projection of the wind speed at the preset time in the laser radar coordinate system, combined with the coordinate conversion matrix from the geographic coordinate system to the radar coordinate system, the horizontal east wind speed and the horizontal north wind speed at the preset time in the geographic coordinate system are determined, and the horizontal wind direction is determined to obtain the wind field information at the preset time.
[0040] In practical applications, in view of the characteristics of the constantly changing attitude of the launch vehicle during flight, this application introduces a new set of radar measurement information and combines five sets of radar information to derive an inversion method for the three-dimensional wind field that takes into account the rocket's attitude.
[0041] The steps of the wind field information estimation method based on arrow-borne laser radar are as follows:
[0042] Wind speed can be characterized by the movement speed of aerosol particles in the atmosphere. Based on the velocity measurement principle of incoherent lidar detection, the one-dimensional radial velocity of aerosol particles in the atmosphere relative to the lidar can be obtained (that is, the velocity component of the aerosol particles in the direction of the detection beam). By using a multi-beam measurement method, one-dimensional radial velocities in different directions can be measured, and the three-dimensional wind speed can be calculated through these one-dimensional radial velocities. Traditional wind speed measurement platforms are usually fixed, while rocket-borne lidar is a high-speed variable attitude platform. In the wind speed calculation link, the motion characteristics of the rocket need to be considered. The schematic diagram of the rocket-borne radar is shown in the figure below. Figure 4 shown.
[0043] (1) Coordinate system definition and wind speed projection.
[0044] When the laser wind radar works on a rocket, the radar system cannot remain horizontal like on a ground-based platform, and the influence of the attitude needs to be considered. Assume that the scanning angle of the radar is still γ s ,like Figure 5 Lasers are emitted in five directions to measure radial wind speed, and the corresponding phase angles between adjacent directions are 90°. To facilitate the description of the problem, we first define the radar coordinate system S l (Ox l y l z l ) and its three-axis pointing. The origin of the coordinate system is set at the center of the radar antenna, and the five measurement points 0, 1, 2, 3 and 4 are in plane α; Oz l The axis passes through the origin and is perpendicular to the plane, and its positive direction is consistent with the radar detection direction; define a plane β passing through the origin and parallel to plane α, Ox lThe axis is in plane β and parallel to the line connecting measuring point 1 and measuring point 3, and the positive direction is the direction from measuring point 3 to measuring point 1; Oy l The axis is in plane β and satisfies the right-hand rule.
[0045] Wind speed is often expressed in the local geographic coordinate system S d (Ox d y d z d ), so it is necessary to establish the transformation relationship between the two coordinate systems. A set of Euler angles can be used to describe S l With S d The location relationship. Suppose the geographic coordinate system S d Rotate around the z-axis, y-axis, and x-axis in sequence ψ l and γ l After that, it coincides with the radar coordinate system. Then we can solve the problem of d To the radar coordinate system S l The coordinate transformation matrix L ld and from the radar coordinate system S l To geographic coordinate system S d The coordinate transformation matrix L dl , as shown in formula (1) and formula (2):
[0046]
[0047] Among them, L x (γ l ) is the geographic coordinate system S d To the radar coordinate system S l The x-axis coordinate transformation matrix; L y (ψ l ) is the geographic coordinate system S d To the radar coordinate system S l The y-axis coordinate transformation matrix; is the geographic coordinate system S d To the radar coordinate system S l The z-axis coordinate transformation matrix; is the geographic coordinate system S d The rotation angle around the z-axis; ψ l is the geographic coordinate system S d The rotation angle around the y-axis; γ l is the geographic coordinate system S d The rotation angle around the x-axis; T is the transpose.
[0048] Wind speed vector in S d The following component array is:
[0049] (V wind )d =[u d v d w d ] T (3)
[0050] Where: u d 、v d and w d They are respectively the wind speed vector in the geographic coordinate system S d Projection on three axes.
[0051] Similarly, the wind speed vector in the radar coordinate system S l The following component array is:
[0052] (V wind ) l =[u l v l w l ] T (4)
[0053] Where: u l 、v l and w l They are respectively the wind speed vector in the radar coordinate system S l Projection on three axes.
[0054] The component arrays of the wind speed vector in the two coordinate systems satisfy the relationship:
[0055] (V wind ) d =L dl (V wind ) l (5)
[0056] (2) Three-dimensional wind field inversion algorithm considering attitude compensation.
[0057] During the rocket's ascent phase, its attitude changes constantly, and the measurement results of the laser wind radar directly installed on the rocket platform will be directly affected by the attitude change. This application takes this phenomenon into consideration and derives the inversion method of three-dimensional wind field data by assuming that the wind field changes linearly.
[0058] When the wind field is evenly distributed, the four measurement directions ( Figure 5 The results at the measurement points 1, 2, 3, and 4) are still the projections of the wind speed vector in the direction of laser emission. At this time, the measurement results are as follows:
[0059]
[0060] Wherein, V1, V2, V3 and V4 represent the measurement results at the measurement points numbered 1, 2, 3 and 4 respectively.
[0061] Solve the projection of the wind speed vector in the radar coordinate system:
[0062]
[0063] In reality, the wind field in the ascent phase of a launch vehicle is often characterized by the horizontal wind speed and direction at a series of discrete height points. Between adjacent discrete points, the size and direction of the wind field are linearly interpolated according to the height and change linearly with the height. At this time, the wind field is no longer uniform and stable.
[0064] The wind direction of high altitude wind is relatively stable and the horizontal wind direction changes little with height. Assume that the horizontal wind speed changes linearly with height and the horizontal wind direction remains unchanged. l It intersects with the α plane at the measuring point 0. Assume that the distance from this point to the origin is L. D , the altitude is h0, and the horizontal wind field size is V H0 , the horizontal wind direction is θ0. The horizontal wind speed and horizontal wind direction satisfy the following rules:
[0065]
[0066] Where h is the altitude of the measurement point, V H (h) and θ(h) are the horizontal wind speed and direction at an altitude of h, respectively. w is the rate of change of horizontal wind speed with height.
[0067] Take the measurement process of measurement point 1 as an example. First, calculate the altitude at measurement point 1. Let the position vector from measurement point 0 to measurement point 1 be r1. From the geometric relationship, we can know that:
[0068] (r1) l =[L D tanγ s 00] T (9)
[0069] Where, (r1) l It is the position vector pointing from measurement point 0 to measurement point 1 in the radar coordinate system.
[0070] From formula (2), we can know that:
[0071]
[0072] Where, (r1) d It is the position vector pointing from measurement point 0 to measurement point 1 in the geographic coordinate system.
[0073] According to formula (10), the height difference between measurement point 1 and measurement point 0 can be solved. Similarly, the height differences between measurement point 2, measurement point 3 and measurement point 4 and measurement point 0 can also be solved respectively.
[0074]
[0075] Wherein, Δh1 is the height difference between measurement point 1 and measurement point 0; Δh2 is the height difference between measurement point 2 and measurement point 0; Δh3 is the height difference between measurement point 3 and measurement point 0; Δh4 is the height difference between measurement point 4 and measurement point 0.
[0076] Substituting the height difference of measurement point 1 in formula (11) into formula (8) can obtain the wind field information at measurement point 1.
[0077]
[0078] Where V H1 is the horizontal wind field size at measurement point 1; θ1 is the horizontal wind direction at measurement point 1; (V 1w ) d It is the projection of the wind speed at point 1 in the geographic coordinate system.
[0079] For the purpose of simplifying the expression, L ld The elements in a ij The form of is simplified as shown in formula (13).
[0080]
[0081] According to the geographic coordinate system S d To the radar coordinate system S l The coordinate transformation matrix L ld , we can give the theoretical measurement result expression of the radar at four measurement points:
[0082]
[0083] Solve to get the radar coordinate system S l The wind speed vector at the lower point 0 is:
[0084]
[0085] In the formula, is the horizontal eastward component of the theoretically estimated wind speed in the radar coordinate system S l projection; is the theoretical estimate of the horizontal north component of the wind speed in the radar coordinate system S l projection; is the theoretical estimate of the vertical component of wind speed in the radar coordinate system S l Projection. It is the projection of the wind speed at the preset time in the laser radar coordinate system.
[0086] The true wind speed vector at point 0 is in the radar coordinate system S l The following component array is:
[0087]
[0088] Where (V0w)l is the true wind speed vector in the radar coordinate system S l The projection in the geographic coordinate system S; (V0w)d is the true wind speed vector in the geographic coordinate system S d Projection in .
[0089] By comparing formula (15) and formula (16), it can be seen that in a linearly changing wind field, using the previous solution method will lead to systematic errors. w When the wind field satisfies the assumption of uniformity and stability, the solution can be solved without error. l Positive direction, measuring distance is L D The observation result at . Then the observation value V0 is:
[0090] V0=V H0 (a 31 cosθ0+a 32 sinθ0)(17)
[0091] Using the measurement results at the four original points, the equation can be constructed:
[0092]
[0093] Where:
[0094]
[0095] It can be proved that the trigonometric function coefficients in equations (17) and (19) are linearly independent, that is, Pa 32 -Qa 31 The value of is not equal to zero. The horizontal eastward wind speed u at the preset time can be solved d and horizontal north wind speed v d :
[0096]
[0097] The horizontal wind speed and horizontal wind direction at the preset time can be further solved based on the east and north wind speeds.
[0098] S2: Determine the influence of the angle of attack and the engine swing angle on the body bending moment of the carrier rocket based on the wind field information at the preset moment, the angle of attack at the current moment and the engine swing angle at the current moment; the body bending moment is determined based on the bending moment generated by aerodynamic force, the bending moment generated by control force and the bending moment generated by inertial force.
[0099] In practical applications, rocket design load diagrams, such as Figure 6 As shown in the figure, when the bending moment at a certain part of the rocket body is considered as the output of the control system, it can be regarded as a function of the angle of attack and the engine swing angle, and the influence of the two on the bending moment of the rocket body can be considered separately. When calculating the bending moment, the influence of aerodynamic force, control force and inertial force can be considered separately.
[0100] As an optional implementation, determining the arrow body bending moment according to the bending moment generated by the aerodynamic force, the bending moment generated by the control force and the bending moment generated by the inertial force specifically includes:
[0101] (1) Bending moment load caused by aerodynamic force.
[0102] Consider the situation of a rocket with a total length of L during nominal flight. According to the overall design and aerodynamic calculations, the aerodynamic lift distribution function of the rocket at this time is defined as:
[0103] F ayb (α,x,Ma),0≤x≤L(21)
[0104] In the formula, F ayb represents the aerodynamic function of the system, α is the angle of attack at the current moment, x represents the integral variable, and Ma represents the Mach number.
[0105] The position in the geometric coordinate system is x k The bending moment (bending moment caused by aerodynamic force) Ma(xk) is:
[0106]
[0107] (2) The moment load generated by the control force.
[0108] The control force is at position x k The bending moment generated at (bending moment generated by the control force) Mc(xk) is:
[0109]
[0110] Among them, x c is the position of the control force; F cyb is the component of thrust on the y-axis of this system; L is the length of the launch vehicle.
[0111] (3) Bending moment load caused by inertia force.
[0112] Since the rocket is not in force balance during flight, there are acceleration and angular acceleration. The inertial force introduced to ensure balance will also produce bending moment. k The acceleration ay(xk) at is:
[0113]
[0114] Where: a yb is the translational acceleration of the center of mass, is the acceleration around the center of mass, x g Indicates the center of mass. The mass distribution function of the arrow body can be calculated from the structure to be m'(x), then the bending moment M generated by the inertial force is i (x k )for:
[0115]
[0116] The sum of the bending moment generated by the aerodynamic force, the bending moment generated by the control force and the bending moment generated by the inertial force is calculated to obtain the arrow body bending moment.
[0117] In practical applications, according to formula (22), formula (23), and formula (24), the total bending moment (arrow body bending moment) M(x k ) is expressed as follows:
[0118] M(x k )=M a (x k )+M c (x k )+M i (x k )(26)
[0119] During the rocket flight, aerodynamic force and control force are factors that affect the bending moment. The small perturbation equation of the bending moment with respect to the angle of attack and the engine swing angle can be written as:
[0120]
[0121] In the formula, M′ α (x k ) is the effect of the angle of attack on the bending moment of the rocket body of the launch vehicle; is the effect of the engine swing angle on the bending moment of the rocket body of the carrier rocket; Δα is the change in the angle of attack; α w is the angle of attack at the preset time; is the engine swing angle change.
[0122]
[0123] is the nominal normal aerodynamic coefficient; q is the dynamic pressure; Sm is the reference area of the arrow body; F ay is the total aerodynamic force of the rocket body; m′(x) is the mass distribution function of the rocket body; m is the total mass of the rocket body; M azb is the aerodynamic moment of the pitch channel; J z is the moment of inertia of the z-axis; K is the normal component coefficient of the pendulum jet; F cyb is the thrust component on the y-axis of the system; M czb is the pitch channel control torque. This system is a right-handed rectangular coordinate system; the origin of the right-handed rectangular coordinate system is the arrow body mass center O, the Ox axis is parallel to the arrow body axis and points to the head, the Oy axis is in the arrow body longitudinal symmetry plane, the Oy axis is perpendicular to the Ox axis and points upward, and the Oz axis is perpendicular to the Oxy plane and points to the right.
[0124] As an optional implementation, S2 specifically includes:
[0125] S21: Determine the angle of attack at the preset time and the engine swing angle at the preset time according to the wind field information at the preset time.
[0126] S22: Determine the change in angle of attack according to the angle of attack at the preset moment and the angle of attack at the current moment.
[0127] S23: Determine the engine swing angle change amount according to the engine swing angle at the preset moment and the engine swing angle at the current moment.
[0128] S24: Determine the influence of the angle of attack on the bending moment of the rocket body of the launch vehicle and the influence of the engine swing angle on the bending moment of the rocket body of the launch vehicle.
[0129] S25: Determine the influence of the angle of attack and the engine swing angle on the bending moment of the rocket body of the launch vehicle based on the angle of attack at the preset time, the change in the angle of attack, the change in the engine swing angle, the influence of the angle of attack on the bending moment of the rocket body of the launch vehicle, and the influence of the engine swing angle on the bending moment of the rocket body of the launch vehicle.
[0130] S3: According to the attitude angle and the attitude angular velocity, the model predictive controller is solved to determine the optimized control quantity sequence; the model predictive controller includes a system output equation and a cost function; the system output equation is a linear equation about state quantity, control quantity and interference quantity determined according to the influence of the angle of attack and the engine swing angle on the bending moment of the rocket body of the carrier rocket; the state quantity is the attitude angle and the attitude angular velocity; the control quantity is the engine swing angle at the next moment; the cost function is determined according to the system output equation.
[0131] In practical applications, model predictive control was first used in the field of industrial control. Thanks to its ability to solve multi-constrained optimization problems, model predictive control has shown broad development prospects in many fields including spacecraft control tasks. The essence of model predictive control is to solve the open-loop optimization problem of the control sequence, and then apply the first element of the optimization sequence result to the controlled system to complete the closed loop. Model predictive control requires the establishment of a prediction model first, and then the design of a cost function to transform the control task into solving an optimization problem.
[0132] (1) Establishment of prediction model (system output equation).
[0133] The small disturbance state equation of the launch vehicle is as follows:
[0134]
[0135] Where:
[0136]
[0137] Among them, A c is the state matrix; B dc is the perturbation matrix; B uc is the control matrix; b1 is the influence coefficient of angular velocity on angular acceleration; b2 is the influence coefficient of angle of attack on angular acceleration; b3 is the influence coefficient of engine swing angle on angular acceleration; c1 is the influence coefficient of angle of attack on the rate of change of trajectory inclination; c1′ is the influence coefficient of angle of attack caused by wind on the rate of change of trajectory inclination; c2 is the influence coefficient of trajectory inclination on the rate of change of trajectory inclination; c3 is the influence coefficient of engine swing angle on the rate of change of trajectory inclination.
[0138] By discretizing the above state equation (30), we can get the discrete system:
[0139] x(k+1)=Ax(k)+B d d(k)+B u u(k)(31)
[0140] Where:
[0141]
[0142] Based on the above discrete system, the predicted values of the system state and output at the next N moments can be given:
[0143]
[0144] Where U k is the control sequence; D kis the disturbance sequence; Φ0 is the state transfer matrix from time k to time k+N-1, Φ1 is the state transfer matrix from time k+1 to time k+N, Γ u0 is the control transfer matrix from time k to time k+N-1, Γ u1 is the control transfer matrix from time k+1 to time k+N, Γ d0 is the perturbation transfer matrix from time k to time k+N-1, Γ d1 is the disturbance transfer matrix from time k+1 to time k+N, and its expression is as follows:
[0145]
[0146] Consider the output equation of the system. The general load reduction task hopes to reduce the total angle of attack of the rocket during flight, that is, to reduce the load on the rocket body during flight. More fundamentally, if the output of the system can directly reflect the magnitude of the bending moment at a certain point on the rocket body, a better load reduction effect can be achieved. With the help of the nominal trajectory, the deviation value of the rocket angle of attack and the deviation value of the bending moment at a certain point on the rocket body can also be expressed as a linear combination of state quantity, interference quantity and control quantity. For the unity of the conclusion, the system output equation is assumed to be:
[0147] y(k)=Cx(k)+D u u(k)+D d d(k)(37)
[0148] Where: y(k) is the effect of the angle of attack and the engine swing angle on the bending moment of the rocket body; x(k) is the state quantity; u(k) is the control quantity; d(k) is the interference quantity. C is the state output matrix; D u is the control output matrix; D d is the perturbation output matrix.
[0149]
[0150] (2) Cost function design and optimization problem solving.
[0151] In the load reduction control task, model prediction needs to comprehensively consider the rocket's attitude tracking accuracy, the change of control quantity and system output. Therefore, the cost function can be designed as:
[0152] J=J1+J2+J3
[0153]
[0154] Among them, J1 is the attitude tracking accuracy index; J2 is the control quantity index; J3 is the output index; x(k+N) is the state at time k+N; x r(k+N) is the expected state at time k+N; S is the state performance indicator matrix; u(k+i) is the control quantity at time k+i; u r (k+i) is the expected control quantity at time k+i; R i is the control performance index matrix; y(k+i) is the output at time k+i; y r (k+i) is the expected output at time k+i; Q i is the output performance indicator matrix.
[0155] Expand formula (39):
[0156] J1=J 11 +J 12 +J 13
[0157]
[0158] Among them, the part that can be used for optimization is only J 11 With J 12 . Similarly, for J2 and J3:
[0159]
[0160] Further simplifying, the model predictive control problem is transformed into an optimal control problem. First, consider J 11 ,J 12 ,J 13 sum:
[0161]
[0162] Where: X k+1 is the state prediction sequence from time k+1 to time k+N; is the transposition of the state prediction sequence from time k+1 to time k+N; Ω, Ψ, Θ1, Θ2, Θ3 are intermediate variables; (the upper right corner T indicates transposition); D k is the disturbance sequence from time k to time k+N-1; (The upper right corner T indicates transpose).
[0163]
[0164] Among them, Q N-1 Output performance indicator matrix for the k+N-1th moment; R N-1 is the control performance indicator matrix at the k+N-1th moment.
[0165] J sum1 Some constant terms that do not have an optimized design space are discarded in the expression of There is also a constant term that cannot be optimized, but for the sake of neatness of the expression, this term is still retained.
[0166] Substituting formula (33) into formula (42), we can obtain:
[0167]
[0168] In the formula: H, F, E1 are intermediate variables.
[0169]
[0170] Similarly, consider the part J that can be optimized in J2 sum2 :
[0171]
[0172] Where: Γ u ′1, Ψ′, U rk ,Ω1′,Y rk , Ω2′, and E2 are intermediate variables.
[0173] Γ u ′1=[A N-1 B u A N-2 B u …B u ](47)
[0174]
[0175] According to the expressions of each component index, that is, formula (42) and formula (46), the total index is:
[0176]
[0177] E=E1+E2(55)
[0178] Solve J with respect to U k The partial derivative expression of , and setting the partial derivative to zero vector, can solve the optimized control quantity sequence at this time as:
[0179]
[0180] Select the first element u in the sequence * (k) is taken as the expected input value of the current system. At the next sampling moment, the above process is repeated.
[0181] S4: Determine the interference compensation amount by using an extended state observer according to the wind field information at the preset time, the angle of attack at the current time, the engine swing angle at the current time, the attitude angle and the attitude angular velocity.
[0182] As an optional implementation, S4 specifically includes:
[0183] According to the wind field information at the preset time, the angle of attack at the preset time and the engine swing angle at the preset time are determined.
[0184] The change in angle of attack is determined according to the angle of attack at the preset time and the angle of attack at the current time.
[0185] The engine swing angle variation is determined according to the engine swing angle at the preset time and the engine swing angle at the current time.
[0186] In practical applications, there are errors between the real coefficients and the nominal coefficients during actual flight, and in severe cases, model mismatch may occur. In addition, there may be interference outside the model. These will have an adverse effect on load reduction control. A suitable extended state observer can be designed to compensate for the model errors and external interference.
[0187]
[0188] In the formula, is the attitude angle; is the attitude angular velocity; is the attitude angular acceleration; is the dynamic small disturbance coefficient, Δα is the change in angle of attack; α w is the angle of attack at the preset time; is the engine swing angle variation; M d It is the comprehensive result of model parameter uncertainty, external interference and measurement uncertainty. The state quantity and control quantity are:
[0189]
[0190] Among them, x1 is the attitude angle; x2 is the attitude angular velocity; x3 is the total disturbance; u is the change in engine swing angle.
[0191] According to the angle of attack at the preset time, the change in the angle of attack, the change in the engine swing angle, the attitude angle and the attitude angular velocity, the state function of the launch vehicle is determined, that is, the state function of the system can be re-expressed as:
[0192]
[0193] in, is the first-order derivative of the attitude angle; is the first-order derivative of the attitude angular velocity; is the first-order derivative of the attitude angular acceleration; f is the derivative of the total disturbance.
[0194] According to the state function, the extended state observer of the launch vehicle is determined, that is, the extended state observer designed according to the state function is:
[0195]
[0196] Among them, e1 is the pitch angle estimation error; z1 is the pitch angle estimation value; is the differential of the estimated pitch angle; z2 is the estimated pitch angle rate; is the differential of the pitch angular rate; z3 is the estimate of the disturbance; β1 is the first observer gain; β2 is the second observer gain; β3 is the third observer gain.
[0197] The extended state observer is solved to determine the disturbance compensation amount.
[0198] By properly selecting the coefficients β1, β2 and β3, we can obtain:
[0199]
[0200] The interference estimated rudder deviation can be obtained:
[0201]
[0202] S5: Determine a final control amount according to the optimized control amount sequence and the interference compensation amount, and reduce the load of the launch vehicle based on the final control amount. In actual application, the final control amount is the sum of the optimized control amount sequence and the interference compensation amount.
[0203] This application proposes a method for load regulation and attitude control of a launch vehicle based on radar wind measurement. The future wind field is measured and predicted by laser radar, the structural load is optimized using model predictive control, and the disturbance is estimated using an extended state observer to improve the control effect. For an ideal load reduction controller, on the one hand, it needs to have a good load reduction effect, and on the other hand, it needs to have a certain anti-interference ability.
[0204] This application will use a digital simulation case as a method demonstration, and the simulation condition selects a certain type of carrier rocket's atmospheric ascent flight mission. Using the carrier rocket load control and attitude control method based on radar wind measurement in this application, after digital simulation, the load reduction control effect is as follows: Figure 7 As shown in the figure, the attitude angle deviation caused by load reduction is as follows Figure 8 As shown, the simulation results of the anti-interference ability test are as follows Fig. 9 and Fig.10 shown.
[0205] In an exemplary embodiment, a computer device is provided. The computer device may be a server or a terminal. The internal structure diagram thereof may be as follows: Fig.11As shown. The computer device includes a processor, a memory, an input / output interface (Input / Output, referred to as I / O) and a communication interface. Among them, the processor, the memory and the input / output interface are connected through a system bus, and the communication interface is connected to the system bus through the input / output interface. Among them, the processor of the computer device is used to provide computing and control capabilities. The memory of the computer device includes a non-volatile storage medium and an internal memory. The non-volatile storage medium stores an operating system, a computer program and a database. The internal memory provides an environment for the operation of the operating system and the computer program in the non-volatile storage medium. The database of the computer device is used to store launch vehicle attitude information, angle of attack and engine swing angle data. The input / output interface of the computer device is used to exchange information between the processor and an external device. The communication interface of the computer device is used to communicate with an external terminal through a network connection. When the computer program is executed by the processor, a launch vehicle load regulation and attitude control method based on radar wind measurement is implemented.
[0206] Those skilled in the art will understand that Fig.11 The structure shown in the figure is only a block diagram of a part of the structure related to the solution of the present application, and does not constitute a limitation on the computer device to which the solution of the present application is applied. The specific computer device may include more or fewer components than those shown in the figure, or combine certain components, or have a different arrangement of components. In an exemplary embodiment, a computer device is provided, including a memory and a processor, wherein a computer program is stored in the memory, and when the processor executes the computer program, the above-mentioned method for load regulation and attitude control of a launch vehicle based on radar wind measurement is implemented.
[0207] In an exemplary embodiment, a computer-readable storage medium is provided, storing a computer program, which, when executed by a processor, implements the above-mentioned method for payload regulation and attitude control of a launch vehicle based on radar wind measurement.
[0208] In an exemplary embodiment, a computer program product is provided, including a computer program, which, when executed by a processor, implements the above-mentioned method for load regulation and attitude control of a launch vehicle based on radar wind measurement.
[0209] It should be noted that the user information (including but not limited to user device information, user personal information, etc.) and data (including but not limited to data used for analysis, stored data, displayed data, etc.) involved in this application are all information and data authorized by the user or fully authorized by all parties, and the collection, use and processing of relevant data must comply with relevant regulations.
[0210] Those skilled in the art can understand that all or part of the processes in the above-mentioned embodiment methods can be completed by instructing the relevant hardware through a computer program, and the computer program can be stored in a non-volatile computer-readable storage medium. When the computer program is executed, it can include the processes of the embodiments of the above-mentioned methods. Among them, any reference to the memory, database or other medium used in the embodiments provided in the present application can include at least one of non-volatile and volatile memory. Non-volatile memory can include read-only memory (ROM), magnetic tape, floppy disk, flash memory, optical memory, high-density embedded non-volatile memory, resistive random access memory (ReRAM), magnetic random access memory (MRAM), ferroelectric random access memory (FRAM), phase change memory (PCM), graphene memory, etc. Volatile memory can include random access memory (RAM) or external cache memory, etc. By way of illustration and not limitation, RAM may be in various forms, such as static random access memory (SRAM) or dynamic random access memory (DRAM).
[0211] The database involved in each embodiment provided in this application may include at least one of a relational database and a non-relational database. The non-relational database may include a distributed database based on blockchain, etc., but is not limited thereto. The processor involved in each embodiment provided in this application may be a general-purpose processor, a central processing unit, a graphics processor, a digital signal processor, a programmable logic device, a data processing logic device based on quantum computing, etc., but is not limited thereto.
[0212] The technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.
[0213] This article uses specific examples to illustrate the principles and implementation methods of this application. The description of the above embodiments is only used to help understand the method and core ideas of this application. At the same time, for those skilled in the art, according to the ideas of this application, there will be changes in the specific implementation methods and application scope. In summary, the content of this specification should not be understood as limiting this application.
Claims
1. A method for load regulation and attitude control of a launch vehicle based on radar wind measurement, characterized in that: include: Obtain the one-dimensional wind speed measurement result of the laser radar at the current position of the launch vehicle, the current angle of attack, the current engine swing angle and the current attitude information; The one-dimensional wind speed measurement result is the projection of the wind speed measured by the laser radar in different measurement directions at the set position; the attitude information includes the attitude angle and the attitude angular velocity; Determine the wind field information of the current position of the launch vehicle at a preset time according to the one-dimensional wind speed measurement result of the laser radar at the current time; the wind field information includes horizontal wind speed and horizontal wind direction; Determine the influence of the angle of attack and the engine swing angle on the bending moment of the rocket body of the carrier rocket according to the wind field information at the preset time, the angle of attack at the current time, and the engine swing angle at the current time; The arrow body bending moment is determined based on the bending moment generated by aerodynamic force, the bending moment generated by control force and the bending moment generated by inertial force; According to the attitude angle and the attitude angular velocity, the model predictive controller is solved to determine the optimized control quantity sequence; the model predictive controller includes a system output equation and a cost function; the system output equation is a linear equation about state quantity, control quantity and interference quantity determined according to the influence of the angle of attack and the engine swing angle on the bending moment of the rocket body of the carrier rocket; the state quantity is the attitude angle and the attitude angular velocity; The control amount is the engine swing angle at the next moment; The cost function is determined based on the system output equation; Determine the interference compensation amount by using an extended state observer according to the wind field information at the preset time, the angle of attack at the current time, the engine swing angle at the current time, the attitude angle and the attitude angular velocity; A final control amount is determined according to the optimized control amount sequence and the interference compensation amount, and the launch vehicle is deloaded based on the final control amount.
2. The method for load regulation and attitude control of a launch vehicle based on radar wind measurement according to claim 1, characterized in that: According to the one-dimensional wind speed measurement result of the laser radar at the current moment, the wind field information at the preset moment of the current position of the launch vehicle is determined, including: According to the one-dimensional wind speed measurement result of the laser radar at the current moment, combined with the position, speed and attitude information of the launch vehicle at the current moment, the projection of the wind speed at the preset moment in the laser radar coordinate system is determined; According to the projection of the wind speed at the preset time in the lidar coordinate system, combined with the coordinate conversion matrix from the geographic coordinate system to the radar coordinate system, the horizontal eastward wind speed and the horizontal northward wind speed in the geographic coordinate system at the preset time are determined, and the horizontal wind direction is determined to obtain the wind field information at the preset time.
3. The method for load regulation and attitude control of a launch vehicle based on radar wind measurement according to claim 1, characterized in that: Determining the influence of the angle of attack and the engine swing angle on the body bending moment of the carrier rocket according to the wind field information at the preset time, the angle of attack at the current time, and the engine swing angle at the current time specifically includes: Determining the angle of attack at the preset time and the engine swing angle at the preset time according to the wind field information at the preset time; Determining a change in the angle of attack according to the angle of attack at the preset time and the angle of attack at the current time; Determining the engine swing angle change amount according to the engine swing angle at the preset time and the engine swing angle at the current time; Determining the influence of the angle of attack on the bending moment of the rocket body of the launch vehicle and the influence of the engine swing angle on the bending moment of the rocket body of the launch vehicle; According to the angle of attack at the preset time, the change in the angle of attack, the change in the engine swing angle, the influence of the angle of attack on the bending moment of the rocket body of the launch vehicle and the influence of the engine swing angle on the bending moment of the rocket body of the launch vehicle, the influence of the angle of attack and the engine swing angle on the bending moment of the rocket body of the launch vehicle is determined.
4. The method for load regulation and attitude control of a launch vehicle based on radar wind measurement according to claim 3 is characterized in that: Determining the influence of the angle of attack on the bending moment of the rocket body of the launch vehicle and the influence of the engine swing angle on the bending moment of the rocket body of the launch vehicle specifically includes: Using the formula Determining the influence of the angle of attack on the bending moment of the rocket body of the launch vehicle and the influence of the engine swing angle on the bending moment of the rocket body of the launch vehicle; Among them, M′ α (x k ) is the effect of the angle of attack on the bending moment of the rocket body of the launch vehicle; The effect of the engine swing angle on the bending moment of the rocket body of the launch vehicle; is the nominal normal aerodynamic coefficient; q is the dynamic pressure; S m is the reference area of the arrow body; F ay is the total aerodynamic force in the normal direction of the launch vehicle; x k is the position for calculating the bending moment; F ayb is the aerodynamic function of the system; x is the integral variable; m′(x) is the mass distribution function of the arrow body; m is the total mass of the arrow body; M azb is the aerodynamic moment of the pitch channel; J z is the moment of inertia of the z-axis; x g is the center of mass position; K is the normal component coefficient of the pendulum jet; x c is the position of the control force; F cyb is the thrust component on the y-axis of the system; M czb is the pitch channel control torque; L is the length of the launch vehicle; this system is a right-handed rectangular coordinate system; the origin of the right-handed rectangular coordinate system is the center of mass O of the rocket body, the Ox axis is parallel to the axis of the rocket body and points to the head, the Oy axis is in the longitudinal symmetry plane of the rocket body, the Oy axis is perpendicular to the Ox axis and points upward, and the Oz axis is perpendicular to the Oxy plane and points to the right.
5. The method for load regulation and attitude control of a launch vehicle based on radar wind measurement according to claim 1, characterized in that: The bending moment of the rocket body is determined based on the bending moment generated by aerodynamic force, control force and inertia force, including: Using the formula Determine the bending moment caused by aerodynamic forces; where M a (x k ) is the bending moment caused by aerodynamic force; x k is the position for calculating the bending moment; F ayb is the aerodynamic function of this system, α is the angle of attack at the current moment, x represents the integral variable, and Ma represents the Mach number; Using the formula Determine the bending moment produced by the control force; where M c (x k ) is the bending moment generated by the control force; x c is the position of the control force; F cyb is the thrust component on the y-axis of this system; L is the length of the launch vehicle; Using the formula Determine the bending moment caused by the inertial force; where M i (x k ) is the bending moment caused by the inertial force; m′(x) is the mass distribution function of the arrow body; a yb (x) is the translational acceleration of the center of mass; The sum of the bending moment generated by the aerodynamic force, the bending moment generated by the control force and the bending moment generated by the inertial force is calculated to obtain the arrow body bending moment.
6. The method for load regulation and attitude control of a launch vehicle based on radar wind measurement according to claim 1, characterized in that: The system output equation is: y(k)=Cx(k)+D u u(k)+D d d(k); Wherein, y(k) is the influence of the angle of attack and the engine swing angle on the bending moment of the rocket body; x(k) is the state quantity; u(k) is the control quantity; d(k) is the interference quantity; C, D u , D d is the intermediate variable; M′ α (x k ) is the effect of the angle of attack on the bending moment of the rocket body of the launch vehicle; It is the influence of the engine swing angle on the bending moment of the rocket body of the launch vehicle.
7. The method for load regulation and attitude control of a launch vehicle based on radar wind measurement according to claim 1, characterized in that: According to the wind field information at the preset time, the angle of attack at the current time, the engine swing angle at the current time, the attitude angle and the attitude angular velocity, an extended state observer is used to determine the interference compensation amount, specifically including: Determining the angle of attack at the preset time and the engine swing angle at the preset time according to the wind field information at the preset time; Determining a change in the angle of attack according to the angle of attack at the preset time and the angle of attack at the current time; Determining the engine swing angle change amount according to the engine swing angle at the preset time and the engine swing angle at the current time; The state function of the carrier rocket is determined according to the angle of attack at the preset time, the change in the angle of attack, the change in the engine swing angle, the attitude angle and the attitude angular velocity; the state function is: in, is the first-order derivative of the attitude angle; x2 is the attitude angular velocity; is the first-order derivative of attitude angular velocity; x3 is attitude angular acceleration; is the first-order derivative of attitude angular acceleration; is the dynamic small perturbation coefficient; is the attitude angle; Δα is the change in angle of attack; α w is the angle of attack at the preset moment; u is the change in the engine swing angle; f is the derivative of the total disturbance; According to the state function, an extended state observer of the launch vehicle is determined; the extended state observer of the launch vehicle is: Among them, e1 is the pitch angle estimation error; z1 is the pitch angle estimation value; is the differential of the estimated pitch angle; z2 is the estimated pitch angle rate; is the differential of the pitch angle rate; z3 is the estimate of the disturbance; β1 is the first observer gain; β2 is the second observer gain; β3 is the third observer gain; The extended state observer is solved to determine the disturbance compensation amount.
8. A computer device comprising: A memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that the processor executes the computer program to implement the method for load regulation and attitude control of a launch vehicle based on radar wind measurement as described in any one of claims 1-7.
9. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the method for load regulation and attitude control of a launch vehicle based on radar wind measurement as described in any one of claims 1 to 7 is implemented.
10. A computer program product, comprising a computer program, characterized in that When the computer program is executed by a processor, the method for load regulation and attitude control of a launch vehicle based on radar wind measurement as described in any one of claims 1 to 7 is implemented.
Citation Information
Patent Citations
Sounding rocket load shedding method and system
CN115729096A
Aircraft energy consumption calculation method considering wind field influence
CN116227013A
Active adaptive load shedding control method for carrier rocket based on fuzzy reasoning
CN117289597A
Oblique-wing supersonic aircraft
US3971535A
Cited By
Carrier rocket control method based on wind field characteristics
CN119803202A
A control method for a launch vehicle based on wind field characteristics
CN119803202B
Aircraft attitude control method, system, equipment and medium
CN120066107A
