Wind disturbance resistance method for autonomous landing of tail-mounted vertical take-off and landing UAV
By adjusting the drone's heading in fixed-wing mode and controlling the roll and pitch angles in rotary-wing mode, the stability problem of autonomous landing of tail-mounted drones in strong wind conditions was solved, achieving safe and reliable autonomous landing.
Patent Information
- Application Number
- CN202411063748.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-05
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2044-08-05
AI Technical Summary
When tail-mounted vertical takeoff and landing drones are autonomously landing in strong winds, their attitude and position control are difficult to stabilize, making them prone to loss of control and affecting flight safety.
By adjusting the drone's heading in fixed-wing mode to make the fuselage direction parallel to the wind speed vector, and by controlling the roll and pitch angles in rotor mode to make the fixed-wing plane perpendicular to the wind speed vector, the PD controller and attitude controller are used to resist the influence of wind speed.
Achieving safe and reliable autonomous landing of drones under level 6 wind conditions ensures that the fixed wing plane of the drone is perpendicular to the wind speed vector in rotor mode, overcoming the influence of wind speed and guaranteeing flight stability.
Smart Images

Figure CN118567382B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of unmanned aerial vehicle control, and specifically provides a method for resisting wind disturbance during the autonomous landing process of a tail-mounted vertical take-off and landing unmanned aerial vehicle. Background Art
[0002] The autonomous landing process of a tail-mounted vertical take-off and landing UAV is: approaching the landing point in fixed-wing mode, then transitioning from fixed-wing mode to rotor mode, and landing at the landing point in rotor mode. In the rotor mode and the process of converting the fixed-wing to rotor mode, the tail-mounted vertical take-off and landing UAV has strong wind disturbances that will affect the attitude and position control of the UAV. If a strong crosswind is encountered during the transition from fixed-wing mode to rotor mode, the UAV is very likely to lose control. If the front of the UAV (i.e., the wing surface of the fixed wing) is not parallel to the incoming flow direction during the landing in rotor mode, the horizontal position of the UAV will be difficult to control, and the vertical height will be difficult to decrease, which is not conducive to flight safety.
[0003] Therefore, there is an urgent need for an anti-disturbance method that can ensure that tail-seat UAVs can achieve safe, reliable and autonomous landing in strong wind weather. Summary of the invention
[0004] In order to solve the above problems, the present invention provides a method for resisting wind disturbance during the autonomous landing process of a tail-mounted vertical take-off and landing UAV, which divides the wind resistance stage of the UAV into wind resistance during the conversion from fixed-wing mode to rotor mode and wind resistance during the landing process of rotor mode. The switching nodes between the fixed-wing mode and the rotor mode are specially designed, and the influence of wind speed is resisted by controlling the roll angle and pitch angle of the UAV, so that the fixed-wing plane of the UAV always remains perpendicular to the wind speed vector.
[0005] The present invention provides a method for resisting wind disturbance during the autonomous landing process of a tail-mounted vertical take-off and landing UAV, wherein the UAV motion modes include a fixed-wing mode and a rotor mode, and the method for resisting wind disturbance includes:
[0006] S1: In fixed-wing mode, the airspeed is measured by the onboard airspeed meter and the wind speed vector is calculated based on the airspeed;
[0007] By adjusting the heading of the drone, the direction of the drone's fuselage is parallel to the wind speed vector. At this time, the drone is converted from fixed-wing mode to rotary-wing mode.
[0008] S2: In rotor mode, the roll and pitch angles of the drone are controlled so that the fixed-wing plane of the drone is perpendicular to the wind speed vector.
[0009] Preferably, a fixed-wing coordinate system is established: the center of mass of the drone is taken as the origin, the fuselage direction is the X-axis, the span direction of the fixed wing is the Y-axis, and the direction perpendicular to the plane of the fixed wing is the Z-axis;
[0010] In the fixed-wing coordinate system, the wind speed vector The calculation formula is:
[0011] ;
[0012] in, represents the direction cosine matrix transformed from the inertial coordinate system to the fixed-wing coordinate system, Indicates the size of the airspeed, are the yaw angle and pitch angle of the drone, is the speed of the UAV in the inertial coordinate system.
[0013] Preferably, in S1, the drone is controlled to make a circular motion around point A, and the drone moves to any point on the arc BC, leaves the circle and moves to point D. At point D, the yaw angle of the drone is: , the UAV is converted from fixed-wing mode to rotary-wing mode, where the coordinate calculation formulas of A, B, C and D in the inertial coordinate system are:
[0014] ;
[0015] In the formula, R represents the radius of the UAV's circular motion around point A. is a known quantity, which is proportional to the magnitude of the wind speed vector.
[0016] Preferably, in S2, a rotor coordinate system is established: the center of mass of the UAV is taken as the origin, the direction perpendicular to the fixed-wing plane is taken as the X-axis, the span direction of the fixed-wing is taken as the Y-axis, and the fuselage direction is taken as the Z-axis;
[0017] In rotor mode, the position control equation of the drone is:
[0018] ;
[0019] in, is the total thrust generated by the drone, For the quality of the drone, represents the acceleration due to gravity, They represent the yaw angle, roll angle and pitch angle of the drone respectively.
[0020] Preferably, in the rotor mode, the controlled state space control equation of the UAV translational control is:
[0021] ;
[0022] in, are the speeds of the drone along the X and Y axes in the inertial coordinate system, are the expected accelerations of the drone along the X and Y axes in the inertial coordinate system, respectively;
[0023] Controlling the desired acceleration using a PD controller for:
[0024] ;
[0025] in, is the PD controller parameter, are the expected speeds of the drone moving along the X and Y axes in the inertial coordinate system, respectively;
[0026] According to the expected acceleration Get the desired roll angle of the drone in rotor mode and the desired pitch angle for:
[0027] .
[0028] Preferably, the control algorithm to maintain the fixed-wing plane of the drone perpendicular to the wind speed vector is:
[0029] ;
[0030] in, represents the expected yaw rate, is the maximum allowable roll angle, is the maximum allowed yaw rate, is a known parameter that can be adjusted manually. They represent the expected yaw rate after filtering calculated in the previous cycle and the expected yaw rate after filtering in the current cycle. represents the filter bandwidth used for filtering, is the sampling period.
[0031] Compared with the prior art, the present invention can achieve the following beneficial effects:
[0032] The present invention specially designs the hovering path in the fixed-wing mode and the switching node between the fixed-wing mode and the rotor mode, so that the fuselage direction of the UAV is parallel to the wind speed vector, which is convenient for realizing autonomous landing in the rotor mode; during the autonomous landing process, if the fixed-wing plane of the UAV is not perpendicular to the wind speed vector, the wind speed will cause the UAV to produce a yaw motion. In order to overcome the influence of the wind speed, the present invention actively generates a roll angle through a controller to resist the wind, controls the movement direction of the nose through the pitch angle, and overcomes the yaw motion caused by the wind speed through the actively generated roll angle, so that the fixed-wing plane of the UAV is always perpendicular to the wind speed vector in the rotor mode. The present invention can ensure that the UAV can achieve safe and reliable autonomous landing under a force 6 wind condition. BRIEF DESCRIPTION OF THE DRAWINGS
[0033] Figure 1 is a control flow chart of a method for resisting wind disturbance during an autonomous landing process of a tail-mounted vertical take-off and landing UAV provided in an embodiment of the present invention;
[0034] Figure 2 is a structural diagram of a tail-seat vertical take-off and landing UAV provided according to an embodiment of the present invention;
[0035] Figure 3 is a schematic diagram of a hovering path in a fixed-wing mode provided according to an embodiment of the present invention;
[0036] Figure 4 is a wind speed curve diagram in a test environment provided according to an embodiment of the present invention;
[0037] Figure 5 is an actual wind-facing 3D trajectory diagram of a UAV provided in an embodiment of the present invention;
[0038] Figure 6 is a comparison diagram between the actual heading and wind speed direction of the UAV in fixed-wing mode provided by an embodiment of the present invention;
[0039] Figure 7 It is a curve diagram of the change of the attitude angle of the UAV during the autonomous landing of the rotor mode provided by an embodiment of the present invention.
[0040] Reference numerals include:
[0041] Fixed wing 1, rotor 2, support rod 3, landing gear 4. DETAILED DESCRIPTION
[0042] Hereinafter, embodiments of the present invention will be described with reference to the accompanying drawings. In the following description, the same modules are represented by the same reference numerals. In the case of the same reference numerals, their names and functions are also the same. Therefore, the detailed description thereof will not be repeated.
[0043] In order to make the purpose, technical solution and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments. It should be understood that the specific embodiments described herein are only used to explain the present invention and do not constitute a limitation of the present invention.
[0044] like Figure 1 As shown, the embodiment of the present invention provides a method for resisting wind disturbance during the autonomous landing process of a tail-mounted vertical take-off and landing UAV. The structure of the tail-mounted vertical take-off and landing UAV is as shown in FIG. Figure 2As shown, the tail-seat vertical take-off and landing UAV shown in the embodiment of the present invention is a double-wing tail-seat vertical take-off and landing UAV, which mainly includes a fixed wing 1, a rotor 2, a support rod 3 and a landing gear 4, wherein the landing gear 4 is fixed to the tail end of the fixed wing 1, and plays a supporting role during take-off and landing, and the two sets of fixed wings 1 are fixed by the support rod 3.
[0045] The tail-seat vertical take-off and landing UAV mainly involves the following motion modes during the autonomous landing process: fixed-wing mode and rotor mode. Therefore, the embodiment of the present invention divides the wind resistance process of the UAV into two stages, including wind resistance during the conversion of the fixed-wing mode to the rotor mode and wind resistance during the landing process of the rotor mode. The specific wind resistance method is as follows:
[0046] S1: Before analyzing and studying the fixed-wing mode, it is necessary to establish an inertial coordinate system and a fixed-wing coordinate system. The establishment of the inertial coordinate system and the fixed-wing coordinate system can adopt the existing general rules. Specifically, the rules for establishing the inertial coordinate system are: the take-off point of the UAV flight route is used as the origin of the inertial coordinate system, the positive direction of the X-axis points to the north of the earth's surface, the positive direction of the Z-axis points to the center of the earth, and the Y-axis is perpendicular to the X-axis in the horizontal plane. The rules for establishing the fixed-wing coordinate system: the center of mass of the UAV is used as the origin of the fixed-wing coordinate system, the X-axis is in the symmetry plane and its positive direction points to the fuselage direction, which is the direction of the UAV's nose, the Y-axis is the wingspan direction of the fixed-wing 1, and the Z-axis is perpendicular to the fixed-wing plane.
[0047] During the autonomous landing process, the drone first needs to fly to the landing radius area near the landing point in fixed-wing mode, and then select a center point to hover and find the wind. Figure 3 Point A shown in the figure moves in a circle with A as the center and R as the radius, where point A and radius R are both quantities selected autonomously according to the control algorithm during the autonomous landing of the drone, and are related to factors such as the flight speed and control algorithm of the drone. During the circular motion, if the drone is at a high altitude, it also needs to descend at the same time, but the motion component of the vertical descent part (the motion component in the Z-axis direction) is less affected by the wind speed. Therefore, the motion component of the descending part is not analyzed in this article, and the descent process can refer to the existing drone motion control.
[0048] In fixed-wing mode, the relative speed between the drone and the surrounding air, i.e., the airspeed, can be measured by the onboard airspeed meter. The wind speed can be calculated by combining the measured airspeed with the actual flight speed of the drone. The wind speed vector in the fixed-wing coordinate system is The calculation formula is:
[0049] ;
[0050] in, represents the direction cosine matrix transformed from the inertial coordinate system to the fixed-wing coordinate system, Indicates the size of the airspeed, is the yaw angle of the drone, is the pitch angle of the drone, It is the actual flying speed of the UAV in the inertial coordinate system, which is measured by the onboard GPS.
[0051] The circular motion of the drone with A as the center usually involves a circling process of multiple circles. The embodiment of the present invention only takes the last circle of the circling process as an example for explanation. Figure 3 As shown, the drone moves around point A along a circle with a radius of R. When it moves to point B, which is perpendicular to the wind direction, it can choose to leave the circle, or continue to move along the circle at B. However, it must leave the circle when it moves to point C, where the heading is parallel to the wind direction. That is, the drone can choose to leave the circle at any point on the arc BC, and then according to the horizontal displacement component required during the descent process, in this embodiment, only the point C is used as an example for explanation. After the drone moves along the circle to point C, the fuselage direction of the drone is parallel to the wind speed vector, that is, the X-axis of the drone faces the wind, and the yaw angle of the drone is: Then, according to the horizontal distance required during the autonomous landing process, the drone maintains the heading angle It remains unchanged and moves along CD to point D. The direction of the drone's fuselage is parallel to the wind speed vector. At point D, the yaw angle of the drone is still: , the UAV is converted from fixed-wing mode to rotary-wing mode, where the coordinate calculation formulas of A, B, C and D in the inertial coordinate system are:
[0052] ;
[0053] In the formula, R represents the radius of the UAV's circular motion around point A. is a known quantity, which is proportional to the magnitude of the wind speed vector.
[0054] S2: After switching to rotor mode, the rotor coordinate system is established with the center of mass of the drone as the origin, the direction perpendicular to the fixed-wing plane as the X-axis, the wingspan direction of the fixed-wing as the Y-axis, and the fuselage direction as the Z-axis, which is equivalent to the fixed-wing system rotating 90° around the Y-axis.
[0055] In the rotor mode, the attitude angle is controlled to control the translation so that the UAV moves to the desired position. The position control equation of the UAV is:
[0056] ;
[0057] in, is the total thrust generated by the drone, For the quality of the drone, represents the acceleration due to gravity, Respectively represent the yaw angle, roll angle and pitch angle of the drone, They represent the coordinates of the drone on the X, Y, and Z axes in the inertial coordinate system, that is, the desired position. The position control equation describes how the position of the drone in space is affected by the total thrust, total mass, and gravitational acceleration, and how the attitude angle of the drone affects its motion.
[0058] Since the motion component of the vertical descent part of the drone (the motion component in the Z-axis direction in the inertial coordinate system) is less affected by the wind speed, only the horizontal motion component of the drone is considered. , therefore, the position control equation of the UAV is simplified to:
[0059] ;
[0060] Then the controlled state space control equation of translation control is:
[0061] ;
[0062] The controlled state space control equations describe the relationship between the velocity and the desired acceleration of the drone moving along the X-axis and Y-axis in the inertial system.
[0063] in, are the speeds of the drone along the X and Y axes in the inertial coordinate system, are the expected accelerations of the drone along the X and Y axes in the inertial coordinate system, respectively;
[0064] Controlling the desired acceleration using a PD controller for:
[0065] ;
[0066] in, are PD controller parameters, which are all known quantities. Their specific values are related to the UAV flight control algorithm. are the expected speeds of the drone moving along the X and Y axes in the inertial coordinate system, respectively;
[0067] According to the expected acceleration and gravity acceleration to construct an attitude controller that describes the desired roll angle of the drone in rotor mode. and the desired pitch angle for:
[0068] .
[0069] In the above translation control, the X-axis of the drone needs to face the wind in the rotor coordinate system, that is, the fixed-wing plane is perpendicular to the wind speed vector. When there is an angle between the X-axis of the drone and the wind speed vector, due to the large fixed-wing area, the force generated by the wind on the fixed wing will cause the drone to produce uncontrolled yaw motion and translation motion. It can be seen from the description of the attitude controller that: when hour, In the inertial coordinate system, the motion of the X and Y axes is generated respectively. hour, In the inertial coordinate system, the motion of the Y and X axes is generated respectively.
[0070] When the X-axis of the aircraft is at an angle to the wind speed vector, in order to offset the effect of wind on the position and maintain the desired position, the drone position controller will inevitably generate a roll angle. To resist the influence of wind, it is necessary to and the direction of the drone's nose movement (given by The X-axis direction of the drone can be completely opposite to the wind speed vector, so that the pitch angle of the drone can control the movement. The control algorithm for actively generating yaw motion and maintaining the fixed-wing plane of the drone perpendicular to the wind speed vector is:
[0071] ;
[0072] in, represents the expected yaw rate, is the maximum allowable roll angle, is the maximum allowed yaw rate, is a known parameter that can be adjusted manually. They represent the expected yaw rate after filtering calculated in the previous cycle and the expected yaw rate after filtering in the current cycle. represents the filter bandwidth used for filtering, is the sampling period, i.e., the execution period of the control algorithm to keep the fixed-wing plane of the UAV perpendicular to the wind speed vector.
[0073] In order to verify the effectiveness of the method of the present invention, a practical test was conducted on the UAV. During the test, the wind speed of the environment changed as follows: Figure 3 As shown in the figure, in this test environment, the drone may leave the circle when it moves to point B, which is perpendicular to the wind direction. Affected by the changing wind speed, the actual 3D trajectory of the drone is as follows: Figure 5 As shown. In the process of moving from point C to point D, if Figure 6As shown in the figure, the actual heading of the drone in fixed-wing mode and the direction against the wind tend to be stable, indicating that in the CD segment, the drone always maintains the direction of the drone body parallel to the wind speed vector. Actively generate yaw motion to keep the fixed-wing plane of the drone perpendicular to the wind speed vector. The test results are as follows Figure 7 The change curve of the attitude angle of the UAV shown in the figure shows that the actual roll angle is basically consistent with the expected roll angle designed, and is basically maintained near 0°; the actual pitch angle is basically consistent with the expected pitch angle designed. Actively generate yaw motion to overcome the influence of wind speed on the heading of the drone when there is an angle between the X axis of the drone and the wind speed vector, and then adjust the pitch angle Control the movement of the drone. Affected by the changing wind speed, the actual heading (yaw angle) of the drone in rotor mode is a constantly changing curve. It should be noted that Figure 7 The time zero in the figure starts from point D when the drone switches from fixed-wing mode to rotary-wing mode.
[0074] Although the embodiments of the present invention have been shown and described above, it is understood that the above embodiments are exemplary and cannot be understood as limiting the present invention. Those skilled in the art may change, modify, replace and modify the above embodiments within the scope of the present invention.
[0075] The above specific implementations of the present invention do not constitute a limitation on the protection scope of the present invention. Any other corresponding changes and modifications made based on the technical concept of the present invention should be included in the protection scope of the claims of the present invention.
Claims
1. A method for resisting wind disturbance during the autonomous landing process of a tail-mounted vertical take-off and landing UAV, wherein the UAV motion modes include a fixed-wing mode and a rotor-wing mode, characterized in that: Wind disturbance mitigation methods include: S1: In fixed-wing mode, the airspeed is measured by the onboard airspeed meter and the wind speed vector is calculated based on the airspeed; By adjusting the heading of the drone, the direction of the drone's fuselage is parallel to the wind speed vector. At this time, the drone is converted from fixed-wing mode to rotary-wing mode. S2: In rotor mode, the roll and pitch angles of the drone are controlled so that the fixed-wing plane of the drone is perpendicular to the wind speed vector; Establish the rotor coordinate system: take the center of mass of the drone as the origin, the direction perpendicular to the fixed-wing plane as the X-axis, the wingspan direction of the fixed-wing as the Y-axis, and the fuselage direction as the Z-axis; In rotor mode, the position control equation of the drone is: ; in, is the total thrust generated by the drone, For the quality of the drone, represents the acceleration due to gravity, They represent the yaw angle, roll angle, and pitch angle of the drone respectively; In the rotor mode, the controlled state space control equation of the UAV translational control is: ; in, They represent the coordinates of the drone on the X, Y, and Z axes in the inertial coordinate system, i.e., the expected positions. are the speeds of the drone along the X and Y axes in the inertial coordinate system, are the expected accelerations of the drone along the X and Y axes in the inertial coordinate system, respectively; Controlling the desired acceleration using a PD controller for: ; in, is the PD controller parameter, are the expected positions of the drone along the X and Y axes in the inertial coordinate system, respectively; According to the expected acceleration Get the desired roll angle of the drone in rotor mode and the desired pitch angle for: ; The control algorithm to maintain the fixed-wing plane of the drone perpendicular to the wind speed vector is: ; in, represents the expected yaw rate, is the maximum allowable roll angle, is the maximum allowed yaw rate, is a known parameter that can be adjusted manually. They represent the expected yaw rate after filtering calculated in the previous cycle and the expected yaw rate after filtering in the current cycle. represents the filter bandwidth used for filtering, is the sampling period.
2. The method for resisting wind disturbance during the autonomous landing process of a tail-mounted vertical take-off and landing UAV as claimed in claim 1, characterized in that: Establish a fixed-wing coordinate system: take the center of mass of the drone as the origin, the fuselage direction as the X-axis, the wingspan direction of the fixed wing as the Y-axis, and the direction perpendicular to the fixed-wing plane as the Z-axis; In the fixed-wing coordinate system, the wind speed vector The calculation formula is: ; in, represents the direction cosine matrix transformed from the inertial coordinate system to the fixed-wing coordinate system, Indicates the size of the airspeed, are the yaw angle and pitch angle of the drone, is the speed of the UAV in the inertial coordinate system.
3. The method for resisting wind disturbance during the autonomous landing process of a tail-mounted vertical take-off and landing UAV as claimed in claim 1, characterized in that: In S1, the drone is controlled to make a circular motion around point A. The drone moves to any point on the arc BC, leaves the circle and moves to point D. At point D, the yaw angle of the drone is: , the UAV is converted from fixed-wing mode to rotary-wing mode, where the coordinate calculation formulas of A, B, C and D in the inertial coordinate system are: ; In the formula, R represents the radius of the UAV's circular motion around point A. is a known quantity, which is proportional to the magnitude of the wind speed vector.
