Unmanned aerial vehicle flight control method, device and system

Through the interactive operation method to ensure the system's cyclic interaction control method and combined with the RTA system, the adaptability problem of traditional drone autonomous driving algorithms in complex scenarios is solved, the flight safety and efficiency of the drone is improved, and the expected functions are alleviated. Security risks.

CN118915812APending Publication Date: 2024-11-08CIVIL AVIATION UNIV OF CHINA
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411058668.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-02
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

When traditional drone autonomous driving algorithms realize more intelligent autonomous driving functions, they cannot adapt to complex scenarios, resulting in limited flight safety and efficiency, and it is difficult to effectively deal with expected functional safety issues.

Method used

Adopt an interactive operation time guarantee system, through the circular interaction of the mission planning module, flight management module, guidance law module and inner ring control module, combined with the RTA system, the drone status information is obtained in real time, the security domain location is determined and the function control strategy is switched. Realize the circular interaction control process of the drone.

Benefits of technology

It improves the system safety and efficiency of drone flight, effectively alleviates the serious operational risks caused by expected functional safety problems in the flight environment, and improves autonomous driving performance and control efficiency.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118915812A_ABST
    Figure CN118915812A_ABST
Patent Text Reader

Abstract

The invention provides an unmanned aerial vehicle flight control method, device and system, and the method comprises the steps: circularly executing the following four-module interactive unmanned aerial vehicle flight control steps until a target position determined by a task planning module is reached: obtaining a first position of an unmanned aerial vehicle through the task planning module, and obtaining a target position of the unmanned aerial vehicle according to a preset operation design domain; the current safety domain position of the unmanned aerial vehicle is judged, a first strategy is determined according to the position safety degree, and flight task plan information is generated and sent to the flight management module; taking the flight management module as a current-level module, and executing an information generation and transmission step: through the current-level module, obtaining a second position of the unmanned aerial vehicle, determining a second strategy according to the output information of the previous-level module, generating target information, and outputting the target information to the next-level module; the next-level module continues to execute the information generation and transmission step until all the modules are executed, and the serious operation risk caused by the expected function safety problem when the unmanned aerial vehicle operates in the flight environment can be effectively relieved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of UAV technology, and in particular to a UAV flight control method, device and system. Background Art

[0002] With the rapid development of the drone industry, drone hardware has become relatively mature, and the most important attribute that distinguishes the actual performance of drones is the software program that is compatible with the computing core of autonomous flight control. When drones perform tasks in the air, they need supporting software programs to drive the drones to complete flight missions while taking into account the safety and efficiency of the drones. In terms of drone control, strategies based on traditional control have been studied for many years and have formed some commonly used and reliable algorithms, but traditional methods are slow to update and iterate and have poor flexibility.

[0003] Under the wave of emerging ideas in artificial intelligence, runtime assurance technology (RTA) is an emerging technology for complex systems in various industries. It has initially solved some problems of unpredictable, difficult to explain and unsafe system behaviors, and has great development space in the future. For the field of drones, flight safety and efficiency are extremely important. Traditional drone autopilot functions have industry design guarantees and have certain security. However, when trying to achieve more fully autonomous autopilot functions in the future, traditional rule-based autopilot algorithms will reach their limits and cannot adapt to more intelligent autopilot scenarios. Summary of the invention

[0004] The purpose of the present application is to provide a method, device and system for controlling the flight of a UAV, which ensures that the four modules in the system are interactively operated, and determines the safety level of the current position of the UAV based on the status information fed back by the UAV in real time, and then switches the functional control strategy to realize a cyclic interactive control process of the UAV, provide better system safety assurance, and effectively alleviate the serious operational risks caused by expected functional safety problems when the UAV is operating in a flight environment.

[0005] In the first aspect, the present application provides a method for controlling a UAV flight, which is applied to an interactive runtime guarantee system, wherein the interactive runtime guarantee system comprises: a task planning module, a flight management module, a guidance law module and an inner loop control module connected in sequence from the upper level to the lower level; each module is connected to the UAV in communication; each module is configured with an RTA system; the method comprises: cyclically executing the following four-module interactive UAV flight control steps until the target position determined by the task planning module is reached: obtaining the first current position attitude information of the UAV in real time through the RTA system in the task planning module; judging the target safety domain position where the UAV is currently located according to the first current position attitude information and a preset operation design domain; wherein the operation design domain comprises: safety domains of different safety levels formed by nesting of multiple irregular rings; according to the position of the target safety domain Safety level, determine the first target function control strategy; generate the UAV's flight mission plan information according to the first target function control strategy, and send it to the flight management module; the target function control strategy includes: complex function control strategy or backup function control strategy; take the flight management module as the current level module, and execute the following information generation and transmission steps: obtain the second current position and posture information of the UAV in real time through the RTA system in the current level module; determine the second target function control strategy according to the second current position and posture information and the output information of the previous level module; generate target information and output it to the next level module according to the second target function control strategy; take the next level module as the current level module again, and continue to execute the information generation and transmission steps until the inner loop control module completes the information generation and transmission steps, so that the UAV flies according to the generated flight control instructions.

[0006] Furthermore, the above-mentioned operation design domain includes: a first safety domain, a second safety domain and a third safety domain with increasing safety levels divided in the state space S, the first safety domain is defined as SDsafe, and the junction of the second safety domain and the third safety domain is the conditional boundary of the switching switch; wherein, the third safety domain is an irregular circular area; the third safety domain indicates that for any point in the area, the RTA system can pass any command from the complex function control strategy to the drone for at least a specified number of seconds without exiting the second safety domain; the second safety domain is an irregular annular area around the third safety domain; the second safety domain indicates that for any point in the area, the RTA switching switch can activate the backup function control system to maintain control of the drone and drive the drone to the expected area of ​​the state space within a preset time; wherein, the expected area and the preset time are related to the design of the regression system; the regression system is designed to drive the drone into the expected area within a preset time; the first safety domain is an irregular annular area around the second safety domain, indicating that any point in the state space is located within SDsafe.

[0007] Furthermore, the above-mentioned RTA system includes a selector; the step of determining the target function control strategy according to the security level of the target security domain location includes: if the target security domain location is in the third security domain, determining the complex function control strategy as the target function control strategy; if the target security domain location is in the second security domain or the first security domain, determining the backup function control strategy as the target function control strategy; if the target security domain location is at the junction of the third security domain and the second security domain, determining a function control strategy different from the current function control strategy as the target function control strategy, and switching the function control strategy through the selector; wherein, the complex function control strategy is a high-performance algorithm control strategy; and the backup function control strategy is a traditional civil aviation function control strategy.

[0008] Furthermore, the above-mentioned step of determining the second target function control strategy based on the second current position posture information and the output information of the previous level module includes: determining the UAV flight safety under the two function control strategies respectively according to the second current position posture information and the output information of the previous level module; determining the function control strategy with higher UAV flight safety as the second target function control strategy; if the UAV flight safety corresponding to the two function control strategies is the same, then the function control strategy that makes the UAV flight performance higher is determined as the second target function control strategy.

[0009] Furthermore, the flight mission planning information generated by the above-mentioned mission planning module includes: target position and expected arrival time; the target information generated by the flight management module includes: waypoint position and expected airspeed from the mission segment to the waypoint; the target information generated by the guidance law module includes: heading instructions corresponding to the current waypoint to the next waypoint; the target information generated by the inner loop control module includes: flight control instructions of the UAV.

[0010] Furthermore, the flight control instruction sent by the inner loop control module to the UAV is a thrust instruction, so that the UAV calculates the thrust instruction based on the motion control equation of the three-degree-of-freedom UAS model to obtain UAV control parameters; the UAV control parameters include: airspeed, track angle and heading angle states related to local air quality; the UAV parameters are optimized based on a model obtained by modeling the steady wind that affects the aircraft path to obtain the airspeed, track angle and heading angle states relative to the inertial reference system; the UAV flight is controlled by the airspeed, track angle and heading angle states relative to the inertial reference system.

[0011] Furthermore, the above-mentioned RTA system includes monitors; the main checks performed by the monitors in each RTA system in a module with interactive and nested feedback levels include multiple of the following: safety checks, output checks, performance checks, input checks, environmental checks and system hardware health checks; the inner-loop control module and the guidance law module are both configured with safety-critical type RTA monitors; the flight management module and the mission planning module are both configured with performance / mission-critical type RTA monitors.

[0012] In the second aspect, the present application also provides a UAV flight control device, which is applied to an interactive runtime guarantee system. The interactive runtime guarantee system includes: a task planning module, a flight management module, a guidance law module and an inner loop control module connected in sequence from the upper level to the lower level; each module is connected to the UAV in communication; each module is configured with an RTA system; the device includes: an interactive loop control module, which is used to cyclically execute the following four-module interactive UAV flight control steps until the target position determined by the task planning module is reached: through the RTA system in the task planning module, the first current position attitude information of the UAV is obtained in real time; according to the first current position attitude information and the preset operation design domain, the target safety domain position where the UAV is currently located is judged; wherein the operation design domain includes: safety domains with different safety levels formed by nesting multiple irregular rings; according to the target The safety degree of the safety domain position is used to determine the first target function control strategy; according to the first target function control strategy, the flight mission plan information of the UAV is generated and sent to the flight management module; the target function control strategy includes: complex function control strategy or backup function control strategy; the flight management module is used as the current level module to perform the following information generation and transmission steps: through the RTA system in the current level module, the second current position attitude information of the UAV is obtained in real time; according to the second current position attitude information and the output information of the previous level module, the second target function control strategy is determined; according to the second target function control strategy, the target information is generated and output to the next level module; the next level module is used again as the current level module, and the information generation and transmission steps are continued until the inner loop control module completes the information generation and transmission steps, so that the UAV flies according to the generated flight control instructions.

[0013] In the third aspect, the present application also provides a UAV flight control system, which includes an interactive runtime guarantee system, which includes: a task planning module, a flight management module, a guidance law module and an inner loop control module connected in sequence from the upper level to the lower level; each module is communicatively connected to the UAV; each module is configured with an RTA system; the RTA system includes: a monitor, a selector, a backup function control strategy and a complex function control strategy; the interactive runtime guarantee system is used to execute the method described in the first aspect.

[0014] In a fourth aspect, the present application further provides a computer-readable storage medium, which stores computer-executable instructions. When the computer-executable instructions are called and executed by a processor, the computer-executable instructions prompt the processor to implement the method described in the first aspect above.

[0015] In the UAV flight control method, device and system provided by the present application, the method is applied to an interactive runtime guarantee system, and the interactive runtime guarantee system includes: a task planning module, a flight management module, a guidance law module and an inner loop control module connected in sequence from the upper level to the lower level; each module is connected to the UAV in communication; each module is configured with an RTA system; the method includes: cyclically executing the following four-module interactive UAV flight control steps until the target position determined by the task planning module is reached: through the RTA system in the task planning module, the first current position attitude information of the UAV is obtained in real time; according to the first current position attitude information and the preset operation design domain, the target safety domain position where the UAV is currently located is judged; wherein the operation design domain includes: safety domains with different safety levels formed by nesting of multiple irregular rings; according to the target safety domain position The first target function control strategy is determined according to the safety level of the UAV; according to the first target function control strategy, the flight mission plan information of the UAV is generated and sent to the flight management module; the target function control strategy includes: complex function control strategy or backup function control strategy; the flight management module is used as the current level module to perform the following information generation and transmission steps: through the RTA system in the current level module, the second current position attitude information of the UAV is obtained in real time; according to the second current position attitude information and the output information of the previous level module, the second target function control strategy is determined; according to the second target function control strategy, the target information is generated and output to the next level module; the next level module is used as the current level module again, and the information generation and transmission steps are continued until the inner loop control module completes the information generation and transmission steps, so that the UAV flies according to the generated flight control instructions. This application ensures that the four modules in the system during interactive operation determine the safety level of the current position of the UAV based on the status information fed back by the UAV in real time, and then switches the function control strategy to realize the cyclic interactive control process of the UAV, provide better system safety assurance, and can effectively alleviate the serious operation risks caused by expected functional safety problems when the UAV is operating in the flight environment. BRIEF DESCRIPTION OF THE DRAWINGS

[0016] In order to more clearly illustrate the specific implementation methods of the present application or the technical solutions in the prior art, the drawings required for use in the specific implementation methods or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some implementation methods of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative work.

[0017] Figure 1 A schematic diagram of the structure of an interactive runtime guarantee system provided in an embodiment of the present application;

[0018] Figure 2 A schematic diagram of the structure of another interactive runtime guarantee system provided in an embodiment of the present application;

[0019] Figure 3 A flowchart of a drone flight control method provided in an embodiment of the present application;

[0020] Figure 4 A schematic diagram of a security domain provided in an embodiment of the present application;

[0021] Figure 5 A structural block diagram of a UAV flight control device provided in an embodiment of the present application;

[0022] Figure 6 A schematic diagram of the structure of a UAV flight control system provided in an embodiment of the present application. DETAILED DESCRIPTION

[0023] The technical solution of the present application will be described clearly and completely in conjunction with the embodiments below. Obviously, the described embodiments are part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present application.

[0024] Taking a rotary-wing drone as an example, its body structure is mainly composed of sensors, computing cores, communication modules, batteries, motors, blades and other components. These hardware are relatively mature, and the most important attribute that distinguishes the actual performance of a drone is the software program that matches the computing core for autonomous flight control. The traditional drone autopilot function has industry design guarantees and has certain security guarantees, but in the future, when trying to achieve a more fully autonomous autopilot function, the traditional rule-based autopilot algorithm will reach its limit and will not be able to adapt to more intelligent drone control scenarios.

[0025] Based on this, the embodiments of the present application provide a UAV flight control method, device and system, which ensure the four modules in the system during interactive operation, determine the safety level of the UAV's current position based on the status information fed back by the UAV in real time, and then switch the functional control strategy to realize the cyclic interactive control process of the UAV, provide better system safety assurance, and effectively alleviate the serious operational risks caused by expected functional safety problems when the UAV is operating in a flight environment.

[0026] To facilitate understanding of this embodiment, a UAV flight control method disclosed in an embodiment of the present application is first introduced in detail.

[0027] The present application provides a method for controlling a drone flight, which is applied to an interactive runtime guarantee system. The interactive runtime guarantee system includes: a task planning module 11, a flight management module 12, a guidance law module 13, and an inner loop control module 14 connected in sequence from the upper level to the lower level, such as Figure 1 As shown, each module is connected to the drone in communication; each module is equipped with an RTA system 15; the RTA system 15 includes a monitor, a selector, a backup function control strategy, and a complex function control strategy. The monitor is used to monitor the real-time flight status information of the drone. The selector is used to select and switch between the two control strategies.

[0028] The main checks performed by the monitors in each RTA system in a module with interactive, nested feedback levels include many of the following: safety checks, output checks, performance checks, input checks, environmental checks, and system hardware health checks; the inner-loop control module and the guidance law module are both equipped with safety-critical RTA monitors; the flight management module and the mission planning module are both equipped with performance / mission-critical RTA monitors.

[0029] The above-mentioned task planning module 11 is Figure 2 The MPS module shown in FIG. 1 is used to generate the entire flight mission plan information of the UAV and update it during operation; the flight mission plan information includes: target location and expected arrival time. The flight management module 12 is also called Figure 2 The FMS module shown in is used to generate the waypoint position and the expected airspeed from the mission segment to the waypoint according to the flight mission plan information; that is, to generate the waypoint position and airspeed command so that the UAV can fly to a certain position in the planned trajectory within a certain time; the guidance law module 13 is Figure 2 The GLAW module shown in FIG. 1 is used to generate a heading instruction corresponding to the current waypoint to the next waypoint based on the waypoint position and the expected airspeed from the mission segment to the waypoint; that is, to generate a command for the inner loop control so that the UAV follows the path defined by a series of waypoints. The inner loop control module 14 is Figure 2 The CLAW module shown in the figure is used to generate the flight control instructions of the UAV according to the heading instructions, maintain attitude stability and accurately follow the commands of the guidance law module GLAW.

[0030] See also Figure 3 The flowchart of the UAV flight control method shown in FIG. 1 comprises the following steps:

[0031] Step S302, looping through the following four-module interactive UAV flight control steps until the target position determined by the mission planning module is reached:

[0032] The mission planning module is used to set flight mission objectives for the above-mentioned drone, or to set overall mission objectives for the drone group including the drone, so as to determine the target position that the drone will eventually fly to, and this position will be continuously updated during the flight.

[0033] Step S3022, obtaining the first current position attitude information of the UAV in real time through the RTA system in the mission planning module; judging the target safety domain position where the UAV is currently located according to the first current position attitude information and the preset operation design domain; wherein the operation design domain includes: safety domains with different safety levels formed by nesting multiple irregular rings; determining the first target function control strategy according to the safety level of the target safety domain position; generating the flight mission plan information of the UAV according to the first target function control strategy, and sending it to the flight management module;

[0034] The above-mentioned first target function control strategy includes: a complex function control strategy or a backup function control strategy; the complex function control strategy is a high-performance algorithm control strategy; the backup function control strategy is a traditional civil aviation function control strategy.

[0035] The above-mentioned operation design domain includes: the first safety domain, the second safety domain and the third safety domain divided in the state space S with increasing safety levels, the first safety domain is defined as SDsafe, and the junction of the second safety domain and the third safety domain is the switching condition boundary.

[0036] If the target security domain is located in the third security domain, the complex function control strategy is determined as the target function control strategy; if the target security domain is located in the second security domain or the first security domain, the backup function control strategy is determined as the target function control strategy; if the target security domain is located at the junction of the third security domain and the second security domain, a function control strategy different from the current function control strategy is determined as the target function control strategy, and the function control strategy is switched through the selector.

[0037] Step S3024, taking the flight management module as the current level module, executing the following information generation and transmission steps: obtaining the second current position and attitude information of the UAV in real time through the RTA system in the current level module; determining the second target function control strategy according to the second current position and attitude information and the output information of the previous level module; generating target information according to the second target function control strategy and outputting it to the next level module;

[0038] During specific implementation, the flight safety of the UAV under the two functional control strategies can be determined respectively according to the second current position posture information and the output information of the previous level module; the functional control strategy with higher UAV flight safety is determined as the second target functional control strategy; if the UAV flight safety corresponding to the two functional control strategies is the same, the functional control strategy that makes the UAV flight performance higher will be determined as the second target functional control strategy.

[0039] Step S3026, re-use the next level module as the current level module, and continue to execute the information generation and transmission steps until the inner loop control module completes the information generation and transmission steps, so that the UAV flies according to the generated flight control instructions.

[0040] The flight mission planning information generated by the above-mentioned mission planning module includes: target position and expected arrival time; the target information generated by the flight management module includes: waypoint position and expected airspeed from the mission segment to the waypoint; the target information generated by the guidance law module includes: heading instructions corresponding to the current waypoint to the next waypoint; the target information generated by the inner loop control module includes: flight control instructions of the UAV.

[0041] The above is a relatively abstract overview. The specific processing process of the following three modules is as follows:

[0042] In step S3022, after the RTA system in the mission planning module generates the flight mission planning information of the UAV and sends it to the flight management module, the following steps are also included;

[0043] (1) The RTA system in the flight management module obtains the second current position attitude information A of the UAV in real time; determines the second target function control strategy A according to the second current position attitude information A and the flight mission plan information; generates route information according to the second target function control strategy A and sends it to the guidance law module; the above-mentioned flight mission plan information includes: the target position and the expected arrival time; the above-mentioned route information includes: the waypoint position and the expected airspeed from the mission segment to the waypoint.

[0044] (2) The RTA system in the guidance law module obtains the second current position attitude information B of the UAV in real time; determines the second target function control strategy B according to the second current position attitude information B and the route information, generates heading information according to the second target function control strategy B, and sends it to the inner loop control module; the heading information includes: the heading instruction corresponding to the current waypoint to the next waypoint;

[0045] (3) The RTA system in the inner loop control module obtains the second current position attitude information C of the UAV in real time; determines the second target function control strategy C according to the second current position attitude information C and the heading information, and generates the flight control instructions of the UAV according to the second target function control strategy C to control the flight of the UAV.

[0046] The flight control command sent by the inner loop control module to the UAV is a thrust command, so that the UAV calculates the thrust command based on the motion control equation of the three-degree-of-freedom UAS model to obtain the UAV control parameters; the UAV control parameters include: airspeed, track angle and heading angle state related to the local air quality; the UAV parameters are optimized based on the model obtained by modeling the steady wind that affects the aircraft path to obtain the airspeed, track angle and heading angle state relative to the inertial reference system; the UAV flight is controlled by the airspeed, track angle and heading angle state relative to the inertial reference system.

[0047] The following is a detailed description of the above security domains:

[0048] The above-mentioned operation design domain includes: the first safety domain, the second safety domain and the third safety domain, which are divided in the state space S with increasing safety levels. The first safety domain is defined as SDsafe, and the junction of the second safety domain and the third safety domain is the conditional boundary of the switching switch; wherein the third safety domain is an irregular circular area; the third safety domain means that for any point in the area, the RTA system can pass any command from the complex function control strategy to the drone for at least a specified number of seconds without exiting the second safety domain; the second safety domain is an irregular annular area around the third safety domain; the second safety domain means that for any point in the area, the RTA switching switch can activate the backup function control system to maintain control of the drone and drive the drone to the expected area of ​​the state space within a preset time; wherein the expected area and the preset time are related to the design of the regression system; the regression system is designed to drive the drone into the expected area within a preset time; the first safety domain is an irregular annular area around the second safety domain, indicating that any point in the state space is located within SDsafe.

[0049] See also Figure 4 As shown, according to current principles and industry design standards, SDsafe and state space S are set, and Represents the set of all states that are determined to be safe for the controlled drone. Since the safety margin is included in the design process, the states outside SDsafe are unsafe or unknown, and such states are defined as the state space S.

[0050] In the state space S, it is divided into type I, II, and III safety areas. The type I safety area is defined as SDsafe, and the junction of type II and type III safety areas is the boundary of the conversion switch condition. Among them, the type I safety area means that the point xo in the state space S is within SDsafe; the type II safety area means that at any point in the area, the RTA conversion switch can activate the backup system, so that the control of the controlled object can be maintained, and the drone can be driven to the desired area Q in the state space within a limited time T; the type III safety area means that at any point in the area, RTA can pass any command from the complex system to the drone within at least τ seconds without exiting the type II safety area. Among them, Q and T are not arbitrary, but related to the design of the regression system. The regression system is designed to drive the state to a specifically defined area Q within a specified time t. The boundary between the type III and type II safety areas defines the boundary of the conversion switch condition.

[0051] The specific functions of the above four modules are as follows:

[0052] The functions of the four modules in turn are that the MPS generates a specific future target position and an associated expected arrival time and some other outputs. These positions and timing plans are then received by the FMS, which converts the mission plan into a series of waypoint positions and the expected airspeeds for the mission segments (MS) to the waypoints. The waypoint positions are defined by positions in an inertial {latitude, longitude, altitude} or local coordinate system {downrange, crossover range, altitude} = {X, Y, H}, where H will be defined by the altitude above the local ground level (AGL). The GLAW determines the airspeed command to follow the expected airspeed from the FMS block, determines the flight path angle command to aim at the expected H from the next waypoint of the FMS block, and determines the heading command to aim at the {X, Y} position from the next waypoint of the FMS block. These commands are then passed to the CLAW, which generates thrust commands to follow the commanded airspeed from the GLAW block, lift commands to follow the commanded flight trajectory from the GLAW block, and bank angle commands to follow the heading command from the GLAW block.

[0053] The CLAW's instructions are then passed to the motion control equations of the three-DOF UAS model, resulting in airspeed, track angle, and heading angle states related to the local air mass. Finally, the steady wind that affects the aircraft path is modeled and added to give the airspeed, track angle, and heading angle states relative to the inertial reference frame.

[0054] In the embodiment of the present application, two types of monitors are designed for the monitors in the RTA system, one of which is a monitor of the safety-critical RTA system, whose failure may cause catastrophic loss of the vehicle or system. Typically, the inner-loop control and outer-loop guidance feedback levels will require safety-critical RTA monitoring and recovery operations, which are characterized by very fast update rates and high-bandwidth decisions. This type of RTA monitor must ensure that the entire feedback system will never enter an unsafe state, and this state cannot guarantee that the recovery controller can recover to a safe state.

[0055] Another is a monitor for performance / mission critical RTA systems, whose failure could result in degradation of UAV performance or mission capability. Typically, this type of RTA monitor is best applied at the outer-loop flight management and mission planning levels, characterized by much slower update rates, and operation on future predicted states to provide a look-ahead planning capability. In this case, the RTA monitor is more akin to a software integrity monitor, with ample time to perform statistical diagnostics and other complex analyses to determine if the high-level system is operating as it should and therefore delivering its stated performance.

[0056] In the embodiment of the present application, the operation design domain of the UAV is divided into Class I, II, and III safety areas, and the boundary between Class II and Class III safety areas defines the boundary of the switching condition; if the UAV posture meets the flight safety conditions, that is, it is located in the Class III safety area, the complex functions in the four modules of the inner loop control law, the guidance law, the flight management system and the mission plan will generate an efficient and safe flight mission plan, and the real-time position and attitude information of the UAV will be fed back to each module to be used as one of the data inputs of the complex function and the backup function; if the safety monitor detects that the UAV posture reaches the safety standard threshold and enters a recoverable state, that is, it is located in the Class II safety area, the switching switch will convert the complex function to the backup function, and the flight mission will be performed by the backup recovery function in the above four modules; if the UAV returns to a safe state from the recoverable state, that is, the Class III safety area, the control is switched back to the complex function to control the UAV flight, and the UAV intelligent flight mission is completed by switching the two functions; while alleviating risks, the real-time efficiency of the UAV flight is improved, and the reliability and safety of the UAV flight process are guaranteed.

[0057] Taking the GLAW module as an example, the backup function control strategy is the industry standard, designed reliable GLAW (DTA GLAW), and the complex function control strategy is the RTA protected GLAW running in advanced mode (AGLAW).

[0058] Four scenarios are set to match the RTA working sequence. Scenario 1: The drone is within the Class III safety domain and remains within the transfer switch trigger threshold. The complex function control strategy is the source of the RTA output. Scenario 2: The drone exceeds the transfer switch threshold and therefore exits the Class III safety domain. The backup function control strategy serves as the source of the RTA output. When the backup function control strategy output returns to within the safety transfer switch trigger threshold, the drone re-enters the Class III safety domain, and the complex function control strategy output again becomes the source of the RTA output. Scenario 3: The drone exceeds the transfer switch threshold and exits the Class III safety domain. The backup function control strategy becomes the source of the RTA output. The backup function control strategy cannot restore the RTA system to the Class III safety domain, or the complex function control strategy output continues to exceed the transfer switch threshold, or both. The RTA output still comes from the backup function control strategy, and the drone operates safely within the Class II safety domain. Scenario 4: The drone exceeds the transfer switch trigger threshold and exits the Class III safety domain. The backup function control strategy becomes the source of the RTA output. The backup function control strategy cannot return the RTA output to within the transfer switch trigger threshold, and the drone exits the Class II safety domain and enters the Class I safety domain.

[0059] This embodiment has the following beneficial effects:

[0060] Through the design of a multi-level interactive feedback system and the addition of multiple runtime guarantee systems, the efficiency and safety of drones in the operating environment are improved. Real-time perception and identification of the relative position of the aircraft and flight mission planning can effectively alleviate the expected functional safety problems of drones in the operating environment, which may lead to serious operational risks. This system helps to improve the safety and efficiency of drones. By collecting and analyzing the information of the aircraft and building a new driving system through RTA, the safety and airworthiness of the aircraft's driving system are greatly improved; planning flight missions through different RTA system states helps to improve the operational safety of drones in complex traffic environments.

[0061] The UAV flight control method provided in the embodiment of the present application is actually a UAV driving control method based on a runtime guarantee technology of multi-level interactive feedback, which can improve the performance and control efficiency of UAV automatic driving and improve the flight safety of UAV.

[0062] Based on the above method embodiment, the embodiment of the present application also provides a UAV flight control device, which is applied to an interactive runtime guarantee system. The interactive runtime guarantee system includes: a task planning module, a flight management module, a guidance law module and an inner loop control module connected in sequence from the upper level to the lower level; each module is connected to the UAV in communication; each module is configured with an RTA system; see Figure 5 As shown, the device comprises:

[0063] The interactive loop control module 52 is used to loop through the following four-module interactive UAV flight control steps until the target position determined by the mission planning module is reached:

[0064] The first control module 522 is used to obtain the first current position attitude information of the UAV in real time through the RTA system in the mission planning module; determine the target safety domain position where the UAV is currently located according to the first current position attitude information and the preset operation design domain; wherein the operation design domain includes: safety domains with different safety levels formed by nesting multiple irregular rings; determine the first target function control strategy according to the safety level of the target safety domain position; generate the flight mission plan information of the UAV according to the first target function control strategy, and send it to the flight management module; the target function control strategy includes: complex function control strategy or backup function control strategy;

[0065] The second control module 524 is used to use the flight management module as the current level module to perform the following information generation and transmission steps: obtain the second current position and attitude information of the UAV in real time through the RTA system in the current level module; determine the second target function control strategy based on the second current position and attitude information and the output information of the previous level module; generate target information and output it to the next level module according to the second target function control strategy; use the next level module as the current level module again and continue to perform the information generation and transmission steps until the inner loop control module completes the information generation and transmission steps, so that the UAV flies according to the generated flight control instructions.

[0066] Furthermore, the above-mentioned operation design domain includes: a first safety domain, a second safety domain and a third safety domain with increasing safety levels divided in the state space S, the first safety domain is defined as SDsafe, and the junction of the second safety domain and the third safety domain is the conditional boundary of the switching switch; wherein, the third safety domain is an irregular circular area; the third safety domain indicates that for any point in the area, the RTA system can pass any command from the complex function control strategy to the drone for at least a specified number of seconds without exiting the second safety domain; the second safety domain is an irregular annular area around the third safety domain; the second safety domain indicates that for any point in the area, the RTA switching switch can activate the backup function control system to maintain control of the drone and drive the drone to the expected area of ​​the state space within a preset time; wherein, the expected area and the preset time are related to the design of the regression system; the regression system is designed to drive the drone into the expected area within a preset time; the first safety domain is an irregular annular area around the second safety domain, indicating that any point in the state space is located within SDsafe.

[0067] Furthermore, the above-mentioned RTA system includes a selector; a first control module 522, which is used to determine the complex function control strategy as the target function control strategy if the target security domain is located in the third security domain; if the target security domain is located in the second security domain or the first security domain, the backup function control strategy is determined as the target function control strategy; if the target security domain is located at the junction of the third security domain and the second security domain, a function control strategy different from the current function control strategy is determined as the target function control strategy, and the function control strategy is switched through the selector; wherein, the complex function control strategy is a high-performance algorithm control strategy; and the backup function control strategy is a traditional civil aviation function control strategy.

[0068] Furthermore, the above-mentioned second control module 524 is used to determine the flight safety of the UAV under the two functional control strategies according to the second current position posture information and the output information of the previous level module; the functional control strategy with higher UAV flight safety is determined as the second target functional control strategy; if the UAV flight safety corresponding to the two functional control strategies is the same, the functional control strategy that makes the UAV flight performance higher will be determined as the second target functional control strategy.

[0069] Furthermore, the flight mission planning information generated by the above-mentioned mission planning module includes: target position and expected arrival time; the target information generated by the flight management module includes: waypoint position and expected airspeed from the mission segment to the waypoint; the target information generated by the guidance law module includes: heading instructions corresponding to the current waypoint to the next waypoint; the target information generated by the inner loop control module includes: flight control instructions of the UAV.

[0070] Furthermore, the flight control instruction sent by the inner loop control module to the UAV is a thrust instruction, so that the UAV calculates the thrust instruction based on the motion control equation of the three-degree-of-freedom UAS model to obtain UAV control parameters; the UAV control parameters include: airspeed, track angle and heading angle states related to local air quality; the UAV parameters are optimized based on a model obtained by modeling the steady wind that affects the aircraft path to obtain the airspeed, track angle and heading angle states relative to the inertial reference system; the UAV flight is controlled by the airspeed, track angle and heading angle states relative to the inertial reference system.

[0071] Furthermore, the above-mentioned RTA system includes monitors; the main checks performed by the monitors in each RTA system in a module with interactive and nested feedback levels include multiple of the following: safety checks, output checks, performance checks, input checks, environmental checks and system hardware health checks; the inner-loop control module and the guidance law module are both configured with safety-critical type RTA monitors; the flight management module and the mission planning module are both configured with performance / mission-critical type RTA monitors.

[0072] The device provided in the embodiment of the present application has the same implementation principle and technical effects as those of the aforementioned method embodiment. For the sake of brief description, for matters not mentioned in the embodiment of the device, reference may be made to the corresponding contents in the aforementioned method embodiment.

[0073] Based on the above method embodiment, the present application embodiment also provides a drone flight control system, see Figure 6 As shown, the UAV flight control system includes: a UAV 62 and an interactive runtime guarantee system 64, and the interactive runtime guarantee system 64 includes: a task planning module 641, a flight management module 642, a guidance law module 643 and an inner loop control module 644 connected in sequence from the upper level to the lower level; each module is communicated with the UAV 62; each module is configured with an RTA system 645; the RTA system 645 includes: a monitor, a selector, a backup function control strategy and a complex function control strategy; the interactive runtime guarantee system 64 is used to execute the steps of the method described in the aforementioned method embodiment.

[0074] The system provided in the embodiment of the present application has the same implementation principle and technical effects as those of the aforementioned method embodiment. For the sake of brief description, for matters not mentioned in the embodiment of the system, reference may be made to the corresponding contents in the aforementioned method embodiment.

[0075] An embodiment of the present application also provides a computer-readable storage medium, which stores computer-executable instructions. When the computer-executable instructions are called and executed by a processor, the computer-executable instructions prompt the processor to implement the above method. The specific implementation can be found in the aforementioned method embodiment, which will not be repeated here.

[0076] The computer program products of the methods, devices, and electronic devices provided in the embodiments of the present application include a computer-readable storage medium storing program code. The instructions included in the program code can be used to execute the methods described in the previous method embodiments. The specific implementation can be found in the method embodiments, which will not be repeated here.

[0077] Unless otherwise specifically stated, the relative steps, numerical expressions and values ​​of the components and steps set forth in these embodiments do not limit the scope of the present application.

[0078] If the functions are implemented in the form of software functional units and sold or used as independent products, they can be stored in a non-volatile computer-readable storage medium that is executable by a processor. Based on this understanding, the technical solution of the present application, or the part that contributes to the prior art or the part of the technical solution, can be embodied in the form of a software product, which is stored in a storage medium and includes several instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present application. The aforementioned storage medium includes: various media that can store program codes, such as a USB flash drive, a mobile hard disk, a read-only memory (ROM), a random access memory (RAM), a magnetic disk or an optical disk.

[0079] In the description of the present application, it should be noted that the terms "center", "upper", "lower", "left", "right", "vertical", "horizontal", "inner", "outer", etc., indicating the orientation or positional relationship, are based on the orientation or positional relationship shown in the drawings, and are only for the convenience of describing the present application and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as limiting the present application. In addition, the terms "first", "second", and "third" are used for descriptive purposes only, and cannot be understood as indicating or implying relative importance.

[0080] Finally, it should be noted that the above-described embodiments are only specific implementation methods of the present application, which are used to illustrate the technical solutions of the present application, rather than to limit them. The protection scope of the present application is not limited thereto. Although the present application is described in detail with reference to the above-described embodiments, ordinary technicians in the field should understand that any technician familiar with the technical field can still modify the technical solutions recorded in the above-described embodiments within the technical scope disclosed in the present application, or can easily think of changes, or make equivalent replacements for some of the technical features therein; and these modifications, changes or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions of the embodiments of the present application, and should be included in the protection scope of the present application. Therefore, the protection scope of the present application shall be subject to the protection scope of the claims.

Claims

1. A UAV flight control method, characterized in that: The method is applied to an interactive runtime assurance system, which includes: a mission planning module, a flight management module, a guidance law module, and an inner loop control module connected in sequence from the upper level to the lower level; each module is connected to the drone in communication; each module is configured with an RTA system; the method includes: The following four-module interactive UAV flight control steps are executed cyclically until the target position determined by the mission planning module is reached: The first current position and attitude information of the UAV is obtained in real time through the RTA system in the mission planning module; the target safety domain position where the UAV is currently located is determined according to the first current position and attitude information and the preset operation design domain; wherein the operation design domain includes: safety domains with different safety levels formed by nesting of multiple irregular rings; according to the safety level of the target safety domain position, a first target function control strategy is determined; according to the first target function control strategy, the flight mission plan information of the UAV is generated and sent to the flight management module; the target function control strategy includes: a complex function control strategy or a backup function control strategy; The flight management module is used as the current level module, and the following information generation and transmission steps are performed: the second current position and attitude information of the UAV is obtained in real time through the RTA system in the current level module; the second target function control strategy is determined according to the second current position and attitude information and the output information of the previous level module; according to the second target function control strategy, the target information is generated and output to the next level module; the next level module is used as the current level module again, and the information generation and transmission steps are continued until the inner loop control module completes the information generation and transmission steps, so that the UAV flies according to the generated flight control instructions.

2. The method according to claim 1, characterized in that The operation design domain includes: a first safety domain, a second safety domain and a third safety domain divided in the state space S with increasing safety levels, the first safety domain is defined as SDsafe, and the junction of the second safety domain and the third safety domain is a switching condition boundary; Among them, the third safety domain is an irregular circular area; the third safety domain indicates that for any point in the area, the RTA system can pass any command from the complex function control strategy to the drone for at least specified seconds without exiting the second safety domain; the second safety domain is an irregular annular area around the third safety domain; the second safety domain indicates that for any point in the area, the RTA conversion switch can activate the backup function control system to maintain control of the drone and drive the drone to the expected area in the state space within a preset time; wherein the expected area and the preset time are related to the design of the regression system; the regression system is designed to drive the drone into the expected area within a preset time; the first safety domain is an irregular annular area around the second safety domain, indicating that any point in the state space is located within SDsafe.

3. The method according to claim 2, characterized in that The RTA system includes a selector; the step of determining the target function control strategy according to the security level of the target security domain location includes: If the target security domain is located in the third security domain, the complex function control strategy is determined as the target function control strategy; If the target security domain is located in the second security domain or the first security domain, determining the backup function control policy as the target function control policy; If the target security domain is located at the junction of the third security domain and the second security domain, a function control strategy different from the current function control strategy is determined as the target function control strategy, and the function control strategy is switched through the selector; Among them, the complex function control strategy is a high-performance algorithm control strategy; the backup function control strategy is a traditional civil aviation function control strategy.

4. The method according to claim 1, characterized in that: The step of determining the second target function control strategy according to the second current position posture information and the output information of the upper level module includes: According to the second current position attitude information and the output information of the upper level module, respectively determine the flight safety of the drone under the two functional control strategies; The functional control strategy with higher UAV flight safety is determined as the second target functional control strategy; If the two functional control strategies correspond to the same UAV flight safety, the functional control strategy that enables the UAV flight performance to be higher will be determined as the second target functional control strategy.

5. The method according to claim 1, characterized in that The flight mission planning information generated by the mission planning module includes: target position and expected arrival time; the target information generated by the flight management module includes: waypoint position and expected airspeed from the mission segment to the waypoint; the target information generated by the guidance law module includes: heading instructions corresponding to the current waypoint to the next waypoint; the target information generated by the inner loop control module includes: flight control instructions for the UAV.

6. The method according to claim 1, characterized in that The flight control instruction sent by the inner loop control module to the UAV is a thrust instruction, so that the UAV calculates the thrust instruction based on the motion control equation of the three-degree-of-freedom UAS model to obtain UAV control parameters; the UAV control parameters include: airspeed, track angle and heading angle state related to local air quality; the UAV parameters are optimized based on a model obtained by modeling the steady wind that affects the aircraft path to obtain the airspeed, track angle and heading angle state relative to the inertial reference system; the UAV flight is controlled by the airspeed, track angle and heading angle state relative to the inertial reference system.

7. The method according to claim 1, characterized in that The RTA system includes monitors; the main checks performed by the monitors in each RTA system in a module with interactive and nested feedback levels include multiple of the following: safety checks, output checks, performance checks, input checks, environmental checks and system hardware health checks; the inner-loop control module and the guidance law module are both configured with safety-critical RTA monitors; the flight management module and the mission planning module are both configured with performance / mission-critical RTA monitors.

8. A UAV flight control device, characterized in that: The device is applied to an interactive runtime guarantee system, which includes: a mission planning module, a flight management module, a guidance law module and an inner loop control module connected in sequence from the upper level to the lower level; each module is connected to the drone in communication; each module is configured with an RTA system; the device includes: The interactive loop control module is used to loop through the following four-module interactive UAV flight control steps until the target position determined by the mission planning module is reached: The first current position and attitude information of the UAV is obtained in real time through the RTA system in the mission planning module; the target safety domain position where the UAV is currently located is determined according to the first current position and attitude information and the preset operation design domain; wherein the operation design domain includes: safety domains with different safety levels formed by nesting of multiple irregular rings; according to the safety level of the target safety domain position, a first target function control strategy is determined; according to the first target function control strategy, the flight mission plan information of the UAV is generated and sent to the flight management module; the target function control strategy includes: a complex function control strategy or a backup function control strategy; The flight management module is used as the current level module, and the following information generation and transmission steps are performed: the second current position and attitude information of the UAV is obtained in real time through the RTA system in the current level module; the second target function control strategy is determined according to the second current position and attitude information and the output information of the previous level module; according to the second target function control strategy, the target information is generated and output to the next level module; the next level module is used as the current level module again, and the information generation and transmission steps are continued until the inner loop control module completes the information generation and transmission steps, so that the UAV flies according to the generated flight control instructions.

9. A UAV flight control system, characterized in that: The UAV flight control system includes an interactive runtime assurance system, which includes: a task planning module, a flight management module, a guidance law module and an inner loop control module connected in sequence from the upper level to the lower level; each module is communicatively connected to the UAV; each module is configured with an RTA system; the RTA system includes: a monitor, a selector, a backup function control strategy and a complex function control strategy; the interactive runtime assurance system is used to execute the method described in any one of claims 1 to 7.

10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer-executable instructions, and when the computer-executable instructions are called and executed by a processor, the computer-executable instructions prompt the processor to implement the method according to any one of claims 1 to 7.