CN104597909A - Flight control algorithm for coaxial double-rotor unmanned helicopter - Google Patents

Flight control algorithm for coaxial double-rotor unmanned helicopter Download PDF

Info

Publication number
CN104597909A
CN104597909A CN201410693712.6A CN201410693712A CN104597909A CN 104597909 A CN104597909 A CN 104597909A CN 201410693712 A CN201410693712 A CN 201410693712A CN 104597909 A CN104597909 A CN 104597909A
Authority
CN
China
Prior art keywords
cable
control
coaxial double
rotary wing
unmanned helicopter
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
Application number
CN201410693712.6A
Other languages
Chinese (zh)
Other versions
CN104597909B (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.)
SHENZHEN MINGXIN AVIATION TECHNOLOGY Co Ltd
Original Assignee
SHENZHEN MINGXIN AVIATION TECHNOLOGY Co Ltd
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 SHENZHEN MINGXIN AVIATION TECHNOLOGY Co Ltd filed Critical SHENZHEN MINGXIN AVIATION TECHNOLOGY Co Ltd
Priority to CN201410693712.6A priority Critical patent/CN104597909B/en
Publication of CN104597909A publication Critical patent/CN104597909A/en
Application granted granted Critical
Publication of CN104597909B publication Critical patent/CN104597909B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

In order to consider a mutual relationship of an assembly body of the coaxial double-rotor unmanned helicopter, a pay-off device and a cable as well as tension control and aircraft speed of the cable, the invention discloses a set of complete control algorithm for cable tension control and aircraft robust control, which can realize stable gesture of the unmanned helicopter on the condition of guaranteeing constant cable tension. The flight control algorithm for the coaxial double-rotor unmanned helicopter comprises the following steps: comprehensively considering the control system of the flight control system through a dynamic model of the coaxial double-rotor unmanned helicopter and a flexible cable; adopting two independent models, wherein the core dynamic model is a dynamic equation used for individually reflecting the gesture and speed characteristics of the helicopter. The model is determined to be a two-input six-output system by the control structure; based on a state variable of the model, the flight control system for coaxial double-rotor unmanned helicopter, which is of a three-layer two-loop structure, is adopted.

Description

Coaxial double-rotary wing unmanned helicopter flight control algolithm
Technical field
The present invention relates to a kind of Flight Control Algorithm, particularly a kind of Flight Control Algorithm for coaxial double-rotary wing depopulated helicopter, belongs to technical field of aerospace.
Background technology
Landing is convenient, spot hover, mobility strong because it possesses for depopulated helicopter, therefore fights of many uses, has considerable operational potential and development prospect.Carry out depopulated helicopter development country relatively early abroad and have the U.S., Britain, Canada, Germany etc.Wherein the U.S. just begins one's study depopulated helicopter the fifties in last century, and the antisubmarine RC Goblin of the QH-50A sixties makes a successful trial flight, and in Vietnam War, AUS just uses QH-50D depopulated helicopter to perform the tasks such as scouting, battlefield surveillance, artilleryman's target observation.Because unmanned helicopter flight control technology exists many difficult points, so depopulated helicopter is for fixed-wing unmanned plane, the development of technology and application is always comparatively slow.
In depopulated helicopter, coaxial double-rotary wing is a kind of important helicopter distribution form, coaxial double-rotary wing depopulated helicopter and conventional unmanned plane layout have very big difference, coaxial double-rotary wing depopulated helicopter has the two width rotors up and down around same axis positive and negative rotation, because two width rotor wing rotation directions are contrary, so its moment of torsion produced is cancelled out each other when course is constant, thus eliminate tail-rotor; Realized the directional control of depopulated helicopter by the differential operation of the total distance of upper and lower rotor, two width rotors are lifting surface and in length and breadth to the control surface with course in the flight course of helicopter simultaneously.Coaxial double-rotary wing depopulated helicopter, due to the distribution form of uniqueness, is very applicable to laying fast of optical cable one class flexible cable.Cable releasing mechanism and unmanned plane body are carried out integrated, utilizes depopulated helicopter rapid flight and vertical takeoff and landing ability, realize a maneuverability, the quick laying system of adaptable unmanned plane cable.
But want engineering to realize this system, there is following difficulty:
1) depopulated helicopter is complicated non-linear, a multi-input multi-output system
From system perspective analysis, depopulated helicopter non-linear be mainly present in the non-linear of mathematical model and topworks non-linear on.Because the nonlinear effect of rotor power characteristic is serious, the property difference of depopulated helicopter not only when different flight state is comparatively large, even and if in same state of flight, when applying manoeuvre amount, also can inspire strong nonlinearity response.Meanwhile, because the intrinsic coupling between depopulated helicopter passage is serious, the non-linear flight response not only affecting this passage of the topworks of a passage, also can have influence on the response of other passages strongly.
2) uncertainty of control object
The significant challenge that depopulated helicopter independent flight control system deviser faces is the uncertainty of how processing controls object, namely depopulated helicopter dynamics described by mathematical modeling and real system inconsistent time, how still can aircraft be controlled accurately and effectively.From the angle analysis of control system theory, depopulated helicopter independent flight control system must have very strong robustness, and concrete control algolithm and controling parameters should be weak relevant to dynamic model, for the structure of model or Parameter Perturbation insensitive.
For the depopulated helicopter of fiber cable laying, except above-mentioned difficulties, also must consider the specific question of flexible cable in laid processes.
Primary need is to the stress of cable, and namely suffered tension force accurately detects and estimates, and controls the payingoff speed of reel, and the tension force of guarantee suffered by optical cable, below setting, makes cable configuration from mechanical damage.
Secondary need controls the payingoff speed of optical cable, guarantees that optical cable is applied to the external force of coaxial double-rotary wing unmanned plane in unwrapping wire process constant.
3rd needs to optimize Flight Control Algorithm under the disturbance of flexible cable tension force, improves the flight quality of aircraft platforms, makes aircraft platforms have good handling stability
Summary of the invention
The object of the invention is the mutual relationship of coaxial double-rotary wing depopulated helicopter, actinobacillus device, this assembly of cable and the control of the tension force of cable and aircraft speed are controlled to unify to consider.The cable strain proposing complete set controls, aircraft Robust Control Algorithm, when ensureing that cable strain is constant, realizes the attitude stabilization of depopulated helicopter.And provide the specific implementation structure of controller.
First aspect present invention provides a kind of coaxial double-rotary wing unmanned helicopter flight control algolithm, and it comprises:
(1) dynamics model analysis of coaxial double-rotary wing depopulated helicopter and flexible cable
Consider the control structure of flight control system system, adopt the model that two independent, its core drive model is by the kinetics equation of the attitude and velocity characteristic of reacting separately helicopter.It is one 2 input, 6 systems exported that control structure determines this model, and its state space equation is expressed and seen formula (3.1):
x · = Ax + Bu , y = Cx - - - ( 3.1 )
In formula (3.1), u = B 1 S A 1 s ,
A condition matrix B input matrix C output matrix
Wherein: the horizontal rotor angle of flap of b---; The longitudinal rotor angle of flap of a---; P---course angle speed;
Q---pitch rate; φ---roll angle; ---the angle of pitch; v x---forward speed;
V y---side velocity; B 1s---longitudinal cyclic pitch; A 1s---horizontal cyclic pitch;
Guarantee control system design and accuracy of simulation basis on, system linearization model is:
A = - α / τ B a - α 0 0 0 0 0 A b - α / τ 0 - α 0 0 0 0 L b L a 0 0 0 0 L u L v M b M a 0 0 0 0 M u M v 0 0 α 0 0 0 0 0 0 0 0 α 0 0 0 0 0 X a 0 0 0 - g / k X u 0 Y b 0 0 0 g / k 0 0 Y v B = B a 0 0 A b 0 0 0 0 0 0 0 0 0 0 0 0 - - - ( 3.2 )
Carry out parameter identification test: first time test does not add mooring cable, and second time loads flexible cable, and aircraft forward flight speed is 5m/s; Third time test loads flexible cable, and aircraft forward flight speed is 12m/s.The result of this cubic parametric identification test is analysed and compared, finds in parameter model, τ and vehicle flight speeds positive correlation, k and percentage speed variation, the rate of change positive correlation particularly with speed in z-axis.By the test of cubic parametric identification, obtain flexible cable to the impact of unmanned aerial vehicle platform block mold.
Experimental result fully shows, the dynamic characteristic in the flight course of the unmanned plane of flexible cable is very complicated, and the model given by us obviously can not describe its whole feature completely, particularly when the attitude of unmanned helicopter platform, course change.The dynamics of flexible cable is easily subject to the impact of DCB Specimen purling, and this effect is quite remarkable under specific state.Because these disturbances are difficult to provide accurate description, this just requires that we will focus on Focus Control object model when departing from when design of control law, the validity of control algolithm.
(2) flight control system functional structure
Unmanned plane will be executed the task when unmanned the intervention, and automatic flight control system is one of indispensable link.Because structure is simple, parameter tuning is quick, and key is not high to the accuracy requirement of depopulated helicopter kinetic model, so be that the classical feedback of representative was once widely used in helicopter flight control system with PID.But will promote the flight envelope of depopulated helicopter further, complete more complicated task, this simple control strategy is incompetent.Therefore, we must the more advanced control algolithm of demand, on the basis meeting controlling functions, promotes the flight quality of depopulated helicopter.
The present invention proposes the control method of the kinetic model that is determined for formula (3.2).Based on the state variable of this model, adopt the coaxial double-rotary wing unmanned helicopter flight control system of tri-layer two loop structure, wherein inner ring is used for calm and Eulerian angle, angular speed, and the dynamics that rotor angle of flap is relevant up and down; And the yaw control channel of helicopter is set up by the Differential Control of upper and lower two rotors.
The position of the unmanned aerial vehicle platform under outer shroud control NED coordinate system, speed.Complete tension force to control to be cross-linked with the logic of flight control system simultaneously.
Prove through test, this structure is extremely successful for the control of so complicated synthesis, effectively can suppress the disturbance that the aerial compound movement pattern of flexible cable is brought.
Second aspect present invention provides a kind of cable paying-off device, it comprises framework, the framework that this framework is rectangle by two xsects integrally connects and composes, the length of the framework of two rectangles and width are all different, an i.e. large rectangle framework and a little rectangular frame, a common edge is comprised between this little rectangular frame and large rectangle framework, setting-in wire coil for optical cable in large rectangle framework, in large rectangle framework, motor is equipped with in the front portion of described wire coil for optical cable, the output shaft of this motor is connected with the wire coil shaft of described wire coil for optical cable, in described little rectangular frame by before backward successively installation tension take turns and cable guide, cable motion sensor is equipped with in the front of this cable guide, emergent cutter is equipped with in the front of this cable motion sensor, cable on described wire coil for optical cable is connected to straining pulley, also tension pick-up is housed between straining pulley and little rectangular frame, to measure the tension force of cable between wire coil for optical cable and straining pulley, namely the equipment in large rectangle framework forms payingoff mechanism, equipment in little rectangular frame forms tension control mechanism.
Preferably, described motor is direct current generator.
The working method of the cable paying-off device that second aspect present invention provides is: by control command incoming task control device, this control device controls payingoff mechanism and releases cable, tension pick-up is by parameter feedbacks such as the height of cable, speed, courses to air route maker, and the speed parameter of this air route maker and tension control mechanism controls the flight parameter of depopulated helicopter by inner ring control system; In this process, cable is outwards discharged by straining pulley 3, the direction of cable guide 4 pairs of cables play the guiding role, cable motion sensor 5 measure cable release three axle speed and as the input parameter of inner ring control system, the effect of emergent cutter 6 is when there is the out of control or fortuitous event such as cable and body generation winding of tension force, instantaneous by cable cutting by priming system, in order to avoid cause the major accidents such as air crash.
More multioperation is all known for those of ordinary skills, repeats no more.
The technical scheme of coaxial double-rotary wing unmanned helicopter flight control algolithm provided by the present invention and cable paying-off device comprises the combination in any of each part mentioned above, and simple change or the combination of each part mentioned above assembly are still protection scope of the present invention.
The control that coaxial double-rotary wing unmanned helicopter flight control algolithm provided by the present invention is the coaxial double-rotary wing depopulated helicopter laid for flexible cable provides theoretical method basis and engineering to instruct.
Accompanying drawing explanation
Fig. 1 is the stressed simplified model schematic diagram of the entirety that pulls flexible cable according to coaxial double-rotary wing depopulated helicopter of the present invention.
Fig. 2 is that cable embodiment illustrated in fig. 1 lays fast with coaxial double-rotary wing unmanned helicopter flight control system outer ring structure.
Fig. 3 is that cable embodiment illustrated in fig. 1 lays fast with ring structure in coaxial double-rotary wing unmanned helicopter flight control system.
Fig. 4 is payingoff mechanism schematic diagram embodiment illustrated in fig. 1.
Fig. 5 is inner ring controller architecture schematic diagram embodiment illustrated in fig. 1.
Fig. 6 is inertial delay switching construction embodiment illustrated in fig. 1.
Fig. 7 is the cable strain curve map of a preferred embodiment of coaxial double-rotary wing unmanned helicopter flight control algolithm of the present invention.
Fig. 8 is roll angle control effects figure embodiment illustrated in fig. 7.
Fig. 9 is angle of pitch control effects figure embodiment illustrated in fig. 7.
Figure 10 is course angle control effects figure embodiment illustrated in fig. 7.
Figure 11 is TRAJECTORY CONTROL design sketch embodiment illustrated in fig. 7.
The implication of the figure notation in Fig. 1-11 is:
1 wire coil for optical cable 2 direct current generator 3 straining pulley 4 cable guide
5 cable motion sensors 6 are met an urgent need cutter 7 tension pick-up.
Embodiment
In order to understand the present invention better, describe the preferred embodiment according to coaxial double-rotary wing unmanned helicopter flight control algolithm of the present invention respectively in detail below in conjunction with accompanying drawing.
Embodiment 1.1: coaxial double-rotary wing unmanned helicopter flight control algolithm, concrete steps are divided into following three steps: dynamic model linearization; H ∞ design of control law and the design of controller switch logic.
4.1 model linearization
By the analysis of upper joint, we think for the state equation of this assembly of coaxial double-rotary wing towing flexible cable, τ and k in its state matrix is actually the amount changed with unmanned plane during flying Parameters variation, we are when Control System Design, corresponding working point must be chosen, and carry out system linearization in this working point, thus launch the design of control.According to the duty of system reality, we select two working points in this patent, first are floating state, second are greater than 10m/s for speed.
Described in model structure as above saves: based on this inearized model, complete inner ring control design case by H ∞ control algolithm.
Known, flexible cable velocity-tension relationship affect depopulated helicopter stressed, and then affect the attitude dynamics feature of helicopter, therefore, is considered as the disturbance in inner ring control technology loop by the relation of flexible cable speed and tension force.
So this inearized model changes into
x · = Ax + Bu + Ew - - - ( 4.1 )
Wherein matrix E is interference matrix, during linearization, the value of E is under different operating point, obtained by the disturbance introducing flexible cable in longitudinal direction, interconnection, and this disturbance is obtained through algorithm for estimating by the responsive angle of cable strain, cable motion detection sensor, angle rate signal.Prove that this disturbance only affects angular speed q, p through test.
Measure and export as y=Cx=[p q φ θ v xv y] t(4.2)
The basic demand of inner ring is the control and stability ensureing attitude when flexible cable disturbs, and therefore controlled output variable is chosen as:
H out=[φ θ]=C outx (4.3)
H in=C Δx+D Δu (4.4)
C in above formula Δand D Δfor variable bound matrix, its element is weight coefficient.
4.2H ∞ design of control law
Basic requirement be minimize cable disturbance on the impact of system, namely minimize closed-loop system transfer function matrix from interference w to the H ∞ norm of controlled input Hin or Hout.
The control structure of interior ring controller as shown in Figure 5.
Obtain the expression formula of interior ring controller, first determine C Δand D Δfor variable bound entry of a matrix element, i.e. weight coefficient.Then the H ∞ performance index from exogenous disturbances w to controlled output Hin optimum is calculated
For arbitrarily the γ suboptimal control rule of H ∞ is:
u = - ( D Δ T D Δ ) - 1 ( D Δ T C Δ + B T P ) x + G ( r - h out ) - - - ( 4.5 )
Wherein r is reference input, and r=[Φ r, θ r] is produced by outer shroud control law. for feedback of status gain.
P is the calm solution of positive semidefinite of H ∞ Algebraic Riccati equations.This Riccati equation is defined as follows:
A T P + PA + C Δ T C Δ + γ - 2 PEE T P - ( PB + C Δ T D Δ ) ( D Δ T D Δ ) - 1 ( D Δ T D Δ + B T P ) = 0 - - - ( 4.6 )
G is with reference to forward direction matrix, G=-[C out(A+BF) -1b] -1(4.7).
The switch logic of 4.3 controllers
When unmanned plane hover and before fly two different operating points fly time, need the switching carrying out controller.The switch logic design of controller will ensure seamlessly transitting without step of handoff procedure exactly, wants keeping system to the tracking performance of reference input simultaneously.We adopt inertial delay changing method, and the method structure is simple, effectively can avoid the step effect in handoff procedure simultaneously.
As shown in Figure 6, wherein ua is the output of control Ka to switch logic, and ub is the output of control Kb, uses inertial delay function when switching
f(a i)=diag(a i/s+a i) (4.8)
So when being switched to ub by ua, the output after switching
u = diag ( 1 - e - a j t ) u b + diag ( e - a j t ) u a - - - ( 4.9 )
This is a combined value switching the decaying exponential function of difference, therefore can ensure the smooth of handoff procedure.
Described in the present embodiment, coaxial double-rotary wing unmanned helicopter flight control algolithm innovative point is compared with prior art:
1) design one effectively can measure optical cable cable attitude, tension force in unwrapping wire process, and complete constant tensile control active release line mechanism;
2) devise a two circuit flight control system structure of tri-layer, cable strain control to carry out with the speed of aircraft, gesture stability to unify to consider by this structure, complex optimum;
3) design and Implement the Flight Control Algorithm based on H ∞ robust control technique, effectively can suppress flexible cable disturbance in unwrapping wire process.
The result that a concrete coaxial double-rotary wing unmanned helicopter flight control algolithm realizes is as follows:
Forward flight=the 5m/s of coaxial double-rotary wing unmanned plane, wind speed average is at 7m/s, and the cable strain utilizing above-mentioned control algolithm to obtain, attitude angle, angular speed control result as shown in Fig. 7-Figure 11.
Can find out, the peak value of cable strain is controlled within 0.5N, it is limited within the scope of an acceptable to the disturbance of attitude of flight vehicle and flight path, the control effects of aircraft roll angle and the angle of pitch further proves this point, the angle of pitch that practical flight measures, roll angle and given reference value consistance are very high, through measurement and statistics, the control accuracy of attitude angle at 2 °, course angle control accuracy 3 °.The flight path control effects of aircraft as shown in figure 11.
Embodiment 1.2: a kind of cable paying-off device, it comprises framework, the framework that this framework is rectangle by two xsects integrally connects and composes, the length of the framework of two rectangles and width are all different, an i.e. large rectangle framework and a little rectangular frame, a common edge is comprised between this little rectangular frame and large rectangle framework, setting-in wire coil for optical cable 1 in large rectangle framework, in large rectangle framework, direct current generator 2 is equipped with in the front portion of described wire coil for optical cable 1, the output shaft of this direct current generator 2 is connected with the wire coil shaft of described wire coil for optical cable 1, in described little rectangular frame by before backward successively installation tension take turns 3 and cable guide 4, cable motion sensor 5 is equipped with in the front of this cable guide 4, emergent cutter 6 is equipped with in the front of this cable motion sensor 5, cable on described wire coil for optical cable 1 is connected to straining pulley 3, also tension pick-up is housed between straining pulley 3 and little rectangular frame, to measure the tension force of cable between wire coil for optical cable 1 and straining pulley 3, namely the equipment in large rectangle framework forms payingoff mechanism, equipment in little rectangular frame forms tension control mechanism.
The working method of the cable paying-off device that the present embodiment provides is: by control command incoming task control device, this control device controls payingoff mechanism and releases cable, tension pick-up is by parameter feedbacks such as the height of cable, speed, courses to air route maker, and the speed parameter of this air route maker and tension control mechanism controls the flight parameter of depopulated helicopter by inner ring control system; In this process, cable is outwards discharged by straining pulley 3, the direction of cable guide 4 pairs of cables play the guiding role, cable motion sensor 5 measure cable release rate and as the input parameter of inner ring control system, the effect of emergent cutter 6 is when there is the out of control or fortuitous event such as cable and body generation winding of tension force, instantaneous by cable cutting by priming system, in order to avoid cause the major accidents such as air crash.

Claims (9)

1. a coaxial double-rotary wing unmanned helicopter flight control algolithm, it comprises three steps: i.e. dynamic model linearization; H ∞ design of control law and the design of controller switch logic,
(1) dynamic model linearization: the dynamics model analysis of coaxial double-rotary wing depopulated helicopter and flexible cable, consider the control structure of flight control system system, adopt the model that two independent, its core drive model is by the kinetics equation of the attitude and velocity characteristic of reacting separately helicopter, control structure determine this model be one 2 input, 6 export systems, its state space equation expression formula is:
y=Cx wherein,
A condition matrix B input matrix C output matrix
The horizontal rotor angle of flap of b---; The longitudinal rotor angle of flap of a---; P---course angle speed;
Q---pitch rate; φ---roll angle; ---the angle of pitch; v x---forward speed
V y---side velocity; B 1s---longitudinal cyclic pitch; A 1s---horizontal cyclic pitch
It is characterized in that: Guarantee control system design and accuracy of simulation basis on, introduce these three corrections of τ, k and α, wherein τ and vehicle flight speeds positive correlation, k and percentage speed variation, rate of change positive correlation particularly with speed in z-axis, the introducing of these corrections, makes system linearization model simplification to be:
(2) based on above-mentioned inearized model, inner ring control design case is completed by H ∞ control algolithm:
Obtain the expression formula of interior ring controller, first determine C Δand D Δfor variable bound entry of a matrix element, i.e. weight coefficient, then calculate the H ∞ performance index from exogenous disturbances w to controlled output Hin optimum
For arbitrarily the γ suboptimal control rule of H ∞ is:
Wherein r is reference input, and r=[Φ r, θ r] is produced by outer shroud control law. for feedback of status gain.
P is the calm solution of positive semidefinite of H ∞ Algebraic Riccati equations.This Riccati equation is defined as follows:
G is with reference to forward direction matrix, G=-[C out(A+BF) -1b] -1;
(3) controller switch logic design: when unmanned plane hover and before fly two different operating points fly time, need the switching carrying out controller.The switch logic design of controller will ensure seamlessly transitting without step of handoff procedure exactly, wants keeping system to the tracking performance of reference input simultaneously; We adopt inertial delay changing method, and the method structure is simple, and effectively can avoid the step effect in handoff procedure, in switch logic, ua is the output of control Ka, and ub is the output of control Kb simultaneously, use inertial delay function when switching
f(a i)=diag(a i/s+a i)
So when being switched to ub by ua, the output after switching
This is a combined value switching the decaying exponential function of difference, therefore can ensure the smooth of handoff procedure.
2. coaxial double-rotary wing unmanned helicopter flight control algolithm as claimed in claim 1, it is characterized in that: flexible cable velocity-tension relationship affect depopulated helicopter stressed, and then affect the attitude dynamics feature of helicopter, therefore, the relation of flexible cable speed and tension force is considered as the disturbance in inner ring control technology loop, so this inearized model adopts wherein matrix E is interference matrix, during linearization, the value of E is under different operating point, obtained by the disturbance introducing flexible cable in longitudinal direction, interconnection, and this disturbance is obtained through algorithm for estimating by the responsive angle of cable strain, cable motion detection sensor, angle rate signal.
3. coaxial double-rotary wing unmanned helicopter flight control algolithm as claimed in claim 1, is characterized in that: measure and export as y=Cx=[p q φ θ v xv y] t.
4. coaxial double-rotary wing unmanned helicopter flight control algolithm as claimed in claim 1, is characterized in that: the basic demand of inner ring is the control and stability ensureing attitude when flexible cable disturbs, and therefore controlled output variable is chosen as: H out=[φ θ]=C outx, H in=C Δx+D Δu, wherein C Δand D Δfor variable bound matrix, its element is weight coefficient.
5. coaxial double-rotary wing unmanned helicopter flight control algolithm as claimed in claim 1, is characterized in that: the forward flight of coaxial double-rotary wing unmanned plane is 5m/s.
6. coaxial double-rotary wing unmanned helicopter flight control algolithm as claimed in claim 3, it is characterized in that: the peak value of cable strain is controlled within 0.5N, the control accuracy of attitude angle is 2 °, and course angle control accuracy is 3 °.
7. coaxial double-rotary wing unmanned helicopter flight control algolithm as claimed in claim 3, is characterized in that: selects two working points, and first is that floating state, second is greater than 10m/s for speed, and model structure is: y=Cx, completes inner ring control design case by H ∞ control algolithm.
8. a cable paying-off device, it comprises framework, the framework that this framework is rectangle by two xsects integrally connects and composes, the length of the framework of two rectangles and width are all different, an i.e. large rectangle framework and a little rectangular frame, a common edge is comprised between this little rectangular frame and large rectangle framework, setting-in wire coil for optical cable (1) in large rectangle framework, in large rectangle framework, motor (2) is equipped with in the front portion of described wire coil for optical cable (1), the output shaft of this motor (2) is connected with the wire coil shaft of described wire coil for optical cable (1), in described little rectangular frame by before backward successively installation tension take turns (3) and cable guide (4), it is characterized in that: cable motion sensor (5) is equipped with in the front of cable guide (4), emergent cutter (6) is equipped with in the front of this cable motion sensor (5), this cable motion sensor (5) measures the three-dimensional velocity of cable, emergent cutter (6) ensures the safety of unwrapping wire aircraft platform, cable on wire coil for optical cable (1) is connected to straining pulley (3), also tension pick-up is housed between straining pulley (3) and little rectangular frame, to measure the tension force of cable between wire coil for optical cable (1) and straining pulley (3), namely the equipment in large rectangle framework forms payingoff mechanism, equipment in little rectangular frame forms tension control mechanism, adopt coaxial double-rotary wing unmanned helicopter flight control algolithm according to claim 1.
9. the method for operating of cable paying-off device as claimed in claim 8, it comprises control command incoming task control device, this control device controls payingoff mechanism and releases cable, tension pick-up is by the height of cable, speed, the parameter feedbacks such as course are to air route maker, this air route maker, and the speed parameter of tension control mechanism controls the flight parameter of depopulated helicopter by inner ring control system, it is characterized in that: in this process, cable is outwards discharged by straining pulley (3), cable guide (4) direction to cable play the guiding role, cable motion sensor (5) measure cable release rate and as the input parameter of inner ring control system.
CN201410693712.6A 2014-11-26 2014-11-26 Coaxial double-rotary wing unmanned helicopter flight control method Active CN104597909B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410693712.6A CN104597909B (en) 2014-11-26 2014-11-26 Coaxial double-rotary wing unmanned helicopter flight control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410693712.6A CN104597909B (en) 2014-11-26 2014-11-26 Coaxial double-rotary wing unmanned helicopter flight control method

Publications (2)

Publication Number Publication Date
CN104597909A true CN104597909A (en) 2015-05-06
CN104597909B CN104597909B (en) 2017-10-17

Family

ID=53123764

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410693712.6A Active CN104597909B (en) 2014-11-26 2014-11-26 Coaxial double-rotary wing unmanned helicopter flight control method

Country Status (1)

Country Link
CN (1) CN104597909B (en)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107330152A (en) * 2017-06-01 2017-11-07 南京航空航天大学 A kind of efficient aerodynamic Calculate Ways suitable for rotor craft
CN107728468A (en) * 2017-08-16 2018-02-23 中山大学 A kind of full stabilized control method of novel Discrete for being applied to suspension load helicopter
CN108536166A (en) * 2018-04-18 2018-09-14 西安科技大学 A kind of stability Design method of multisystem small-sized depopulated helicopter
CN108919830A (en) * 2018-07-20 2018-11-30 南京奇蛙智能科技有限公司 A kind of flight control method that unmanned plane precisely lands
CN110597054A (en) * 2019-05-15 2019-12-20 浙江华奕航空科技有限公司 Linear variable parameter robustness control method for coaxial unmanned helicopter course
CN111413997A (en) * 2020-04-14 2020-07-14 中国人民解放军32180部队 High-wind-resistance tilting rotor mooring unmanned aerial vehicle and flight control method thereof
CN115291643A (en) * 2022-08-22 2022-11-04 中国船舶集团有限公司系统工程研究院 Constant tension control method and system for resistance reduction cable of shipborne mooring unmanned aerial vehicle
CN117950417A (en) * 2024-03-14 2024-04-30 天津万森科技发展有限公司 Fixed-point hovering stabilization method and equipment for multi-model double-rotor unmanned aerial vehicle

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107943070B (en) * 2017-11-01 2020-07-28 杭州睿杰智能空中机器人科技有限公司 Method for controlling active disturbance rejection flight speed and attitude of unmanned helicopter

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002189501A (en) * 2000-12-20 2002-07-05 Kawasaki Heavy Ind Ltd Method for deciding control rule of automatic control system
CN201528159U (en) * 2009-11-24 2010-07-14 龚文基 Laying system of electrical laying pilot rope of unmanned helicopter
CN103064420A (en) * 2012-12-14 2013-04-24 西北工业大学 Approaching posture coordination control method of space tether robot with movable tether point
CN202939488U (en) * 2012-12-03 2013-05-15 航宇救生装备有限公司 Automatic control system of moored hot-air airship
CN103123488A (en) * 2013-01-18 2013-05-29 西北工业大学 Coordination control method for tethered system robot system to approach target
CN103135552A (en) * 2013-01-18 2013-06-05 西北工业大学 Coordination control method of spatial rope-tying robot compounded body postures after target catching
CN103955220A (en) * 2014-04-30 2014-07-30 西北工业大学 Coordination control method for tracking optimal track by space tied-rope robot
CN104049637A (en) * 2014-04-14 2014-09-17 西北工业大学 Three-axis active posture control method for space tether-robot

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002189501A (en) * 2000-12-20 2002-07-05 Kawasaki Heavy Ind Ltd Method for deciding control rule of automatic control system
CN201528159U (en) * 2009-11-24 2010-07-14 龚文基 Laying system of electrical laying pilot rope of unmanned helicopter
CN202939488U (en) * 2012-12-03 2013-05-15 航宇救生装备有限公司 Automatic control system of moored hot-air airship
CN103064420A (en) * 2012-12-14 2013-04-24 西北工业大学 Approaching posture coordination control method of space tether robot with movable tether point
CN103123488A (en) * 2013-01-18 2013-05-29 西北工业大学 Coordination control method for tethered system robot system to approach target
CN103135552A (en) * 2013-01-18 2013-06-05 西北工业大学 Coordination control method of spatial rope-tying robot compounded body postures after target catching
CN104049637A (en) * 2014-04-14 2014-09-17 西北工业大学 Three-axis active posture control method for space tether-robot
CN103955220A (en) * 2014-04-30 2014-07-30 西北工业大学 Coordination control method for tracking optimal track by space tied-rope robot

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
周国仪 等: "共轴式直升机线性系统建模", 《飞行力学》 *
袁夏明 等: "共轴式无人直升机建模与鲁棒跟踪控制", 《控制理论与应用》 *

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107330152A (en) * 2017-06-01 2017-11-07 南京航空航天大学 A kind of efficient aerodynamic Calculate Ways suitable for rotor craft
CN107330152B (en) * 2017-06-01 2020-11-13 南京航空航天大学 Efficient pneumatic balancing method suitable for rotor craft
CN107728468A (en) * 2017-08-16 2018-02-23 中山大学 A kind of full stabilized control method of novel Discrete for being applied to suspension load helicopter
CN108536166A (en) * 2018-04-18 2018-09-14 西安科技大学 A kind of stability Design method of multisystem small-sized depopulated helicopter
CN108919830A (en) * 2018-07-20 2018-11-30 南京奇蛙智能科技有限公司 A kind of flight control method that unmanned plane precisely lands
CN110597054A (en) * 2019-05-15 2019-12-20 浙江华奕航空科技有限公司 Linear variable parameter robustness control method for coaxial unmanned helicopter course
CN111413997A (en) * 2020-04-14 2020-07-14 中国人民解放军32180部队 High-wind-resistance tilting rotor mooring unmanned aerial vehicle and flight control method thereof
CN111413997B (en) * 2020-04-14 2023-08-22 中国人民解放军32180部队 High-wind-resistance tilting rotor wing mooring unmanned aerial vehicle and flight control method thereof
CN115291643A (en) * 2022-08-22 2022-11-04 中国船舶集团有限公司系统工程研究院 Constant tension control method and system for resistance reduction cable of shipborne mooring unmanned aerial vehicle
CN115291643B (en) * 2022-08-22 2024-05-03 中国船舶集团有限公司系统工程研究院 Constant tension control method and system for drag reduction cable of shipborne mooring unmanned aerial vehicle
CN117950417A (en) * 2024-03-14 2024-04-30 天津万森科技发展有限公司 Fixed-point hovering stabilization method and equipment for multi-model double-rotor unmanned aerial vehicle
CN117950417B (en) * 2024-03-14 2024-06-18 天津万森科技发展有限公司 Fixed-point hovering stabilization method and equipment for multi-model double-rotor unmanned aerial vehicle

Also Published As

Publication number Publication date
CN104597909B (en) 2017-10-17

Similar Documents

Publication Publication Date Title
CN104597909A (en) Flight control algorithm for coaxial double-rotor unmanned helicopter
CN100501624C (en) Electric flight control system for aircraft elevators
CN102591358B (en) Multi-UAV (unmanned aerial vehicle) dynamic formation control method
CN106444430B (en) The sub grade Reentry control system of carrier rocket one and method, analogue system and method
Oh et al. Rendezvous and standoff target tracking guidance using differential geometry
CN109471454B (en) Terminal guidance segment entering method of micro operation aircraft with designated attack inclination angle
CN111045450B (en) Double-formation team formation process guidance method for fixed-wing unmanned aerial vehicle
CN110889170B (en) Method for estimating falling angle and attack angle of large-angle attack target of aircraft
CN102163059A (en) Attitude control system and attitude control method of variable thrust unmanned aerial vehicle
CN107121940B (en) Four-degree-of-freedom semi-physical simulation platform for parafoil
CN104648695A (en) Heeling-angle-availability-based optimal planning method of reentry corridor
CN105739513A (en) Quadrotor flying robot non-linear trajectory tracking controller and tracking control method thereof
Munoz et al. Robust nonlinear real-time control strategy to stabilize a PVTOL aircraft in crosswind
CN109703769B (en) Air refueling docking control method based on preview strategy
CN204342167U (en) The cable actinobacillus device of coaxial double-rotary wing depopulated helicopter
JP2011051470A (en) Simple manual flight operation system of unmanned flying body
Bekar et al. High fidelity progressive reinforcement learning for agile maneuvering UAVs
Zhou et al. A simple reentry trajectory generation and tracking scheme for common aero vehicle
Sanchez et al. Nonlinear and optimal real-time control of a rotary-wing UAV
CN113885358B (en) Hybrid configuration fixed wing unmanned aerial vehicle maneuver simulation control law design method
CN110209179A (en) A kind of prompt high track algorithm of hypersonic aircraft
Yue et al. Suggested closed-loop response characteristics for tanker in aerial refueling via mission-oriented evaluation
Tang et al. Homing on a moving dock for a quadrotor vehicle
Kim et al. Design of 6-dof attitude controller of hovering model helicopter
Nowak et al. The selected innovative solutions in UAV control systems technologies

Legal Events

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