Double-ring position control method for universal pneumatic flexible mechanical arm based on digital twinning

By establishing a virtual object using digital twin technology and designing a dual-loop control method, the position control problem of a universal pneumatic flexible robotic arm under environmental changes and disturbances was solved, achieving high-precision and fast-response robotic arm control.

CN119036436AActive Publication Date: 2024-11-29TIANJIN UNIV

Patent Information

Application Number
CN202410835615.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-06-26
Publication Date
2024-11-29
Estimated Expiration
2044-06-26

AI Technical Summary

Technical Problem

In existing technologies, omnidirectional pneumatic flexible robotic arms are difficult to achieve fast and high-precision position control when environmental conditions change or DH modeling is inaccurate. Furthermore, they are affected by gravity bias, Coriolis force, and coupling disturbances, which leads to a decrease in servo control accuracy.

Method used

A dual-loop position control method based on digital twins is adopted. A virtual body is built in the structural simulation software, and the position and pose information of the end point is obtained in real time by combining digital simulation software. A finite-time extended state observer and an integral error controller are designed to compensate for the influence of disturbances. Accurate tracking is achieved by using a fast integral sliding mode controller.

Benefits of technology

This improves the position control accuracy and response speed of the robotic arm under conditions of environmental changes and inaccurate modeling, ensuring stable and rapid control performance.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119036436A_ABST
    Figure CN119036436A_ABST
Patent Text Reader

Abstract

A universal pneumatic flexible mechanical arm double-ring position control method based on digital twinning belongs to the field of industrial intelligent manufacturing technology and mechanical arm servo control, and comprises the following steps: firstly, establishing a universal pneumatic flexible mechanical arm virtual body structure in digital simulation software according to the structural characteristics of a universal pneumatic flexible mechanical arm entity; only kinematics control is involved in the virtual body; under the disturbance influence of gravity bias, Coriolis force and coupling on an entity, a finite time expansion state observer is designed to estimate disturbance, and an integral error controller compensates the disturbance; designing a fast integral sliding mode controller to realize fast and accurate tracking of an expected position; according to the method, the problem that the universal pneumatic flexible mechanical arm is influenced by disturbance in movement is solved, the pose of the tail end point obtained by the digital twinning virtual body is not influenced by imprecise D-H modeling and environmental condition changes, and finally it is guaranteed that the universal pneumatic flexible mechanical arm based on digital twinning can rapidly, accurately and stably track the space position track.
Need to check novelty before this filing date? Find Prior Art

Description

Technical field:

[0001] The present invention belongs to the field of industrial intelligent manufacturing technology and robotic arm servo control, and specifically relates to a dual-loop position control method of a universal pneumatic flexible robotic arm based on digital twins. Background technology:

[0002] As an important part of industrial automation, the robotic arm in the field of industrial intelligent manufacturing has been widely used in many industries, including automobile manufacturing, electronic assembly, metal processing, food and beverage production, etc. The introduction and development of the robotic arm has greatly improved production efficiency, product quality and factory manufacturing capabilities. In order to meet the needs of the intelligent manufacturing site for the flexibility and flexibility of the robotic arm, a universal pneumatic flexible robotic arm driven by pneumatic artificial muscles is designed to realize the functions of grasping and carrying. In order to achieve high-precision grasping and carrying functions, the fast and high-precision position control of the universal pneumatic flexible robotic arm is a meaningful problem. At present, in the real robotic arm position control application, an encoder is generally installed on each joint, and the joint position of the robotic arm is obtained by measuring the joint rotation angle, and then the end position of the robotic arm is calculated by the DH method; or the image of the robotic arm is obtained by a monocular or binocular camera, and the position and posture of the robotic arm are calculated by a computer vision algorithm; or the point cloud data of the laser radar is used to build the environment model and the robotic arm position and posture. In the above methods, when environmental conditions (occlusion, lighting, surface material of the object being measured) change, the accuracy of the data obtained by the camera and lidar will decrease; when the DH modeling is inaccurate, the accuracy of the robot arm's posture will also decrease. Therefore, when environmental conditions change or the DH modeling is inaccurate, fast and high-precision position control of the universal pneumatic flexible robot arm is very necessary.

[0003] As we all know, when the omnidirectional pneumatic flexible robotic arm moves, it will be affected by the disturbances of gravity bias, Coriolis force and coupling; and the above disturbances will have an adverse effect on the servo control of the omnidirectional pneumatic flexible robotic arm, making it impossible to achieve high-precision control; at the same time, the omnidirectional pneumatic flexible robotic arm is driven by pneumatic artificial muscles, and its slow movement problem limits its application in certain high-speed and high-precision tasks.

[0004] Digital twin refers to the interaction and mapping between the physical world and the digital world through the digital replica of a physical object or system. The core idea of ​​digital twin is to collect data of physical entities in real time through sensors and other devices, and transmit this data to digital models so that the digital models can dynamically reflect the status and behavior of physical entities. In this way, users can monitor, analyze, predict and optimize physical entities in a virtual environment, thereby improving efficiency, reducing costs and risks.

[0005] The present invention proposes a dual-loop position control method for a universal pneumatic flexible robotic arm based on digital twin. According to the structural characteristics of the universal pneumatic flexible robotic arm entity, a virtual body structure of the universal pneumatic flexible robotic arm is first established in structural simulation software and digital simulation software, and only kinematic control is involved in the virtual body; when the entity is affected by the disturbances of gravity bias, Coriolis force and coupling, a finite-time expanded state observer is designed to estimate the disturbance, and an integral error controller compensates for the disturbance; a fast integral sliding mode controller is designed to achieve fast and accurate tracking of the desired position; the present invention solves the problem of the universal pneumatic flexible robotic arm being affected by disturbances during movement, and the position and posture of the end point obtained by the digital twin virtual body is not affected by the inaccurate DH modeling and changes in environmental conditions, ultimately ensuring that the universal pneumatic flexible robotic arm based on digital twin can quickly, accurately and stably track the spatial position trajectory, effectively solving the above-mentioned problems. Summary of the invention:

[0006] To achieve the above objectives, the technical solution adopted by the present invention is as follows:

[0007] A dual-loop position control method for a universal pneumatic flexible robotic arm based on digital twins includes the following steps:

[0008] Step 1: According to the structural characteristics of the universal pneumatic flexible robotic arm entity, a virtual body structure of the universal pneumatic flexible robotic arm is established in the structural simulation software, and the virtual body structure is imported into the digital simulation software. The angle sensor data of the entity is transmitted to the virtual body through the serial port, and the position information and posture information of the end point of the virtual body can be obtained in real time. Finally, the posture information of the end point of the virtual body is transmitted to the entity through the serial port;

[0009] Step 2: Consider the gravity bias, Coriolis force and coupling introduced when the universal pneumatic flexible manipulator moves as disturbances, and establish a second-order mathematical model of the universal pneumatic flexible manipulator;

[0010] Step 3: Establish a mathematical model of the outer ring of the universal pneumatic flexible manipulator and a mathematical model of the inner ring of the universal pneumatic flexible manipulator;

[0011] Step 4: The difference between the pose information of the end point of the virtual body and the pose information of the expected end point is taken as the outer loop pose error. The outer loop pose error is inversely solved into an angle error through the Levenberg-Marquardt method and input into the outer loop. According to the outer loop mathematical model of the universal pneumatic flexible manipulator, the outer loop fast integral sliding mode controller is designed, and its output is taken as the expected value of the inner loop mathematical model of the universal pneumatic flexible manipulator.

[0012] Step 5: According to the mathematical model of the inner loop of the universal pneumatic flexible manipulator, an inner loop finite time expansion state observer is designed to estimate the disturbance of the universal pneumatic flexible manipulator;

[0013] Step 6: Design an inner loop integral error controller based on the inner loop mathematical model of the universal pneumatic flexible manipulator and the estimated value of the inner loop finite time extended state observer for the disturbance;

[0014] Step 7: Use the Lyapunov method to check the convergence of the inner loop finite time extended state observer, the inner loop integral error controller and the outer loop fast integral sliding mode controller.

[0015] Furthermore, the step 1 specifically includes: using the angle sensor data θ of each joint of the entity i (t), where i = 1, 2, ..., 6, so as to perform kinematic control in the virtual body and obtain the position information and posture information of the end point from the virtual body. 0 T6(t) is the pose information matrix, which is expressed as:

[0016]

[0017] Where: P x (t), P y (t), P z (t) represents the coordinates of the end point of the universal pneumatic flexible manipulator in the global coordinate system X, Y, and Z axes, respectively, x (t), n y (t), n z (t) represents the normal axis coordinate of the end point in the global coordinate system X, Y, and Z axes, respectively. x (t), o y (t), o z (t) represents the coordinates of the orientation axis of the end point in the global coordinate system X, Y, and Z axes, respectively. x (t), a y (t), a z (t) represents the coordinates of the approach axis of the end point in the global coordinate system X, Y, and Z axes respectively.

[0018] Furthermore, the step 2 specifically includes:

[0019] The second-order mathematical model of the universal pneumatic flexible manipulator is:

[0020]

[0021] Where:

[0022] ψ2(u(t),t)=B w (t)20 / πarctan(u(t)),Ω 1,1 =Ω 2,3 =Ω3,3 =diag{b c ,b c}

[0023]

[0024] Where: x i1 (t) = θ i (t) is the angle of each joint of the universal pneumatic flexible robotic arm, is the angular velocity of each joint of the universal pneumatic flexible manipulator, ψ1(X1(t), t) is the state coupling matrix, ψ2(u(t), t) is the control coupling matrix, B w (t) is the coupling matrix, u i (t) is the output of the inner loop integral error controller, f i (t) is the gravitational bias and Coriolis force, ψ1(X1(t),t) and ψ2(u(t),t) are considered as perturbations W d (t), is the decoupling constant, r is the radius of the joint disk, L0 is the length of the connecting rod, J e represents the moment of inertia of each joint, P0 is the pre-inflation pressure, b is the length of the braided mesh fiber, n is the number of turns of the braided mesh fiber, ζ is the structural compensation parameter, and b i1 =(3P0ζr 2 L0) / (πn 2 J e ), X1(t)=[x 11 (t),x 21 (t),…,x 61 (t)] T is the angle matrix, X2(t)=[x 12 (t),x 22 (t),…,x 62 (t)] T is the angular velocity matrix.

[0025] Furthermore, the step three specifically includes:

[0026] The mathematical model of the outer ring of the universal pneumatic flexible manipulator is:

[0027]

[0028] The mathematical model of the inner ring of the universal pneumatic flexible manipulator is:

[0029]

[0030] Where: V(t) = [v1(t), v2(t), …, v6(t)] Tis the output of the outer loop fast integral sliding mode controller, G(t) = [g 12 (t),g 22 (t),...,g 62 (t)] T is the inner loop tracking error matrix, X3(t)=W di (t) is the expansion state of the disturbance, W d (t) = [w d1 (t),w d2 (t),…,w d6 (t)] T And W d (t) is continuous and bounded, X3(t) = [x 13 (t),x 23 (t),…,x 63 (t)] T .

[0031] Furthermore, in the step 4, the difference between the pose information of the end point of the virtual body and the pose information of the expected end point is used as the outer loop pose error, and the outer loop pose error is inversely solved into an angle error by the Levenberg-Marquardt method and input into the outer loop, specifically including:

[0032] The pose information of the end point of the virtual body 0 T6(t) and the pose information of the expected end point 0 T 6des The difference between (t) and (t) is taken as the outer ring posture error, and the outer ring posture error is inversely solved into the outer ring angle error dθ by the Levenberg-Marquardt method. i (t) is input to the outer loop fast integral sliding mode controller, and the inverse solution process is as follows through the Levenberg-Marquardt method:

[0033] dθ(k)=Ψ(J T (θ(k))J(θ(k))+χ 2 (k)I6) -1 J T (θ(k))dD(k)

[0034] =Ω(k)

[0035] Where: k is the number of sampling points, dθ(k) = [dθ1(k), dθ2(k), ..., dθ6(k)] T is the differential vector of the end point pose, Ω(k) is a nonlinear function used to save dθ(k) at the k sampling point, I6∈R 6×6is the identity matrix, Ψ=diag{ψ1,ψ2,...,ψ6} is the convergence rate parameter matrix, J(θ(k)) is the Jacobian matrix, and χ(k) is a time-varying parameter;

[0036] The update rule of χ(k) is:

[0037]

[0038] According to the outer ring mathematical model of the universal pneumatic flexible manipulator, an outer ring fast integral sliding mode controller is designed, and its output is used as the expected value of the inner ring mathematical model of the universal pneumatic flexible manipulator, which specifically includes:

[0039] The outer loop fast integral sliding mode controller is:

[0040]

[0041]

[0042] The sliding surface is s i (t) is:

[0043]

[0044] Where: v i (t) is the outer loop control law, e i1 (t) is the observation error of the finite-time extended state observer, α and β are two constant parameters greater than zero, m1 and m2 are two constant parameters greater than zero, q1 and q2 are two odd numbers greater than zero and satisfy 0<q1 / q2<1, a∈(0,1) and b∈(0,1) are two exponential terms, λ c is a constant parameter greater than zero.

[0045] Furthermore, the step five specifically includes:

[0046] The inner loop finite-time extended state observer is:

[0047]

[0048] Where: e i1 (t) = z i1 (t)-x i2 (t), e i2 (t) = z i2 (t)-x i3 (t)

[0049]

[0050] Where: sig α (x)=|x| αsgn(x) is the energy function, f1(e i1 (t)) and f2(e i1 (t)) is the designed nonlinear function, l1 and l2 are observer parameters, K1 is an adjustable parameter, z i1 (t) and z i2 (t) are x i2 (t) and x i3 The estimated value of (t), e i1 (t) and e i2 (t) are z i1 (t) and z i2 (t), a decoupling matrix is ​​given by U d (t)=B0u(t)=[U d1 (t),U d2 (t),…,U d6 (t)] T ;

[0051] Furthermore, the step six specifically includes:

[0052] The inner loop integral error controller is:

[0053]

[0054] Where: Z(t)=[z 12 (t),z 22 (t),...,z 62 (t)] is the perturbation estimation matrix, a1 = 0.5, δ = 0.009, c i and d i are two positive parameters greater than zero, ε i (t) = v i (t)-z i1 (t) is the inner loop angular velocity error, U0(t) is the nonlinear error, and Z(t) is W d (t) is an estimated value.

[0055] Furthermore, the step seven specifically includes:

[0056] The convergence of the outer loop fast integral sliding mode controller is tested. The first step is to prove that the outer loop angle error dθ i (t) can converge to the sliding surface s i (t), the Lyapunov function equation is designed as follows:

[0057] For the Lyapunov function equation V reach (t) Derivative:

[0058]

[0059] If there exists a positive number m2 such that m2>max|ε i (t)|, then Established, that is, the outer ring angle error dθ i (t) can converge to the sliding surface s i (t) up;

[0060] The second step is to prove the outer ring angle error dθ i (t) can be along the sliding surface s i (t) converges to zero, and the Lyapunov function equation is designed as follows:

[0061] For the Lyapunov function equation V sm (t) Derivative:

[0062]

[0063] Since α>0, β>0 and dθ i (t)tanh(λ c dθ i (t))>0, so Established, thus the outer ring angle error dθ can be obtained i (t) can be along the sliding surface s i (t) converges to zero, and the convergence test of the outer loop fast integral sliding mode controller is completed;

[0064] The convergence of the inner loop finite time extended state observer is tested to prove that the observation error e i1 (t) and e i2 (t) can converge to zero in a finite time. First, the observation error system of the inner loop finite time extended state observer is given as follows:

[0065]

[0066] The Lyapunov function equation is designed as follows: V ESO (t)=∈ T (t)P∈(t)

[0067] Where: P is a positive definite symmetric matrix, the constructed error ∈ T (t) = [f1(e i1 (t)),e i2 (t)];

[0068] For the Lyapunov function equation V ESO (t) Derivative:

[0069]

[0070] make ξ is a sufficiently small positive constant, the Lyapunov function equation V ESO The derivative of (t) can be written as:

[0071]

[0072] The finite time convergence time is:

[0073] Where t0 is the initial time;

[0074] because And it satisfies the finite time convergence rule, so the observation error e i1 (t) and e i2 (t) can converge to zero in finite time, and the finite time convergence test of the inner loop finite time extended state observer is completed;

[0075] The inner loop integral error controller is tested for convergence. To prove that the inner loop angular velocity error ε i (t) can converge to zero. First, the error system of the inner loop integral error controller is given as follows:

[0076]

[0077] Where: g i2 (t) = v i (t)-x i2 (t) is the construction tracking error of the inner loop system;

[0078] In the following proof, fal(ε i (t),a1,δ) is expressed as fal(ε i (t)), the Lyapunov function equation is designed as follows:

[0079] For the Lyapunov function equation V IEC (t) Derivative:

[0080]

[0081] make: And H(t) is bounded, is a positive parameter; it can be concluded that So if there is a small positive number and a large positive number ε0 satisfies: Can make holds; that is, when the parameter c i When it is big enough, Established, that is, the inner ring angular velocity error ε i (t) can converge to zero, and the convergence test of the inner loop integral error controller is completed.

[0082] The beneficial effects of the present invention are:

[0083] 1. The present invention establishes a virtual body through structural simulation software and digital simulation software. Providing entity angle information to the virtual body can obtain the pose information of the end point of the virtual body in real time. Since the structure of the virtual body and the entity is a mapping relationship, the pose information of the end point of the virtual body can be regarded as the pose information of the end point of the entity. There will be no problem of low accuracy of the pose information obtained when the environmental conditions change and the DH modeling is inaccurate. That is, the pose information of the end point obtained by the virtual body is not affected by the inaccurate DH modeling and changes in environmental conditions, which improves the robustness and pose acquisition accuracy.

[0084] 2. The present invention regards the gravity bias, Coriolis force and coupling of the universal pneumatic flexible manipulator as disturbances, estimates the disturbances using the inner loop finite time extended state observer, and compensates in the inner loop integral error controller, thereby reducing the influence of the disturbances on the universal pneumatic flexible manipulator and improving the control accuracy. At the same time, due to the rapid response of the inner loop integral error controller and the outer loop fast integral sliding mode controller, more detailed corrections are made on the basis of the inner loop control, thereby improving the response speed of the overall system.

[0085] 3. The dual closed-loop position control method of the present invention is easy to implement in engineering applications, and multiple Lyapunov functions are used to verify the effectiveness of the designed inner loop finite time extended state observer, inner loop integral error controller and outer loop fast integral sliding mode controller. At the same time, stable, accurate and fast control performance is guaranteed. Description of the drawings:

[0086] Figure 1 It is a principle diagram of the dual-loop position control method of a universal pneumatic flexible robotic arm based on digital twin of the present invention;

[0087] Figure 2 It is a design flow chart of the present invention;

[0088] Figure 3 It is a virtual body diagram of a universal pneumatic flexible robotic arm;

[0089] Figure 4 It is a fixed-point position tracking diagram of the universal pneumatic flexible robotic arm based on digital twin of the present invention;

[0090] Figure 5 is the finite time extended state observer z of the present invention 21 (t)Signal curve graph. Specific implementation method:

[0091] In order to make the purpose of the present invention more specific and the technical solution more clear, the present invention is described in detail with reference to the following drawings and specific embodiments.

[0092] Figure 1 Shown is a schematic diagram of the control method of the present invention, illustrating the dual-loop position control method of the universal pneumatic flexible robotic arm based on digital twins described in the present invention.

[0093] Combine the following Figure 1-5 The control method of the present invention is described in detail, but it is not intended to limit the present invention.

[0094] A dual-loop position control method for a universal pneumatic flexible robotic arm based on digital twins includes the following steps:

[0095] S100, according to the structural characteristics of the universal pneumatic flexible robotic arm entity, a virtual body structure of the universal pneumatic flexible robotic arm is established in the structural simulation software, and the virtual body structure is imported into the digital simulation software, and the angle sensor data of the entity is transmitted to the virtual body through the serial port, so that the position information and posture information of the end point of the virtual body can be obtained in real time, and finally the position and posture information of the end point of the virtual body is transmitted to the entity through the serial port;

[0096] S200, taking the gravity bias, Coriolis force and coupling introduced when the universal pneumatic flexible manipulator moves as disturbances, a second-order mathematical model of the universal pneumatic flexible manipulator is established;

[0097] S300, establishing a mathematical model of an outer ring of a universal pneumatic flexible robotic arm and a mathematical model of an inner ring of a universal pneumatic flexible robotic arm;

[0098] S400, the difference between the pose information of the end point of the virtual body and the pose information of the expected end point is used as the outer loop pose error, the outer loop pose error is inversely solved into an angle error through the Levenberg-Marquardt method and input into the outer loop, and according to the outer loop mathematical model of the universal pneumatic flexible manipulator, an outer loop fast integral sliding mode controller is designed, and its output is used as the expected value of the inner loop mathematical model of the universal pneumatic flexible manipulator;

[0099] S500, designing an inner loop finite time expansion state observer according to an inner loop mathematical model of the universal pneumatic flexible manipulator to estimate the disturbance of the universal pneumatic flexible manipulator;

[0100] S600, design an inner loop integral error controller according to the inner loop mathematical model of the universal pneumatic flexible manipulator and the estimated value of the inner loop finite time expansion state observer for the disturbance;

[0101] S700, Lyapunov method is used to check the convergence of the inner loop finite time extended state observer, the inner loop integral error controller and the outer loop fast integral sliding mode controller.

[0102] In this embodiment, S100, according to the structural characteristics of the universal pneumatic flexible robotic arm entity, a universal pneumatic flexible robotic arm virtual body structure is established in the structural simulation software, and the virtual body structure is imported into the digital simulation software, and the angle sensor data of the entity is transmitted to the virtual body through the serial port, so that the position information and posture information of the end point of the virtual body can be obtained in real time, and finally the posture information of the end point of the virtual body is transmitted to the entity through the serial port, specifically including:

[0103] Using the angle sensor data θ of each joint of the entity i (t), where i = 1, 2, ..., 6, so as to perform kinematic control in the virtual body and obtain the position information and posture information of the end point from the virtual body. 0 T6(t) is the pose information matrix, which is expressed as:

[0104]

[0105] Where: P x (t), P y (t), P z (t) represents the coordinates of the end point of the universal pneumatic flexible manipulator in the global coordinate system X, Y, and Z axes, respectively, x (t), n y (t), n z (t) represents the normal axis coordinate of the end point in the global coordinate system X, Y, and Z axes, respectively. x (t), o y (t), o z (t) represents the coordinates of the orientation axis of the end point in the global coordinate system X, Y, and Z axes, respectively. x (t), a y (t), a z (t) represent the coordinates of the approach axis of the end point under the global coordinate system X, Y, and Z axes, respectively. In this embodiment, S200, the gravity bias, Coriolis force and coupling introduced when the universal pneumatic flexible manipulator moves are considered as disturbances, and a second-order mathematical model of the universal pneumatic flexible manipulator is established, specifically including:

[0106] The second-order mathematical model of the universal pneumatic flexible manipulator is:

[0107]

[0108] Where:

[0109] ψ2(u(t),t)=B w (t)20 / πarctan(u(t)),Ω 1,1 =Ω2,3 =Ω 3,3 =diag{b c ,b c}

[0110]

[0111]

[0112] Where: x i1 (t) = θ i (t) is the angle of each joint of the universal pneumatic flexible robotic arm, is the angular velocity of each joint of the universal pneumatic flexible manipulator, ψ1(X1(t), t) is the state coupling matrix, ψ2(u(t), t) is the control coupling matrix, B w (t) is the coupling matrix, u i (t) is the output of the inner loop integral error controller, f i (t) is the gravitational bias and Coriolis force, ψ1(X1(t),t) and ψ2(u(t),t) are considered as perturbations W d (t), is the decoupling constant, r is the radius of the joint disk, L0 is the length of the connecting rod, J e represents the moment of inertia of each joint, P0 is the pre-inflation pressure, b is the length of the braided mesh fiber, n is the number of turns of the braided mesh fiber, ζ is the structural compensation parameter, and b i1 =(3P0ζr 2 L0) / (πn 2 J e ), X1(t)=[x 11 (t),x 21 (t),…,x 61 (t)] T is the angle matrix,

[0113] X2(t)=[x 12 (t),x 22 (t),…,x 62 (t)] T is the angular velocity matrix.

[0114] In this embodiment, S300, establishing a mathematical model of an outer ring of a universal pneumatic flexible mechanical arm and a mathematical model of an inner ring of a universal pneumatic flexible mechanical arm, specifically includes:

[0115] The mathematical model of the outer ring of the universal pneumatic flexible manipulator is:

[0116]

[0117] The mathematical model of the inner ring of the universal pneumatic flexible manipulator is:

[0118]

[0119] Where: V(t) = [v1(t), v2(t), …, v6(t)] T is the output of the outer loop fast integral sliding mode controller, G(t) = [g 12 (t),g 22 (t),…,g 62 (t)] T is the inner loop tracking error matrix, X3(t)=W di (t) is the expansion state of the disturbance, W d (t) = [w d1 (t),w d2 (t),…,w d6 (t)] T And W d (t) is continuous and bounded,

[0120] X3(t)=[x 13 (t),x 23 (t),…,x 63 (t)] T .

[0121] In this embodiment, S400, the difference between the pose information of the virtual end point and the pose information of the expected end point is used as the outer loop pose error, and the outer loop pose error is inversely solved into an angle error through the Levenberg-Marquardt method and input into the outer loop. According to the outer loop mathematical model of the universal pneumatic flexible manipulator, an outer loop fast integral sliding mode controller is designed, and its output is used as the expected value of the inner loop mathematical model of the universal pneumatic flexible manipulator, which specifically includes:

[0122] The pose information of the end point of the virtual body 0 T6(t) and the pose information of the expected end point 0 T 6des The difference between (t) and (t) is taken as the outer ring posture error, and the outer ring posture error is inversely solved into the outer ring angle error dθ by the Levenberg-Marquardt method. i (t) is input to the outer loop fast integral sliding mode controller, and the inverse solution process is as follows through the Levenberg-Marquardt method:

[0123] dθ(k)=Ψ(J T (θ(k))J(θ(k))+χ 2 (k)I6) -1 J T (θ(k))dD(k)

[0124] =Ω(k)

[0125] Where: k is the number of sampling points, dθ(k) = [dθ1(k), dθ2(k), …, dθ6(k)] T is the differential vector of the end point pose, Ω(k) is a nonlinear function used to save dθ(k) at the k sampling point, I6∈R 6×6 is the identity matrix, Ψ=diag{ψ1,ψ2,…,ψ6} is the convergence rate parameter matrix, J(θ(k)) is the Jacobian matrix, and χ(k) is a time-varying parameter;

[0126] The update rule of χ(k) is:

[0127]

[0128] The outer loop fast integral sliding mode controller is:

[0129]

[0130] The sliding surface is s i (t) is:

[0131]

[0132] Where: v i (t) is the outer loop control law, e i1 (t) is the observation error of the finite-time extended state observer, α and β are two constant parameters greater than zero, m1 and m2 are two constant parameters greater than zero, q1 and q2 are two odd numbers greater than zero and satisfy 0<q1 / q2<1, a∈(0,1) and b∈(0,1) are two exponential terms, λ c is a constant parameter greater than zero.

[0133] In this embodiment, S500, designing an inner loop finite time expansion state observer according to the inner loop mathematical model of the universal pneumatic flexible manipulator to estimate the disturbance of the universal pneumatic flexible manipulator, specifically includes:

[0134] The inner loop finite-time extended state observer is:

[0135]

[0136] Where: e i1 (t) = z i1 (t)-x i2 (t), e i2 (t) = z i2 (t)-x i3 (t)

[0137]

[0138] Where: sig α (x)=|x| α sgn(x) is the energy function, f1(e i1 (t)) and f2(e i1 (t)) is the designed nonlinear function, l1 and l2 are observer parameters, K1 is an adjustable parameter, z i1 (t) and z i2 (t) are x i2 (t) and x i3 The estimated value of (t), e i1 (t) and e i2 (t) are z i1 (t) and z i2 (t), a decoupling matrix is ​​given by U d (t)=B0u(t)=[U d1 (t),U d2 (t),…,U d6 (t)] T .

[0139] In this embodiment, S600, according to the inner loop mathematical model of the universal pneumatic flexible manipulator and the estimated value of the inner loop finite time extended state observer for the disturbance, designing the inner loop integral error controller specifically includes:

[0140] The inner loop integral error controller is:

[0141]

[0142] Where:

[0143] Where: Z(t)=[z 12 (t),z 22 (t),…,z 62 (t)] is the perturbation estimation matrix, a1 = 0.5, δ = 0.009, c i and d i are two positive parameters greater than zero, ε i (t) = v i (t)-z i1 (t) is the inner loop angular velocity error, U0(t) is the nonlinear error, and Z(t) is W d (t) is an estimated value.

[0144] In this embodiment, S700, using the Lyapunov method to perform convergence test on the inner loop finite time extended state observer, the inner loop integral error controller and the outer loop fast integral sliding mode controller, specifically includes:

[0145] The convergence test of the outer loop fast integral sliding mode controller is carried out to prove that the outer loop angle error dθ i (t) can converge to the sliding surface s i (t), the Lyapunov function equation is designed as follows:

[0146]

[0147] For the Lyapunov function equation V reach (t) Derivative:

[0148]

[0149] In the formula: Due to s i (t)tanh(λ c s i (t))>0, Established; Order:

[0150] -M=-s i (t)m1|dθ i (t)| a tanh(λ c dθ i (t))

[0151] =Γ(t)-m1|dθ i (t)| a dθ i (t)tanh(λ c dθ i (t))<0

[0152] Where:

[0153] According to the above analysis, we can get:

[0154]

[0155] If there exists a positive number m2 such that m2>max|ε i (t)|, then Established, that is, the outer ring angle error dθ i (t) can converge to the sliding surface s i (t) up;

[0156] Prove that the outer ring angle error dθ i (t) can be along the sliding surface s i (t) converges to zero, and the Lyapunov function equation is designed as follows:

[0157]

[0158] For the Lyapunov function equation Vsm (t) Derivative:

[0159]

[0160] based on And s i (t) = 0, we can get:

[0161]

[0162] Since α>0, β>0 and dθ i (t)tanh(λ c dθ i (t))>0, so Established, thus the outer ring angle error dθ can be obtained i (t) can be along the sliding surface s i (t) converges to zero, and the convergence test of the outer loop fast integral sliding mode controller is completed;

[0163] The convergence of the inner loop finite time extended state observer is tested to prove that the observation error e i1 (t) and e i2 (t) can converge to zero in a finite time. First, the observation error system of the inner loop finite time extended state observer is given as follows:

[0164]

[0165] The Lyapunov function equation is designed as follows:

[0166] V ESO (t)=∈ T (t)P∈(t)

[0167] Where: P is a positive definite symmetric matrix, the constructed error ∈ T (t) = [f1(e i1 (t)),e i2 (t)]; Derivative of the constructed error ∈(t):

[0168]

[0169] Where:

[0170] To complete the following proof, let:

[0171]

[0172] Where: M ≥ 0, and χ are two parameters;

[0173] For the Lyapunov function equation V ESO (t) Derivative:

[0174]

[0175] For the Lyapunov function equation V ESO (t)The following inequality holds:

[0176] Where: ||∈(t)||2 is the 2-norm of ∈(t), λ min {P} is the minimum value of the P eigenvalue;

[0177] make ξ is a sufficiently small positive constant, the Lyapunov function equation V ESO The derivative of (t) can be written as:

[0178]

[0179] The finite time convergence time is:

[0180]

[0181] Where t0 is the initial time;

[0182] because Then the observation error e i1 (t) and e i2 (t) can converge to zero, since the finite convergence time is t ESO , observation error e i1 (t) and e i2 (t) can converge to zero in finite time, and the finite time convergence test of the inner loop finite time extended state observer is completed;

[0183] The inner loop integral error controller is tested for convergence. To prove that the inner loop angular velocity error ε i (t) can converge to zero. First, the error system of the inner loop integral error controller is given as follows:

[0184]

[0185] Where: g i2 (t) = v i (t)-x i2 (t) is the construction tracking error of the inner loop system;

[0186] In the following proof, fal(ε i (t),a1,δ) is expressed as fal(ε i (t)), the Lyapunov function equation is designed as follows:

[0187]

[0188] For the Lyapunov function equation V IEC (t) Derivative:

[0189]

[0190]

[0191] make: And H(t) is bounded, is a positive parameter;

[0192] Lyapunov Function Equation V IEC The derivative of (t) can be written as:

[0193]

[0194] Can be expanded to:

[0195]

[0196] From the above formula, we can get So if there is a small positive number and a large positive number ε0 satisfies:

[0197]

[0198] Can make Established;

[0199] Where: ε i (t)∈(-ε0,ε0);

[0200] That is, when the parameter c i When it is big enough, Established, that is, the inner ring angular velocity error ε i (t) can converge to zero, and the inner loop integral error controller completes the convergence test. Therefore, the dual-loop position control method of the universal pneumatic flexible manipulator based on digital twins of the present invention is convergent and effective.

[0201] Example:

[0202] In order to verify the effectiveness of the dual-loop position control method of the universal pneumatic flexible robotic arm based on digital twin proposed in the present invention, an experimental verification is given to illustrate that the dual closed-loop position control method of the universal pneumatic flexible robotic arm based on digital twin is effective, as follows:

[0203] The initial deflection angle of all joints of the universal pneumatic flexible robotic arm entity and virtual body is 0°, that is, the universal pneumatic flexible robotic arm entity and virtual body are located at the initial position coordinates (0m, 0m, 0.865m). The entity and virtual body communicate bidirectionally through serial port transmission. The entity transmits the data of the six angle sensors to the virtual body through the serial port. The kinematic control method is used in the virtual body to input the data of the six angle sensors into the virtual body. The virtual body outputs the position and posture information of the end point, and finally transmits the position and posture information of the end point of the virtual body to the entity through the serial port. The universal pneumatic flexible robotic arm entity is composed of connecting rods, universal joints, joint discs, pneumatic artificial muscle drivers, angle sensors, angular velocity sensors, and is equipped with corresponding hardware, industrial computers, and air sources. The virtual body runs in a dedicated server, and the virtual body runs in the digital simulation software therein.

[0204] The control objectives are set as:

[0205] The desired position coordinates are set to (-0.168m, 0.166m, 0.824m). The universal pneumatic flexible robotic arm based on digital twin needs to move quickly and accurately from the initial position coordinates (0m, 0m, 0.865m) to the desired position coordinates.

[0206] When the desired position is given, the position curve output by the universal pneumatic flexible robotic arm based on digital twin is as follows: Figure 4 As shown. The solid lines represent the expected position inputs in the three coordinate directions of -0.168m, 0.166m, and 0.824m, and the dotted lines represent the actual position outputs at the expected positions of -0.168m, 0.166m, and 0.824m, respectively. Figure 4 It can be seen that under the input of the desired position in the three coordinate directions, the universal pneumatic flexible robotic arm based on digital twin can quickly and accurately track the desired position.

[0207] When the expected position signal input is -0.168m, 0.166m, and 0.824m, the state estimation signal of the finite time extended state observer is as follows: Figure 5 As shown. 21 (t) represents the deflection angular velocity x of the second joint 22 The estimated curve of (t), e 21 (t) is z 21 (t) Deflection angular velocity x of the second joint 22 (t) is the observation error curve. Figure 5 It can be seen that the finite time extended state observer can quickly output accurate and stable estimates of the joint deflection angular velocity.

[0208] According to the disclosure and teaching of the above description, those skilled in the art can also change and modify the above implementation. Therefore, the present invention is not limited to the above specific implementation, and any obvious improvement, replacement or modification made by those skilled in the art on the basis of the present invention belongs to the protection scope of the present invention.

Claims

1. A dual-loop position control method for a universal pneumatic flexible robotic arm based on digital twins, characterized in that: The following steps are involved: Step 1: According to the structural characteristics of the universal pneumatic flexible robotic arm entity, a virtual body structure of the universal pneumatic flexible robotic arm is established in the structural simulation software, and the virtual body structure is imported into the digital simulation software. The angle sensor data of the entity is transmitted to the virtual body through the serial port, and the position information and posture information of the end point of the virtual body can be obtained in real time. Finally, the posture information of the end point of the virtual body is transmitted to the entity through the serial port; Step 2: Consider the gravity bias, Coriolis force and coupling introduced when the universal pneumatic flexible manipulator moves as disturbances, and establish a second-order mathematical model of the universal pneumatic flexible manipulator; Step 3: Establish a mathematical model of the outer ring of the universal pneumatic flexible manipulator and a mathematical model of the inner ring of the universal pneumatic flexible manipulator; Step 4: The difference between the pose information of the end point of the virtual body and the pose information of the expected end point is taken as the outer loop pose error. The outer loop pose error is inversely solved into an angle error through the Levenberg-Marquardt method and input into the outer loop. According to the outer loop mathematical model of the universal pneumatic flexible manipulator, the outer loop fast integral sliding mode controller is designed, and its output is taken as the expected value of the inner loop mathematical model of the universal pneumatic flexible manipulator. Step 5: According to the mathematical model of the inner loop of the universal pneumatic flexible manipulator, an inner loop finite time expansion state observer is designed to estimate the disturbance of the universal pneumatic flexible manipulator; Step 6: Design an inner loop integral error controller based on the inner loop mathematical model of the universal pneumatic flexible manipulator and the estimated value of the inner loop finite time extended state observer for the disturbance; Step 7: Use the Lyapunov method to check the convergence of the inner loop finite time extended state observer, the inner loop integral error controller and the outer loop fast integral sliding mode controller.

2. The dual-loop position control method of a universal pneumatic flexible manipulator based on digital twin according to claim 1 is characterized in that: The step 1 specifically includes: using the angle sensor data θ of each joint of the entity i (t), where i = 1, 2,, 6, so as to perform kinematic control in the virtual body and obtain the position information and posture information of the end point from the virtual body. 0 T6(t) is the pose information matrix, which is expressed as: Where: P x (t), P y (t), P z (t) represents the coordinates of the end point of the universal pneumatic flexible manipulator in the global coordinate system X, Y, and Z axes, respectively, x (t), n y (t), n z (t) represents the normal axis coordinate of the end point in the global coordinate system X, Y, and Z axes, respectively. x (t), o y (t), o z (t) represents the coordinates of the orientation axis of the end point in the global coordinate system X, Y, and Z axes, respectively. x (t), a y (t), a z (t) represents the coordinates of the approach axis of the end point in the global coordinate system X, Y, and Z axes respectively.

3. The dual-loop position control method of a universal pneumatic flexible manipulator based on digital twin according to claim 2 is characterized in that: The step 2 specifically includes: The second-order mathematical model of the universal pneumatic flexible manipulator is: Where: ψ2(u(t),t)=B w (t)20 / parctan(u(t)),Ω 1,1 =Oh 2,3 =Oh 3,3 =diag{b c ,b c } Where: x i1 (t) = θ i (t) is the angle of each joint of the universal pneumatic flexible robotic arm, is the angular velocity of each joint of the universal pneumatic flexible manipulator, ψ1(X1(t), t) is the state coupling matrix, ψ2(u(t), t) is the control coupling matrix, B w (t) is the coupling matrix, u i (t) is the output of the inner loop integral error controller, f i (t) is the gravitational bias and Coriolis force, ψ1(X1(t),t) and ψ2(u(t),t) are considered as perturbations W d (t), is the decoupling constant, r is the radius of the joint disk, L0 is the length of the connecting rod, J e represents the moment of inertia of each joint, P0 is the pre-inflation pressure, b is the length of the braided mesh fiber, n is the number of turns of the braided mesh fiber, ζ is the structural compensation parameter, b i1 =(3P0ζr 2 L0) / (πn 2 J e ), X1(t)=[x 11 (t),x 21 (t),…,x 61 (t)] T is the angle matrix, X2(t)=[x 12 (t),x 22 (t),…,x 62 (t)] T is the angular velocity matrix.

4. The dual-loop position control method for a universal pneumatic flexible manipulator based on digital twin according to claim 3 is characterized in that: The step three specifically includes: The mathematical model of the outer ring of the universal pneumatic flexible manipulator is: The mathematical model of the inner ring of the universal pneumatic flexible manipulator is: Where: V(t) = [v1(t), v2(t),, v6(t)] T is the output of the outer loop fast integral sliding mode controller, G(t) = [g 12 (t),g 22 (t),…,g 62 (t)] T is the inner loop tracking error matrix, X3(t)=W di (t) is the expansion state of the disturbance, W d (t) = [w d1 (t),w d2 (t),…,w d6 (t)] T And W d (t) is continuous and bounded, X3(t) = [x 13 (t),x 23 (t),…,x 63 (t)] T .

5. The dual-loop position control method of a universal pneumatic flexible manipulator based on digital twin according to claim 4 is characterized in that: In the step 4, the difference between the pose information of the virtual body end point and the pose information of the expected end point is used as the outer loop pose error, and the outer loop pose error is inversely solved into an angle error by the Levenberg-Marquardt method and input into the outer loop, specifically including: The pose information of the end point of the virtual body 0 T6(t) and the pose information of the expected end point 0 T 6des The difference between (t) and (t) is taken as the outer ring posture error, and the outer ring posture error is inversely solved into the outer ring angle error dθ by the Levenberg-Marquardt method. i (t) is input to the outer loop fast integral sliding mode controller, and the inverse solution process is as follows through the Levenberg-Marquardt method: dθ(k)=Ψ(J T (θ(k))J(θ(k))+χ 2 (k)I6) -1 J T (θ(k))dD(k) =Ω(k) Where: k is the number of sampling points, dθ(k) = [dθ1(k), dθ2(k),, dθ6(k)] T is the differential vector of the end point pose, Ω(k) is a nonlinear function used to save dθ(k) at the k sampling point, I6∈R 6×6 is the identity matrix, Ψ=diag{ψ1,ψ2,,ψ6} is the convergence rate parameter matrix, J(θ(k)) is the Jacobian matrix, and χ(k) is a time-varying parameter; The update rule of χ(k) is: According to the outer ring mathematical model of the universal pneumatic flexible manipulator, an outer ring fast integral sliding mode controller is designed, and its output is used as the expected value of the inner ring mathematical model of the universal pneumatic flexible manipulator, which specifically includes: The outer loop fast integral sliding mode controller is: The sliding surface is s i (t) is: Where: v i (t) is the outer loop control law, e i1 (t) is the observation error of the finite-time extended state observer, α and β are two constant parameters greater than zero, m1 and m2 are two constant parameters greater than zero, q1 and q2 are two odd numbers greater than zero and satisfy 0<q1 / q2<1, a∈(0,1) and b∈(0,1) are two exponential terms, λ c is a constant parameter greater than zero.

6. The dual-loop position control method of a universal pneumatic flexible manipulator based on digital twin according to claim 5 is characterized in that: The step five specifically includes: The inner loop finite-time extended state observer is: where: e i1 (t) = z i1 (t) - x i2 (t), e i2 (t) = z i2 (t) - x i3 (t) Where: sig α (x)=|x| α sgn(x) is the energy function, f1(e i1 (t)) and f2(e i1 (t)) is the designed nonlinear function, l1 and l2 are observer parameters, K1 is an adjustable parameter, z i1 (t) and z i2 (t) are x i2 (t) and x i3 The estimated value of (t), e i1 (t) and e i2 (t) are z i1 (t) and z i2 (t), a decoupling matrix is ​​given by U d (t)=B0u(t)=[U d1 (t),U d2 (t),…,U d6 (t)] T .

7. The dual-loop position control method of a universal pneumatic flexible manipulator based on digital twin according to claim 6 is characterized in that: The step six specifically includes: The inner loop integral error controller is: Where: Where: Z(t)=[z 12 (t),z 22 (t),,z 62 (t)] is the perturbation estimation matrix, a1 = 0.5, δ = 0.009, c i and d i are two positive parameters greater than zero, ε i (t) = v i (t)-z i1 (t) is the inner loop angular velocity error, U0(t) is the nonlinear error, and Z(t) is W d (t) is an estimated value.

8. The dual-loop position control method of a universal pneumatic flexible manipulator based on digital twin according to claim 7 is characterized in that: The step seven specifically includes: The convergence of the outer loop fast integral sliding mode controller is tested. The first step is to prove that the outer loop angle error dθ i (t) can converge to the sliding surface s i (t), the Lyapunov function equation is designed as follows: For the Lyapunov function equation V reach (t) Derivative: If there exists a positive number m2 such that m2>max|ε i (t)|, then Established, that is, the outer ring angle error dθ i (t) can converge to the sliding surface s i (t) up; The second step is to prove the outer ring angle error dθ i (t) can be along the sliding surface s i (t) converges to zero, and the Lyapunov function equation is designed as follows: For the Lyapunov function equation V sm (t) Derivative: Since α>0, β>0 and dθ i (t)tanh(λ c dθ i (t))>0, so Established, thus the outer ring angle error dθ can be obtained i (t) can be along the sliding surface s i (t) converges to zero, and the convergence test of the outer loop fast integral sliding mode controller is completed; The convergence of the inner loop finite time extended state observer is tested to prove that the observation error e i1 (t) and e i2 (t) can converge to zero in a finite time. First, the observation error system of the inner loop finite time extended state observer is given as follows: The Lyapunov function equation is designed as follows: V ESO (t)= T (t)P(t) Where: P is a positive definite symmetric matrix, the constructed error T (t) = [f1(e i1 (t)),e i2 (t)]; For the Lyapunov function equation V ESO (t) Derivative: make ξ is a sufficiently small positive constant, the Lyapunov function equation V ESO The derivative of (t) can be written as: The finite time convergence time is: Where t0 is the initial time; because And it satisfies the finite time convergence rule, so the observation error e i1 (t) and e i2 (t) can converge to zero in finite time, and the finite time convergence test of the inner loop finite time extended state observer is completed; The inner loop integral error controller is tested for convergence. To prove that the inner loop angular velocity error ε i (t) can converge to zero. First, the error system of the inner loop integral error controller is given as follows: Where: g i2 (t) = v i (t)-x i2 (t) is the construction tracking error of the inner loop system; In the following proof, fal(ε i (t),a1,δ) is expressed as fal(ε i (t)), the Lyapunov function equation is designed as follows: For the Lyapunov function equation V IEC (t) Derivative: make: And H(t) is bounded, is a positive parameter; it can be concluded that So if there is a small positive number and a large positive number ε0 satisfies: Can make holds; that is, when the parameter c i When it is big enough, Established, that is, the inner ring angular velocity error ε i (t) can converge to zero, and the convergence test of the inner loop integral error controller is completed.

Citation Information

Patent Citations

  • Unmanned aerial vehicle active anti-interference flight control method for reconnaissance task

    CN115629620A

  • Finite time anti-interference control method for universal pneumatic flexible mechanical arm

    CN116276962A

  • Mechanical arm trajectory tracking control method based on time-varying sliding mode

    CN116968019A

  • Finite time anti-interference control method for 3-PSS pneumatic high-speed parallel robot

    CN118106978A

  • Sliding mode controller position control device

    US20050222695A1

Cited By

  • Hydraulic support assembly error self-adaptive compensation method based on laser tracking and positioning

    CN122331627A