Closed-loop control method and system for jumping motion of tensegrity robot
By establishing a dynamic model under contact and collision conditions and planning the desired motion trajectory of the center of mass, a closed-loop control law was designed to solve the error and robustness problems in the motion control of the tensioning robot, enabling the robot to jump accurately and land stably in complex environments.
Patent Information
- Application Number
- CN202410999843.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-24
- Publication Date
- 2024-11-15
AI Technical Summary
Existing motion control methods for tensioning robots suffer from large errors and insufficient robustness, making it difficult to achieve precise jump control in complex environments.
A dynamic model considering contact and collision conditions is established, the desired motion trajectory of the center of mass is planned, and a closed-loop control law is designed to achieve stable control of the robot during the take-off and landing phases.
By using a high-precision dynamic model and closed-loop control, control errors are reduced, improving the reliability and stability of the robot in complex environments and ensuring the accuracy of jumping movements and smooth landing.
Smart Images

Figure CN118963116A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robotics, and in particular to a closed-loop control method, system, equipment, medium and program for a tensegrity robot jumping motion. Background Art
[0002] As an innovative work in the field of robotics, the tensegrity robot has a unique rigid-flexible hybrid structure, which is composed of precisely arranged rigid rods and elastic cables, giving this type of robot unprecedented deformation flexibility and environmental adaptability. In exploration missions on the rugged surface of planets or in the complex and changing environment of post-disaster ruins, the tensegrity robot can flexibly adjust its structural form and cross obstacles in an unconventional way, showing an incomparable advantage over traditional wheeled and legged robots. However, it is precisely this complex structural characteristic that has set up many obstacles for the tensegrity robot in achieving precise jumping control.
[0003] At present, the research on the control technology of tensegrity robot jumping motion mainly focuses on two directions: open-loop control method and intelligent learning control method. Although the open-loop control strategy, such as manually adjusting the control input based on the experience of engineers or using the Monte Carlo method to extensively search the control input space, has achieved preliminary control of jumping motion to a certain extent, its fundamental defect is that it over-relies on the static analysis of the tensegrity structure and ignores the key role of the structural dynamic characteristics during the jumping process. This neglect makes the control system appear fragile and powerless when facing sudden changes in the external environment (such as uneven ground, wind interference, etc.), and it is difficult to ensure the precise control of the jumping speed, height and trajectory, which seriously affects the reliability and success rate of task execution.
[0004] At the same time, intelligent learning control methods, such as evolutionary algorithms and deep reinforcement learning, provide new ideas for the jump control of tensegrity robots with their powerful data processing and adaptive optimization capabilities. However, these methods face another challenge in practical applications: they often focus on the global optimization of control strategies, while ignoring the unique motion analysis problems of tensegrity robots, resulting in defects such as large errors and insufficient robustness in the motion control methods of tensegrity robots. Summary of the invention
[0005] Aiming at the problems of large error and insufficient robustness in the existing tensegrity robot motion control methods, the present invention provides a tensegrity robot jumping motion closed-loop control method, which solves the defects of large error and insufficient robustness in the existing tensegrity robot motion control methods and realizes the tensegrity robot jumping motion with controllable motion state.
[0006] In order to achieve the above object, the present invention provides the following technical solutions.
[0007] In a first aspect, the present invention provides a closed-loop control method for a tensegrity robot jumping motion, comprising:
[0008] Establish a dynamic model of tensegrity robot considering contact and collision conditions;
[0009] According to the dynamic model of the tensegrity robot, the expected motion trajectory of the center of mass during the take-off phase is planned;
[0010] The tracking result of the robot's center of mass motion trajectory is obtained through the expected motion trajectory of the center of mass in the take-off phase;
[0011] Based on the tracking results of the robot's center of mass motion trajectory, a closed-loop control law for the tensegrity robot during the falling phase is designed to control the robot to maintain a balanced configuration and land smoothly.
[0012] As a further improvement of the present invention, the establishment of a tensegrity robot dynamics model considering contact and collision conditions includes:
[0013] The contact and collision process between the tensegrity robot nodes and the environment surface is described based on the complementary relationship, and the dynamic model of the tensegrity robot considering the contact and collision conditions is established according to the Lagrangian equation of the complete system under the action of non-conservative forces.
[0014] The dynamic model of the tensegrity robot is specifically expressed as follows:
[0015]
[0016] Φ q (q) = O
[0017]
[0018] Where q∈R N represents the generalized coordinate vector of the tensegrity robot, indicating the position and orientation of the robot rod component; M(q)∈R N×N represents the inertia matrix; A(q) represents the tensegrity structure equilibrium matrix, and the elements in A(q) are expressed as l j represents the length of the cable member; B(q)=A(q)SL(q) represents the steering matrix, L(q)=diag(l1,l2…l m ), S = diag(E1A1, E2A2…E M A M ), s = [E1A1 E2A2 ... E M A M ] T , E j A is the Young's modulus of the cable member.j represents the cross-sectional area of the cable member; u = [1 / r1 1 / r2…1 / r M ] T represents the control input, r j represents the original length of the cable member; u=[1 / r1 1 / r2 … 1 / r M ] T represents the control input, r j Indicates the original length of the cable member; Q N represents the normal contact generalized force vector between the robot node and the environment surface, Q f represents the tangential friction generalized force vector between the robot node and the environment surface, Φ q (q) is the complete constraint of the generalized coordinates of the tensegrity robot rod components, λ q is the corresponding Lagrange multiplier.
[0019] As a further improvement of the present invention, the planning of the expected motion trajectory of the center of mass in the take-off phase according to the dynamic model of the tensegrity robot includes:
[0020] Simplify the dynamic model of the tensegrity robot based on the complementary relationship, and obtain a simplified dynamic model of the tensegrity robot;
[0021] Based on the linear projection operator method, the simplified dynamic model of the tensegrity robot is transformed into a dynamic equation in the form of ordinary differential equations for control law design.
[0022] Based on the quadratic programming method, the center-of-mass motion trajectory of the tensegrity robot in the take-off phase is planned through the dynamic equation in the form of ordinary differential equations, and the expected center-of-mass motion trajectory in the take-off phase that meets the requirements of the expected jumping task is generated.
[0023] As a further improvement of the present invention, the center-of-mass motion trajectory planning of the tensegrity robot during the take-off phase includes the vertical motion trajectory of the center-of-mass of the tensegrity robot and the forward motion trajectory planning of the center-of-mass of the tensegrity robot;
[0024] The vertical motion trajectory of the center of mass of the tensegrity robot includes:
[0025] The linear model of the vertical motion of the robot's center of mass is expressed as:
[0026] In the formula, represents the vertical motion vector of the center of mass, z k is the vertical displacement of the robot’s center of mass at time k, T represents the simulation step size;
[0027] The expected duration of the robot's take-off phase is defined as NT, based on The prediction model of the robot's take-off phase is obtained as follows:
[0028] Where: Z k+1 =[z k+1 …z k+N ] T ,
[0029]
[0030] The vertical motion trajectory of the center of mass is planned through the quadratic programming problem, and the following is obtained:
[0031]
[0032] In the formula, Q z is the weight matrix, h t represents the expected center of mass height at the time of liftoff, H is the expected vertical velocity of the center of mass at the moment of liftoff. d represents the expected jumping height of the robot's center of mass, and g represents the acceleration due to gravity;
[0033] The solution of the quadratic programming k Substitution That is, the expected trajectory Z of the center of mass height of the robot during the take-off phase is obtained k+1 ;
[0034] The forward motion trajectory planning of the center of mass of the tensegrity robot comprises:
[0035] The linear model of the forward motion of the center of mass of the tensegrity robot is:
[0036] The prediction model of the tensegrity robot during the take-off phase is:
[0037] In the formula, x k is the vertical displacement of the robot’s center of mass at time k, X k+1 =[x k+1 …x k+N ] T ,
[0038] The forward motion trajectory of the center of mass is planned through the quadratic programming problem:
[0039]
[0040] In the formula, Q x is the weight matrix, x t represents the expected horizontal position of the center of mass at the moment of liftoff, v xtrepresents the expected horizontal velocity of the center of mass at the moment of leaving the ground, g represents the acceleration due to gravity, and μ represents the coefficient of ground friction;
[0041] The solution of the quadratic programming k Substitution That is, the expected forward trajectory X of the center of mass of the robot during the take-off phase is obtained k+1 .
[0042] As a further improvement of the present invention, obtaining the tracking result of the robot's center of mass motion trajectory through the expected center of mass motion trajectory in the take-off phase includes:
[0043] The center of mass trajectory tracking control law of the tensegrity robot in the take-off phase is designed based on the nonlinear adaptive closed-loop control method to realize the robot's center of mass motion trajectory tracking, so as to control the robot to reach the desired jumping target and obtain the robot's center of mass motion trajectory tracking result.
[0044] As a further improvement of the present invention, the closed-loop control law of the tensegrity robot in the falling phase is designed based on the robot center of mass motion trajectory tracking result to control the robot to maintain a balanced configuration and land smoothly, including:
[0045] During the robot's falling phase, the ground contact force is regarded as an external disturbance, and based on the linear projection operator method, the dynamic model of the tensegrity robot is simplified as follows:
[0046]
[0047] Where M q =P q M+(IP q ), B q =P q B(q),Q q =P q (Q N +Q f ),
[0048] Select the length of the tensegrity robot cable member as the task space:
[0049]
[0050] In the formula, x l =[l1 l2…l 23 ] T represents the cable member length vector, represents the Jacobian matrix of the robot task space;
[0051] Will Left multiplication And substitute The spatial dynamics of the robot falling task is expressed as:
[0052]
[0053] In the formula,
[0054] Design the robot closed-loop control law as:
[0055]
[0056] In the formula, x dl Denotes the expected length of the cable member, D l is a positive definite matrix representing the expected damping matrix, K l is a positive definite matrix representing the expected stiffness matrix;
[0057] Will Substitution In the task space closed-loop system, it is expressed as:
[0058]
[0059] By adjusting The expected damping matrix and stiffness matrix in the robot are used to achieve stable control of the robot configuration during the falling phase and meet the requirements of smooth landing.
[0060] In a second aspect, the present invention provides a closed-loop control system for a tensegrity robot jumping motion, comprising:
[0061] Dynamic model building module: used to build the dynamic model of the tensegrity robot considering contact and collision conditions;
[0062] Motion trajectory planning module: used to plan the expected motion trajectory of the center of mass during the take-off phase according to the dynamic model of the tensegrity robot;
[0063] Obtaining tracking result module: used to obtain the tracking result of the robot's center of mass motion trajectory through the expected motion trajectory of the center of mass in the take-off phase;
[0064] Control robot motion module: It is used to design the closed-loop control law of the tensegrity robot during the falling phase based on the robot's center of mass motion trajectory tracking results, so as to control the robot to maintain a balanced configuration and land smoothly.
[0065] In a third aspect, the present invention provides an electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the steps of the method for closed-loop control of jumping motion of a tensegrity robot when executing the computer program.
[0066] In a fourth aspect, the present invention provides a computer-readable storage medium, wherein the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps of the closed-loop control method for the jumping motion of a tensegrity robot are implemented.
[0067] In a fifth aspect, the present invention provides a computer program product, characterized in that it includes computer instructions, which, when executed by a processor, implement the steps of the closed-loop control method for the jumping motion of a tensegrity robot.
[0068] Compared with the prior art, the present invention has the following beneficial effects:
[0069] The present invention can more accurately simulate the actual motion state of the robot during the jumping process by establishing a dynamic model under contact and collision conditions, thereby reducing the control error caused by model simplification or ignoring certain dynamic factors. This high-precision model provides a solid foundation for subsequent trajectory planning and tracking. Secondly, when planning the expected motion trajectory of the center of mass in the take-off stage, possible contact and collision situations are considered, so that the control strategy has stronger adaptability and stability when facing uncertainty and external interference. This design enhances the robustness of the control system and improves the operational reliability of the robot in a complex environment. In addition, the closed-loop control law of the falling stage is designed by tracking the results of the center of mass motion trajectory, and the present invention realizes real-time monitoring and adjustment of the entire process of the robot's jumping motion. The closed-loop control can timely discover and correct the deviation between the actual motion and the expected trajectory, ensure that the robot can complete the jumping action according to the predetermined trajectory, and maintain a balanced configuration and land smoothly. Therefore, the present method is not only applicable to specific jumping motions, but also can adjust the expected motion trajectory of the center of mass in the take-off stage and the control law of the falling stage according to actual needs to adapt to different motion scenes and task requirements. BRIEF DESCRIPTION OF THE DRAWINGS
[0070] The drawings described herein are for illustrative purposes only and are not intended to limit the scope of the present disclosure in any way. In the drawings:
[0071] Figure 1 A schematic flow chart of a closed-loop control method for jumping motion of a tensegrity robot according to the present invention;
[0072] Figure 2 This is a flow chart of the closed-loop control algorithm for the jumping motion of the tensegrity robot of the present invention;
[0073] Figure 3 It is a center of mass height tracking curve of the tensegrity robot in the take-off stage of the present invention;
[0074] Figure 4 It is a tracking curve of the forward displacement of the center of mass of the tensegrity robot during the take-off phase of the present invention;
[0075] Figure 5 It is a lateral displacement tracking curve of the center of mass of the tensegrity robot during the take-off phase of the present invention;
[0076] Figure 6 This is a state diagram of the robot of the present invention at the initial moment of jumping motion;
[0077] Figure 7 This is a state diagram of the robot's jumping motion taking-off moment;
[0078] Figure 8 The state diagram of the robot in the jumping motion of the present invention at the jumping apex moment;
[0079] Fig. 9 This is a state diagram of the robot of the present invention when it stably lands after jumping;
[0080] Fig.10 It is a structural schematic diagram of a closed-loop control system for jumping motion of a tensegrity robot according to the present invention;
[0081] Fig.11 Schematic diagram of an electronic device in an embodiment of the present invention. DETAILED DESCRIPTION
[0082] In order to enable those skilled in the art to better understand the technical solutions in the present invention, the technical solutions in the present invention will be clearly and completely described below in conjunction with the drawings in the present invention. The described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments in the present invention, all other embodiments obtained by ordinary technicians in the field without creative work should fall within the scope of protection of the present invention.
[0083] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those generally understood by those skilled in the art of the present invention. The terms used herein in the specification of the present invention are only for the purpose of describing specific embodiments and are not intended to limit the present invention. The term "and / or" used herein includes any and all combinations of one or more related listed items.
[0084] Aiming at the problems of large error and insufficient robustness in the existing tensegrity robot motion control method, the present invention provides a tensegrity robot jumping motion closed-loop control method, such as Figure 1 As shown, the method includes:
[0085] Establish a dynamic model of tensegrity robot considering contact and collision conditions;
[0086] According to the dynamic model of the tensegrity robot, the expected motion trajectory of the center of mass during the take-off phase is planned;
[0087] The tracking result of the robot's center of mass motion trajectory is obtained through the expected center of mass motion trajectory in the take-off phase;
[0088] Based on the tracking results of the robot's center of mass motion trajectory, a closed-loop control law for the tensegrity robot during the falling phase is designed to control the robot to maintain a balanced configuration and land smoothly.
[0089] The method solves the defects of existing tensegrity robot motion control methods such as large error and insufficient robustness, and realizes the jumping motion of the tensegrity robot with controllable motion state.
[0090] The present invention is described in detail below with reference to the accompanying drawings and specific embodiments:
[0091] like Figure 2 As shown, the present invention provides a closed-loop control method for jumping motion of a tensegrity robot, comprising:
[0092] S1: The contact and collision process between the nodes of the tensegrity robot and the environment surface is described based on the complementary relationship, and the dynamic model of the tensegrity robot considering the contact and collision conditions is established.
[0093] Specifically, in S1, the contact and collision process between the tensegrity robot node and the environment surface is described based on the complementary relationship, and the dynamic model of the tensegrity robot under the contact and collision conditions is established, including:
[0094] S1.1: Describe the contact and collision process between the nodes of the tensegrity robot and the environment surface based on the complementary relationship.
[0095] The contact and collision process between the tensegrity robot node and the environment surface has the following complementary relationship:
[0096] g i ≥0,λ Ni ≥0,g i λ Ni =0 i=1…n (1)
[0097] in,
[0098] g i =d i +δ i ,
[0099] Where, d i is the normal distance between the robot’s i-th node and the environment surface, δ i is the embedding depth of the robot’s ith node along the normal direction of the environment surface, λ Ni is the normal contact force of the robot’s ith node, n Indicates the number of robot nodes.
[0100] The complementary relationship described by formula (1) can be equivalently expressed in the form of an equation:
[0101]
[0102] S1.2: Based on the Lagrangian equation of the complete system under the action of non-conservative forces, and combined with formula (2) and formula (3), the dynamic model of the tensegrity robot is established as:
[0103]
[0104] Where q∈R N represents the generalized coordinate vector of the tensegrity robot, indicating the position and orientation of the robot rod component; M(q)∈R N×N represents the inertia matrix; A(q) represents the tensegrity structure equilibrium matrix, and the elements in A(q) can be expressed as l j represents the length of the cable member; B(q)=A(q)SL(q) represents the steering matrix, L(q)=diag(l1,l2…l m ), S = diag(E1A1, E2A2…E M A M ), s = [E1A1 E2A2 … E M A M ] T , E j A is the Young's modulus of the cable member. j Represents the cross-sectional area of the cable member. u=[1r11r2…1r M ] T represents the control input, r j represents the original length of the cable member; u=[1 / r1 1 / r2 … 1 / r M ] T represents the control input, r j Indicates the original length of the cable member; Q N represents the normal contact generalized force vector between the robot node and the environment surface, Q f represents the tangential friction generalized force vector between the robot node and the environment surface, Φ q (q) is the complete constraint of the generalized coordinates of the tensegrity robot rod components, λ q is the corresponding Lagrange multiplier.
[0105] S2: Based on the linear projection operator method, the dynamic model established in S1 is transformed into the form of ordinary differential equations for control law design.
[0106] Specifically, in S2, the dynamic model with complete constraints shown in formula (4) is transformed into an ordinary differential equation for control law design based on the projection operator method, including:
[0107] S2.1: Simplified tensegrity robot dynamics model based on complementary relationship
[0108] Based on the complementary relationship in formula (1), the nodes of the tensegrity robot can be divided into a node set B that has no contact with the environment surface and a node set U that has contact with the environment surface. Formula (1) can be equivalent to:
[0109]
[0110] Substituting formula (5) into formula (4), the dynamic model of the tensegrity robot can be expressed as:
[0111]
[0112] In the formula, λ n =[λ Ni ] i∈U represents the normal support force of the environment contact node, λ f =[λ fi ] i∈U represents the tangential friction force of the environment contact node; Φ n (q) = [d i (q)] i∈U Represents the normal distance of the contact node relative to the environment surface, Φ f (q) = x f =[x fi ] i∈U represents the tangential displacement of the contact node; The Jacobian matrix representing the robot's constraint space.
[0113] S2.2: Convert the simplified dynamic model into ordinary differential equation form based on linear projection operator
[0114] The projection operator of the null space N(J) of the Jacobian matrix J of the constraint space can be expressed as Then its orthogonal complement space N(J) ⊥ The projection operator can be expressed as (IP).
[0115] Multiplying the differential equation in formula (6) by P on the left yields:
[0116]
[0117] Taking the first-order derivative of the equality constraint in formula (6) yields:
[0118]
[0119] N(J) ⊥ The generalized velocity components in can be expressed as:
[0120]
[0121] Taking the derivative of formula (10) we can get
[0122]
[0123] In the formula,
[0124] Adding formula (8) and formula (11) yields the dynamic equation of the complete constraint system in the form of ordinary differential equations:
[0125]
[0126] Where M p =PM+(IP), B p =PB(q).
[0127] S3: Based on the quadratic programming method, the center of mass motion trajectory of the tensegrity robot in the take-off phase is planned to generate the expected center of mass motion trajectory in the take-off phase that meets the expected jumping task requirements.
[0128] Specifically, in S3, the center of mass motion trajectory of the tensegrity robot in the take-off phase is planned based on the quadratic programming method to generate an expected center of mass motion trajectory in the take-off phase that meets the expected jumping task requirements, including:
[0129] The jumping motion process of the tensegrity robot can be divided into the take-off phase (from the initial state to the robot completely leaving the ground) and the falling phase (from the robot completely leaving the ground to stabilizing on the ground). Since the robot is in free fall in the air, the vertical velocity of the robot's center of mass and the forward velocity of the center of mass at the end of the take-off phase can determine the jumping height and jumping distance of the robot. Therefore, the forward and vertical motion trajectories of the center of mass need to be planned separately in 3.
[0130] S3.1: Plan the vertical trajectory of the center of mass to achieve the desired jump height
[0131] The vertical motion of the robot's center of mass can be represented by the following linear model:
[0132]
[0133] In the formula, represents the vertical motion vector of the center of mass, z k is the vertical displacement of the robot’s center of mass at time k, T represents the simulation step size.
[0134] The expected duration of the robot take-off phase is specified as NT. Based on formula (13), the prediction model of the robot take-off phase can be obtained as follows:
[0135]
[0136] Where: Z k+1 =[z k+1 … z k+N ] T ,
[0137] The vertical motion trajectory of the center of mass is planned through the following quadratic programming problem:
[0138]
[0139] In the formula, Q z is the weight matrix, h t represents the expected center of mass height at the time of liftoff, H is the expected vertical velocity of the center of mass at the moment of liftoff. d represents the expected jumping height of the robot's center of mass, and g represents the acceleration due to gravity.
[0140] The solution of the quadratic programming k Substituting into formula (14), we can get the expected trajectory Z of the center of mass height of the robot during the take-off phase: k+1 .
[0141] S3.2: Plan the forward trajectory of the center of mass to achieve the desired jump distance
[0142] The process of robot center of mass forward motion trajectory planning is the same as the vertical trajectory planning method. The linear model of center of mass forward motion and the prediction model of the take-off stage can be expressed as:
[0143]
[0144] In the formula, x k is the vertical displacement of the robot’s center of mass at time k, X k+1 =[x k+1 …x k+N ] T ,
[0145] The forward motion trajectory of the center of mass is planned through the following quadratic programming problem:
[0146]
[0147] In the formula, Q x is the weight matrix, x t represents the expected horizontal position of the center of mass at the moment of liftoff, v xt It represents the expected horizontal velocity of the center of mass when leaving the ground, g represents the acceleration due to gravity, and μ represents the coefficient of ground friction.
[0148] The solution of the quadratic programming k Substituting into formula (17), we can get the expected forward trajectory X of the center of mass of the robot during the take-off phase: k+1 .
[0149] S4: Based on the nonlinear adaptive closed-loop control method, the center of mass trajectory tracking control law of the tensegrity robot during the take-off phase is designed to achieve the robot's center of mass motion trajectory tracking to control the robot to achieve the desired jumping target.
[0150] Specifically, in S4, a mass center trajectory tracking control law of the tensegrity robot in the take-off phase is designed based on a nonlinear adaptive closed-loop control method to achieve the robot mass center motion trajectory tracking so as to control the robot to reach the desired jump target, including:
[0151] The control goal of the robot's take-off phase is to control the robot's center of mass to track the desired trajectory. Select the robot's center of mass as the task space:
[0152]
[0153] In the formula, x t =[x o y o z o ] T represents the centroid position vector, Represents the Jacobian matrix of the robot task space.
[0154] Multiply formula (12) by Substituting into formula (19), the spatial dynamics of the robot's take-off task can be expressed as:
[0155]
[0156] In the formula, Uncertainty It can be approximated by a set of radial basis functions, and formula (20) can be expressed as:
[0157]
[0158] In the formula, is the unknown constant matrix, ε is the approximate error vector, Φ h is the radial basis function vector, the vector Φ hEach element in is selected as a Gaussian function:
[0159]
[0160] In the formula, v c represents the center vector, σ q Represents the width of the Gaussian function.
[0161] Design the robot closed-loop control law as:
[0162]
[0163] u e =(SL(q)) -1 (T e +s)
[0164]
[0165] Where, T e Represents the prestressed balanced tension of the cable member, satisfying the prestressed equilibrium condition A(q)T e =0;x d represents the expected trajectory of the center of mass motion; D q =d q I, K q =k q I, is the control law parameter matrix; W h for The estimated value of is, and its adaptive law is:
[0166]
[0167] Where Γ, α>0, β>0 are control law parameters.
[0168] Substituting formula (23) into formula (21), the task space closed-loop system can be expressed as:
[0169]
[0170] In the formula, e = x t -x d ,
[0171] Furthermore, the stability analysis of the proposed controller is carried out and the Lyapunov function is defined as follows:
[0172]
[0173] In the formula, P=αD q +βKq ,
[0174] Formula (26) satisfies the following relationship:
[0175]
[0176] In the formula,
[0177] Deriving formula (26) and substituting it into formula (24) yields:
[0178]
[0179] In the formula, H=2[αI βI] T ,
[0180] By choosing appropriate control law parameters α , β, k q ,d q Let the matrix Q be a positive definite matrix that satisfies the following inequality:
[0181]
[0182] Where λ min =min{2αk q ,2(βd q -α)} is a positive constant.
[0183] because is a constant matrix, there exists v h make Substituting into formula (29), formula (28) can be further simplified as:
[0184]
[0185] When x e and vec(ΔW h )satisfy When Formula (30) can be further simplified as:
[0186]
[0187] According to the Lyapunov function inequality relationship shown in formula (27) and formula (31), it is proved that Consistently eventually bounded.
[0188] S5: Design a closed-loop control law for the falling phase of the tensegrity robot based on the partial feedback linearization method to control the robot to maintain a balanced configuration and land smoothly.
[0189] Specifically, in S5, the control law of the tensegrity robot during the falling phase is designed to control the robot to restore and maintain a balanced configuration in the air and achieve a smooth landing, including:
[0190] The control task in the falling stage is mainly to control the tensegrity robot to restore and maintain the initial equilibrium configuration and to achieve a smooth landing. Therefore, in the falling stage, the length of the tensegrity robot cable member is used as the control target to control its configuration, and a damping term is added to the cable member length closed-loop system to achieve a smooth landing.
[0191] During the robot's falling phase, the ground contact force is regarded as an external disturbance. Based on the linear projection operator method in S2, the dynamic model of the tensegrity robot shown in formula (4) can be simplified as follows:
[0192]
[0193] Where M q =P q M+(IP q ), B q =P q B(q),Q q =P q (Q N +Q f ),
[0194]
[0195] Select the length of the tensegrity robot cable member as the task space:
[0196]
[0197] In the formula, x l =[l1 l2…l 23 ] T represents the cable member length vector, Represents the Jacobian matrix of the robot task space.
[0198] Multiply formula (32) by Substituting into formula (33), the spatial dynamics of the robot falling task can be expressed as:
[0199]
[0200] In the formula,
[0201] Design the robot closed-loop control law as:
[0202]
[0203] In the formula, x dl Denotes the expected length of the cable member, D l is a positive definite matrix representing the expected damping matrix, K l is a positive definite matrix representing the expected stiffness matrix.
[0204] Substituting formula (35) into formula (34), the task space closed-loop system can be expressed as:
[0205]
[0206] By adjusting the desired damping matrix and stiffness matrix in formula (36), the robot configuration can be stably controlled during the falling phase and meet the requirement of smooth landing.
[0207] In summary, the present invention proposes for the first time a tensegrity robot jumping motion control scheme based on closed-loop control. Compared with the prior art, the present invention has the following advantages and effects:
[0208] The present invention adopts complementary relationship to describe the contact collision process, establishes a tensegrity robot dynamic model in the form of differential algebraic equations without contact condition judgment, and transforms the dynamic model in the form of differential algebraic equations into ordinary differential equations for control law design through linear projection operators, laying a foundation for closed-loop control law design based on dynamic models. In addition, by describing the desired jumping motion of the robot as a constraint of the optimization problem, the desired trajectory of the center of mass motion of the robot in the take-off phase that meets the desired jumping motion constraint conditions is established. Secondly, the present invention designs a closed-loop center of mass motion trajectory tracking control law in the take-off phase of the tensegrity robot based on a nonlinear adaptive control method, realizes the robust tracking of the robot center of mass motion to the desired trajectory, so as to ensure that the robot can reach the expected height and expected jumping distance of the jumping task, and realizes the controllable jumping motion of the tensegrity robot. Finally, the present invention designs a closed-loop control law in the falling phase of the tensegrity robot based on a partial feedback linearization method, so as to ensure that the robot recovers and stabilizes in the initial configuration after completing the take-off action, and realizes the landing shock absorption of the tensegrity robot, so that the robot can land smoothly after completing the take-off task.
[0209] The present invention is further explained below in conjunction with specific embodiments.
[0210] Example:
[0211] The effectiveness of the implementation scheme is illustrated by the simulation results of the jumping motion control of a six-rod spherical tensegrity robot. The six-rod spherical tensegrity robot consists of 6 rod components and 24 cable components. Figure 3 shown.
[0212] The simulation process parameters were set as follows: the total simulation time was 2 s, the simulation step was 0.005 s, the initial state of the tensegrity robot was stationary on the horizontal ground, and its jumping target was to land on a horizontal platform at a height of 0.4 m and 0.6 m in front of its center of mass.
[0213] The physical parameters of the robot and the environment are as follows: the length of the rod component is L = 1m, and the mass is 1kg; the Young's modulus of the cable component is E j =2GPa, cross-sectional area is A j =π×10 -6 m 2 ; The ground friction coefficient is μ=0.6, and the acceleration of gravity is g=9.8.
[0214] According to its jumping target, the expected maximum jumping height of the center of mass is set to 1m, and the relevant parameters of the robot's center of mass motion trajectory planning are defined as: T = 0.005s, N = 10, H d =1m, h t =0.5m,v t =3.11m / s, Q z =I 10 ; x t =0.03m,v xt =1.2m / s, Q x =I 10 .
[0215] The relevant parameters of the tensegrity robot control law are: k q =2000,d q =300, α=β=1, Γ=0.01, W h The initial value of D is 0. l =100I 23 , K l =2000I 23 .
[0216] Under the above settings, the simulation results are as follows Figure 3 to Figure 9 shown.
[0217] Figure 3 to Figure 5The center of mass trajectory tracking curve of the tensegrity robot in the take-off stage (0.05s-0.1s), the dotted line is the expected motion trajectory of the center of mass obtained by trajectory planning, and the solid line is the actual motion trajectory of the center of mass. The simulation results show that the forward displacement, vertical displacement, and lateral displacement of the robot's center of mass can quickly and stably track its expected instructions during the take-off stage, and the tracking error is kept in a small range. The robot can complete the take-off with the expected center of mass vertical speed and forward speed, thereby ensuring that the robot can reach its expected jumping height and jumping distance during the jumping process, and finally complete the expected rolling motion.
[0218] Figure 6 to Figure 9 A three-dimensional schematic diagram of the jumping motion process of the tensegrity robot. Figure 6 It is a schematic diagram at t = 0.005s (initial time), and the tensegrity robot is stationary on the horizontal ground; Figure 7 This is a schematic diagram of the moment t=0.1s (the moment of leaving the ground). The tensegrity robot completes the task of tracking the center of mass trajectory during the take-off phase, and the robot leaves the ground and enters a free fall motion state. Figure 8 This is a schematic diagram at t=0.52s (jump apex moment). The robot reaches its maximum jumping height after leaving the ground. The results show that its center of mass height can reach the expected maximum jumping height represented by the black dotted line, and it achieves configuration recovery and maintenance in the air. Fig. 9 This is a schematic diagram of the moment t=2s (stable landing moment). The results show that the robot landed stably on the desired platform, achieved stable landing and finally completed the jumping task.
[0219] In summary, the closed-loop control law for the jumping motion of the tensegrity robot designed in the present invention solves the defects of the existing tensegrity robot motion control methods such as large errors and insufficient robustness, realizes the jumping motion of the tensegrity robot with controllable motion state, and has guiding significance for the design of the tensegrity robot motion control system.
[0220] The second object of the present invention is to provide a closed-loop control system for the jumping motion of a tensegrity robot. Fig.10 As shown, including:
[0221] Dynamic model building module: used to build the dynamic model of the tensegrity robot considering contact and collision conditions;
[0222] Motion trajectory planning module: used to plan the expected motion trajectory of the center of mass during the take-off phase according to the dynamic model of the tensegrity robot;
[0223] Obtaining tracking result module: used to obtain the tracking result of the robot's center of mass motion trajectory through the expected motion trajectory of the center of mass in the take-off phase;
[0224] Control robot motion module: It is used to design the closed-loop control law of the tensegrity robot during the falling phase based on the robot's center of mass motion trajectory tracking results, so as to control the robot to maintain a balanced configuration and land smoothly.
[0225] like Fig.11 As shown, the third object of the present invention is to provide an electronic device, the electronic device comprising: a processor, a memory and a display screen. The memory and the display screen are both connected to the processor, such as through a bus. Optionally, the electronic device may also include a transceiver. It should be noted that in actual applications, the transceiver is not limited to one, and the structure of the electronic device does not constitute a limitation on the embodiments of the present application.
[0226] The processor may be a CPU (Central Processing Unit), a general-purpose processor, a DSP (Digital Signal Processor), an ASIC (Application Specific Integrated Circuit), an FPGA (Field Programmable Gate Array) or other programmable logic devices, transistor logic devices, hardware components or any combination thereof. It may implement or execute various exemplary logic blocks, modules and circuits described in conjunction with the disclosure of this application. The processor may also be a combination that implements computing functions, such as a combination of one or more microprocessors, a combination of a DSP and a microprocessor, etc.
[0227] The bus may include a path to transmit information between the above components. The bus may be a PCI (Peripheral Component Interconnect) bus or an EISA (Extended Industry Standard Architecture) bus, etc. The bus may be divided into an address bus, a data bus, a control bus, etc.
[0228] The memory can be ROM (Read Only Memory) or other types of static storage devices that can store static information and instructions, RAM (Random Access Memory) or other types of dynamic storage devices that can store information and instructions, or it can be EEPROM (Electrically Erasable Programmable Read Only Memory), CD-ROM (Compact Disc Read Only Memory) or other optical disk storage, optical disk storage (including compressed optical disk, laser disk, optical disk, digital versatile disk, Blu-ray disk, etc.), magnetic disk storage medium or other magnetic storage device, or any other medium that can be used to carry or store the desired program code in the form of instructions or data structures and can be accessed by a computer, but is not limited to this.
[0229] The memory is used to store the application code for executing the solution of the present application, and the execution is controlled by the processor. The processor is used to execute the application code stored in the memory to implement the content shown in the above method embodiment.
[0230] Fig.11 The electronic device shown is merely an example and should not bring any limitation to the functions and scope of use of the embodiments of the present application.
[0231] The fourth object of the present invention is to provide a computer-readable storage medium, wherein the computer-readable storage medium stores a computer program, wherein the computer program is stored thereon, and when the program is executed by a processor, the aforementioned Figures 1 to 2 The various processes of the method embodiment shown in the figure include, for example, a memory including instructions, and the instructions can be executed by a processor of an electronic device to complete the method.
[0232] A computer-readable storage medium may be a tangible device that holds and stores instructions used by an instruction execution device. A computer-readable storage medium may be, but is not limited to, an electrical storage device, a magnetic storage device, an optical storage device, an electromagnetic storage device, a semiconductor storage device, or any combination thereof. Specifically, a computer-readable storage medium may be a portable computer disk, a hard disk, a USB flash drive, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), a podium random access memory (SRAM), a portable compact disk read-only memory (CD-ROM), a digital versatile disk (DVD), a memory stick, a floppy disk, an optical disk, a magnetic disk, a mechanical encoding device, and any combination thereof.
[0233] A fifth object of the present invention is to provide a computer program product, comprising computer instructions, which, when executed by a processor, implement the above Figures 1 to 2 The various processes of the method embodiment shown can achieve the same technical effect, and will not be described again here to avoid repetition.
[0234] Many embodiments and many applications beyond the examples provided will be apparent to those skilled in the art upon reading the above description. Therefore, the scope of the present teachings should not be determined with reference to the above description, but rather with reference to the preceding claims and the full scope of equivalents to which such claims are entitled. For the purpose of comprehensiveness, all articles and references, including disclosures of patent applications and publications, are incorporated herein by reference. The omission of any aspect of the subject matter disclosed herein in the preceding claims is not intended to be a disclaimer of such subject matter, nor should it be considered that the applicants did not consider such subject matter to be part of the disclosed inventive subject matter.
[0235] The above content is a further detailed description of the present invention. It cannot be determined that the specific implementation methods of the present invention are limited to these. For ordinary technicians in the technical field to which the present invention belongs, without departing from the concept of the present invention, they can also make several simple deductions or substitutions, which should be regarded as belonging to the protection scope of the present invention determined by the submitted claims.
Claims
1. A closed-loop control method for jumping motion of a tensegrity robot, characterized in that: include: Establish a dynamic model of tensegrity robot considering contact and collision conditions; According to the dynamic model of the tensegrity robot, the expected motion trajectory of the center of mass during the take-off phase is planned; The tracking result of the robot's center of mass motion trajectory is obtained through the expected center of mass motion trajectory in the take-off phase; Based on the tracking results of the robot's center of mass motion trajectory, a closed-loop control law for the tensegrity robot during the falling phase is designed to control the robot to maintain a balanced configuration and land smoothly.
2. A closed-loop control method for jumping motion of a tensegrity robot according to claim 1, characterized in that: The method of establishing a tensegrity robot dynamics model considering contact and collision conditions includes: The contact and collision process between the tensegrity robot nodes and the environment surface is described based on the complementary relationship, and the dynamic model of the tensegrity robot considering the contact and collision conditions is established according to the Lagrangian equation of the complete system under the action of non-conservative forces. The dynamic model of the tensegrity robot is specifically expressed as follows: Φ q (q)=O Where q∈R N represents the generalized coordinate vector of the tensegrity robot, indicating the position and orientation of the robot rod component; M(q)∈R N×N represents the inertia matrix; A(q) represents the tensegrity structure equilibrium matrix, and the elements in A(q) are expressed as l j represents the length of the cable member; B(q)=A(q)SL(q) represents the steering matrix, L(q)=diag(l1,l2…l m ), S = diag(E1A1, E2A2…E M A M ), s = [E1A1 E2A2 ... E M A M ] T , E j A is the Young's modulus of the cable member. j represents the cross-sectional area of the cable member; u = [1 / r1 1 / r2…1 / r M ] T represents the control input, r j represents the original length of the cable member; u = [1 / r11 / r2…1 / r M ] T represents the control input, r j Indicates the original length of the cable member; Q N represents the normal contact generalized force vector between the robot node and the environment surface, Q f represents the tangential friction generalized force vector between the robot node and the environment surface, Φ q (q) is the complete constraint of the generalized coordinates of the tensegrity robot rod components, λ q is the corresponding Lagrange multiplier.
3. A closed-loop control method for jumping motion of a tensegrity robot according to claim 1, characterized in that: The method of planning the expected motion trajectory of the center of mass in the take-off phase according to the dynamic model of the tensegrity robot includes: Simplify the dynamic model of the tensegrity robot based on the complementary relationship, and obtain a simplified dynamic model of the tensegrity robot; Based on the linear projection operator method, the simplified dynamic model of the tensegrity robot is transformed into a dynamic equation in the form of ordinary differential equations for control law design. Based on the quadratic programming method, the center-of-mass motion trajectory of the tensegrity robot in the take-off phase is planned through the dynamic equation in the form of ordinary differential equations, and the expected center-of-mass motion trajectory in the take-off phase that meets the requirements of the expected jumping task is generated.
4. A closed-loop control method for jumping motion of a tensegrity robot according to claim 3, characterized in that: The center-of-mass motion trajectory planning of the tensegrity robot during the take-off phase includes the vertical motion trajectory of the center-of-mass of the tensegrity robot and the forward motion trajectory planning of the center-of-mass of the tensegrity robot; The vertical motion trajectory of the center of mass of the tensegrity robot includes: The linear model of the vertical motion of the robot's center of mass is expressed as: In the formula, represents the vertical motion vector of the center of mass, z k is the vertical displacement of the robot’s center of mass at time k, T represents the simulation step size; The expected duration of the robot's take-off phase is defined as NT, based on The prediction model of the robot's take-off phase is obtained as follows: where: Z k+1 = [z k+1 …z k+N T , The vertical motion trajectory of the center of mass is planned through the quadratic programming problem, and the following is obtained: In the formula, Q z is the weight matrix, h t represents the expected center of mass height at the time of liftoff, H is the expected vertical velocity of the center of mass at the moment of liftoff. d represents the expected jumping height of the robot's center of mass, and g represents the acceleration due to gravity; The solution of the quadratic programming k Substitution That is, the expected trajectory Z of the center of mass height of the robot during the take-off phase is obtained k+1 ; The forward motion trajectory planning of the center of mass of the tensegrity robot comprises: The linear model of the forward motion of the center of mass of the tensegrity robot is: The prediction model of the tensegrity robot during the take-off phase is: In the formula, x k is the vertical displacement of the robot’s center of mass at time k, X k+1 =[x k+1 …x k+N ] T , The forward motion trajectory of the center of mass is planned through the quadratic programming problem: In the formula, Q x is the weight matrix, x t represents the expected horizontal position of the center of mass at the moment of liftoff, v xt represents the expected horizontal velocity of the center of mass at the moment of leaving the ground, g represents the acceleration due to gravity, and μ represents the coefficient of ground friction; The solution of the quadratic programming k Substitution That is, the expected forward trajectory X of the center of mass of the robot during the take-off phase is obtained k+1 .
5. The closed-loop control method for jumping motion of a tensegrity robot according to claim 1, characterized in that: The method of obtaining the tracking result of the robot's center of mass motion trajectory through the expected center of mass motion trajectory in the take-off phase includes: The center of mass trajectory tracking control law of the tensegrity robot in the take-off phase is designed based on the nonlinear adaptive closed-loop control method to realize the robot's center of mass motion trajectory tracking, so as to control the robot to reach the desired jumping target and obtain the robot's center of mass motion trajectory tracking result.
6. A closed-loop control method for jumping motion of a tensegrity robot according to claim 2, characterized in that: The method of designing a closed-loop control law of the tensegrity robot in the falling phase based on the robot center of mass motion trajectory tracking result to control the robot to maintain a balanced configuration and land smoothly includes: During the robot's falling phase, the ground contact force is regarded as an external disturbance, and based on the linear projection operator method, the dynamic model of the tensegrity robot is simplified as follows: Where M q =P q M+(IP q ), B q =P q B(q),Q q =P q (Q N +Q f ), Select the length of the tensegrity robot cable member as the task space: In the formula, x l =[l1 l2…l 23 ] T represents the cable member length vector, represents the Jacobian matrix of the robot task space; Will Left multiplication And substitute The spatial dynamics of the robot falling task is expressed as: In the formula, Design the robot closed-loop control law as: In the formula, x dl Denotes the expected length of the cable member, D l is a positive definite matrix representing the expected damping matrix, K l is a positive definite matrix representing the expected stiffness matrix; Will Substitution In the task space closed-loop system, it is expressed as: By adjusting The expected damping matrix and stiffness matrix in the robot are used to achieve stable control of the robot configuration during the falling phase and meet the requirements of smooth landing.
7. A closed-loop control system for the jumping motion of a tensegrity robot, characterized in that: include: Dynamic model building module: used to build the dynamic model of the tensegrity robot considering contact and collision conditions; Motion trajectory planning module: used to plan the expected motion trajectory of the center of mass during the take-off phase according to the dynamic model of the tensegrity robot; Obtaining tracking result module: used to obtain the tracking result of the robot's center of mass motion trajectory through the expected motion trajectory of the center of mass in the take-off phase; Control robot motion module: It is used to design the closed-loop control law of the tensegrity robot during the falling phase based on the robot's center of mass motion trajectory tracking results, so as to control the robot to maintain a balanced configuration and land smoothly.
8. An electronic device, characterized in that: The method comprises a memory, a processor and a computer program stored in the memory and executable on the processor, wherein the processor implements the steps of a closed-loop control method for jumping motion of a tensegrity robot as described in any one of claims 1 to 6 when executing the computer program.
9. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps of the closed-loop control method for jumping motion of a tensegrity robot described in any one of claims 1 to 6 are implemented.
10. A computer program product, characterized in that It comprises computer instructions, which, when executed by a processor, implement the steps of a closed-loop control method for jumping motion of a tensegrity robot as described in any one of claims 1 to 6.
Citation Information
Cited By
A spectral submanifold-based fast and accurate control method for cable-driven tensegrity robots
CN120578055B
