CN108427430A - Quadrotor control method based on network-control - Google Patents

Quadrotor control method based on network-control Download PDF

Info

Publication number
CN108427430A
CN108427430A CN201810275951.8A CN201810275951A CN108427430A CN 108427430 A CN108427430 A CN 108427430A CN 201810275951 A CN201810275951 A CN 201810275951A CN 108427430 A CN108427430 A CN 108427430A
Authority
CN
China
Prior art keywords
control
rotor aircraft
rotor
network control
quad
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.)
Pending
Application number
CN201810275951.8A
Other languages
Chinese (zh)
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.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
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 Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN201810275951.8A priority Critical patent/CN108427430A/en
Publication of CN108427430A publication Critical patent/CN108427430A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The quadrotor control method based on network-control that the invention discloses a kind of, for solving to there is technical issues that in quadrotor control, it is first location subsystem and posture subsystem by quadrotor model decomposition, it is directed to influence of the communication delay to posture subsystem stability simultaneously, it is proposed delay compensation scheme, and using the system model of the tool boxes Truetime setup delay compensation scheme, and the scheme of proposition is verified.By simulating, verifying, network-control, which is applied to, has certain feasibility and validity in the quadrotor flight control system under communication delay.

Description

Four-rotor aircraft control method based on network control
Technical Field
The invention relates to a control method of a four-rotor aircraft, in particular to a control method of a four-rotor aircraft based on network control.
Background
In the unmanned aerial vehicle field, four rotor crafts have can hover, low in cost, small, can low-altitude flight, noise is low, control advantage such as nimble. Therefore, the method has wide application in military and civil fields, such as: pesticide spraying, aerial photography, safety patrol, traffic supervision, earthquake rescue and the like.
Because the state of the aircraft cannot be monitored on the aircraft body by an operator of the aircraft, the flight state of the aircraft can only be monitored on the ground and the flight task of the aircraft can only be controlled, the ground station is responsible for monitoring various flight data and flight states of the aircraft by establishing a two-way communication link, and meanwhile, an instruction input interface is provided for ground personnel, so that the operator can send various instruction data to the aircraft. Aircraft for collecting ground or ambient data encounter a wide variety of complex environments where parameters change and problems arise that interfere with the communication between the aircraft and the ground station, all of which reduce the flight stability of the aircraft to a greater or lesser extent.
The four-rotor aircraft and the ground station are communicated through wireless signals, the accuracy of the system positioning of the four-rotor aircraft is directly influenced by the strength of the wireless signals, the wireless signals are lossy in air, and various obstacles can reflect and refract the wireless signals, so that communication time delay inevitably exists in the whole system, the requirement on real-time performance of the four-rotor unmanned aerial vehicle is high, and in order to accurately control the motion of the four-rotor aircraft, the attitude control without time delay is necessary. To achieve accurate pose estimation for a quad-rotor aircraft, communication delays of various durations in the system need to be compensated. In the existing method, the problem of communication delay between the quad-rotor aircraft and the ground station in various working environments is rarely considered, so that the unmanned aerial vehicle is difficult to realize in remote control and task execution.
Disclosure of Invention
The purpose of the invention is as follows: aiming at the problems, the invention provides a control method of a four-rotor aircraft based on network control, which is used for solving the technical problem of time delay in the control of the four-rotor aircraft.
The technical scheme is as follows: in order to realize the purpose of the invention, the technical scheme adopted by the invention is as follows: a control method of a four-rotor aircraft based on network control comprises the following steps:
(1) establishing a dynamic model of the four-rotor aircraft;
(2) decoupling into an attitude subsystem and a position subsystem, and designing a state space model for each channel of the subsystems;
(3) each state space model constructs a state feedback controller with a communication time delay condition;
(4) constructing an event trigger mechanism, wherein the trigger time in the controller is updated when the event trigger mechanism is met;
(5) solving a sufficient condition for realizing stable control of an event trigger mechanism under the communication time delay;
(6) constructing a state feedback gain matrix which meets sufficient conditions;
(7) and building a network control system model based on the TrueTime toolbox.
In the step (1), the kinetic model is as follows:
wherein x, y and z represent coordinate values in a ground coordinate system; phi, theta and psi respectively represent roll angle, pitch angle and yaw angle; u. ofth,uφ,uθ,uψRespectively representing virtual control input quantities in vertical, roll, pitch and yaw directions; g represents acceleration due to gravity; m represents the mass of the quad-rotor aircraft; i isxx,Iyy,IzzRespectively representing inertia moment of inertia of a roll shaft, a pitch shaft and a yaw shaft; kt,KmRespectively representing a lift coefficient and a drag coefficient; l represents the four-rotor arm length.
In the step (3), the state feedback controller with communication delay is:
u(t)=Kx(t),K<0
where K is the state feedback gain.
In the step (4), the event triggering mechanism is as follows:
wherein omega123Is a positive definite symmetric constant matrix, α and β are event trigger coefficients and are positive values.
Has the advantages that: the invention has the following beneficial effects:
(1) according to the invention, data communication is limited through the trigger condition, so that the calculation load and the communication frequency of the four-rotor flight control system are reduced, the network transmission load is reduced, and the problem that the four-rotor remote control relying on real-time continuous information exchange in the prior art is difficult to implement in practical application is solved;
(2) according to the invention, through analyzing the upper and lower bounds of the communication time delay, the sufficient condition for controlling the four-rotor flight control system in the form of a linear matrix inequality under the communication time delay is obtained, and the problem that only the time delay is considered in the prior art is solved;
(3) the four-rotor aircraft dynamic model is decomposed into a position subsystem and an attitude subsystem, the time delay problem of each channel of the subsystem is controlled, and the accuracy of model network control is improved;
(4) the gain of the state feedback controller is established by a linear matrix inequality, which is easier to be verified by advanced algorithm and can reduce conservative of conclusion.
Drawings
FIG. 1 is a flow chart of a four-rotor aircraft control method based on network control of the present invention;
FIG. 2 is a control block diagram of a four-rotor aircraft flight system according to the method of the present invention;
FIG. 3 is a diagram of a simulation model of a quad-rotor attitude subsystem in the practice of the present invention;
FIG. 4 shows simulation results of a four-rotor aircraft attitude subsystem model under time delay in the implementation process of the invention.
Detailed Description
The technical solution of the present invention is further described below with reference to the accompanying drawings and examples.
Fig. 1 is a flow chart of a control method of a four-rotor aircraft based on network control according to the invention, and fig. 2 is a control block diagram of a system of the four-rotor aircraft. The invention discloses a control method of a four-rotor aircraft based on network control, which comprises the following steps:
(1) a dynamic model of the four-rotor aircraft is established, and the specific form is as follows:
wherein six state variables [ x, y, z, phi, theta, psi are included]T(ii) a x, y and z represent coordinate values in a ground coordinate system; phi, theta and psi respectively represent roll angle, pitch angle and yaw angle; u. ofth,uφ,uθ,uψRespectively representing virtual control input quantities in vertical, roll, pitch and yaw directions; g represents acceleration due to gravity; m represents the mass of the quad-rotor aircraft; i isxx,Iyy,IzzRespectively representing inertia moment of inertia of a roll shaft, a pitch shaft and a yaw shaft; kt,KmRespectively representing a lift coefficient and a drag coefficient; l represents the four-rotor arm length.
Four virtual control inputs uth,uφ,uθ,uψ]TIs defined as follows:
wherein u is1,u2,u3,u4Representing the PWM input generated by the motor on each rotor.
(2) Decomposing according to a double closed-loop control algorithm to obtain an inner loop attitude subsystem and an outer loop position subsystem, designing a state space model for each channel of each subsystem, and defining roll angles as an exampleThe subsystem of roll angle is then:
wherein,C=[1 0]。
(3) and designing a state feedback controller with a communication time delay condition according to the state space model of each channel so as to be stable.
Let the communication time delay be tau (t) and satisfy 0 < tau (t) to taumIn which τ ismWhich is an upper bound on the communication delay.
The expression for the state feedback controller with communication delay condition is as follows:
u(t)=Kx(t),K<0
where K is the state feedback gain.
(4) And constructing an event trigger mechanism, wherein the trigger time in the controller is updated when the event trigger mechanism is met.
(4.1) the error vector is constructed as:
eφ(ikh)=xφ((tk+s)h)-xφ(tkh),
wherein h is the sampling period of the sensor; x is the number ofφ(tkh) And xφ((tk+ s) h) respectively represent the most recently transmitted system state value of the event trigger and the state value currently sampled by the sensor.
(4.2) the novel event triggering mechanism is designed as follows:
wherein omega123Is a positive definite symmetric constant matrix, αAnd β are event trigger coefficients and are positive values.
(5) Solving the sufficient condition for realizing stable control of the event trigger mechanism under the communication time delay;
the following sufficient conditions are obtained by integrating the Linear Matrix Inequality (LMI) and the communication time-varying characteristic, so that the four-rotor flight control time delay system is stable:
wherein, the expression of the elements in the LMI is as follows:
Γ=[0 BKC 0 BK]
wherein e isi,P,Qi,Ri,M,Mi,NiiAre suitably dimensioned matrices and satisfy:
except for zero, the elements of the matrix Ω are:
Ω11=Q1mR2-0.25π2M-M3+γM2-1.5R4,
Ω13=0.25π2M+M3-γM1-πM2+ATN21,11=Ω2,12=Ω3,13=1.5R4,
Ω1,14=ATN122=-π(Q1-Q2)-1.5(R3+R4),Ω28=Ω39=Ω4,10=1.5R3,
Ω58=Ω69=Ω7,10=3R35,11=Ω6,12=Ω7,13=3R488=Ω99=Ω10,10=-4.5R3,
Ω15,15=αΦ21
(6) constructing a state feedback gain matrix K ═ Z-1L, the matrices Z and L satisfy the following linear matrix inequality:
wherein, the expression of the elements in the LMI is as follows:
Π1=[0 B 0 B 0],Γ1=[0 L 0 L]
wherein, P, Qi,Ri,Xi,NiZ, L, J are matrices of appropriate dimensions.
(7) And (3) aiming at each channel state space model of the four-rotor flight control system, a simulation platform based on a TrueTime toolbox is built. Fig. 3 is a simulation model diagram of the four-rotor attitude subsystem based on network control. As can be seen from fig. 4, when the communication delay existing in the network is considered, it can be seen that an overshoot phenomenon exists in the response process, the steady-state error is small, the system attitude control performance is not greatly affected, and the expected effect is achieved.
A network control system model is built by utilizing a TrueTime simulation tool box, tracking information of an expected attitude angle and an actual attitude angle is obtained according to a random time delay value, feasibility judgment can be carried out on the method, communication time delay is introduced into the four-rotor flight control system, the value of the maximum allowable time delay upper bound is improved by analyzing the upper bound and the lower bound of the communication time delay, and meanwhile, when the time delay change rate is 0, the time delay is constant, so the method has wider application field.

Claims (4)

1. A control method of a four-rotor aircraft based on network control is characterized in that: the method comprises the following steps:
(1) establishing a dynamic model of the four-rotor aircraft;
(2) decoupling into an attitude subsystem and a position subsystem, and designing a state space model for each channel of the subsystems;
(3) each state space model constructs a state feedback controller with a communication time delay condition;
(4) constructing an event trigger mechanism, wherein the trigger time in the controller is updated when the event trigger mechanism is met;
(5) solving a sufficient condition for realizing stable control of an event trigger mechanism under the communication time delay;
(6) constructing a state feedback gain matrix which meets sufficient conditions;
(7) and building a network control system model based on the TrueTime toolbox.
2. The network control-based quad-rotor aircraft control method of claim 1, wherein: in the step (1), the kinetic model is as follows:
wherein x, y and z represent coordinate values in a ground coordinate system; phi, theta and psi respectively represent roll angle, pitch angle and yaw angle; u. ofth,uφ,uθ,uψRespectively representing virtual control input quantities in vertical, roll, pitch and yaw directions; g represents acceleration due to gravity; m represents the mass of the quad-rotor aircraft; i isxx,Iyy,IzzRespectively representing inertia moment of inertia of a roll shaft, a pitch shaft and a yaw shaft; kt,KmRespectively representing a lift coefficient and a drag coefficient; l represents the four-rotor arm length.
3. The network control-based quad-rotor aircraft control method of claim 2, wherein: in the step (3), the state feedback controller with communication delay is:
u(t)=Kx(t),K<0
where K is the state feedback gain.
4. A method of controlling a quad-rotor aircraft based on network control according to claim 3, wherein: in the step (4), the event triggering mechanism is as follows:
wherein omega123Is a positive definite symmetric constant matrix, α and β are event trigger coefficients and are positive values.
CN201810275951.8A 2018-03-30 2018-03-30 Quadrotor control method based on network-control Pending CN108427430A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810275951.8A CN108427430A (en) 2018-03-30 2018-03-30 Quadrotor control method based on network-control

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810275951.8A CN108427430A (en) 2018-03-30 2018-03-30 Quadrotor control method based on network-control

Publications (1)

Publication Number Publication Date
CN108427430A true CN108427430A (en) 2018-08-21

Family

ID=63159563

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810275951.8A Pending CN108427430A (en) 2018-03-30 2018-03-30 Quadrotor control method based on network-control

Country Status (1)

Country Link
CN (1) CN108427430A (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109471448A (en) * 2018-12-27 2019-03-15 西北工业大学 One kind being based on event driven flexible spacecraft attitude control method
CN109976361A (en) * 2019-03-14 2019-07-05 天津大学 Quadrotor drone attitude control method towards event triggering
CN110471308A (en) * 2019-07-17 2019-11-19 南京航空航天大学 Aeroengine distributed control system simulation model modeling method based on TrueTime
CN112034733A (en) * 2020-08-17 2020-12-04 广东工业大学 City simulation method of quad-rotor unmanned aerial vehicle based on Unity3D
CN113031644A (en) * 2021-02-06 2021-06-25 中南大学 Communication time lag oriented aircraft formation control system event triggering method, device and medium
CN115544673A (en) * 2022-11-28 2022-12-30 四川腾盾科技有限公司 Method for assisting in taking off and landing of large unmanned aerial vehicle
CN116227151A (en) * 2023-01-06 2023-06-06 华东理工大学 Universal estimation method and device for four-rotor unmanned aerial vehicle system

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102929135A (en) * 2012-10-10 2013-02-13 西北工业大学 Method for designing controller for aircraft time lagging and varying model
CN103116280A (en) * 2013-01-16 2013-05-22 北京航空航天大学 Microminiature unmanned aerial vehicle longitudinal control method with random delay of distributed network
CN105204341A (en) * 2015-09-25 2015-12-30 西安石油大学 Robust tracking control method of network control system based on switching control theory
CN107357301A (en) * 2017-07-12 2017-11-17 南京邮电大学 The UAV Attitude synchronous method without angular velocity measurement based on random delay

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102929135A (en) * 2012-10-10 2013-02-13 西北工业大学 Method for designing controller for aircraft time lagging and varying model
CN103116280A (en) * 2013-01-16 2013-05-22 北京航空航天大学 Microminiature unmanned aerial vehicle longitudinal control method with random delay of distributed network
CN105204341A (en) * 2015-09-25 2015-12-30 西安石油大学 Robust tracking control method of network control system based on switching control theory
CN107357301A (en) * 2017-07-12 2017-11-17 南京邮电大学 The UAV Attitude synchronous method without angular velocity measurement based on random delay

Non-Patent Citations (6)

* Cited by examiner, † Cited by third party
Title
LI T,等: "Improved approaches on adaptive event-triggered output feedback control of networked control systems", 《JOURNAL OF THE FRANKLIN INSTITUTE》 *
凌金福: "四旋翼飞行器飞行控制算法的研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *
刘同其: "四旋翼飞行器非线性容错控制方法研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *
李雯: "飞行器网络控制系统研究", 《中国博士学位论文全文数据库 信息科技辑》 *
沈杨杨,等: "一种小型倾转四旋翼飞行器的轨迹控制", 《HTTP://KNS.CNKI.NET/KCMS/DETAIL/23.1191.U.20171026.0848.012.HTML》 *
赵玥,等: "四旋翼无人飞行器控制算法设计", 《计算机工程与应用》 *

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109471448A (en) * 2018-12-27 2019-03-15 西北工业大学 One kind being based on event driven flexible spacecraft attitude control method
CN109976361A (en) * 2019-03-14 2019-07-05 天津大学 Quadrotor drone attitude control method towards event triggering
CN109976361B (en) * 2019-03-14 2022-03-25 天津大学 Event-triggering-oriented four-rotor unmanned aerial vehicle attitude control method
CN110471308A (en) * 2019-07-17 2019-11-19 南京航空航天大学 Aeroengine distributed control system simulation model modeling method based on TrueTime
WO2021008163A1 (en) * 2019-07-17 2021-01-21 南京航空航天大学 Simulation model modeling method of aircraft engine distributed control system based on truetime
CN112034733A (en) * 2020-08-17 2020-12-04 广东工业大学 City simulation method of quad-rotor unmanned aerial vehicle based on Unity3D
CN113031644A (en) * 2021-02-06 2021-06-25 中南大学 Communication time lag oriented aircraft formation control system event triggering method, device and medium
CN115544673A (en) * 2022-11-28 2022-12-30 四川腾盾科技有限公司 Method for assisting in taking off and landing of large unmanned aerial vehicle
CN116227151A (en) * 2023-01-06 2023-06-06 华东理工大学 Universal estimation method and device for four-rotor unmanned aerial vehicle system

Similar Documents

Publication Publication Date Title
CN108427430A (en) Quadrotor control method based on network-control
Das et al. Dynamic inversion with zero-dynamics stabilisation for quadrotor control
He et al. A Simple Attitude Control of Quadrotor Helicopter Based on Ziegler‐Nichols Rules for Tuning PD Parameters
CN111273688B (en) Four-rotor unmanned aerial vehicle consistency formation control method based on event triggering
Jithu et al. Quadrotor modelling and control
La Civita et al. Design and flight testing of a high-bandwidth h-infinity loop shaping controller for a robotic helicopter
dos Santos et al. Design of attitude and path tracking controllers for quad-rotor robots using reinforcement learning
Cheng et al. Neural-networks control for hover to high-speed-level-flight transition of ducted fan uav with provable stability
Abdelmaksoud et al. Practical real-time implementation of a disturbance rejection control scheme for a twin-rotor helicopter system using intelligent active force control
Liang et al. Active disturbance rejection attitude control for a bird-like flapping wing micro air vehicle during automatic landing
Chen et al. Adaptive attitude control for a coaxial tilt-rotor UAV via immersion and invariance methodology
Yu et al. Compensating aerodynamics of over-actuated multi-rotor aerial platform with data-driven iterative learning control
Wang et al. Control of quadrotor slung load system based on double ADRC
CN117452859A (en) Control system and method for autonomous flight aircraft
Matouk et al. Bond Graph Model-Based Control of the Quadcopter Dynamics
Tang et al. Second-order sliding mode attitude controller design of a small-scale helicopter
dos Santos et al. Nonlinear tracking and aggressive maneuver controllers for quad-rotor robots using learning automata
Gu et al. Autonomous formation flight–design and experiments
Béjar et al. Modeling and control of autonomous helicopters
Liu et al. Robust trajectory tracking control of uncertain quadrotors without linear velocity measurements
Weiser et al. In-flight validation of a robust flight controller featuring anti-windup compensation
Mazlan et al. The design of an automatic flight control system and dynamic simulation for fixed-wing unmanned aerial vehicle (UAV) using X-Plane and LabVIEW
Roy Horizontal position control of a small scale helicopter using adaptive backstepping controller
Mohamed et al. Sliding mode controller design for a flying quadrotor with simplified action planner
Wang et al. Integrated 3‐D flight trajectory tracking control with aerodynamic constraints on attitude and control surfaces

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
RJ01 Rejection of invention patent application after publication

Application publication date: 20180821

RJ01 Rejection of invention patent application after publication