Forest fire control unmanned aerial vehicle stability test method
By calculating the impact of drone movement and rotation on water flow, the problem of inaccurate water flow points of fire-fighting drones is solved, the stability and accuracy of drones in the fire-fighting process is achieved, and the fire-fighting efficiency is improved.
Patent Information
- Application Number
- CN202411455626.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-10-18
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2044-10-18
AI Technical Summary
During the fire extinguishing process of existing fire-fighting drones, the location of the jetted water flow point cannot accurately land on the fire source, resulting in low fire extinguishing efficiency and poor stability of the drone.
By calculating the influence of the drone's movement speed and direction in the first coordinate system on the water flow point, and the centrifugal effect of the drone's own rotation angle and angular velocity in the second coordinate system on the water flow, the drone's respectively controlled The movement and rotation of the water flows under different circumstances can obtain the expected position of the water flowing under different circumstances, and judge the drone stability test results.
The precise calculation and simulation of the drone's water flow point is achieved, ensuring the stability and accuracy of the drone in the fire fighting process and improving the fire extinguishing efficiency.
Smart Images

Figure CN118981587A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of unmanned aerial vehicle control and relates to a method for testing the stability of a forest fire fighting unmanned aerial vehicle. Background Art
[0002] Drones can be used in many fields such as meteorology, monitoring, agriculture, communications, public security management, etc., and have been widely used in the field of firefighting.
[0003] The stability of existing firefighting drones cannot be guaranteed. During the fire-fighting process, the water jetted by the drone cannot accurately land on the fire source, which greatly reduces the fire-fighting efficiency and the stability of the drone is poor. Summary of the invention
[0004] In order to solve the problems existing in the background technology, the present invention proposes a forest fire fighting UAV stability testing method.
[0005] In order to achieve the above object, the technical solution adopted by the present invention is as follows: A method for testing the stability of a forest firefighting UAV, comprising: S1. Calculate the influence of the movement of the UAV on the location of the water flow point according to the moving speed and direction of the UAV in the first coordinate system; S2. Calculate the centrifugal effect of the rotation of the drone on the water flow based on the rotation angle and angular velocity of the drone in the second coordinate system; S3, controlling the UAV movement factor and the UAV rotation separately to obtain the expected position where the UAV water jet falls under different conditions; S4. Determine the distance difference between the actual landing point of the UAV water spray and the expected position, and obtain the UAV stability test result.
[0006] Furthermore, the step S1 calculates the influence of the movement of the drone on the location of the water flow landing point according to the moving speed and direction of the drone in the first coordinate system and is divided into the following steps: S1.11. Calculate the horizontal speed and direction of the drone; S1.12. Based on the horizontal movement of the UAV in the time series, analyze the inertial effect of the horizontal movement of the UAV on the water jet of the UAV; S1.21. Calculate the vertical movement speed and direction of the drone on the Z axis; S1.22. Based on the vertical movement speed of the UAV in the time series, analyze the inertial effect of the vertical movement of the UAV on the water jet of the UAV; S1.31. Combine the vertical action of the drone and the horizontal action of the drone to obtain the effect of the drone movement on the water flow position.
[0007] Furthermore, the specific method for analyzing the inertial effect of the horizontal movement of the drone on the water jet of the drone in S1.12 according to the horizontal movement of the drone in the time series is: According to the speed of the drone's horizontal displacement, the spatial coordinates of the water flow's landing point are calculated. When the drone moves, the impact of the drone's movement on the water flow's landing point is calculated. The specific formula is:
[0008] in is the offset distance of the drone’s water flow landing point, is the horizontal displacement speed of the UAV, is the time from the water jet to the ground, where The calculation method is:
[0009] in, is the flight altitude of the drone, is the acceleration due to gravity, is the vertical speed of the drone. The value is 0.
[0010] Furthermore, the specific method of S1.22 analyzing the inertial effect of the vertical movement of the drone on the water jet of the drone according to the vertical movement speed of the drone in the time series is: The rise or fall of the drone affects the time from the water jet to the landing, thus affecting The value of is calculated by calculating the time from the water jet of the drone to the landing ,
[0011] in, is the flight altitude of the drone, is the acceleration due to gravity, is the vertical speed of the UAV, and the inertial effect of the vertical movement of the UAV on the water jet of the UAV is calculated.
[0012] Furthermore, the specific method of integrating the vertical direction effect and the horizontal direction effect of the drone in S1.31 is: Combined with the horizontal and vertical displacement distance and displacement direction of the UAV, the time from the UAV water flow spraying to the landing is judged. The time from the UAV water flow spraying to the landing is combined with the current UAV flight speed to obtain the influence of the UAV displacement on the water flow landing point.
[0013] Furthermore, the S2 calculates the centrifugal effect of the rotation of the drone on the water flow based on the rotation angle and angular velocity of the drone in the second coordinate system, including: When the UAV rotates and deviates on the z-axis, the rotation offset angle and direction of the UAV are recorded. Based on the rotation offset angle and angular velocity of the UAV in the horizontal direction in the time series, the influence of the rotation of the UAV on the z-axis on the spray distance of the UAV water jet is analyzed. When the UAV rotates and deviates on the y-axis, the rotation angular velocity and direction of the UAV are recorded. Based on the rotation angle and angular velocity of the UAV in the spraying direction in the time series, the influence of the rotation of the UAV in the spraying direction on the spraying distance of the UAV water jet is analyzed.
[0014] Furthermore, when the UAV rotates and deviates on the z-axis, the specific method for analyzing the influence of the rotation of the UAV on the z-axis on the landing point of the water jet from the UAV is as follows: Determine the plane distance between the drone's rotation point and the location of the drone's water jet outlet , the water flow speed of the drone spraying water is , determine the linear velocity of the drone water flow during rotation , based on the time from the water jet to the ground , calculate the UAV water flow offset distance , the specific formula is as follows:
[0015]
[0016] This is used to calculate and analyze the spray distance of the water jet from the drone when it rotates on the z-axis. , the specific formula is:
[0017] It is the plane distance between the final landing point of the drone water flow and the rotation point of the drone; The angle at which the water flow landing point deviates from the initial water flow spray direction in the rotation direction is R / r.
[0018] Furthermore, when the UAV rotates and deviates on the y-axis, the specific method for analyzing the influence of the rotation of the UAV in the spraying direction on the spraying distance of the UAV spraying water flow is as follows: The current flight altitude of the drone is , the water flow speed of the drone spraying water is , the deviation angle of the UAV in the jet direction is , the linear speed of the drone water flow during movement , calculate the landing time of the drone in the water flow , the specific formula is:
[0019] Obtain the landing time of the drone in the water flow , a comprehensive analysis is conducted under the rotation effect of the drone on the water flow and the gravity effect, and the influence of the deflection of the drone on the y-axis on the water flow jet landing point is obtained. The specific formula is:
[0020] It is the plane distance between the final landing point of the drone water flow and the rotation point of the drone.
[0021] Furthermore, the rotational offset of the drone on the z-axis and the rotational offset on the y-axis cannot occur simultaneously. The drone can only rotate and offset on the z-axis or only rotate and offset on the y-axis.
[0022] Compared with the prior art, the present invention has the following beneficial effects: The present invention can accurately calculate the landing point of the water flow on the drone, accurately simulate the location of the water flow landing point on the drone, calculate from the movement of the drone and the rotation of the drone itself, consider multi-dimensional drone flight changes, accurately predict the landing point of the water flow, verify the actual fire-fighting effect of the drone, and ensure that the drone can perform stably during the fire-fighting process. BRIEF DESCRIPTION OF THE DRAWINGS
[0023] Figure 1 It is the overall operation flow chart of the present invention. DETAILED DESCRIPTION
[0024] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0025] like Figure 1 As shown, the technical solution adopted by the present invention is as follows: First of all, it should be stated that the forest firefighting drone stability test method provided by the present invention is carried on a drone device, wherein the drone carries a water pipe extending to a water source. Water is sprayed through the water pipe for firefighting operations. The drone carries equipment and instruments for monitoring flight altitude, flight attitude and status, such as an altimeter, a gyroscope, etc.
[0026] A method for testing the stability of a forest firefighting UAV, comprising: S1. Calculate the impact of the drone's movement on the location of the water flow point based on the drone's moving speed and direction in the first coordinate system. During the flight of the drone, the drone's own movement generates inertia, which causes the water flow point to shift. Assume that the drone moves at a uniform speed.
[0027] S1 is divided into the following steps: S1.11. Calculate the speed and direction of the drone in the horizontal direction. The movement of the drone produces an inertial effect on the water flow carried by the drone, affecting the landing point of the water flow during fire extinguishing.
[0028] S1.12. Based on the horizontal movement speed of the UAV in the time series, analyze the inertial effect of the horizontal movement of the UAV on the water jet of the UAV.
[0029] The specific method for analyzing the inertial effect of the drone moving in the horizontal direction on the water jet from the drone is: The displacement of the landing point of the water flow carried by the drone is affected by the horizontal speed of the drone. According to the speed of the drone's horizontal displacement, the spatial coordinates of the water flow landing point are calculated. When the drone starts to move, the impact of the drone's movement on the water flow landing point is calculated. The specific formula is:
[0030] in is the offset distance of the drone’s water flow landing point, is the horizontal displacement speed of the UAV, is the time from the water jet to the ground, where The calculation method is:
[0031] in, is the acceleration due to gravity, is the vertical speed of the drone. At this time, the drone is not moving in the vertical direction, so The value is 0. The time from the water jetting to the landing has nothing to do with the horizontal speed of the drone, but only with the height of the water jetting. The time from the water jetting to the landing is calculated by the height of the water jetting. . Use the time from when the water is sprayed to when it hits the ground and the horizontal displacement speed of the UAV The displacement change of the water flow landing point caused by the horizontal movement of the drone is calculated.
[0032] S1.21. Calculate the vertical speed and direction of the drone on the Z axis. Not only does the horizontal movement of the drone affect the change of the water flow point, but the rise and fall of the drone also changes the position of the water flow point.
[0033] S1.22. Based on the vertical movement speed of the UAV in the time series, analyze the inertial effect of the vertical movement of the UAV on the water jet of the UAV.
[0034] The specific method for analyzing the inertial effect of the vertical movement of the UAV on the water jet of the UAV is: The raising or lowering of the drone affects the time from the water jet to the ground, thus affecting the time from the water jet to the ground. The specific formula is:
[0035] in, is the flight altitude of the drone, is the acceleration due to gravity, is the vertical speed of the drone. By calculating the time from the spraying of the drone water flow to the landing, the effect of the drone's vertical movement on the drone's water flow is obtained. The calculation method is also , in order to calculate the impact of the drone's takeoff and landing on the water flow point.
[0036] S1.31. Combine the vertical and horizontal effects of the drone to obtain the impact of the drone movement on the water flow position.
[0037] The specific method of integrating the vertical and horizontal effects of the drone is as follows: Combined with the displacement distance and displacement direction of the drone in the horizontal and vertical directions, the time from the spraying of the drone water flow to the landing is judged. The time from the spraying of the drone water flow to the landing is combined with the current drone flight speed to obtain the influence of the drone displacement on the water flow landing point.
[0038] In this way, the effects of the horizontal displacement and vertical movement of the drone are integrated to obtain the impact of the drone on the water flow landing point when it moves.
[0039] S2. Calculate the centrifugal effect of the drone's own rotation on the water flow based on the drone's own rotation angle and angular velocity in the second coordinate system. The drone not only has displacement during flight, but also deflection, so it is necessary to calculate the centrifugal effect of the drone's own rotation on the water flow.
[0040] The S2 includes: When the UAV rotates and deviates on the z-axis, the rotation offset angle and direction of the UAV are recorded. According to the rotation offset angle and angular velocity of the UAV in the horizontal direction in the time series, the influence of the rotation of the UAV on the z-axis on the spray distance of the UAV water jet is analyzed.
[0041] When the UAV rotates and deviates on the y-axis, the rotation angular velocity and direction of the UAV are recorded. Based on the rotation angle and angular velocity of the UAV in the spraying direction in the time series, the influence of the rotation of the UAV in the spraying direction on the spraying distance of the UAV water jet is analyzed.
[0042] The rotation offset of the drone on the z-axis and the rotation offset on the y-axis are calculated separately. The rotation offset of the drone on the z-axis and the rotation offset on the y-axis cannot occur at the same time. The drone can only rotate and offset on the z-axis or only rotate and offset on the y-axis. If the drone rotates and offsets on both the z-axis and the y-axis at the same time, it will cause the drone to lose control, causing unnecessary losses to the drone during the firefighting process.
[0043] In step S2, when the UAV rotates and deviates on the z-axis, the specific method for analyzing the influence of the rotation of the UAV on the z-axis on the landing point of the UAV water jet is as follows: The z-axis in the second coordinate system is the vertical direction of the horizontal plane where the drone is flying.
[0044] When the drone rotates, the drone rotation point is always in the same spatial position.
[0045] Determine the plane distance between the drone's rotation point and the location of the drone's water jet outlet , the water flow speed of the drone spraying water is , determine the linear velocity of the drone water flow during rotation , based on the time from the water jet to the ground , calculate the UAV water flow offset distance , the specific formula is as follows:
[0046]
[0047] This is used to calculate and analyze the spray distance of the water jet from the drone when it rotates on the z-axis. , the specific formula is:
[0048] It is the plane distance between the final landing point of the drone water flow and the rotation point of the drone; The angle at which the water flow landing point deviates from the initial water flow spray direction in the rotation direction is R / r.
[0049] Make sure that the rotation point of the drone is on the same horizontal plane as the location of the drone's water jet outlet. When the drone rotates and deviates on the y-axis, the specific method for analyzing the effect of the drone's rotation in the jet direction on the jet distance of the drone's water jet is as follows: The current flight altitude of the drone is , the water flow speed of the drone spraying water is , the deviation angle of the UAV in the jet direction is , the linear speed of the drone water flow during movement , calculate the landing time of the drone in the water flow , the specific formula is:
[0050] Obtain the landing time of the drone in the water flow , a comprehensive analysis is conducted under the rotation effect of the drone on the water flow and the gravity effect, and the influence of the deflection of the drone on the y-axis on the water flow jet landing point is obtained. The specific formula is:
[0051] It is the plane distance between the final landing point of the drone water flow and the rotation point of the drone.
[0052] Through the aforementioned S1 and S2 steps, the effects of the UAV's movement and rotation offset on the water jet landing point are calculated, and the expected location where the UAV's water jet falls is obtained.
[0053] S3. Control the UAV movement factor and the UAV rotation separately to obtain the expected position where the UAV water jet falls under different conditions.
[0054] In order to improve the stability of the drone during the fire-fighting process and the accuracy of the drone's water jet, and to prevent the drone from rotating during flight and causing instability, the movement of the drone and the rotation of the drone are separated and independently controlled.
[0055] The offset of the water flow landing point when the drone is displaced and the offset of the water flow landing point when the drone is rotating are obtained, and the influence of multi-dimensional drone movement or rotation on the water flow landing point is obtained.
[0056] S4. Determine the distance difference between the actual landing point of the drone water spray and the expected position, and obtain the drone stability test result. If the distance difference between the actual landing point of the drone water spray and the expected position is too large, the application of the drone in fire fighting is unstable. If the distance difference between the actual landing point of the drone water spray and the expected position is small, the drone can be stably used in fire fighting.
[0057] Although the present invention has been described in detail with reference to the aforementioned embodiments, it is still possible for those skilled in the art to modify the technical solutions described in the aforementioned embodiments, or to make equivalent substitutions for some of the technical features therein. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the protection scope of the present invention.
Claims
1. A method for testing the stability of a forest firefighting drone, characterized in that: Included are: S1. Calculate the influence of the movement of the UAV on the location of the water flow point according to the moving speed and direction of the UAV in the first coordinate system; S2. Calculate the centrifugal effect of the rotation of the drone on the water flow based on the rotation angle and angular velocity of the drone in the second coordinate system; S3, controlling the UAV movement factor and the UAV rotation separately to obtain the expected position where the UAV water jet falls under different conditions; S4. Determine the distance difference between the actual landing point of the UAV water spray and the expected position, and obtain the UAV stability test result.
2. A forest fire fighting drone stability testing method according to claim 1, characterized in that ,The S1 calculates the influence of the movement of the drone on the location of the water flow point according to the moving speed and direction of the drone in the first coordinate system, which is divided into the following steps: S1.
11. Calculate the horizontal speed and direction of the drone; S1.
12. Based on the horizontal movement of the UAV in the time series, analyze the inertial effect of the horizontal movement of the UAV on the water jet of the UAV; S1.
21. Calculate the vertical movement speed and direction of the drone on the Z axis; S1.
22. Based on the vertical movement speed of the UAV in the time series, analyze the inertial effect of the vertical movement of the UAV on the water jet of the UAV; S1.
31. Combine the vertical action of the drone and the horizontal action of the drone to obtain the effect of the drone movement on the water flow position.
3. A forest fire fighting drone stability testing method according to claim 2, characterized in that ,In S1.12, according to the horizontal movement of the UAV under the time series, the specific method for analyzing the inertial effect of the horizontal movement of the UAV on the UAV water jet is: According to the speed of the drone's horizontal displacement, the spatial coordinates of the water flow's landing point are calculated. When the drone moves, the impact of the drone's movement on the water flow's landing point is calculated. The specific formula is: in is the offset distance of the drone’s water flow landing point, is the horizontal displacement speed of the UAV, is the time from the water jet to the ground, where The calculation method is: in, is the flight altitude of the drone, is the acceleration due to gravity, is the vertical speed of the drone. The value is 0.
4. A method for testing the stability of a forest firefighting drone according to claim 3, characterized in that ,The specific method of S1.22 analyzing the inertial effect of the UAV moving in the vertical direction on the UAV jetting water is as follows: The rise or fall of the drone affects the time from the water jet to the landing, thus affecting The value of is calculated by calculating the time from the water jet of the drone to the landing , in, is the flight altitude of the drone, is the acceleration due to gravity, is the vertical speed of the UAV, and the inertial effect of the vertical movement of the UAV on the water jet of the UAV is calculated.
5. A method for testing the stability of a forest firefighting drone according to claim 4, characterized in that ,The specific method of integrating the vertical direction effect and the horizontal direction effect of the drone in S1.31 is: Combined with the horizontal and vertical displacement distance and displacement direction of the UAV, the time from the UAV water flow spraying to the landing is judged. The time from the UAV water flow spraying to the landing is combined with the current UAV flight speed to obtain the influence of the UAV displacement on the water flow landing point.
6. A method for testing the stability of a forest firefighting drone according to claim 1, characterized in that , the S2 calculates the centrifugal effect of the drone's own rotation on the water flow based on the drone's own rotation angle and angular velocity in the second coordinate system, including: When the UAV rotates and deviates on the z-axis, the rotation offset angle and direction of the UAV are recorded. Based on the rotation offset angle and angular velocity of the UAV in the horizontal direction in the time series, the influence of the rotation of the UAV on the z-axis on the spray distance of the UAV water jet is analyzed. When the UAV rotates and deviates on the y-axis, the rotation angular velocity and direction of the UAV are recorded. Based on the rotation angle and angular velocity of the UAV in the spraying direction in the time series, the influence of the rotation of the UAV in the spraying direction on the spraying distance of the UAV water jet is analyzed.
7. A method for testing the stability of a forest firefighting drone according to claim 6, characterized in that ,When the UAV rotates and deviates on the z axis, the specific method for analyzing the effect of the rotation of the UAV on the z axis on the landing point of the UAV jetting water is as follows: Determine the plane distance between the drone's rotation point and the location of the drone's water jet outlet , the water flow speed of the drone spraying water is , determine the linear velocity of the drone water flow during rotation , based on the time from the water jet to the ground , calculate the UAV water flow offset distance , the specific formula is as follows: This is used to calculate and analyze the spray distance of the water jet from the drone when it rotates on the z-axis. , the specific formula is: It is the plane distance between the final landing point of the drone water flow and the rotation point of the drone; The angle at which the water flow landing point deviates from the initial water flow spray direction in the rotation direction is R / r.
8. A method for testing the stability of a forest firefighting UAV according to claim 7, characterized in that ,When the UAV rotates and deviates on the y axis, the specific way to analyze the ,effect of the rotation of the UAV in the jetting direction on the jetting distance of the UAV jetting water is as follows: The current flight altitude of the drone is , the water flow speed of the drone spraying water is , the deviation angle of the UAV in the jet direction is , the linear speed of the drone water flow during movement , calculate the landing time of the drone in the water flow , the specific formula is: Obtain the landing time of the drone in the water flow , a comprehensive analysis is conducted under the rotation effect of the drone on the water flow and the gravity effect, and the influence of the deflection of the drone on the y-axis on the water flow jet landing point is obtained. The specific formula is: It is the plane distance between the final landing point of the drone water flow and the rotation point of the drone.
9. A method for testing the stability of a forest firefighting drone according to claim 8, characterized in that , the rotational offset of the drone on the z-axis and the rotational offset on the y-axis cannot occur at the same time. The drone can only rotate and offset on the z-axis or only rotate and offset on the y-axis.
Citation Information
Patent Citations
Rotor unmanned aerial vehicle autonomous positioning method based on vehicle-mounted multi-sensor
CN106989744A
Spraying stability augmentation method and device for fire-extinguishing unmanned aerial vehicle
CN111437542A
Unmanned aerial vehicle, unmanned aerial vehicle control method and airship cooperation system
CN112558640A
Forest disaster monitoring aircraft based on STM32 and Raspberry Pi
CN116767526A
Unmanned aerial vehicle anti-interference flight control method based on high-pressure water washing
CN117452801A
