Umbrella ladder type land-based AWEs moving trajectory tracking control method

By establishing the dynamic model of the umbrella ladder system and designing the augmented PD control law, the problem of uncontrollable trajectory of multiple units in umbrella ladder land-based AWEs is solved, and the stable trajectory tracking control of umbrella ladder land-based AWEs is realized, which improves the Automation and coordination of the system.

CN118934442APending Publication Date: 2024-11-12ANHUI ELECTRIC POWER DESIGN INST CEEC +1
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202411087836.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-09
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

In the existing umbrella ladder-type land-based AWEs technology, it is difficult for many units to achieve air motion trajectory constraint control, resulting in operation relying on manual manual operation and uncontrollable trajectory, and there is a cable winding problem.

Method used

The dynamic model of the umbrella ladder system is established based on the Kane method, and the PD control law is designed and expanded through the decoupling relationship of the control quantity, and the position and angle of attack of the umbrella ladder are adjusted to realize the trajectory tracking control of the multi-rigid body system of the umbrella ladder.

Benefits of technology

The stable tracking control of the operating trajectory of umbrella ladder-based AWEs is realized, which avoids winding problems between unit operations and improves the automation and coordination of the system.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118934442A_ABST
    Figure CN118934442A_ABST
Patent Text Reader

Abstract

The invention relates to an umbrella ladder type land-based AWEs moving trajectory tracking control method. Compared with the prior art, the defect that it is difficult for multiple AWEs units to achieve air moving trajectory constraint control is overcome. The method comprises the following steps: establishing an umbrella ladder system dynamic model; establishing a control quantity decoupling relation; and controlling the umbrella ladder type land-based AWEs. According to the invention, a trajectory tracking control strategy based on a chain type multi-rigid body system is designed for the requirement of umbrella ladder type land-based AWEs moving trajectory control, stable tracking control of the moving trajectory of the AWEs can be realized, and the problem of intertwining of unit operation in a large-scale AWEs site is effectively avoided.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of parachute-ladder land-based AWEs, and in particular to an operating trajectory tracking and control method of parachute-ladder land-based AWEs. Background Art

[0002] In recent years, high-altitude wind power generation technology has become a hot topic in engineering practice and scientific research at home and abroad. In 2023, the national key R&D project "Key technologies and equipment for large-scale parachute ladder land-based high-altitude wind power generation" was approved, which will promote the construction of a kilometer-level high-altitude wind power generation original technology source and industrial development in my country.

[0003] like Figure 1 As shown in the figure, parachute-ladder land-based AWEs are China's new exploration of the development of AWE technology. It is a cutting-edge and disruptive new wind power generation technology with obvious advantages in large-scale, lightweight, and safety. Parachute-ladder land-based AWEs are composed of basic components such as helium balloons, balance parachutes, working parachutes, and ground winches-generator sets. It uses specially designed working parachutes to capture wind energy in high-altitude areas, and transmits wind power to ground winches-generator sets through traction cables to achieve the capture, conversion, and utilization of high-altitude wind energy. Limited by technology and engineering economy, its structural size will inevitably change with the power level. In view of the high degree of autonomy and innovation of this technology, it is necessary to further study how to improve the stability of the final production system so that parachute-ladder land-based AWEs can be more competitive than other energy sources.

[0004] At present, my country's parachute-ladder land-based AWEs are gradually moving towards large-scale, intelligent and commercialization. At the AWEs site, multiple AWEs units will be operated simultaneously to achieve efficient production capacity and continuous power generation. There is still a lack of research results on the operation control of parachute-ladder land-based AWEs technology in China. This technology still has technical problems such as operation relying on manual operation and uncontrollable operation trajectory. Due to the natural characteristics of the system's flexible connection, how to achieve the constraint control of the system's aerial motion trajectory to ensure the coordinated operation between the parachute-ladder groups and prevent the entanglement of the cables of multiple units has become a problem that needs to be solved urgently. Summary of the invention

[0005] The purpose of the present invention is to solve the defect in the prior art that multiple AWEs units are difficult to realize air motion trajectory constraint control, and to provide a parachute-ladder land-based AWEs operation trajectory tracking control method to solve the above problem.

[0006] In order to achieve the above object, the technical solution of the present invention is as follows:

[0007] A parachute-ladder type land-based AWEs operation trajectory tracking control method comprises the following steps:

[0008] Establishment of parachute-ladder system dynamics model: According to the operation characteristics of parachute-ladder land-based AWEs, the parachute-ladder system dynamics model based on multi-rigid body ropes is established based on Kane method;

[0009] Establishment of control quantity decoupling relationship: According to the structural relationship of system components, the attached mass points of the chain multi-rigid body system are divided into three categories to achieve control quantity decoupling;

[0010] Control of parachute-ladder land-based AWEs: Obtain the structural parameters and operating parameters of the parachute-ladder land-based AWEs components, design the augmented PD control law, adjust the position of each parachute particle, change the attack angle α of each parachute based on attitude adjustment, and send control instructions to the parachute-ladder land-based AWEs.

[0011] The establishment of the parachute ladder system dynamics model comprises the following steps:

[0012] The flexible, uniform-density parachute ladder system cable is discretized into n segments, each segment is assumed to be a slender rigid rod, called a multi-rigid body system, the near-ground end of the parachute ladder system is regarded as the end, and its mass is distributed at the end of the segment and regarded as a mass point. Based on this assumption, the cable is regarded as an open-chain multi-rigid body system.

[0013] Assuming that each node of the cable is only affected by gravity and the internal constraints of the system, the ground coordinate system of the position, velocity and acceleration between the nodes of the cable is expressed as follows:

[0014]

[0015] in,

[0016]

[0017] In the formula, (x i ,y i ,z i ) is the position coordinate of the particle point of the i-th cable in the ground coordinate system, is the position coordinate representation of the velocity of the particle point of the i-th cable in the ground coordinate system, is the position coordinate of the acceleration of the particle of the i-th cable in the ground coordinate system, (x i+1 ,y i+1 ,z i+1 ) is the position coordinate of the particle of the i+1th cable segment in the ground coordinate system, is the position coordinate of the particle of the i+1th cable segment in the ground coordinate system, is the position coordinate of the i+1th cable particle in the ground coordinate system, E is the rotation matrix, E(θ i+1 ,φ i+1 ) is in (θ i+1 ,φ i+1 ), For (θ i+1 ,φ i+1 ) is the first-order derivative of the rotation matrix, l i+1 is the length of the i+1th cable section, θ is the angle between the cable and the vertical direction, θ i+1 is the angle between the i+1th cable and the vertical direction, is the first-order derivative of the angle between the i+1th cable and the vertical direction, is the second-order derivative of the angle between the i+1th cable and the vertical direction, φ is the angle between the cable projection and the horizontal axis, φ i+1 is the angle between the projection of the i+1th cable section and the horizontal axis, is the first-order derivative of the angle between the projection of the i+1th cable segment and the horizontal axis, is the second-order derivative of the angle between the projection of the i+1th cable section and the horizontal axis;

[0018] Based on the Kane method, the above multi-rigid body system is modeled, and the discrete n-node Kane dynamic equation is as follows:

[0019]

[0020]

[0021] In the formula, F θj , F φj and are the generalized active force and generalized inertial force in the directions of θ and φ, respectively, m i is the mass of the i-th cable particle, a i represents the acceleration of the particle in the i-th cable segment, F ext,i represents the external force on the particle of the i-th cable segment, v i represents the speed of the i-th cable segment, v j represents the speed of the jth cable segment, θ j represents the angle between the jth cable section and the vertical direction, represents the first derivative of the angle between the jth cable segment and the vertical direction, φ j represents the angle between the projection of the j-th cable segment and the horizontal axis, represents the first derivative of the angle between the projection of the j-th cable segment and the horizontal axis, represents the length of the i-th cable in the vertical direction, represents the length of the projection of the i-th cable in the horizontal axis direction, represents the length of the jth cable in the vertical direction, represents the length of the j-th cable projection in the horizontal axis direction, l j represents the length of the jth cable segment, E(θ j ,φ j) means in (θ j ,φ j ) at the rotation matrix;

[0022] Any generalized coordinate θ acting on the multi-body system j and φ j The sum of the generalized external force and the generalized inertia force on is 0;

[0023] Simplifying the Kane dynamic equation, the closed form of the parachute ladder system dynamic model is as follows:

[0024]

[0025] in,

[0026]

[0027] in,

[0028]

[0029] In the formula, is the angular acceleration of the nth cable segment with the vertical direction, is the angle between the projection of the nth cable segment and the horizontal axis, M and B are the parameter matrices of mass and force respectively, M 2j-1,2k-1 、M 2j-1,2k 、M 2j,2k-1 and M 2j,2k are the elements in different rows and columns of the M matrix, B 2j-1 and B 2j are the elements of different columns in the B matrix, l k represents the length of the kth cable segment, f is the weight coefficient piecewise function composed of the rotation matrix, R(j,k) and R * (j, k) are different operators composed of rotation matrices, E(θ j ,φ j ) T Indicated in (θ j ,φ j ) is the transpose of the rotation matrix at , T represents the transpose, E(θ k ,φ k ) means in (θ k ,φ k ), Indicates (θ k ,φ k ) is the first-order derivative of the rotation matrix, F ext,i,x 、F ext,i,y and F ext,i,z represents the external force F on the i-th cable segment ext,i Components in the x, y, and z directions, R(j,k) 1,1、R(j,k) 1,2 、R(j,k) 2,1 and R(j,k) 2,2 are different elements in the R(j,k) operator matrix, R * (j,k) 1,1 , R * (j,k) 1,2 , R * (j,k) 2,1 and R * (j,k) 2,2 R * Different elements in (j,k), θ k represents the angle between the kth cable section and the vertical direction, represents the first derivative of the angle between the kth cable section and the vertical direction, φ k represents the angle between the projection of the kth cable segment and the horizontal axis, Represents the first derivative of the angle between the projection of the kth cable section and the horizontal axis.

[0030] The establishment of the control quantity decoupling relationship comprises the following steps:

[0031] Call the pre-built parachute ladder system dynamics model and extract the inertia term M(s) from it, and divide the force parameter matrix B into the Coriolis terms and external force term F, introduce gravity term G(s), and rewrite it into the following form:

[0032]

[0033] The chained multi-rigid body attachment points i=1...n are divided into the following three categories:

[0034] When i=n, ​​that is, the particle is a particle of a helium balloon, the particle is subject to both buoyancy and aerodynamic force;

[0035] When i∈S P , that is, the particle is the particle where the parachute is in equilibrium or doing work, and the set S P The particles in the fluid are acted upon by aerodynamic forces but not by buoyancy;

[0036] when That is, the particle is a cable particle, and such particles are not affected by buoyancy and aerodynamic forces;

[0037] Then each parachute mass point m i ,i∈S P The aerodynamic force is expressed as its effective frontal area A i With a force basis vector F basis,i The linear product of the external force term F is converted to:

[0038]

[0039] In the formula, S Q represents the set of particles where the freely openable and closable equilibrium / work-doing parachute is located. Indicates S Q The control vector composed of the effective windward area of ​​the parachute at the midpoint, F α express The matrix corresponding to the external force components, F β Indicates except The matrix composed of external force components other than ;

[0040] To change the control quantity A in F i ,i∈S Q Extract it and write F as follows:

[0041] F=[F1 F2 ... F n ] 3×n N(j),

[0042] Among them, F n represents the column vector that divides F into columns, and N(j) represents a vector whose first j-1 elements are 0 and the rest are 1:

[0043] N(j)=[0 KN j-1 =0 N j =1 K 1] T ;

[0044] Construct U1 to represent the i-th, i∈S Q The diagonal matrix is ​​a matrix with the first diagonal element being 1 and the other elements being 0. U2 represents a column vector with the i-th row element being 1 and the other elements being 0. And i∈S P or i=n

[0045] Therefore, the external force term F is written as:

[0046] F=E(θ j ,φ j ) T ·l j ·F b I(j) (U1u+U2),

[0047] Where I(j) is a diagonal matrix constructed with the elements of N(j) as diagonal elements, that is, I(j) = diag(N(j)), F b Indicates that its elements are calculated as F α The corresponding elements in , then the construction of each row element of the external force term F is realized, and the decoupling relationship between the external force term F and the control quantity u is extracted from the dynamic model.

[0048] The control of the parachute ladder land-based AWEs includes the following steps:

[0049] By adjusting the position of the segmented cable mass points of each parachute, and changing the length of the parachute connecting cable to change the effective windward area of ​​the parachute, the trajectory tracking control of each node of the parachute ladder multi-rigid body system is realized by the attitude control method to overcome the influence of wind speed disturbance on the operation of the parachute ladder system;

[0050] Based on the parachute-ladder system dynamics model, the expected trajectory s is designed using generalized coordinates. d , the expected trajectory s d It represents the process of the parachute ladder moving from the initial state to the desired equilibrium state.

[0051] At this time, the state error of the parachute ladder is defined as follows:

[0052] e=s d -s,

[0053] s=[θ1φ1Kθ n φ n ] T ,

[0054] Where, e is the parachute ladder trajectory state error, s is the parachute ladder motion trajectory in the generalized coordinate system;

[0055] The parachute ladder trajectory tracking augmented PD control law is designed as follows:

[0056]

[0057] Where M(s) is the inertia term, is the Coriolis term, F α express The matrix corresponding to the external force components, G(s) is the gravity term, K P and K v are proportional gain and differential gain respectively, represents the second-order derivative of the desired trajectory, is the first-order derivative of the parachute ladder trajectory state error, is the second-order derivative of the parachute ladder trajectory state error, F β - Indicates F β The minus inverse of

[0058] The parachute ladder trajectory tracking augmented PD control law is implemented to make the state error of the parachute ladder conform to the relationship shown in the following equation to ensure the asymptotic convergence of the state error.

[0059]

[0060] Obtain the structural parameters and operating parameters of the parachute-ladder land-based AWEs components, realize the trajectory control of the parachute-ladder land-based AWEs through the parachute-ladder trajectory tracking augmented PD control law, and send the control instructions to the corresponding parachute-ladder land-based AWEs equipment;

[0061] Based on the fact that the launch and recovery processes are inverse to each other and the above trajectory control exists during the launch process, the control steps during the launch process are as follows:

[0062] The helium balloon is inflated, the balance parachute and power parachute are mounted, and the winch rotates forward to assist the parachute ladder to ascend;

[0063] According to the power generation demand and the wind conditions of the high-altitude wind field, the target trajectory position of each particle of the parachute ladder multi-rigid body system is set;

[0064] Obtain status information of the parachute ladder system through sensors, including position, speed, and acceleration;

[0065] The auxiliary cable is extended by the balance parachute driver to change the attack angle of each balance parachute and thus change the windward area of ​​the parachute. The controller input of the parachute ladder trajectory tracking augmented PD control law is the position error of each particle in the parachute ladder multi-rigid body system, and the output is the control signal u for adjusting the windward area of ​​the parachute.

[0066] Setting position error:

[0067] e=s d -s,

[0068] Position error change rate:

[0069]

[0070] Control signal u:

[0071]

[0072] Where u is used to adjust the parachute angle of attack α, and there is a corresponding functional relationship between the values ​​of u and α:

[0073] α=h(u);

[0074] The windward area of ​​the parachute is continuously monitored and adjusted, and the feedback control mechanism is used to make adjustments based on the real-time state error to reduce the trajectory deviation. The trajectory tracking control of the parachute-ladder multi-rigid body system is achieved through the controller of the parachute-ladder trajectory tracking augmented PD control law.

[0075] Beneficial Effects

[0076] Compared with the prior art, the method for tracking and controlling the operation trajectory of parachute-ladder land-based AWEs of the present invention is designed to meet the needs of operation trajectory control of parachute-ladder land-based AWEs, and a trajectory tracking control strategy based on a chain multi-rigid body system is designed. The method can realize stable tracking control of the operation trajectory of AWEs and effectively avoid the problem of entanglement between units in large-scale AWEs sites. BRIEF DESCRIPTION OF THE DRAWINGS

[0077] Figure 1 It is a schematic diagram of the structure of the parachute ladder type land-based AWEs;

[0078] Figure 2 is a method sequence diagram of the present invention;

[0079] Figure 3 (a) is a schematic diagram of the positional relationship of adjacent mass points in the multi-rigid body model involved in the present invention;

[0080] Figure 3 (b) is a schematic diagram of a multi-rigid body model of the cable involved in the present invention

[0081] Figure 4 Schematic diagram of the parachute ladder trajectory tracking control strategy design involved in the present invention

[0082] Figure 5 A comparison diagram of the expected trajectories of various particles of the parachute ladder involved in the present invention;

[0083] Figure 6 A comparison diagram of the actual trajectories of various particles of the parachute ladder involved in the present invention;

[0084] Figure 7 It is a schematic diagram of the error between the actual trajectory and the expected trajectory of the parachute ladder involved in the present invention. DETAILED DESCRIPTION

[0085] In order to have a further understanding and recognition of the structural features and the effects achieved by the present invention, a preferred embodiment and accompanying drawings are used for detailed description as follows:

[0086] like Figure 2 As shown, the parachute ladder type land-based AWEs operation trajectory tracking control method described in the present invention includes the following steps:

[0087] The first step is to establish the parachute-ladder system dynamics model: According to the operating characteristics of parachute-ladder land-based AWEs, the dynamics model of the parachute-ladder system based on multi-rigid body ropes is established based on the Kane method.

[0088] This invention takes a certain domestic high altitude wind power generation demonstration project as the research object. Figure 1As shown, the parachute-ladder land-based AWEs are composed of basic components such as a helium balloon, a balance parachute, a power parachute, and a ground winch-generator set. The present invention uses the finite segment method to establish a multi-rigid body rope model of the main cable. By dividing the rope into several rigid body segments for modeling, the deformation and stress distribution of the rope under different working conditions are effectively described, thereby enhancing the accuracy of the model. Due to the multiple nonlinear components contained in the model and their strong coupling relationship and interaction, according to the characteristics of the chain multi-rigid body model, the following trajectory tracking control strategy based on nonlinear control is designed.

[0089] The specific steps are as follows:

[0090] (1) Figure 3 (a) and Figure 3 As shown in (b), the flexible, uniform-density parachute ladder system cable is discretized into n segments, each segment is assumed to be a slender rigid rod, called a multi-rigid body system, and the near-ground end of the parachute ladder system is regarded as the end, and its mass is distributed at the end of the segment and regarded as a point mass. Based on this assumption, the cable is regarded as an open-chain multi-rigid body system.

[0091] (2) Assuming that each node of the cable is only affected by gravity and the internal constraint force of the system, the ground coordinate system of the position, velocity and acceleration between the nodes of the cable is expressed as follows:

[0092]

[0093]

[0094] in,

[0095]

[0096] In the formula, (x i ,y i ,z i ) is the position coordinate of the particle point of the i-th cable in the ground coordinate system, is the position coordinate representation of the velocity of the particle point of the i-th cable in the ground coordinate system, is the position coordinate of the acceleration of the particle of the i-th cable in the ground coordinate system, (x i+1 ,y i+1 ,z i+1 ) is the position coordinate of the particle of the i+1th cable segment in the ground coordinate system, is the position coordinate of the particle of the i+1th cable segment in the ground coordinate system, is the position coordinate of the i+1th cable particle in the ground coordinate system, E is the rotation matrix, E(θ i+1 ,φ i+1 ) is in (θ i+1 ,φ i+1 ), For (θ i+1 ,φ i+1 ) is the first-order derivative of the rotation matrix, l i+1 is the length of the i+1th cable section, θ is the angle between the cable and the vertical direction, θ i+1 is the angle between the i+1th cable and the vertical direction, is the first-order derivative of the angle between the i+1th cable and the vertical direction, is the second-order derivative of the angle between the i+1th cable and the vertical direction, φ is the angle between the cable projection and the horizontal axis, φ i+1 is the angle between the projection of the i+1th cable section and the horizontal axis, is the first-order derivative of the angle between the projection of the i+1th cable segment and the horizontal axis, It is the second-order derivative of the angle between the projection of the i+1th cable section and the horizontal axis.

[0097] (3) Based on the Kane method, the above multi-rigid body system is modeled and the discrete n-node Kane dynamic equation is as follows:

[0098]

[0099] In the formula, F θj , F φj and are the generalized active force and generalized inertial force in the directions of θ and φ, respectively, m i is the mass of the i-th cable particle, a i represents the acceleration of the particle in the i-th cable segment, F ext,i represents the external force on the particle of the i-th cable segment, v i represents the speed of the i-th cable segment, v j represents the speed of the jth cable segment, θ j represents the angle between the jth cable section and the vertical direction, represents the first derivative of the angle between the jth cable segment and the vertical direction, φ j represents the angle between the projection of the j-th cable segment and the horizontal axis, represents the first derivative of the angle between the projection of the j-th cable segment and the horizontal axis, represents the length of the i-th cable in the vertical direction, represents the length of the projection of the i-th cable in the horizontal axis direction, represents the length of the jth cable in the vertical direction, represents the length of the j-th cable projection in the horizontal axis direction, l j represents the length of the jth cable segment, E(θ j ,φ j ) means in (θ j ,φ j) at the rotation matrix;

[0100] Any generalized coordinate θ acting on the multi-body system j and φ j The sum of the generalized external force and the generalized inertia force on is 0.

[0101] (4) Simplifying the Kane dynamic equation, the closed form dynamic model of the parachute ladder system is as follows:

[0102]

[0103] in,

[0104]

[0105] in,

[0106]

[0107] In the formula, is the angular acceleration of the nth cable segment with the vertical direction, is the angle between the projection of the nth cable segment and the horizontal axis, M and B are the parameter matrices of mass and force respectively, M 2j-1,2k-1 、M 2j-1,2k 、M 2j,2k-1 and M 2j,2k are the elements in different rows and columns of the M matrix, B 2j-1 and B 2j are the elements of different columns in the B matrix, l k represents the length of the kth cable segment, f is the weight coefficient piecewise function composed of the rotation matrix, R(j,k) and R * (j, k) are different operators composed of rotation matrices, E(θ j ,φ j ) T Indicated in (θ j ,φ j ) is the transpose of the rotation matrix at , T represents the transpose, E(θ k ,φ k ) means in (θ k ,φ k ), Indicates (θ k ,φ k ) is the first-order derivative of the rotation matrix, F ext,i,x 、F ext,i,y and F ext,i,z represents the external force F on the i-th cable segment ext,i Components in the x, y, and z directions, R(j,k) 1,1 、R(j,k) 1,2 、R(j,k)2,1 and R(j,k) 2,2 are different elements in the R(j,k) operator matrix, R * (j,k) 1,1 , R * (j,k) 1,2 , R * (j,k) 2,1 and R * (j,k) 2,2 R * Different elements in (j,k), θ k represents the angle between the kth cable section and the vertical direction, represents the first derivative of the angle between the kth cable section and the vertical direction, φ k represents the angle between the projection of the kth cable segment and the horizontal axis, Represents the first derivative of the angle between the projection of the kth cable section and the horizontal axis.

[0108] The second step is to establish the decoupling relationship of the control quantity: the chain multi-rigid body system has a complex structure and the interactions between the particles are diverse. How to accurately classify the particles and ensure that the classified particles can reflect their respective characteristics in the dynamics and control process is a key technical issue. According to the structural relationship of the system components, the present invention divides the attached particles of the chain multi-rigid body system into three categories to achieve the decoupling of the control quantity.

[0109] The specific steps are as follows:

[0110] (1) Call the pre-built parachute ladder system dynamics model and extract the inertia term M(s) from it, and divide the force parameter matrix B into the Coriolis term and external force term F, introduce gravity term G(s), and rewrite it into the following form:

[0111]

[0112] (2) The chained multi-rigid body attachment points i=1...n are divided into the following three categories:

[0113] When i=n, ​​that is, the particle is a particle of a helium balloon, the particle is subject to both buoyancy and aerodynamic force;

[0114] When i∈S P , that is, the particle is the particle where the parachute is in equilibrium or doing work, and the set S P The particles in the fluid are acted upon by aerodynamic forces but not by buoyancy;

[0115] when That is, the particle is a cable particle, that is, the particle is not attached to equilibrium or the particle of a work-doing parachute or helium balloon, and such particles are not subject to buoyancy and aerodynamic forces;

[0116] Then each parachute mass point m i ,i∈S P The aerodynamic force is expressed as its effective frontal area A i With a force basis vector F basis,i The linear product of the external force term F is converted to:

[0117]

[0118] In the formula, S Q represents the set of particles where the freely openable and closable equilibrium / work-doing parachute is located. Indicates S Q The control vector composed of the effective windward area of ​​the parachute at the midpoint, F α express The matrix corresponding to the external force components, F β Indicates except The matrix composed of external force components other than ;

[0119] To change the control quantity A in F i ,i∈S Q Extract it and write F as follows:

[0120] F=[F1F2...F n ] 3×n N(j),

[0121] Among them, F n represents the column vector that divides F into columns, and N(j) represents a vector whose first j-1 elements are 0 and the rest are 1:

[0122] N(j)=[0 KN j-1 =0 N j =1 K 1] T ;

[0123] Construct U1 to represent the i-th, i∈S Q The diagonal matrix with the first diagonal element being 1 and the other elements being 0, U2 represents the first ( And i∈S P or i=n) a column vector with row elements of 1 and other elements of 0,

[0124] Therefore, the external force term F is written as:

[0125] F=E(θ j ,φ j ) T ·l j ·F b I(j) (U1u+U2),

[0126] Where I(j) is a diagonal matrix constructed with the elements of N(j) as diagonal elements, that is, I(j) = diag(N(j)), F b Indicates that its elements are calculated as F α The corresponding elements in , then the construction of each row element of the external force term F is realized, and the decoupling relationship between the external force term F and the control quantity u is extracted from the dynamic model.

[0127] The third step is the control of the parachute-ladder land-based AWEs: obtain the structural parameters and operating parameters of the parachute-ladder land-based AWEs components, design the augmented PD control law, adjust the position of the particle of each parachute, change the attack angle α of each parachute based on attitude adjustment, and send the control instructions to the parachute-ladder land-based AWEs.

[0128] The designed augmented PD control law is adaptive and robust, and can maintain stable control effects in complex environments and different working conditions. Using a real-time control system, the control instructions calculated by the augmented PD control law are sent to each component of the parachute-ladder land-based AWEs to achieve closed-loop control. The control instructions are continuously adjusted through a feedback mechanism to correct deviations in system operation and ensure that the system operates stably according to the predetermined trajectory.

[0129] (1) By adjusting the position of the segmented cable mass points of each parachute and changing the length of the segmented cables connecting the parachute body to change the effective windward area of ​​the parachute body, the trajectory tracking control of each node of the parachute-ladder multi-rigid body system is realized by the attitude control method to overcome the influence of wind speed disturbance on the operation of the parachute-ladder system.

[0130] (2) Figure 4 As shown, based on the parachute-ladder system dynamics model, the expected trajectory s described by generalized coordinates is designed for it d , the expected trajectory s d It represents the process of the parachute ladder moving from the initial state to the desired equilibrium state.

[0131] At this time, the state error of the parachute ladder is defined as follows:

[0132] e=s d -s,

[0133] s=[θ1φ1Kθ n φ n ] T ,

[0134] Where, e is the parachute ladder trajectory state error, s is the parachute ladder motion trajectory in the generalized coordinate system;

[0135] The parachute ladder trajectory tracking augmented PD control law is designed as follows:

[0136]

[0137] Where M(s) is the inertia term, is the Coriolis term, F α express The matrix corresponding to the external force components, G(s) is the gravity term, K P and K v are proportional gain and differential gain respectively, represents the second-order derivative of the desired trajectory, is the first-order derivative of the parachute ladder trajectory state error, is the second-order derivative of the parachute ladder trajectory state error, F β - Indicates F β The minus inverse of .

[0138] (3) Implementing this control strategy, the state error of the parachute ladder conforms to the relationship shown in the following equation to ensure the asymptotic convergence of the state error:

[0139]

[0140] The structural parameters and operating parameters of the parachute-ladder land-based AWEs components are obtained, and the trajectory control of the parachute-ladder land-based AWEs is realized through the parachute-ladder trajectory tracking augmented PD control law, and the control instructions are sent to the corresponding parachute-ladder land-based AWEs equipment.

[0141] (4) Based on the fact that the launch and recovery processes are inverse to each other and the above-mentioned trajectory control exists during the launch process, the control steps during the launch process are as follows:

[0142] A1) Inflate the helium balloon, mount the balance parachute and power parachute, and the winch rotates forward to assist the parachute ladder to ascend;

[0143] A2) Plan the target trajectory position of each particle of the parachute ladder multi-rigid body system according to the power generation demand and the wind conditions of the high-altitude wind field;

[0144] A3) Obtain status information of the parachute ladder system through sensors, including position, speed, and acceleration;

[0145] A4) Extend the auxiliary cable through the balance parachute driver to change the attack angle of each balance parachute and thus change the windward area of ​​the parachute. The controller input of the parachute ladder trajectory tracking augmented PD control law is the position error of each particle in the parachute ladder multi-rigid body system, and the output is the control signal u for adjusting the windward area of ​​the parachute.

[0146] Setting position error:

[0147] e=s d -s,

[0148] Position error change rate:

[0149]

[0150] Control signal u:

[0151]

[0152] Where u is used to adjust the parachute angle of attack α, and there is a corresponding functional relationship between the values ​​of u and α:

[0153] α=h(u);

[0154] A5) Continuously monitor and adjust the windward area of ​​the parachute, use the feedback control mechanism to make adjustments based on the real-time state error to reduce the trajectory deviation, and then realize the trajectory tracking control of the parachute ladder multi-rigid body system through the controller of the parachute ladder trajectory tracking augmented PD control law.

[0155] Aiming at the demand of parachute-ladder land-based AWEs running trajectory control, the present invention designs a trajectory tracking control strategy based on a chain multi-rigid body system, which can realize the stable tracking control of the running trajectory of AWEs. In order to verify the effectiveness of the strategy designed by the present invention, a domestic high-altitude wind energy demonstration project is taken as the research object, and the structural parameters and operating parameters of the parachute-ladder land-based AWEs components are obtained as shown in Tables 1 and 2.

[0156] Table 1 Parachute ladder system parameters

[0157]

[0158]

[0159] Table 2 Tracking control experimental parameters

[0160]

[0161] Through the above parachute ladder trajectory tracking augmented PD control law, a simulation test experiment for the trajectory control of parachute ladder land-based AWEs equipment is designed. Figure 5 The expected trajectory of the parachute ladder in the generalized coordinate system is shown, that is, the trajectory that the parachute ladder system should follow under ideal conditions; Figure 6 The actual generalized coordinates of the parachute ladder system under control in the simulation environment change with time, reflecting the position and attitude changes of the parachute ladder during the movement process; d The error changes with time as Figure 7As shown. The system motion trajectory changes dramatically in the early stage and the error is large. This is due to the dynamic dynamic response of the complex nonlinear system under variable wind field conditions, which causes the motion trajectory to change dramatically in the initial stage. Finally, the trajectory state error of the parachute ladder controlled operation process basically tends to be stable after 50s, and converges approximately to near 0, which proves that the control system can effectively eliminate the trajectory tracking error and achieve stable trajectory tracking control under the control law designed by the present invention. At the same time, the error and convergence demonstrate the effectiveness of the augmented PD control law, proving that its application in the parachute ladder system can achieve precise trajectory control. Stable trajectory tracking control is achieved.

[0162] The above shows and describes the basic principles, main features and advantages of the present invention. Those skilled in the art should understand that the present invention is not limited to the above embodiments. The above embodiments and descriptions only describe the principles of the present invention. The present invention may be subject to various changes and improvements without departing from the spirit and scope of the present invention. These changes and improvements fall within the scope of the present invention. The scope of protection claimed by the present invention is defined by the attached claims and their equivalents.

Claims

1. A parachute-ladder land-based AWEs operation trajectory tracking control method, characterized in that: The following steps are involved: 11) Establishment of parachute-ladder system dynamics model: According to the operation characteristics of parachute-ladder land-based AWEs, the dynamics model of the parachute-ladder system based on multi-rigid body ropes is established based on Kane method; 12) Establishment of control quantity decoupling relationship: According to the structural relationship of system components, the attached mass points of the chain multi-rigid body system are divided into three categories to achieve control quantity decoupling; 13) Control of parachute-ladder land-based AWEs: Obtain the structural parameters and operating parameters of the parachute-ladder land-based AWEs components, design the augmented PD control law, adjust the position of each parachute particle, change the attack angle α of each parachute based on attitude adjustment, and send control commands to the parachute-ladder land-based AWEs.

2. The method for tracking and controlling the trajectory of parachute-ladder land-based AWEs according to claim 1 is characterized in that: The establishment of the parachute ladder system dynamics model comprises the following steps: 21) The flexible, uniform-density parachute ladder system cable is discretized into n segments, each segment is assumed to be a slender rigid rod, called a multi-rigid body system, the near-ground end of the parachute ladder system is regarded as the end, and its mass is distributed at the end of the segment and regarded as a mass point. Based on this assumption, the cable is regarded as an open-chain multi-rigid body system; 22) Assuming that each node of the cable is only affected by gravity and the internal constraint force of the system, the ground coordinate system of the position, velocity and acceleration between the nodes of the cable is expressed as follows: in, In the formula, (x i ,y i ,z i ) is the position coordinate of the particle point of the i-th cable in the ground coordinate system, is the position coordinate representation of the velocity of the particle point of the i-th cable in the ground coordinate system, is the position coordinate of the acceleration of the particle of the i-th cable in the ground coordinate system, (x i+1 ,y i+1 ,z i+1 ) is the position coordinate of the particle of the i+1th cable segment in the ground coordinate system, is the position coordinate of the particle of the i+1th cable segment in the ground coordinate system, is the position coordinate of the i+1th cable particle in the ground coordinate system, E is the rotation matrix, E(θ i+1 ,φ i+1 ) is in (θ i+1 ,φ i+1 ), For (θ i+1 ,φ i+1 ) is the first-order derivative of the rotation matrix, l i+1 is the length of the i+1th cable section, θ is the angle between the cable and the vertical direction, θ i+1 is the angle between the i+1th cable and the vertical direction, is the first-order derivative of the angle between the i+1th cable and the vertical direction, is the second-order derivative of the angle between the i+1th cable and the vertical direction, φ is the angle between the cable projection and the horizontal axis, φ i+1 is the angle between the projection of the i+1th cable section and the horizontal axis, is the first-order derivative of the angle between the projection of the i+1th cable segment and the horizontal axis, is the second-order derivative of the angle between the projection of the i+1th cable section and the horizontal axis; 23) Based on the Kane method, the above multi-rigid body system is modeled, and the discrete n-node Kane dynamic equation is as follows: In the formula, F θj , F φj and are the generalized active force and generalized inertial force in the directions of θ and φ, respectively, m i is the mass of the i-th cable particle, a i represents the acceleration of the particle in the i-th cable segment, F ext,i represents the external force on the particle of the i-th cable segment, v i represents the speed of the i-th cable segment, v j represents the speed of the jth cable segment, θ j represents the angle between the jth cable section and the vertical direction, represents the first derivative of the angle between the jth cable segment and the vertical direction, φ j represents the angle between the projection of the j-th cable segment and the horizontal axis, represents the first derivative of the angle between the projection of the j-th cable segment and the horizontal axis, represents the length of the i-th cable in the vertical direction, represents the length of the projection of the i-th cable in the horizontal axis direction, represents the length of the jth cable in the vertical direction, represents the length of the j-th cable projection in the horizontal axis direction, l j represents the length of the jth cable, E(θ j ,φ j ) means in (θ j ,φ j ) at the rotation matrix; Any generalized coordinate θ acting on the multi-body system j and φ j The sum of the generalized external force and the generalized inertia force on is 0; 24) Simplifying the Kane dynamic equation, the closed form parachute ladder system dynamic model is as follows: in, in, In the formula, is the angular acceleration of the nth cable segment with the vertical direction, is the angle between the projection of the nth cable segment and the horizontal axis, M and B are the parameter matrices of mass and force respectively, M 2j-1,2k-1 、M 2j-1,2k 、M 2j,2k-1 and M 2j,2k are the elements in different rows and columns of the M matrix, B 2j-1 and B 2j are the elements of different columns in the B matrix, l k represents the length of the kth cable segment, f is the weight coefficient piecewise function composed of the rotation matrix, R(j,k) and R * (j, k) are different operators composed of rotation matrices, E(θ j ,φ j ) T Indicated in (θ j ,φ j ) is the transpose of the rotation matrix at , T represents the transpose, E(θ k ,φ k ) means in (θ k ,φ k ), Indicates (θ k ,φ k ) is the first-order derivative of the rotation matrix, F ext,i,x 、F ext,i,y and F ext,i,z represents the external force F on the i-th cable segment ext,i Components in the x, y, and z directions, R(j,k) 1,1 、R(j,k) 1,2 、R(j,k) 2,1 and R(j,k) 2,2 are different elements in the R(j,k) operator matrix, R * (j,k) 1,1 , R * (j,k) 1,2 , R * (j,k) 2,1 and R * (j,k) 2,2 R * Different elements in (j,k), θ k represents the angle between the kth cable section and the vertical direction, represents the first derivative of the angle between the kth cable section and the vertical direction, φ k represents the angle between the projection of the kth cable segment and the horizontal axis, Represents the first derivative of the angle between the projection of the kth cable section and the horizontal axis.

3. The method for tracking and controlling the trajectory of parachute-ladder land-based AWEs according to claim 1 is characterized in that: The establishment of the control quantity decoupling relationship comprises the following steps: 31) Call the pre-built parachute ladder system dynamics model and extract the inertia term M(s) from it, and divide the force parameter matrix B into the Coriolis term and external force term F, introduce gravity term G(s), and rewrite it into the following form: 32) The chained multi-rigid body attachment points i=1...n are divided into the following three categories: When i=n, ​​that is, the particle is a particle of a helium balloon, the particle is subject to both buoyancy and aerodynamic force; When i∈S P , that is, the particle is the particle where the parachute is in equilibrium or doing work, and the set S P The particles in the fluid are acted upon by aerodynamic forces but not by buoyancy; When i≠n, That is, the particle is a cable particle, and such particles are not affected by buoyancy and aerodynamic forces; Then each parachute mass point m i ,i∈S P The aerodynamic force is expressed as its effective frontal area A i With a force basis vector F basis,i The linear product of the external force term F is converted to: In the formula, S Q represents the set of particles where the freely openable and closable equilibrium / work-doing parachute is located. Indicates S Q The control vector composed of the effective windward area of ​​the parachute at the midpoint, F α means i≠n, The matrix corresponding to the external force components, F β Indicates that except i≠n, The matrix composed of external force components other than ; To change the control quantity A in F i ,i∈S Q Extract it and write F as follows: F=[F1F2...F n ] 3×n N(j), Among them, F n represents the column vector that divides F into columns, and N(j) represents a vector whose first j-1 elements are 0 and the rest are 1: N(j)=[0 KN j-1 0 N j [1 K 1] T 4 Construct U1 to represent the i-th, i∈S Q The diagonal matrix is ​​a matrix with the first diagonal element being 1 and the other elements being 0. U2 represents a column vector with the i-th row element being 1 and the other elements being 0. And i∈S P or i = n, Therefore, the external force term F is written as: F=E(θ j ,f j ) T ·l j ·F b ·I(j)·(U1u+U2), Where I(j) is a diagonal matrix constructed with the elements of N(j) as diagonal elements, that is, I(j) = diag(N(j)), F b Indicates that its elements are calculated as F α The corresponding elements in , then the construction of each row element of the external force term F is realized, and the decoupling relationship between the external force term F and the control quantity u is extracted from the dynamic model.

4. The method for tracking and controlling the trajectory of parachute-ladder land-based AWEs according to claim 1 is characterized in that: The control of the parachute ladder land-based AWEs includes the following steps: 41) It is set that by adjusting the position of the segmented cable mass point where each parachute is located, and by changing the length of the parachute connecting cable to change the effective windward area of ​​the parachute, the trajectory tracking control of each node of the parachute ladder multi-rigid body system is realized by the attitude control method, so as to overcome the influence of wind speed disturbance on the operation of the parachute ladder system; 42) Based on the parachute-ladder system dynamics model, the expected trajectory s is designed using generalized coordinates d , the expected trajectory s d It represents the process of the parachute ladder moving from the initial state to the desired equilibrium state. At this time, the state error of the parachute ladder is defined as follows: e=s d -s, s=[θ1φ1Kθ n f n ] T , Where, e is the parachute ladder trajectory state error, s is the parachute ladder motion trajectory in the generalized coordinate system; The parachute ladder trajectory tracking augmented PD control law is designed as follows: Where M(s) is the inertia term, is the Coriolis term, F α means i≠n, The matrix corresponding to the external force components, G(s) is the gravity term, K P and K v are proportional gain and differential gain respectively, represents the second-order derivative of the desired trajectory, is the first-order derivative of the parachute ladder trajectory state error, is the second-order derivative of the parachute ladder trajectory state error, F β - Indicates F β The minus inverse of 43) Implement the parachute ladder trajectory tracking augmented PD control law to make the state error of the parachute ladder conform to the relationship shown in the following equation to ensure the asymptotic convergence of the state error: Obtain the structural parameters and operating parameters of the parachute-ladder land-based AWEs components, realize the trajectory control of the parachute-ladder land-based AWEs through the parachute-ladder trajectory tracking augmented PD control law, and send the control instructions to the corresponding parachute-ladder land-based AWEs equipment; 44) Based on the fact that the launch and recovery processes are inverse to each other and the above trajectory control exists during the launch process, the control steps during the launch process are as follows: 441) The helium balloon is inflated, the balance parachute and the power parachute are mounted, and the winch rotates forward to assist the parachute ladder to ascend; 442) According to the power generation demand and the wind conditions of the high-altitude wind field, the target trajectory position of each particle of the parachute ladder multi-rigid body system is set; 443) Obtain status information of the parachute ladder system through sensors, including position, speed, and acceleration; 444) The auxiliary cable is extended through the balance parachute driver to change the attack angle of each balance parachute and thus change the windward area of ​​the parachute. The controller input of the parachute ladder trajectory tracking augmented PD control law is the position error of each particle point of the parachute ladder multi-rigid body system, and the output is the control signal u for adjusting the windward area of ​​the parachute. Setting position error: e=s d -s, Position error change rate: Control signal u: Where u is used to adjust the parachute angle of attack α, and there is a corresponding functional relationship between the values ​​of u and α: α=h(u); 445) The windward area of ​​the parachute is continuously monitored and adjusted, and the feedback control mechanism is used to make adjustments according to the real-time state error to reduce the trajectory deviation. The trajectory tracking control of the parachute-ladder multi-rigid body system is realized through the controller of the parachute-ladder trajectory tracking augmented PD control law.

Citation Information

Cited By

  • Umbrella ladder type high-altitude wind turbine generator control method and system

    CN119801822A

  • Umbrella ladder type high altitude wind turbine control method and system

    CN119801822B