A multi-modal smooth switching flight control method and system for a quadcopter unmanned aerial vehicle with a boom

By employing a multimodal smooth-switching flight control method, the dynamics problem of UAVs caused by the movement of the robotic arm was solved, achieving stable flight control of the quadcopter UAV at different angles and ensuring high performance and the reliability of the actuators.

CN120540148BActive Publication Date: 2026-11-10NORTHEAST FORESTRY UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202510598146.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2025-05-09
Publication Date
2026-11-10
Estimated Expiration
2045-05-09

AI Technical Summary

Technical Problem

Traditional single-mode controllers are unable to adapt to the stable flight control requirements of robotic arms at different angles, resulting in the displacement of the drone's center of gravity, changes in rotational inertia, and additional force/torque interference, which affect flight control performance and may damage the mechanical structure.

Method used

A multimodal smooth switching flight control method for a quadcopter drone with a robotic arm is designed. By establishing the Earth inertial coordinate system, the body coordinate system, and the robotic arm coordinate system, a three-loop trajectory tracking control framework is constructed, including position tracking, attitude angle tracking, and angular velocity tracking control. A multimodal smooth switching controller is used to achieve smooth transitions under changes in the robotic arm angle.

Benefits of technology

When the robotic arm is performing a task, it ensures the high performance and high reliability of the quadcopter drone's flight control, and ensures the reliable response of the actuator, avoiding abrupt changes in control commands and damage to the mechanical structure.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN120540148B_ABST
    Figure CN120540148B_ABST
Patent Text Reader

Abstract

This invention provides a multimodal smooth-switching flight control method and system for a quadrotor drone with a robotic arm, belonging to the field of special-purpose drone flight control. To address the complex dynamic problems of drone center of mass shift, moment of inertia changes, and additional force / torque disturbances caused by robotic arm movement, traditional single-mode controllers struggle to adapt to stable flight control requirements under different robotic arm angles. This invention addresses the issue of changes in the system's center of mass and moment of inertia, as well as the introduction of additional forces and torques, caused by the robotic arm's movement during mission execution. It also considers the difficulty for the quadrotor's actuators to execute abrupt control commands. Therefore, a multimodal smooth-switching control method based on the robotic arm's motion state is proposed, enabling the quadrotor to achieve high-performance, highly reliable flight control even when the robotic arm continuously changes its attitude due to mission requirements.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention relates to the field of flight control technology for special unmanned aerial vehicles (UAVs), and more specifically, to a multimodal smooth switching flight control method and system for a quadcopter UAV with a boom. Background Technology

[0002] Arm-mounted drones typically refer to hybrid flight platforms that utilize quadcopter drones equipped with robotic arms for aerial operations. While inheriting the high-altitude reach and maneuverability of traditional quadcopter platforms, they also gain environmental interaction capabilities through the mounted multi-degree-of-freedom robotic arms. Their applications in complex operational scenarios are increasingly widespread, such as high-altitude power line inspection and insulator cleaning, fruit and vegetable harvesting and branch pruning in complex agricultural and forestry environments, and precise installation of aerial instruments and equipment. During operations, the robotic arm continuously adjusts its posture, leading to a shift in the system's center of mass and continuous changes in rotational inertia, while introducing additional forces and torques to the quadcopter drone platform. These dynamic disturbances not only significantly reduce the flight control performance of the quadcopter drone platform, causing mission failure, but may also damage the platform structure in extreme cases. For such systems with time-varying parameters, multimodal control methods, by establishing mode switching mechanisms, can effectively describe the characteristics of system parameter changes. Furthermore, the design based on a multi-controller architecture and switching logic significantly improves the control performance of systems with changing parameters. Multimodal control methods have been successfully applied to a variety of novel aircraft platforms, such as rapidly deformable reconfigurable aircraft, composite UAVs with adjustable robotic arm lengths, and blended wing-body aircraft with flexible wings.

[0003] Research on flight control for robotic arms-mounted unmanned aerial vehicles (UAVs) is rapidly developing. Existing methods are mainly based on traditional quadrotor dynamics models, treating the robotic arm's motion as an external disturbance and employing robust control strategies to suppress it, or using adaptive control strategies to adjust parameters online for precise control. However, when the robotic arm is in a state of rapid motion or has a significant mass proportion, the traditional dynamics model differs fundamentally from the actual system, leading to a significant decrease in the performance of robust and adaptive control. In fact, analysis and modeling of the robotic arm's dynamics reveals a significant nonlinear relationship between the system's rotational inertia and additional forces / torques and the changes in the robotic arm's angle, while also significantly enhancing the coupling effect between system states. As the robotic arm's angle changes continuously, the system's dynamic characteristics exhibit typical multimodal features: parameters remain unchanged in a stationary state, change gradually at low speeds, and change drastically at high speeds. Faced with the complex dynamic characteristics caused by the robotic arm's motion, traditional single-modal control methods cannot simultaneously meet the requirements of high performance and high reliability. Therefore, a complex multimodal flight control method is urgently needed to achieve precise flight control of quadrotor UAVs under all working conditions of the robotic arm.

[0004] To achieve optimal control performance across modes, multimodal control methods require dedicated controllers for different modes. However, this design approach is prone to control command jumps during mode switching. These jumps, constrained by the actuator's physical limitations, may fail to execute accurately, potentially causing mechanical damage such as motor burnout due to sudden current surges or propeller fatigue failure due to speed jumps. To obtain smooth control commands in multimodal control methods, existing research either disregards the underlying energy stability of the system and directly applies a weighted average of the control gains of adjacent modes after mode switching, or designs smooth controllers while ensuring system stability in discrete time. Considering that the actuators of quadcopter UAVs (such as propellers and motors) are essentially continuous-time systems, developing multimodal smooth switching control methods with continuous-time stability has become an important research direction in this field. Summary of the Invention

[0005] The technical problem to be solved by this invention is:

[0006] To address the complex dynamic issues of drone center of mass shift, moment of inertia change, and additional force / torque interference caused by robotic arm movement, traditional single-mode controllers are ill-suited to the stable flight control requirements of robotic arms at different angles.

[0007] The technical solution adopted by the present invention to solve the above-mentioned technical problems is as follows:

[0008] This invention provides a multi-modal smooth switching flight control method for a quadcopter unmanned aerial vehicle (UAV) with a boom, comprising the following steps:

[0009] S100. Establish the Earth inertial coordinate system, the fixed coordinate system of the aircraft body, and the coordinate system of the robotic arm to obtain the angle information of the robotic arm and the position and attitude information of the quadcopter UAV.

[0010] S200, Tracking control framework formulation and mode determination, including constructing a dynamic model of the coupled system of the quadcopter UAV and the robotic arm, designing a three-loop trajectory tracking control framework including an outer loop for position tracking control, a middle loop for attitude angle tracking control, and an inner loop for angular velocity tracking control; based on the robotic arm angle information obtained in step S100, determining the current mode of the system through a preset mode division criterion, and calling the dynamic model of the corresponding mode;

[0011] S300, attitude tracking control of quadcopter UAV under continuous change of robotic arm angle: the current attitude angle of quadcopter UAV obtained in step S100 is used as the reference input of the system to determine the system state error. The desired angular velocity is obtained through the state feedback controller and transmitted to the inner loop. The inner loop designs a corresponding multi-modal smooth switching controller according to the robotic arm angle to realize angular velocity tracking.

[0012] S400, Position tracking control of quadcopter UAV under continuous change of robotic arm angle: According to step S100, the position and attitude information of quadcopter UAV are obtained and the system state error is calculated; the lift of the system and the desired yaw angle and pitch angle are calculated through the PD position controller, and together with the reference yaw angle, they are transmitted to the angle loop as reference input. The position tracking control of quadcopter UAV under continuous change of robotic arm angle is realized through step S300.

[0013] S500: During the continuous movement of the robotic arm, the quadcopter drone undergoes multi-modal smooth switching control. By providing the reference input of the system, the current position and attitude information are obtained in real time to obtain the system state error. Based on the real-time obtained robotic arm angle, the control system mode is determined. Steps S200-S400 are repeated until the quadcopter drone reaches the reference position and attitude under continuous changes in the robotic arm angle.

[0014] Further, in step S100, the following are included:

[0015] Establish an Earth inertial space rectangular coordinate system F based on the initial position of the quadcopter UAV. i Its three axes point east (x), north (y), and directly upward (z), respectively; the body coordinate system F is fixed at the geometric center of the quadcopter UAV. b Its three axes point directly in front of the quadcopter drone (x) b ), left side (y b ), directly above (z b ); Coordinate system O fixed on the joints of the robotic arm i (i = 0, 1, 2, 3), where O0 is the base coordinate system of the robotic arm system, and its origin coincides with the origin of the body coordinate system. The x0 axis is parallel to the x-axis of the UAV. b The axes are aligned, with the y0 axis aligned with the drone's z axis. b The axes are in opposite directions; the other three coordinate systems, fixed to the robotic arm joints, are respectively fixed at the three link joints, x i The axis points to the connecting rod, z i axis and y b The axes are in the same direction, y i The axis is determined according to the right-hand rule;

[0016] The position information (x, y, z), attitude information (φ, θ, ψ), and robotic arm angles (θ1, θ2, θ3) of the quadcopter are obtained from the onboard sensors on the drone.

[0017] Further, in step S200, the following are included:

[0018] Based on the coordinate system established in step S100, the forces and torques introduced by the robotic arm's motion to the UAV platform are calculated iteratively using the Newton-Euler formula. Considering the system's rotational inertia and center of mass changes caused by the robotic arm's motion, the dynamic model of the robotic arm-mounted UAV is as follows:

[0019]

[0020] In the formula, v x v y and v z These are the speeds of the quadcopter drone along its x, y, and z axes, respectively; m b f is the mass of the quadcopter drone; g is the acceleration due to gravity; f bx f bz τ by It refers to the force and torque that the robotic arm's movement brings to the drone, where f bx Along x b axis, f bz Along z b axis, τ by Around y b Axis; F T It is the total lift of the quadcopter drone; M p M q M r These are the rotational torques of the three axes of the quadcopter drone; k p k q k r These are the drag coefficients of the three axes of the quadcopter drone; J xx J yy J zz J xz This is the moment of inertia of the quadcopter drone with its robotic arm, which is related to the length of the robotic arm and its current angle, and is expressed as:

[0021]

[0022] In the formula, a1=(l c1 s1) 2 a2=(l1s1+l c2 s 12 ) 2 a3=(l1s1+l2s) 12 +l c3 s 123 ) 2 b1 = (l c1 c1) 2 b2=(l1c1+l c2 c 12 ) 2 b3 = (l1c1 + l2c) 12 +l c3 c123 ) 2 ;l i It is the length of link i in the robotic arm; l ci J is the length from the center of link i of the robotic arm to the joint. bx J by J bz It is the moment of inertia of a quadcopter drone; m i It is the mass of link i; s1 is sin(θ1), s 12 sin(θ) 1+ θ2), s 123 is sin(θ1+θ2+θ3), c1 is cos(θ1), c 12 cos(θ) 1+ θ2), c 123 The expression is cos(θ1+θ2+θ3);

[0023] Considering the actuator dynamics of the quadcopter drone, the model is as follows:

[0024]

[0025] In the formula, ζ p ζ q ζ r These are the physical parameters of the actuator; M pf M qf M rf It is the control input that needs to be designed;

[0026] Based on the current robotic arm angle, the following angular velocity multimodal linear variable parameter tracking control system is established:

[0027]

[0028] In the formula, B s Both are Jacobian matrices obtained after linearizing the tracking control system; w is the disturbance term of the tracking control system; z s It is the system state that needs to be observed; C s It is the output matrix; e s =[p,q,r,M p M q M r ] T It is a system tracking error;

[0029] u s =[M pf M qf M rf ] T It is the system control input; η k,σ Under the same mode The multicell coefficients of the matrix; σ represents the system modes corresponding to different robot arm angles;

[0030] Based on formulas (1) to (5), a three-loop tracking control framework for the position-angle-angular velocity of the robotic arm UAV is established to realize flight tracking control of the UAV under different robotic arm angles.

[0031] Further, in step S300, the following are included:

[0032] When a quadcopter drone performs attitude tracking control, the reference input Φ d The lateral rotation angle φ calculated for the position loop d Pitch angle θ d and the given heading angle ψ d ;

[0033] Define the angle tracking error as e Φ =Φ d -Φ=[φ d -φ,θ d -θ,ψ d -ψ] T , where Φ is the instantaneous roll angle, pitch angle, and yaw angle; the state feedback controller for angle tracking is designed as follows: Where R is the system rotation matrix, ω d =[p d ,q d ,r d ] T , ζ Φ =diag{ζ φ ,ζ θ ,ζ ψ};ζ Φ =diag{ζ φ ,ζ θ ,ζ ψ} are the positive real parameters of the roll angle, pitch angle, and yaw angle that need to be designed;

[0034] Based on the current robotic arm angle, switch from mode i to mode j σ(t) j The multi-modal smooth switching controller for the angular velocity loop is designed as follows:

[0035]

[0036] In the formula, T j It is a smoothed time; It is a mode-dependent control gain, consisting of a matrix related to the robot arm angle. B s C s Related; α is the time-dependent smoothing coefficient;

[0037] The controller of formula (7) is solved by the following inequality:

[0038]

[0039] The robustness performance index of the controller in formula (7) is: λ、 τ D These represent the maximum energy increase during mode switching, the minimum normal number of system energy decrease under different modes, the maximum normal number of system stability under smoothing under different modes, the maximum smoothing time during mode switching, dwell time, system parameters, and the system's anti-interference suppression capability, μ. ij μ is the energy rise factor when switching from mode i to mode j. ji It is the energy switching coefficient for switching from mode j to mode j.

[0040] Further, in step S400, the following is included:

[0041] Position tracking control uses a PD controller. Considering the forces and torques introduced by the robotic arm's motion, the virtual control input is designed as follows:

[0042]

[0043] In the formula, ζ px ζ vx ζ py ζ vy ζ pz ζ vz These are the positive constants to be designed, so that the virtual control input of formula (9) is:

[0044]

[0045] Using formulas (9) and (10), the controller for position tracking control is designed as follows:

[0046]

[0047] In the formula,

[0048] Given reference input x d y d z d The controller adjusts the UAV position in real time according to the current system position error and calculates the yaw and pitch angles, which are then transmitted to the attitude control loop. The attitude controller in step S300 realizes the position tracking control of the UAV under different robotic arm angles.

[0049] A multimodal smooth switching flight control system for a quadcopter with a boom, the system having program modules corresponding to the above steps, and executing the steps in the above-described method for multimodal smooth switching flight control of a quadcopter with a boom during operation.

[0050] A computer-readable storage medium storing a computer program configured to, when invoked by a processor, implement the steps of a multimodal smooth-switching flight control method for a quadcopter unmanned aerial vehicle with a boom.

[0051] Compared with the prior art, the beneficial effects of the present invention are:

[0052] Compared to robust and adaptive single-mode control methods, this invention addresses the issue of changes in the system's center of mass and moment of inertia caused by the movement of the robotic arm by designing a multi-mode smooth switching controller for different robotic arm angles. This ensures high-performance and highly reliable flight control of the quadcopter UAV while the robotic arm is performing its tasks.

[0053] To address the issue of traditional multimodal control methods that neglect the physical constraints of actuators, this invention introduces a transition period during the mode switching interval and reconstructs the system energy function based on Lyapunov stability theory. This ensures global stability while achieving a smooth transition of control commands, thereby guaranteeing the reliable response of the actuator.

[0054] In summary, this invention takes a robotic arm-mounted unmanned aerial vehicle (UAV) as its application object. Based on the motion of the robotic arm, a complete dynamic model is derived. At the same time, the physical constraints of the actuator are taken into account, and a multi-modal smooth switching controller is designed. This ensures high-performance flight control of the quadcopter UAV under the robotic arm's task, while also enabling the actuator to smoothly execute control commands. It has high engineering application value. Attached Figure Description

[0055] Figure 1 This is a flowchart of a multimodal smooth switching flight control method for a quadcopter unmanned aerial vehicle with a boom, as described in an embodiment of the present invention.

[0056] Figure 2 The diagram shows the continuous change of the robotic arm angle and the mode partitioning diagram in the embodiment of the present invention, wherein (a) is the angle change diagram of the robotic arm, (b) is the parameter space diagram of the robotic arm, (c) is the modal diagram under different robotic arm angles, and (d) is the partitioning diagram under different robotic arm angles.

[0057] Figure 3 This is a diagram of the position loop tracking control framework for a quadcopter UAV under continuously changing robotic arm angle in an embodiment of the present invention.

[0058] Figure 4This is a diagram illustrating the attitude tracking effect and control commands of a quadcopter UAV under continuously changing robotic arm angle in an embodiment of the present invention.

[0059] Figure 5 The diagram shows the position tracking effect and control command of a quadcopter UAV under continuous change of robotic arm angle in an embodiment of the present invention. (a)-(c) are the response curves of yaw angle, pitch angle and roll angle under two different controllers, respectively; (d)-(f) are the control inputs under the multimodal smooth controller, respectively; (g)-(i) are the control inputs under the traditional multimodal controller, respectively. Detailed Implementation

[0060] To make the above-mentioned objects, features and advantages of the present invention more apparent and understandable, specific embodiments of the present invention will be described in detail below with reference to the accompanying drawings.

[0061] Specific Implementation Plan 1: Combining Figures 1 to 4 As shown, this invention provides a multi-modal smooth switching flight control method for a quadcopter unmanned aerial vehicle (UAV) with a boom, comprising the following steps:

[0062] S100. Establish coordinate systems and acquire the angle information of the robotic arm and the position and attitude information of the quadcopter drone, including establishing the Earth inertial coordinate system, the fixed coordinate system of the body and the coordinate system of the robotic arm, and acquiring the current angle of the robotic arm and the position and attitude information of the quadcopter drone through airborne sensors.

[0063] Specifically, including,

[0064] Establish an Earth inertial space rectangular coordinate system F based on the initial position of the quadcopter UAV. i Its three axes point east (x), north (y), and sky (z) respectively; the body coordinate system F is fixed at the geometric center of the quadcopter UAV. b Its three axes point forward (x, y). b ), left(y b ), on (z) b ); Coordinate system O fixed on the joints of the robotic arm i (i = 0, 1, 2, 3), where O0 is the base coordinate system of the robotic arm system, and its origin coincides with the origin of the body coordinate system. The x0 axis is parallel to the x-axis of the UAV. b The axes are aligned, with the y0 axis aligned with the drone's z axis. b The axes are opposite (in this invention, the robotic arm mounted on the quadcopter drone is only in the x-axis direction). b -z b (Plane motion); the other three coordinate systems (three links) are fixed at the link joints (link ends), x i The axis points to the connecting rod, z i axis and y b The axes are in the same direction, y iThe axis is determined according to the right-hand rule;

[0065] The quadcopter obtains its position (x, y, z), attitude (φ, θ, ψ), and robotic arm angles (θ1, θ2, θ3) using the inertial measurement unit, barometer, and GPS sensors installed on the drone. During tracking and control, the quadcopter's position and attitude information needs to be converted to the Earth-fixed coordinate system F. i Below, to facilitate operation;

[0066] S200: Tracking control framework formulation and mode determination. Based on the spatial coordinate system established in step S100, the system dynamic characteristics caused by the movement of the robotic arm are integrated into the dynamic model of the quadcopter UAV, constructing a complete coupled system dynamic model of the quadcopter UAV and the robotic arm. On this basis, a three-loop trajectory tracking control framework is designed: the outer loop realizes position tracking control, the middle loop realizes attitude angle tracking control, and the inner loop realizes angular velocity tracking control. At the same time, based on the real-time robotic arm angle information obtained in step S100, the current mode of the system is determined by the preset mode division criteria, and the dynamic model of the corresponding mode is called.

[0067] Specifically, including,

[0068] Based on the coordinate system established in step S100, the forces and torques introduced by the robotic arm's motion to the UAV platform are calculated iteratively using the Newton-Euler formula. Simultaneously considering the system's rotational inertia and center of mass changes caused by the robotic arm's motion, the dynamic model of the robotic arm-mounted UAV is as follows:

[0069]

[0070]

[0071] In the formula, v x v y and v z The x, y, and z axes velocities of the quadcopter drone are given by m. b Here, f is the mass of the quadcopter drone, g is the local gravitational acceleration, and f is the local gravitational acceleration. bx f bz τ by The force and torque exerted on the drone by the movement of the robotic arm (where f) bx Along x b axis, f bz Along z b axis, τ by Around y b (axis), F T It is the total lift of the quadcopter drone, M p M q M r These are the rotational torques of the three axes of the quadcopter drone, kp k q k r These are the drag coefficients of the three axes of the quadcopter drone, J xx J yy J zz J xz It is the moment of inertia of the system (the quadcopter drone with a robotic arm), which is closely related to the length and current angle of the robotic arm, and is expressed as:

[0072]

[0073] In the formula, a1=(l c1 s1) 2 a2=(l1s1+l c2 s 12 ) 2 a3=(l1s1+l2s) 12 +l c3 s 123 ) 2 b1 = (l c1 c1) 2 b2=(l1c1+l c2 c 12 ) 2 b3 = (l1c1 + l2c) 12 +l c3 c 123 ) 2 s1 is sin(θ1), s 12 sin(θ) 1+ θ2), s 123 is sin(θ1+θ2+θ3), c1 is cos(θ1), c 12 cos(θ) 1+ θ2), c 123 For cos(θ1+θ2+θ3), l i It is the length of link i of the robotic arm, l ci J is the length from the center of link i of the robotic arm to the end of the link. bx J by J bz It is the moment of inertia of the quadcopter drone, m i It is the mass of link i;

[0074] Considering the dynamics of the quadcopter's actuators (the quadcopter's propellers), it can be modeled as follows:

[0075]

[0076] In the formula, ζ p ζ q ζ rIt refers to the physical parameters of the actuator (i.e., the inherent parameters after the hardware is manufactured, which are specific numbers), M pf M qf M rf It is the control input that needs to be designed;

[0077] Considering that angular velocity dynamics are strongly coupled, nonlinear, and exhibit large-range parameter variations due to the influence of the robotic arm's motion, a multimodal linear variable parameter tracking control system for angular velocity is established based on the current robotic arm angle:

[0078]

[0079] In the formula, B s It is the Jacobian matrix obtained after linearizing the tracking control system, w is the disturbance term of the tracking control system, and z is the Jacobian matrix. s It is the system state that needs to be observed, C s It is the output matrix, e s =[p,q,r,M p M q M r ] T It is the system tracking error, u s =[M pf M qf M rf ] T It is the system control input, η k,σ Under the same mode The multicell coefficients of the matrix, where σ is the system mode corresponding to different robot arm angles;

[0080] Based on the above tracking and control system, a three-loop tracking and control framework of position-angle-angular velocity for the robotic arm UAV is established to realize flight tracking and control of the UAV at different robotic arm angles.

[0081] S300, attitude tracking control of a quadcopter drone under continuous changes in robotic arm angle: The attitude tracking control is a two-loop control framework consisting of a middle loop attitude angle tracking control and an inner loop angular velocity tracking control. Based on the current attitude angle of the quadcopter drone obtained in step S100, the given attitude angle of the quadcopter drone is used as the reference input to determine the system state error. The desired angular velocity is obtained through the designed state feedback controller and transmitted to the inner loop. Based on the system mode determined in step S200, the inner loop angular velocity control performs rapid tracking through the design of a corresponding multi-mode smooth switching controller, thereby realizing the attitude tracking control of the quadcopter drone under continuous changes in robotic arm angle and ensuring the smoothness of control commands during mode switching.

[0082] Specifically, including,

[0083] When a quadcopter drone performs attitude tracking control, its reference input Φ d The lateral rotation angle φ calculated for the position loop d Pitch angle θ d and the given heading angle ψ d ;

[0084] Define the angle tracking error as e Φ =Φ d -Φ=[φ d -φ,θ d -θ,ψ d -ψ] T Where Φ represents the instantaneous roll angle, pitch angle, and yaw angle, the state feedback controller for angle tracking is designed as follows: Where R is the system rotation matrix, ω d =[p d ,q d ,r d ] T , ζ Φ =diag{ζ φ ,ζ θ ,ζ ψ} represents the positive real parameters for the roll, pitch, and yaw angles that need to be designed; if the angular velocity control loop can perform rapid tracking, angle control can be achieved; based on the current robot arm angle, the multi-modal smooth switching controller of the angular velocity loop can be designed as (switching from mode i to mode j σ(t)). j )):

[0085]

[0086] In the formula, T j It is a smooth time. The modality-dependent control gain is determined by a matrix related to the robot arm angle. B s C s Related to this, α is a time-dependent smoothing coefficient;

[0087] The controller can be solved using the following inequality and has a certain degree of anti-interference capability:

[0088]

[0089] The robustness performance index of this controller is as follows: λ、 τ Dc, γ0, and μ represent the maximum energy rise during mode switching, the minimum normal number ensuring system energy decrease under different modes, the maximum normal number ensuring system stability under smoothing under different modes, the maximum smoothing time during mode switching, dwell time, system parameters, and the system's anti-interference suppression capability, respectively. ij μ is the energy rise factor when switching from mode i to mode j. ji It is the energy switching coefficient for switching from mode j to mode j; the controller designed using this inequality can adjust the UAV attitude in real time according to the current system attitude error, realize attitude tracking control and smooth transition of control input during switching, and enable the UAV actuator to execute control commands smoothly;

[0090] S400, Position tracking control of a quadcopter UAV under continuous changes in robotic arm angle; Based on the three-loop trajectory tracking control framework established in step S200, the position and yaw angle of the quadcopter UAV are given as the reference input of the system. The system state error is calculated based on the current position and attitude information of the quadcopter UAV obtained in step S100. First, the lift of the system and the desired roll and pitch angles are calculated through the designed PD position controller. Then, the calculated roll and pitch angles, together with the given reference yaw angle, are passed to the angle loop as reference inputs. Angle tracking is achieved using the method in step S300, and finally, the position tracking control of the quadcopter UAV under continuous changes in robotic arm angle is realized.

[0091] Specifically, including,

[0092] When performing position tracking control on a rotary-wing UAV, due to its underactuated characteristics, a position controller is needed to calculate the yaw and pitch angles in real time as reference inputs for angle control. The position tracking control employs a PD controller, and considering the forces and torques introduced by the robotic arm's movement, the virtual control input is designed as follows:

[0093]

[0094] In the formula, ζ px ζ vx ζ py ζ vy ζ pz ζ vz These are the positive constants to be designed, so that the virtual control input above is:

[0095]

[0096] Using formulas (9) and (10), the controller for position tracking control can be designed as follows:

[0097]

[0098] In the formula,

[0099] Given reference input x d y d z d The controller adjusts the UAV position in real time according to the current system position error and calculates the roll and pitch angles and transmits them to the attitude control loop. According to the attitude controller in step S300, the position tracking control of the UAV under different robotic arm angles is realized.

[0100] The S500 system employs multi-modal smooth switching control for a quadcopter drone during continuous robotic arm movement. It uses onboard accelerometers and gyroscopes to measure the robotic arm angle in real time, determining the current control mode. Simultaneously, it utilizes IMU, GPS, and barometer sensors to acquire the drone's attitude and position information. Then, based on reference inputs, it calculates the system state error, and the onboard computer resolves the control inputs in real time, achieving position and attitude control of the drone. This process is repeated until the drone reaches the desired trajectory, continuously updating the drone's state.

[0101] Specific Implementation Scheme 2: The present invention provides a multimodal smooth switching flight control system for a quadcopter with a boom. The system has a program module corresponding to the above steps, and executes the steps in the above-mentioned multimodal smooth switching flight control method for a quadcopter with a boom when running.

[0102] The other combinations and connections in this implementation scheme are the same as in Specific Implementation Scheme 1.

[0103] Specific Implementation Scheme 3: The present invention provides a computer-readable storage medium storing a computer program configured to implement, when called by a processor, a multimodal smooth switching flight control method for a quadcopter unmanned aerial vehicle with a boom.

[0104] The other combinations and connections in this implementation scheme are the same as in Specific Implementation Scheme 1.

[0105] Simulation Experiment

[0106] (1) Verification of attitude control capability of a quadcopter UAV under different robotic arm angles. The robotic arm angle changes as follows:

[0107] θ1 = π / 2 + π / 6sin(π / 36·t), θ2 = π / 6cos(π / 36·t), θ3 = π / 6sin(π / 30·t). Further dividing the first and second angles, the changes in the robotic arm's angles are classified into four modes: Mode 1: θ1 ∈ [π / 3, π / 2], θ2 ∈ [-π / 6, 0], θ3 ∈ [-π / 6, π / 6]; Mode 2: θ θ1∈[π / 2,2π / 3], θ2∈[-π / 6,0], θ3∈[-π / 6,π / 6]; Mode 3: θ1∈[π / 3,π / 2], θ2∈[0,π / 6], θ3∈[-π / 6,π / 6]; Mode 4: θ1∈[π / 2,2π / 3], θ2∈[0,π / 6], θ3∈[-π / 6,π / 6], the continuous change of the robotic arm angle and the mode partitioning diagram are shown below. Figure 2 As shown. The attitude angle tracking value is set to φ. d = -0.17, θ d =0.08, ψ d =0.05t, the state feedback controller parameter of the angle control loop is designed as ζ φ =0.4, ζ θ =0.5, ζ ψ =0.2, the multi-mode smooth switching controller parameters of the angular velocity control loop are λ1=45, λ2=52, λ3=48, λ4=50, μ ij =1.4, c i =62,m i =2.3, b i =304, γ0=9.8, ζ p =ζ q =ζ r =0.5, T=0.3s, the attitude loop tracking control framework of a quadcopter UAV under continuous change of robotic arm angle is as follows: Figure 3 As shown. The obtained attitude tracking curve and the control commands output by the controller are as follows. Figure 5 As shown, compared with common multimodal control methods, the multimodal smooth switching control method designed in this invention not only ensures high-performance and high-reliability flight control, but also achieves smooth control commands so that the actuator can execute smoothly.

[0108] (2) Verification of the position control capability of a quadcopter UAV under different robotic arm angles. In position tracking, the controllers and parameters of the angle control loop and angular velocity control loop are the same as those in attitude tracking control. The position loop tracking control framework of the quadcopter UAV under continuous changes in robotic arm angle is as follows: Figure 4 As shown. The position reference trajectory is set to x. d =0.8sin(0.1t), y d =0.8cos(0.1t), z d =0.06t, ψd =0.1. For ease of comparison, two types of position loops were designed: a PD controller and a sliding mode controller. The parameter of the PD controller is ζ. px =2.7, ζ vx =0.8, ζ py =3.4, ζ vy =0.4, ζ pz =4.2, ζ vz =5.5, the sliding surface in the sliding mode controller is set to The rate of convergence is set to The obtained position tracking curve and the control commands output by the controller are as follows: Figure 5 As shown, under the PD controller, the system state can track the reference trajectory well, and the output control command does not change. However, the control command output by the sliding mode controller keeps jittering up and down, causing the system state to jitter around the reference trajectory.

[0109] While the present invention has been disclosed above, its scope of protection is not limited thereto. Those skilled in the art can make various changes and modifications without departing from the spirit and scope of the present invention, and all such changes and modifications will fall within the scope of protection of the present invention.

Claims

1. A multi-modal smooth-switching flight control method for a quadcopter unmanned aerial vehicle (UAV) with a boom, characterized in that, Includes the following steps: S100. Establish the Earth inertial coordinate system, the fixed coordinate system of the aircraft body, and the coordinate system of the robotic arm to obtain the angle information of the robotic arm and the position and attitude information of the quadcopter UAV. S200, Tracking control framework formulation and mode determination, including constructing a dynamic model of the coupled system of the quadcopter UAV and the robotic arm, designing a three-loop trajectory tracking control framework including an outer loop for position tracking control, a middle loop for attitude angle tracking control, and an inner loop for angular velocity tracking control; based on the robotic arm angle information obtained in step S100, determining the current mode of the system through a preset mode division criterion, and calling the dynamic model of the corresponding mode; Based on the current robotic arm angle, the following angular velocity multimodal linear variable parameter tracking control system is established: (6) In the formula, , These are all Jacobian matrices obtained after linearizing the tracking control system; It is a disturbance term in the tracking control system; It is the system state that needs to be observed; It is the output matrix; It is a system tracking error. These are the rotational torques of the three axes of the quadcopter drone; It is the system control input. , , It is the control input that needs to be designed; Under the same mode The multicell coefficients of the matrix; These are the system modes corresponding to different robot arm angles; S300, attitude tracking control of quadcopter UAV under continuous change of robotic arm angle: the current attitude angle of quadcopter UAV obtained in step S100 is used as the reference input of the system to determine the system state error. The desired angular velocity is obtained through the state feedback controller and transmitted to the inner loop. The inner loop designs a corresponding multi-modal smooth switching controller according to the robotic arm angle to realize angular velocity tracking. When a quadcopter drone performs attitude tracking control, the reference input Φ d The lateral rotation angle calculated for the position loop Pitch angle and given heading angle ; Define the angle tracking error as Where Φ represents the instantaneous roll angle, pitch angle, and yaw angle; the state feedback controller for angle tracking is designed as follows: Where R is the system rotation matrix, , These are the positive real parameters of the roll angle, pitch angle, and yaw angle that need to be designed. Based on the current robotic arm angle, switch from mode i to mode j. The multi-modal smooth switching controller of the angular velocity loop is designed as follows: (7) In the formula, It is a smoothed time; It is a mode-dependent control gain, consisting of a matrix related to the robot arm angle. , , related; A time-dependent smoothing coefficient; The controller of formula (7) is solved by the following inequality: (8) The robustness performance index of the controller in formula (7) is: , , , , , These represent the maximum energy increase during mode switching, the minimum normal number of system energy decrease under different modes, the maximum normal number of system stability under smoothing under different modes, the maximum smoothing time during mode switching, dwell time, system parameters, and the system's anti-interference suppression capability, μ. ij μ is the energy rise factor when switching from mode i to mode j. ji It is the energy switching coefficient for switching from mode j to mode j; It is the mass of link i; S400, Position tracking control of quadcopter UAV under continuous change of robotic arm angle: According to step S100, the position and attitude information of quadcopter UAV are obtained and the system state error is calculated; the lift of the system and the desired yaw angle and pitch angle are calculated through the PD position controller, and together with the reference yaw angle, they are transmitted to the angle loop as reference input. The position tracking control of quadcopter UAV under continuous change of robotic arm angle is realized through step S300. S500: During the continuous movement of the robotic arm, the quadcopter drone undergoes multi-modal smooth switching control. By providing the reference input of the system, the current position and attitude information are obtained in real time to obtain the system state error. Based on the real-time obtained robotic arm angle, the control system mode is determined. Steps S200-S400 are repeated until the quadcopter drone reaches the reference position and attitude under continuous changes in the robotic arm angle.

2. The multi-modal smooth switching flight control method for a quadcopter unmanned aerial vehicle (UAV) with a boom according to claim 1, characterized in that: In step S100, the following are included: Establish an Earth inertial space rectangular coordinate system based on the initial position of the quadcopter UAV. Its three axes point east (x), north (y), and directly upward (z), respectively; the body coordinate system is fixed at the geometric center of the quadcopter UAV. Its three axes point directly in front of the quadcopter drone (x) b ), left (y b ), directly above (z b ); coordinate system fixed on the joints of the robotic arm (i=0,1,2,3), where The coordinate system is the base coordinate system of the robotic arm system, with its origin coinciding with the origin of the body coordinate system. The x0 axis is aligned with the x-axis of the drone. b The axes are aligned, with the y0 axis aligned with the drone's z axis. b The axes are in opposite directions; the other three coordinate systems, fixed to the robotic arm joints, are respectively fixed at the three link joints, x i The axis points to the connecting rod, z i axis and y b The axes are in the same direction, y i The axis is determined according to the right-hand rule; The position information of the quadcopter drone is obtained from the onboard sensors on the drone. ), attitude information ( ) and robotic arm angle ( ).

3. The multi-modal smooth switching flight control method for a quadcopter unmanned aerial vehicle (UAV) with a boom according to claim 2, characterized in that: Step S200 includes, Based on the coordinate system established in step S100, the forces and torques introduced by the robotic arm's motion to the UAV platform are calculated iteratively using the Newton-Euler formula. Considering the system's rotational inertia and center of mass changes caused by the robotic arm's motion, the dynamic model of the robotic arm-mounted UAV is as follows: (1) (2) (3) In the formula, v x v y and v z These represent the speeds of the x, y, and z axes of the quadcopter drone. It refers to the mass of the quadcopter drone; It is gravitational acceleration; , , It is the force and torque that the robotic arm's movement brings to the drone, among which Along x b axis, Along z b axis, Around y b axis; It is the total lift of the quadcopter drone; These are the rotational torques of the three axes of the quadcopter drone; , , These are the drag coefficients of the three axes of the quadcopter drone; This is the moment of inertia of the quadcopter drone with its robotic arm, which is related to the length of the robotic arm and its current angle, and is expressed as: (4) In the formula, , , ; , , ; It is the length of link i of the robotic arm; It is the length from the center of link i of the robotic arm to the joint. It is the moment of inertia of the quadcopter drone; It is the mass of link i; s1 is sin(θ1), s 12 sin(θ) 1+ θ2), for c1 is cos(θ1), c 12 cos(θ) 1+ θ2), for ; Considering the actuator dynamics of the quadcopter drone, the model is as follows: (5) In the formula, , , These are the physical parameters of the actuator; , , It is the control input that needs to be designed; Based on formulas (1) to (5), a three-loop tracking control framework for the position-angle-angular velocity of the robotic arm UAV is established to realize flight tracking control of the UAV under different robotic arm angles.

4. The multi-modal smooth switching flight control method for a quadcopter unmanned aerial vehicle (UAV) with a boom according to claim 3, characterized in that: Step S400 includes, Position tracking control uses a PD controller. Considering the forces and torques introduced by the robotic arm's motion, the virtual control input is designed as follows: (9) In the formula, These are the positive constants to be designed, so that the virtual control input of formula (9) is: (10) Using formulas (9) and (10), the controller for position tracking control is designed as follows: (11) In the formula, , , ; Given reference input The controller adjusts the UAV position in real time according to the current system position error and calculates the yaw and pitch angles, which are then transmitted to the attitude control loop. The attitude controller in step S300 realizes the position tracking control of the UAV under different robotic arm angles.

5. A multi-modal smooth-switching flight control system for a quadcopter unmanned aerial vehicle with a boom, characterized in that: The system has a program module corresponding to the steps of any one of the claims 1-4 above, and executes the steps in the above-described method for multimodal smooth switching flight control of a quadcopter with a boom.

6. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program configured to, when invoked by a processor, implement the steps of the multimodal smooth switching flight control method for a quadcopter unmanned aerial vehicle according to any one of claims 1-4.