CN108037764A - A kind of unmanned helicopter active disturbance rejection flight position control method - Google Patents

A kind of unmanned helicopter active disturbance rejection flight position control method Download PDF

Info

Publication number
CN108037764A
CN108037764A CN201711055319.4A CN201711055319A CN108037764A CN 108037764 A CN108037764 A CN 108037764A CN 201711055319 A CN201711055319 A CN 201711055319A CN 108037764 A CN108037764 A CN 108037764A
Authority
CN
China
Prior art keywords
disturbance rejection
controller
active disturbance
channel
fal
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
CN201711055319.4A
Other languages
Chinese (zh)
Other versions
CN108037764B (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.)
Hangzhou Ruijie Intelligent Air Robot Technology Co ltd
Original Assignee
Individual
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 Individual filed Critical Individual
Priority to CN201711055319.4A priority Critical patent/CN108037764B/en
Publication of CN108037764A publication Critical patent/CN108037764A/en
Application granted granted Critical
Publication of CN108037764B publication Critical patent/CN108037764B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions 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/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
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability

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 present invention relates to unmanned aerial vehicle (UAV) control field, specifically a kind of unmanned helicopter active disturbance rejection flight position control method.The present invention includes interconnection control, vertical passage control, altitude channel control, and each passage control process comprises the following steps:According to the position of unmanned helicopter, observation state amount and expansion state amount are obtained;Inputted according to controller, observation state amount and expansion state amount, the controller for obtaining each passage export.The coupling of each interchannel of present system can be considered as disturbing, and automatic disturbance rejection controller can be by the disturbance estimation of extended state observer and disturbance compensation, by its coupling counters.The invention is a kind of Non-Model Controller, and the accurate model of controlled device is not required in it, but relies on error to control.

Description

Active disturbance rejection flight position control method for unmanned helicopter
Technical Field
The invention relates to the field of unmanned aerial vehicle control, in particular to an active disturbance rejection flight position control method for an unmanned helicopter.
Background
The flight control system of the unmanned helicopter mainly comprises two parts, wherein the first part is a speed and attitude control system and is mainly responsible for stability augmentation, so that the unmanned helicopter is in a stable state under the condition that external conditions are not changed and is the basis for the autonomous flight of the aircraft, and the second part is a position control system and is used for controlling the flight path of the aircraft so that the unmanned helicopter can fly according to a route or a waypoint given by a user.
Attitude control and speed control of traditional helicopter flight control generally use a classical control theory as a theoretical basis, and a PID (proportion integration differentiation) controller is used as a controller for control. PID is a model-free controller that can control only according to the error of the controlled variable, so that the controlled object can be regarded as a black box with only input and output when designing a control system based on the PID controller. Just because the PID control technology is based on using errors to control the errors, the PID control technology can occupy the dominance in practical engineering application without a complex mathematical modeling process. However, since the PID control technique is an early control technique, it is affected by the theoretical level and the technical level of the development times, and there is no advanced digital computer and various digital signal processing techniques using the digital computer when designing the PID, the PID control technique at that time enters the control project with many "unsatisfactory defects" at present, and completes most of the control tasks excellently, thereby occupying an important position in the field of the control project.
The following four defects of the PID control technology are overcome: the control effect of the original error generated by directly subtracting e (t) -v (t) -y (t) as the input of the controller is not ideal; input of differential elementThere is no good algorithm to compute; linear combinations are not necessarily the best way to combine; integral of error signal e (t) -There are many negative effects of the introduction of (c). Clearly, the drawbacks of the above four aspects are all the problems that arise in the large environment in which PID appears that year. Under the conditions of advanced digital signal processing, more means are provided for overcoming the defects. The process control idea of reducing errors by carrying out the essence of the PID control technology, namely errors, utilizes the modern advanced digital signal processing technology and reasonably develops the special nonlinear effect to discuss the process of overcoming the defects of the four aspects of the PID control technology, and the novel practical digital control technology, namely the active disturbance rejection control technology, is promoted.
Disclosure of Invention
Aiming at the defects in the prior art, the invention aims to provide an active disturbance rejection flight position control method of an unmanned helicopter.
The technical scheme adopted by the invention for realizing the purpose is as follows: an active disturbance rejection flight position control method of an unmanned helicopter comprises transverse channel control, longitudinal channel control and height channel control, wherein each channel control process comprises the following steps:
obtaining an observation state quantity and an expansion state quantity according to the position of the unmanned helicopter;
and obtaining the controller output of each channel according to the controller input, the observation state quantity and the expansion state quantity.
The longitudinal channel control comprises the following steps:
position x of x-axis direction under computer body coordinate systemb
xb=xecosψ+yesinψ
Wherein x iseAnd yeThe positions of the unmanned helicopter in the X-axis and Y-axis directions under a ground coordinate system are respectively, and psi is a yaw angle;
observed state quantity is z1=z1+h(z2-c1e+u);
The amount of expansion state is z2=z2+h(-d1fe);
Wherein h is a control period, and e is z1-xbFe is fal (e,0.5, h), fal () is the fal function, u is the output of the active disturbance rejection controller for the vertical channel, z is the output of the active disturbance rejection controller for the vertical channel1And z2Is 0;
the output of the active disturbance rejection controller of the longitudinal channel is u- β1fal(e111)-z2
Wherein e is1=x′b-z1,x′bInput to the active disturbance rejection controller for the longitudinal channel, representing the target distance to the forward flight, α1,β1,δ1Are controller parameters related to the model of the unmanned helicopter.
The cross channel control comprises the steps of:
calculating the position x of the unmanned helicopter in the y-axis directionb
yb=xesinψ+yecosψ
Wherein,xeand yeThe positions of the unmanned helicopter in the X-axis and Y-axis directions under a ground coordinate system are respectively, and psi is a yaw angle;
observed state quantity is z1=z1+h(z2-c1e+u);
The amount of expansion state is z2=z2+h(-d1fe);
Wherein h is a control period, and e is z1-ybFe is fal (e,0.5, h), fal () is the fal function, u is the output of the active disturbance rejection controller for the cross-channel, z is the output of the active disturbance rejection controller for the cross-channel1And z2Is 0;
the output of the active disturbance rejection controller of the cross channel is u- β1fal(e111)-z2
Wherein e is1=y′b-z1,y′bInput to the active disturbance rejection controller for the cross-channel, representing the target distance of the side flight, α1,β1,δ1Are controller parameters related to the model of the unmanned helicopter.
The height channel control comprises the following steps:
observed state quantity is z1=z1+h(z2-c1e+u);
The amount of expansion state is z2=z2+h(-d1fe);
Wherein h is a control period, and e is z1-zeFe is fal (e,0.5, h), fal () is the fal function, u is the output of the active disturbance rejection controller for the vertical channel, z is the output of the active disturbance rejection controller for the vertical channeleFor the position of the unmanned helicopter in the Z-axis direction under the ground coordinate system, Z1And z2Is 0;
the output of the active disturbance rejection controller of the longitudinal channel is u- β1fal(e111)-z2
Wherein e is1=z′b-z1,z′bInput to the active disturbance rejection controller for the altitude channel, representing the target distance to fly vertically, α1,β1,δ1Are controller parameters related to the model of the unmanned helicopter.
The coupling between the channels of the system can be regarded as disturbance, and the coupling can be counteracted by the active disturbance rejection controller through the disturbance estimation and the disturbance compensation of the extended state observer. The invention is a modeless controller that does not require an accurate model of the controlled object, but relies on error for control.
Drawings
FIG. 1 is a block diagram of the present invention;
FIG. 2 is a diagram of simulation results of an active disturbance rejection controller;
FIG. 3 is a diagram of PID controller simulation results;
FIG. 4 is a graph of the output of the active disturbance rejection controller;
fig. 5 is a graph of the output of a PID controller.
Detailed Description
The present invention will be described in further detail with reference to the accompanying drawings and examples.
The position control system synthesizes the waypoint targets given by the user, plans a proper route, converts the proper route into a proper speed instruction and issues the speed instruction to each channel. Since the waypoints given by the user are usually coordinate information in the ground coordinate system, the position control system should plan a reasonable flight pattern.
Position controller under the organism coordinate system: the feedback information of the position controller is different from that of the speed and attitude controller, the feedback is not feedback under a body coordinate system, but is a coordinate system after a ground coordinate system rotates through a yaw angle, and an XOY plane of the coordinate system is still horizontal to the ground, so that the flying distance is ensured to be stable relative to the ground. The original northeast waypoint information can be conveniently converted into instructions of flying a few meters ahead and adjusting the course and then sent to a speed control system.
As shown in fig. 1, the position controller has three channels, which correspond to the three channels of the velocity controller, i.e., the longitudinal direction, the lateral direction, and the height, respectively. The algorithm for the longitudinal channel is as follows
xb=xecosψ+yesinψ
e=z1-xb
fe=fal(e,0.5,h)
z1=z1+h(z2-c1e+u)
z2=z2+h(-d1fe)
e1=x′b-z1
u=β1fal(e111)-z2
Wherein, x'bThe controller inputs are, u is the output.
The algorithm for the transverse channel is as follows
yb=xesinψ+yecosψ
e=z1-yb
fe=fal(e,0.5,h)
z1=z1+h(z2-c1e+u)
z2=z2+h(-d1fe)
e1=y′b-z1
u=β1fal(e111)-z2
Wherein y'bIs the controller input and u is the output.
The algorithm for the altitude channel is as follows:
e=z1-ze
fe=fal(e,0.5,h)
z1=z1+h(z2-c1e+u)
z2=z2+h(-d1fe)
e1=z′b-z1
u=β1fal(e111)-z2
wherein z'bIs the controller input and u is the output.
Of the above formulas, α1,β1,δ1As controller parameters, α1,β1,δ1In a simulated embodiment of the algorithm of the present invention applied for controller parameters related to model of unmanned helicopter α1、β1、δ1Respectively taken as 1, 0.5 and 0.001.
In order to clearly embody the advantages of the active disturbance rejection controller, the simplest second-order integral model is used to compare the control effects of the active disturbance rejection controller and the PID controller, as shown in FIGS. 2-5.

Claims (4)

1. An active disturbance rejection flight position control method of an unmanned helicopter is characterized by comprising transverse channel control, longitudinal channel control and height channel control, wherein each channel control process comprises the following steps:
obtaining an observation state quantity and an expansion state quantity according to the position of the unmanned helicopter;
and obtaining the controller output of each channel according to the controller input, the observation state quantity and the expansion state quantity.
2. The unmanned helicopter active disturbance rejection flight position control method of claim 1, wherein the longitudinal channel control comprises the steps of:
position x of x-axis direction under computer body coordinate systemb
xb=xecosψ+yesinψ
Wherein x iseAnd yeThe positions of the unmanned helicopter in the X-axis and Y-axis directions under a ground coordinate system are respectively, and psi is a yaw angle;
observed state quantity is z1=z1+h(z2-c1e+u);
The amount of expansion state is z2=z2+h(-d1fe);
Wherein h is a control period, and e is z1-xbFe is fal (e,0.5, h), fal () is the fal function, u is the output of the active disturbance rejection controller for the vertical channel, z is the output of the active disturbance rejection controller for the vertical channel1And z2Is 0;
the output of the active disturbance rejection controller of the longitudinal channel is u- β1fal(e111)-z2
Wherein e is1=xb′-z1,xb' input to the active disturbance rejection controller for longitudinal channel, representing target distance to fly ahead, α1,β1,δ1Are controller parameters related to the model of the unmanned helicopter.
3. The unmanned helicopter active disturbance rejection flight position control method of claim 1, wherein the lateral channel control comprises the steps of:
calculating the position x of the unmanned helicopter in the y-axis directionb
yb=xesinψ+yecosψ
Wherein x iseAnd yeThe positions of the unmanned helicopter in the X-axis and Y-axis directions under a ground coordinate system are respectively, and psi is a yaw angle;
observed state quantity is z1=z1+h(z2-c1e+u);
The amount of expansion state is z2=z2+h(-d1fe);
Wherein h is a control period, and e is z1-ybFe is fal (e,0.5, h), fal () is the fal function, u is the output of the active disturbance rejection controller for the cross-channel, z is the output of the active disturbance rejection controller for the cross-channel1And z2Is 0;
the output of the active disturbance rejection controller of the cross channel is u- β1fal(e111)-z2
Wherein e is1=yb′-z1,yb' input to the active disturbance rejection controller for the lateral channel, representing the target distance for the side flight, α1,β1,δ1Are controller parameters related to the model of the unmanned helicopter.
4. The method of claim 1, wherein the altitude passage control comprises the steps of:
observed state quantity is z1=z1+h(z2-c1e+u);
The amount of expansion state is z2=z2+h(-d1fe);
Wherein h is a control period, and e is z1-zeFe is fal (e,0.5, h), fal () is the fal function, u is the output of the active disturbance rejection controller for the vertical channel, z is the output of the active disturbance rejection controller for the vertical channeleFor the position of the unmanned helicopter in the Z-axis direction under the ground coordinate system, Z1And z2Is 0;
the output of the active disturbance rejection controller of the longitudinal channel is u- β1fal(e111)-z2
Wherein e is1=zb′-z1,zb' input to the active disturbance rejection controller for altitude channel, representing target distance to fly vertically, α1,β1,δ1Are controller parameters related to the model of the unmanned helicopter.
CN201711055319.4A 2017-11-01 2017-11-01 Active disturbance rejection flight position control method for unmanned helicopter Active CN108037764B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201711055319.4A CN108037764B (en) 2017-11-01 2017-11-01 Active disturbance rejection flight position control method for unmanned helicopter

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201711055319.4A CN108037764B (en) 2017-11-01 2017-11-01 Active disturbance rejection flight position control method for unmanned helicopter

Publications (2)

Publication Number Publication Date
CN108037764A true CN108037764A (en) 2018-05-15
CN108037764B CN108037764B (en) 2021-02-23

Family

ID=62093650

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201711055319.4A Active CN108037764B (en) 2017-11-01 2017-11-01 Active disturbance rejection flight position control method for unmanned helicopter

Country Status (1)

Country Link
CN (1) CN108037764B (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108549406A (en) * 2018-05-18 2018-09-18 沈阳无距科技有限公司 Helicopter course heading control method, device and readable storage medium storing program for executing
CN109709810A (en) * 2019-01-22 2019-05-03 天津大学 All directionally movable robot track following model-free Auto-disturbance-rejection Control

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003259393A (en) * 2002-03-01 2003-09-12 Sony Corp Encoding apparatus, decoding apparatus, method, and computer program
CN102830622A (en) * 2012-09-05 2012-12-19 北京理工大学 Auto-disturbance-rejection automatic flight control method for four-rotor aircraft
CN103411479A (en) * 2013-08-01 2013-11-27 北京理工大学 Sliding mode and active disturbance rejection based composite control method of tank gun controlling system
CN104635743A (en) * 2013-11-13 2015-05-20 中国电子科技集团公司第二十七研究所 Minimum altitude full-course autonomous flight control system of high-speed unmanned aerial vehicle
CN104865968A (en) * 2015-04-22 2015-08-26 浙江工业大学 Quad-rotor aircraft hovering control method employing cascade auto disturbances rejection control technology
CN104898429A (en) * 2015-05-27 2015-09-09 北京工业大学 Tri-rotor attitude control method based on auto-disturbance rejection controller
CN105912009A (en) * 2016-06-16 2016-08-31 浙江工业大学 Four-rotor aircraft control method based on pole allocation and fuzzy active disturbance rejection control technology
CN106842953A (en) * 2017-03-13 2017-06-13 贾杰 A kind of depopulated helicopter self adaptation lower order controller
CN107272408A (en) * 2017-06-13 2017-10-20 华南理工大学 A kind of power planning method in small-sized depopulated helicopter flight control

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003259393A (en) * 2002-03-01 2003-09-12 Sony Corp Encoding apparatus, decoding apparatus, method, and computer program
CN102830622A (en) * 2012-09-05 2012-12-19 北京理工大学 Auto-disturbance-rejection automatic flight control method for four-rotor aircraft
CN103411479A (en) * 2013-08-01 2013-11-27 北京理工大学 Sliding mode and active disturbance rejection based composite control method of tank gun controlling system
CN104635743A (en) * 2013-11-13 2015-05-20 中国电子科技集团公司第二十七研究所 Minimum altitude full-course autonomous flight control system of high-speed unmanned aerial vehicle
CN104865968A (en) * 2015-04-22 2015-08-26 浙江工业大学 Quad-rotor aircraft hovering control method employing cascade auto disturbances rejection control technology
CN104898429A (en) * 2015-05-27 2015-09-09 北京工业大学 Tri-rotor attitude control method based on auto-disturbance rejection controller
CN105912009A (en) * 2016-06-16 2016-08-31 浙江工业大学 Four-rotor aircraft control method based on pole allocation and fuzzy active disturbance rejection control technology
CN106842953A (en) * 2017-03-13 2017-06-13 贾杰 A kind of depopulated helicopter self adaptation lower order controller
CN107272408A (en) * 2017-06-13 2017-10-20 华南理工大学 A kind of power planning method in small-sized depopulated helicopter flight control

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
TAO NIU,等: "Based on ADRC UAV longitudinal pitching Angle control research", 《2016 INFORMATION TECHNOLOGY,NETWORKING,ELECTRONIC AND AUTOMATION CONTROL CONFERENCE,IEEE》 *
周驰: "基于系统辨识的小型无人直升机建模及控制器设计", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 *
贾杰,刘智腾: "基于Qt的小型无人机地面站软件设计与实现", 《计算机与现代化》 *
贾杰,陈焕强: "基于DSP的无人机飞控系统的硬件设计", 《传感检测及物联网系统》 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108549406A (en) * 2018-05-18 2018-09-18 沈阳无距科技有限公司 Helicopter course heading control method, device and readable storage medium storing program for executing
CN108549406B (en) * 2018-05-18 2021-10-15 沈阳无距科技有限公司 Helicopter course control method and device and readable storage medium
CN109709810A (en) * 2019-01-22 2019-05-03 天津大学 All directionally movable robot track following model-free Auto-disturbance-rejection Control
CN109709810B (en) * 2019-01-22 2022-03-15 天津大学 Model-free active disturbance rejection control method for track tracking of all-directional mobile robot

Also Published As

Publication number Publication date
CN108037764B (en) 2021-02-23

Similar Documents

Publication Publication Date Title
CN105676641B (en) The design method of Nonlinear Robust Controller based on contragradience and sliding formwork control
Liu et al. Tracking control of small-scale helicopters using explicit nonlinear MPC augmented with disturbance observers
CN105786024B (en) A kind of airborne photoelectric platform high precision tracking controller and its tracking and controlling method based on Compensation for Model Errors
CN106774400B (en) Unmanned aerial vehicle three-dimensional track guidance method based on inverse dynamics
CN107390531B (en) The hypersonic aircraft control method of parameter learning finite time convergence control
CN107943070B (en) Method for controlling active disturbance rejection flight speed and attitude of unmanned helicopter
CN105159306A (en) Four-rotor aircraft sliding-mode control method based on global stability
CN111258231A (en) Autonomous aerial refueling and docking semi-physical system imitating visual navigation of prey birds and method thereof
Le Bras et al. Approach maneuvers for autonomous landing using visual servo control
Kim et al. Landing control on a mobile platform for multi-copters using an omnidirectional image sensor
CN103569353A (en) Method and device for aiding the management of the flight of an aircraft
Lee et al. Obstacle avoidance using image-based visual servoing integrated with nonlinear model predictive control
CN104536448B (en) Backstepping based control method for unmanned-plane attitude system
CN105759609B (en) A kind of carrier-borne aircraft autonomous landing on the ship method based on explicit non-linear Model Predictive Control
CN104199303A (en) Stratospheric satellite planar path tracking control method based on vector field guidance
Mills et al. Vision based control for fixed wing UAVs inspecting locally linear infrastructure using skid-to-turn maneuvers
CN105116914A (en) Stratospheric-airship-analytic-model-based prediction path tracking control method
CN108037764B (en) Active disturbance rejection flight position control method for unmanned helicopter
Liang et al. Active disturbance rejection attitude control for a bird-like flapping wing micro air vehicle during automatic landing
Rigatos et al. Input–output linearizing control of the underactuated hovercraft using the derivative-free nonlinear kalman filter
Yang et al. A decentralised control strategy for formation flight of unmanned aerial vehicles
CN115145313B (en) Method for predicting and correcting moving target track in real time
CN116301058A (en) Unmanned flight feedback nonlinear yaw control method, system and equipment
Gu et al. Autonomous formation flight–design and experiments
CN113110428A (en) Carrier-based aircraft landing fixed time trajectory tracking method based on limited backstepping control

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
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20210201

Address after: 311121 Room 401, Building 9, 1818-2 Wenyi West Road, Yuhang Street, Hangzhou City, Zhejiang Province

Applicant after: HANGZHOU RUIJIE INTELLIGENT AIR ROBOT TECHNOLOGY Co.,Ltd.

Address before: 330038 Room 202, Building 2, 696 Fenghe South Avenue, Honggutan New District, Nanchang City, Jiangxi Province

Applicant before: Jia Jie

GR01 Patent grant
GR01 Patent grant