CN110793405B - Self-adaptive control method for preventing instantaneous impact of unfolding of folding rudder of electric steering engine - Google Patents
Self-adaptive control method for preventing instantaneous impact of unfolding of folding rudder of electric steering engine Download PDFInfo
- Publication number
- CN110793405B CN110793405B CN201910870547.XA CN201910870547A CN110793405B CN 110793405 B CN110793405 B CN 110793405B CN 201910870547 A CN201910870547 A CN 201910870547A CN 110793405 B CN110793405 B CN 110793405B
- Authority
- CN
- China
- Prior art keywords
- rudder
- impact
- steering engine
- electric steering
- unfolding
- 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
Links
Images
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F42—AMMUNITION; BLASTING
- F42B—EXPLOSIVE CHARGES, e.g. FOR BLASTING, FIREWORKS, AMMUNITION
- F42B15/00—Self-propelled projectiles or missiles, e.g. rockets; Guided missiles
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F42—AMMUNITION; BLASTING
- F42B—EXPLOSIVE CHARGES, e.g. FOR BLASTING, FIREWORKS, AMMUNITION
- F42B10/00—Means for influencing, e.g. improving, the aerodynamic properties of projectiles or missiles; Arrangements on projectiles or missiles for stabilising, steering, range-reducing, range-increasing or fall-retarding
- F42B10/02—Stabilising arrangements
- F42B10/14—Stabilising arrangements using fins spread or deployed after launch, e.g. after leaving the barrel
- F42B10/20—Stabilising arrangements using fins spread or deployed after launch, e.g. after leaving the barrel deployed by combustion gas pressure, or by pneumatic or hydraulic forces
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Fluid Mechanics (AREA)
- Chemical & Material Sciences (AREA)
- Aviation & Aerospace Engineering (AREA)
- Combustion & Propulsion (AREA)
- Feedback Control In General (AREA)
Abstract
Hair brushThe self-adaptive control method for resisting instantaneous impact of unfolding of the folding rudder of the electric steering engine comprises the following steps of: 1) the missile computer sends the working state characters of the folded rudders to the electric steering engine by using digital communication according to the missile flight time sequence information; 2) judging the working state of the folded rudder according to the unfolded state characters, controlling a rigid-flexible coupling model before and after the folded rudder is unfolded, establishing an instantaneous impact state space equation according to an unfolded instantaneous impact dynamics theoretical model and an expected attitude, predicting rudder shaft torque applied by gas drive at the next moment, and representing bounded interference and uncertain factors of a system; 3) designing a self-adaptive sliding mode control strategy according to a state space equation, controlling an instantaneous swing angle and a feedback current, weakening positive and negative feedback vibration of a position feedback signal and torque impact action of a rudder shaft by adopting feedforward anti-swing vibration control, and converting the output of a controller into a system duty ratio deltapwmAnd finally, the closed-loop control of the motor is realized.
Description
Technical Field
The invention relates to the control technology of an electric steering engine system of an aircraft, in particular to a self-adaptive control method aiming at instantaneous impact when a folding rudder of an electric steering engine is unfolded.
Background
In order to meet the requirements of modern military operations on stealth performance, maneuverability and adaptability of a launching platform, tactical weapon missiles are generally launched in a box type or an embedded type. The electric steering engine part is required to adopt the folding control surface technology as much as possible, namely the control surface is in a folding state in the launching box; when the missile flies away from the launching box, the control surface automatically expands to a normal position for normal launching. By using the folding rudder technology, the occupied space of the missile is greatly reduced, the launching maneuverability and the concealment of the missile are improved, and the adaptability of a launching platform is optimized, so that the folding rudder electric steering engine gradually becomes a new design trend.
However, the unfolding of the folding rudder is a complex pneumatic process, and particularly when the missile leaves the missile box and the folding rudder is unfolded instantaneously, impact load can be generated on a control surface due to the action of pneumatics, structural gaps and the like, so that huge instantaneous impact force is generated, the high-frequency jitter of the control surface of the steering engine is caused, the strength of the control surface is poor, and the control surface is bent or deformed; in addition, the jitter is extremely unfavorable for the control of a servo system, and can cause direct consequences such as reduction of system stability, even divergence and the like, thereby causing high power consumption, heating of a steering engine, and failure and damage in severe cases.
Disclosure of Invention
The invention aims to solve the technical problems that the steering engine shakes at high frequency and even the system diverges due to instantaneous impact force generated at the moment of unfolding a folding rudder.
In order to solve the technical problem, the invention discloses a self-adaptive control method for resisting instantaneous impact of unfolding of a folding rudder of an electric steering engine, which comprises the following steps of:
1) the missile computer sends the working state characters of the folded rudders to the electric steering engine by using digital communication according to the missile flight time sequence information;
2) judging the working state of the folded rudder according to the unfolded state characters, controlling a rigid-flexible coupling model before and after the folded rudder is unfolded, establishing an instantaneous impact state space equation according to an unfolded instantaneous impact dynamics theoretical model and an expected attitude, predicting rudder shaft torque applied by gas drive at the next moment, and representing bounded interference and uncertain factors of a system;
3) designing adaptive sliding mode control strategy according to state space equationSlightly, the instantaneous swing angle and the feedback current are controlled, the feedforward anti-swing vibration control is adopted to weaken the positive and negative feedback vibration of a position feedback signal and the torque impact action of a rudder shaft, and the output of a controller is converted into the system duty ratio deltapwmAnd finally, the closed-loop control of the motor is realized.
In order to solve the adverse effects of instantaneous impact and high-frequency jitter when the folding rudder is unfolded, the invention provides an adaptive control method for resisting the instantaneous impact when the folding rudder is unfolded by an electric steering engine, on one hand, the adaptive sliding mode control based on dynamic compensation is adopted for the instantaneous unfolding of the folding rudder, the instantaneous impact and damping oscillation action of the unfolding of the system are reduced, and the rapid robustness of the system is improved; on the other hand, discrete FFT conversion processing is carried out on the position feedback signal, frequency and amplitude identification is carried out on the high-frequency impact signal of the folded rudder, low-pass filtering based on SOGI is carried out on the position feedback signal, and therefore the problem of buffeting of the electric steering engine is solved.
Drawings
The invention will be further explained with reference to the drawings and examples.
FIG. 1 is a block diagram of a state identification process according to an embodiment of the present invention.
Fig. 2 is a schematic unfolding view of a folded rudder according to an embodiment of the present invention.
FIG. 3 is a block diagram of adaptive sliding mode control based on dynamic compensation according to an embodiment of the present invention.
Fig. 4 is a diagram of the structure of the SOGI low-pass filter according to the embodiment of the present invention.
Detailed Description
A self-adaptive control method for an electric steering engine to resist instantaneous impact of unfolding of a folded rudder comprises the following steps of:
1. the missile computer sends a folded rudder working state word to an electric steering engine by utilizing digital communication according to the missile flight time sequence information;
FIG. 1 is a block diagram illustrating a state recognition process. The computer sends the folding rudder working state word to reach the electric steering engine through popping up, and the electric steering engine identifies the folding rudder working state word D(s), thereby identifying the working state of the electric steering engine:
only when the folding rudder works in an unfolding stage, the self-adaptive sliding mode control based on the dynamic compensation is adopted;
2. judging the working state of the folded rudder according to the working state characters, controlling a rigid-flexible coupling model before and after the folded rudder is unfolded, establishing an instantaneous impact state space equation according to an unfolded instantaneous impact dynamics theoretical model and an expected attitude (an instantaneous swinging angle and rudder shaft bearing torque), and predicting the rudder shaft torque applied by gas drive at the next moment, wherein the characteristics are bounded interference and uncertain factors of a system;
fig. 2 is a schematic diagram of the unfolding of the folded rudder, and a dynamic model of the unfolding moment of the folded rudder is analyzed.
In the unfolding process, an inertia coordinate system of the interface center of the rudder shaft and a movable coordinate system parallel to the mass center of the outer rudder are established, and the inertia matrix of the rigid body relative to the origin p of the movable coordinate system is obtained as follows: (centroid mc coordinate is (x)c,yc,zc))
The kinetic energy of the rotation matrix coordinate and the rigid body around the origin of the coordinate system can be obtained by rotation transformation:
wherein R isopFor the rotation matrix:
the outer rudder kinetic energy is:
where ω is ωin+ωout,ωinIs the vector of angular velocity of rotation of the rudder shaft, omegaoutIs the vector of the angular velocity of the rotation of the outer rudder rotating shaft. ω projects under the inertial coordinate system as:
the inner rudder kinetic energy is:
column-writing Lagrange function, and establishing a control system dynamic equation when a control surface is unfolded as follows:
Q1=-kpθ, kp is the stiffness of the rudder system.
Q2=M(t), M (t) is the control surface unfolding driving torque generated by the fuel gas.
The moment of momentum is projected on an inertia coordinate system and balanced by the rigid deformation of a transmission mechanism and the moment generated by the servo control of a motor, and the torque completely applied to a rudder shaft bearing is as follows:
M(o)=(Mx My Mz)T (9)
in the impact process, the inner rudder and the outer rudder are locked by the locking pin at the moment of in-place, so that the included angle of the inner rudder and the outer rudder meets the requirementThe method is characterized in that an ideal curve of the gas drive torque attenuation along with time in the impact stage can be predicted by an ideal model of the gas drive applied torque in the expansion stage:
MB→t=F(t) (10)
3. simplifying a dynamic equation of a rotation angle and torque of a motor and a rudder shaft, establishing an instantaneous impact discrete state space equation, taking the rotation angle of the rudder shaft as output, taking the rudder shaft torque applied by gas drive of an impact section as external interference and uncertain factors, predicting the predicted rudder shaft torque, establishing a sliding mode surface, designing an adaptive law of a prediction error estimation value, performing stability design by using a Lyapunov function, and finally realizing adaptive control based on dynamic compensation at the moment of unfolding of a folded rudder.
As shown in FIG. 3, the dynamic model is a dynamic model of the rotation direction of the rudder shaft in the impact section by simplifying the dynamic equation of the rotation angle and the torque of the motor and the rudder shaft based on the adaptive sliding mode control of the dynamic compensation
Wherein J is equivalent moment of inertia, theta is the rotation angle of the rudder shaft, imFor the gear ratio of the motor shaft to the rudder shaft, KtIs the motor current torque coefficient, MBThe torque generated by the explosion to which the rudder shaft of the impact section is subjected.
dynamic gas torque M obtained by the aboveB(t) function of time with d characterizing other unmodeled disturbances, while lettingThe state space model is thus rewritten as:
the defined error is:
wherein xdAlpha is the virtual control for the command position. The virtual control α is set to:
k of which1Positive real number, from which it follows:
defining the slip form surface as:
s=ce1+e2 (17)
then it can be deduced that:
designing the controller output:
u=ueq+uvss (19)
wherein u iseqFor equivalent control, uvssFor handover control, it is specifically expressed as follows:
wherein k is2Is a positive real number, dfIs a predicted value of d and is,torque is applied for the gas predicted at time t,is the predicted next time instant.e3For uncertain upper bound of interference, andis e3An estimate of (d). Defining the estimation error as:
the Lyapunov function is chosen to be:
derivation of this can yield:
substituting the adaptive law to obtain:
get a0=min{2(k1+c),2k2}, then
Therefore, all signal closed loops in the system are proved to be converged to zero, and the designed control strategy is stable in closed loop.
4. Discrete FFT conversion processing is carried out on the steering engine position feedback signal, frequency and amplitude identification is carried out on the folded steering engine high-frequency impact signal, and low-pass filtering based on SOGI is carried out on the feedback signal;
the position feedback signal is low-pass filtered using a SOGI second order generalized integrator as shown in fig. 4. Firstly, identifying the frequency and amplitude information of a high-frequency impact signal of the folded rudder in real time by utilizing discrete FFT analysis and combining rolling type sampling; and then the high-frequency buffeting signal is subjected to low-pass filtering processing through an SOGI second-order generalized integrator shown in the figure, and the central frequency of a low-pass filter is set as a recognized high-frequency impact signal.
The SOGI low-pass filter transfer function q(s) satisfies:
wherein Q(s) is a low pass filter transfer function,is the center frequency of the low pass filter, and ζ is the damping ratio.
5. The electric steering engine control system adopts position loop and current loop double closed loop control, takes a rudder instruction and a rudder feedback position signal after low-pass filtering as the input of a position loop, and sends the rudder instruction and the rudder feedback position signal to the electric steering engine, and finally realizes closed loop control.
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 (6)
1. The self-adaptive control method for preventing instantaneous impact of unfolding of the folding rudder of the electric steering engine is characterized by comprising the following steps of:
1) the missile computer sends the working state characters of the folded rudders to the electric steering engine by using digital communication according to the missile flight time sequence information;
2) judging the working state of the folded rudder according to the working state characters, controlling a rigid-flexible coupling model before and after the folded rudder is unfolded, establishing an instantaneous impact state space equation according to an unfolded instantaneous impact dynamics theoretical model and an expected attitude, predicting rudder shaft torque applied by gas drive at the next moment, and representing bounded interference and uncertain factors of a system;
3) designing a self-adaptive sliding mode control strategy according to a state space equation, controlling an instantaneous swing angle and a feedback current, weakening positive and negative feedback vibration of a position feedback signal and torque impact action of a rudder shaft by adopting feedforward anti-swing vibration control, and converting the output of a controller into a system duty ratio deltapwmAnd finally, the closed-loop control of the electric steering engine is realized.
2. The self-adaptive control method for resisting instantaneous impact of unfolding of the folding rudder of the electric steering engine as claimed in claim 1, wherein the working state of the folding rudder of the electric steering engine is recognized, the missile-mounted computer sends missile-launching and folding rudder unfolding state signals in real time and transmits the missile-launching and folding rudder unfolding state signals to the electric steering engine through state words D(s) to participate in control:
3. the adaptive control method for the electric steering engine to resist the instantaneous unfolding impact of the folded rudder as claimed in claim 1, wherein the desired attitude in the step 2) comprises an instantaneous swing angle and a rudder shaft bearing torque.
4. The self-adaptive control method for resisting instantaneous expansion impact of the folding rudder of the electric steering engine according to claim 1, wherein in the expansion process, an inertia coordinate system of the interface center of the rudder shaft and a moving coordinate system parallel to the mass center of the outer rudder are established to obtain an inertia matrix of a rigid body relative to the origin p of the moving coordinate systemComprises the following steps:
the centroid mc coordinate is (x)c,yc,zc);
The kinetic energy of the rotation matrix coordinate and the rigid body around the origin of the coordinate system can be obtained by rotation transformation:
wherein R isopFor the rotation matrix:
the outer rudder kinetic energy is:
where ω is ωin+ωout,ωinIs the vector of angular velocity of rotation of the rudder shaft, omegaoutThe vector of the rotating angular velocity of the outer rudder rotating shaft is shown; ω projects under the inertial coordinate system as:
the inner rudder kinetic energy is:
column-writing Lagrange function, and establishing a control system dynamic equation when a control surface is unfolded as follows:
Q1=-kpθ,kpThe stiffness of the rudder system;
Q2m (t), m (t) is a control surface unfolding driving torque generated by gas;
the moment of momentum is projected on an inertia coordinate system and balanced by the rigid deformation of a transmission mechanism and the moment generated by the servo control of a motor, and the torque completely applied to a rudder shaft bearing is as follows:
M(o)=(Mx My Mz)T (9)
in the impact process, the inner rudder and the outer rudder are locked by the locking pin at the moment of in-place, so that the included angle of the inner rudder and the outer rudder meets the requirementThe ideal model of the torque applied by the gas drive in the expansion section can predict an ideal curve of the gas drive torque attenuation along with time in the impact section:
MB→t=F(t) (11)。
5. the adaptive control method of the electric steering engine for resisting the instantaneous impact of the unfolding of the folding rudder according to claim 1 is characterized in that adaptive sliding mode control is performed, a dynamic equation of a rotation angle and a torque of a motor and a rudder shaft is simplified according to the locking characteristics of an inner rudder and an outer rudder of an impact section, an instantaneous impact state space equation is established, the rotation angle of the rudder shaft is used as output, the torque of the rudder shaft applied by gas driving of the impact section is used as external interference and uncertain factors, the torque of the rudder shaft is predicted, a sliding mode surface is established, an adaptive law of a prediction error estimation value is designed, a Lyapunov function is used for stability design, and finally adaptive control based on dynamic compensation at the moment of the unfolding of the folding rudder is achieved.
6. The self-adaptive control method for resisting instantaneous impact of unfolding of the folding rudder of the electric steering engine according to claim 1, wherein feedforward anti-shimmy control is carried out on the position feedback signal, discrete FFT analysis is adopted to combine with rolling type sampling, amplitude and frequency information of the impact signal are identified in real time, low-pass filtering processing is carried out on the position feedback signal through SOGI low-pass filtering, and the central frequency of a low-pass filter is set as an identified impact signal frequency value.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910870547.XA CN110793405B (en) | 2019-09-16 | 2019-09-16 | Self-adaptive control method for preventing instantaneous impact of unfolding of folding rudder of electric steering engine |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910870547.XA CN110793405B (en) | 2019-09-16 | 2019-09-16 | Self-adaptive control method for preventing instantaneous impact of unfolding of folding rudder of electric steering engine |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110793405A CN110793405A (en) | 2020-02-14 |
CN110793405B true CN110793405B (en) | 2021-10-15 |
Family
ID=69427092
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910870547.XA Active CN110793405B (en) | 2019-09-16 | 2019-09-16 | Self-adaptive control method for preventing instantaneous impact of unfolding of folding rudder of electric steering engine |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110793405B (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113221243B (en) * | 2021-05-12 | 2023-01-20 | 上海机电工程研究所 | Simulation calculation method and system for transient synchronous unfolding of aircraft folded rudder |
CN113566657B (en) * | 2021-07-30 | 2022-11-01 | 北京机械设备研究所 | Missile-borne intelligent vibration control electric steering engine and control method |
CN117537670B (en) * | 2023-06-05 | 2024-06-14 | 西安现代控制技术研究所 | Rudder distribution method for improving remote missile rudder resource utilization efficiency |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7386395B1 (en) * | 2005-01-18 | 2008-06-10 | Honeywell International Inc. | Systems and methods for shock compensation utilizing an adaptive control technique algorithm |
CN107688295A (en) * | 2017-08-29 | 2018-02-13 | 浙江工业大学 | A kind of quadrotor finite time self-adaptation control method based on fast terminal sliding formwork |
CN108667322A (en) * | 2018-05-24 | 2018-10-16 | 中车青岛四方车辆研究所有限公司 | single-phase rectifier control method and system |
CN108871103A (en) * | 2018-06-14 | 2018-11-23 | 湖北三江航天红峰控制有限公司 | A kind of miniature missile folds the delay unfolding mechanism of rudder piece |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8436283B1 (en) * | 2008-07-11 | 2013-05-07 | Davidson Technologies Inc. | System and method for guiding and controlling a missile using high order sliding mode control |
-
2019
- 2019-09-16 CN CN201910870547.XA patent/CN110793405B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7386395B1 (en) * | 2005-01-18 | 2008-06-10 | Honeywell International Inc. | Systems and methods for shock compensation utilizing an adaptive control technique algorithm |
CN107688295A (en) * | 2017-08-29 | 2018-02-13 | 浙江工业大学 | A kind of quadrotor finite time self-adaptation control method based on fast terminal sliding formwork |
CN108667322A (en) * | 2018-05-24 | 2018-10-16 | 中车青岛四方车辆研究所有限公司 | single-phase rectifier control method and system |
CN108871103A (en) * | 2018-06-14 | 2018-11-23 | 湖北三江航天红峰控制有限公司 | A kind of miniature missile folds the delay unfolding mechanism of rudder piece |
Also Published As
Publication number | Publication date |
---|---|
CN110793405A (en) | 2020-02-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110793405B (en) | Self-adaptive control method for preventing instantaneous impact of unfolding of folding rudder of electric steering engine | |
CN109884895B (en) | Unmanned aerial vehicle self-adaptive tracking control algorithm based on saturation limited condition | |
Sun et al. | Fixed-time sliding mode disturbance observer-based nonsmooth backstepping control for hypersonic vehicles | |
Ruggiero et al. | A multilayer control for multirotor UAVs equipped with a servo robot arm | |
CN110308735B (en) | Under-actuated UUV trajectory tracking sliding mode control method aiming at input time lag | |
Kendoul | Nonlinear hierarchical flight controller for unmanned rotorcraft: design, stability, and experiments | |
CN107272639B (en) | Detection, estimation and its adjusting method of rigid spacecraft reaction wheel failure | |
Kim et al. | Reinforcement learning-based optimal flat spin recovery for unmanned aerial vehicle | |
CN111176318B (en) | Positioning and swing eliminating method and system for flying and lifting system for eliminating steady-state error | |
Jiang et al. | Integral sliding mode based control for quadrotors with disturbances: Simulations and experiments | |
Liang et al. | Nonlinear control for aerial transportation systems with double-pendulum swing effects | |
CN109782787A (en) | A kind of solar light pressure assists the bimodulus MPC control method of lower drive lacking spacecraft attitude | |
CN111338369B (en) | Multi-rotor flight control method based on nonlinear inverse compensation | |
CN113110539A (en) | Elastic/arrow three-channel control method and control device based on duck rudder | |
CN110376890B (en) | Control method of two-stage pendulum flying and lifting system based on energy analysis | |
Zou et al. | Singularity-free backstepping controller for model helicopters | |
Yeh et al. | Variable structure-based nonlinear missile guidance/autopilot design with highly maneuverable actuators | |
CN112256046A (en) | Course control method for underwater vehicle | |
CN110109357B (en) | Semi-global self-adaptive control method for non-standard type non-linear aircraft | |
CN112327629A (en) | Small unmanned helicopter self-adaptive fault-tolerant control method based on dynamic compensation | |
CN112113466A (en) | Multi-missile cooperative guidance method with limited time convergence | |
CN114690793B (en) | Sliding mode control-based reusable carrier rocket vertical soft landing guidance method | |
CN111142380A (en) | Control method of position servo system for rocket gun launching during traveling | |
CN111306995B (en) | Method for designing combined controller for suppressing projectile flutter | |
Gao et al. | Event-triggered tracking control scheme for quadrotors with external disturbances: theory and validations |
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 |