Bionic flapping-wing flying robot formation method and device based on system identification

Through system identification methods and dynamic model control, precise control of the speed and heading of the flapping-wing flight robot is achieved, solving the problem of limited endurance of a single flight robot and improving formation efficiency and flexibility.

CN118963404AInactive Publication Date: 2024-11-15UNIV OF SCI & TECH BEIJING
View PDF 3 Cites 0 Cited by

Patent Information

Application Number
CN202411024122.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-29
Publication Date
2024-11-15
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

The limited endurance and payload of a single-frame flapping-wing flying robot limits its application performance at the space, time and mission levels, and is difficult to fully exert its effectiveness especially in complex environments.

Method used

Using the bionic flapping wing flying robot formation method based on system identification, the dynamic model identification and controller design can realize precise control of the speed and heading of the flying robot, and determine the pilot and follow the flying robot through inter-aircraft communication and ground station communication. Position, optimize formation.

Benefits of technology

It improves the controllability and formation efficiency of the flapping-wing flying robot during the formation process, shortens the formation time, and makes the formation more flexible and efficient.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118963404A_ABST
    Figure CN118963404A_ABST
Patent Text Reader

Abstract

The invention provides a bionic flapping-wing flying robot formation method and device based on system identification, and belongs to the technical field of flapping-wing unmanned aerial vehicles, and the method achieves the precise control of the speed and course of a flapping-wing flying robot through a system identification method, improves the controllability of a single flapping-wing flying robot in the formation process, and improves the formation efficiency. Meanwhile, inter-aircraft communication is established, the most suitable position of the piloting flying robot is obtained through calculation, the formation efficiency is improved, the formation time is shortened, and formation is more flexible.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of flapping-wing unmanned aerial vehicles, and in particular to a bionic flapping-wing flying robot formation method and device based on system identification. Background Art

[0002] With the rapid development of microelectronic systems, micro sensors and batteries, drone technology has been greatly improved. At the same time, with the continuous development of bionics, bionic flapping-wing flying robots have gradually become a hot topic of research at home and abroad. This kind of flying robot imitates the flying mode of birds or insects, has higher energy utilization efficiency and stronger flight flexibility, and therefore has broad application prospects in military and civilian fields.

[0003] The bionic flapping-wing flying robot is a flying robot that imitates the flying method of birds in nature. It generates lift and thrust required for flying by flapping its wings, thus achieving flight. Birds in nature have different flying methods due to their different sizes and wingspans. Most birds also use their tails to control their posture when flying.

[0004] With the widespread use of drones in the military field, the measures taken against them are also increasing, and the environment faced by flapping-wing flying robots is becoming more and more complex. Due to the limited endurance and payload of a single flapping-wing flying robot, its effectiveness cannot be fully utilized when performing tasks, which limits the application of flapping-wing flying robots in terms of space, time and mission. Summary of the invention

[0005] In order to solve the above problems in the prior art, the present invention provides a bionic flapping-wing flying robot formation method and device based on system identification. The invention realizes precise control of the speed and heading of the flapping-wing flying robot through the system identification method, improves the controllability of a single flapping-wing flying robot in the formation process, and establishes inter-machine communication at the same time. The most suitable position of the pilot flying robot is calculated, thereby improving the formation efficiency, shortening the formation time, and making the formation more flexible. To achieve the above purpose, the technical scheme is as follows:

[0006] On the one hand, the present invention provides a bionic flapping-wing flying robot formation method based on system identification, the method comprising:

[0007] S1. Obtaining a dynamic model of a flapping-wing flying robot according to a system identification method;

[0008] S2. Obtaining a controller of the flapping-wing flying robot according to a dynamic model of the flapping-wing flying robot;

[0009] S3, establishing communication between the flapping-wing flying robots and communication between all the flapping-wing flying robots and a ground station, to achieve information exchange between the flapping-wing flying robots;

[0010] S4. Determine a leading flight robot and a following flight robot according to the formation command request issued by the ground station and the positions of all the flapping-wing flight robots;

[0011] S5. According to the positions of the pilot flying robot and the follower flying robot, the controller is used to control the posture and speed of the flapping-wing flying robots to obtain a flapping-wing flying robot formation that meets the requirements of the formation instruction.

[0012] Optionally, in S1, a dynamic model of the flapping-wing flying robot is obtained according to a system identification method, including:

[0013] S11. According to the transverse test and the longitudinal test of the flapping-wing flying robot, the dynamic characteristics of the transverse test and the longitudinal test and the input and output data of the transverse test and the longitudinal test are obtained;

[0014] S12, preprocessing the dynamic characteristics of the horizontal test and the vertical test and the input and output data of the horizontal test and the vertical test to obtain the preprocessed dynamic characteristics and the input and output data of the system;

[0015] S13, according to a part of the preprocessed dynamic characteristics and the input and output data of the system, using a nonlinear dynamic model and a maximum likelihood estimation method to obtain undetermined parameters in the dynamic model of the flapping-wing flying robot, wherein the nonlinear dynamic model includes:

[0016]

[0017]

[0018]

[0019] In the formula, is the forward acceleration, is the climb rate, is the yaw rate, ω is the flapping frequency, δ e represents the elevator of the differential tail, δ r represents the rudder amount of the differential tail, φ is the roll attitude angle of the flapping-wing flying robot, θ is the pitch attitude angle of the flapping-wing flying robot, ψ is the yaw attitude angle of the flapping-wing flying robot, p represents the angular velocity of the flapping-wing flying robot around its roll axis, q represents the angular velocity of the flapping-wing flying robot around its pitch axis, and r represents the angular velocity of the flapping-wing flying robot around its yaw axis;

[0020] in:

[0021]

[0022]

[0023] In the formula, δ e represents the elevator of the differential tail, δ r Represents the rudder amount of the differential tail, δ1 is the left rudder amount, δ2 is the right rudder amount;

[0024] S14, verifying the accuracy of the dynamic model of the flapping-wing flying robot according to the preprocessed dynamic characteristics and the input and output data of the system in the other part;

[0025] S15. Repeat steps S13 to S14 to modify the parameters in the dynamic model of the flapping-wing flying robot until the model is verified to be qualified.

[0026] Optionally, obtaining the controller of the flapping-wing flying robot according to the dynamic model of the flapping-wing flying robot in S2 includes:

[0027] The dynamic model and parameters of the flapping-wing flying robot that have been verified to be qualified are written into a controller to obtain the controller of the flapping-wing flying robot.

[0028] Optionally, the content of the information interaction includes: GPS position information, altitude information, forward speed information, climb rate, roll attitude angle, yaw attitude angle and pitch attitude angle information of the bionic flapping-wing flying robot.

[0029] Optionally, the step S4 of determining the leading flight robot and the following flight robot according to the formation instruction requirement issued by the ground station and the positions of all the flapping-wing flight robots includes:

[0030] S41, according to the positions of all the flapping-wing flying robots, obtaining the flapping-wing flying robot closest to the center position, and setting the flapping-wing flying robot closest to the center position and nearby flapping-wing flying robots as candidate pilot flying robots;

[0031] S42. Calculate the time it takes for each of the candidate leading flying robots to form a formation according to the candidate leading flying robots, select the candidate leading flying robot with the shortest formation time as the leading flying robot, and the remaining flapping-wing flying robots as follower flying robots.

[0032] Optionally, the step S42 of calculating the time for each of the candidate pilot flying robots to form a formation includes:

[0033] Calculate that when all the following flight robots except the candidate pilot flight robot quickly adjust their headings, they need to reduce their flight speeds to reduce the turning radius and shorten the turning time. In this process, the speed loss of the i-th following flight robot is:

[0034]

[0035] The flight time of the i-th following flying robot to the selected leading flying robot:

[0036]

[0037] The total flight time of all follow-up flying robots to the selected pilot flying robot:

[0038]

[0039] Where k is the loss constant, v i is the current speed, r i is the turning radius, d i is the distance between the i-th follower flight robot and the selected pilot flight robot, n is the total number of follower robots, Ψ c In order to follow the flying robot, the heading is adjusted to a yaw angle toward the current position of the selected leading flying robot.

[0040] Optionally, in S5, according to the positions of the pilot flying robot and the follower flying robot, the controller is used to control the posture and speed of the flapping-wing flying robot to obtain a flapping-wing flying robot formation that meets the requirements of the formation instruction, including:

[0041] S51. According to the formation instruction, the pilot flying robot reduces the flight speed and altitude and maintains the flight altitude unchanged;

[0042] S52, adjusting the heights of all the following flight robots according to the flight height of the pilot flight robot, so that the heights of all the following flight robots are consistent with the flight height of the pilot flight robot;

[0043] S53, adjusting the positions of the following flight robots in sequence according to the relative distance between the following flight robot and the leading flight robot, in an order from near to far and in accordance with the principle of avoidance;

[0044] S54, according to the positions of all the following flight robots, the heights of the following flight robots are adjusted in real time to be consistent with the flight height of the leading flight robot, so as to obtain the flapping-wing flight robot formation required by the formation instruction.

[0045] Optionally, the avoidance principle in S53 includes:

[0046] The speed of the following flying robot a is v a , the speed of the following flying robot b is v b , where v a ≥v b , when the distance between the following flying robot a and the following flying robot b is less than v a +v b When the following flying robot b is 2v b The radius of the circling avoidance is 2 (v a +v b ), the following flying robot b switches back to the original heading.

[0047] Optionally, the formation rules of the flapping-wing flying robots include:

[0048] Rule 1: The flapping-wing flying robot maintains a consistent flying altitude;

[0049] Rule 2: When flying in a straight line, the flying speed and heading angle of the flapping-wing flying robot are consistent;

[0050] Rule 3: When turning, the heading angle of the flapping-wing flying robot is consistent.

[0051] On the other hand, the present invention provides a bionic flapping-wing flying robot device based on system identification, which is applied to a bionic flapping-wing flying robot formation method based on system identification, characterized in that the device comprises:

[0052] A model building module is used to obtain a dynamic model of the flapping-wing flying robot according to a system identification method;

[0053] A first determination module is used to obtain a controller of the flapping-wing flying robot according to a dynamic model of the flapping-wing flying robot;

[0054] An establishing module is used to establish communication between the flapping-wing flying robots and communication between all the flapping-wing flying robots and a ground station, so as to realize information interaction between the flapping-wing flying robots;

[0055] A second determination module is used to determine the leading flight robot and the following flight robot according to the formation instruction requirements issued by the ground station and the positions of all the flapping-wing flight robots;

[0056] The control module is used to control the posture and speed of the flapping-wing flying robot using the controller according to the positions of the pilot flying robot and the follower flying robot, so as to obtain a flapping-wing flying robot formation that meets the requirements of the formation instruction.

[0057] Compared with the prior art, the technical solution of the present invention has at least the following beneficial effects:

[0058] On the one hand, the above scheme realizes precise control of the speed and heading of the flapping-wing flying robot through the system identification method, thereby improving the controllability of a single flapping-wing flying robot during the formation process. On the other hand, it establishes inter-machine communication and calculates the most suitable position of the pilot flying robot, thereby improving the formation efficiency, shortening the formation time, and making the formation more flexible. BRIEF DESCRIPTION OF THE DRAWINGS

[0059] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.

[0060] Figure 1 is a flow chart provided by an embodiment of the present invention;

[0061] Figure 2 is a flow chart of a system identification method provided by an embodiment of the present invention;

[0062] Figure 3 is a flow chart of selecting a pilot flying robot provided by an embodiment of the present invention;

[0063] Figure 4 is a flow chart of an overall formation provided by an embodiment of the present invention;

[0064] Figure 5 is a flow chart of a single-machine formation provided by an embodiment of the present invention;

[0065] Figure 6 is a schematic diagram of the selection of the pilot flying robot provided by an embodiment of the present invention;

[0066] Figure 7 is a schematic diagram of an overall formation provided by an embodiment of the present invention;

[0067] Figure 8 is a block diagram of a flapping-wing flying robot device provided by an embodiment of the present invention;

[0068] Fig. 9 is an overall schematic diagram of a flapping-wing flying robot provided by an embodiment of the present invention;

[0069] Fig.10 is a schematic diagram of a flapping-wing flying robot frame provided by an embodiment of the present invention;

[0070] Fig.11 It is a schematic diagram of the tail of a flapping-wing flying robot provided by an embodiment of the present invention. DETAILED DESCRIPTION

[0071] The technical solution of the present invention is described below in conjunction with the accompanying drawings.

[0072] In the embodiments of the present invention, words such as "exemplarily" and "for example" are used to indicate examples, illustrations or explanations. Any embodiment or design described as "example" in the present invention should not be interpreted as being more preferred or more advantageous than other embodiments or designs. Specifically, the use of the word "example" is intended to present the concept in a specific way. In addition, in the embodiments of the present invention, the meaning expressed by "and / or" can be both, or it can be either of the two.

[0073] In order to make the technical problems, technical solutions and advantages to be solved by the present invention more clear, a detailed description will be given below with reference to the accompanying drawings and specific embodiments.

[0074] like Figures 1 to 7 As shown, the present invention provides a bionic flapping-wing flying robot formation method based on system identification, the method comprising:

[0075] S1. Obtaining a dynamic model of a flapping-wing flying robot according to a system identification method;

[0076] Specifically, Figure 2 As shown, in S1, a dynamic model of a flapping-wing flying robot is obtained according to a system identification method, including:

[0077] S11. According to the transverse test and the longitudinal test of the flapping-wing flying robot, the dynamic characteristics of the transverse test and the longitudinal test and the input and output data of the transverse test and the longitudinal test are obtained;

[0078] Furthermore, in the lateral test, the flapping frequency of the flapping-wing flying robot was kept constant, and then the rudder of the tail wing was changed to guide the flying robot to complete three actions: left turn, straight flight, and right turn. Multiple experiments were carried out to record the yaw rate and roll rate of the flying robot under different rudder amounts.

[0079] In the longitudinal test, two test schemes were used. The first scheme was to maintain the constant tail angle, make the flapping-wing flying robot fly forward, change the flapping frequency, record the forward speed, acceleration, and record the changing trend of the forward speed and acceleration under different flapping frequencies. The second scheme was to maintain the same flapping frequency and change the elevator of the tail. The flying robot's ascending speed and pitch angle rate were recorded.

[0080] S12, preprocessing the dynamic characteristics of the horizontal test and the vertical test and the input and output data of the horizontal test and the vertical test to obtain the preprocessed dynamic characteristics and the input and output data of the system;

[0081] Furthermore, the preprocessing method includes: removing noise and outliers and performing filtering or smoothing on them.

[0082] S13, according to a part of the preprocessed dynamic characteristics and the input and output data of the system, using a nonlinear dynamic model and a maximum likelihood estimation method to obtain undetermined parameters in the dynamic model of the flapping-wing flying robot, wherein the nonlinear dynamic model includes:

[0083]

[0084]

[0085]

[0086] In the formula, is the forward acceleration, is the climb rate, is the yaw rate, ω is the flapping frequency, δ e represents the elevator of the differential tail, δ r represents the rudder amount of the differential tail, φ is the roll attitude angle of the flapping-wing flying robot, θ is the pitch attitude angle of the flapping-wing flying robot, ψ is the yaw attitude angle of the flapping-wing flying robot, p represents the angular velocity of the flapping-wing flying robot around its roll axis, q represents the angular velocity of the flapping-wing flying robot around its pitch axis, and r represents the angular velocity of the flapping-wing flying robot around its yaw axis;

[0087] in:

[0088]

[0089]

[0090] In the formula, δ e represents the elevator of the differential tail, δ r Represents the rudder amount of the differential tail, δ1 is the left rudder amount, δ2 is the right rudder amount;

[0091] S14, verifying the accuracy of the dynamic model of the flapping-wing flying robot according to the preprocessed dynamic characteristics and the input and output data of the system in the other part;

[0092] S15. Repeat steps S13 to S14 to modify the parameters in the dynamic model of the flapping-wing flying robot until the model is verified to be qualified.

[0093] S2. Obtaining a controller of the flapping-wing flying robot according to a dynamic model of the flapping-wing flying robot;

[0094] Specifically, in S2, the controller of the flapping-wing flying robot is obtained according to the dynamic model of the flapping-wing flying robot, including:

[0095] The dynamic model and parameters of the flapping-wing flying robot that have been verified to be qualified are written into a controller to obtain the controller of the flapping-wing flying robot.

[0096] S3, establishing communication between the flapping-wing flying robots and communication between all the flapping-wing flying robots and a ground station, to achieve information exchange between the flapping-wing flying robots;

[0097] Specifically, the content of the information interaction includes: GPS position information, altitude information, forward speed information, climb rate, roll attitude angle, yaw attitude angle and pitch attitude angle information of the bionic flapping-wing flying robot;

[0098] The content of the information interaction is sent to all flying robots and ground stations on a periodic basis, with a period of 200ms.

[0099] S4. Determine a leading flight robot and a following flight robot according to the formation command request issued by the ground station and the positions of all the flapping-wing flight robots;

[0100] Specifically, Figure 3 As shown, in S4, according to the formation instruction requirements issued by the ground station and the positions of all the flapping-wing flying robots, a pilot flying robot is obtained, including:

[0101] S41, according to the positions of all the flapping-wing flying robots, obtaining the flapping-wing flying robot closest to the center position, and setting the flapping-wing flying robot closest to the center position and nearby flapping-wing flying robots as candidate pilot flying robots;

[0102] Further, such as Figure 6 As shown, according to the position of the flapping-wing flying robot, a cube containing all flapping-wing flying robots and having a bottom parallel to the ground can be determined. At the center of the cube, the flapping-wing flying robot closest to the center is found, and its distance from the center is calculated, which is recorded as d m , taking the center as the center of the sphere, 4d m A selection sphere is drawn for the radius, and all flapping-wing flying robots located within the outer shell and the interior of the sphere are set as pilot flying robots to be selected.

[0103] S42. Calculate the time it takes for each of the candidate leading flying robots to form a formation according to the candidate leading flying robots, select the candidate leading flying robot with the shortest formation time as the leading flying robot, and the remaining flapping-wing flying robots as follower flying robots.

[0104] Specifically, the calculation of the time for each of the candidate pilot flying robots to form a formation in S42 includes:

[0105] Calculate that when all the following flight robots except the candidate pilot flight robot quickly adjust their headings, they need to reduce their flight speeds to reduce the turning radius and shorten the turning time. In this process, the speed loss of the i-th following flight robot is:

[0106]

[0107] The flight time of the i-th following flying robot to the selected leading flying robot:

[0108]

[0109] The total flight time of all follow-up flying robots to the selected pilot flying robot:

[0110]

[0111] Where k is the loss constant, v i is the current speed, r i is the turning radius, d i is the distance between the i-th follower flight robot and the selected pilot flight robot, n is the total number of follower robots, Ψ c In order to follow the flying robot, the heading is adjusted to a yaw angle toward the current position of the selected leading flying robot.

[0112] S5. According to the positions of the pilot flying robot and the follower flying robot, the controller is used to control the posture and speed of the flapping-wing flying robots to obtain a flapping-wing flying robot formation that meets the requirements of the formation instruction;

[0113] Specifically, Figure 4 As shown, in S5, according to the positions of the pilot flying robot and all the following flying robots, the controller is used to control the posture and speed of the flapping-wing flying robot to obtain the flapping-wing flying robot formation required by the formation instruction, including:

[0114] S51. According to the formation instruction, the pilot flying robot reduces the flight speed and altitude and maintains the flight altitude unchanged;

[0115] Furthermore, the formation instruction requirements include: "I" shape, "V" shape, diamond shape and triangle shape.

[0116] S52, adjusting the heights of all the following flight robots according to the flight height of the pilot flight robot, so that the heights of all the following flight robots are consistent with the flight height of the pilot flight robot;

[0117] S53, adjusting the positions of the following flight robots in sequence according to the relative distance between the following flight robot and the leading flight robot, in an order from near to far and in accordance with the principle of avoidance;

[0118] S54, according to the positions of all the following flight robots, adjusting the heights of the following flight robots in real time to be consistent with the flight height of the leading flight robot, and obtaining the flapping-wing flight robot formation required by the formation instruction;

[0119] Further, such as Figure 5 and Figure 7 As shown, the following flight robot located at the rear side of the pilot flight robot first adjusts the flight altitude to be higher than the current altitude of the pilot flight robot, increases the flight speed, and adjusts the heading in sequence from near to far according to the relative distance to the pilot flight robot to follow the trajectory of the pilot flight robot. While adjusting to follow, the flight speed is gradually adjusted to be consistent with the pilot aircraft. The following flight robot located at the front side of the pilot flight robot lowers the flight altitude to be lower than the current altitude of the pilot flight robot. Adjust the heading to quickly approach the position of the pilot flight robot, and queue up at the current altitude according to the arrival order to follow the trajectory of the pilot flight robot until the upper following flight robot completes the following trajectory. The lower following flight robot increases its altitude to form a following queue. While adjusting to follow, the flight speed is gradually adjusted to be consistent with the pilot aircraft. After the following queue is fully formed, adjust the position of the following flight robot and switch to the set formation.

[0120] Specifically, the avoidance principle in S53 includes:

[0121] The speed of the following flying robot a is v a , the speed of the following flying robot b is v b , where v a ≥v b , when the distance between the following flying robot a and the following flying robot b is less than v a +v b When the following flying robot b is 2v b The radius of the circling avoidance is 2 (v a +v b ), the following flying robot b switches back to the original heading.

[0122] Specifically, the flapping-wing flying robot follows the formation rules, including:

[0123] Rule 1: The flapping-wing flying robot maintains a consistent flying altitude;

[0124] Rule 2: When flying in a straight line, the flying speed and heading angle of the flapping-wing flying robot are consistent;

[0125] Rule 3: When turning, the heading angle of the flapping-wing flying robot is consistent.

[0126] like Figure 8 The present invention provides a bionic flapping-wing flying robot device based on system identification, which is applied to a bionic flapping-wing flying robot formation method based on system identification, characterized in that the device comprises:

[0127] A model building module is used to obtain a dynamic model of the flapping-wing flying robot according to a system identification method;

[0128] A first determination module is used to obtain a controller of the flapping-wing flying robot according to a dynamic model of the flapping-wing flying robot;

[0129] An establishing module is used to establish communication between the flapping-wing flying robots and communication between all the flapping-wing flying robots and a ground station, so as to realize information interaction between the flapping-wing flying robots;

[0130] A second determination module is used to determine the leading flight robot and the following flight robot according to the formation instruction requirements issued by the ground station and the positions of all the flapping-wing flight robots;

[0131] The control module is used to control the posture and speed of the flapping-wing flying robot using the controller according to the positions of the pilot flying robot and the follower flying robot, so as to obtain a flapping-wing flying robot formation that meets the requirements of the formation instruction.

[0132] Specifically, Figures 9 to 11 As shown, the flapping-wing flying robot includes a wing 1, a steering gear 2, a pull rod 3, a tail wing 4, a GPS module 5, a data transmission module 6, a controller module 7 and a posture sensor 8.

[0133] Furthermore, the two wings 1 are symmetrically distributed on both sides of the frame, and the tail is equipped with the tail 4, and the tail 4 is connected to the steering gear 2 through the pull rod 3 to control the tail 4;

[0134] The controller module 7 is fixed above the lower beam of the frame, the attitude sensor 8 is fixed directly above the controller module 7, the GPS module 5 is fixed above the upper beam of the frame, directly above the attitude sensor 8, and the data transmission module 6 is fixed behind the controller module 7;

[0135] The GPS module 5 is connected to the controller module 7, and the data transmission module 6 is connected to the controller module 7, and all the connection modes are connected by physical wires.

[0136] The present invention provides a bionic flapping-wing flying robot formation method and device based on system identification. The invention realizes precise control of the speed and heading of flapping-wing flying robots through the system identification method, improves the controllability of a single flapping-wing flying robot in the formation process, and establishes inter-machine communication at the same time. The most suitable position of the pilot flying robot is obtained by calculation, thereby improving the formation efficiency, shortening the formation time, and making the formation more flexible.

[0137] It is to be understood that the present invention is described by the above embodiments and should not be construed as limiting the embodiments of the present invention and the scope of the present invention. It is known to those skilled in the art that various changes or equivalent substitutions may be made to these features and embodiments without departing from the spirit and scope of the present invention. In addition, under the teachings of the present invention, these features and embodiments may be modified to adapt to specific circumstances and materials without departing from the spirit and scope of the present invention. Therefore, the present invention is not limited by the specific embodiments disclosed herein, and all embodiments falling within the scope of the claims of this application are within the scope of protection of the present invention.

Claims

1. A bionic flapping-wing flying robot formation method based on system identification, characterized in that: The method comprises: S1. Obtaining a dynamic model of a flapping-wing flying robot according to a system identification method; S2. Obtaining a controller of the flapping-wing flying robot according to a dynamic model of the flapping-wing flying robot; S3, establishing communication between the flapping-wing flying robots and communication between all the flapping-wing flying robots and a ground station, to achieve information exchange between the flapping-wing flying robots; S4. Determine a leading flight robot and a following flight robot according to the formation command request issued by the ground station and the positions of all the flapping-wing flight robots; S5. According to the positions of the pilot flying robot and the follower flying robot, the controller is used to control the posture and speed of the flapping-wing flying robots to obtain a flapping-wing flying robot formation that meets the requirements of the formation instruction.

2. The bionic flapping-wing flying robot formation method based on system identification according to claim 1 is characterized in that: In S1, a dynamic model of the flapping-wing flying robot is obtained according to a system identification method, including: S11. According to the transverse test and the longitudinal test of the flapping-wing flying robot, the dynamic characteristics of the transverse test and the longitudinal test and the input and output data of the transverse test and the longitudinal test are obtained; S12, preprocessing the dynamic characteristics of the horizontal test and the vertical test and the input and output data of the horizontal test and the vertical test to obtain the preprocessed dynamic characteristics and the input and output data of the system; S13, according to a part of the preprocessed dynamic characteristics and the input and output data of the system, using a nonlinear dynamic model and a maximum likelihood estimation method to obtain undetermined parameters in the dynamic model of the flapping-wing flying robot, wherein the nonlinear dynamic model includes: In the formula, is the forward acceleration, is the climb rate, is the yaw rate, ω is the flapping frequency, δ e represents the elevator of the differential tail, δ r represents the rudder amount of the differential tail, φ is the roll attitude angle of the flapping-wing flying robot, θ is the pitch attitude angle of the flapping-wing flying robot, ψ is the yaw attitude angle of the flapping-wing flying robot, p represents the angular velocity of the flapping-wing flying robot around its roll axis, q represents the angular velocity of the flapping-wing flying robot around its pitch axis, and r represents the angular velocity of the flapping-wing flying robot around its yaw axis; in: In the formula, δ e represents the elevator of the differential tail, δ r Represents the rudder amount of the differential tail, δ1 is the left rudder amount, δ2 is the right rudder amount; S14, verifying the accuracy of the dynamic model of the flapping-wing flying robot according to the preprocessed dynamic characteristics and the input and output data of the system in the other part; S15. Repeat steps S13 to S14 to modify the parameters in the dynamic model of the flapping-wing flying robot until the model is verified to be qualified.

3. The bionic flapping-wing flying robot formation method based on system identification according to claim 2 is characterized in that: In S2, a controller of the flapping-wing flying robot is obtained according to the dynamic model of the flapping-wing flying robot, including: The dynamic model and parameters of the flapping-wing flying robot that have been verified to be qualified are written into a controller to obtain the controller of the flapping-wing flying robot.

4. The bionic flapping-wing flying robot formation method based on system identification according to claim 1 is characterized in that: The content of the information interaction includes: GPS position information, altitude information, forward speed information, climbing rate, roll attitude angle, yaw attitude angle and pitch attitude angle information of the bionic flapping-wing flying robot.

5. The bionic flapping-wing flying robot formation method based on system identification according to claim 1, characterized in that: The step S4 determines the leading flight robot and the following flight robot according to the formation command request issued by the ground station and the positions of all the flapping-wing flight robots, including: S41, according to the positions of all the flapping-wing flying robots, obtaining the flapping-wing flying robot closest to the center position, and setting the flapping-wing flying robot closest to the center position and nearby flapping-wing flying robots as candidate pilot flying robots; S42. Calculate the time it takes for each of the candidate leading flying robots to form a formation according to the candidate leading flying robots, select the candidate leading flying robot with the shortest formation time as the leading flying robot, and the remaining flapping-wing flying robots as follower flying robots.

6. The bionic flapping-wing flying robot formation method based on system identification according to claim 5 is characterized in that: The step S42 calculates the time for each of the candidate pilot flying robots to form a formation, including: Calculate that when all the following flight robots except the candidate pilot flight robot quickly adjust their headings, they need to reduce their flight speeds to reduce the turning radius and shorten the turning time. In this process, the speed loss of the i-th following flight robot is: The flight time of the i-th following flying robot to the selected leading flying robot: The total flight time of all follow-up flying robots to the selected pilot flying robot: Where k is the loss constant, v i is the current speed, r i is the turning radius, d i is the distance between the i-th follower flight robot and the selected pilot flight robot, n is the total number of follower robots, Ψ c In order to follow the flying robot, the heading is adjusted to a yaw angle toward the current position of the selected leading flying robot.

7. The bionic flapping-wing flying robot formation method based on system identification according to claim 1 is characterized in that: In S5, according to the positions of the pilot flying robot and the follower flying robot, the controller is used to control the posture and speed of the flapping-wing flying robot to obtain a flapping-wing flying robot formation that meets the requirements of the formation instruction, including: S51. According to the formation instruction, the pilot flying robot reduces the flight speed and altitude and maintains the flight altitude unchanged; S52, adjusting the heights of all the following flight robots according to the flight height of the pilot flight robot, so that the heights of all the following flight robots are consistent with the flight height of the pilot flight robot; S53, adjusting the positions of the following flight robots in sequence according to the relative distance between the following flight robot and the leading flight robot, in an order from near to far and in accordance with the principle of avoidance; S54, according to the positions of all the following flight robots, the heights of the following flight robots are adjusted in real time to be consistent with the flight height of the leading flight robot, so as to obtain the flapping-wing flight robot formation required by the formation instruction.

8. The bionic flapping-wing flying robot formation method based on system identification according to claim 7 is characterized in that: The avoidance principle in S53 includes: The speed of the following flying robot a is v a , the speed of the following flying robot b is v b , where v a ≥v b , when the distance between the following flying robot a and the following flying robot b is less than v a +v b When the following flying robot b is 2v b The radius of the circling avoidance is 2 (v a +v b ), the following flying robot b switches back to the original heading.

9. The bionic flapping-wing flying robot formation method based on system identification according to claim 7, characterized in that: The formation rules of the flapping-wing flying robots include: Rule 1: The flapping-wing flying robot maintains a consistent flying altitude; Rule 2: When flying in a straight line, the flying speed and heading angle of the flapping-wing flying robot are consistent; Rule 3: When turning, the heading angle of the flapping-wing flying robot is consistent.

10. A bionic flapping-wing flying robot device based on system identification, characterized in that: The device comprises: A model building module is used to obtain a dynamic model of the flapping-wing flying robot according to a system identification method; A first determination module is used to obtain a controller of the flapping-wing flying robot according to a dynamic model of the flapping-wing flying robot; An establishing module is used to establish communication between the flapping-wing flying robots and communication between all the flapping-wing flying robots and a ground station, so as to realize information interaction between the flapping-wing flying robots; A second determination module is used to determine the leading flight robot and the following flight robot according to the formation instruction requirements issued by the ground station and the positions of all the flapping-wing flight robots; The control module is used to control the posture and speed of the flapping-wing flying robot using the controller according to the positions of the pilot flying robot and the follower flying robot, so as to obtain a flapping-wing flying robot formation that meets the requirements of the formation instruction.

Citation Information

Patent Citations

  • Unmanned aerial vehicle formation and flight method thereof

    CN113110588A

  • Flapping-wing flying robot formation control method

    CN113504797A

  • Formation leader selection algorithm based on unmanned gyroplanes

    CN114815876A