Four-rotor lifting control method and system based on energy and beneficial state coupling
By adopting the control method of energy and beneficial state coupling in the quadrotor lifting system, the difficulty of load swing and attitude control caused by under-drive and external interference of the quadrotor system is solved, and better positioning accuracy and transient characteristics are achieved. , improves the overall control performance of the system.
Patent Information
- Application Number
- CN202411072367.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-06
- Publication Date
- 2024-11-22
AI Technical Summary
The four-rotor lifting system faces under-drive characteristics, external interference and system uncertainty when controlling translation, vertical motion and attitude, resulting in difficulty in load swing and attitude control, and the prior art is difficult to effectively ensure transient characteristics and attitude response.
Using the control method based on energy and beneficial state coupling, a comprehensive three-dimensional model of 8 degrees of freedom of the four-rotor transport system is established through the Lagrangian equation, and the inner and outer ring controllers are designed separately, and the generalized displacement signal and coupling term are used to determine Function optimization control input ensures positioning and load swing removal of the quadrotor.
It significantly improves the positioning accuracy and load swing suppression ability of the four-rotor, enhances the system's transient characteristics and attitude control performance, ensures effective control of inner ring attitude tracking and outer ring displacement, and improves robustness and stability.
Smart Images

Figure CN119002535A_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of unmanned aerial vehicle control, and in particular relates to a quad-rotor hoisting control method and system based on energy and beneficial state coupling. Background Art
[0002] The quadrotor lifting system is abbreviated as QTS. In recent years, quadrotor aircraft have received widespread attention. It can achieve vertical take-off, landing, and hover at the desired height, and is highly flexible. Researchers have explored various control schemes and motion planning methods for quadrotor aircraft. Since quadrotor aircraft need to control translation, vertical motion, and attitude at the same time, it has six degrees of freedom but only four control inputs (i.e., three torques and one thrust), so it is an under-actuated system. In addition to the under-actuated characteristics, quadrotor aircraft also need to deal with strong nonlinearity, system uncertainty, external interference, and singularity when developing controllers. To address these problems, researchers have proposed methods such as adaptive nonlinear control, robust control, linear quadratic control, and sliding mode control.
[0003] The quadrotor transport system, which consists of a quadrotor, cables, and payloads, plays a vital role in military operations and emergency response. In a quadrotor transport system, there are only four control inputs to control eight degrees of freedom, including three translational degrees of freedom, two load swing degrees of freedom, and three attitude degrees of freedom. Therefore, the entire quadrotor transport system has a double underactuated characteristic. The underactuated characteristics of QTS, external disturbances, and system uncertainties pose great challenges to the execution of its control tasks.
[0004] In order to track the attitude and load position of the quadrotor, QTS is usually regarded as a differential flat hybrid system. In the modeling process, the load is regarded as an interfering object, and the operation trajectory is planned in a flat space using a geometric controller. Forcing the quadrotor to move to the target position may cause the load to swing violently. To address this swing problem, a variety of open-loop control methods and closed-loop control methods have been proposed. The closed-loop control method counteracts external interference through real-time feedback signals and shows better robustness than the open-loop method.
[0005] A nested saturation method is introduced in the prior art, which can not only suppress the swing of the load, but also drive the quadrotor to the target position. However, this method takes the attitude of the quadrotor as the control input, ignoring the fact that the attitude of the quadrotor is regulated by torque. To this end, an eight-degree-of-freedom three-dimensional control hierarchical method is proposed to ensure that the requirements of human body positioning, attitude control and load swing elimination are met simultaneously. However, due to the lack of load information, the transient characteristics of the system cannot be fully guaranteed. In addition, the coupling terms in the hierarchical control method may affect the transient response of the QTS, such as the position, attitude and load angle of the quadrotor.
[0006] In recent years, energy shaping methods have been widely studied and used to control various mechanical systems, such as bridge cranes and mobile inverted pendulums. The inventors found that in the total energy shaping method, the introduction of kinetic energy enhances the internal coupling and significantly improves the transient characteristics compared with the potential energy shaping method. However, the energy shaping method has limited improvement on the anti-sway effect. By introducing load displacement information, the system coupling is enhanced, thereby reducing the swing angle of the load. However, the coupling term between the inner loop attitude change and the outer loop position will affect the transient performance of the system. Summary of the invention
[0007] In order to overcome the shortcomings of the above-mentioned prior art, the present invention provides a quadrotor lifting control method and system based on energy and beneficial state coupling, and establishes a comprehensive three-dimensional model of eight degrees of freedom of the quadrotor transportation system using the Lagrange equation. Based on the cascade system theory, the inner and outer loop controllers can be designed separately. The inner loop uses an attitude tracking controller, while the outer loop adopts a new energy coupling-based controller to control the displacement of the quadrotor and eliminate load swing.
[0008] To achieve the above objectives, one or more embodiments of the present invention provide the following technical solutions:
[0009] The first aspect of the present invention provides a quad-rotor hoisting control method based on energy and beneficial state coupling.
[0010] The quadrotor lifting control method based on energy and beneficial state coupling includes the following steps:
[0011] Establish the outer loop dynamics model and inner loop dynamics model of the quadrotor UAV transport system, define the outer loop tracking error and inner loop tracking error, and define the coupling term between the inner loop and the outer loop;
[0012] The mechanical energy of the entire system is defined as the first energy storage function; the body position and the load swing angle are associated, a generalized displacement signal is introduced, and a second new energy storage function is defined using the generalized displacement signal; the first energy storage function is summed with the second new energy storage function to obtain a total energy storage function;
[0013] A coupling item discriminant function is defined, and the coupling item discriminant function is used to judge whether the coupling item between the inner loop and the outer loop is harmful or beneficial;
[0014] Based on the discrimination results of the total energy storage function and the coupling term discrimination function, the virtual control input of the outer loop is obtained. Based on the virtual control input of the outer loop, the body displacement and the load swing angle are obtained through the outer loop dynamics model.
[0015] Based on the attitude tracking controller, the control torque of the inner loop is obtained, and based on the control torque input of the inner loop, the attitude angle is obtained through the inner loop dynamics model.
[0016] The second aspect of the present invention provides a quad-rotor hoisting control system based on energy and beneficial state coupling.
[0017] The quadrotor lifting control system based on energy and beneficial state coupling includes:
[0018] The inner and outer loop division module is configured to: establish an outer loop dynamics model and an inner loop dynamics model of the quadrotor UAV transportation system, define an outer loop tracking error and an inner loop tracking error, and define a coupling term between the inner loop and the outer loop;
[0019] The energy storage function definition module is configured to: define the mechanical energy of the entire system as a first energy storage function; associate the body position with the load swing angle, introduce a generalized displacement signal, and use the generalized displacement signal to define a second new energy storage function; sum the first energy storage function and the second new energy storage function to obtain a total energy storage function;
[0020] The coupling item judgment module is configured to: define a coupling item discrimination function, and use the coupling item discrimination function to judge whether the coupling item between the inner loop and the outer loop is harmful or beneficial;
[0021] The outer loop controller design module is configured to: obtain the virtual control input of the outer loop based on the discrimination results of the total energy storage function and the coupling term discrimination function, and obtain the body displacement and load swing angle through the outer loop dynamics model based on the virtual control input of the outer loop;
[0022] The inner loop controller design module is configured to obtain the control torque of the inner loop based on the attitude tracking controller, and obtain the attitude angle through the inner loop dynamics model based on the control torque input of the inner loop.
[0023] The third aspect of the present invention provides a computer-readable storage medium having a program stored thereon, which, when executed by a processor, implements the steps in the quad-rotor hoisting control method based on energy and beneficial state coupling as described in the first aspect of the present invention.
[0024] The fourth aspect of the present invention provides an electronic device, including a memory, a processor, and a program stored in the memory and executable on the processor, wherein when the processor executes the program, the steps in the quad-rotor hoisting control method based on energy and beneficial state coupling as described in the first aspect of the present invention are implemented.
[0025] One or more of the above technical solutions have the following beneficial effects:
[0026] The present invention provides a quadrotor hoisting control method and system based on energy and beneficial state coupling. It is a new control method based on energy coupling, which simultaneously realizes the positioning of the quadrotor and eliminates the swing of the load. First, the concept of generalized load is introduced, and then a new QTS passive characteristic is proposed; secondly, a judgment function is designed to evaluate the benefits of the coupling terms, and the beneficial coupling terms are retained to improve the transient characteristics of the system; thirdly, by constructing a new energy storage function, a new outer loop subsystem control signal is proposed to ensure that the inner loop attitude tracking controller can effectively track the quadrotor transportation system. In order to verify the feasibility and effectiveness of this method, a variety of simulation experiments were carried out. This method not only has excellent positioning and swing elimination capabilities, but also significantly improves the attitude control performance.
[0027] The newly constructed control scheme of the present invention includes the position information of the quadrotor and the load swing signal, which significantly enhances the state coupling of the system compared with the traditional energy coupling hierarchical control method.
[0028] The present invention is different from the traditional method of directly proving the growth condition limit of the coupling term. The controller proposed by the present invention retains the beneficial coupling effect and significantly improves the transient characteristics of the system.
[0029] The present invention analyzes the Lyapunov candidate function while retaining the beneficial coupling between the inner and outer loops, and provides a theoretical proof of the asymptotic stability of the equilibrium point of the closed-loop system.
[0030] Advantages of additional aspects of the present invention will be given in part in the following description, and in part will become obvious from the following description, or will be learned through practice of the present invention. BRIEF DESCRIPTION OF THE DRAWINGS
[0031] The accompanying drawings in the specification, which constitute a part of the present invention, are used to provide a further understanding of the present invention. The exemplary embodiments of the present invention and their descriptions are used to explain the present invention and do not constitute improper limitations on the present invention.
[0032] Figure 1 It is a schematic diagram of the four-rotor transport system of the present invention.
[0033] Figure 2 It is a comparison diagram of displacement and swing angle between the control method of the present invention and the energy coupling control method.
[0034] Figure 3 It is a comparison diagram of the control input of the control method of the present invention and the energy coupling control method.
[0035] Figure 4 It is a comparison diagram of the attitude angles of the control method of the present invention and the energy coupling control method.
[0036] Figure 5 The displacement and swing angle after external disturbance is applied in the present invention.
[0037] Figure 6 It is the control input after applying external disturbance in the present invention.
[0038] Figure 7 It is the attitude angle after applying external disturbance in the present invention.
[0039] Figure 8 This is a comparison diagram of displacement and swing angle before and after applying internal disturbance in the present invention.
[0040] Fig. 9 This is a comparison diagram of the control input before and after applying the internal disturbance of the present invention.
[0041] Fig.10 This is a comparison diagram of the attitude angles before and after the internal disturbance is applied in the present invention.
[0042] Fig.11 This is an overall flow chart of the first embodiment of the present invention. DETAILED DESCRIPTION
[0043] It should be noted that the following detailed descriptions are exemplary and are intended to provide further explanation of the present invention. Unless otherwise specified, all technical and scientific terms used herein have the same meanings as those commonly understood by those skilled in the art to which the present invention belongs.
[0044] It should be noted that the terms used herein are for describing specific embodiments only and are not intended to be limiting of exemplary embodiments according to the present invention.
[0045] In the absence of conflict, the embodiments of the present invention and the features of the embodiments may be combined with each other.
[0046] Embodiment 1
[0047] The embodiment of the present invention proposes a QTS control scheme based on energy shaping and beneficial coupling technology. The Lagrange equation is used to establish a comprehensive three-dimensional model of the eight degrees of freedom of the quadrotor transport system; based on the cascade system theory, the inner and outer loop controllers can be designed separately, and the stability of the system can be guaranteed as long as the growth constraint of the coupling term is met. Among them, the inner loop uses an attitude tracking controller, while the outer loop uses a new energy coupling-based controller to control the displacement of the quadrotor and eliminate load swing.
[0048] Specifically, the swing angle is converted into generalized displacement information by mathematically correlating the airframe position with the load swing angle information. This transforms the objectives of airframe positioning and load swing elimination into system-wide positioning objectives. An energy storage function that includes the QTS kinetic and potential energies is established. Based on this function, a controller is designed to achieve accurate airframe positioning and load elimination. In order to fully utilize the state coupling effect between the inner and outer loop subsystems, a state coupling method is introduced.
[0049] The simulation results show that the control method of this embodiment is superior to the traditional energy coupling control method in positioning and eliminating the swing of the outer ring, and enhances the attitude adjustment capability of the inner ring. The method also shows strong robustness. The simulation results further verify the feasibility and effectiveness of the proposed control scheme.
[0050] The quadrotor hoisting control method based on energy and beneficial state coupling disclosed in this embodiment may include the following steps:
[0051] The quadrotor lifting control method based on energy and beneficial state coupling is characterized by comprising the following steps:
[0052] Establish the outer loop dynamics model and inner loop dynamics model of the quadrotor UAV transport system, define the outer loop tracking error and inner loop tracking error, and define the coupling term between the inner loop and the outer loop;
[0053] The mechanical energy of the entire system is defined as the first energy storage function; the body position and the load swing angle are associated, a generalized displacement signal is introduced, and a second new energy storage function is defined using the generalized displacement signal; the first energy storage function is summed with the second new energy storage function to obtain a total energy storage function;
[0054] A coupling item discriminant function is defined, and the coupling item discriminant function is used to judge whether the coupling item between the inner loop and the outer loop is harmful or beneficial;
[0055] Based on the discrimination results of the total energy storage function and the coupling term discrimination function, the virtual control input of the outer loop is obtained. Based on the virtual control input of the outer loop, the body displacement and the load swing angle are obtained through the outer loop dynamics model.
[0056] Based on the attitude tracking controller, the control torque of the inner loop is obtained, and based on the control torque input of the inner loop, the attitude angle is obtained through the inner loop dynamics model.
[0057] As a more specific technical solution, this embodiment includes the following steps:
[0058] (a) Dynamic model of the quadrotor transport system.
[0059] according to Figure 1The quadrotor transport system shown uses the Newton-Lagrange equation to establish the following dynamic model:
[0060]
[0061] Among them, (1) represents the outer loop dynamic model, which covers the displacement of the quadrotor and the swing of the load; (2) and (3) represent the inner loop dynamic model; Indicates converting a vector into an antisymmetric matrix; represents the state vector including the displacement of the body and the swing angle of the load; denote the inertia matrix and the centripetal-Coriolis matrix respectively; represents the gravity vector; Indicates control input; F r represents the air resistance vector.
[0062] The above symbols are expressed in detail as follows:
[0063] q=[ξ T ,θ1,θ2] T (4)
[0064]
[0065] m c11 =m c22 =m c33 =M+m; m c55 =ml 2 ;m c41 =m c14 =mlC1C2;
[0066] m c43 =m c34 =mlS1C2;m c51 =m c15 =-mlS1S2;m c52 =m c25 =mlC2;m c53 =m c35 =mlC1S2
[0067]
[0068]
[0069] G=[0,0,0,mglS1C2,mglC1S2] T (7)
[0070] u=[(fRe3-(M+m)ge3) T ,0,0] T (8)
[0071] e3=[0,0,1] T (9)
[0072]
[0073]
[0074] in, Indicates the position of the quadrotor's center of mass in the inertial coordinate system; and is the motion of the projection signal; f(t) is the control input of the system; R(t)∈SO(3) is the rotation matrix of the quadrotor from the body coordinate system to the inertial coordinate system; Indicates the angular velocity of the quadrotor when its attitude changes in the body coordinate system; represents the mass of the quadrotor; Indicates the mass of the load; Indicates the rope length between the quadrotor and the payload; represents the acceleration due to gravity; Represents the moment of inertia of the quadrotor in the body coordinate system; C1, C2, S1 and S2 are the abbreviations of cos(θ1), cos(θ2), sin(θ1) and sin(θ2) respectively.
[0075] As mentioned above, the quadrotor lifting system has two main control objectives, namely ensuring that the quadrotor reaches a close target position and suppressing the load swing ξ→ξ d ,Θ→0 2×1 , where θ = [θ1, θ2] T . For the desired location The goal can also be expressed as:
[0076]
[0077] In order to facilitate the analysis and design of the subsequent controller, the outer loop tracking error is defined as as follows:
[0078] e q (t) = q(t) - q d =[e ξ (t) T ,θ1(t),θ2(t)] T (17)
[0079]
[0080] Then, the error model can be defined as follows:
[0081]
[0082] Considering the input u of the subsystem, the system contains the coupling term R(t) of the rotation matrix in cascade form. Therefore, fRe3 can be decomposed into:
[0083]
[0084] Contains information about the thrust and rotation matrices as coupling terms between the inner and outer loops.
[0085] The control vector then designed The definition is as follows:
[0086]
[0087] In addition, the input u(t) of the outer loop subsystem can be decomposed into the following three parts:
[0088] u=u d -m0+Δ d (twenty four)
[0089] In the formula, From the virtual control input f d , The vector form of the combined gravity of the quadrotor and the payload is: represents the coupling term between the inner and outer loops, Δ d The vector expansion form represented by is defined as follows:
[0090]
[0091] m0=[0,0,(M+m)g,0,0] T (26)
[0092] Δ d =[Δ T ,0,0] (27)
[0093] According to equation (1), the second-order time derivative of equation (17) can be expressed as:
[0094]
[0095] The new outer loop error vector Defined as And its derivative with respect to time can be obtained:
[0096]
[0097] Among them, the auxiliary vector and coupling terms Given as follows:
[0098]
[0099] Among them, the matrix The definition is as follows:
[0100]
[0101] Among them I 5×5 represents the identity matrix, 0 5×5 represents the zero matrix.
[0102] Attitude error in the inner loop subsystem and angular velocity error The definition is as follows:
[0103]
[0104] e ω =ω-R T R d ω d (34)
[0105] in is the inverse operation of sk(·), It is a posture of expectation. is the angular velocity of the quadrotor in the object coordinate system. R and e ω The time derivative is:
[0106]
[0107] Then, according to equations (17), (18), (33), and (34), a nonlinear control scheme is designed to achieve the control objective.
[0108] Note 1: The system consists of four control inputs and And the controlled variables consisting of displacement and attitude show under-actuated characteristics. After the introduction of load, QTS has a "double" under-actuated characteristic. Unlike the full-drive system, the control input u(t) of the outer loop affects the thrust f(t) and torque τ(t), which in turn affects the attitude R(t) of the inner loop. The attitude adjustment of the inner loop is affected by the control input of the outer loop, and there is a coupling relationship between the two.
[0109] In order to facilitate subsequent analysis, (1) is expanded and transformed as follows:
[0110]
[0111] (ii) Establishment of energy storage equation.
[0112] In this section, the characteristics of the position signal are analyzed in detail and a new energy storage function is proposed.
[0113] For the outer ring subsystem, the energy equation is derived using the kinetic energy and potential energy of the system as follows:
[0114]
[0115] Due to M c is a positive definite symmetric matrix, E is θ1(t) and θ2(t) are locally positive definite.
[0116] Take the time derivative of (42) and consider is a skew-symmetric matrix, we can get:
[0117]
[0118] The above formula shows that the input of the system is fRe3-(M+m)ge3 and the output is ξ. Since the load information is not included in the energy equation, the energy equation is only related to the displacement ξ(t) of the quadrotor. Therefore, we introduce the load position information to redefine the energy equation:
[0119] ξ p =ξ+l[S1C2, S2, -C1C2] T (44)
[0120] The generalized displacement signal is introduced below:
[0121] χ p =ξ+h(Θ) (45)
[0122] Where h = [h1, h2, h3] T is the unknown coefficient related to the load swing. Then, the generalized displacement signal χ p Define a new energy storage function E k (t), its derivative can be written as:
[0123]
[0124] Direct control with the introduction of generalized displacement information enhances the coupling between displacement and load motion in the quadrotor.
[0125] In order to determine E k The specific expression of (t) is obtained from equations (42), (43) and (46):
[0126] E k =E+E d (47)
[0127] Where E d The specific expression of (t) is as follows:
[0128]
[0129] Substituting equations (37)-(39) into equation (48), we obtain:
[0130]
[0131] and The specific form is as follows:
[0132]
[0133] observe and The structure of and considering the following mathematical results, we can get:
[0134]
[0135]
[0136] The following conditions are met for h:
[0137]
[0138] in, is a constant parameter. Then equation (50) can be rewritten as follows:
[0139]
[0140] Substituting equation (40) and equation (41) into equation (59), we obtain:
[0141]
[0142] Therefore E dx It can be expressed as follows:
[0143]
[0144] Similarly, E dy and E dz The expression is as follows:
[0145]
[0146]
[0147] Therefore, from equations (61)-(63) we can get:
[0148]
[0149] According to the above formula (64), we choose λ<0 to ensure E dis positive, and the control gain k is introduced λ =-λ>0 for easy expression. Therefore, the new energy storage function E can be obtained from equations (42) and (64): k (t):
[0150]
[0151] E k is locally positive definite.
[0152] (iii) Controller design
[0153] This section gives the detailed design process of the controller.
[0154] The control objective of this embodiment is to eliminate the positioning of the quadrotor and the load swing given in equation (16). According to equations (56)-(58), h is generated by:
[0155] h=-k λ [S1C2, S2, 1-C1C2] T (66)
[0156] In addition, based on formula (45), χ p (t) can be written as:
[0157] χ p =ξ-k λ [S1C2, S2, 1-C1C2] T (67)
[0158] According to formula (67), the control objective (16) can be changed to:
[0159] χ p → d (68)
[0160] Therefore, the load positioning error The definition is as follows:
[0161] υ=χ p -ξ d =e ξ +h (69)
[0162] Considering equation (65), the total energy storage function can be defined as follows:
[0163]
[0164] Where E t It is positive. represents the diagonal positive definite gain matrix. By equations (46) and (69), E t The time derivative of (t) is given by:
[0165]
[0166] Substituting equation (22) and equation (23) into equation (71), we obtain:
[0167]
[0168] The inner and outer loop coupling terms in equation (72) have both favorable and unfavorable effects on system performance. Therefore, in order to make full use of the beneficial coupling terms, the following equation is proposed:
[0169]
[0170] The criteria for determining whether a coupling term is harmful or beneficial are as follows:
[0171]
[0172] Based on equations (72)-(74), the virtual control input f is given d for:
[0173]
[0174] in represents a positive definite diagonal matrix, and P is defined as follows:
[0175]
[0176] The thrust f(t) can be calculated from the virtual force f of the outer ring d The synthesis is as follows:
[0177]
[0178] To determine the desired attitude, the required attitude axis vector must be calculated using the following formula:
[0179]
[0180] Therefore, the controller settings for the inner loop attitude are as follows:
[0181]
[0182] in, is a matrix containing positive constants, and the desired angular velocity ω d It can be calculated by the following formula:
[0183]
[0184] As shown in
[31] , the torque input (79) ensures that e R and e ωThe zero-point equilibrium is exponentially stable.
[0185] Lemma 1: Under the action of the virtual control input (75), the system error (18) converges asymptotically to zero, that is:
[0186]
[0187] Proof: Substituting formula (75) into formula (72), we can obtain:
[0188]
[0189] in, It should be discussed on a case-by-case basis.
[0190] Case 1: If J>0, then
[0191]
[0192] Choose the positive definite function E defined in (70) t (t) as a Lyapunov candidate function V(t) = E t (t), its time derivative is as follows:
[0193]
[0194] Therefore, the equilibrium point of the closed-loop system is stable in the Lyapunov sense and can be expressed by combining equations (69) and (75):
[0195]
[0196] Combining equation (65) with equation (70) we get:
[0197]
[0198] Secondly, the convergence of the closed-loop system is proved, and the invariant set Φ is defined as:
[0199]
[0200] Let Γ be the largest invariant set in Φ. It can be deduced from formula (84) that in the invariant set Γ
[0201]
[0202] where α υ =[α υx ,α υy ,α υz ] T is a constant vector to be determined, and then from equation (75) we can get:
[0203] f d =-K p α υ +(M+m)ge3 (89)
[0204] Then we need to prove that in the maximal invariant set Γ υ =0 3×1 Taking the second-order time derivative on both sides of equation (67) and substituting it into equation (88), we can obtain:
[0205]
[0206] Substitute equation (89) into equations (37)-(39):
[0207]
[0208] According to equations (90)-(95), we can obtain:
[0209]
[0210] With α υx For example. If α υx ≠0, we can conclude that when t→∞, and (85) The conclusion is obviously inconsistent. Therefore, this assumption is not valid. Through similar analysis, we can see that in Γ:
[0211]
[0212] f d =(M+m)ge3 (100)
[0213]
[0214] in is a constant vector to be determined. Similarly, we can conclude that, in the set Γ:
[0215]
[0216] In the formula, is a constant vector to be determined. Therefore, it can be deduced from equations (88) and (102) that And the following conclusions can be obtained from equations (56)-(58):
[0217]
[0218] Taking into account the swing angle of the load, in actual conditions it is So we can get:
[0219]
[0220] On this basis, through equations (40)-(41), (66), (99)-(101), (106) and (88), we can obtain:
[0221]
[0222] Combining equations (99)-(101), (106) and (107), the maximum invariant set Γ only contains equilibrium points:
[0223]
[0224] The above conclusions are proved by Lassalle's invariance principle.
[0225] Case 2: If J≤0, then
[0226]
[0227] When the coupling term Δ is ignored, the stability proof process is the same as in case 1, so as long as the coupling term satisfies the growth limit condition, the stability of the entire system can be proved.
[0228] Lemma 2: There exists a positive constant and one at point The κ-type function γ(·) is differentiable at , so that the coupling term η satisfies the following growth constraint:
[0229] ||β||≤γ(e R )||e||,if||e||≥d Δ (110)
[0230] Proof: To prove this lemma, we should first analyze the boundedness of the signals h and h, and draw the following conclusion from equation (66):
[0231]
[0232] From equations (56)-(58), we can see that You can scale as follows:
[0233]
[0234] Let λ p and λ d They represent the control gain K p and K d The maximum eigenvalue of . According to equations (111) and (112), it is not difficult to obtain:
[0235]
[0236] Define the following parameters:
[0237]
[0238] There is a positive number Let the virtual control input vector f d (t)Satisfy:
[0239]
[0240] Combining equation (22) with equations (77) and (78), we can obtain:
[0241]
[0242] In the formula, Represents vector Re3 and vector R d The sine of the angle between ||e3 R || represents the rotation matrix R and R d Therefore, considering equation (115), we have
[0243]
[0244] Combining η, Δ u and (117), we can get the following inequality:
[0245]
[0246] where F represents the Frobenius norm of the matrix. Then we get γ(·) and d as follows Δ :
[0247]
[0248] Therefore, Lemma 2 is proved.
[0249] Theorem 1: The thrust input (75) and torque input (79) can make the quadrotor reach the desired position and ensure the elimination of the load swing angle.
[0250]
[0251] Proof: According to Lemma 1 and Lemma 2 and the stability of the inner loop tracking, it is proved that the equilibrium point is asymptotically stable.
[0252] (IV) Simulation results and analysis
[0253] This part includes two sets of simulation experiments to verify the superiority of the proposed control scheme. The first set is compared with the energy coupling control method to verify the better performance of the proposed method, and the second set tests its robustness to external disturbances and parameter uncertainties.
[0254] The machine mass, load mass, gravitational acceleration, rope length and moment of inertia are set as follows:
[0255] M=0.645kg, m=0.075kg, g=9.8kg·m / s 2 ,
[0256] l=0.535m,J=diag(0.010,0.010,0.012)kg·m 2
[0257] The inner loop control gains of the two controllers are uniformly set to:
[0258] K R =diag(5.3,5.3,6.2)
[0259] K ω =diag(0.5,0.5,1.0)
[0260] For the energy coupling control method, the control gain is selected as follows:
[0261] K P =diag(2.7,1.8,7.0)
[0262] K d =diag(4.6,3.1,10)
[0263] K λ =diag(1.8,4.5,1.0)
[0264] The control gain of the controller designed in this embodiment is selected as follows:
[0265] K P =diag(4.5,3.1,8)
[0266] K d =diag(5.1,2.8,10)
[0267] K λ =diag(5.0,12,1.0)
[0268] Simulation test 1: control performance test
[0269] The initial position and expected position of the quadrotor are set as follows:
[0270] ξ(0)=[1.0,1.3,1.5] T → d =[0.5,0.3,1.0] T
[0271] from Figure 2 , Figure 3 and Figure 4 It can be seen that in terms of positioning of the quadrotor, the performance of the energy coupling control method is similar to that of the proposed method, but in terms of the ability to eliminate swing, the proposed method is significantly stronger than the energy coupling control method. Figure 4 It can be seen that the designed outer loop controller also has good performance in suppressing the inner loop posture.
[0272] Simulation test 2: Robustness simulation test
[0273] Next, two sets of disturbance rejection simulation tests are given. The first set applies external disturbances in different directions to test the robustness of the system. The second set changes the rope length and load mass. New initial positions and expected positions are selected to test the impact of internal disturbances on the system.
[0274] In the first set of robustness simulation tests, we used pulse signals to simulate external disturbances to the system. These disturbances act on the quadrotor and the load from different directions. Figure 5-Figure 7 As shown. At time t1, we apply a disturbance along the θ1 direction to the load. The proposed control method can still ensure that the quadrotor reaches the target position accurately and effectively suppresses the swing of the load. At times t2 and t3, we apply disturbances to the load along the θ1 and θ2 directions at the same time. This method can still quickly restore the system to a balanced state. In addition, at times t4 and t5, external disturbances are applied to the x and y axes of the quadrotor respectively. The proposed algorithm can still ensure the stability of the system.
[0275] In order to evaluate the robustness of the proposed control scheme to internal disturbances such as uncertain rope length and load mass, two cases are considered: 1) l = 1m, m = 0.106kg; 2) l = 0.535m, m = 0.075kg. The control performance is shown in Figure 8-Figure 10 As shown in the figure, it can be seen from these curves that the quadrotor can still reach the expected position quickly and stably under different rope lengths and load masses. The load swing angle can be kept within 3 degrees. At the same time, the quadrotor fuselage attitude is also kept within the normal range.
[0276] This embodiment proposes a new control method based on energy coupling, which simultaneously realizes the positioning of the quadrotor and eliminates the swing of the load. First, the concept of generalized load is introduced, and then the new QTS passive characteristic is proposed. Secondly, a judgment function is designed to evaluate the benefits of the coupling terms, and the beneficial coupling terms are retained to improve the transient characteristics of the system. By constructing a new energy storage function, a new outer loop subsystem control signal is proposed to ensure that the inner loop attitude tracking controller can effectively track the quadrotor transport system. In order to verify the feasibility and effectiveness of this method, a variety of simulation experiments were carried out. This method not only has excellent positioning and swing elimination capabilities, but also significantly improves the attitude control performance.
[0277] Embodiment 2
[0278] This embodiment discloses a quad-rotor hoisting control system based on energy and beneficial state coupling.
[0279] The quadrotor lifting control system based on energy and beneficial state coupling includes:
[0280] The inner and outer loop division module is configured to: establish an outer loop dynamics model and an inner loop dynamics model of the quadrotor UAV transportation system, define an outer loop tracking error and an inner loop tracking error, and define a coupling term between the inner loop and the outer loop;
[0281] The energy storage function definition module is configured to: define the mechanical energy of the entire system as a first energy storage function; associate the body position with the load swing angle, introduce a generalized displacement signal, and use the generalized displacement signal to define a second new energy storage function; sum the first energy storage function and the second new energy storage function to obtain a total energy storage function;
[0282] The coupling item judgment module is configured to: define a coupling item discrimination function, and use the coupling item discrimination function to judge whether the coupling item between the inner loop and the outer loop is harmful or beneficial;
[0283] The outer loop controller design module is configured to: obtain the virtual control input of the outer loop based on the discrimination results of the total energy storage function and the coupling term discrimination function, and obtain the body displacement and load swing angle through the outer loop dynamics model based on the virtual control input of the outer loop;
[0284] The inner loop controller design module is configured to obtain the control torque of the inner loop based on the attitude tracking controller, and obtain the attitude angle through the inner loop dynamics model based on the control torque input of the inner loop.
[0285] Embodiment 3
[0286] The purpose of this embodiment is to provide a computer-readable storage medium.
[0287] A computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the steps in the quad-rotor hoisting control method based on energy and beneficial state coupling as described in Example 1 of the present disclosure.
[0288] Embodiment 4
[0289] The purpose of this embodiment is to provide an electronic device.
[0290] An electronic device includes a memory, a processor, and a program stored in the memory and executable on the processor. When the processor executes the program, the steps of the quad-rotor hoisting control method based on energy and beneficial state coupling as described in Example 1 of the present disclosure are implemented.
[0291] The steps involved in the apparatuses of the above embodiments 2, 3 and 4 correspond to the method embodiment 1, and the specific implementation methods can refer to the relevant description part of embodiment 1. The term "computer-readable storage medium" should be understood as a single medium or multiple media including one or more instruction sets; it should also be understood to include any medium that can store, encode or carry an instruction set for execution by a processor and enable the processor to execute any method in the present invention.
[0292] Those skilled in the art should understand that the modules or steps of the present invention described above can be implemented by a general-purpose computer device, or alternatively, they can be implemented by a program code executable by a computing device, so that they can be stored in a storage device and executed by the computing device, or they can be made into individual integrated circuit modules, or multiple modules or steps therein can be made into a single integrated circuit module for implementation. The present invention is not limited to any specific combination of hardware and software.
[0293] Although the above describes the specific implementation mode of the present invention in conjunction with the accompanying drawings, it is not intended to limit the scope of protection of the present invention. Those skilled in the art should understand that various modifications or variations that can be made by those skilled in the art on the basis of the technical solution of the present invention without creative work are still within the scope of protection of the present invention.
Claims
1. A quadrotor hoisting control method based on energy and beneficial state coupling, characterized in that: The following steps are involved: Establish the outer loop dynamics model and inner loop dynamics model of the quadrotor UAV transport system, define the outer loop tracking error and inner loop tracking error, and define the coupling term between the inner loop and the outer loop; The mechanical energy of the entire system is defined as the first energy storage function; the body position and the load swing angle are associated, a generalized displacement signal is introduced, and a second new energy storage function is defined using the generalized displacement signal; the first energy storage function is summed with the second new energy storage function to obtain a total energy storage function; A coupling item discriminant function is defined, and the coupling item discriminant function is used to judge whether the coupling item between the inner loop and the outer loop is harmful or beneficial; Based on the discrimination results of the total energy storage function and the coupling term discrimination function, the virtual control input of the outer loop is obtained. Based on the virtual control input of the outer loop, the body displacement and the load swing angle are obtained through the outer loop dynamics model. Based on the attitude tracking controller, the control torque of the inner loop is obtained, and based on the control torque input of the inner loop, the attitude angle is obtained through the inner loop dynamics model.
2. The quadrotor hoisting control method based on energy and beneficial state coupling according to claim 1, characterized in that: The outer loop tracking error for: e q (t)=q(t)-q d =[e ξ (t) T ,θ1(t),θ2(t)] T ; in, represents the state vector including the displacement of the body and the swing angle of the load; is the desired position; θ=[θ1,θ2] T for; Indicates the position of the quadrotor's center of mass in the inertial coordinate system; and is the motion of the projection signal; e ξ =ξ-ξ d is the error of the body displacement; The inner loop tracking error includes the attitude error and angular velocity error e ω =ω-R T R d oh d ; in, is the inverse operation of sk(·), It is a posture of expectation. is the angular velocity of the quadrotor in the object coordinate system; R(t)∈SO(3) is the rotation matrix of the quadrotor from the body coordinate system to the inertial coordinate system; The coupling term is: Where f(t) is the control input of the system; e3 is the constant vector [0,0,1] T .
3. The quadrotor lifting control method based on energy and beneficial state coupling as claimed in claim 2, characterized in that: The generalized displacement signal χ p for: x p =ξ+h(Θ); h=[h1,h2,h3] T is the undetermined coefficient related to load swing; Indicates the position of the quadrotor's center of mass in the inertial coordinate system; New energy storage function E k (t) is: in, represents the state vector including the displacement of the machine body and the swing angle of the load; M c (q) is the inertia matrix; represents the mass of the quadrotor; Indicates the mass of the load; Indicates the rope length between the quadrotor and the payload; Represents the acceleration due to gravity; C1 and C2 are the abbreviations of cos(θ1) and cos(θ2) respectively; and is the motion of the projection signal; k λ =-λ>0 is the control gain; Is a constant parameter.
4. The quadrotor hoisting control method based on energy and beneficial state coupling as claimed in claim 3, characterized in that: Defining Load Positioning Error for: y=x p -x d =e ξ +h; Among them, ξ d is the desired position; The total energy storage function E t for: Among them, E t It is positive. represents a diagonal positive definite gain matrix.
5. The quadrotor hoisting control method based on energy and beneficial state coupling according to claim 1, characterized in that: The coupling term discriminant function Q is: Where Δ represents the coupling term; represents the derivative of the load positioning error; The criteria for determining whether a coupling term is harmful or beneficial are:
6. The quadrotor hoisting control method based on energy and beneficial state coupling according to claim 1, characterized in that: Solve the derivative of the total energy storage function to be less than or equal to 0, and obtain the virtual control input f of the outer loop d for: in, represents a positive definite diagonal matrix; The virtual control input f of the outer loop is determined by the discrimination result of the coupling term discrimination function. d The value of P in is defined as follows:
7. The quadrotor hoisting control method based on energy and beneficial state coupling as claimed in claim 2, characterized in that: The inner loop's attitude tracking controller is set up as follows: in, is a matrix containing positive constants; Represents the moment of inertia of the quadrotor in the body coordinate system; represents the angular velocity of the quadrotor when its attitude changes in the body coordinate system; R(t)∈SO(3) is the rotation matrix of the quadrotor from the body coordinate system to the inertial coordinate system; It is a posture of expectation. is the angular velocity of the quadrotor in the object coordinate system; sk(ω) represents the conversion of vector ω into an antisymmetric matrix.
8. A quadrotor hoisting control system based on energy and beneficial state coupling, characterized in that: include: The inner and outer loop division module is configured to: establish an outer loop dynamics model and an inner loop dynamics model of the quadrotor UAV transportation system, define an outer loop tracking error and an inner loop tracking error, and define a coupling term between the inner loop and the outer loop; The energy storage function definition module is configured to: define the mechanical energy of the entire system as a first energy storage function; associate the body position with the load swing angle, introduce a generalized displacement signal, and use the generalized displacement signal to define a second new energy storage function; sum the first energy storage function and the second new energy storage function to obtain a total energy storage function; The coupling item judgment module is configured to: define a coupling item discrimination function, and use the coupling item discrimination function to judge whether the coupling item between the inner loop and the outer loop is harmful or beneficial; The outer loop controller design module is configured to: obtain the virtual control input of the outer loop based on the discrimination results of the total energy storage function and the coupling term discrimination function, and obtain the body displacement and load swing angle through the outer loop dynamics model based on the virtual control input of the outer loop; The inner loop controller design module is configured to obtain the control torque of the inner loop based on the attitude tracking controller, and obtain the attitude angle through the inner loop dynamics model based on the control torque input of the inner loop.
9. A computer-readable storage medium having a program stored thereon, characterized in that: When the program is executed by a processor, the steps of the quad-rotor hoisting control method based on energy and beneficial state coupling as described in any one of claims 1 to 7 are implemented.
10. An electronic device comprising a memory, a processor, and a program stored in the memory and executable on the processor, characterized in that: When the processor executes the program, the steps in the quad-rotor hoisting control method based on energy and beneficial state coupling as described in any one of claims 1-7 are implemented.
