CN109407551B - Method for carrying out semi-physical simulation test on joint control section of carrier rocket - Google Patents

Method for carrying out semi-physical simulation test on joint control section of carrier rocket Download PDF

Info

Publication number
CN109407551B
CN109407551B CN201811529697.6A CN201811529697A CN109407551B CN 109407551 B CN109407551 B CN 109407551B CN 201811529697 A CN201811529697 A CN 201811529697A CN 109407551 B CN109407551 B CN 109407551B
Authority
CN
China
Prior art keywords
control
attitude
spray pipe
attitude angle
generated
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201811529697.6A
Other languages
Chinese (zh)
Other versions
CN109407551A (en
Inventor
于亚男
王迪
周静
周嘉炜
贺从园
胡存明
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Aerospace Control Technology Institute
Original Assignee
Shanghai Aerospace Control Technology Institute
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shanghai Aerospace Control Technology Institute filed Critical Shanghai Aerospace Control Technology Institute
Priority to CN201811529697.6A priority Critical patent/CN109407551B/en
Publication of CN109407551A publication Critical patent/CN109407551A/en
Application granted granted Critical
Publication of CN109407551B publication Critical patent/CN109407551B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B17/00Systems involving the use of models or simulators of said systems
    • G05B17/02Systems involving the use of models or simulators of said systems electric

Abstract

The invention discloses a method for carrying out a semi-physical simulation test on a joint control section of a carrier rocket, which comprises the following steps: time synchronization processing is carried out on the linear section control system and the nonlinear section control system, so that when the linear section control system controls a servo system of the rocket body model, the nonlinear section control system also controls an attitude control spray pipe of the rocket body model; carrying out simulation calculation on the rocket body model, wherein the simulation calculation comprises the following steps: the method comprises the steps that interference torque generated by an attitude control spray pipe is superposed into a linear control model and is resolved to obtain a first attitude angle error, and interference torque generated by a servo system is superposed into a nonlinear control model and is settled to obtain a second attitude angle error; and combining and superposing the first attitude angle error and the second attitude angle error according to the proportional coefficients of the control moments respectively generated by the servo system and the attitude control spray pipe to obtain the attitude angle error at the current moment. The invention realizes the purpose of carrying out semi-physical simulation test on the carrier rocket in the joint control section.

Description

Method for carrying out semi-physical simulation test on joint control section of carrier rocket
Technical Field
The invention relates to the technical field of semi-physical simulation, in particular to a method for carrying out semi-physical simulation test on a joint control section of a carrier rocket.
Background
The carrier rocket is generally a three-stage rocket, and the flight process of the carrier rocket can be divided into the following flight sections according to the change of characteristics of the carrier rocket in the flight process: a first-stage, a second-stage and a third-stage active section and a gliding section; in order to meet the requirements of different flight sections, different attitude control systems are correspondingly adopted to carry out attitude control on the carrier rocket.
Specifically, the attitude control system of the launch vehicle can be divided into attitude control systems of a primary, a secondary and a tertiary active section (linear section) and a gliding section (nonlinear section) according to the change of characteristics and the difference of actuating mechanisms in the flight process of the launch vehicle. The attitude control systems of the first-stage, second-stage and third-stage active sections effectively and correspondingly eliminate the interference influence generated by the carrier rocket in each flight section by adopting a control method of a swing engine, and quickly and correctly realize the control of the attitude of the carrier rocket. For the attitude control system of the nonlinear section, a method for controlling the attitude by adopting an attitude control nozzle (a typical nonlinear switch control method) is adopted to eliminate the nonlinear interference generated by the carrier rocket in the flight section of the gliding section.
As shown in fig. 1, the control method of the swing engine includes the following processes: the attitude motion state of the carrier rocket is measured in real time through an attitude angle or attitude angular velocity measuring device in a linear section attitude control system to obtain attitude angle and attitude angular velocity signals, the measured attitude angle and attitude angular velocity signals are subjected to signal synthesis in a signal synthesis and synthesis device in the linear section attitude control system, and are subjected to signal synthesis through a correction network or an attitude controller in the linear section attitude control system to generate attitude control signals, and the attitude control signals are directly transmitted to a control device (servo system) in the linear section attitude control system to drive an engine of the servo system to swing to generate control torque and perform attitude control on the carrier rocket.
As shown in fig. 2, the non-linear control of the launch vehicle generally uses a non-linear switch control method, and the nozzle of the launch vehicle is controlled to work in a positive-on-off-negative-on manner. Taking the pitching channel as an example, the attitude dynamics equation of the attitude control nozzle control section (nonlinear control section) is as follows:
Figure BDA0001905329740000011
in the formula: i is a symbol for controlling the switch,
Figure BDA0001905329740000012
in order to correct the angular deviation of the pitch attitude,
Figure BDA0001905329740000013
for pitch attitude angular rate, alpha0As static amplification factor, alpha, of the attitude angle channel1And the dynamic amplification factor of the attitude angular rate channel.
Formula 1 describes the dynamic characteristics of the posture of the rocket body during the control of the posture control spray pipe, and a satellite-rocket separation section, a discharge section and a gliding section, wherein the shaking of the propellant is considered during the axial overload period, and only the rigid body motion is considered during the non-axial overload period. In conclusion, when the carrier rocket is in a nonlinear flight section, the attitude control nozzle can be applied to control the attitude of the carrier rocket.
Research shows that after the carrier rocket executes the flight process of the three-stage active section, the three-stage engine of the carrier rocket is shut down, and in a time period of 5s after the shut-down of the carrier rocket is finished, namely the attitude motion of the carrier rocket is subjected to combined attitude control by a servo system of a control mechanism of a linear section attitude control system and an attitude control spray pipe controlled by a nonlinear section attitude control system, and the control stage is called as a combined control section.
As shown in FIG. 3, a timing diagram of the combined control section is provided, wherein tk31 represents three-stage engine shutdown time, T- "0" -III represents three-stage active section control system ending control time, and T-ZK-T1 represents three-stage gliding section control path closing time.
And after the flight section of the three-stage active section is finished, the three-stage engine is shut down, and after the three-stage engine is shut down for 5s, the control of the three-stage active section control system is finished, namely the servo mechanism returns to zero. And (3) the three-stage engine is shut down, and after the engine is shut down for 1s, the three-stage gliding section control path is communicated, so that the carrier rocket is subjected to attitude control by combining a servo system of a linear section control system control mechanism and an attitude control spray pipe of a nonlinear section control system control mechanism in 4s from T-ZK-T1 to T- '0' -III, and the control effect of the combined control section and the caused attitude disturbance cannot be subjected to simulation test or examination by adopting the conventional sectional semi-physical simulation test method for the flight section of the carrier rocket combined control section.
Disclosure of Invention
The invention aims to provide a method for performing a semi-physical simulation test on a joint control section of a carrier rocket, which achieves the purpose of performing the semi-physical simulation test on the joint control section under the simultaneous action of two execution mechanisms by adopting a mode of linearly superposing the effect of attitude angle control on the basis of the configuration of a semi-physical simulation test system of the conventional carrier rocket control system.
In order to achieve the above purpose, the invention is realized by the following technical scheme:
a method for carrying out a semi-physical simulation test on a joint control section of a carrier rocket comprises the following processes: performing time synchronization processing on a linear section control system and a nonlinear section control system, so that when the linear section control system controls a servo system of an arrow body model, the nonlinear section control system also controls an attitude control spray pipe of the arrow body model; performing simulation calculation on the rocket body model, wherein the simulation calculation comprises the following steps: the interference torque generated by the attitude control spray pipe is superposed into the linear control model and is resolved to obtain a first attitude angle error, and the interference torque generated by the servo system is superposed into the nonlinear control model and is settled to obtain a second attitude angle error; and combining and superposing the first attitude angle error and the second attitude angle error according to the proportional coefficients of the control moments respectively generated by the servo system and the attitude control spray pipe to obtain the attitude angle error at the current moment.
Further, the linear control model is a first linear control kinetic equation:
Figure BDA0001905329740000031
in the formula, ωX1、ωy1、ωz1The attitude angular velocity of the rocket model calculated for the solution of the linear kinetic equation,
Figure BDA0001905329740000032
ψ1、γ1attitude angle deviations in pitch, yaw and rolling directions which are respectively calculated by solving a linear dynamic equation,
Figure BDA0001905329740000033
δψ、δγthe engine pivot angle, J, in the servo system controlling the pitch, yaw and roll directions, respectivelycIs the moment of inertia of the rocket model, d30、b3、b30To control moment coefficient, M'rX、M′rY、M′rZThe disturbance moments in pitching, yawing and rolling directions are respectively;
the interference torque generated by the attitude control spray pipe is as follows:
Figure BDA0001905329740000034
in the formula, M1、M2、M3Interference moments generated by the attitude control spray pipe in the pitching direction, the yawing direction and the rolling direction are respectively;
Figure BDA0001905329740000035
Kψ、Kγrespectively control the pitching direction, the yawing direction and the rolling direction,
Figure BDA0001905329740000036
b、dcontrol moment coefficients in pitching, yawing and rolling directions are respectively;
the second linear control dynamic equation obtained after the disturbance moment generated by the attitude control spray pipe is superposed is as follows:
Figure BDA0001905329740000041
and calculating by using the second linear control braking mechanical equation to obtain the first attitude angle error.
Further, the nonlinear control model is a first nonlinear control kinetic equation
Figure BDA0001905329740000042
In the formula, ωX2、ωy2、ωz2The attitude angular velocity of the rocket model calculated for the solution of the nonlinear dynamical equation,
Figure BDA0001905329740000043
ψ2、γ2attitude angle deviations in pitch, yaw and rolling directions which are respectively calculated by solving a nonlinear dynamical equation,
Figure BDA0001905329740000044
Kψ、Kγthe attitude control spray pipe switching signals for controlling pitching, yawing and rolling directions are respectively determined by the working conditions of the attitude control engine, namely +1 is taken when the positive attitude control spray pipe works, -1 is taken when the negative attitude control spray pipe works, and 0, M 'is taken when the attitude control spray pipe does not work'rX1、M′rY1、M′rZ1Respectively are disturbance moments in pitching, yawing and rolling directions,
Figure BDA0001905329740000045
b、dcontrol moment coefficients in pitching, yawing and rolling directions are respectively; the disturbance torque generated by the servo system is as follows:
Figure BDA0001905329740000046
and (3) superposing the disturbance torque generated by the servo system to obtain a second nonlinear control dynamic equation:
Figure BDA0001905329740000051
and calculating by using the second nonlinear control dynamics equation to obtain the second attitude angle error.
Further, the step of linearly superimposing the first and second attitude angle errors further comprises:
at the same simulation moment, the pitching direction control moment generated by the swing angle of the engine is as
Figure BDA0001905329740000052
The pitching direction control moment generated by the attitude control spray pipe is as follows
Figure BDA0001905329740000053
The two control modes control the proportional coefficient of the moment to be
Figure BDA0001905329740000054
The sum of the pitch attitude angle deviations generated by the two kinetic equations is
Figure BDA0001905329740000055
Figure BDA0001905329740000056
Namely the pitching attitude angle deviation value of the arrow model entering the measurement equation;
at the same simulation moment, the yaw direction control moment generated by the swing angle of the engine is equal to
Figure BDA0001905329740000057
The yaw direction control moment generated by the attitude control spray pipe is KψbThe two control modes control the proportional coefficient of the torque to be
Figure BDA0001905329740000058
The sum of the yaw attitude angle deviations generated by the two kinetic equations is
Figure BDA0001905329740000059
Psi is the yaw attitude angle deviation value of the rocket model entering the measurement equation;
at the same simulation moment, the rolling direction control moment generated by the swing angle of the engine is as follows
Figure BDA00019053297400000510
The rolling direction control moment generated by the attitude control spray pipe is dKγThe two control modes control the proportional coefficient of the torque to be
Figure BDA00019053297400000511
The rolling attitude angle deviation superposition value generated by the two kinetic equations is
Figure BDA0001905329740000061
And gamma is the rolling attitude angle deviation value of the arrow body model entering the measurement equation.
The invention has the following technical effects:
according to the method, time synchronization processing is carried out on the linear section control system and the nonlinear section control system, so that when the linear section control system controls the servo system of the rocket body model, the nonlinear section control system also controls the attitude control spray pipe of the rocket body model; carrying out simulation calculation on the rocket body model, wherein the simulation calculation comprises the following steps: the method comprises the steps that interference torque generated by an attitude control spray pipe is superposed into a linear control model and is resolved to obtain a first attitude angle error, and interference torque generated by a servo system is superposed into a nonlinear control model and is settled to obtain a second attitude angle error; and combining and superposing the first attitude angle error and the second attitude angle error according to the proportional coefficients of the control moments respectively generated by the servo system and the attitude control spray pipe to obtain the attitude angle error at the current moment, thereby realizing the purpose of performing a semi-physical simulation test on the carrier rocket in the joint control section.
Drawings
FIG. 1 is a block diagram of the main components of a linear section attitude control system of a launch vehicle in the prior art;
FIG. 2 is a block diagram of the main components of a prior art attitude control system for a nonlinear section of a launch vehicle;
FIG. 3 is a timing diagram of a joint control segment in the prior art;
FIG. 4 is a schematic diagram illustrating a schematic principle of a method for performing a semi-physical simulation test on a joint control section of a launch vehicle according to an embodiment of the present invention;
fig. 5 is a schematic flow chart of a method for performing a semi-physical simulation test on a joint control section of a launch vehicle provided in an embodiment of the present invention.
Detailed Description
Research shows that in a combined control section for jointly carrying out attitude control on a carrier rocket in a 5s time period after the shutdown of an engine in a flight active section of the carrier rocket, namely a servo system controlled by a linear section control system and an attitude control spray pipe controlled by a nonlinear section control system, a sectional semi-physical simulation experiment system cannot carry out semi-physical simulation experiment on the carrier rocket, namely the control effect of the combined control section and the caused attitude disturbance cannot be subjected to simulation experiment or examination.
Aiming at the problems, the invention provides a method for carrying out a semi-physical simulation test on a joint control section of a carrier rocket, which realizes the semi-physical simulation of the joint control section by adopting a mode of carrying out linear superposition on the effect of attitude angle control.
The present invention will now be further described by way of the following detailed description of a preferred embodiment thereof, taken in conjunction with the accompanying drawings.
Referring to fig. 1 and fig. 2, a method for performing a semi-physical simulation test on a joint control segment of a launch vehicle according to this embodiment includes the following steps: and (3) a closed-loop semi-physical simulation system is built, and when the carrier rocket is subjected to attitude control jointly by a servo system controlled by a linear section control system and an attitude control spray pipe controlled by a nonlinear section control system, an rocket body model of the carrier rocket is built and is subjected to parallel independent calculation.
Specifically, first, the linear section control system and the nonlinear section control system are subjected to time synchronization processing, so that when the linear section control system controls the servo system, the nonlinear section control system also controls the attitude control nozzle.
And (3) superposing interference items generated by the attitude control spray pipe into the linear control model, and superposing interference generated by the servo mechanism into the nonlinear control model.
Further, the disturbance torque generated by the servo system is superposed to the first nonlinear control dynamics equation to be calculated to obtain a second nonlinear control dynamics equation, and the second nonlinear control dynamics equation is used for calculation to obtain the first attitude angle error.
And superposing the interference torque generated by the attitude control spray pipe to the first linear control dynamic equation to calculate to obtain a second linear control dynamic equation, and calculating by using the second linear control dynamic equation to obtain a second attitude angle error.
Further, the first linear control dynamics equation is:
Figure BDA0001905329740000071
in the formula (I), the compound is shown in the specification,
Figure BDA0001905329740000072
δψ、δγthe engine yaw angle, omega, in a servo system for controlling the pitch, yaw and roll directions, respectivelyX1、ωy1、ωz1Angular velocity of attitude of rocket model calculated for solution of linear kinetic equation, JcIs the moment of inertia of the rocket model, d30、b3、b30In order to control the torque coefficient, the torque coefficient is controlled,
Figure BDA0001905329740000073
ψ1、γ1attitude angle deviations, M ', in pitch, yaw, and roll directions, respectively, solved by a linear kinetic equation'rX、M′rY、M′rZThe disturbance moments in pitching, yawing and rolling directions are respectively.
The attitude control spray pipe corresponds to linear control dynamics, and the generated disturbance moment is as follows:
Figure BDA0001905329740000081
in the formula, M1、M2、M3The interference moment generated by the attitude control spray pipe,
Figure BDA0001905329740000082
Kψ、Kγthe attitude control spray pipe switching signals for controlling pitching, yawing and rolling directions are respectively determined by the working conditions of the attitude control engine, namely, the positive attitude control spray pipe is taken as +1 when working, the negative attitude control spray pipe is taken as-1 when working, and the attitude control spray pipe is taken as 0 when not working,
Figure BDA0001905329740000083
b、dthe control moment coefficients of pitching, yawing and rolling directions are respectively.
The second linear control dynamic equation obtained after the disturbance moment generated by the attitude control spray pipe is superposed is as follows:
Figure BDA0001905329740000084
calculating by using the formula (4) to obtain a first attitude angle error as follows:
Figure BDA0001905329740000085
ψ1、γ1
the first nonlinear control dynamics equation is:
Figure BDA0001905329740000086
in the formula, ωX2、ωy2、ωz2The attitude angular velocity of the rocket model calculated for the solution of the nonlinear dynamical equation,
Figure BDA0001905329740000087
ψ2、γ2attitude angle deviations in pitch, yaw and rolling directions which are respectively calculated by solving a nonlinear dynamical equation,
Figure BDA0001905329740000091
Kψ、Kγthe attitude control spray pipe switching signals for controlling pitching, yawing and rolling directions are respectively determined by the working conditions of the attitude control engine, namely +1 is taken when the positive attitude control spray pipe works, -1 is taken when the negative attitude control spray pipe works and 0 is taken when the attitude control spray pipe does not work. Attitude control engine layouts may be different for different rockets, but the operating conditions are similar. M'rX1、M′rY1、M′rZ1The disturbance moments in pitching, yawing and rolling directions are respectively. The disturbance torque generated by the servo system (specifically the engine swing angle in the servo system) on the nonlinear control dynamics is as follows:
Figure BDA0001905329740000092
and superposing the disturbance torque generated by the swing angle of the engine to obtain a second nonlinear control dynamic equation as follows:
Figure BDA0001905329740000093
and calculating by using the formula (7) to obtain the second attitude angle error as follows:
Figure BDA0001905329740000094
ψ2、γ2
and the attitude angle error obtained by superposing and combining the first attitude angle error and the second attitude angle error according to the proportion of control moments respectively generated by the attitude control spray pipe and the servo system is used as the input value of the measurement system at the current simulation moment. And then the measuring system outputs the new attitude angle error data, and the simulation is finished.
And linearly superposing the first attitude angle error and the second attitude angle error according to the control moment generated by the two control modes, wherein the specific superposition mode is as follows:
at the same simulation moment (same simulation period), the control moment of the pitching direction generated by the swing angle of the engine is equal to
Figure BDA0001905329740000101
The pitching direction control moment generated by the attitude control spray pipe is as follows
Figure BDA0001905329740000102
The two control modes control the proportional coefficient of the moment to be
Figure BDA0001905329740000103
The sum of the pitch attitude angle deviations generated by the two kinetic equations is
Figure BDA0001905329740000104
Figure BDA0001905329740000105
Namely the pitch attitude angle deviation value of the arrow model entering the measurement equation.
At the same simulation moment, the yaw direction control moment generated by the swing angle of the engine is equal to
Figure BDA0001905329740000106
The yaw direction control moment generated by the attitude control spray pipe is KψbThe two control modes control the proportional coefficient of the torque to be
Figure BDA0001905329740000107
The yaw attitude angle deviation generated by the two kinetic equationsA superimposed value of
Figure BDA0001905329740000108
Psi is the yaw attitude angle deviation value of the rocket model entering the measurement equation.
At the same simulation moment, the rolling direction control moment generated by the swing angle of the engine is as follows
Figure BDA0001905329740000109
The rolling direction control moment generated by the attitude control spray pipe is dKγThe two control modes control the proportional coefficient of the torque to be
Figure BDA00019053297400001010
The rolling attitude angle deviation superposition value generated by the two kinetic equations is
Figure BDA00019053297400001011
And gamma is the rolling attitude angle deviation value of the arrow body model entering the measurement equation.
After the first attitude angle error and the second attitude angle error are linearly superposed, the attitude angle error enters an arrow body attitude measurement system, and is output as a measurement value of the attitude angle error:
Figure BDA00019053297400001012
in the formula (I), the compound is shown in the specification,
Figure BDA00019053297400001013
and G(s) is a transfer function of the measuring link.
After the measured value of the attitude angle error enters an arrow body attitude control system, linear control controlled by a servo system and nonlinear control using an attitude control spray pipe as an actuating mechanism are respectively carried out, and the linear control output of the servo system is as follows:
Figure BDA0001905329740000111
in the formula, a0、aStatic amplification factors, G, for pitch (yaw) and roll channels, respectivelySF(s) is the transfer function of the servo system.
In summary, when the carrier rocket is subjected to attitude control by combining two actuating mechanisms, namely a servo system controlled by a linear section control system and an attitude control spray pipe controlled by a nonlinear section control system, interference terms generated by the two actuating mechanisms are simultaneously introduced into an rocket body resolving model, and the rocket body model of the carrier rocket is resolved in parallel and independently to obtain two attitude angle errors respectively. And (3) superposing and combining the two attitude angle errors according to the proportion of control moments respectively generated by the attitude control spray pipe and the servo system to obtain a new attitude angle error, taking the new attitude angle error as an input value of the measurement system at the current simulation moment, then outputting and processing the data of the new attitude angle error by the measurement system, ending the simulation of the simulation period, and entering the next simulation period cycle. Therefore, the problem that the original semi-physical simulation scheme cannot realize the semi-physical simulation of the combined control section is solved.
While the present invention has been described in detail with reference to the preferred embodiments, it should be understood that the above description should not be taken as limiting the invention. Various modifications and alterations to this invention will become apparent to those skilled in the art upon reading the foregoing description. Accordingly, the scope of the invention should be determined from the following claims.

Claims (2)

1. A method for carrying out a semi-physical simulation test on a joint control section of a carrier rocket is characterized by comprising the following processes: performing time synchronization processing on a linear section control system and a nonlinear section control system, so that when the linear section control system controls a servo system of an arrow body model, the nonlinear section control system also controls an attitude control spray pipe of the arrow body model;
performing simulation calculation on the rocket body model, wherein the simulation calculation comprises the following steps:
the interference torque generated by the attitude control spray pipe is superposed into the linear control model and is solved to obtain a first attitude angle error, and the interference torque generated by the servo system is superposed into the nonlinear control model and is solved to obtain a second attitude angle error;
combining and superposing the first attitude angle error and the second attitude angle error according to proportional coefficients of control moments respectively generated by the servo system and the attitude control spray pipe to obtain an attitude angle error at the current moment;
the linear control model is a first linear control kinetic equation:
Figure FDA0003046026320000011
in the formula, ωX1、ωy1、ωz1The attitude angular velocity of the rocket model calculated for the solution of the linear kinetic equation,
Figure FDA0003046026320000012
ψ1、γ1attitude angle deviations in pitch, yaw and rolling directions which are respectively calculated by solving a linear dynamic equation,
Figure FDA0003046026320000014
δψ、δγthe engine pivot angle, J, in the servo system controlling the pitch, yaw and roll directions, respectivelycIs the moment of inertia of the rocket model, d30、b3、b30To control moment coefficient, M'rX、M′rY、M′rZThe disturbance moments in pitching, yawing and rolling directions are respectively;
the interference torque generated by the attitude control spray pipe is as follows:
Figure FDA0003046026320000013
in the formula, M1、M2、M3Interference moments generated by the attitude control spray pipe in the pitching direction, the yawing direction and the rolling direction are respectively;
Figure FDA0003046026320000021
Kψ、Kγrespectively control the pitching direction, the yawing direction and the rolling direction,
Figure FDA0003046026320000022
b、dcontrol moment coefficients in pitching, yawing and rolling directions are respectively;
the second linear control dynamic equation obtained after the disturbance moment generated by the attitude control spray pipe is superposed is as follows:
Figure FDA0003046026320000023
calculating by using the second linear control braking mechanical equation to obtain the first attitude angle error;
the nonlinear control model is a first nonlinear control kinetic equation:
Figure FDA0003046026320000024
in the formula, ωX2、ωy2、ωz2The attitude angular velocity of the rocket model calculated for the solution of the nonlinear dynamical equation,
Figure FDA0003046026320000025
ψ2、γ2attitude angle deviations in pitch, yaw and rolling directions which are respectively calculated by solving a nonlinear dynamical equation,
Figure FDA0003046026320000026
Kψ、Kγrespectively controlling pitching, yawing and rolling directions by attitude controlDetermining the working condition of the engine, namely taking +1 when the positive attitude control spray pipe works, taking-1 when the negative attitude control spray pipe works, and taking 0, M 'when the attitude control spray pipe does not work'rX1、M′rY1、M′rZ1Respectively are disturbance moments in pitching, yawing and rolling directions,
Figure FDA0003046026320000027
b、dcontrol moment coefficients in pitching, yawing and rolling directions are respectively;
the disturbance torque generated by the servo system is as follows:
Figure FDA0003046026320000031
and (3) superposing the disturbance torque generated by the servo system to obtain a second nonlinear control dynamic equation:
Figure FDA0003046026320000032
and calculating by using the second nonlinear control dynamics equation to obtain the second attitude angle error.
2. The method for semi-physical simulation testing of a launch vehicle joint control section of claim 1, wherein the step of linearly superimposing the first and second attitude angle errors further comprises:
at the same simulation moment, the pitching direction control moment generated by the swing angle of the engine is as
Figure FDA0003046026320000033
The pitching direction control moment generated by the attitude control spray pipe is as follows
Figure FDA0003046026320000034
The two control modes control the proportional coefficient of the moment to be
Figure FDA0003046026320000035
The sum of the pitch attitude angle deviations generated by the two kinetic equations is
Figure FDA0003046026320000036
Figure FDA0003046026320000037
Namely the pitching attitude angle deviation value of the arrow model entering the measurement equation;
at the same simulation moment, the yaw direction control moment generated by the swing angle of the engine is equal to
Figure FDA0003046026320000038
The yaw direction control moment generated by the attitude control spray pipe is KψbThe two control modes control the proportional coefficient of the torque to be
Figure FDA0003046026320000039
The sum of the yaw attitude angle deviations generated by the two kinetic equations is
Figure FDA00030460263200000310
Psi is the yaw attitude angle deviation value of the rocket model entering the measurement equation;
at the same simulation moment, the rolling direction control moment generated by the swing angle of the engine is as follows
Figure FDA0003046026320000041
The rolling direction control moment generated by the attitude control spray pipe is dKγThe two control modes control the proportional coefficient of the torque to be
Figure FDA0003046026320000042
The rolling attitude angle deviation superposition value generated by the two kinetic equations is
Figure FDA0003046026320000043
And gamma is the rolling attitude angle deviation value of the arrow body model entering the measurement equation.
CN201811529697.6A 2018-12-14 2018-12-14 Method for carrying out semi-physical simulation test on joint control section of carrier rocket Active CN109407551B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811529697.6A CN109407551B (en) 2018-12-14 2018-12-14 Method for carrying out semi-physical simulation test on joint control section of carrier rocket

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811529697.6A CN109407551B (en) 2018-12-14 2018-12-14 Method for carrying out semi-physical simulation test on joint control section of carrier rocket

Publications (2)

Publication Number Publication Date
CN109407551A CN109407551A (en) 2019-03-01
CN109407551B true CN109407551B (en) 2021-09-24

Family

ID=65459088

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811529697.6A Active CN109407551B (en) 2018-12-14 2018-12-14 Method for carrying out semi-physical simulation test on joint control section of carrier rocket

Country Status (1)

Country Link
CN (1) CN109407551B (en)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110104218B (en) * 2019-04-19 2021-04-30 北京航天自动控制研究所 Pre-deflection angle nonlinear compensation method and device for rocket engine frame deformation angle
CN110362112B (en) * 2019-07-22 2022-05-03 江南机电设计研究所 Introduction method for inhibiting engine interference
CN110750053A (en) * 2019-10-10 2020-02-04 中国人民解放军陆军装甲兵学院 Error analysis method for semi-physical simulation system of aircraft
CN112325710B (en) * 2020-09-24 2023-03-31 北京航天自动控制研究所 High-precision attitude control method and system for high-thrust direct orbit entry of carrier rocket
CN112445234B (en) * 2020-11-27 2022-11-15 航天科工火箭技术有限公司 Attitude control method and device for spacecraft
CN112550769B (en) * 2020-12-14 2022-03-15 北京航天自动控制研究所 Method for controlling angular deviation of angular speed control section
CN112550768B (en) * 2020-12-14 2022-07-12 北京航天自动控制研究所 High-precision angular velocity control method under short-time large-boundary interference
CN114019826B (en) * 2021-10-12 2023-11-03 湖北三江航天红林探控有限公司 Semi-physical simulation test system and method for controller of solid attitude control power system
CN114384799B (en) * 2022-01-14 2023-11-28 北京中科宇航技术有限公司 Combined thrust vector control method for boosting and core-level engine

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06129798A (en) * 1992-10-19 1994-05-13 Mitsubishi Heavy Ind Ltd Objective missile
CN102589350A (en) * 2012-01-09 2012-07-18 林德福 Semi-physical simulation system for developing laser terminal guidance ammunition round
JP2015137991A (en) * 2014-01-24 2015-07-30 セイコーエプソン株式会社 Functional elements, sensor device, electronic apparatus and movable body
CN104898635A (en) * 2014-10-27 2015-09-09 中国运载火箭技术研究院 High thrust liquid rocket fault reconfiguration control method
CN104898680A (en) * 2015-05-04 2015-09-09 湖北航天技术研究院总体设计所 Solid carrier rocket attitude control method based on solid variable-jet-direction jet engine
CN106200668A (en) * 2016-09-12 2016-12-07 上海航天控制技术研究所 Outer loop energy resource system and test method thereof for semi-physical simulation
CN106444430A (en) * 2016-11-09 2017-02-22 上海宇航系统工程研究所 Control system and method for sublevel reentry of carrier rocket, and simulation system and method
CN107807626A (en) * 2017-09-27 2018-03-16 上海航天控制技术研究所 One kind can autonomous configuration flight control system based on Embedded Multi-task

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050137724A1 (en) * 2003-10-10 2005-06-23 Georgia Tech Research Corporation Adaptive observer and related method

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06129798A (en) * 1992-10-19 1994-05-13 Mitsubishi Heavy Ind Ltd Objective missile
CN102589350A (en) * 2012-01-09 2012-07-18 林德福 Semi-physical simulation system for developing laser terminal guidance ammunition round
JP2015137991A (en) * 2014-01-24 2015-07-30 セイコーエプソン株式会社 Functional elements, sensor device, electronic apparatus and movable body
CN104898635A (en) * 2014-10-27 2015-09-09 中国运载火箭技术研究院 High thrust liquid rocket fault reconfiguration control method
CN104898680A (en) * 2015-05-04 2015-09-09 湖北航天技术研究院总体设计所 Solid carrier rocket attitude control method based on solid variable-jet-direction jet engine
CN106200668A (en) * 2016-09-12 2016-12-07 上海航天控制技术研究所 Outer loop energy resource system and test method thereof for semi-physical simulation
CN106444430A (en) * 2016-11-09 2017-02-22 上海宇航系统工程研究所 Control system and method for sublevel reentry of carrier rocket, and simulation system and method
CN107807626A (en) * 2017-09-27 2018-03-16 上海航天控制技术研究所 One kind can autonomous configuration flight control system based on Embedded Multi-task

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
"Computed Torque Control of an aerospace craft using nonlinear inverse model and rotation matrix";Jong Tai Jang等;《2015 15th International Conference on Control, Automation and Systems (ICCAS)》;20151231;全文 *
"Development of hardware-in-the-loop simultion for rocket guidance system";Yulyan Wahyu Hadi等;《2015 International Conference on Electrical Engineering and Informatics (ICEEI)》;20151231;全文 *
"基于最优制导的运载火箭姿态控制方法研究";周静等;《上海航天》;20161231;第33卷;全文 *
"运载火箭电动伺服与发动机间隙补偿控制方法";贺从园等;《上海航天》;20161231;第33卷;全文 *

Also Published As

Publication number Publication date
CN109407551A (en) 2019-03-01

Similar Documents

Publication Publication Date Title
CN109407551B (en) Method for carrying out semi-physical simulation test on joint control section of carrier rocket
CN108803649B (en) A kind of VTOL Reusable Launch Vehicles active disturbance rejection sliding-mode control
CN109189085B (en) Spacecraft networked system attitude control method based on event triggering
Hu et al. Disturbance observer based finite-time attitude control for rigid spacecraft under input saturation
CN111309042A (en) Aircraft overload tracking method taking overload and angular speed as outer loop
CN108762096B (en) Disturbance suppression method for control moment gyro frame system based on discrete nonlinear cascade extended state observer
CN104155988B (en) Multichannel attitude controller of aircraft
CN109062043B (en) Spacecraft active disturbance rejection control method considering network transmission and actuator saturation
Zhu et al. Integrated direct/indirect adaptive robust posture trajectory tracking control of a parallel manipulator driven by pneumatic muscles
JP3859454B2 (en) Satellite maneuver control device
CN107402516B (en) Rank saturation the fuzzy PD attitude control method is passed based on joint executing agency
CN109814496B (en) Multi-axis time synchronization method in S-type acceleration and deceleration trajectory planning
CN104252133A (en) Longitudinal control law smooth switching method of unmanned aerial vehicle
CN103412571B (en) A kind of spacecraft relative Attitude Control for Spacecraft method based on feedback linearization technology
CN116834976A (en) Fault-tolerant control distribution method for RCS moment output at initial stage of reentry section of aerospace vehicle
CN113419431B (en) Stratospheric airship trajectory tracking control method and system based on event triggering
CN111198570A (en) Anti-delay high-precision active disturbance rejection attitude control method based on fixed time differentiator prediction
CN113110554B (en) Four-rotor unmanned aerial vehicle composite continuous rapid terminal sliding mode attitude control method
Xiao et al. Adaptive quaternion-based output feedback control for flexible spacecraft attitude tracking with input constraints
CN105739511B (en) A kind of missing mark hovers asymptotic control method to the underactuated spacecraft of control
CN108107726B (en) Four-rotor aircraft output limited backstepping control method based on symmetric time-varying obstacle Lyapunov function
CN113485396B (en) Spacecraft intersection butt joint final approximation segment relative orbit and attitude tracking control method
Sahu et al. Adaptive control validation using a MATLAB-based CFD/RBD coupled simulation
CN113485394B (en) High-precision fixed-time-convergence relative-posture fault-tolerant tracking control method
CN113569391A (en) Method, device, equipment and medium for determining parameters of earth-moon transfer orbit

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant