Multi-connecting-rod flexible mechanical arm singular perturbation decomposition and dual-mode compound control method

By using singular perturbation decomposition and dual-mode composite control methods, the dynamic model of the flexible robotic arm is decomposed into fast and slow variable subsystems. Adaptive sliding mode and fuzzy controllers are designed to solve the problem of balancing continuous vibration and dynamic characteristics of the flexible robotic arm, achieving higher control accuracy and stability.

CN121625110APending Publication Date: 2026-03-10LANZHOU UNIVERSITY OF TECHNOLOGY
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202511156044.8
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2025-08-18
Publication Date
2026-03-10

AI Technical Summary

Technical Problem

Flexible robotic arms are prone to continuous vibration, and traditional control methods struggle to balance fast and slow dynamic characteristics.

Method used

The dynamic model of the flexible robotic arm is decomposed into fast-variable and slow-variable subsystems using the singular perturbation decomposition method. An adaptive sliding mode variable structure controller and a fuzzy controller are designed to perform stability analysis and control on the fast and slow-variable subsystems, respectively.

Benefits of technology

It significantly reduced the elastic vibration amplitude of the flexible robotic arm, improved the system response speed and control accuracy, and enhanced the stability and control precision of the multi-degree-of-freedom flexible robotic arm.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN121625110A_ABST
    Figure CN121625110A_ABST
Patent Text Reader

Abstract

The invention provides a singular perturbation decomposition and dual-mode compound control method for a multi-connecting-rod flexible mechanical arm, and relates to the technical field of robots. The method comprises the following steps: establishing a dynamic model of the flexible mechanical arm; singular perturbation decomposition is adopted, and the flexible mechanical arm dynamic model is decomposed into a fast-varying subsystem and a slow-varying subsystem; designing a self-adaptive sliding mode variable structure controller for the quick change subsystem; carrying out stability analysis on the adaptive sliding mode variable structure controller; designing a fuzzy controller for the slow-varying subsystem; performing stability analysis on the fuzzy controller; and simulation verification is conducted on the flexible mechanical arm, comparison verification is conducted on multiple control algorithms of the flexible mechanical arm from the three angles of the joint position, the joint output torque and the tail end position error, and the stability of the flexible mechanical arm is verified. According to the method, the dynamic model of the flexible mechanical arm can be decomposed into the fast-varying subsystem and the slow-varying subsystem, and the control precision and stability of the multi-degree-of-freedom flexible mechanical arm are effectively improved.
Need to check novelty before this filing date? Find Prior Art

Description

TECHNICAL FIELD

[0001] The present application relates to the technical field of robots, and in particular to a singular perturbation decomposition and dual-mode composite control method for a multi-link flexible robot arm. BACKGROUND

[0002] In the related art, flexible robot arms gradually replace traditional rigid robot arms due to their small mass, low stiffness, high load-to-weight ratio, low energy consumption, and fast response, but the problem that the flexible robot arm is prone to sustained vibration due to its lightweight and large elastic arm rod and small damping, and that traditional control cannot simultaneously consider fast and slow dynamic characteristics is not considered.

[0003] The information disclosed in the background section of this application is only intended to deepen the understanding of the general background of the application and should not be regarded as acknowledging or implying in any form that this information constitutes prior art known to those skilled in the art. SUMMARY

[0004] The present application provides a singular perturbation decomposition and dual-mode composite control method for a multi-link flexible robot arm, which can solve the technical problem that the flexible robot arm is prone to sustained vibration and that traditional control cannot simultaneously consider fast and slow dynamic characteristics.

[0005] According to a first aspect of the present application, a singular perturbation decomposition and dual-mode composite control method for a multi-link flexible robot arm is provided, comprising:

[0006] establishing a flexible robot arm dynamics model;

[0007] using singular perturbation decomposition to decompose the flexible robot arm dynamics model into a fast varying subsystem and a slow varying subsystem;

[0008] designing an adaptive sliding mode variable structure controller for the fast varying subsystem;

[0009] performing stability analysis on the adaptive sliding mode variable structure controller;

[0010] designing a fuzzy controller for the slow varying subsystem;

[0011] performing stability analysis on the fuzzy controller;

[0012] performing simulation verification on the flexible robot arm, and comparing and verifying multiple control algorithms for the flexible robot arm from the angles of joint position, joint output torque, and end position error to verify their stability.

[0013] Further, the flexible robot arm dynamics model is established, comprising:

[0014] assigning coordinate systems to multiple flexible robot arms;

[0015] according to the formula

[0016]

[0017]

[0018]

[0019]

[0020]

[0021] Determine the homogeneous transformation matrix between coordinate system {i} to coordinate system {i-1} where i = 0, 1, 2, , is the kth order modal shape of the ith flexible manipulator, is the modal coordinate of the kth order modal shape of the ith flexible manipulator, r is the order of the selected Ritz basis function of the ith flexible manipulator;

[0022] According to the formula

[0023]

[0024]

[0025]

[0026]

[0027]

[0028]

[0029]

[0030]

[0031] Determine the elastic potential energy of the ith flexible manipulator where, is the kinetic energy of the mass point with mass on the ith flexible manipulator, is the kinetic energy of the lumped mass on the ith flexible manipulator, is the total kinetic energy of the ith flexible manipulator and mass, g is the gravitational constant, is the expression of the center of mass vector of the ith flexible manipulator when it is not deformed in the inertial reference coordinate system {0}, is the expression of the center of mass vector of the ith flexible manipulator when it is not deformed in the follow-up coordinate system {i}, Young's modulus of the i-th flexible manipulator, Moment of inertia of the i-th flexible manipulator;

[0032] According to the formula

[0033]

[0034] Determine the dynamics equation of the flexible manipulator, wherein the Lagrange function is defined as And .

[0035] Further, singular perturbation decomposition is adopted to decompose the flexible manipulator dynamics model into fast and slow subsystems, including:

[0036] According to the formula

[0037]

[0038]

[0039] Determine the slow state of the flexible manipulator dynamics model And the fast state ;

[0040] According to the formula

[0041]

[0042] Determine the singular perturbation model, wherein , , , , , , , , .

[0043] Further, an adaptive sliding mode variable structure controller is designed for the fast subsystem, including:

[0044] According to the formula

[0045]

[0046]

[0047] Determine the fast subsystem dynamics under the sliding surface S and the vibration disturbance input, wherein Λ>0;

[0048] According to the formula

[0049]

[0050]

[0051] determining an optimization objective, wherein, ;

[0052] according to the formula

[0053]

[0054] determining the input of the adaptive sliding mode variable structure controller , wherein, is a sliding mode gain matrix, is an adaptive parameter matrix;

[0055] according to the formula

[0056]

[0057]

[0058] determining an update law adjustment, wherein, is an adaptive gain, is a basis function vector, .

[0059] Further, the adaptive sliding mode variable structure controller is analyzed for stability, comprising:

[0060] according to the formula

[0061]

[0062] constructing a Lyapunov function, wherein, is a parameter error matrix;

[0063] deriving the Lyapunov function, when , then determining that the adaptive sliding mode variable structure controller is stable, wherein, α>0, β>0.

[0064] Further, a fuzzy controller is designed for the slow-varying subsystem, comprising:

[0065] mapping the input variables and the output variables to , determining the value range of the input variables and the output variables, wherein the input variables are the flexible manipulator position error value and the flexible manipulator position error rate of change, the output variables are the control torque, NB is negative large, NM is negative medium, NS is negative small, Z0 is zero, PS is positive small, PM is positive medium, and PB is positive large;

[0066] mapping the input variables and the output variables to the fuzzy domain to determine the quantization factor and the proportion factor;

[0067] according to the formula

[0068]

[0069] determining the deblurring method, wherein, is a flexible manipulator position error value, is a flexible manipulator position error rate of change, is a control torque.

[0070] Further, the stability of the fuzzy controller is analyzed, including:

[0071] Assuming that there is an ideal control law;

[0072] According to the formula

[0073]

[0074] determining the ideal control law wherein, contains inertia, Coriolis force and gravity terms, > 0, > 0;

[0075] According to the formula

[0076]

[0077] determining the actual error;

[0078] According to the formula

[0079]

[0080] constructing a Lyapunov function;

[0081] deriving the Lyapunov function, when , the fuzzy controller is determined to be stable.

[0082] According to a second aspect of the present application, a multi-link flexible manipulator singular perturbation decomposition and dual-mode composite control device is provided, comprising: a processor; a memory for storing processor executable instructions; wherein the processor is configured to call the instructions stored in the memory to execute the multi-link flexible manipulator singular perturbation decomposition and dual-mode composite control method.

[0083] According to a third aspect of the present application, a computer readable storage medium is provided, having computer program instructions stored thereon, the computer program instructions being executed by a processor to implement the multi-link flexible manipulator singular perturbation decomposition and dual-mode composite control method.

[0084] Technical effects: According to the present application, the flexible mechanical arm dynamics model is decomposed into fast and slow subsystems, which can reduce the coupling, significantly reduce the elastic vibration amplitude of the flexible mechanical arm, reduce the position error of the flexible mechanical arm, improve the system response speed and the smoothness of the output torque, thereby effectively improving the control accuracy and stability of the multi-degree-of-freedom flexible mechanical arm. When establishing the dynamics model of the flexible mechanical arm, the AMM and the Lagrange method can be used to establish the dynamics model of the flexible mechanical arm, which reduces the modeling difficulty and simplifies the complexity of the adaptive sliding mode variable structure controller and the fuzzy controller design. When decomposed into fast and slow subsystems, the flexible mechanical arm dynamics model can be decomposed into fast and slow subsystems through singular perturbation decomposition, which can reduce the mutual coupling of fast and slow dynamics and reduce mutual interference, so that the controller of each subsystem can be designed according to the control target of the system, thereby improving the control accuracy of the multi-degree-of-freedom flexible mechanical arm and effectively suppressing the flexible vibration. When designing the adaptive sliding mode variable structure controller, the adaptive sliding mode variable structure controller can be designed for the fast subsystem, the adaptive sliding mode control can suppress vibration, improve trajectory tracking accuracy, and the optimal gain can be designed to minimize the interference transmission effect. When designing the fuzzy controller, the fuzzy controller can realize intelligent adjustment of the slow subsystem of the flexible mechanical arm, distinguish vibration error conditions through fuzzy rules, achieve the balance of fast response and suppression of overshoot, and the barycentric method can smooth the output control signal and reduce the mutation.

[0085] It should be understood that the above general description and the following detailed description are only exemplary and explanatory, but not limiting the present application. Other features and aspects of the present application will be more apparent from the following detailed description of exemplary embodiments with reference to the accompanying drawings. BRIEF DESCRIPTION OF DRAWINGS

[0086] In order to more clearly illustrate the technical solutions in the embodiments of the present application or the prior art, the drawings needed in the embodiment or prior art description will be briefly introduced as follows. Obviously, the drawings in the following description are only some embodiments of the present application, and those skilled in the art can also obtain other embodiments from these drawings without creative labor;

[0087] Figure 1 Exemplarily show the flowchart of the singular perturbation decomposition and double-mode compound control method of the multi-link flexible mechanical arm according to the embodiment of the present application;

[0088] Figure 2 Exemplarily show the control structure diagram according to the embodiment of the present application;

[0089] Figure 3 Exemplarily show the fuzzy control rule diagram according to the embodiment of the present application;

[0090] Figure 4 A parameter diagram of a flexible arm system according to an embodiment of the present invention is shown as an example. Detailed Implementation

[0091] To make the objectives, technical solutions, and advantages of the embodiments of the present invention clearer, the technical solutions of the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings. Obviously, the described embodiments are only some embodiments of the present invention, and not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative effort are within the scope of protection of the present invention.

[0092] The technical solution of the present invention will be described in detail below with reference to specific embodiments. These specific embodiments can be combined with each other, and the same or similar concepts or processes may not be described again in some embodiments.

[0093] Figure 1 An exemplary flowchart illustrates a singular perturbation decomposition and dual-mode composite control method for a multi-link flexible robotic arm according to an embodiment of the present invention, the method comprising:

[0094] Step S1: Establish a dynamic model of the flexible robotic arm;

[0095] Step S2: Using singular perturbation decomposition, the dynamic model of the flexible robotic arm is decomposed into a fast-changing subsystem and a slow-changing subsystem;

[0096] Step S3: Design an adaptive sliding mode variable structure controller for the fast-changing subsystem;

[0097] Step S4: Perform stability analysis on the adaptive sliding mode variable structure controller;

[0098] Step S5: Design a fuzzy controller for the slow-changing subsystem;

[0099] Step S6: Perform stability analysis on the fuzzy controller;

[0100] Step S7: Simulation verification of the flexible robotic arm is performed. Multiple control algorithms of the flexible robotic arm are compared and verified from three aspects: joint position, joint output torque, and end-effector position error, to verify its stability.

[0101] The singular perturbation decomposition and dual-mode composite control method for multi-link flexible manipulators according to embodiments of the present invention decomposes the dynamic model of the flexible manipulator into a fast-variable subsystem and a slow-variable subsystem, which can reduce coupling, significantly reduce the elastic vibration amplitude of the flexible manipulator, reduce the position error of the flexible manipulator, and improve the smoothness of the system response speed and output torque, thereby effectively improving the control accuracy and stability of the multi-degree-of-freedom flexible manipulator.

[0102] According to one embodiment of the present invention, in step S1, a coordinate system is assigned, the mode shape is determined, and the dynamics of the flexible manipulator are described by determining the kinetic and potential energy of the system, thereby establishing a dynamic model of the flexible manipulator.

[0103] According to an embodiment of the present invention, a dynamic model of a flexible robotic arm is established, including: assigning coordinate systems to multiple flexible robotic arms; and determining the homogeneous transformation matrix between coordinate system {𝑖} and coordinate system {𝑖-1} according to formulas (1), (2), (3), (4), and (5). ,

[0104] (1),

[0105] (2),

[0106] (3),

[0107] (4),

[0108] (5),

[0109] Where, 𝑖=0, 1, 2, , Let k be the k-th mode shape of the i-th flexible robotic arm. Let be the modal coordinates of the k-th mode shape of the i-th flexible manipulator, and let be the order of the Ritz basis function chosen by the i-th flexible manipulator.

[0110] The elastic potential energy of the i-th flexible robotic arm is determined according to formulas (6), (7), (8), (9), (10), (11), (12) and (13). ,

[0111] (6),

[0112] (7),

[0113] (8),

[0114] (9),

[0115] (10)

[0116] (11),

[0117] (12),

[0118] (13)

[0119] in, The mass of the i-th flexible robotic arm is The kinetic energy of the particle. Let be the kinetic energy of the concentrated mass block on the i-th flexible robotic arm. Let be the total kinetic energy of the i-th flexible robotic arm and its mass, and let be the gravitational constant. Let be the expression for the centroid vector of the i-th flexible robotic arm in the inertial reference coordinate system {0} when it is undeformed. Let be the expression for the centroid vector of the i-th flexible robotic arm in the follower coordinate system {x} when it is undeformed. Let i be the Young's modulus of the i-th flexible robotic arm. Let be the moment of inertia of the section of the i-th flexible robotic arm;

[0120] The dynamic equation of the flexible robotic arm is determined according to formula (14).

[0121] (14)

[0122] The Lagrange function is defined as follows: and .

[0123] According to one embodiment of the present invention, a coordinate system (e.g., coordinate systems {a} and {b-1}) is assigned to each flexible manipulator, and the pose relationship between coordinate systems {a} and {b-1} is described by a homogeneous transformation matrix. The elastic deformation of the flexible manipulator is described by mode shapes and modal coordinates. Equations (6) to (13) describe the elastic potential energy and kinetic energy of the flexible manipulator. By defining the Lagrangian function, the dynamic equation of the flexible manipulator is obtained.

[0124] In this way, a dynamic model of a flexible robotic arm can be established using AMM and the Lagrange method, reducing the difficulty of modeling and simplifying the design complexity of adaptive sliding mode variable structure controllers and fuzzy controllers.

[0125] According to an embodiment of the present invention, in step S2, singular perturbation decomposition is used to decompose the dynamic model of the flexible robotic arm into a fast-changing subsystem and a slow-changing subsystem.

[0126] Figure 2 A schematic diagram of the control structure according to an embodiment of the present invention is shown as an example.

[0127] According to an embodiment of the present invention, singular perturbation decomposition is used to decompose the dynamic model of the flexible manipulator into a fast-changing subsystem and a slow-changing subsystem, including: determining the slow-changing state of the dynamic model of the flexible manipulator according to formulas (15) and (16). and rapidly changing states

[0128] (15)

[0129] (16)

[0130] The singular perturbation model is determined according to formula (17).

[0131] (17)

[0132] in, , , , , , , , , .

[0133] According to one embodiment of the present invention, a small parameter is introduced. The slowly varying state of the dynamic model of the flexible robotic arm is defined according to formulas (15) and (16). and rapidly changing states This is transformed into a singular perturbation model:

[0134] The standard form of singular perturbations is obtained by organizing and deriving: Thus, it can be simplified to the singular perturbation model of formula (17).

[0135] In this way, the dynamic model of the flexible manipulator can be decomposed into fast-changing subsystems and slow-changing subsystems through singular perturbation decomposition. This reduces the coupling effect between fast-changing and slow-changing dynamics, reduces mutual interference, and enables the controllers of each subsystem to be designed according to the control objectives of the system. This improves the control accuracy of the multi-degree-of-freedom flexible manipulator and effectively suppresses flexible vibration.

[0136] According to an embodiment of the present invention, in step S3, an adaptive sliding mode variable structure controller is designed for the fast-changing subsystem.

[0137] According to one embodiment of the present invention, an adaptive sliding mode variable structure controller is designed for the fast-changing subsystem, comprising: determining the sliding surface S and the dynamics of the fast-changing subsystem under vibration disturbance input according to formulas (18) and (19).

[0138] (18)

[0139] (19)

[0140] Where Λ>0;

[0141] The optimization objective is determined based on formulas (20) and (21).

[0142] (20)

[0143] (twenty one),

[0144] in, ;

[0145] The input of the adaptive sliding mode variable structure controller is determined according to formula (23). ,

[0146] (twenty three),

[0147] in, Here is the sliding mode gain matrix. For adaptive parameter matrix;

[0148] The update law adjustment is determined according to formulas (24) and (25).

[0149] (twenty four),

[0150] (25)

[0151] in, For adaptive gain, For the basis function vector, .

[0152] According to one embodiment of the present invention, the sliding surface can be defined according to formula (18), with the goal of optimizing the design through L2 gain. This makes it possible to interfere with To the sliding surface Minimize the gain, i.e., reduce the impact of vibration disturbance. The dynamics of the fast-changing subsystem under vibration disturbance input can be written as formula (19). The optimization objective is to minimize... It satisfies formula (20), and the optimal solution is obtained by solving the Riccati equation (21). . The adaptive gain is used to control the speed of parameter adjustment. The basis function vectors are used to approximate the unknown nonlinear terms in the system. Based on the elastic vibration characteristics of the flexible robotic arm, the basis functions are chosen as elastic modal variables. Polynomial combinations.

[0153] In this way, an adaptive sliding mode variable structure controller can be designed for the fast-changing subsystem. The adaptive sliding mode control can suppress vibration, improve trajectory tracking accuracy, and design the optimal gain to minimize the interference transmission effect.

[0154] According to one embodiment of the present invention, in step S4, a stability analysis is performed on the adaptive sliding mode variable structure controller.

[0155] According to one embodiment of the present invention, stability analysis of the adaptive sliding mode variable structure controller includes: constructing a Lyapunov function according to formula (26).

[0156] (26)

[0157] in, This is the parameter error matrix;

[0158] Differentiating the Lyapunov function with respect to the time factor, when When α > 0 and β > 0, the adaptive sliding mode variable structure controller is determined to be stable.

[0159] According to an embodiment of the present invention, for the stability analysis of a fast-changing subsystem, the Lyapunov function is first constructed using formula (26), and the derivative of formula (26) is obtained as follows: , After simplification, we get: ,because ,and Bounded, and can satisfy: If so, the stability of the adaptive sliding mode variable structure controller is determined.

[0160] According to one embodiment of the present invention, in step S5, a fuzzy controller is designed for the slowly varying subsystem.

[0161] According to an embodiment of the present invention, designing a fuzzy controller for the slowly varying subsystem includes: mapping input variables and output variables to... Determine the range of values ​​for the input and output variables, where the input variables are the position error value and the rate of change of the position error of the flexible robotic arm, and the output variable is the control torque, where NB is negative large, NM is negative medium, NS is negative small, Z0 is zero, PS is positive small, PM is positive medium, and PB is positive large; map the input and output variables to the fuzzy domain, and determine the quantization factor and the scaling factor; determine the defuzzification method according to formula (27).

[0162] (27)

[0163] in, This represents the positional error value of the flexible robotic arm. The rate of change of position error of the flexible robotic arm. To control the torque.

[0164] According to one embodiment of the present invention, the precise quantity is first fuzzified, and a seven-segment fuzzy domain is adopted in the design of the fuzzy controller to map the input and output variables to... The error range is determined to be... The unit is rad, and the error change rate ranges from [value missing]. The unit is rad / s; control torque The unit is Nm. Mapping the input and output variables to the fuzzy domain [-3, 3], it is easy to see that the quantization factor is... , , scaling factor , Figure 3 An illustrative diagram of fuzzy control rules according to an embodiment of the present invention is shown. The fuzzy controller has two input variables and one output variable, each of which is divided into seven levels, thus requiring a total of 49 fuzzy control rules to be constructed. The goal of the control strategy is to reduce vibration error; that is, when the vibration error is large, the main goal is to quickly reduce the error, while when the vibration error is small, the control goal is to reduce the overshoot of the control system. Based on this principle, corresponding fuzzy control rules are formulated. The final step of fuzzy control is defuzzification, which is performed using the center-of-gravity method, as shown in formula (27), with a hybrid control rate of... .

[0165] In this way, intelligent adjustment of the slow-changing subsystem of the flexible robotic arm can be achieved through fuzzy control. By distinguishing vibration error conditions through fuzzy rules, a balance between rapid response and overshoot suppression can be achieved. The center of gravity method can smooth the output control signal and reduce abrupt changes.

[0166] According to one embodiment of the present invention, in step S6, a stability analysis is performed on the fuzzy controller.

[0167] According to one embodiment of the present invention, stability analysis of the fuzzy controller includes: assuming the existence of an ideal control law; and determining the ideal control law according to formula (28). ,

[0168] (28)

[0169] in, Includes terms of inertia, Coriolis force, and gravity. >0, >0;

[0170] The actual error is determined according to formula (29).

[0171] (29)

[0172] Construct the Lyapunov function according to formula (30).

[0173] (30)

[0174] Differentiating the Lyapunov function, when , When the fuzzy controller is stable, it is determined that the controller is stable.

[0175] According to one embodiment of the present invention, for the stability analysis of the controller of a slowly varying subsystem, it is first assumed that an ideal control law exists. This can completely cancel out the nonlinear term and achieve accurate tracking. At this point, the closed-loop error is: The fuzzy controller output Approximating the ideal control law results in an approximation error. : Substituting this into the dynamic equation, we obtain the actual error, i.e., formula (29). Using formula (30), we construct the Lyapunov function and differentiate it to obtain: , Assuming fuzzy approximation error Bounded, meaning there exists a constant. Make ,but: Using the young inequality, we get: According to Lyapunov theory, when At that time, the system state will eventually be The corresponding error is bounded: , This proves that the designed slow-varying subsystem controller is stable and feasible.

[0176] According to an embodiment of the present invention, in step S7, the flexible robotic arm is simulated and verified. Multiple control algorithms of the flexible robotic arm are compared and verified from three perspectives: joint position, joint output torque, and end-effector position error, to verify its stability.

[0177] According to one embodiment of the present invention, a two-degree-of-freedom flexible robotic arm system is constructed. Figure 4A parameter diagram of a flexible arm system according to an embodiment of the present invention is shown, including various parameters commonly found in flexible arm systems. Experimental simulations were performed using Matlab 2021b. After constructing a model of the two-degree-of-freedom flexible manipulator, controllers for each subsystem were designed. Through simulation comparisons of joint positions under various algorithms and singular perturbation decomposition system control, it can be seen that the trajectory of the system joints under the combined control of the singular perturbation decomposition system closely matches the designed desired trajectory. Through simulation comparisons of joint output torque under various algorithms and the combined control of the singular perturbation decomposition system, it can be seen that the combined control of the singular perturbation decomposition system results in more stable joint output torque. Through simulation comparisons of system end-effector position errors under various algorithms and the combined control of the singular perturbation decomposition system, it can be seen that the combined control of the singular perturbation decomposition system results in lower end-effector position errors and better control performance.

[0178] The singular perturbation decomposition and dual-mode composite control method for multi-link flexible manipulators according to embodiments of the present invention decomposes the dynamic model of the flexible manipulator into fast-variable subsystems and slow-variable subsystems. This reduces coupling, significantly reduces the elastic vibration amplitude of the flexible manipulator, decreases its position error, and improves the smoothness of the system response speed and output torque, thereby effectively improving the control accuracy and stability of the multi-degree-of-freedom flexible manipulator. When establishing the dynamic model of the flexible manipulator, AMM and Lagrangian methods can be used, reducing modeling difficulty and simplifying the design complexity of adaptive sliding mode variable structure controllers and fuzzy controllers. When decomposing into fast and slow-variable subsystems, singular perturbation decomposition can be used to decompose the dynamic model of the flexible manipulator into fast-variable and slow-variable subsystems, reducing the coupling effect between fast and slow dynamics, minimizing mutual interference, and enabling the controllers of each subsystem to be designed according to the control objectives of the system, thereby improving the control accuracy of the multi-degree-of-freedom flexible manipulator and effectively suppressing flexible vibration. When designing an adaptive sliding mode variable structure controller, an adaptive sliding mode variable structure controller can be designed for the fast-changing subsystem. Adaptive sliding mode control suppresses vibration, improves trajectory tracking accuracy, and allows for the design of optimal gain to minimize disturbance propagation effects. When designing a fuzzy controller, fuzzy control can be used to achieve intelligent adjustment of the slow-changing subsystem of the flexible robotic arm. Fuzzy rules can distinguish vibration error conditions, achieving a balance between fast response and overshoot suppression. The center-of-gravity method can smooth the output control signal and reduce abrupt changes.

[0179] This invention can be a method, apparatus, system, and / or computer program product. The computer program product may include a computer-readable storage medium having computer-readable program instructions loaded thereon for performing various aspects of the invention.

[0180] Those skilled in the art should understand that the embodiments of the present invention described above and shown in the accompanying drawings are merely examples and do not limit the present invention. The objectives of the present invention have been fully and effectively achieved. The functions and structural principles of the present invention have been demonstrated and explained in the embodiments, and any variations or modifications may be made to the implementation of the present invention without departing from the stated principles.

Claims

1. A singular perturbation decomposition and dual-mode hybrid control method for a multi-link flexible manipulator, characterized in that, The method comprises the following steps: establishing a flexible robot arm dynamics model; decomposing the flexible robot arm dynamics model into a fast variable subsystem and a slow variable subsystem by singular perturbation decomposition; designing an adaptive sliding mode variable structure controller for the fast variable subsystem; analyzing the stability of the adaptive sliding mode variable structure controller; designing a fuzzy controller for the slow variable subsystem; analyzing the stability of the fuzzy controller; performing simulation verification on the flexible robot arm, and comparing and verifying multiple control algorithms of the flexible robot arm from the angles of joint position, joint output torque and end position error to verify the stability.

2. The singular perturbation decomposition and dual-mode hybrid control method for multi-link flexible manipulators according to claim 1, wherein, The method comprises the following steps of establishing a flexible robot arm dynamics model: assigning coordinate systems to multiple flexible robot arms; determining the flexible robot arm dynamics model according to the formula determining a homogeneous transformation matrix between coordinate system {i} and coordinate system {i-1} where i = 0, 1, 2, is the kth order modal shape of the ith flexible manipulator, f ik is the modal coordinate of the kth order modal shape of the ith flexible manipulator, r is the order of the selected Ritz function of the ith flexible manipulator; determining the flexible robot arm dynamics model according to the formula elastic potential energy of the i-th flexible manipulator i where dT i m is the kinetic energy of a mass dm of the i-th flexible manipulator, T i M is the kinetic energy of a lumped mass of the i-th flexible manipulator, T i is the total kinetic energy of the i-th flexible manipulator and mass, g is the gravitational constant, is the expression of the center of mass vector of the i-th flexible manipulator in the inertial reference frame {0} when it is not deformed, is the expression of the center of mass vector of the i-th flexible manipulator in the co-moving reference frame {i} when it is not deformed, E i is the Young's modulus of the i-th flexible manipulator, I i is the moment of inertia of the i-th flexible manipulator; determining the flexible robot arm dynamics model according to the formula determining the dynamics equation of the flexible manipulator, wherein the Lagrange function is defined as and 3. The singular perturbation decomposition and dual-mode hybrid control method for multi-link flexible manipulators according to claim 1, wherein, decomposing the flexible robot arm dynamics model into a fast variable subsystem and a slow variable subsystem by singular perturbation decomposition, comprising the following steps: determining the fast variable subsystem according to the formula z s = [θ1, θ2,..., θ m ] T determining slow varying states z of the flexible robot arm dynamics model s and fast varying states z f ; determining the fast variable subsystem according to the formula A singularly perturbed model is determined, where η = z f , z = z s , u f = B f u, 4. The singular perturbation decomposition and dual-mode hybrid control method for multi-link flexible manipulators according to claim 1, wherein, designing an adaptive sliding mode variable structure controller for the fast variable subsystem, comprising the following steps: determining the sliding surface S and the fast variable subsystem dynamics under the vibration interference input according to the formula, wherein Λ>0; determining the optimization target according to the formula determining the optimization target according to the formula analyzing the stability of the adaptive sliding mode variable structure controller, comprising the following steps: determining the sliding surface S according to the formula Determining an input u of an adaptive sliding mode variable structure controller f where K = diag(k1, k2, k3, k4) is a sliding mode gain matrix, is an adaptive parameter matrix; designing a fuzzy controller for the slow variable subsystem, comprising the following steps: determine the update law adjustment, where γ = 0.1 is an adaptive gain, φ(η) is a basis function vector, and η = [q 11 , q 12 , q 21 , q 22 ] T .

5. The singular perturbation decomposition and dual-mode hybrid control method for multi-link flexible manipulators according to claim 4, wherein, mapping the input variables and the output variables to {NB, NM, NS, ZO, PS, PM, PB} to determine the value range of the input variables and the output variables, wherein the input variables are the flexible robot arm position error value and the flexible robot arm position error change rate, the output variables are the control torque, NB is negative large, NM is negative medium, NS is negative small, ZO is zero, PS is positive small, PM is positive medium, and PB is positive large; mapping the input variables and the output variables to the fuzzy domain to determine the quantization factor and the proportion factor; Construct Lyapunov function, wherein is a parameter error matrix; Taking the derivative of Lyapunov function, when then the adaptive sliding mode variable structure controller is stable, where a>0, b>0.

6. The singular perturbation decomposition and dual-mode hybrid control method for multi-link flexible manipulators according to claim 1, wherein, determining the fuzzy controller according to the formula analyzing the stability of the fuzzy controller, comprising the following steps: assuming that an ideal control law exists; determining the actual error according to the formula determining a deblurring method, where e is a flexible robot arm position error value, is a flexible robot arm position error change rate, u s is a control torque.

7. The singular perturbation decomposition and dual-mode hybrid control method for multi-link flexible manipulators according to claim 6, wherein, determining the actual error according to the formula constructing a Lyapunov function; a computer program instruction is stored thereon, and the computer program instruction is executed by a processor to implement the method in any one of claims 1-7. Determining an ideal control law wherein, including inertial, Coriolis and gravitational terms, K p > 0, K d > 0; ​ ​ ​ ​ Taking the derivative of the Lyapunov function, when the fuzzy controller is determined to be stable.

8. A computer-readable storage medium, characterized in that, ​