CN115817859A - Reusable carrier rocket rolling channel control method - Google Patents
Reusable carrier rocket rolling channel control method Download PDFInfo
- Publication number
- CN115817859A CN115817859A CN202310122973.1A CN202310122973A CN115817859A CN 115817859 A CN115817859 A CN 115817859A CN 202310122973 A CN202310122973 A CN 202310122973A CN 115817859 A CN115817859 A CN 115817859A
- Authority
- CN
- China
- Prior art keywords
- rolling
- ducted fan
- attitude angle
- control period
- roll
- 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.)
- Granted
Links
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
The invention relates to a rocket rolling channel control method, in particular to a reusable carrier rocket rolling channel control method, aiming at solving the defects that when a swing engine is used for control, the swing mass is large, the rotational inertia is large, and a control loop is easily influenced, when a grid rudder is used for control, the structural form is complex, data processing is difficult to a certain extent, when reaction force is used for control, the control force is small and fixed, and the required fuel and the scale thereof are required to be increased when the control force is increased. The invention discloses a method for controlling a rolling channel of a reusable carrier rocket by controlling a ducted fan, which comprises the following steps: the method comprises the steps of measuring an arrow body rolling attitude angle and a rolling angular speed, calculating rolling attitude angle deviation and rolling angular speed deviation, calculating a rolling channel instruction, determining a speed regulation mark quantity, determining the working state of each ducted fan, and driving the ducted fan to change the arrow body rolling attitude angle by a ducted fan controller.
Description
Technical Field
The invention relates to a control method of a rocket rolling channel, in particular to a control method of a reusable carrier rocket rolling channel.
Background
At present, the reusable carrier rocket rolling channel control methods mainly comprise three methods: swing engine Control, grid rudder Control, and Reaction force Control (RCS). When the swing engine is used as a control actuating mechanism, the engine swings under the pushing of the servo mechanism to provide control torque to realize the attitude control of the rolling channel, and the mode has the defects that the large engine has large swing mass and large rotary inertia around a swing shaft, and meanwhile, the engine-servo local loop has low frequency and is easy to be overlapped with the elastic frequency of a whole rocket so as to influence a control loop. When the grid rudder is adopted as a control execution mechanism, the grid rudder is usually folded and tightly attached to the outer wall of an arrow body in a take-off acceleration stage, the grid rudder is unfolded when needed, and the rudder deflection angle of the grid rudder is adjusted through rotation of a rudder shaft, so that the attitude control of a rolling channel is realized. When the reaction force control system is used as an actuating mechanism, the rocket attitude is adjusted by using the thrust generated by the jet flow of the attitude control engine, and the attitude control engine is generally laterally and fixedly arranged on the rocket body.
Disclosure of Invention
The invention aims to solve the defects that in the prior art, when a swing engine is used for control, the swing mass is large, the rotational inertia is large, a control loop is easily influenced, when a grid rudder is used for control, the structural form is complex, data processing is difficult, when reaction force is used for control, the control force is small and fixed, fuel needs to be added when the control force is increased, and the scale of the fuel needs to be increased.
In order to achieve the above purpose, the technical solution provided by the present invention is as follows:
a reusable carrier rocket rolling channel control method is characterized in that: in the rolling channel control method, two groups of ducted fans are arranged on the periphery of an rocket body of a rocket, the directions of control forces generated by the two groups of ducted fans are opposite and are arranged at intervals, and each group comprises at least two ducted fans; the control method comprises the following steps:
Wherein, the first and the second end of the pipe are connected with each other,proportional, derivative and integral feedback coefficients in the PID control method,a compensation term for disturbance error; the rolling channel instruction is control force which needs to be applied to the arrow body to realize the rolling attitude angle;
s4, determining a speed regulation mark quantity according to the motor temperature T of the ducted fan;
Wherein the content of the first and second substances,if so, the speed cannot be adjusted;the speed can be adjusted;
s5, determining the speed regulation mark quantity according to the S4And the working state of the ducted fan in the last control period, and determining the working state of each ducted fan in the current control period(ii) a The working state is a rotating speed;
when in useIf the rotational speed of the ducted fan in the previous control period is the highest, the rotational speed of the current control period is set to be the lowest rotational speed;
when in useAnd the rotational speed of the ducted fan in the previous control period does not reach the highest rotational speed,if the duration time is less than or equal to t _ flag, the rotating speed of the current control period is unchanged; the T _ flag is set over-temperature working time, and the over-temperature working time refers to the time for the ducted fan to continuously work when the temperature T of the motor is greater than the set temperature;
when in useThe rotational speed of the ducted fan in the previous control period does not reach the highest rotational speed,if the duration time is more than t _ flag, the rotating speed of the current control period is set as the lowest rotating speed;
when in useAccording to in S3Obtaining the rotating speed of each ducted fan in the current control period;
s6, sending the working state of each ducted fan in the current control period to a ducted fan controller, wherein the ducted fan controller drives each ducted fan to rotate, and the rolling attitude angle of an arrow body is changed; and returning to S1, and adjusting the next control period.
Furthermore, the two groups of ducted fans comprise the same number of ducted fans, and the same number of the two groups of ducted fans is beneficial to keeping the stable stress of the arrow body in the circumferential direction along the two directions.
Further, in S4, the set temperature is an upper temperature limit of the ducted fan during normal operation, and the adaptive adjustment is performed according to the model of the ducted fan in actual use.
Further, in S2, a roll attitude angle deviation is calculatedAnd deviation of roll angular velocityThe method specifically comprises the following steps:
s2.1, rolling the attitude angle through an arrow body according to the following formulaAnd the current desired roll attitude angleCalculating roll attitude angle deviation:
S2.2. Rolling angular velocity through arrow body according to the following formulaAnd the currently desired roll rateCalculating the roll angular velocity deviation:
determination of control parameters using pole placement byThe expected pole in the pole allocation method is determined according to the requirements of dynamic performance and control precision of the rocket roll attitude angle;
wherein the content of the first and second substances,an open loop transfer function for the system;a transfer function model of the arrow body rolling attitude angle;a transfer function model of the roll angular velocity of the arrow body;to incorporate a transfer function model of the roll attitude angle of the navigation system,a transfer function model of the roll angular velocity of the integrated navigation system;is a ducted fan transfer function model.
Further, in S3, a disturbance error compensation termDetermined by extended state observer observation, the observer equation is as follows:
wherein the content of the first and second substances,is a control period;to expand the state observer parameters;is the process quantity;the current rolling channel instruction is obtained;indicating a current control period;the disturbance error compensation item of the previous control period is used, and the initial value is assigned as a 0 value;for the attitude angle and the speed of the rolling angle of the arrow body measured by the observer in the current control period,and the initial values of the arrow body rolling attitude angle and the arrow body rolling angular velocity are assigned according to the measured initial values.
Compared with the prior art, the invention has the following beneficial effects:
1. according to the invention, rocket body rolling is realized by utilizing the ducted fan, the volume of the ducted fan is smaller, and the fan blades are arranged in the ducted channel, so that the influence of the flying environment of the rocket on the blades is smaller, the rolling process of the rocket is more stable, meanwhile, because the influence of the environment on the ducted fan and the mutual influence among the ducted fans are smaller, in the process of calculating the rolling channel instruction, the calculation model is simpler, and the corresponding control force can be adjusted by adjusting the rotating speed of the fan blades; the ducted fan does not need to be associated with an engine and rocket fuel, and the design, assembly and debugging process are simpler and more convenient.
2. The invention is used for calculating the rolling channel instructionTime-lapse rolling channel control algorithmThe PID control method is not highly adaptive to unknown complex disturbance environment, and the disturbance error compensation item is combined with two models of the PID control method and the disturbance error compensation itemUnknown disturbance can be calculated in real time, and errors are reduced, so that the rolling channel control algorithm after the two models are combined is more accurate, and the control effect of the whole control system is better.
3. In the adjusting process of the working state of the ducted fan, the speed-adjusting mark quantity is increased, the working state of the ducted fan in the current control period is adjusted by combining the temperature of the motor of the ducted fan, the failure of the ducted fan caused by overhigh temperature is avoided, meanwhile, the overtemperature time is also set, and the working state of the ducted fan is more accurately controlled through the cooperation of a plurality of parameters.
4. The ducted fan used by the invention is an existing product, the technology is mature, additional development is not needed, the cost is low, and the size and the control force of the needed fan can be customized according to the requirement.
Drawings
FIG. 1 is a block diagram of the transfer function of the PID control method of the invention;
FIG. 2 is a schematic structural view of a ducted fan and an arrow body in an embodiment of the present invention;
FIG. 3 is a top view of FIG. 2;
description of reference numerals:
100-arrow body, 111-first ducted fan, 112-second ducted fan, 121-third ducted fan, 122-fourth ducted fan, 200-installation plane.
Detailed Description
The invention is described in further detail below with reference to the following figures and specific examples:
the invention discloses a reusable carrier rocket rolling channel control method, which comprises the following steps:
s1, obtaining an arrow body rolling attitude angle through measurement of an arrow navigation systemAnd angular velocity of arrow roll;
S2, calculating the deviation of the rolling attitude angleAnd deviation of roll angular velocityThe method specifically comprises the following steps:
s2.1, rolling the attitude angle through an arrow body according to the following formulaAnd the current desired roll attitude angleCalculating roll attitude angle deviation:
S2.2. Rolling angular velocity through arrow body according to the following formulaAnd the currently desired roll rateCalculating the roll angular velocity deviation:
In other embodiments of the present invention, step S2.2 may be performed first, and then step S2.1 may be performed, or steps S2.1 and S2.2 may be performed simultaneously.
S3, controlling an algorithm through a rolling channel according to the rolling attitude angle deviation and the rolling angular speed deviation in the S2Calculating a roll channel command:
Wherein the content of the first and second substances,the rolling channel instruction needs control force applied to the arrow body to realize the rolling attitude angle,proportional, derivative and integral feedback coefficients in the PID control method,a disturbance error compensation term.
the transfer function block diagram of the PID control method is shown in FIG. 1, an expected pole meeting the requirements is set according to index requirements such as dynamic performance of a reusable rocket roll attitude angle, control precision requirements and the like, and control parameters are determined by using a pole configuration method through the following formula:
Wherein the content of the first and second substances,open loop transfer function for the system;comprehensively calculating a transfer function model of the rocket body rolling attitude angle according to a kinetic equation and a kinematic equation of the rocket body rolling attitude angle;is a transfer function model of the angular velocity of the rocket body roll according to the rocketComprehensively calculating a kinetic equation and a kinematic equation of the roll angular velocity;to incorporate a transfer function model of the roll attitude angle of the navigation system,to combine a transfer function model of the roll angular velocity of a navigation system,andcan be determined according to the hardware characteristics of the navigation device;for the ducted fan transfer function model, the expressions are respectively as follows:
wherein s is a Laplace operator;the torque of the ducted fan can be obtained according to the characteristics of the ducted fan;、for step S2Andcarrying out Laplace transformation on the roll attitude angle and the roll angular speed;、all the components are intermediate in weight percentage,is the real rolling attitude angle in the rocket running process,the actual rolling angular velocity in the running process of the rocket;
the disturbance error compensation termDetermined by extended state observer observation, the observer equation is as follows:
wherein the content of the first and second substances,is a control period;adjusting the observer parameters of the extended state according to the rolling channel condition, and generally determining according to experience;is a process quantity;the current rolling channel instruction is obtained;indicating a current control period;the initial value is assigned to be 0 for the disturbance error compensation item of the previous control period;for the attitude angle and the speed of the rolling angle of the arrow body measured by the observer in the current control period,and the initial values of the arrow body rolling attitude angle and the arrow body rolling angular velocity are assigned according to the measured initial values.
S4, determining a speed regulation mark quantity according to the motor temperature T of the ducted fan;
Wherein the content of the first and second substances,if so, the speed cannot be adjusted;the speed can be adjusted; the set temperature is the upper limit of the temperature of the ducted fan when the ducted fan normally works;
in other embodiments of the present invention, step S4 may be executed first, and then step S3 may be executed;
s5, integrating the rolling channel command calculated in the step S3And the speed regulation flag determined in S4Determining the working state of each ducted fan in the current control period according to the following formula;
Wherein the content of the first and second substances,the working state of the ducted fan is the current control period, and the working state of the ducted fan is the rotating speed of the ducted fan;the lowest rotating speed for the ducted fan to work;the working state of the ducted fan in the last control period is obtained;is a function of the rolling channel command and the rotational speed of the ducted fan, generally in a nonlinear form, and is determined by the characteristics of the ducted fan;
when in useIf the rotational speed of the ducted fan in the previous control period is the highest, the rotational speed of the current control period is set to be the lowest rotational speed;
when in useAnd the rotational speed of the ducted fan in the previous control period does not reach the highest rotational speed,if the duration time is less than or equal to t _ flag, the rotating speed of the current control period is unchanged; the T _ flag is set over-temperature working time, and the over-temperature working time refers to the time for the ducted fan to continuously work when the temperature T of the motor is greater than the set temperature;
when in useThe rotational speed of the ducted fan in the previous control period does not reach the highest rotational speed,if the duration time is more than t _ flag, the rotating speed of the current control period is set as the lowest rotating speed;
when in useAccording to in S3Obtaining the rotating speed of each ducted fan in the current control period;
s6, converting the working state of the ducted fan into a PWM wave instruction, and sending the PWM wave instruction to a ducted fan controller;
s7, the ducted fan controller drives each ducted fan to rotate according to the PWM wave instruction, and the arrow body rolling attitude angle is changed; and returning to S1, and adjusting the next control period.
The rocket structure capable of realizing the reusable carrier rocket rolling passage control method comprises an rocket body 100 and two groups of ducted fans arranged at the periphery of the rocket body 100, wherein the number of the ducted fans arranged in the two groups of ducted fans is the same, the directions of generated control forces are opposite, the two groups of ducted fans are arranged at intervals, each group comprises at least two ducted fans, and the two groups of ducted fans are arranged on the same installation plane 200.
The ducted fans in this embodiment are arranged as shown in fig. 2, and include a first ducted fan 111, a second ducted fan 112, a third ducted fan 121, and a fourth ducted fan 122; wherein, first ducted fan 111, second ducted fan 112 are the first group, third ducted fan 121, fourth ducted fan 122 are the second group, the direction that first group ducted fan produced the control force is the anticlockwise, the second group ducted fan produced the control force direction and is the clockwise, according to the motor rotational speed of ducted fan, can adjust its control force size, consequently, through the control force of adjusting two sets of different wind directions, can realize the control to the arrow body 100 roll passageway.
Claims (6)
1. A reusable carrier rocket rolling channel control method is characterized in that:
in the rolling channel control method, two groups of ducted fans are arranged on the periphery of an rocket body of a rocket, the directions of control forces generated by the two groups of ducted fans are opposite and are arranged at intervals, and each group comprises at least two ducted fans; the control method comprises the following steps:
Wherein, the first and the second end of the pipe are connected with each other,proportional, derivative and integral feedback coefficients in the PID control method,a compensation term for disturbance error; the roll channel commandThe control force applied to the arrow body is needed to realize the rolling attitude angle;
s4, determining a speed regulation mark quantity according to the motor temperature T of the ducted fan;
Wherein the content of the first and second substances,if so, the speed cannot be adjusted;the speed can be adjusted;
s5, determining the speed regulation mark quantity according to S4Determining the working state of each ducted fan in the current control period(ii) a The working state is the rotating speed of the ducted fan;
when in useIf the rotational speed of the ducted fan in the previous control period is the highest, the rotational speed of the current control period is set to be the lowest rotational speed;
when in useAnd the rotational speed of the ducted fan in the previous control period does not reach the highest rotational speed,if the duration time is less than or equal to t _ flag, the rotating speed of the current control period is unchanged; the T _ flag is set over-temperature working time, and the over-temperature working time refers to the time when the motor temperature T is greater than the set temperatureThe time of continuous operation of the fan;
when the temperature is higher than the set temperatureThe rotational speed of the ducted fan in the previous control period does not reach the highest rotational speed,if the duration time is more than t _ flag, the rotating speed of the current control period is set as the lowest rotating speed;
when in useAccording to in S3Obtaining the rotating speed of each ducted fan in the current control period;
s6, sending the working state of each ducted fan in the current control period to a ducted fan controller, driving each ducted fan to rotate by the ducted fan controller, and changing the arrow body rolling attitude angle; and returning to S1, and adjusting the next control period.
2. A reusable launch vehicle rolling corridor control method according to claim 1, characterised in that:
the two groups of ducted fans comprise the same number of ducted fans.
3. A method for controlling a rolling passage of a re-usable launch vehicle according to claim 2, wherein:
and S4, setting the temperature as the upper limit of the temperature of the ducted fan during normal work.
4. A method of controlling a rolling passage of a reusable launch vehicle according to claim 3, wherein:
in S2, the roll attitude angle deviation is calculatedAnd deviation of roll angular velocityThe method specifically comprises the following steps:
s2.1, rolling the attitude angle through an arrow body according to the following formulaAnd the current desired roll attitude angleCalculating roll attitude angle deviation:
S2.2. Rolling angular velocity through arrow body according to the following formulaAnd the currently desired roll angular velocityCalculating the roll angular velocity deviation:
5. A method of controlling a rolling passage of a re-usable launch vehicle according to any one of claims 1 to 4, wherein:
determination of control parameters using pole placement byThe expected pole in the pole allocation method is determined according to the requirements of dynamic performance and control precision of the rocket roll attitude angle;
wherein the content of the first and second substances,open loop transfer function for the system;a transfer function model of the arrow body rolling attitude angle;a transfer function model of the angular velocity of the arrow roll;to incorporate a transfer function model of the roll attitude angle of the navigation system,a transfer function model of the roll angular velocity of the integrated navigation system;is a ducted fan transfer function model.
6. A method as claimed in claim 5, wherein the method comprises the steps of:
in S3, a disturbance error compensation termDetermined by extended state observer observation, the observer equation is as followsShowing:
wherein the content of the first and second substances,is a control period;to expand the state observer parameters;is the process quantity;the current rolling channel instruction is obtained;indicating a current control period;the initial value is assigned to be 0 for the disturbance error compensation item of the previous control period;for the attitude angle and the speed of the rolling angle of the arrow body measured by the observer in the current control period,and the initial values of the arrow body rolling attitude angle and the arrow body rolling angular velocity measured by the observer in the previous control period are assigned according to the measured initial values.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310122973.1A CN115817859B (en) | 2023-02-16 | 2023-02-16 | Reusable carrier rocket rolling channel control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310122973.1A CN115817859B (en) | 2023-02-16 | 2023-02-16 | Reusable carrier rocket rolling channel control method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115817859A true CN115817859A (en) | 2023-03-21 |
CN115817859B CN115817859B (en) | 2023-06-13 |
Family
ID=85521610
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310122973.1A Active CN115817859B (en) | 2023-02-16 | 2023-02-16 | Reusable carrier rocket rolling channel control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115817859B (en) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB0104971D0 (en) * | 2000-02-29 | 2001-04-18 | Andrews Space & Technology Inc | Method and apparatus for placing satellites in low-earth orbit |
US20160076544A1 (en) * | 2014-09-12 | 2016-03-17 | Celestica Technology Consultancy (Shanghai) Co., Ltd. | Fan control system and method thereof |
CN109270834A (en) * | 2018-11-05 | 2019-01-25 | 吉林大学 | A kind of design method based on PID four-rotor aircraft control system |
CN210564806U (en) * | 2019-10-17 | 2020-05-19 | 西安未来空天引擎科技有限公司 | Runner and storage tank integrated rocket stamping combined power system |
CN210738696U (en) * | 2019-10-21 | 2020-06-12 | 西安未来空天引擎科技有限公司 | Open-cycle variable-thrust liquid rocket engine system |
CN115556966A (en) * | 2022-10-20 | 2023-01-03 | 北京航天自动控制研究所 | Low-cost rocket type recoverable test aircraft |
-
2023
- 2023-02-16 CN CN202310122973.1A patent/CN115817859B/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB0104971D0 (en) * | 2000-02-29 | 2001-04-18 | Andrews Space & Technology Inc | Method and apparatus for placing satellites in low-earth orbit |
US20160076544A1 (en) * | 2014-09-12 | 2016-03-17 | Celestica Technology Consultancy (Shanghai) Co., Ltd. | Fan control system and method thereof |
CN109270834A (en) * | 2018-11-05 | 2019-01-25 | 吉林大学 | A kind of design method based on PID four-rotor aircraft control system |
CN210564806U (en) * | 2019-10-17 | 2020-05-19 | 西安未来空天引擎科技有限公司 | Runner and storage tank integrated rocket stamping combined power system |
CN210738696U (en) * | 2019-10-21 | 2020-06-12 | 西安未来空天引擎科技有限公司 | Open-cycle variable-thrust liquid rocket engine system |
CN115556966A (en) * | 2022-10-20 | 2023-01-03 | 北京航天自动控制研究所 | Low-cost rocket type recoverable test aircraft |
Non-Patent Citations (1)
Title |
---|
赵红刚;潘涛;陈华兵;: "一种弱气动弹/箭滚转控制方法" * |
Also Published As
Publication number | Publication date |
---|---|
CN115817859B (en) | 2023-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109614633B (en) | Nonlinear modeling and linearization balancing method for composite rotor craft | |
CN107023405B (en) | Thrust dispatching method for gas-turbine unit | |
US8668434B2 (en) | Robust flow parameter model for component-level dynamic turbine system control | |
CN104936859B (en) | Control device for engine | |
CN106844887B (en) | Dynamics modeling method and device for rotor unmanned aerial vehicle | |
CN106707759B (en) | A kind of aircraft Herbst maneuver autopilot method | |
CN108614573B (en) | Automatic fault-tolerant attitude control method for six-rotor unmanned aerial vehicle | |
CN109407551A (en) | A kind of pair of carrier rocket jointly controls the method that section carries out Hardware-in-loop Simulation Experimentation | |
CN111459188B (en) | Quaternion-based multi-rotor nonlinear flight control method | |
CN104504294A (en) | Flight simulation original state compound genetic balancing method | |
CN115016268A (en) | Fault-tolerant control method for tiltable four-rotor unmanned aerial vehicle based on sliding mode theory | |
CN109270834A (en) | A kind of design method based on PID four-rotor aircraft control system | |
CN112607002A (en) | Double-rotor ducted aircraft based on annular motor drive and control method thereof | |
CN112484955A (en) | Wind tunnel simulation method for aircraft roll control | |
CN105043774B (en) | A kind of method using interpolation calculation steering wheel power consumption | |
CN113885543B (en) | Design method of navigation body auto-disturbance rejection roll controller under complex sea condition disturbance | |
CN115817859A (en) | Reusable carrier rocket rolling channel control method | |
CN111852763B (en) | Fault-tolerant self-adaptive PID control method based on floating fan | |
CN116643578A (en) | Multimode unified control method for microminiature tailstock unmanned aerial vehicle | |
CN103185668A (en) | Simulation device for rotor effect of wing-mounted engine scaled model | |
CN207631475U (en) | It is a kind of can self-adjusting balance plant protection drone | |
CN115179300A (en) | Flexible mechanical arm trajectory tracking control method for preset time | |
CN111338369B (en) | Multi-rotor flight control method based on nonlinear inverse compensation | |
JPH0323399B2 (en) | ||
CN112441253A (en) | Simulation analysis system and method for real-time trail of multi-rotor unmanned aerial vehicle |
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 |