Methods for obtaining the tension of the traction rope and for traction drones

By calculating and filtering the tension of the traction rope using the attitude adjustment motor and inertial measurement unit on the drone, the problems of increased cost and load in the existing technology are solved, and the real-time and safe detection of the traction rope tension is realized.

CN123067516APending Publication Date: 2026-11-10SHENZHEN BLUEWING TECHNOLOGY CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202611048654.0
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2026-07-14
Publication Date
2026-11-10

AI Technical Summary

Technical Problem

Existing technologies obtain the tension of the traction rope by installing tension sensors on the drone, which leads to increased costs and load, affecting the safety and reliability of the drone.

Method used

By utilizing attitude adjustment motors, traction power motors, angle sensors, and inertial measurement units, combined with parameters such as the airframe coordinate system, total rotor lift, thrust, gravity, and aerodynamic drag, the tension of the traction rope is calculated and filtered, eliminating the need for additional tension sensors.

Benefits of technology

It enables the acquisition of traction rope tension without increasing costs and load, improving the reliability and safety of drones. It can detect the overload or slack state of the traction rope in real time, reducing the complexity of drones.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN123067516A_ABST
    Figure CN123067516A_ABST
Patent Text Reader

Abstract

This application discloses a method for obtaining the tension of a traction rope and a traction drone. The method includes: establishing a body coordinate system of the traction drone; obtaining the total lift of the rotor of the attitude adjustment motor, the thrust of the traction power motor, and the gravity of the traction drone; obtaining the elevation angle and azimuth angle of the traction rope through an angle sensor, obtaining the three-axis acceleration and current attitude angle through an inertial measurement unit, and obtaining the airspeed and installation angle of the traction drone; obtaining aerodynamic drag based on the airspeed; obtaining the original tension of the traction rope based on the total lift, thrust, gravity, elevation angle, azimuth angle, three-axis acceleration, current attitude angle, aerodynamic drag, and installation angle; and filtering the original tension to obtain the tension of the traction rope. This method reduces the complexity of the traction drone and improves its reliability.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This application relates to the field of unmanned aerial vehicle (UAV) technology, and in particular to a method for obtaining the tension of a traction rope and for traction of an UAV. Background Technology

[0002] With the development of drones, they are now being used to tow paragliders, where drones use tow ropes to accelerate the paraglider's takeoff. To ensure the safety and smoothness of the towing process, it is necessary to monitor the tension of the tow rope in real time. Current technology uses tension sensors mounted on the drone to obtain this tension, but this requires additional sensors, increasing the cost and load on the drone. Summary of the Invention

[0003] To address the aforementioned technical problems, this application provides a method for obtaining the tension of a traction rope and a method for traction drones.

[0004] In a first aspect, this application provides a method for obtaining the tension of a traction rope, applied to a towing drone. The traction rope is installed on the towing drone, which includes multiple attitude adjustment motors, multiple traction power motors, an angle sensor, an inertial measurement unit, and a control unit. The control unit is connected to the multiple attitude adjustment motors, the multiple traction power motors, the angle sensor, and the inertial measurement unit, respectively. The method for obtaining the tension includes: Establish the body coordinate system of the towing UAV; The total lift of the rotor of the attitude adjustment motor, the thrust of the traction power motor, and the gravity of the towing drone are obtained. The angle sensor obtains the elevation angle and azimuth angle of the traction rope, the inertial measurement unit obtains the triaxial acceleration and current attitude angle, and the flight airspeed and installation angle of the traction drone are obtained. The aerodynamic drag is obtained based on the flight airspeed, and the original tension of the traction rope is obtained based on the total lift of the rotor, the thrust, the gravity, the elevation angle of the traction rope, the azimuth angle of the traction rope, the triaxial acceleration, the current attitude angle, the aerodynamic drag, and the installation angle. The tension of the traction rope is obtained by filtering the original tension.

[0005] In some embodiments, the step of obtaining the original tension of the traction rope based on the total lift of the rotor, the thrust, the gravity, the elevation angle of the traction rope, the azimuth angle of the traction rope, the triaxial acceleration, the current attitude angle, the aerodynamic drag, and the installation angle includes: The current attitude angle includes pitch angle and roll angle, and the original tension satisfies the following formula: G

[0006]

[0007] in, G For the gravity, The original tension, L The total lift of the rotor is [value missing]. T For the thrust, The elevation angle of the traction rope. Let be the azimuth angle of the traction rope. The pitch angle is... The roll angle is... D The aerodynamic drag is... The installation angle is... The mass of the towing drone, For the triaxial acceleration z Axial acceleration, For the triaxial acceleration x Axial acceleration.

[0008] In some embodiments, the towing drone includes four attitude adjustment motors, and the total lift of the rotors satisfies the following formula: L =k_thrust*(thr1+thr2+thr3+thr4) L The total lift of the rotor is given by , k_thrust is the thrust coefficient, and thr1, thr2, thr3 and thr4 are the throttle commands of the four attitude adjustment motors, respectively.

[0009] In some embodiments, the towing drone includes two traction motors, the thrust of which satisfies the following formula: T =k_tow*(thr5+thr6) T The thrust is k_tow, the tension coefficient is k_tow, and thr5 and thr6 are the throttle commands of the two traction motors, respectively.

[0010] In some embodiments, the aerodynamic drag satisfies the following formula:

[0011] D The aerodynamic drag is... air density, The airspeed is the stated flight speed. The drag coefficient, For reference area.

[0012] In some embodiments, the acquisition method further includes: The direction of the traction rope is obtained based on the elevation angle and the azimuth angle of the traction rope.

[0013] In some embodiments, the unit vector of the direction of the traction rope satisfies the following formula:

[0014] For the unit vector, The elevation angle of the traction rope. The azimuth angle of the traction rope.

[0015] In some embodiments, the acquisition method further includes: When the traction drone performs constant tension traction control, a first traction control rate is obtained based on the tension of the traction rope, and the first traction control rate satisfies the following formula:

[0016] The first traction control rate, For the preset tension, ,and These are control parameters.

[0017] In some embodiments, the acquisition method further includes: When the towing UAV performs constant climb rate control, the vertical speed of the towing UAV is acquired, and a second traction control rate is obtained based on the vertical speed. The second traction control rate satisfies the following formula:

[0018] This is the second traction control rate. The vertical velocity, The preset vertical velocity, ,and These are control parameters.

[0019] Secondly, this application provides a towing drone, wherein a towing rope is installed on the towing drone, the towing drone including multiple attitude adjustment motors, multiple traction power motors, an angle sensor, an inertial measurement unit, and a control unit, the control unit being connected to the multiple attitude adjustment motors, the multiple traction power motors, the angle sensor, and the inertial measurement unit respectively, and the control unit being used for: Establish the body coordinate system of the towing UAV; The total lift of the rotor of the attitude adjustment motor, the thrust of the traction power motor, and the gravity of the towing drone are obtained. The angle sensor obtains the elevation angle and azimuth angle of the traction rope, the inertial measurement unit obtains the triaxial acceleration and current attitude angle, and the flight airspeed and installation angle of the traction drone are obtained. The aerodynamic drag is obtained based on the flight airspeed, and the original tension of the traction rope is obtained based on the total lift of the rotor, the thrust, the gravity, the elevation angle of the traction rope, the azimuth angle of the traction rope, the triaxial acceleration, the current attitude angle, the aerodynamic drag, and the installation angle. The tension of the traction rope is obtained by filtering the original tension.

[0020] The towing drone provided in this application includes multiple attitude adjustment motors, multiple traction power motors, angle sensors, an inertial measurement unit (IMU), and a control unit. The control unit is connected to the multiple attitude adjustment motors, multiple traction power motors, angle sensors, and the IMU. The acquisition method includes: establishing the body coordinate system of the towing drone; acquiring the total rotor lift of the attitude adjustment motors, the thrust of the traction power motors, and the gravity of the towing drone; acquiring the elevation angle and azimuth angle of the towing rope through the angle sensors, acquiring the three-axis acceleration and current attitude angle through the IMU, and acquiring the flight airspeed and installation angle of the towing drone; obtaining the aerodynamic drag based on the flight airspeed; obtaining the original tension of the towing rope based on the total rotor lift, thrust, gravity, elevation angle of the towing rope, azimuth angle of the towing rope, three-axis acceleration, current attitude angle, aerodynamic drag, and installation angle; and filtering the original tension to obtain the tension of the towing rope. The tension of the traction rope is obtained through multiple attitude adjustment motors, multiple traction power motors, angle sensors, inertial measurement units, and control units. This eliminates the need for additional tension sensors, reducing the cost and load on the towing drone, thus lowering its complexity and improving its reliability. Furthermore, the initial tension of the traction rope is obtained from the rotor's total lift, thrust, gravity, the traction rope's elevation angle, azimuth angle, three-axis acceleration, current attitude angle, aerodynamic drag, and installation angle. The three-axis acceleration data is high-frequency data from the towing drone, allowing for rapid changes in initial tension and real-time monitoring. In addition, the initial tension data can detect traction rope overload or slack, improving safety warnings. Attached Figure Description

[0021] To more clearly illustrate the technical solutions in the embodiments of this application, the accompanying drawings used in the description of the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of this application. For those skilled in the art, other drawings can be obtained based on these drawings without creative effort. Wherein: Figure 1 This is a flowchart illustrating an embodiment of the acquisition method provided in this application; Figure 2 yes Figure 1 A schematic diagram of the framework of one embodiment of the towing drone; Figure 3 yes Figure 1 A schematic diagram of one embodiment of a towing drone and a towing rope; Figure 4 yes Figure 1 A schematic diagram of the structure of one embodiment of the towing drone; Figure 5 yes Figure 1 A side view of one embodiment of the body coordinate system in the diagram; Figure 6 yes Figure 5 A schematic diagram of one embodiment of the body coordinate system. Detailed Implementation

[0022] The technical solutions of the embodiments of this application will be clearly and completely described below with reference to the accompanying drawings. Obviously, the described embodiments are only some embodiments of this application, and not all embodiments. Based on the embodiments of this application, all other embodiments obtained by those skilled in the art without creative effort are within the scope of protection of this application.

[0023] It should be noted that if the embodiments of this application involve directional indicators (such as up, down, left, right, front, back, etc.), the directional indicators are only used to explain the relative positional relationship and movement of each component in a certain specific posture (as shown in the figure). If the specific posture changes, the directional indicators will also change accordingly.

[0024] Furthermore, if the embodiments of this application involve descriptions such as "first" or "second," these descriptions are for descriptive purposes only and should not be construed as indicating or implying their relative importance or implicitly specifying the number of technical features indicated. Therefore, features defined with "first" or "second" may explicitly or implicitly include at least one of those features. Additionally, the technical solutions of various embodiments can be combined with each other, but this must be based on the ability of those skilled in the art to implement them. If the combination of technical solutions is contradictory or impossible to implement, it should be considered that such a combination of technical solutions does not exist and is not within the scope of protection claimed in this application.

[0025] Please see Figures 1 to 6 As shown, Figure 1 This is a flowchart illustrating an embodiment of the acquisition method provided in this application; Figure 2 yes Figure 1 A schematic diagram of the framework of one embodiment of the towing drone; Figure 3 yes Figure 1 A schematic diagram of one embodiment of the towing drone and towing rope 200; Figure 4 yes Figure 1 A schematic diagram of the structure of one embodiment of the towing drone; Figure 5 yes Figure 1 A side view of one embodiment of the body coordinate system in the diagram; Figure 6 yes Figure 5 A schematic diagram of an embodiment of the body coordinate system. The method for obtaining the tension of the traction rope 200 in this embodiment is applied to a towing drone 100, and the traction rope 200 is mounted on the towing drone 100.

[0026] The towing drone 100 is connected to the unpowered aircraft 300 via a towing rope 200. The unpowered aircraft 300 includes, but is not limited to, paragliders, hang gliders, gliders, hot air balloons, and other unpowered or underpowered aircraft. In addition, the towing drone 100 is used for towing in the fishery and animal husbandry sector or for towing water surface facilities via the towing rope 200.

[0027] The towing drone 100 of this embodiment includes multiple attitude adjustment motors 10, multiple traction power motors 20, angle sensors 30, inertial measurement units 40, and a control unit 50. The control unit 50 is connected to the multiple attitude adjustment motors 10, multiple traction power motors 20, angle sensors 30, and inertial measurement units 40. The control unit 50 can be a central processing unit (CPU) or a microcontroller unit (MCU). The acquisition method of this embodiment includes the following steps.

[0028] Step S101: Establish the body coordinate system of the towing UAV 100.

[0029] The control unit 50 establishes the body coordinate system of the towing UAV 100; such as Figure 5 and Figure 6 As shown, the towing drone 100 has a horizontal coordinate system, and the origin of the horizontal coordinate system is fixedly connected to the fuselage of the towing drone 100. x The axis points forward along the horizontal plane. y The axis points to the right along the horizontal plane. z The axis points vertically towards the Earth's center; the coordinate system of the towing UAV 100 includes... x B axis, y B axis, z B The axis, the origin of the body coordinate system, is fixedly connected to the mounting position of the inertial measurement unit 40. x B The axis points forward along the central axis of the fuselage of the tractor-trailer 100. y B The axis points to the right along the mounting plane of the inertial measurement unit 40. z B The axis points to the underside of the fuselage of the towing UAV 100 based on the right-hand rule. In this embodiment, the body coordinate system of the towing UAV 100 is established as an auxiliary coordinate system to facilitate understanding of the attitude of the towing UAV 100 (i.e., pitch and roll angles below).

[0030] Step S102: Obtain the total rotor lift of the attitude adjustment motor 10, the thrust of the traction power motor 20, and the gravity of the traction drone 100.

[0031] The control unit 50 acquires the total lift of the rotor of the attitude adjustment motor 10, the thrust of the traction power motor 20, and the gravity of the traction drone 100.

[0032] In some embodiments, the towing drone 100 may include four attitude adjustment motors 10 and two traction power motors 20; the total rotor lift of the attitude adjustment motors 10, the thrust of the traction power motors 20, and the gravity of the towing drone 100 are obtained, wherein the gravity of the towing drone 100 is equal to the mass of the towing drone 100 multiplied by the gravitational acceleration.

[0033] Step S103: Obtain the elevation angle and azimuth angle of the traction rope 200 through the angle sensor 30, obtain the three-axis acceleration and current attitude angle through the inertial measurement unit 40, and obtain the flight airspeed and installation angle of the traction drone 100.

[0034] The control unit 50 acquires the elevation and azimuth angles of the traction rope 200 via the angle sensor 30, and acquires the triaxial acceleration and current attitude angle via the inertial measurement unit 40, thereby acquiring the airspeed and installation angle of the towed drone 100. The triaxial acceleration includes... x Axial acceleration, y Axial acceleration and z Shaft acceleration; angular velocity can also be obtained through inertial measurement unit 40; installation angle refers to the spatial offset angle formed by the thrust of multiple traction power motors 20 and pitch angle.

[0035] Step S104: Obtain aerodynamic drag based on flight airspeed, and obtain the original tension of traction rope 200 based on total rotor lift, thrust, gravity, elevation angle of traction rope 200, azimuth angle of traction rope 200, triaxial acceleration, current attitude angle, aerodynamic drag, and installation angle.

[0036] The control unit 50 obtains the aerodynamic drag based on the flight airspeed, and obtains the original tension of the traction rope 200 based on the total lift of the rotor, thrust, gravity, elevation angle of the traction rope 200, azimuth angle of the traction rope 200, triaxial acceleration, current attitude angle, aerodynamic drag, and installation angle.

[0037] Step S105: Filter the original tension to obtain the tension of the traction rope 200.

[0038] The control unit 50 filters the original tension to obtain the tension of the traction rope 200. For example, the control unit 50 filters the original tension using existing low-pass filtering and Kalman filtering to obtain the tension of the traction rope 200, which can suppress high-frequency fluctuations caused by noise and errors, so as to output a smooth and reliable tension of the traction rope 200.

[0039] The acquisition method in this embodiment includes: establishing the body coordinate system of the towing drone 100; acquiring the total lift of the rotor of the attitude adjustment motor 10, the thrust of the traction power motor 20, and the gravity of the towing drone 100; acquiring the elevation angle and azimuth angle of the towing rope 200 through the angle sensor 30, acquiring the three-axis acceleration and the current attitude angle through the inertial measurement unit 40, acquiring the airspeed and installation angle of the towing drone 100; obtaining the aerodynamic drag based on the airspeed, and obtaining the original tension of the towing rope 200 based on the total lift of the rotor, thrust, gravity, elevation angle of the towing rope 200, azimuth angle of the towing rope 200, three-axis acceleration, current attitude angle, aerodynamic drag, and installation angle; and filtering the original tension to obtain the tension of the towing rope 200. The tension of the traction rope 200 is obtained through multiple attitude adjustment motors 10, multiple traction power motors 20, angle sensors 30, inertial measurement units 40, and control units 50. This eliminates the need for additional tension sensors, reduces the cost and load on the traction drone 100, lowers its complexity, improves its reliability, and facilitates implementation, thus enhancing its scalability. Furthermore, the initial tension of the traction rope 200 is obtained through the rotor's total lift, thrust, gravity, the elevation angle and azimuth angle of the traction rope 200, triaxial acceleration, current attitude angle, aerodynamic drag, and installation angle. The triaxial acceleration data, being high-frequency data from the traction drone, allows for rapid changes in the initial tension, achieving real-time monitoring. Additionally, the initial tension can be used to detect overload or slack in the traction rope, improving safety warnings.

[0040] In some embodiments, step S104 of this embodiment includes: the current attitude angle includes pitch angle and roll angle, and the original tension satisfies the following formula: G (1) (2) in, G For gravity, For the original tension, L For the total lift of the rotor, T For thrust, The elevation angle of the traction rope is 200 degrees. The azimuth angle of the traction rope is 200 degrees. The pitch angle, For roll angle, D For aerodynamic drag, For installation angle, To traction the mass of the drone 100, For triaxial acceleration z Axial acceleration, For triaxial acceleration x Axial acceleration.

[0041] In some embodiments, such as Figures 5-6 As shown, Figure 5 The direction of gravity in the horizontal coordinate system z The positive directions of the axes are the same. Figure 5 In The elevation angle of the traction rope is 200 degrees. Figure 5 In For the original tension, Figure 5 In L For the total lift of the rotor, Figure 5 In T For thrust, Figure 5 In The pitch angle, Figure 5 In D For aerodynamic drag, Figure 5 In For installation angle. Figure 6 In The azimuth angle of the traction rope is 200 degrees. Figure 6 In The roll angle refers to the angle in the body coordinate system. z B The projection of the axis onto the yz plane of the horizontal coordinate system and z B The angle between the axes; Figure 6 In The elevation angle of the traction rope is 200 degrees. Figure 6 In The pitch angle refers to the angle in the body coordinate system. z B The projection of the axis onto the yz plane of the horizontal coordinate system and z The angle between the axes. Figure 6 The towing drone 100 shown is only for illustrating the horizontal coordinate system, the body coordinate system, the azimuth angle, roll angle, elevation angle, and pitch angle of the towing rope 200. Some components of the towing drone 100 are not shown and do not represent the final form of the towing drone 100, so they will not be described in detail here.

[0042] In some embodiments, the tension of the traction rope 200 is estimated by least squares using the above formulas (1) and (2) to obtain the original tension.

[0043] This embodiment obtains the original tension of the traction rope 200 by measuring the total lift of the rotor, thrust, gravity, elevation angle of the traction rope 200, azimuth angle of the traction rope 200, triaxial acceleration, current attitude angle, aerodynamic drag, and installation angle. It does not increase the cost or load of the traction drone 100, reduces the complexity of the traction drone 100, improves its reliability, is easy to implement, and enhances the scalability of the traction drone 100.

[0044] In some embodiments, the towing drone 100 of this embodiment includes four attitude adjustment motors 10, and the total rotor lift satisfies the following formula: L =k_thrust*(thr1+thr2+thr3+thr4) (3) L Let be the total lift of the rotor, k_thrust be the thrust coefficient, and thr1, thr2, thr3, and thr4 be the throttle commands of the four attitude adjustment motors 10. The thrust coefficient can be a constant. The throttle commands of the attitude adjustment motors 10 include, but are not limited to, the speed control commands received by each attitude adjustment motor 10.

[0045] In other embodiments, the throttle command of the four attitude adjustment motors 10 can be replaced by the rotational speed of the four attitude adjustment motors 10.

[0046] In this embodiment, the total lift of the rotor is obtained through the throttle commands and thrust coefficients of the four attitude adjustment motors 10. L It is easy to implement and improves the scalability of the tractor drone 100.

[0047] In some embodiments, the towing drone 100 of this embodiment includes two towing motors 20, and the thrust of the towing motors 20 satisfies the following formula: T =k_tow*(thr5+thr6)(4) T Let t_tow be the thrust, k_tow be the tension coefficient, and thr5 and thr6 be the throttle commands of the two traction motors 20, respectively. The tension coefficient can be a constant, and the throttle commands of the traction motors 20 include, but are not limited to, the speed control commands received by each traction motor 20.

[0048] In other embodiments, the throttle command of the two traction motors 20 can be replaced by the rotational speed of the two traction motors 20.

[0049] In this embodiment, the total lift of the rotor is obtained through throttle commands from two traction power motors (20) and the thrust coefficient. L It is easy to implement and improves the scalability of the tractor drone 100.

[0050] In some embodiments, the aerodynamic drag of this embodiment satisfies the following formula: (5) D For aerodynamic drag, air density, For airspeed, The drag coefficient, The reference area is [area]. The drag coefficient is [value]. This refers to the dimensionless coefficient representing the aerodynamic drag characteristics of a 100-ton towed unmanned aerial vehicle (UAV); reference area This refers to the preset reference projection area of ​​the tractor drone 100.

[0051] This embodiment derives aerodynamic drag from air density, airspeed, drag coefficient, and reference area. D It is easy to implement.

[0052] In some embodiments, the acquisition method of this embodiment further includes: The direction of the traction rope 200 is obtained based on its elevation angle and azimuth angle; that is, the control unit 50 obtains the direction of the traction rope 200 based on its elevation angle and azimuth angle. The unit vector of the direction of the traction rope 200 satisfies the following formula: (6) in, Unit vector The elevation angle of the traction rope is 200 degrees. The azimuth angle of the traction rope is 200 degrees.

[0053] In this embodiment, the direction of the traction rope 200 is obtained based on the elevation angle and azimuth angle of the traction rope 200, making it easy to determine the direction of the traction rope 200.

[0054] In some embodiments, the acquisition method of this embodiment further includes: When the traction drone 100 is subjected to constant tension traction control, the first traction control rate is obtained based on the tension of the traction rope 200, and the first traction control rate satisfies the following formula: (7) The first traction control rate, For the preset tension, For the tension of the traction rope 200, ,and These are control parameters.

[0055] In this embodiment, when the towing drone 100 is subjected to constant tension traction control, a first traction control rate is obtained based on the tension of the traction rope 200. The first traction control rate can be controlled by the tension of the traction rope 200, which can avoid the start-up impact and sudden speed change of the towing drone 100 and improve the safety of the unpowered aircraft 300.

[0056] In some embodiments, the acquisition method of this embodiment further includes: When the towing drone 100 performs constant climb rate control, the vertical speed of the towing drone 100 is obtained, and a second traction control rate is obtained based on the vertical speed. The second traction control rate satisfies the following formula: (8) For the second traction control rate, Vertical velocity, The preset vertical velocity, ,and These are control parameters.

[0057] This embodiment achieves constant tension traction control and constant climb rate control by obtaining the second traction control rate based on vertical speed.

[0058] This application also provides a towing drone, such as Figures 1 to 6 As shown, the towing drone 100 in this embodiment includes multiple attitude adjustment motors 10, multiple traction power motors 20, angle sensors 30, inertial measurement units 40, and control units 50. The control units 50 are connected to the multiple attitude adjustment motors 10, multiple traction power motors 20, angle sensors 30, and inertial measurement units 40, respectively.

[0059] The control unit 50 is used to: establish the body coordinate system of the towing UAV; acquire the total lift of the rotor of the attitude adjustment motor 10, the thrust of the traction power motor 20, and the gravity of the towing UAV 100; acquire the elevation angle and azimuth angle of the towing rope 200 through the angle sensor 30, acquire the three-axis acceleration and current attitude angle through the inertial measurement unit 40, acquire the airspeed and installation angle of the towing UAV 100; obtain the aerodynamic drag based on the airspeed, and obtain the original tension of the towing rope 200 based on the total lift of the rotor, thrust, gravity, elevation angle of the towing rope 200, azimuth angle of the towing rope 200, three-axis acceleration, current attitude angle, aerodynamic drag, and installation angle; and filter the original tension to obtain the tension of the towing rope 200.

[0060] This embodiment obtains the tension of the traction rope 200 through multiple attitude adjustment motors 10, multiple traction power motors 20, angle sensors 30, inertial measurement units 40, and control units 50. This eliminates the need for additional tension sensors, reduces the cost and load on the traction drone 100, lowers its complexity, improves its reliability, and facilitates implementation, thus enhancing its scalability. Furthermore, the original tension of the traction rope 200 is obtained through the rotor's total lift, thrust, gravity, the elevation angle and azimuth angle of the traction rope 200, triaxial acceleration, current attitude angle, aerodynamic drag, and installation angle. The triaxial acceleration data is high-frequency data from the traction drone, allowing for rapid changes in the original tension and achieving real-time monitoring. Additionally, the original tension data can detect traction rope overload or slack, improving safety warnings.

[0061] In some embodiments, the control unit 50 is also used to perform least squares estimation of the tension of the traction rope 200 using the above formulas (1) and (2) to obtain the original tension.

[0062] In some embodiments, the control unit 50 is also used to obtain the total rotor lift based on the throttle command of the four attitude adjustment motors 10. The total rotor lift satisfies the above formula (3), which will not be repeated here.

[0063] In some embodiments, the control unit 50 is further configured to obtain the thrust of the traction motor 20 based on the throttle command of the two traction motors 20, wherein the thrust of the traction motor 20 satisfies the above formula (4).

[0064] In some embodiments, the control unit 50 is also used to obtain aerodynamic drag based on air density, airspeed, drag coefficient and reference area, wherein the aerodynamic drag satisfies the above formula (5).

[0065] In some embodiments, the control unit 50 is further configured to obtain the direction of the traction rope 200 based on the elevation angle and azimuth angle of the traction rope 200, wherein the unit vector of the direction of the traction rope 200 satisfies the above formula (6).

[0066] In some embodiments, the control unit 50 is further configured to obtain a first traction control rate based on the tension of the traction rope 200 when the traction drone 100 is subjected to constant tension traction control, and the first traction control rate satisfies the above formula (7).

[0067] In some embodiments, the control unit 50 is further configured to acquire the vertical speed of the towing drone 100 when the towing drone 100 is performing constant climb rate control, and obtain a second traction control rate based on the vertical speed, the second traction control rate satisfying the above formula (8).

[0068] In summary, this application establishes the body coordinate system of the towing UAV 100; obtains the total rotor lift of the attitude adjustment motor 10, the thrust of the traction power motor 20, and the gravity of the towing UAV 100; obtains the elevation angle and azimuth angle of the towing rope 200 through the angle sensor 30; obtains the three-axis acceleration and current attitude angle through the inertial measurement unit 40; obtains the airspeed and installation angle of the towing UAV 100; obtains the aerodynamic drag based on the airspeed; obtains the original tension of the towing rope 200 based on the total rotor lift, thrust, gravity, elevation angle of the towing rope 200, azimuth angle of the towing rope 200, three-axis acceleration, current attitude angle, aerodynamic drag, and installation angle; and obtains the tension of the towing rope 200 by filtering the original tension. The tension of the traction rope 200 is obtained through multiple attitude adjustment motors 10, multiple traction power motors 20, angle sensors 30, inertial measurement units 40, and control units 50. This eliminates the need for additional tension sensors, reduces the cost and load on the traction drone 100, lowers its complexity, improves its reliability, and facilitates implementation, thus enhancing its scalability. Furthermore, the initial tension of the traction rope 200 is obtained through the rotor's total lift, thrust, gravity, the elevation angle and azimuth angle of the traction rope 200, triaxial acceleration, current attitude angle, aerodynamic drag, and installation angle. The triaxial acceleration data, being high-frequency data from the traction drone, allows for rapid changes in the initial tension, achieving real-time monitoring. Additionally, the initial tension can be used to detect overload or slack in the traction rope, improving safety warnings.

[0069] The above description is merely an embodiment of this application and does not limit the patent scope of this application. Any equivalent structural or procedural transformations made using the content of this application's specification and drawings, or direct or indirect applications in other related technical fields, are similarly included within the patent protection scope of this application.

Claims

1. A method for obtaining the tension of a traction rope, characterized in that, This invention is applied to a towing drone, wherein the towing rope is mounted on the towing drone, and the towing drone includes multiple attitude adjustment motors, multiple traction power motors, an angle sensor, an inertial measurement unit, and a control unit. The control unit is connected to the multiple attitude adjustment motors, the multiple traction power motors, the angle sensor, and the inertial measurement unit, respectively. The acquisition method includes: Establish the body coordinate system of the towing UAV; The total lift of the rotor of the attitude adjustment motor, the thrust of the traction power motor, and the gravity of the towing UAV are obtained. The angle sensor obtains the elevation angle and azimuth angle of the traction rope, the inertial measurement unit obtains the triaxial acceleration and current attitude angle, and the flight airspeed and installation angle of the traction drone are obtained. The aerodynamic drag is obtained based on the flight airspeed, and the original tension of the traction rope is obtained based on the total lift of the rotor, the thrust, the gravity, the elevation angle of the traction rope, the azimuth angle of the traction rope, the triaxial acceleration, the current attitude angle, the aerodynamic drag, and the installation angle. The tension of the traction rope is obtained by filtering the original tension.

2. The acquisition method according to claim 1, characterized in that, The step of obtaining the original tension of the traction rope based on the total lift of the rotor, the thrust, the gravity, the elevation angle of the traction rope, the azimuth angle of the traction rope, the triaxial acceleration, the current attitude angle, the aerodynamic drag, and the installation angle includes: The current attitude angle includes pitch angle and roll angle, and the original tension satisfies the following formula: G in, G For the gravity, The original tension, L The total lift of the rotor is [value missing]. T For the thrust, The elevation angle of the traction rope, Let be the azimuth angle of the traction rope. The pitch angle is... The roll angle is... D The aerodynamic drag is... The installation angle is... The mass of the towing drone, For the triaxial acceleration z Axial acceleration, For the triaxial acceleration x Axial acceleration.

3. The acquisition method according to claim 1, characterized in that, The towing drone includes four attitude adjustment motors, and the total lift of the rotors satisfies the following formula: L =k_thrust*(thr1+thr2+thr3+thr4) L The total lift of the rotor is given by , k_thrust is the thrust coefficient, and thr1, thr2, thr3 and thr4 are the throttle commands of the four attitude adjustment motors, respectively.

4. The acquisition method according to claim 3, characterized in that, The towing drone includes two towing motors, and the thrust of the towing motors satisfies the following formula: T =k_tow*(thr5+thr6) T The thrust is k_tow, the tension coefficient is k_tow, and thr5 and thr6 are the throttle commands of the two traction motors, respectively.

5. The acquisition method according to claim 1, characterized in that, The aerodynamic drag satisfies the following formula: D The aerodynamic drag is... air density, The airspeed is the stated flight speed. The drag coefficient, For reference area.

6. The acquisition method according to claim 1, characterized in that, The acquisition method further includes: The direction of the traction rope is obtained based on the elevation angle and the azimuth angle of the traction rope.

7. The method for obtaining according to claim 6, characterized in that, The unit vector of the direction of the traction rope satisfies the following formula: For the unit vector, The elevation angle of the traction rope, The azimuth angle of the traction rope.

8. The method for obtaining according to any one of claims 1-7, characterized in that, The acquisition method further includes: When the traction drone performs constant tension traction control, a first traction control rate is obtained based on the tension of the traction rope, and the first traction control rate satisfies the following formula: The first traction control rate, For the preset tension, ,and These are control parameters.

9. The method for obtaining according to any one of claims 1-7, characterized in that, The acquisition method further includes: When the towing UAV performs constant climb rate control, the vertical speed of the towing UAV is acquired, and a second traction control rate is obtained based on the vertical speed. The second traction control rate satisfies the following formula: This is the second traction control rate. The vertical velocity, The preset vertical velocity, ,and These are control parameters.

10. A towing unmanned aerial vehicle, characterized in that, A traction rope is installed on the towing drone. The towing drone includes multiple attitude adjustment motors, multiple traction power motors, an angle sensor, an inertial measurement unit, and a control unit. The control unit is connected to the multiple attitude adjustment motors, the multiple traction power motors, the angle sensor, and the inertial measurement unit, respectively. The control unit is used for: Establish the body coordinate system of the towing UAV; The total lift of the rotor of the attitude adjustment motor, the thrust of the traction power motor, and the gravity of the towing drone are obtained. The angle sensor obtains the elevation angle and azimuth angle of the traction rope, the inertial measurement unit obtains the triaxial acceleration and current attitude angle, and the flight airspeed and installation angle of the traction drone are obtained. The aerodynamic drag is obtained based on the flight airspeed, and the original tension of the traction rope is obtained based on the total lift of the rotor, the thrust, the gravity, the elevation angle of the traction rope, the azimuth angle of the traction rope, the triaxial acceleration, the current attitude angle, the aerodynamic drag, and the installation angle. The tension of the traction rope is obtained by filtering the original tension.