WO2024087271A1 - Aéronef à rotors multiples, son procédé de commande, dispositif, et support de stockage lisible par ordinateur - Google Patents

Aéronef à rotors multiples, son procédé de commande, dispositif, et support de stockage lisible par ordinateur Download PDF

Info

Publication number
WO2024087271A1
WO2024087271A1 PCT/CN2022/133003 CN2022133003W WO2024087271A1 WO 2024087271 A1 WO2024087271 A1 WO 2024087271A1 CN 2022133003 W CN2022133003 W CN 2022133003W WO 2024087271 A1 WO2024087271 A1 WO 2024087271A1
Authority
WO
WIPO (PCT)
Prior art keywords
rotor
control
matrix
vector
efficiency matrix
Prior art date
Application number
PCT/CN2022/133003
Other languages
English (en)
Chinese (zh)
Inventor
沈阳
陶永康
张均
苏江城
段鹏
王磊
周英
Original Assignee
广东汇天航空航天科技有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 广东汇天航空航天科技有限公司 filed Critical 广东汇天航空航天科技有限公司
Publication of WO2024087271A1 publication Critical patent/WO2024087271A1/fr

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10—Simultaneous control of position or course in three dimensions
    • G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft

Definitions

  • the present application relates to the field of aircraft control, and in particular to a multi-rotor aircraft and a control method, device, and computer-readable storage medium thereof.
  • the main purpose of the present application is to provide a control method and device for a multi-rotor aircraft, and a computer-readable storage medium, aiming to solve the technical problem of poor power failure fault-tolerant control of multi-rotor drones.
  • the present application provides a control method for a multi-rotor aircraft, the control method for a multi-rotor aircraft comprising:
  • control efficiency matrix If the control efficiency matrix satisfies the preset speed distribution condition, obtaining a control distribution matrix corresponding to the control efficiency matrix;
  • the rotation speed corresponding to each of the rotors is adjusted based on the rotation speed vector, and the step of returning to execute, based on the current operating state of the multi-rotor UAV, determining the control efficiency matrix corresponding to each rotor in the rotor system of the multi-rotor UAV.
  • the step of determining a rotation speed vector corresponding to the rotor system based on the control allocation matrix comprises:
  • the rotation speed vector is determined based on the virtual control vector to be allocated and the control allocation matrix.
  • the step of determining the rotation speed vector based on the virtual control vector to be allocated and the control allocation matrix comprises:
  • a rotation speed vector corresponding to the rotor system is determined.
  • the step of obtaining the maximum virtual control vector corresponding to the rotor system based on the virtual control vector to be allocated comprises:
  • the maximum virtual control vector corresponding to the rotor system is obtained.
  • the method further comprises:
  • the remaining allocatable maximum rotation speed is set as the preset maximum rotation speed, and the remaining allocatable minimum rotation speed is set as the preset minimum rotation speed.
  • the step of obtaining a control distribution matrix corresponding to the manipulation efficiency matrix comprises:
  • the product matrix is reversible, it is determined that the manipulation efficiency matrix satisfies a preset speed distribution condition, and a control distribution matrix corresponding to the manipulation efficiency matrix is obtained.
  • the step of obtaining a control allocation matrix corresponding to the manipulation efficiency matrix comprises:
  • the step of adjusting the rotational speed corresponding to each of the rotors based on the rotational speed vector comprises:
  • the rotation speed corresponding to each of the rotors is adjusted.
  • the step of determining the control efficiency matrix corresponding to each rotor in the rotor system of the multi-rotor UAV based on the current operating state of the multi-rotor UAV comprises:
  • the steering efficiency matrix is determined based on a conventional steering efficiency matrix and the health factor.
  • the current operating state includes the current of the motor corresponding to each of the rotors or the rotational speed of each of the rotors.
  • the present application also provides a multi-rotor aircraft, the multi-rotor aircraft comprising:
  • a first determination module is used to determine a control efficiency matrix corresponding to each rotor in a rotor system of the multi-rotor UAV based on a current operating state of the multi-rotor UAV;
  • an acquisition module configured to acquire a control allocation matrix corresponding to the manipulation efficiency matrix if the manipulation efficiency matrix satisfies a preset speed allocation condition
  • a second determination module is used to determine a rotation speed vector corresponding to the rotor system based on the control allocation matrix, wherein the rotation speed vector includes a rotation speed to be allocated corresponding to each of the rotors;
  • An adjustment module is used to adjust the speed corresponding to each of the rotors based on the speed vector, and return to execute the step of determining the control efficiency matrix corresponding to each rotor in the rotor system of the multi-rotor UAV based on the current operating state of the multi-rotor UAV
  • An embodiment of the present application also proposes a multi-rotor UAV device, which includes a memory, a processor, and computer-readable instructions stored in the memory and executable on the processor, and the computer-readable instructions, when executed by the processor, implement the steps of the control method of the multi-rotor aircraft as described above.
  • An embodiment of the present application further provides a computer-readable storage medium having computer-readable instructions stored thereon.
  • the computer-readable instructions are executed by a processor, the steps of the control method for the multi-rotor aircraft as described above are implemented.
  • the present application determines the control efficiency matrix corresponding to each rotor in the rotor system of the multi-rotor UAV based on the current operating state of the multi-rotor UAV. If the control efficiency matrix satisfies a preset speed distribution condition, a control allocation matrix corresponding to the control efficiency matrix is obtained. Then, based on the control allocation matrix, a speed vector corresponding to the rotor system is determined, wherein the speed vector includes a speed to be allocated corresponding to each rotor.
  • the speed corresponding to each rotor is adjusted, and the step of determining the control efficiency matrix corresponding to each rotor in the rotor system of the multi-rotor UAV based on the current operating state of the multi-rotor UAV is returned to execute.
  • the manipulation efficiency matrix and the control allocation matrix are used to allocate excess rotation speed to the rotor, so as to better control the rotor rotation speed and stabilize the flight state of the multi-rotor UAV.
  • the rotor speed can be adjusted in real time to obtain sufficient power, which improves the effect of the fault-tolerant control of the multi-rotor UAV power failure and improves the stability of the multi-rotor UAV flight process.
  • FIG1 is a schematic diagram of the structure of a control device for a multi-rotor aircraft in a hardware operating environment involved in an embodiment of the present application;
  • FIG2 is a schematic diagram of a flow chart of a first embodiment of a multi-rotor aircraft control method of the present application
  • FIG3 is a schematic diagram of the control configuration of the multi-rotor aircraft of the present application.
  • FIG. 4 is a schematic diagram of functional modules of an embodiment of a multi-rotor aircraft control device of the present application.
  • FIG. 1 is a schematic diagram of the structure of a multi-rotor aircraft control device in a hardware operating environment involved in an embodiment of the present application.
  • the multi-rotor aircraft control device of the embodiment of the present application may be a PC.
  • the multi-rotor aircraft control device may include: a processor 1001, such as a CPU, a network interface 1004, a user interface 1003, a memory 1005, and a communication bus 1002.
  • the communication bus 1002 is used to realize the connection and communication between these components.
  • the user interface 1003 may include a display screen (Display), an input unit such as a keyboard (Keyboard), and the optional user interface 1003 may also include a standard wired interface and a wireless interface.
  • the network interface 1004 may optionally include a standard wired interface and a wireless interface (such as a WI-FI interface).
  • the memory 1005 may be a high-speed RAM memory, or a stable memory (non-volatile memory), such as a disk memory.
  • the memory 1005 may also be a storage device independent of the aforementioned processor 1001.
  • the multi-rotor aircraft control device may also include a camera, an RF (Radio Frequency) circuit, a sensor, an audio circuit, a WiFi module, etc.
  • sensors such as light sensors, motion sensors and other sensors are not described here.
  • terminal structure shown in FIG. 1 does not constitute a limitation on the multi-rotor aircraft control device, and may include more or fewer components than shown, or a combination of certain components, or a different arrangement of components.
  • the memory 1005 as a computer storage medium may include an operating system, a network communication module, a user interface module, and computer-readable instructions.
  • the network interface 1004 is mainly used to connect to the background server and communicate data with the background server;
  • the user interface 1003 is mainly used to connect to the client (user end) and communicate data with the client;
  • the processor 1001 can be used to call the computer-readable instructions stored in the memory 1005.
  • the multi-rotor aircraft control device includes: a memory 1005, a processor 1001, and computer-readable instructions stored in the memory 1005 and executable on the processor 1001, wherein the processor 1001 calls the computer-readable instructions stored in the memory 1005 and executes the steps of the multi-rotor aircraft control method in the following embodiments.
  • the present application also provides a method, referring to FIG. 2 , which is a flow chart of a first embodiment of a control method for a multi-rotor aircraft of the present application.
  • the control method of the multi-rotor aircraft is applied to a multi-rotor UAV, and comprises the following steps:
  • Step S101 based on the current operating state of the multi-rotor UAV, determining the control efficiency matrix corresponding to each rotor in the rotor system of the multi-rotor UAV.
  • a multi-rotor UAV refers to an unmanned rotorcraft with more than 4 rotors.
  • the control efficiency matrix is a matrix that describes the relationship between the UAV control channel and the rotational speed of the multi-rotor UAV.
  • the number of column vectors in the control efficiency matrix is determined by the number of rotors of the multi-rotor UAV, and the number of row vectors is determined by the number of control channels of the UAV.
  • a multi-rotor UAV has 8 propellers and 4 control channels.
  • the 4 control channels control the thrust, rolling moment, pitching moment, and yaw moment respectively.
  • each column represents a propeller, and there are 8 columns in total.
  • the first row represents the contribution of each propeller to the thrust
  • the second row represents the contribution to the rolling moment
  • the third row represents the contribution to the pitching moment
  • the fourth row represents the contribution to the yaw moment.
  • the electronic control of the multi-rotor UAV monitors the operating status of the multi-rotor UAV in real time, including the current/speed in the motor/rotor, etc.
  • the operating status of the motor/rotor system can be evaluated in the form of a numerical ratio, for example, the current speed/expected speed, the current tension/theoretical tension at the current speed. If the current motor/rotor operates as expected, it is represented by 1. If the motor/rotor does not operate as expected, it is represented by a numerical ratio, and a complete failure is 0.
  • the range of the numerical ratio can be set to 0 to 1, and the current speed/expected speed or current tension/theoretical tension at the current speed of each rotor is used as a row vector, and the number of control channels is used as a column vector to determine the control efficiency matrix corresponding to each rotor in the rotor system of the multi-rotor UAV.
  • each propeller in the control efficiency matrix of a multi-rotor drone in normal flight is operating normally, providing stable force for each control channel of the multi-rotor drone. If the current/speed provided by the motor/rotor changes, such as insufficient energy, resulting in insufficient current, or damage to the rotor, resulting in its speed not being able to provide the required force, the control efficiency matrix will change.
  • the control efficiency matrix of the rotor drone must be re-determined.
  • the control efficiency matrix corresponding to each rotor in the rotor system is determined, which realizes the control of the specific power situation of the drone flight, and can better understand the power situation of the drone, so as to maintain the stability of the drone in the future.
  • Step S102 if the control efficiency matrix satisfies a preset speed distribution condition, a control distribution matrix corresponding to the control efficiency matrix is obtained.
  • the control allocation matrix is used to calculate the speed distribution matrix that each propeller needs to allocate.
  • the control efficiency matrix can be converted into a control allocation matrix by inverting the control efficiency matrix, that is, the control allocation matrix is the inverse matrix of the control efficiency matrix. If the control efficiency matrix cannot be inverted, the control efficiency matrix cannot be obtained. Therefore, whether the control efficiency matrix can be inverted is used as a preset speed distribution condition, and the control efficiency matrix is inverted in real time to obtain the control allocation matrix.
  • CW Lockwise
  • CCW Counter Clockwise
  • motors/rotors 1/4/6/7 are the right motors/rotors of the multi-rotor drone
  • motors/rotors 2/3/5/8 are the left motors/rotors of the multi-rotor drone
  • x and y are vector axes.
  • the control allocation matrix cannot be obtained through the control efficiency matrix, and then there is no adjustment of the speed of the remaining propellers.
  • the control efficiency matrix does not meet the preset speed allocation conditions, but assuming that motors 5/6/7/8 fail completely, that is, the upper four propellers stop rotating, then the lower four propellers can still maintain balance, and the flight of the multi-rotor drone can be stabilized by controlling the speed of the rotors.
  • the control allocation matrix can be calculated through the control efficiency matrix at this time, that is, the preset speed allocation conditions are met, and the control efficiency matrix can be inverted to obtain the control allocation matrix.
  • the corresponding control distribution matrix is obtained, which enables precise control of the multi-rotor UAV's control distribution speed.
  • the obtained control distribution matrix can greatly improve the accuracy of subsequent rotor speed distribution.
  • Step S103 determining a rotation speed vector corresponding to the rotor system based on the control allocation matrix, wherein the rotation speed vector includes rotation speeds to be allocated corresponding to each of the rotors.
  • the speed vector includes the speed size and speed direction allocated to each rotor; the speed to be allocated refers to the speed amount that each rotor needs to increase or decrease at the current speed.
  • the motor/rotor changes, which in turn changes the control efficiency matrix and the control allocation matrix.
  • the current rotation speed of some rotors needs to be adjusted.
  • the changes of motors/rotors of multi-rotor drones during flight may be continuous, the control efficiency matrix may also be constantly changing, and the corresponding control allocation matrix is also changing.
  • the remaining motor throttle of the multi-rotor drone is allocated to the corresponding motor to increase the motor power, or based on the row and column values in the control allocation matrix, all speed vectors to be allocated are allocated to the rotors to be allocated, and the speed vectors corresponding to each rotor are determined.
  • control allocation matrix shows that the expected pulling force of the No. 1 propeller of the multi-rotor drone is 10N, but due to the insufficient speed of the No. 1 propeller, the pulling force provided is only 8N. At this time, based on the control allocation matrix, a part of the allocable speed of the multi-rotor drone is allocated to the No.
  • Step S104 adjusting the rotation speed corresponding to each of the rotors based on the rotation speed vector, and returning to execute the step of determining the control efficiency matrix corresponding to each rotor in the rotor system of the multi-rotor UAV based on the current operating state of the multi-rotor UAV.
  • the corresponding control allocation matrix is obtained by manipulating the efficiency matrix to obtain the speed vector corresponding to the rotor.
  • the rotor system of the multi-rotor UAV After the rotor system of the multi-rotor UAV obtains the speed vector, it adjusts the speed corresponding to the rotor according to the value of the vector. For example, the speed vector of propeller No. 1 changes from +1 to +5, then 4 unit speeds are added to the original rotation direction of propeller No. 1. After the speed of the corresponding rotor is adjusted, it can generate enough force to make the multi-rotor UAV reach the desired operating state. At the same time, as the flight state of the multi-rotor UAV changes, the above steps are repeated to adjust the speed of the rotor.
  • the speed corresponding to the rotor is adjusted so that the rotor can generate enough force, thereby realizing the detection and control of the power situation of the multi-rotor UAV, improving the fault-tolerant control capability of the rotor system to deal with various power situations, and improving the flight stability of the multi-rotor UAV.
  • the control efficiency matrix corresponding to each rotor in the rotor system of the multi-rotor UAV is determined. If the control efficiency matrix meets the preset speed distribution condition, the control distribution matrix corresponding to the control efficiency matrix is obtained. Then, based on the control distribution matrix, the speed vector corresponding to the rotor system is determined, wherein the speed vector includes the speed to be distributed corresponding to each rotor. Finally, the speed corresponding to each rotor is adjusted based on the speed vector, and the step of determining the control efficiency matrix corresponding to each rotor in the rotor system of the multi-rotor UAV based on the current running state of the multi-rotor UAV is returned.
  • the control efficiency matrix and the control distribution matrix are used to distribute excess speed to the rotor, so as to better control the speed of the rotor and stabilize the flight state of the multi-rotor UAV.
  • the rotor speed can be adjusted in real time to obtain sufficient power, thereby improving the flight stability of the multi-rotor UAV and solving the problem of poor fault tolerance control of power failure of the multi-rotor UAV.
  • step S103 a second embodiment of the control method of the multi-rotor aircraft of the present application is proposed, which includes in step S103:
  • Step S201 based on multiple control channels, obtaining a virtual control vector to be allocated corresponding to each of the rotors;
  • Step S202 determining the rotation speed vector based on the virtual control vector to be allocated and the control allocation matrix.
  • the control channel is the channel inside the flight control system that controls the operating status of the multi-rotor drone, such as the thrust control channel, roll control channel, pitch control channel, and yaw control channel.
  • the virtual control vector to be allocated is the control quantity that is expected to be allocated calculated by the flight control system through the control algorithm on the control channel.
  • a typical flight control algorithm generally consists of two parts: a controller and a distributor.
  • the controller mainly generates the expected virtual control vectors to be allocated for the four control channels (including altitude channel, roll channel, pitch channel, and yaw channel) based on instructions and sensor data. It is generally composed of a position loop/velocity loop/attitude loop/angular velocity loop, and is usually implemented using PID algorithm, ADRC algorithm, MPC algorithm, LQR algorithm, etc. These algorithms are roughly the same on aircraft of different configurations and can be shared.
  • step S202 includes:
  • Step a based on the virtual control vector to be allocated, obtaining the maximum virtual control vector corresponding to the rotor system;
  • Step b determining the rotation speed vector corresponding to the rotor system based on the maximum virtual control vector and the control allocation matrix.
  • the maximum virtual control vector refers to the maximum control vector that can be currently allocated to each rotor.
  • the flight control internal control algorithm will calculate the virtual control vectors to be allocated on the four control channels, and then calculate the maximum virtual control vector that each rotor can currently accept, and then calculate the speed vector allocated this time through the following formula:
  • u_i is the speed vector assigned to the i-th rotor
  • B+ is the control allocation matrix
  • vi_i is the maximum virtual control quantity vector of the i-th rotor.
  • the maximum virtual control quantity vector assigned at each step ensures that the speed does not exceed the remaining assignable speed, that is, each step of allocation will always saturate the speed of a certain motor/rotor, which is equivalent to seeking a value on the boundary at each step, which will neither exceed the boundary (the assigned speed is less than the preset maximum speed) nor be within the boundary (the assigned speed is greater than the preset minimum speed).
  • the specific expression is: umin_i ⁇ u_i ⁇ umax_i;
  • step a includes:
  • Step c determining a ratio range corresponding to each of the rotors based on the control allocation matrix, the virtual control vector to be allocated, a preset maximum rotational speed corresponding to each of the rotors, and a preset minimum rotational speed corresponding to each of the rotors, and obtaining a maximum ratio within the ratio range as a first ratio corresponding to each of the rotors;
  • Step d obtaining a maximum virtual control vector corresponding to the rotor system based on the largest first ratio among the first ratios corresponding to the rotors and the virtual control vector to be allocated.
  • the preset maximum speed and the preset minimum speed are the maximum speed and the minimum speed that each rotor can provide.
  • the ratio range is calculated based on the condition that the currently assigned speed is greater than or equal to the preset minimum speed and less than or equal to the preset maximum speed.
  • the first ratio is the largest ratio in the ratio range, which is mainly used as a parameter for calculating the maximum virtual control vector corresponding to the rotor system.
  • v_i k1*v_0;
  • v_i is the maximum virtual control quantity vector of the i-th rotor
  • v_0 is the virtual control vector to be allocated
  • k1 is the first ratio
  • the virtual control vectors to be allocated corresponding to each rotor are obtained, and based on the virtual control vectors to be allocated and the control allocation matrix, the speed vector is determined, thereby realizing the real-time speed control of the multi-rotor UAV, greatly improving the fault tolerance of the power of the multi-rotor UAV rotor during flight, and ensuring its stability during flight.
  • a third embodiment of the control method of the multi-rotor aircraft of the present application is proposed, which, after step b, further includes:
  • Step S301 determining a remaining allocatable maximum speed and a remaining allocatable minimum speed based on a preset maximum speed, a preset minimum speed and a speed vector;
  • Step S302 setting the remaining allocatable maximum speed as a preset maximum speed, and setting the remaining allocatable minimum speed as a preset minimum speed.
  • the remaining allocable maximum speed is the maximum speed value that can be further allocated after the current speed allocation of each rotor
  • the remaining allocable minimum speed is the minimum speed value that can be further allocated after the current speed allocation of each rotor.
  • the multi-rotor drone calculates the speed assigned to each rotor through the control allocation matrix and the virtual control vector to be allocated, because the speed that can be allocated to the multi-rotor drone is limited, each time the speed is allocated to each rotor, the preset maximum speed and the preset minimum speed must be subtracted from the current allocated speed to ensure that the speed allocated in the next round will not exceed the remaining speed.
  • umax_(i+1) is the maximum speed of each rotor at time i+1
  • umin_(i+1) is the minimum speed of each rotor at time i+1
  • umin_(i) is the preset minimum speed of each rotor at time i
  • umax_(i) is the preset maximum speed of each rotor at time i
  • u_i is the speed allocated to each rotor at time i.
  • u_(i+1) is the rotation speed assigned to each rotor at time i+1.
  • the remaining allocatable maximum speed and the remaining allocatable minimum speed are determined, and then the remaining allocatable maximum speed is set as the preset maximum speed, and the remaining allocatable minimum speed is set as the preset minimum speed, so that the speed of each speed distribution will not exceed the remaining allocatable speed, thereby improving the accuracy of speed distribution.
  • step S102 includes:
  • Step S401 based on the manipulation efficiency matrix, obtaining a transposed matrix of the manipulation efficiency matrix, and based on the manipulation efficiency matrix and the transposed matrix, obtaining a product matrix;
  • Step S402 If the product matrix is reversible, determine whether the control efficiency matrix satisfies a preset speed distribution condition, and obtain a control distribution matrix corresponding to the control efficiency matrix.
  • step S402 includes:
  • Step e obtaining the inverse matrix of the product matrix
  • Step f obtaining a control allocation matrix corresponding to the manipulation efficiency matrix based on the inverse matrix and the transposed matrix.
  • BBT is the product matrix
  • (BBT)-1 is the inverse matrix
  • BT is the transposed matrix of the manipulation efficiency matrix
  • B+ is the control allocation matrix
  • the transposed matrix of the control efficiency matrix is obtained, and based on the control efficiency matrix and the transposed matrix, the product matrix is obtained; if the product matrix is reversible, it is determined that the control efficiency matrix satisfies the preset speed distribution condition, and the control distribution matrix corresponding to the control efficiency matrix is obtained, thereby realizing accurate judgment of the speed distribution of the multi-rotor UAV and better clarifying the speed that each rotor currently needs to be allocated.
  • step S104 a fifth embodiment of the control method of the multi-rotor aircraft of the present application is proposed, which includes in step S104:
  • Step S501 obtaining a second ratio corresponding to each of the rotors based on the maximum virtual control vector and the virtual control vector to be allocated, and obtaining an actual allocated rotational speed based on the second ratio and the rotational speed vector;
  • Step S502 adjusting the rotation speed corresponding to each of the rotors based on the actual allocated rotation speed.
  • the second ratio represents that the maximum virtual control vector is a multiple of the virtual control amount to be allocated, and the actual allocated rotational speed is the rotational speed actually allocated to each rotor.
  • the speed vector obtained by each iterative calculation is the maximum virtual control vector that can be allocated under the current power state and its corresponding speed vector.
  • the maximum virtual control vector here refers to the vector with the longest length along the direction of the virtual control vector to be allocated.
  • the virtual control vector v_0 to be allocated is [0.60.1,0.1,0.1]
  • the maximum virtual control vector v_i after a motor fails completely is [0.6,0.1,0.1,0.1]*1.5.
  • the speed corresponding to the distribution of the v_0 virtual control quantity we want to achieve is u_i*v_0/v_i, that is, u_i/1.5 for the above example.
  • the above method can complete the control distribution under the condition of motor failure, and then adjust the speed corresponding to each rotor.
  • the second ratio corresponding to each of the rotors is obtained, and based on the second ratio and the speed vector, the actual allocated speed is obtained. Then, based on the actual allocated speed, the speed corresponding to each of the rotors is adjusted, thereby achieving effective allocation of the speeds corresponding to each of the rotors, enabling the rotors to obtain more accurate allocation, and ensuring the flight stability of the multi-rotor UAV.
  • step S101 a sixth embodiment of the control method of the multi-rotor aircraft of the present application is proposed, which includes in step S101:
  • Step S601 determining the health coefficient corresponding to each rotor in the rotor system of the multi-rotor drone based on the current operating state of the multi-rotor drone;
  • Step S602 determining the manipulation efficiency matrix based on the conventional manipulation efficiency matrix and the health coefficient.
  • the health coefficient represents the theoretical tension at the current tension/current speed, that is, it represents the tension loss.
  • the conventional control efficiency matrix is the control efficiency matrix of the multi-rotor UAV when all the motors/rotors are operating normally.
  • the operating status includes the current of the motor corresponding to each of the rotors or the speed of each of the rotors.
  • the electronic control of a multi-rotor drone monitors the operating status of the motor/rotor in real time, such as current/speed, etc. Through monitoring, the health coefficient of the motor/rotor system can be evaluated.
  • the health coefficient represents the theoretical tension at the current thrust/current speed, that is, the thrust loss.
  • the health coefficient is 1, and when the motor/rotor system fails completely, the health coefficient is 0.
  • the electronic control will feed back the evaluated health coefficient to the flight control.
  • the electronic control and the flight control lose contact (when two-way communication cannot be achieved for a period of time, the electronic control is considered to be lost, usually because the communication line is physically disconnected or the power supply battery fails), the flight control considers that the health coefficient of the motor/rotor system is 0.
  • the eight electronic controls of an eight-rotor all feed back the health coefficients of the motor/rotor systems they control to the flight control, and the flight control obtains a health coefficient vector of length 8.
  • the flight control determines the control efficiency matrix based on the above health coefficients. For example, for a four-axis eight-propeller aircraft, the normal control efficiency matrix of its normal state is:
  • B0 is the conventional control efficiency matrix.
  • the positive and negative signs are determined by the corresponding rotor position and rotation direction, representing the contribution of the force generated by each rotor to the overall force of the aircraft.
  • the influence of the two rotors on the rolling moment on the left and right sides is naturally one positive influence and one negative influence.
  • Each column represents a propeller, and each column represents a control channel.
  • the first row represents the contribution of each propeller to the thrust (virtual control quantity), the second row represents the contribution to the rolling moment, the third row represents the contribution to the pitch moment, and the fourth row represents the contribution to the yaw moment.
  • B0 is the control efficiency matrix under normal conditions
  • k is the column vector of the health coefficient
  • n is the number of motors/rotors
  • B is the control efficiency matrix.
  • the health coefficient corresponding to each rotor in the rotor system of the multi-rotor UAV is determined by the current operating state of the multi-rotor UAV, and then the control efficiency matrix is determined based on the conventional control efficiency matrix and the health coefficient, thereby realizing the expression of the operating state of the multi-rotor UAV in the form of numerical values.
  • the control efficiency matrix more clearly describes the contribution of the corresponding rotation speed of each rotor to the virtual control quantity of each control channel, making the monitoring and control of the rotation speed more accurate and maintaining the flight stability of the multi-rotor UAV.
  • the present application also provides a multi-rotor aircraft, referring to FIG. 4 , the multi-rotor aircraft comprises:
  • a first determination module 10 is used to determine a control efficiency matrix corresponding to each rotor in a rotor system of the multi-rotor UAV based on a current operating state of the multi-rotor UAV;
  • An acquisition module 20 configured to acquire a control allocation matrix corresponding to the manipulation efficiency matrix if the manipulation efficiency matrix satisfies a preset speed allocation condition
  • a second determination module 30 is used to determine a rotation speed vector corresponding to the rotor system based on the control allocation matrix, wherein the rotation speed vector includes a rotation speed to be allocated corresponding to each of the rotors;
  • the adjustment module 40 is used to adjust the rotation speed corresponding to each of the rotors based on the rotation speed vector, and return to execute the step of determining the control efficiency matrix corresponding to each rotor in the rotor system of the multi-rotor drone based on the current operating state of the multi-rotor drone.
  • the first determining module 10 is further configured to:
  • the steering efficiency matrix is determined based on a conventional steering efficiency matrix and the health factor.
  • the acquisition module 20 is further used for:
  • the product matrix is reversible, it is determined that the manipulation efficiency matrix satisfies a preset speed distribution condition, and a control distribution matrix corresponding to the manipulation efficiency matrix is obtained.
  • multi-rotor aircraft is also used for:
  • the second determining module 30 is further configured to:
  • the rotation speed vector is determined based on the virtual control vector to be allocated and the control allocation matrix.
  • multi-rotor aircraft is also used for:
  • a rotation speed vector corresponding to the rotor system is determined.
  • multi-rotor aircraft is also used for:
  • the maximum virtual control vector corresponding to the rotor system is obtained.
  • multi-rotor aircraft is also used for:
  • the remaining allocatable maximum rotation speed is set as the preset maximum rotation speed, and the remaining allocatable minimum rotation speed is set as the preset minimum rotation speed.
  • the adjustment module 40 is also used for:
  • the rotation speed corresponding to each of the rotors is adjusted.
  • the present application also provides a computer-readable storage medium.
  • the computer-readable storage medium of the present application stores computer-readable instructions, and when the computer-readable instructions are executed by a processor, the steps of the control method of the multi-rotor aircraft as described above are implemented.
  • the method implemented when the computer-readable instructions running on the processor are executed can refer to the various embodiments of the control method of the multi-rotor aircraft in the present application, and will not be repeated here.
  • an embodiment of the present application also proposes a computer program product, which includes computer-readable instructions, and when the computer-readable instructions are executed by a processor, the steps of the control method of the multi-rotor aircraft as described above are implemented.
  • the technical solution of the present application is essentially or the part that contributes to the prior art can be embodied in the form of a software product, which is stored in a storage medium (such as ROM/RAM, magnetic disk, optical disk) as described above, and includes a number of instructions for a terminal device (which can be a mobile phone, computer, server, air conditioner, or network device, etc.) to execute the methods described in each embodiment of the present application.
  • a storage medium such as ROM/RAM, magnetic disk, optical disk
  • a terminal device which can be a mobile phone, computer, server, air conditioner, or network device, etc.

Landscapes

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

Abstract

Aéronef à rotors multiples, son procédé de commande, dispositif, et support de stockage lisible par ordinateur. Le procédé consiste : en fonction d'un état de fonctionnement en cours d'un véhicule aérien sans pilote à rotors multiples, à déterminer une matrice d'efficacité de fonctionnement correspondant à chaque rotor ; à acquérir des matrices d'attribution de commande correspondant aux matrices d'efficacité de fonctionnement ; en fonction des matrices d'attribution de commande, à déterminer des vecteurs de vitesse de rotation correspondant au système de rotors ; et en fonction des vecteurs de vitesse de rotation, à régler la vitesse de rotation correspondant à chaque rotor, et à retourner à l'étape pour déterminer une matrice d'efficacité de fonctionnement correspondant à chaque rotor en fonction de l'état de fonctionnement en cours du véhicule aérien sans pilote à rotors multiples.
PCT/CN2022/133003 2022-10-26 2022-11-18 Aéronef à rotors multiples, son procédé de commande, dispositif, et support de stockage lisible par ordinateur WO2024087271A1 (fr)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202211314841.0A CN115407802B (zh) 2022-10-26 2022-10-26 多旋翼飞行器及其控制方法、设备、计算机可读存储介质
CN202211314841.0 2022-10-26

Publications (1)

Publication Number Publication Date
WO2024087271A1 true WO2024087271A1 (fr) 2024-05-02

Family

ID=84168721

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/133003 WO2024087271A1 (fr) 2022-10-26 2022-11-18 Aéronef à rotors multiples, son procédé de commande, dispositif, et support de stockage lisible par ordinateur

Country Status (2)

Country Link
CN (1) CN115407802B (fr)
WO (1) WO2024087271A1 (fr)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115407802B (zh) * 2022-10-26 2023-03-24 广东汇天航空航天科技有限公司 多旋翼飞行器及其控制方法、设备、计算机可读存储介质

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104699108A (zh) * 2013-12-10 2015-06-10 中国航空工业第六一八研究所 一种多旋翼飞行器的控制分配方法
US20170152033A1 (en) * 2015-11-30 2017-06-01 Cloud Cap Technology, Inc. Mutirotor aircraft control systems
CN110888451A (zh) * 2019-12-20 2020-03-17 国网山西省电力公司电力科学研究院 一种多旋翼无人机容错控制方法及系统
CN113467244A (zh) * 2021-07-15 2021-10-01 之江实验室 基于控制矩阵重分配的多旋翼无人机容错控制方法及装置
CN113625763A (zh) * 2021-08-30 2021-11-09 北京三快在线科技有限公司 无人机的控制方法、装置、介质、电子设备和无人机
CN113741549A (zh) * 2021-11-04 2021-12-03 普宙科技(深圳)有限公司 一种多旋翼无人机控制量分配方法
CN114879739A (zh) * 2022-05-31 2022-08-09 哈尔滨工业大学 一种基于零空间的可倾转四旋翼无人机控制分配方法及系统
CN114911250A (zh) * 2022-06-21 2022-08-16 北京航空航天大学 一种位置姿态独立控制的多旋翼无人机
WO2022193075A1 (fr) * 2021-03-15 2022-09-22 深圳市大疆创新科技有限公司 Procédé de commande de véhicule aérien sans pilote, véhicule aérien sans pilote et support de stockage
CN115407802A (zh) * 2022-10-26 2022-11-29 广东汇天航空航天科技有限公司 多旋翼飞行器及其控制方法、设备、计算机可读存储介质

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105759613B (zh) * 2016-03-22 2017-08-15 沈阳上博智拓科技有限公司 倾转旋翼机的控制方法和控制装置
CN107943089B (zh) * 2017-12-25 2020-12-15 成都纵横自动化技术股份有限公司 多规格动力系统控制分配方法及相关装置
CN107992080B (zh) * 2017-12-25 2020-12-15 成都纵横自动化技术股份有限公司 控制分配方法、装置及多旋翼飞行器
CN113778115A (zh) * 2021-08-30 2021-12-10 北京三快在线科技有限公司 多旋翼无人机的控制方法、装置、介质、设备及无人机

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104699108A (zh) * 2013-12-10 2015-06-10 中国航空工业第六一八研究所 一种多旋翼飞行器的控制分配方法
US20170152033A1 (en) * 2015-11-30 2017-06-01 Cloud Cap Technology, Inc. Mutirotor aircraft control systems
CN110888451A (zh) * 2019-12-20 2020-03-17 国网山西省电力公司电力科学研究院 一种多旋翼无人机容错控制方法及系统
WO2022193075A1 (fr) * 2021-03-15 2022-09-22 深圳市大疆创新科技有限公司 Procédé de commande de véhicule aérien sans pilote, véhicule aérien sans pilote et support de stockage
CN113467244A (zh) * 2021-07-15 2021-10-01 之江实验室 基于控制矩阵重分配的多旋翼无人机容错控制方法及装置
CN113625763A (zh) * 2021-08-30 2021-11-09 北京三快在线科技有限公司 无人机的控制方法、装置、介质、电子设备和无人机
CN113741549A (zh) * 2021-11-04 2021-12-03 普宙科技(深圳)有限公司 一种多旋翼无人机控制量分配方法
CN114879739A (zh) * 2022-05-31 2022-08-09 哈尔滨工业大学 一种基于零空间的可倾转四旋翼无人机控制分配方法及系统
CN114911250A (zh) * 2022-06-21 2022-08-16 北京航空航天大学 一种位置姿态独立控制的多旋翼无人机
CN115407802A (zh) * 2022-10-26 2022-11-29 广东汇天航空航天科技有限公司 多旋翼飞行器及其控制方法、设备、计算机可读存储介质

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
XU, XUESONG; NI, YUN; WE, YI-ZHENG: "A Multi-model Fault-tolerant Control Method of Six-rotor UAV", FIRE CONTROL & COMMAND CONTROL, CN, vol. 47, no. 3, 31 March 2020 (2020-03-31), CN, pages 45 - 50, XP009554681, ISSN: 1002-0640, DOI: 10.3969/j.issn.1002-0640.2022.03.008 *

Also Published As

Publication number Publication date
CN115407802B (zh) 2023-03-24
CN115407802A (zh) 2022-11-29

Similar Documents

Publication Publication Date Title
WO2024087271A1 (fr) Aéronef à rotors multiples, son procédé de commande, dispositif, et support de stockage lisible par ordinateur
CN106843245A (zh) 一种无人机姿态控制方法、装置及无人机
CN108196563B (zh) 一种多旋翼无人机自抗扰补偿控制方法及系统
CN110888451A (zh) 一种多旋翼无人机容错控制方法及系统
US11347242B2 (en) Methods and apparatus for flight control prioritization
WO2020237528A1 (fr) Procédé et dispositif de commande de vol d'un véhicule aérien sans pilote à décollage et atterrissage verticaux, et véhicule aérien sans pilote à décollage et atterrissage verticaux
EP3384361A1 (fr) Systèmes de commande d'aéronef à plusieurs rotors
CN113342037A (zh) 具有输入饱和的多旋翼无人机时变编队控制方法及系统
CN107943089B (zh) 多规格动力系统控制分配方法及相关装置
CN115066370A (zh) 分布式飞行控制系统中使用优化的推力分配
CN111198570A (zh) 一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法
TWI709011B (zh) 用於無人機雲臺航向解算與控制的方法
CN109308064A (zh) 一种四旋翼无人机的故障容错控制方法及系统
CN112758315B (zh) 一种螺旋桨桨叶角度调节方法和装置
CN113625763A (zh) 无人机的控制方法、装置、介质、电子设备和无人机
CN116566792A (zh) 一种多无人系统分布式仿真方法和系统
WO2022193075A1 (fr) Procédé de commande de véhicule aérien sans pilote, véhicule aérien sans pilote et support de stockage
CN114253137B (zh) 基于控制分配的无人机系统故障诊断与容错控制方法
US11987381B2 (en) Method and control unit for controlling an overdetermined system, system and aircraft
CN113359794B (zh) 无人机的控制方法、装置、介质、电子设备及无人机
CN116009606A (zh) 无人机的动力分配方法、装置、无人机及存储介质
CN116414148B (zh) 一种分布式的旋翼无人机协同控制方法、装置和系统
CN108459907A (zh) 一种多执行单元的能量均衡指令分配方法
CN113296533A (zh) 广义作动器控制分配与重构方法、装置及其相关组件
WO2021097772A1 (fr) Procédé, dispositif et système de commande d'aéronef, et support de stockage associé