CN116301058A - Unmanned flight feedback nonlinear yaw control method, system and equipment - Google Patents
Unmanned flight feedback nonlinear yaw control method, system and equipment Download PDFInfo
- Publication number
- CN116301058A CN116301058A CN202310525748.2A CN202310525748A CN116301058A CN 116301058 A CN116301058 A CN 116301058A CN 202310525748 A CN202310525748 A CN 202310525748A CN 116301058 A CN116301058 A CN 116301058A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- feedback
- deviation
- nonlinear
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 51
- 238000004364 calculation method Methods 0.000 claims abstract description 24
- 238000012546 transfer Methods 0.000 claims abstract description 8
- 239000004973 liquid crystal related substance Substances 0.000 claims description 24
- 238000013461 design Methods 0.000 claims description 13
- 230000008569 process Effects 0.000 claims description 13
- 238000004590 computer program Methods 0.000 claims description 6
- 238000006243 chemical reaction Methods 0.000 claims description 5
- 238000013016 damping Methods 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000010276 construction Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 abstract description 3
- 238000005516 engineering process Methods 0.000 description 9
- 230000000694 effects Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000004044 response Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000011217 control strategy Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
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 invention discloses an unmanned aerial vehicle feedback nonlinear yaw control method, system and equipment, belonging to the technical field of unmanned aerial vehicle flight control, wherein the method comprises the following steps: calculating to obtain the current heading distance deviation of the unmanned aerial vehicle; calculating to obtain the current track angle deviation of the unmanned aerial vehicle; establishing a nonlinear state equation of course distance deviation and course angle deviation; converting the nonlinear state equation into a linear system; according to the transfer characteristic of the linear system, constructing state feedback according to the course distance deviation and the course angle deviation, so as to convert the linear system into a closed-loop control system; calculating to obtain a state feedback coefficient; calculating to obtain the state feedback; according to the state feedback, a roll angle real-time instruction is obtained through calculation and is sent to control equipment of the unmanned aerial vehicle for yaw control. The invention can quickly and accurately realize the yaw control of the unmanned aerial vehicle by establishing a feedback closed-loop control system for tracking the course distance deviation and the track angle deviation of the unmanned aerial vehicle in real time.
Description
Technical Field
The invention belongs to the technical field of unmanned aerial vehicle flight control, and particularly relates to an unmanned aerial vehicle flight feedback nonlinear yaw control method, system and equipment.
Background
Unmanned vehicles are widely applied, and the unmanned vehicles autonomously complete flight control according to planned flight path tasks, wherein yaw track control realizes the track tracking in the yaw direction by generating roll angle control instructions through an autonomous control system according to real-time position deviation.
In the traditional unmanned aerial vehicle yaw control, a PID control strategy based on transverse position deviation is mainly adopted, and in order to meet the control response index requirement, a PID system of a deviation signal needs to be subjected to repeated iteration parameter adjustment in the design process, and the parameter adjustment process often needs a designer to have better engineering experience, consumes longer time and sometimes cannot obtain better tracking effect.
Disclosure of Invention
The invention provides a unmanned aerial vehicle feedback nonlinear yaw control method, a system and equipment, which are used for solving the problems of long time consumption and poor tracking effect of the existing unmanned aerial vehicle yaw control technology. The invention can quickly and accurately realize the yaw control of the unmanned aerial vehicle by establishing a feedback closed-loop control system for tracking the distance deviation and the track angle deviation of the aerial vehicle in real time.
The invention is realized by the following technical scheme:
an unmanned aerial feedback nonlinear yaw control method, the control method comprising:
according to the current position coordinates of the unmanned aerial vehicle and the corresponding route coordinates, calculating to obtain the current heading distance deviation of the unmanned aerial vehicle;
according to the speed of the unmanned aerial vehicle in the flight altitude plane, calculating to obtain the current track angle deviation of the unmanned aerial vehicle;
establishing a nonlinear state equation of the course distance deviation and the track angle deviation;
converting the nonlinear state equation into a linear system;
according to the transfer characteristic of the linear system, constructing state feedback according to the course distance deviation and the track angle deviation, so as to convert the linear system into a closed-loop control system;
calculating to obtain a state feedback coefficient according to the design index of the closed-loop control system;
calculating to obtain the state feedback according to the state feedback coefficient;
according to the state feedback, a roll angle real-time instruction is obtained through calculation and is sent to control equipment of the unmanned aerial vehicle for yaw control.
Compared with the existing technology for realizing the yaw control of the unmanned aerial vehicle by adopting the PID control strategy of the transverse position deviation, the technology has higher engineering experience requirements on related personnel, long time consumption, incapability of guaranteeing the tracking effect and the like, and the control technology provided by the invention can quickly and accurately realize the yaw control of the unmanned aerial vehicle by establishing a feedback closed-loop control system for tracking the heading distance deviation and the track angle deviation of the unmanned aerial vehicle in real time; meanwhile, the resolving process in the control technology provided by the invention can be realized only according to the system design parameters, has low engineering experience requirements on related personnel, is convenient for popularization and application of the technology, and provides technical support and data support for the flight safety of unmanned aerial vehicles.
As a preferred embodiment, the present invention sets the coordinates of the P point of the current position of the unmanned aerial vehicle as
The route starting point coordinate corresponding to the current position P point is +.>
The route end point coordinate corresponding to the current position P point is +.>
The current heading distance deviation of the unmanned aerial vehicle is obtained through the following calculation:
in the method, in the process of the invention,
。
as a preferred embodiment, the invention takes the plane velocity vector of the flying height of the unmanned aerial vehicle as
The current track angle deviation of the unmanned aerial vehicle is obtained through the following calculation:
in the method, in the process of the invention,
，/>
for the route end coordinates +.>
Vector representation of +.>
For the starting point coordinates of the route->
Is the modulus of the vector.
As a preferred embodiment, the nonlinear state equation established by the present invention is:
in the method, in the process of the invention,
acceleration of gravity, ++>
Is thattTime of flight speed,/->
Is thattRoll angle of moment->
Is thattHeading distance deviation of time,/>
Is thattTrack angular deviation of time.
As a preferred embodiment, the method of the invention is introduced
Simultaneously taking
The linear system of conversion is then:
wherein, the liquid crystal display device comprises a liquid crystal display device,
is thattStatus feedback of time of day->
Is->
Is transformed into->
And (5) the system deviation is brought.
As a preferred embodiment, the state feedback constructed by the present invention is:
the established state equation of the closed-loop control system is as follows:
wherein, the liquid crystal display device comprises a liquid crystal display device,
for the state quantity->
Is thattCourse distance deviation coefficient of moment,/>
Is thattThe track angle deviation coefficient at the moment;
the characteristic polynomial of the closed-loop control system is as follows:
in the method, in the process of the invention,
for Laplace operator>
And->
Damping ratio and natural frequency of the closed loop control system, respectively.
As a preferred embodiment, the present invention calculates, according to the design index of the closed-loop control system, a state feedback coefficient, which is respectively:
in a preferred embodiment, according to the state feedback coefficient, the state feedback is calculated as:
wherein, the liquid crystal display device comprises a liquid crystal display device,
is thattStatus feedback of time of day->
Is thattHeading distance deviation of time,/>
Is thattTrack angle deviation of time of day, +.>
Is thattCourse distance deviation coefficient of moment,/>
Is thattThe track angle deviation coefficient at the moment;
and then, according to the relation between the state feedback and the roll angle, calculating to obtain a roll angle real-time instruction.
In a second aspect, the present invention proposes an unmanned flight feedback nonlinear yaw control system, the control system comprising:
a first calculation unit: according to the current position coordinates of the unmanned aerial vehicle and the corresponding route coordinates, calculating to obtain the current heading distance deviation of the unmanned aerial vehicle;
a second calculation unit: according to the speed of the unmanned aerial vehicle in the flight altitude plane, calculating to obtain the current track angle deviation of the unmanned aerial vehicle;
a state equation construction unit: establishing a nonlinear state equation of the course distance deviation and the track angle deviation;
a conversion unit: converting the nonlinear state equation into a linear system;
closed loop control unit: and constructing state feedback according to the transfer characteristic of the linear system by using the heading distance deviation and the track angle deviation: thereby converting the linear system into a closed loop control system;
a third calculation unit: calculating a state feedback coefficient according to the design index of the closed-loop control system, and calculating the state feedback according to the state feedback coefficient;
and a calculation unit: according to the state feedback, a roll angle real-time instruction is obtained through calculation and is sent to control equipment of the unmanned aerial vehicle for yaw control.
In a third aspect the invention proposes an on-board electronic device comprising a memory storing a computer program and a processor implementing the steps of the control method according to the invention as described above when said computer program is executed by said processor.
The invention has the following advantages and beneficial effects:
1. according to the invention, a nonlinear state equation is established by utilizing real-time flight parameters of the unmanned aerial vehicle, the nonlinear state equation is converted into a linear system, and a closed-loop control system with course distance deviation and track angle deviation as state feedback is established, so that a roll angle real-time instruction can be quickly calculated according to design indexes of the system, and yaw control of the unmanned aerial vehicle can be quickly and accurately realized.
2. According to the invention, the real-time roll angle instruction can be obtained by calculation only according to the design index of the system, the engineering experience requirement on a designer is low, and the cost is reduced.
Drawings
The accompanying drawings, which are included to provide a further understanding of embodiments of the invention and are incorporated in and constitute a part of this application, illustrate embodiments of the invention. In the drawings:
fig. 1 is a flowchart of a control method according to an embodiment of the present invention.
Fig. 2 is a real-time parameter relationship during the flight of an unmanned aerial vehicle according to an embodiment of the present invention.
Fig. 3 is a block diagram of a linear system transfer function according to an embodiment of the present invention.
Fig. 4 is a schematic block diagram of a control system according to an embodiment of the present invention.
Detailed Description
For the purpose of making apparent the objects, technical solutions and advantages of the present invention, the present invention will be further described in detail with reference to the following examples and the accompanying drawings, wherein the exemplary embodiments of the present invention and the descriptions thereof are for illustrating the present invention only and are not to be construed as limiting the present invention.
Examples:
the engineering experience requirements of related designers are higher and the time consumption is longer for the existing unmanned aerial vehicle yaw control technology; sometimes, a good tracking effect cannot be obtained, and the control accuracy is poor. Based on this, this embodiment proposes an unmanned aerial feedback nonlinear yaw control method, in the flight process of an aircraft, the change of aerodynamic force, centrifugal force and the like can cause the nonlinear response of the change of the yaw angle of the aircraft, so that the nonlinear control technology is adopted to accurately model and control the dynamic response of the aircraft, so that the yaw motion of the aircraft can be controlled more accurately and reliably, and meanwhile, the nonlinear control technology can also better process uncertainty factors (such as wind direction, load and the like) affecting the yaw motion of the aircraft, and improve the robustness and reliability of yaw control, so that the nonlinear control method adopting course distance deviation and track angle deviation as feedback control parameters is provided in this embodiment: the method specifically utilizes real-time parameters in the flight process of the unmanned aerial vehicle to establish a nonlinear state equation, and converts the state equation into a closed-loop control system taking course distance deviation and track angle deviation as state feedback, so that a roll angle real-time instruction can be obtained by quick and accurate calculation according to design indexes of the system, yaw control of the unmanned aerial vehicle is effectively realized, and control precision, robustness and adaptability are improved.
As shown in fig. 1, the method proposed in this embodiment includes the following steps:
Specifically, when the unmanned aerial vehicle flies on the route, the coordinates of the P point of the current position can be set as
The route coordinates corresponding to the current position P point can be defined by +.>
(i.e. route start point coordinates) and +.>
(i.e., route end coordinates) composition, as shown in FIG. 2, the vertical distance of the current position to the track is calculated +.>
Namely, the current heading distance deviation of the unmanned aerial vehicle is calculated by the following steps:
wherein, the liquid crystal display device comprises a liquid crystal display device,
。
it should be noted that, the track of the unmanned aerial vehicle is planned in advance, and the track may be formed by a plurality of segments of the track, so in this embodiment, one segment of the track is represented by a line segment formed by the coordinates of the starting point and the coordinates of the ending point of the track.
The current position coordinates of the unmanned aerial vehicle can be obtained in real time according to a GPS (Global positioning System) and other positioning devices on the unmanned aerial vehicle, and the head-tail coordinates of the route corresponding to the current position of the unmanned aerial vehicle can be directly obtained from a pre-planned route instruction stored on the unmanned aerial vehicle.
And 2, calculating to obtain the current track angle deviation of the unmanned aerial vehicle according to the speed in the plane of the flying height of the unmanned aerial vehicle.
In particular, the in-plane velocity vector of the unmanned aerial vehicle may be expressed as
As shown in fig. 2, the current track angular deviation calculating method is expressed as:
wherein, the liquid crystal display device comprises a liquid crystal display device,
，/>
for the route end coordinates +.>
Vector representation of +.>
For the starting point coordinates of the route->
Vector representation of->
Is the difference between the coordinate vector of the route end point and the coordinate vector of the route starting point, and I.S. is the modulus of the vector.
And 3, establishing a nonlinear state equation of the course distance deviation and the course angle deviation.
The unmanned aerial vehicle course control realizes yaw control by rolling to generate lateral force, so that the embodiment establishes a state equation of course distance deviation and track angle deviation, expressed as:
wherein, the liquid crystal display device comprises a liquid crystal display device,
acceleration of gravity, ++>
Is thattTime of flight speed,/->
Is thattRoll angle of moment->
Is thattHeading distance deviation of time,/>
Is->
Differential of->
Is thattTrack angle deviation of time of day, +.>
Is->
Is a derivative of (a).
And 4, converting the nonlinear state equation into a linear system.
The state equation of the course distance deviation and the course angle deviation is a nonlinear equation, so the embodiment introduces
At the same time due to->
Smaller, thus->
Thereby converting the above state equation into a linear system, specifically expressed as:
wherein, the liquid crystal display device comprises a liquid crystal display device,
is thattStatus feedback of time of day->
Is->
Is transformed into->
The resulting systematic deviation, the open loop transfer function block diagram of the linear system is shown in fig. 3.
And 5, establishing a closed-loop control system with the heading distance deviation and the track angle deviation as state feedback and a state equation thereof according to the linear system.
Specifically, according to the open loop transfer characteristic of the linear system, a state feedback is constructed by using the course distance deviation and the course angle deviation, so that the linear system is converted into a closed loop control system, and the state feedback is expressed as:
the state equation of the closed-loop control system established in this embodiment is as follows:
wherein, the liquid crystal display device comprises a liquid crystal display device,
for the state quantity->
Is->
Differential of->
And->
Is thattThe state feedback coefficient of the moment (in particular, +.>
Is the heading distance deviation coefficient>
Is the track angular deviation coefficient).
The characteristic polynomials of the system are:
；
wherein, the liquid crystal display device comprises a liquid crystal display device,
for Laplace operator>
And->
The damping ratio and the natural frequency of the system are respectively determined by the system control design index.
And step 6, calculating to obtain a state feedback coefficient according to the design index of the closed-loop control system.
According to the damping ratio and the natural frequency of the closed-loop control system, the state feedback coefficients are calculated, and are respectively:
and 7, calculating to obtain state feedback according to the calculated state feedback coefficient.
The embodiment obtains the state feedback coefficient according to the calculation, namely
And->
Calculating to obtain state feedback, namely:
and 8, according to the calculated state feedback, calculating to obtain a roll angle real-time instruction and sending the roll angle real-time instruction to control equipment of the unmanned aerial vehicle for yaw control.
The embodiment obtains state feedback according to the calculation, namely
Resolving to obtain real-time instructions of roll angles
。
The embodiment also provides an unmanned aerial feedback nonlinear yaw control system, and specifically as shown in fig. 4, the system provided in the embodiment includes:
the first calculation unit is used for acquiring the current position coordinates of the unmanned aerial vehicle and the corresponding route coordinates thereof, and calculating to obtain the current course distance deviation of the unmanned aerial vehicle according to the acquired coordinate data.
And the second calculation unit is used for calculating the current track angle deviation of the unmanned aerial vehicle according to the in-plane speed of the flying height of the unmanned aerial vehicle.
And the state equation construction unit is used for establishing a nonlinear state equation of the course distance deviation and the course angle deviation.
And the conversion unit is used for converting the nonlinear state equation into a linear system.
And the closed-loop control unit establishes a closed-loop control equation with the heading distance deviation and the track angle deviation as state feedback and a state equation thereof according to the linear system.
And the third calculation unit is used for calculating a state feedback coefficient according to the design index of the closed-loop control system and obtaining state feedback according to the state feedback coefficient.
And the calculating unit is used for calculating a roll angle real-time instruction according to the state feedback and sending the roll angle real-time instruction to the control equipment of the unmanned aerial vehicle for yaw control.
The embodiment also provides an onboard electronic device for executing the method of the embodiment.
The on-board electronic device may employ a computer device including a processor, a memory, and a system bus; various device components, including memory and processors, are connected to the system bus. A processor is a piece of hardware used to execute computer program instructions by basic arithmetic and logical operations in a computer system. Memory is a physical device used to temporarily or permanently store computing programs or data (e.g., program state information). The system bus may be any of several types of bus structures including a memory bus or memory controller, a peripheral bus, and a local bus. The processor and the internal memory may communicate data via a system bus. Where internal memory includes Read Only Memory (ROM) or flash memory, and Random Access Memory (RAM), which generally refers to the main memory loaded with an operating system and computer programs.
It should be noted that other computer systems including more or fewer subsystems than computer devices may also be suitable for use with the invention.
As described in detail above, the computer apparatus adapted to the present embodiment can perform the specified operation of the yaw control method. The computer device performs these operations in the form of software instructions that are executed by a processor in a computer-readable medium. The software instructions may be read into memory from a storage device or from another device via a lan interface. The software instructions stored in the memory cause the processor to perform the method of processing group member information described above. Furthermore, the invention may be implemented by means of hardware circuitry or by means of combination of hardware circuitry and software instructions. Thus, implementation of the present embodiments is not limited to any specific combination of hardware circuitry and software.
The foregoing description of the embodiments has been provided for the purpose of illustrating the general principles of the invention, and is not meant to limit the scope of the invention, but to limit the invention to the particular embodiments, and any modifications, equivalents, improvements, etc. that fall within the spirit and principles of the invention are intended to be included within the scope of the invention.
Claims (10)
1. An unmanned aerial feedback nonlinear yaw control method, the control method comprising:
according to the current position coordinates of the unmanned aerial vehicle and the corresponding route coordinates, calculating to obtain the current heading distance deviation of the unmanned aerial vehicle;
according to the speed of the unmanned aerial vehicle in the flight altitude plane, calculating to obtain the current track angle deviation of the unmanned aerial vehicle;
establishing a nonlinear state equation of the course distance deviation and the track angle deviation;
converting the nonlinear state equation into a linear system;
according to the transfer characteristic of the linear system, constructing state feedback according to the course distance deviation and the track angle deviation, so as to convert the linear system into a closed-loop control system;
calculating to obtain a state feedback coefficient according to the design index of the closed-loop control system;
calculating to obtain the state feedback according to the state feedback coefficient;
according to the state feedback, a roll angle real-time instruction is obtained through calculation and is sent to control equipment of the unmanned aerial vehicle for yaw control.
2. The unmanned aerial feedback nonlinear yaw control method of claim 1, wherein the coordinates of the P point of the current position of the unmanned aerial vehicle are set as
The route starting point coordinate corresponding to the current position P point is +.>
The route end point coordinate corresponding to the current position P point is +.>
The current heading distance deviation of the unmanned aerial vehicle is obtained through the following calculation:
in the method, in the process of the invention,
。
3. the unmanned aerial vehicle feedback nonlinear yaw control method of claim 2, wherein the unmanned aerial vehicle altitude in-plane velocity vector is set to be
The current track angle deviation of the unmanned aerial vehicle is obtained through the following calculation:
in the method, in the process of the invention,
，/>
for the route end coordinates +.>
Vector representation of +.>
For the starting point coordinates of the route->
Is the modulus of the vector.
4. The unmanned aerial feedback nonlinear yaw control method of claim 1, wherein the nonlinear state equation established is:
in the method, in the process of the invention,
acceleration of gravity, ++>
Is thattTime of flight speed,/->
Is thattRoll angle of moment->
Is thattHeading distance deviation of time,/>
Is thattTrack angular deviation of time.
5. The unmanned aerial feedback nonlinear yaw control method of claim 4, wherein the method is introduced
Taking->
The linear system of conversion is then:
wherein, the liquid crystal display device comprises a liquid crystal display device,
is thattStatus feedback of time of day->
Is->
Is transformed into->
And (5) the system deviation is brought.
6. The unmanned aerial feedback nonlinear yaw control method of claim 5, wherein the constructed state feedback is:
the established state equation of the closed-loop control system is as follows:
wherein, the liquid crystal display device comprises a liquid crystal display device,
for the state quantity->
Is thattCourse distance deviation coefficient of moment,/>
Is thattThe track angle deviation coefficient at the moment;
the characteristic polynomial of the closed-loop control system is as follows:
in the method, in the process of the invention,
for Laplace operator>
And->
Damping ratio and natural frequency of the closed loop control system, respectively.
7. The unmanned aerial vehicle feedback nonlinear yaw control method of claim 6, wherein the state feedback coefficients are calculated according to the design index of the closed-loop control system, and are respectively:
8. the unmanned aerial vehicle feedback nonlinear yaw control method of claim 1, wherein the calculating the state feedback according to the state feedback coefficient is:
wherein, the liquid crystal display device comprises a liquid crystal display device,
is thattStatus feedback of time of day->
Is thattHeading distance deviation of time,/>
Is thattTrack angle deviation of time of day, +.>
Is thattCourse distance deviation coefficient of moment,/>
Is thattThe track angle deviation coefficient at the moment;
and then, according to the relation between the state feedback and the roll angle, calculating to obtain a roll angle real-time instruction.
9. An unmanned flight feedback nonlinear yaw control system, the control system comprising:
a first calculation unit: according to the current position coordinates of the unmanned aerial vehicle and the corresponding route coordinates, calculating to obtain the current heading distance deviation of the unmanned aerial vehicle;
a second calculation unit: according to the speed of the unmanned aerial vehicle in the flight altitude plane, calculating to obtain the current track angle deviation of the unmanned aerial vehicle;
a state equation construction unit: establishing a nonlinear state equation of the course distance deviation and the track angle deviation;
a conversion unit: converting the nonlinear state equation into a linear system;
closed loop control unit: and constructing state feedback according to the transfer characteristic of the linear system by using the heading distance deviation and the track angle deviation: thereby converting the linear system into a closed loop control system;
a third calculation unit: calculating a state feedback coefficient according to the design index of the closed-loop control system, and calculating the state feedback according to the state feedback coefficient;
and a calculation unit: according to the state feedback, a roll angle real-time instruction is obtained through calculation and is sent to control equipment of the unmanned aerial vehicle for yaw control.
10. An on-board electronic device comprising a memory and a processor, the memory storing a computer program, characterized in that the processor implements the steps of the method of any of claims 1-8 when the computer program is executed.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202310525748.2A CN116301058B (en) | 2023-05-11 | 2023-05-11 | Unmanned flight feedback nonlinear yaw control method, system and equipment |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202310525748.2A CN116301058B (en) | 2023-05-11 | 2023-05-11 | Unmanned flight feedback nonlinear yaw control method, system and equipment |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN116301058A true CN116301058A (en) | 2023-06-23 |
| CN116301058B CN116301058B (en) | 2023-08-04 |
Family
ID=86796154
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202310525748.2A Active CN116301058B (en) | 2023-05-11 | 2023-05-11 | Unmanned flight feedback nonlinear yaw control method, system and equipment |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN116301058B (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117073473A (en) * | 2023-10-17 | 2023-11-17 | 中国空气动力研究与发展中心空天技术研究所 | Missile view angle planning guidance method and system based on time constraint |
Citations (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6573486B1 (en) * | 2002-02-22 | 2003-06-03 | Northrop Grumman Corporation | Projectile guidance with accelerometers and a GPS receiver |
| US20120095621A1 (en) * | 2009-03-26 | 2012-04-19 | Ohio University | Trajectory tracking flight controller |
| US20140114505A1 (en) * | 2012-02-27 | 2014-04-24 | Textron Innovations Inc. | Yaw Damping System And Method For Aircraft |
| CN106773689A (en) * | 2016-12-16 | 2017-05-31 | 西北工业大学 | AUV formation cooperative control methods based on layered distribution type Model Predictive Control |
| CN107315345A (en) * | 2017-06-23 | 2017-11-03 | 华南农业大学 | Take aim at based on double antenna GNSS and in advance the agricultural machinery self-navigation control method of tracing model |
| US20180057163A1 (en) * | 2016-08-24 | 2018-03-01 | Princess Sumaya University For Technology | Unmanned aerial vehicle |
| CN107844123A (en) * | 2017-10-11 | 2018-03-27 | 中国空气动力研究与发展中心计算空气动力研究所 | A kind of Nonlinear Flight device flight tracking control method |
| US20190033892A1 (en) * | 2017-07-27 | 2019-01-31 | Intel Corporation | Trajectory tracking controllers for rotorcraft unmanned aerial vehicles (uavs) |
| US20210072770A1 (en) * | 2019-09-06 | 2021-03-11 | Samsung Electronics Co., Ltd. | Multi-sensor-based unmanned aerial vehicle and method for controlling same |
| CN112947572A (en) * | 2021-03-12 | 2021-06-11 | 华南理工大学 | Terrain following-based four-rotor aircraft self-adaptive motion planning method |
| CN113126644A (en) * | 2021-06-03 | 2021-07-16 | 北京理工大学 | Unmanned aerial vehicle three-dimensional track tracking method based on adaptive line-of-sight method |
| US20220107160A1 (en) * | 2020-10-02 | 2022-04-07 | United States Of America, As Represented By The Secretary Of The Navy | Glide Trajectory Optimization for Aerospace Vehicles |
| CN114510076A (en) * | 2022-02-10 | 2022-05-17 | 中国人民解放军战略支援部队信息工程大学 | Target collaborative detection and guidance integrated method and system based on unscented transformation |
| CN114610068A (en) * | 2022-03-16 | 2022-06-10 | 广州极飞科技股份有限公司 | Unmanned aerial vehicle control method, device, equipment and storage medium |
| CN114877891A (en) * | 2022-06-16 | 2022-08-09 | 东南大学 | Course initial alignment method based on angle parameterization |
| CN115344056A (en) * | 2022-10-17 | 2022-11-15 | 中国空气动力研究与发展中心空天技术研究所 | Intelligent flight control method and application of aircraft with complex control surface |
-
2023
- 2023-05-11 CN CN202310525748.2A patent/CN116301058B/en active Active
Patent Citations (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6573486B1 (en) * | 2002-02-22 | 2003-06-03 | Northrop Grumman Corporation | Projectile guidance with accelerometers and a GPS receiver |
| US20120095621A1 (en) * | 2009-03-26 | 2012-04-19 | Ohio University | Trajectory tracking flight controller |
| US20140114505A1 (en) * | 2012-02-27 | 2014-04-24 | Textron Innovations Inc. | Yaw Damping System And Method For Aircraft |
| US20180057163A1 (en) * | 2016-08-24 | 2018-03-01 | Princess Sumaya University For Technology | Unmanned aerial vehicle |
| CN106773689A (en) * | 2016-12-16 | 2017-05-31 | 西北工业大学 | AUV formation cooperative control methods based on layered distribution type Model Predictive Control |
| CN107315345A (en) * | 2017-06-23 | 2017-11-03 | 华南农业大学 | Take aim at based on double antenna GNSS and in advance the agricultural machinery self-navigation control method of tracing model |
| US20190033892A1 (en) * | 2017-07-27 | 2019-01-31 | Intel Corporation | Trajectory tracking controllers for rotorcraft unmanned aerial vehicles (uavs) |
| CN107844123A (en) * | 2017-10-11 | 2018-03-27 | 中国空气动力研究与发展中心计算空气动力研究所 | A kind of Nonlinear Flight device flight tracking control method |
| US20210072770A1 (en) * | 2019-09-06 | 2021-03-11 | Samsung Electronics Co., Ltd. | Multi-sensor-based unmanned aerial vehicle and method for controlling same |
| US20220107160A1 (en) * | 2020-10-02 | 2022-04-07 | United States Of America, As Represented By The Secretary Of The Navy | Glide Trajectory Optimization for Aerospace Vehicles |
| CN112947572A (en) * | 2021-03-12 | 2021-06-11 | 华南理工大学 | Terrain following-based four-rotor aircraft self-adaptive motion planning method |
| CN113126644A (en) * | 2021-06-03 | 2021-07-16 | 北京理工大学 | Unmanned aerial vehicle three-dimensional track tracking method based on adaptive line-of-sight method |
| CN114510076A (en) * | 2022-02-10 | 2022-05-17 | 中国人民解放军战略支援部队信息工程大学 | Target collaborative detection and guidance integrated method and system based on unscented transformation |
| CN114610068A (en) * | 2022-03-16 | 2022-06-10 | 广州极飞科技股份有限公司 | Unmanned aerial vehicle control method, device, equipment and storage medium |
| CN114877891A (en) * | 2022-06-16 | 2022-08-09 | 东南大学 | Course initial alignment method based on angle parameterization |
| CN115344056A (en) * | 2022-10-17 | 2022-11-15 | 中国空气动力研究与发展中心空天技术研究所 | Intelligent flight control method and application of aircraft with complex control surface |
Non-Patent Citations (10)
| Title |
|---|
| ANPING WU等: "Target Three-Dimensional Localization and Error Analysis for Unmanned Aerial Vehicles", 《(\"FULL TEXT & METADATA\":YAW) AND (\"AUTHOR AFFILIATIONS\":INSTITUTE OF AEROSPACE TECHNOLOGY, CHINA AERODYNAMICS RESEARCH AND \"AUTHOR AFFILIATIONS\":DEVELOPMENT CENTER)》 * |
| BO REN等: "Nonlinear control of terminal guided mortar projectile", 《2016 35TH CHINESE CONTROL CONFERENCE (CCC)》 * |
| 刘文江等: "基于自抗扰控制技术的船舶直线航迹控制器设计", 山东大学学报(工学版), no. 06 * |
| 孙颖: "无人机自适应航迹规划及航迹跟踪控制的研究", 《中国优秀硕士电子学位论文库 工程科技辑》 * |
| 张永宏等: "旋翼无人机的偏航控制系统设计", 《制造业自动化》 * |
| 张治生等: "一种新的小型无人机飞行控制策略研究", 飞行力学, no. 04 * |
| 李猛等: "轴对称无人直升机的一种全向控制方法", 航空计算技术, no. 06 * |
| 梁卓等: "卫星制导炸弹模型参考变结构控制器设计", 计算机仿真, no. 04 * |
| 王洋等: "基于自适应控制器的无人机飞行控制系统研究", 弹箭与制导学报, no. 04 * |
| 黄江涛等: "基于深度强化学习技术的舰载无人机自主着舰控制研究", 《南京师范大学学报(工程技术版)》 * |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117073473A (en) * | 2023-10-17 | 2023-11-17 | 中国空气动力研究与发展中心空天技术研究所 | Missile view angle planning guidance method and system based on time constraint |
| CN117073473B (en) * | 2023-10-17 | 2024-01-02 | 中国空气动力研究与发展中心空天技术研究所 | Missile view angle planning guidance method and system based on time constraint |
Also Published As
| Publication number | Publication date |
|---|---|
| CN116301058B (en) | 2023-08-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Qi et al. | Autonomous landing solution of low-cost quadrotor on a moving platform | |
| Spasojevic et al. | Perception-aware time optimal path parameterization for quadrotors | |
| Wang et al. | High-order nonlinear differentiator and application to aircraft control | |
| Dorobantu et al. | An airborne experimental test platform: From theory to flight | |
| CN116301058B (en) | Unmanned flight feedback nonlinear yaw control method, system and equipment | |
| Wang et al. | Vision-based tracking control of underactuated water surface robots without direct position measurement | |
| Mills et al. | Vision based control for fixed wing UAVs inspecting locally linear infrastructure using skid-to-turn maneuvers | |
| Gonçalves et al. | Homography-based visual servoing of an aircraft for automatic approach and landing | |
| Jung et al. | Bank-to-turn control for a small UAV using backstepping and parameter adaptation | |
| Oliveira et al. | Moving path following for autonomous robotic vehicles | |
| Yue et al. | Cooperative control for multiple quadrotors under position deviations and aerodynamic drag | |
| CN104121930B (en) | A kind of compensation method based on the MEMS gyro drift error adding table coupling | |
| US11029709B1 (en) | Adaptive wind estimation, trajectory generation, and flight control for aerial systems using motion data | |
| CN113608543A (en) | Method, device, equipment and storage medium for self-adaptive planning of flight path of aircraft | |
| CN111708010B (en) | Mobile equipment positioning method, device and system and mobile equipment | |
| KR101846019B1 (en) | Apparatus and method for computing position of flight vehicle | |
| CN116820081A (en) | Under-actuated unmanned ship path tracking control method based on model-free self-adaptive sliding mode | |
| CN109752957A (en) | A kind of unmanned boat guidances command controller structure and design method | |
| CN112445242B (en) | Method, device, equipment and storage medium for tracking route | |
| CN114791735A (en) | Unmanned ship deviation rectifying method and system | |
| Kamath et al. | Vision-based Fast-terminal Sliding Mode Super Twisting Controller for Autonomous Landing of a Quadrotor on a Static Platform | |
| CN102508819B (en) | Angular-speed-based quaternion Legendre approximate output method during extreme flying of aircraft | |
| Zhao et al. | Vision-based robust position control for ground target tracking and hovering of quadrotors | |
| Sun et al. | Flexible modelling and altitude control for powered parafoil system based on active disturbance rejection control | |
| KR101833242B1 (en) | System and method for controlling navigation of flight vehicle |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |