Unmanned aerial vehicle flight control method and device, electronic equipment and storage medium
By obtaining the initial attitude and tilt angle of the drone, determining the target takeoff mode and adjusting the rotor speed, the problem of safe takeoff from the inclined surface in a disaster environment is solved, and the success rate and safety of the flight mission are improved.
Patent Information
- Application Number
- CN202410992275.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-23
- Publication Date
- 2024-11-12
AI Technical Summary
Existing drone technology is difficult to take off safely from tilted surfaces in disaster environments, which can lead to equipment damage and mission failure.
By acquiring the initial attitude and initial tilt angle of the drone, the target takeoff mode is determined, and the target speed and control signals of the rotor are generated based on the mode, and the rotor speed is adjusted to achieve safe takeoff. In addition, the status vector is monitored in real time and control parameters are adjusted to ensure the success of takeoff and hover tasks.
Improves the flight flexibility and safety of drones in disaster situations, reduces the risk of equipment damage caused by improper takeoff, and ensures success rates for takeoff and hover tasks.
Smart Images

Figure CN118938986A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of drone control technology, and in particular to a drone flight control method, device, electronic equipment and storage medium. Background Art
[0002] Unmanned Aerial Vehicles (UAVs) have shown great potential in responding to disaster situations. With their excellent flexibility, high safety, simple operation process and relatively low operating costs, they are ideal for disaster monitoring and rescue missions. In order to improve the take-off and landing capabilities of UAVs, several research teams are committed to developing advanced control systems. Samir Bouabdallah established a mathematical model to provide a theoretical basis for simulation and control of quadcopters and designed five different controllers to optimize the attitude, altitude and position control of the aircraft. S. Park adopted the robust integral control method (RIC) to incorporate model uncertainty and sensor noise into interference factors, thereby enhancing the robustness of the control system. Bruno Herisse proposed a nonlinear control strategy designed for vertical landing of vertical take-off and landing UAVs. D. Cabecinhas used a hybrid automaton model to achieve dynamic switching of states according to the different dynamic behaviors of the aircraft.
[0003] Although these studies provide effective solutions for the vertical takeoff and landing of drones, most of the existing technologies focus on "planar dynamics", which assumes that drones take off and land on a flat surface. However, in actual disaster environments, due to the damage caused by natural disasters, such as the destruction of roads and buildings, it is often difficult for drones to find a suitable flat takeoff site. In addition, if a drone is forced to take off vertically under harsh conditions, it may cause damage to the equipment and affect the execution of the mission.
[0004] The preceding description is intended to provide general background information and does not necessarily constitute prior art. Summary of the invention
[0005] In response to the above technical problems, the present application provides a UAV flight control method, device, electronic device and storage medium, which can solve the problem of UAV taking off from an inclined surface in disaster situations, and effectively improve the flexibility and safety of UAV flight in disaster situations.
[0006] In order to solve the above technical problems, the present application provides a UAV flight control method, comprising the following steps:
[0007] Get the initial attitude and initial tilt angle of the drone;
[0008] Determining a target takeoff mode of the UAV based on the initial posture and the initial tilt angle;
[0009] Based on the target takeoff mode, determining the target speed corresponding to each rotor of the UAV and generating a corresponding control signal;
[0010] Based on the control signal, the speed of each rotor of the UAV is adjusted to the corresponding target speed to control the UAV to perform a take-off mission.
[0011] Furthermore, in some embodiments of the present application, after controlling the drone to perform a takeoff mission, the method further includes:
[0012] Acquire the real-time state vector of the UAV during the take-off mission in real time;
[0013] Based on the real-time state vector and the reference state vector, generating a corresponding error signal;
[0014] The control parameters of the UAV are adjusted in real time based on the error signal.
[0015] Furthermore, in some embodiments of the present application, the method further includes:
[0016] If it is detected that the real-time state vector meets the preset hovering condition, a mode switching signal is generated;
[0017] In response to the mode switching signal, determining a hovering control signal based on the real-time state vector;
[0018] The control parameters of the UAV are adjusted based on the hovering control signal so that the UAV performs the hovering task according to the control parameters.
[0019] Further, in some embodiments of the present application, the preset hovering condition includes a position error, a height threshold and a posture threshold, and the method further includes:
[0020] Calculate the current position information, altitude information and attitude information of the drone based on the real-time state vector;
[0021] Detect whether the position information, the height information, and the posture information meet a preset hovering condition.
[0022] Further, in some embodiments of the present application, determining the hovering control signal based on the real-time state vector includes:
[0023] extracting a target component from the real-time state vector;
[0024] Determining position information based on the target component, and determining altitude information and pitch angle information based on a proportional-derivative controller;
[0025] A hovering control signal is determined based on the position information, the altitude information, and the pitch angle information.
[0026] Furthermore, in some embodiments of the present application, it also includes:
[0027] Based on the equipment parameters of the UAV, a corresponding UAV dynamics model is constructed;
[0028] A dynamic hybrid system for the UAV to take off from an inclined surface is constructed based on the UAV dynamics model, and the dynamic hybrid system includes control strategies corresponding to a take-off mode and a hovering mode, respectively.
[0029] Further, in some embodiments of the present application, determining the target take-off mode of the drone based on the initial posture and the initial tilt angle includes:
[0030] If the initial tilt angle is greater than 0 and not greater than a preset first threshold, determining that the target take-off mode of the drone is the first take-off mode;
[0031] If the initial tilt angle is greater than a preset first threshold value and not greater than a preset second threshold value, determining that the target take-off mode of the drone is the second take-off mode;
[0032] If the initial tilt angle is greater than the preset second threshold value and not greater than the preset third threshold value, it is determined that the drone is currently unable to take off directly.
[0033] Accordingly, the present application also provides a UAV flight control device, comprising:
[0034] The acquisition module is used to obtain the initial attitude and initial tilt angle of the drone;
[0035] A first determination module, configured to determine a target takeoff mode of the UAV based on the initial posture and the initial tilt angle;
[0036] A second determination module is used to determine the target speed corresponding to each rotor of the UAV based on the target take-off mode, and generate a corresponding control signal;
[0037] The adjustment module is used to adjust the speed of each rotor of the UAV to the corresponding target speed based on the control signal, so as to control the UAV to perform a take-off mission.
[0038] The present application also provides an electronic device, comprising: a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes the steps of the UAV flight control method as described above when executing the program.
[0039] The present application also provides a storage medium storing a computer program that can be loaded by a processor and execute the drone flight control method as described above.
[0040] Implementing the embodiments of the present application has the following beneficial effects:
[0041] As described above, the present application provides a method, device, electronic device and storage medium for controlling a drone flight, wherein the drone flight control method includes: obtaining the initial attitude and initial tilt angle of the drone; determining the target takeoff mode of the drone based on the initial attitude and initial tilt angle; determining the target speed corresponding to each rotor of the drone based on the target takeoff mode, and generating a corresponding control signal; adjusting the speed of each rotor of the drone to the corresponding target speed based on the control signal to control the drone to perform a takeoff mission. The present application can automatically adjust the takeoff strategy according to the tilt angle, ensure that the rotor does not contact the surface, reduce the risk of equipment damage caused by improper takeoff, solve the problem of drones taking off from tilted surfaces in disaster situations, and effectively improve the flexibility and safety of drone flights in disaster situations. BRIEF DESCRIPTION OF THE DRAWINGS
[0042] The drawings herein are incorporated into the specification and constitute a part of the specification, illustrate embodiments consistent with the present application, and together with the specification are used to explain the principles of the present application. In order to more clearly illustrate the technical solutions of the embodiments of the present application, the drawings required for use in the description of the embodiments are briefly introduced below. Obviously, for ordinary technicians in this field, other drawings can be obtained based on these drawings without creative labor.
[0043] Figure 1 It is a flowchart of the UAV flight control method provided by the embodiment of the present application;
[0044] Figure 2 is a schematic diagram of a quadcopter dynamics model provided in an embodiment of the present application;
[0045] Figure 3 is a schematic diagram of a simplified model of a quadcopter placed on an inclined plane provided in an embodiment of the present application;
[0046] Figure 4 is a schematic diagram of the state switching of a quadcopter provided in an embodiment of the present application;
[0047] Figure 5It is a structural schematic diagram of the UAV flight control device provided in an embodiment of the present application;
[0048] Figure 6 It is a schematic diagram of the structure of an electronic device provided in an embodiment of the present application.
[0049] The realization of the purpose, functional features and advantages of this application will be further described in conjunction with the embodiments and with reference to the accompanying drawings. The above-mentioned drawings have shown clear embodiments of this application, which will be described in more detail later. These drawings and textual descriptions are not intended to limit the scope of the concept of this application in any way, but to illustrate the concept of this application to those skilled in the art by referring to specific embodiments. DETAILED DESCRIPTION
[0050] Exemplary embodiments will be described in detail herein, examples of which are shown in the accompanying drawings. When the following description refers to the drawings, the same numbers in different drawings represent the same or similar elements unless otherwise indicated. The implementations described in the following exemplary embodiments do not represent all implementations consistent with the present application. Instead, they are merely examples of devices and methods consistent with some aspects of the present application as detailed in the appended claims.
[0051] It should be noted that, in this article, the terms "include", "comprises" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also includes other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, an element defined by the sentence "includes a ..." does not exclude the existence of other identical elements in the process, method, article or device including the element. In addition, components, features, and elements with the same name in different embodiments of the present application may have the same meaning or different meanings, and their specific meanings need to be determined by their explanation in the specific embodiment or further combined with the context of the specific embodiment.
[0052] It should be understood that the specific embodiments described herein are only used to explain the present application and are not used to limit the present application.
[0053] In the subsequent description, the suffixes such as "module", "component" or "unit" used to represent elements are only used to facilitate the description of the present application, and have no specific meanings. Therefore, "module", "component" or "unit" can be used in a mixed manner.
[0054] Currently, unmanned aerial vehicles (UAVs) equipped with remote sensing instruments offer many opportunities for use in disaster-related situations. Many control systems have been developed in the prior art to enable UAVs to take off and land vertically. For example, Samir Bouabdallah proposed a mathematical model for simulating and controlling quadcopters and developed five different controllers to compare attitude, altitude, and position controllers. S.Park proposed a RIC method to design controllers, treating incorrect parts of the model and sensor noise as interference. Bruno Herisse proposed a nonlinear controller for vertical landing of vertical take-off and landing UAVs. D.Cabecinhas proposed a model using hybrid automata in which states correspond to different dynamic behaviors. However, the take-off of UAVs from inclined surfaces has not been well studied. Since natural disasters usually cause huge losses, and roads and buildings are always demolished, it may be difficult to find an aircraft to take off. If a UAV takes off vertically in such a harsh environment, it will cause damage to itself. There is an urgent need for a UAV control method that can solve the above problems.
[0055] See also Figure 1 , Figure 1 : is a flowchart of the UAV flight control method provided by the embodiment of the present application. The UAV flight control method provided by this embodiment may specifically include the following steps:
[0056] S1. Obtain the initial attitude and initial tilt angle of the drone;
[0057] Specifically, for step S1, the main purpose is to obtain the current initial attitude and initial tilt angle of the drone, where the initial attitude usually refers to the orientation of the drone relative to a reference coordinate system (usually the earth coordinate system), including pitch, roll and yaw; the initial tilt angle specifically refers to the angle between the drone and the horizontal plane, which affects the stability and lift required when the drone takes off. The initial attitude can be measured by using sensors such as an inertial measurement unit (IMU), an integrated accelerometer and a gyroscope to measure the attitude information of the drone; the initial tilt angle can be measured by measuring the tilt of the drone relative to the direction of gravity through the accelerometer in the IMU, or by using other sensors such as an inclinometer or a visual sensor.
[0058] Initial attitude and tilt angle are key parameters that determine the takeoff behavior of the drone, directly affecting the selection of takeoff control strategy and the calculation of lift (thrust) during takeoff. Sensor data needs to be processed by data fusion algorithms to improve the accuracy and reliability of measurements, especially in multi-sensor systems. In addition, the measurement of initial attitude and tilt angle needs to be performed in real time so that the control system can respond quickly and adjust the takeoff strategy.
[0059] By accurately obtaining the initial attitude and initial tilt angle of the drone, the flight control system of the drone can more effectively plan the take-off path and calculate the required lift and thrust, thereby ensuring that the drone can take off safely and stably from the inclined surface. This step is the basis for achieving autonomous take-off of the drone in complex environments.
[0060] S2. Determine the target takeoff mode of the UAV based on the initial attitude and initial tilt angle;
[0061] Specifically, for step S2, the take-off mode refers to the flight control strategy of the UAV from a stationary state to lift-off, which is customized according to the initial conditions of the UAV. There may be multiple take-off modes depending on the initial attitude and tilt angle. For example, take-off from flat ground, take-off at a small angle, take-off at a large angle, etc. In a specific embodiment, the UAV control system has built-in decision logic to select the most appropriate take-off mode based on the measured initial attitude and tilt angle. Each take-off mode corresponds to a set of specific control parameters, including but not limited to rotor speed, lift demand, attitude adjustment amount, etc. After determining the take-off mode, the flight control system needs to respond dynamically and adjust the control parameters to adapt to the current take-off conditions.
[0062] In this embodiment, by determining the target take-off mode based on the initial posture and the initial tilt angle, the UAV can adapt to different take-off conditions and improve the success rate and safety of taking off from an inclined surface.
[0063] S3. Based on the target takeoff mode, determine the target speed corresponding to each rotor of the drone and generate a corresponding control signal;
[0064] Specifically, for step S3, each takeoff mode corresponds to a specific set of rotor speed settings, which are determined based on the UAV's dynamic model and expected flight behavior. Using the UAV's dynamic model, the force and torque balance in different takeoff modes is analyzed to calculate the required rotor thrust and speed; according to the requirements of the takeoff mode, the target speed of each rotor is determined to generate sufficient lift to overcome gravity and other external forces, such as ground effect or wind; based on the calculated target rotor speed, a control signal is generated; these signals will be sent to the UAV's flight control system to adjust the actual speed of the rotor. In the specific implementation process, the control signal can be adjusted according to the error between the target speed and the actual speed of the rotor by using a control algorithm, such as a PID (proportional-integral-differential) controller. In a multi-rotor UAV, the speed of each rotor needs to be coordinated to maintain the balance of the UAV and control its attitude.
[0065] Through this process, the drone can accurately adjust the rotor speed according to the target takeoff mode and generate appropriate control signals to ensure that the drone can take off safely and stably from the inclined surface. This is one of the key technologies in the drone's intelligent flight control system and is crucial for achieving autonomous takeoff in complex environments.
[0066] S4. Adjust the speed of each rotor of the drone to the corresponding target speed based on the control signal to control the drone to perform the takeoff mission;
[0067] Specifically, for step S4, the control signal is the output of the flight control system, which is used to directly drive the rotor of the drone to adjust to the required target speed. According to the take-off mode and the target speed calculated by the dynamic model, the control system generates a corresponding control signal, and adjusts the rotation speed of each rotor through the electronic speed controller (ESC). The adjustment of the rotor speed directly affects the thrust and lift of the drone. By accurately controlling the rotor speed, the drone can obtain enough lift to overcome gravity and achieve a smooth take-off. Asymmetric adjustment of the rotor speed can change the attitude of the drone. For example, increasing the speed of certain rotors can cause the drone to pitch or roll to adapt to the tilt angle during take-off.
[0068] In addition, real-time flight data acquired by sensors can be fed back to the control system, which dynamically adjusts the control signal based on the deviation between the actual flight state and the target state. The control system of the drone also needs to be able to adapt to different environmental conditions, such as wind speed and direction, and compensate for the impact of the environment on flight by adjusting the rotor speed.
[0069] Through the above steps, the UAV's flight control system can accurately adjust the rotor speed and generate and execute control signals to ensure that the UAV can safely and effectively perform the task of taking off from a tilted surface according to the target takeoff mode.
[0070] The UAV flight control method provided in this embodiment can accurately control the UAV take-off process by determining the target take-off mode according to the initial posture and tilt angle; the UAV can adapt to different take-off conditions, including different initial postures and tilt angles, which enhances the flexibility of the flight mission and achieves the effect of taking off from an inclined surface; and the stability of the UAV during take-off is ensured by adjusting the rotor speed to match the target speed. It can be seen that the UAV flight control method provided in this embodiment improves the success rate of flight missions, especially take-off missions in complex or disaster situations, and provides strong support for the safe and effective flight of UAVs under diverse conditions.
[0071] Furthermore, in some embodiments, after controlling the drone to perform a take-off mission, the drone flight control method may further include:
[0072] Real-time acquisition of the real-time state vector of the UAV during the take-off mission;
[0073] Based on the real-time state vector and the reference state vector, a corresponding error signal is generated;
[0074] The control parameters of the UAV are adjusted in real time based on the error signal.
[0075] Specifically, after the drone is controlled to start taking off, the drone flight control method provided in this embodiment may further include real-time monitoring and real-time adjustment steps, and the specific process is as follows: during the drone take-off process, real-time data on the drone speed, attitude, position and altitude are continuously collected to form a real-time state vector; a reference state vector is set, where the reference state vector is a set of predefined ideal state data, which is used to compare with the real-time state vector to determine whether the current flight state of the drone meets expectations; by comparing the real-time state vector and the reference state vector, the difference between the two is calculated to generate an error signal, which reflects the degree of deviation of the drone flight state; using the error signal, the control system dynamically adjusts the flight control parameters of the drone, which may include adjusting the rotor speed, changing the flight path or other control inputs to reduce the error. This process forms a closed-loop control system, in which the real-time state of the drone is used as feedback to continuously optimize the control input to ensure that the drone flies according to the predetermined trajectory.
[0076] Through real-time monitoring and real-time adjustment of control parameters, the UAV is more likely to successfully complete takeoff and subsequent flight missions, especially in complex or changing environments. This enhances the intelligence and adaptability of the UAV flight control system and provides a strong guarantee for the UAV to safely and accurately perform takeoff and flight missions.
[0077] Furthermore, in some embodiments, the drone flight control method further includes:
[0078] If it is detected that the real-time state vector meets the preset hovering condition, a mode switching signal is generated;
[0079] In response to the mode switching signal, determining a hovering control signal based on a real-time state vector;
[0080] The control parameters of the UAV are adjusted based on the hovering control signal so that the UAV performs the hovering task according to the control parameters.
[0081] Specifically, after controlling the drone to take off, the real-time state vector of the drone itself is obtained in real time, including but not limited to parameters such as position, speed, attitude and altitude; an error signal is generated based on the difference between the state vector obtained in real time and the preset reference state vector (desired hovering state); based on the error signal and the preset hovering conditions (such as position error, height threshold and attitude threshold), it is judged whether the drone meets the hovering requirements. When the drone meets the hovering conditions, the control system generates a mode switching signal to instruct the drone to switch from take-off mode to hovering mode. At the same time, based on the real-time state vector and hovering conditions of the drone, the control system determines the control signals required for hovering, which may include precise control of rotor speed, thrust and torque to achieve stable hovering.
[0082] After determining that it is necessary to switch to hovering mode, the control system responds to the mode switching signal and adjusts the control parameters of the drone in real time to adapt to the hovering state; and by adjusting the control parameters, the drone enters and maintains the hovering state. The control system needs to continuously monitor and adjust to counteract external disturbances, such as wind speed changes.
[0083] This embodiment provides a comprehensive UAV flight control method, which achieves a smooth transition from take-off to hovering by real-time monitoring and adjusting the UAV status, ensuring the stability and safety of the flight and improving the accuracy and reliability of mission execution.
[0084] Furthermore, in some embodiments, the preset hovering condition includes a position error, a height threshold, and a posture threshold. The UAV flight control method in this embodiment also includes:
[0085] Calculate the current position information, altitude information and attitude information of the drone based on the real-time state vector;
[0086] Check whether the position information, height information and attitude information meet the preset hovering conditions.
[0087] Specifically, the preset hovering conditions in this embodiment may include but are not limited to one or more of position error, height threshold and attitude threshold, which define the accuracy and stability standards required for the drone to reach the hovering state. Based on the sensor data of the drone, the current position information, height information and attitude information of the drone are calculated in real time, and the calculated current state is compared with the preset hovering conditions to determine whether the drone is already in or close to the hovering state. Among them, key state components such as position, height and attitude are extracted from the real-time state vector, which are the basis for judging whether the hovering conditions are met. Then, the error between the current state and the hovering condition is evaluated. If the error is within an acceptable range, the drone can enter the hovering mode; if the error exceeds the threshold, further adjustment is required. According to whether the hovering conditions are met, the control strategy of the drone is adjusted. If the conditions are met, the hovering control signal is executed; if not, the flight parameters are continued to be adjusted to reduce the error. This embodiment provides an accurate and reliable hovering control method for the drone by clarifying the hovering conditions and realizing real-time monitoring and evaluation, ensuring the smooth execution of the flight mission.
[0088] Further, in some embodiments, determining the hovering control signal based on the real-time state vector includes:
[0089] Extracting a target component from a real-time state vector;
[0090] Determine position information based on the target component, and determine altitude information and pitch angle information based on a proportional-derivative controller;
[0091] A hover control signal is determined based on the position information, the altitude information, and the pitch angle information.
[0092] Specifically, a real-time state vector is extracted from the sensor data of the drone, which contains information such as the current position, speed, attitude and altitude of the drone. The key target components are extracted from the real-time state vector, which are crucial for the hovering control of the drone. Based on the target components, the current position information of the drone is calculated, and the position information is a key parameter that needs to be accurately maintained in hovering control. A proportional differential controller (PD controller) is used to determine the altitude information and pitch angle information of the drone. The PD controller adjusts the control input through proportional and differential links to reduce errors and improve the stability of the system. Finally, the position information, altitude information and pitch angle information are combined to generate hovering control signals, which will be used to adjust the rotor speed of the drone to achieve stable hovering. In the specific implementation process, the flight control system dynamically adjusts the flight parameters of the drone according to the hovering control signal to ensure that the drone can hover stably at the specified position and altitude. Through precise control signal generation and real-time adjustment, the safety and stability of the drone in the hovering state are ensured, providing a reliable flight platform for performing various tasks.
[0093] This embodiment improves the intelligence and automation level of the UAV flight control system by generating a hovering control signal, ensuring that the UAV can achieve precise and stable hovering under various conditions.
[0094] Furthermore, in some embodiments, the drone flight control method further includes:
[0095] Based on the equipment parameters of the UAV, the corresponding UAV dynamics model is constructed;
[0096] Based on the UAV dynamics model, a dynamic hybrid system for the UAV to take off from an inclined surface is constructed. The dynamic hybrid system includes control strategies corresponding to the take-off mode and the hovering mode respectively.
[0097] Specifically, before implementing the UAV flight control method provided in this embodiment, this embodiment also provides the construction of a UAV dynamics model and a dynamic hybrid system, including constructing a dynamic model based on the equipment parameters of the UAV, and establishing a dynamic hybrid system based on the model, which includes control strategies corresponding to the take-off mode and the hovering mode. First, the equipment parameters of the UAV, such as rotor speed, motor characteristics, center of mass position, mass, size, etc., are used for detailed analysis to provide basic data for establishing an accurate dynamic model. Then, according to the physical characteristics and flight principles of the UAV, a mathematical model is constructed, which can describe the power, stability and control response of the UAV in flight. Next, using the constructed dynamic model, a dynamic hybrid system is developed, which can simulate the entire process of the UAV taking off from an inclined surface to hovering. The dynamic hybrid system includes a control strategy for the take-off mode and a control strategy for the hovering mode. The former designs a specific control strategy for the take-off mode to ensure that the UAV can safely take off from various surfaces according to the initial posture and tilt angle, and the latter designs a control strategy for the hovering mode, so that the UAV can accurately maintain its position and height after reaching a certain height to achieve stable hovering. The control strategies for takeoff and hovering modes are integrated into the flight control system to ensure smooth transition and stable control of the drone throughout the flight process. The dynamic hybrid system can adapt to different environmental conditions and ensure safe takeoff and stable hovering of the drone under various initial conditions. By building an accurate dynamic model and designing an effective control strategy, the accuracy, stability and environmental adaptability of the drone's flight control are improved.
[0098] In this embodiment, a quadcopter is selected as the research object. Due to its flexibility and portability, it is equipped with rotors in the experiment. The four rotors are marked 1 to 4, symmetrically distributed at the same level in the fuselage, and have the same structure and radius. It is assumed that roter1 and roter3 rotate counterclockwise, and roter2 and roter4 rotate clockwise. The flight control computer and external devices are placed in the middle of the quadcopter bracket. The quadcopter achieves changes in lift by changing the speed of the rotors, thereby controlling its attitude and position. Figure 2 The thrust vectors and directions of rotation of the four rotors are shown.
[0099] Next, a simulation system for the quadcopter during takeoff is constructed, which models the quadcopter control in a closed-loop PD control structure.
[0100]
[0101] The quadcopter has four control loops, namely the position control loop, attitude control loop, altitude control loop and yaw control loop. The input of the quadcopter is the speed of the four rotors, and the output of the quadcopter is the state vector, which is then fed back to the input variable to generate an error signal.
[0102] Then, construct a dynamic hybrid system such as Figure 3 As shown, Figure 3 A simplified model of a quadcopter placed on an inclined plane.
[0103] The dashed lines show the quadcopter taking off from surfaces at different angles, the level θ is described as a state variable in quadcopter coordinates, and the pitch angle is considered as the rotation angle around the quadcopter's y-axis.
[0104] Due to the symmetry of the quadcopter, this embodiment only proposes a takeoff maneuver, in which the rotation occurs on one side, resulting in θ ≥ 0. α, γ are described as the rotation angles around the x-axis and z-axis of the quadcopter, h is the height at which the quadcopter maintains its initial attitude to avoid the rotor falling to the surface, and the error variable can be written as the difference between the expected variable and the test value, as shown in the following formula:
[0105]
[0106] Among them, θ q , α q , β q is the component extracted from the state vector x. The calculation of h is similar to Figure 1 is related to d in , where d is the distance from the quadcopter motor to the center of mass.
[0107]
[0108] This embodiment considers that the condition is satisfied when the error is less than 0.01. In other words, only when the equation satisfies condition 3, the quadcopter can switch from the take-off mode to the hovering mode.
[0109]
[0110] Δ is defined as a point increment that ensures safety.
[0111] The following sections provide an in-depth look at the takeoff and hover modes used by the hybrid framework.
[0112] Further, in some embodiments, determining the target take-off mode of the drone based on the initial posture and the initial tilt angle includes:
[0113] If the initial tilt angle is greater than 0 and not greater than a preset first threshold, determining that the target takeoff mode of the drone is the first takeoff mode;
[0114] If the initial tilt angle is greater than a preset first threshold value and not greater than a preset second threshold value, determining that the target takeoff mode of the drone is the second takeoff mode;
[0115] If the initial tilt angle is greater than the preset second threshold value and not greater than the preset third threshold value, it is determined that the drone cannot take off directly at present.
[0116] Specifically, the take-off modes of the drone in this embodiment include three types, that is, the take-off modes are divided into three types of quadcopters that usually take off from different surfaces. In the first case, when the condition is met Time
[0117]
[0118] In the takeoff mode, the pitch angle θ can be maintained. , so that the pitch angle θ is maintained only during the first takeoff. After a period of time, the quadcopter starts to fly under the specified conditions, that is, At this point, the most important thing for the controller is to ensure that the quadcopter does not hit the slope. In the case of , the quadcopter cannot take off because the pitch angle is too large. Each type corresponds to a different controller design and is controlled by a proportional differential controller.
[0119] where τ p ,τ r ,τ y represents the pitch, roll and yaw torque required by the fuselage, T refers to the thrust, and ω0 is the rotor speed.
[0120] Regarding the quadcopter suspension, the hovering mode in this embodiment aims to achieve two points, the first point is to change the attitude to horizontal, and the second point is to hover above a fixed point. The four components (x, y, z, θ) extracted from the state vector x are controlled by the PD controller. The xy position error is calculated in the world coordinate system and rotated by the rotation matrix. The height is controlled by the proportional differential controller.
[0121]
[0122] The pitch angle is controlled by a proportional-derivative controller.
[0123]
[0124] like Figure 4 As shown, Figure 4 Indicates the two modes of the quadcopter. Block A is the take-off mode, which assumes that the quadcopter is flying at a fixed angle; block B is the hovering mode, which assumes that the quadcopter adjusts its attitude to a horizontal level and then hovers at a point. The different states of the hybrid frame correspond to Figure 4 The two modes considered for the quadcopter shown, where q is described as the mode variable. The takeoff mode switches immediately to the hovering mode once the transition condition is met. The condition is defined as the error between the actual value and the desired value.
[0125] In summary, the UAV flight control method provided in this embodiment can automatically determine the target takeoff mode according to the initial attitude and tilt angle, and adapt to different takeoff environments, including inclined surfaces in disaster situations. By calculating and generating control signals, the target speed of each rotor is accurately adjusted to ensure that the UAV rotor provides appropriate lift and thrust to achieve stable takeoff. By intelligently selecting the takeoff mode and accurately controlling the rotor speed, the risk of collision or damage that may occur during takeoff is reduced, especially in complex or disaster environments. During takeoff, the UAV status is obtained in real time, and the control parameters are adjusted in time to ensure that the UAV flies according to the predetermined trajectory, thereby improving the success rate of the flight mission. In combination with a hybrid control system and a dynamic hybrid model, an innovative flight control strategy is provided to improve the flight performance and mission execution capabilities of the UAV in a variety of environments.
[0126] In order to better implement the UAV flight control method of the embodiment of the present application, the embodiment of the present application also provides a UAV flight control device. The meanings of the terms are the same as those in the above UAV flight control method, and the specific implementation details can refer to the description in the method embodiment.
[0127] See also Figure 5 , Figure 5A schematic diagram of the structure of a UAV flight control device provided in an embodiment of the present application, wherein the UAV flight control device may specifically include an acquisition module 201, a first determination module 202, a second determination module 203 and an adjustment module 204, which may be specifically as follows:
[0128] The acquisition module 201 is used to acquire the initial attitude and initial tilt angle of the UAV;
[0129] A first determination module 202 is used to determine a target takeoff mode of the UAV based on an initial attitude and an initial tilt angle;
[0130] The second determination module 203 is used to determine the target speed corresponding to each rotor of the UAV based on the target takeoff mode, and generate a corresponding control signal;
[0131] The adjustment module 204 is used to adjust the speed of each rotor of the drone to a corresponding target speed based on the control signal, so as to control the drone to perform a take-off mission.
[0132] The UAV flight control device provided in this embodiment obtains the initial posture and initial tilt angle of the UAV through the acquisition module 201, and then determines the target take-off mode of the UAV based on the initial posture and initial tilt angle through the first determination module 202; determines the target speed corresponding to each rotor of the UAV based on the target take-off mode through the second determination module 203, and generates a corresponding control signal; finally, the speed of each rotor of the UAV is adjusted to the corresponding target speed based on the control signal through the adjustment module 204 to control the UAV to perform the take-off task. In the UAV flight control scheme provided in this embodiment, the take-off strategy can be automatically adjusted according to the tilt angle to ensure that the rotor does not contact the surface, reduce the risk of equipment damage caused by improper take-off, solve the problem of UAV taking off from an inclined surface in disaster situations, and effectively improve the flexibility and safety of UAV flight in disaster situations.
[0133] In addition, the present application also provides an electronic device, such as Figure 6 , which shows a schematic diagram of the structure of an electronic device involved in an embodiment of the present application. Specifically, the electronic device may include a processor 301 with one or more processing cores, a memory 302 with one or more computer-readable storage media, a power supply 303, an input unit 304 and other components. Those skilled in the art can understand that Figure 6 The electronic device structure shown in the figure does not constitute a limitation on the electronic device, and may include more or fewer components than shown in the figure, or combine certain components, or arrange the components differently.
[0134] The processor 301 is the control center of the electronic device. It uses various interfaces and lines to connect various parts of the entire electronic device. By running or executing software programs and / or modules stored in the memory 302, and calling data stored in the memory 302, it executes various functions of the electronic device and processes data, thereby monitoring the electronic device as a whole. Optionally, the processor 301 may include one or more processing cores; preferably, the processor 301 may integrate an application processor and a modem processor, wherein the application processor mainly processes the operating system, user interface, and application programs, and the modem processor mainly processes wireless communications. It is understandable that the above-mentioned modem processor may not be integrated into the processor 301.
[0135] The memory 302 can be used to store software programs and modules. The processor 301 executes various functional applications and unmanned aerial vehicle flight control methods by running the software programs and modules stored in the memory 302. The memory 302 may mainly include a program storage area and a data storage area, wherein the program storage area may store an operating system, an application required for at least one function (such as a sound playback function, an image playback function, etc.), etc.; the data storage area may store data created according to the use of the electronic device, etc. In addition, the memory 302 may include a high-speed random access memory, and may also include a non-volatile memory, such as at least one disk storage device, a flash memory device, or other volatile solid-state storage devices. Accordingly, the memory 302 may also include a memory controller to provide the processor 301 with access to the memory 302.
[0136] The electronic device also includes a power supply 303 for supplying power to each component. Preferably, the power supply 303 can be logically connected to the processor 301 through a power management system, so that the power management system can manage charging, discharging, power consumption and other functions. The power supply 303 can also include one or more DC or AC power supplies, recharging systems, power failure detection circuits, power converters or inverters, power status indicators and other arbitrary components.
[0137] The electronic device may further include an input unit 304, which may be used to receive input digital or character information and generate keyboard, mouse, joystick, optical or trackball signal input related to user settings and function control.
[0138] Although not shown, the electronic device may further include a display unit, etc., which will not be described in detail herein. Specifically in this embodiment, the processor 301 in the electronic device will load the executable files corresponding to the processes of one or more application programs into the memory 302 according to the following instructions, and the processor 301 will run the application programs stored in the memory 302, thereby realizing various functions, as follows:
[0139] Based on the initial posture and the initial tilt angle, the target take-off mode of the UAV is determined; based on the target take-off mode, the target speed corresponding to each rotor of the UAV is determined, and a corresponding control signal is generated; based on the control signal, the speed of each rotor of the UAV is adjusted to the corresponding target speed to control the UAV to perform the take-off mission.
[0140] The specific implementation of the above operations can be found in the previous embodiments, which will not be described in detail here.
[0141] The embodiment of the present application can automatically adjust the take-off strategy according to the tilt angle, ensure that the rotor does not contact the surface, reduce the risk of equipment damage due to improper take-off, and solve the problem of UAV taking off from tilted surfaces in disaster situations, thereby effectively improving the flexibility and safety of UAV flight in disaster situations.
[0142] A person of ordinary skill in the art will appreciate that all or part of the steps in the various methods of the above embodiments may be completed by instructions, or by controlling related hardware through instructions. The instructions may be stored in a computer-readable storage medium and loaded and executed by a processor.
[0143] To this end, an embodiment of the present application provides a storage medium in which a plurality of instructions are stored, and the instructions can be loaded by a processor to execute the steps in any of the UAV flight control methods provided in the embodiments of the present application. For example, the instructions can execute the following steps:
[0144] Based on the initial posture and the initial tilt angle, the target take-off mode of the UAV is determined; based on the target take-off mode, the target speed corresponding to each rotor of the UAV is determined, and a corresponding control signal is generated; based on the control signal, the speed of each rotor of the UAV is adjusted to the corresponding target speed to control the UAV to perform the take-off mission.
[0145] The specific implementation of the above operations can be found in the previous embodiments, which will not be described in detail here.
[0146] The storage medium may include: a read-only memory (ROM), a random access memory (RAM), a disk or an optical disk, etc. Since the instructions stored in the storage medium can execute the steps in any of the UAV flight control methods provided in the embodiments of the present application, the beneficial effects that can be achieved by any of the UAV flight control methods provided in the embodiments of the present application can be achieved. For details, please refer to the previous embodiments and will not be repeated here.
[0147] The above is a detailed introduction to a drone flight control method, device, electronic device and storage medium provided in the embodiments of the present application. Specific examples are used in this article to illustrate the principles and implementation methods of the present application. The description of the above embodiments is only used to help understand the method of the present application and its core idea; at the same time, for technical personnel in this field, according to the ideas of the present application, there will be changes in the specific implementation methods and application scopes. In summary, the content of this specification should not be understood as a limitation on the present application.
Claims
1. A UAV flight control method, It is characterized in that The steps include: Get the initial attitude and initial tilt angle of the drone; Determining a target takeoff mode of the UAV based on the initial posture and the initial tilt angle; Based on the target takeoff mode, determining the target speed corresponding to each rotor of the UAV and generating a corresponding control signal; Based on the control signal, the speed of each rotor of the UAV is adjusted to the corresponding target speed to control the UAV to perform a take-off mission.
2. The UAV flight control method according to claim 1, It is characterized in that After controlling the drone to perform a takeoff mission, the method further includes: Acquire the real-time state vector of the UAV during the take-off mission in real time; Based on the real-time state vector and the reference state vector, generating a corresponding error signal; The control parameters of the UAV are adjusted in real time based on the error signal.
3. The UAV flight control method according to claim 2, It is characterized in that The method further comprises: If it is detected that the real-time state vector meets the preset hovering condition, a mode switching signal is generated; In response to the mode switching signal, determining a hovering control signal based on the real-time state vector; The control parameters of the UAV are adjusted based on the hovering control signal so that the UAV performs the hovering task according to the control parameters.
4. The UAV flight control method according to claim 3, It is characterized in that The preset hovering condition includes a position error, a height threshold and a posture threshold, and the method further includes: Calculate the current position information, altitude information and attitude information of the drone based on the real-time state vector; Detect whether the position information, the height information, and the posture information meet a preset hovering condition.
5. The UAV flight control method according to claim 3, It is characterized in that The determining of the hovering control signal based on the real-time state vector comprises: extracting a target component from the real-time state vector; Determining position information based on the target component, and determining altitude information and pitch angle information based on a proportional-derivative controller; A hovering control signal is determined based on the position information, the altitude information, and the pitch angle information.
6. The UAV flight control method according to claim 1, It is characterized in that Also includes: Based on the equipment parameters of the UAV, a corresponding UAV dynamics model is constructed; A dynamic hybrid system for the UAV to take off from an inclined surface is constructed based on the UAV dynamics model, and the dynamic hybrid system includes control strategies corresponding to a take-off mode and a hovering mode, respectively.
7. The UAV flight control method according to claim 1, It is characterized in that The step of determining a target takeoff mode of the UAV based on the initial posture and the initial tilt angle includes: If the initial tilt angle is greater than 0 and not greater than a preset first threshold, determining that the target take-off mode of the drone is the first take-off mode; If the initial tilt angle is greater than a preset first threshold value and not greater than a preset second threshold value, determining that the target take-off mode of the drone is the second take-off mode; If the initial tilt angle is greater than the preset second threshold value and not greater than the preset third threshold value, it is determined that the drone is currently unable to take off directly.
8. A UAV flight control device, It is characterized in that include: The acquisition module is used to obtain the initial attitude and initial tilt angle of the drone; A first determination module, configured to determine a target takeoff mode of the UAV based on the initial posture and the initial tilt angle; A second determination module is used to determine the target speed corresponding to each rotor of the UAV based on the target take-off mode, and generate a corresponding control signal; The adjustment module is used to adjust the speed of each rotor of the UAV to the corresponding target speed based on the control signal, so as to control the UAV to perform a take-off mission.
9. An electronic device, It is characterized in that include: A memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes the program according to the steps of the UAV flight control method as described in any one of claims 1 to 7.
10. A storage medium, It is characterized in that A computer program is stored which can be loaded by a processor and execute the UAV flight control method as described in any one of claims 1 to 7.
Citation Information
Cited By
Real-time trajectory prediction system and method for unmanned aerial vehicle
CN119781525A
A real-time trajectory prediction system and method for unmanned aerial vehicles
CN119781525B
Inclined plane take-off and landing method and system of tilting four-rotor air-ground unmanned aerial vehicle
CN120215547A
A method and system for inclined take-off and landing of a tilt-rotating quadrotor land-to-air drone
CN120215547B
Aircraft control method and system, and aircraft, control terminal and storage medium
WO2026152346A1
