Motion control simulation method for flexible unfolding mechanism
Through absolute node coordinate method and dual-loop motion control strategy, the dynamic modeling and motion simulation control problems of large-scale motion and large-flexible components are solved, and high-precision motion simulation calculation is realized, suitable for high-speed and nonlinear situations. Flexible expansion mechanism.
Patent Information
- Application Number
- CN202411125467.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-16
- Publication Date
- 2024-11-12
AI Technical Summary
The prior art is difficult to effectively carry out dynamic modeling and motion simulation control of large-scale motion and large-flexible components, especially in high-speed and nonlinear conditions, and it is impossible to accurately describe the dynamic characteristics of large-scale motion in space.
The dynamic model of the flexible expansion mechanism is constructed by the absolute node coordinate method, the mechanism is divided into finite units, the motion coupling relationship and dynamic equation matrix are established, and the motion simulation calculation is realized through the dual-loop motion control strategy and control module, and the Lagrangian is removed. Multiplier constraint term, reducing the degree of freedom of solution.
It improves the accuracy and efficiency of motion simulation calculation, is suitable for strong nonlinear problems of large-scale motion and large flexible deformation, and enhances the solatability and accuracy of the calculation.
Smart Images

Figure CN118938708A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of motion simulation, and in particular to a motion control simulation method for a flexible unfolding mechanism. Background Art
[0002] The motion control of a motion mechanism usually requires the determination of the relevant parameters of the motion control system through motion control simulation. Small motion mechanisms can obtain relevant parameter data based on experimental measurements of physical motion, while large mechanisms are difficult to conduct physical tests. Space deployment mechanisms have the characteristics of high flexibility and large structural scale, making it difficult to determine parameters through experiments.
[0003] In order to improve the motion accuracy of space flexible motion mechanisms, the existing technology has proposed a number of flexible modeling methods, such as kinematic-elastic dynamics method, floating coordinate method, modal superposition method, etc. Among them, the kinematic-elastic dynamics method is only suitable for low-speed and low-flexibility motion; the floating coordinate method has problems such as Coriolis force and dynamic stiffening caused by rotation, and is not suitable for high-speed and large flexible components; the modal superposition method is a linear superposition of modal configurations and is not suitable for nonlinear problems.
[0004] The above methods are not suitable for dynamic modeling and motion simulation control of large-scale spatial motion and large flexible parts. Therefore, it is necessary to establish a motion control simulation method that is suitable for large-scale spatial motion and large flexible parts and can solve strong nonlinear calculations. Summary of the invention
[0005] In order to solve the above problems, the present invention provides a flexible deployment mechanism motion control simulation method.
[0006] The present invention aims to provide a flexible deployment mechanism motion control simulation method, which specifically comprises the following steps:
[0007] S1. Construct a basic model of the flexible deployment mechanism, divide the controlled rods of the flexible deployment mechanism into finite elements, and determine the nodes and degrees of freedom of each finite element;
[0008] S2. Determine the kinematic coupling relationship between the rods and establish the node degree of freedom mapping matrix;
[0009] S3. Establishing a kinetic equation matrix of a single unit, and establishing a kinetic equation of a single unit according to the kinetic equation matrix;
[0010] S4. According to the dynamic equation of a single unit, a dynamic equation of the flexible deployment mechanism is established;
[0011] S5. Establish motion control strategy according to dynamic equations and construct motion control module;
[0012] S6. Construct a simulation calculation program based on the motion control strategy, encode the calculation formula and process, adjust and optimize the relevant control parameters, and use a computer to implement the corresponding motion simulation calculation.
[0013] Preferably, step S3 uses the absolute node coordinate method to establish the dynamic equation matrix of a single unit.
[0014] Preferably, the dynamic equation matrix includes a unit mass matrix, a unit axial stiffness matrix, a unit bending stiffness matrix, a unit equivalent moment matrix, and a unit equivalent gravity matrix.
[0015] Preferably, the unit mass matrix M e It is expressed as:
[0016]
[0017] The unit axial stiffness matrix K el It can be expressed as:
[0018]
[0019] The element bending stiffness matrix K et It is expressed as:
[0020]
[0021] The unit equivalent moment matrix is expressed as:
[0022]
[0023] Among them, f i is the sum of squares of the generalized coordinate variables, expressed as:
[0024]
[0025] q 3 ,q 4 represent the third and fourth generalized degrees of freedom of a single element, respectively;
[0026] The unit equivalent gravity matrix is expressed as:
[0027]
[0028] In the above formula, the subscript e indicates a unit matrix; ρ e is the unit material density; A e is the cross-sectional area of the rod; E e is the elastic modulus of the unit material; q e is the unit node coordinate, and its subscript number represents the node degree of freedom; I eis the bending inertia moment; τ is the node moment; g is the gravity vector moment; S is the unit shape function matrix; S is expressed as:
[0029]
[0030] in:
[0031]
[0032] Where x is the axial local coordinate of the unit when it is not deformed, and l is the initial length of the unit;
[0033] The kinetic equation of the single unit is expressed as:
[0034]
[0035] Where M e is the unit mass matrix, q e is the unit node coordinate, K e is the unit stiffness matrix, denoted by K et and K el the sum of is the nodal external force received by the unit, is the unit equivalent moment matrix, is the unit equivalent gravity matrix.
[0036] Preferably, the dynamic equation of the flexible deployment mechanism is expressed as:
[0037]
[0038] Where M is the mass matrix of the overall structure, q is the degree of freedom matrix of the overall structure, K is the stiffness matrix of the overall structure, and Q is the external force matrix of the overall structure.
[0039] Preferably, the motion coupling relationship includes a rod unit continuous constraint relationship and a hinge constraint relationship; the rod unit continuous constraint relationship includes a displacement constraint and an angle constraint, and the hinge constraint relationship is a displacement constraint.
[0040] Preferably, the motion control strategy is a dual-loop motion control strategy of a position loop and a speed loop.
[0041] Preferably, step S5 specifically includes: establishing a dual-loop motion control strategy of a position loop and a speed loop according to a dynamic equation, establishing a corresponding controller, and constructing a motion control module.
[0042] Compared with the prior art, the present invention can achieve the following beneficial effects:
[0043] The present invention is based on the absolute node coordinate method, and by establishing a coupling constraint equation relationship, removes the Lagrange multiplier constraint term in the dynamic equation, reduces the degree of freedom of solving the dynamic differential equation group, and improves the calculation efficiency; it is suitable for problems such as large-scale motion and large flexible deformation, and makes the simulation calculation more accurate. BRIEF DESCRIPTION OF THE DRAWINGS
[0044] Figure 1 It is a flow chart of a flexible deployment mechanism motion control simulation method provided according to an embodiment of the present invention.
[0045] Figure 2 It is a control flow diagram of a motion control module provided according to an embodiment of the present invention. DETAILED DESCRIPTION
[0046] Hereinafter, embodiments of the present invention will be described with reference to the accompanying drawings. In the following description, the same modules are represented by the same reference numerals. In the case of the same reference numerals, their names and functions are also the same. Therefore, the detailed description thereof will not be repeated.
[0047] In order to make the purpose, technical solution and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments. It should be understood that the specific embodiments described herein are only used to explain the present invention and do not constitute a limitation of the present invention.
[0048] like Figure 1 As shown, the present invention provides a flexible deployment mechanism motion control simulation method, which specifically includes the following steps:
[0049] S1. Construct a basic model of the flexible deployment mechanism, divide the controlled rods of the flexible deployment mechanism into finite elements, and determine the nodes and degree of freedom numbers of each finite element.
[0050] S2. Determine the kinematic coupling relationship between the rods and establish the node degree of freedom mapping matrix;
[0051] The motion coupling relationship includes the continuous constraint relationship of the bar element and the hinge constraint relationship; the continuous constraint relationship of the bar element includes displacement constraint and rotation constraint, and the hinge constraint relationship is only a displacement constraint, but not a rotation constraint.
[0052] S3. Establishing a kinetic equation matrix of a single unit, and establishing a kinetic equation of a single unit according to the kinetic equation matrix;
[0053] Specifically, the absolute node coordinate method is used to establish;
[0054] The dynamic equation matrix includes various matrices such as unit mass matrix, unit axial stiffness matrix, unit bending stiffness matrix, unit equivalent moment matrix, unit equivalent gravity matrix, etc.
[0055] Element mass matrix M e It can be expressed as:
[0056]
[0057] Unit axial stiffness matrix K el It can be expressed as:
[0058]
[0059] Element bending stiffness matrix K et It can be expressed as:
[0060]
[0061] The unit equivalent moment matrix can be expressed as:
[0062]
[0063] Among them, f i is the sum of squares of the generalized coordinate variables, expressed as:
[0064]
[0065] q 3 ,q 4 represent the third and fourth generalized degrees of freedom of a single element, respectively;
[0066] The unit equivalent gravity matrix can be expressed as:
[0067]
[0068] In the above formula, the subscript e indicates a unit matrix; ρ e is the unit material density; A e is the cross-sectional area of the rod; E e is the elastic modulus of the unit material; q e is the unit node coordinate, and its subscript number e represents the node degree of freedom; I e is the bending inertia moment; τ is the node moment; g is the gravity vector moment; S is the unit shape function matrix; S is expressed as:
[0069]
[0070] in:
[0071]
[0072] Where x is the axial local coordinate of the unit when it is not deformed, and l is the initial length of the unit;
[0073] In summary, the dynamic equation of a single unit can be established:
[0074]
[0075] Where M e is the unit mass matrix, q e is the unit node coordinate, K e is the unit stiffness matrix (denoted as K et and K el sum), is the nodal external force received by the unit, is the unit equivalent moment matrix, is the unit equivalent gravity matrix.
[0076] The node degree of freedom mapping matrix of step S2 is the mapping matrix of the entire node. Step S3 is to establish the dynamic equation matrix of a single unit. In step S3, only the nodes involved in the single unit are used (not all nodes are used). The mapping matrix relationship is used to map the matrix information of a single unit to the overall matrix.
[0077] S4. According to the dynamic equation of a single unit, a dynamic equation of the flexible deployment mechanism is established;
[0078] The constraint equations including Lagrange multiplier terms are established based on the constraint equations:
[0079]
[0080] Where M is the mass matrix of the overall structure, q is the degree of freedom matrix of the overall structure, K is the stiffness matrix of the overall structure, Q is the external force matrix of the overall structure, Φ is the node constraint equation, and λ is the Lagrange multiplier coefficient;
[0081] The above equation cannot be transformed into the state space form expected by motion control. By using degree of freedom mapping and artificially constraining the degree of freedom form of the equation, the complexity of the equation is manually reduced, so that the general form of the dynamic equation can be expressed as:
[0082]
[0083] Where M is the mass matrix of the overall structure, q is the degree of freedom matrix of the overall structure, K is the stiffness matrix of the overall structure, and Q is the external force matrix of the overall structure.
[0084] S5. Establish motion control strategy according to dynamic equations and construct motion control module;
[0085] The motion control strategy is a dual-loop motion control strategy of a position loop and a speed loop; Step S5 specifically includes: establishing a dual-loop motion control strategy of a position loop and a speed loop according to the dynamic equation, establishing a corresponding controller, and constructing Figure 2The motion control module shown.
[0086] S6. Construct a simulation calculation program based on the motion control strategy, encode the calculation formula and process, adjust and optimize the relevant control parameters, and use a computer to implement the corresponding motion simulation calculation.
[0087] Since the deployment process of the space deployment mechanism involves large-scale movement, large flexible deformation and other problems, it is a strong nonlinear problem. For this type of problem, the present invention adopts the absolute node coordinate method suitable for strong nonlinear problems as the basic method of the dynamic model, constructs model design, finite element modeling, model processing, simulation process building and other steps, which is suitable for large-scale movement, large flexible deformation and other problems, so that the simulation calculation accuracy is higher.
[0088] It should be understood that the various forms of processes shown above can be used to reorder, add or delete steps. For example, the steps described in the disclosure of the present invention can be performed in parallel, sequentially or in different orders, as long as the desired results of the technical solution disclosed in the present invention can be achieved, and this document does not limit this.
[0089] The above specific implementations do not constitute a limitation on the protection scope of the present invention. It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and substitutions can be made according to design requirements and other factors. Any modification, equivalent substitution and improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims
1. A flexible deployment mechanism motion control simulation method, characterized in that: The specific steps include: S1. Construct a basic model of the flexible deployment mechanism, divide the controlled rods of the flexible deployment mechanism into finite elements, and determine the nodes and degrees of freedom of each finite element; S2. Determine the kinematic coupling relationship between the rods and establish the node degree of freedom mapping matrix; S3. Establishing a kinetic equation matrix of a single unit, and establishing a kinetic equation of a single unit according to the kinetic equation matrix; S4. According to the dynamic equation of a single unit, a dynamic equation of the flexible deployment mechanism is established; S5. Establish motion control strategy according to dynamic equations and construct motion control module; S6. Construct a simulation calculation program based on the motion control strategy, encode the calculation formula and process, adjust and optimize the relevant control parameters, and use a computer to implement the corresponding motion simulation calculation.
2. A flexible deployment mechanism motion control simulation method according to claim 1, characterized in that: The step S3 uses the absolute node coordinate method to establish the dynamic equation matrix of a single unit.
3. A flexible deployment mechanism motion control simulation method according to claim 2, characterized in that: The dynamic equation matrix includes a unit mass matrix, a unit axial stiffness matrix, a unit bending stiffness matrix, a unit equivalent moment matrix, and a unit equivalent gravity matrix.
4. The method for simulating motion control of a flexible deployment mechanism according to claim 3, characterized in that: The unit mass matrix M e It is expressed as: The unit axial stiffness matrix K el It can be expressed as: The element bending stiffness matrix K et It is expressed as: The unit equivalent moment matrix is expressed as: Among them, f i is the sum of squares of the generalized coordinate variables, expressed as: q3 and q4 represent the third and fourth generalized degrees of freedom of a single unit, respectively; The unit equivalent gravity matrix is expressed as: In the above formula, the subscript e indicates a unit matrix; ρ e is the unit material density; A e is the cross-sectional area of the rod; E e is the elastic modulus of the unit material; q e is the unit node coordinate, and its subscript number represents the node degree of freedom; I e is the bending inertia moment; τ is the node moment; g is the gravity vector moment; S is the unit shape function matrix; S is expressed as: in: Where x is the axial local coordinate of the unit when it is not deformed, and l is the initial length of the unit; The kinetic equation of the single unit is expressed as: Where M e is the unit mass matrix, q e is the unit node coordinate, K e is the unit stiffness matrix, denoted by K et and K el The sum of is the nodal external force received by the unit, is the unit equivalent moment matrix, is the unit equivalent gravity matrix.
5. A flexible deployment mechanism motion control simulation method according to claim 4, characterized in that: The dynamic equation of the flexible deployment mechanism is expressed as: Where M is the mass matrix of the overall structure, q is the degree of freedom matrix of the overall structure, K is the stiffness matrix of the overall structure, and Q is the external force matrix of the overall structure.
6. A flexible deployment mechanism motion control simulation method according to claim 5, characterized in that: The motion coupling relationship includes a rod unit continuous constraint relationship and a hinge constraint relationship; the rod unit continuous constraint relationship includes a displacement constraint and an angle constraint, and the hinge constraint relationship is a displacement constraint.
7. The method for simulating motion control of a flexible deployment mechanism according to claim 6, characterized in that: The motion control strategy is a dual-loop motion control strategy of a position loop and a speed loop.
8. The flexible deployment mechanism motion control simulation method according to claim 7, characterized in that: The step S5 specifically includes: establishing a dual-loop motion control strategy of a position loop and a speed loop according to a dynamic equation, establishing a corresponding controller, and constructing a motion control module.
