Self-adaptive boundary anti-interference vibration reduction control method of flexible mechanical arm system
Through the Hamilton principle and adaptive boundary controller, the flexible robot arm system can achieve stable tracking of set angular displacement signals and suppress vibration when facing non-matching interference and limited input and output, solving the vibration and control accuracy of the flexible robot arm system. Sexual problems.
Patent Information
- Application Number
- CN202411526005.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-10-30
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2044-10-30
AI Technical Summary
In practical applications, flexible robotic arm systems are affected by non-matching interference, limited input and output and actuator saturation dead zone problems, resulting in limited vibration suppression and angular displacement tracking accuracy and stability, and effective control methods are needed to solve these problems. question.
The Hamiltonian principle is used to model the flexible robotic arm system as a distributed parameter system, and the auxiliary system is designed to compensate for the input and output difference. The adaptive boundary controller is proposed through the parameter adaptive law and obstacle Liyapunov function to effectively suppress vibration and limit the end of the boom. Slope and tracking errors for deflection and angular displacement.
The flexible robotic arm system is able to track the set angular displacement signal, limiting the errors of the end deflection and angular displacement of the arm end within the safe range, effectively compensates for the impact of input and output limitations and interference on the system, and improves control accuracy and stability.
Smart Images

Figure CN119024708A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of flexible manipulator vibration suppression, and in particular relates to an adaptive boundary anti-disturbance vibration reduction control method for a flexible manipulator system. Background Art
[0002] Compared with traditional rigid robotic arms, flexible robotic arms have unique advantages in practical applications due to their light weight, high toughness, low energy consumption and other characteristics. They have been widely used in many fields such as aerospace, industrial manufacturing, and medicine. However, the vibration problem caused by the flexible characteristics is the most critical problem to be overcome in the research and application of flexible robotic arm systems.
[0003] In recent years, research on flexible manipulators has achieved certain scientific research results. Existing results usually model the flexible structure system as a concentrated parameter system or a distributed parameter system. Although the latter has a complex model, it can avoid the control overflow problem. Interference is one of the main factors causing vibration of flexible manipulators. Most existing research is devoted to solving the matching interference in the same channel as the controller. However, due to the parameter disturbance, unmodeled dynamics, and external wind field, the non-matching interference caused by factors such as external wind field can directly act on the system state. Therefore, the non-matching interference of the flexible manipulator system in practical applications cannot be ignored. Effective control methods are urgently needed to solve the combined effects of matching and non-matching interference acting on the flexible manipulator system represented by the distributed parameter system.
[0004] In addition, due to the limitations of physical factors, the actuator will experience saturation and dead zone phenomena in response to the input control signal, resulting in a deviation between the actual control input of the system and the ideal control input, affecting the accuracy and stability of the control system; for safety reasons, the slope of the deflection of the end of the robot arm and the angular displacement tracking error need to be limited to a safe range, and output limitation is also a hot topic in the current research field of flexible robot arms; therefore, the research on anti-disturbance and vibration reduction of flexible robot arm systems under input and output limitations has important theoretical and application value. Summary of the invention
[0005] In view of the key issues that need to be considered in the study of the above-mentioned flexible robotic arm system, the present invention proposes an adaptive boundary anti-disturbance vibration reduction control method for a flexible robotic arm system under input and output constraints, which effectively suppresses the vibration of the flexible robotic arm and enables it to stably track the set angular displacement signal.
[0006] An adaptive boundary anti-disturbance vibration reduction control method for a flexible manipulator system comprises the following steps: Step 1: Using Hamilton's principle, the flexible robotic arm system is modeled as a distributed parameter system; Step 2: Convert the input saturation and dead zone problem into a new saturation problem by designing an auxiliary system to forward compensate the difference between the control input and the actuator output; Step 3: Design a parameter adaptive law to compensate for the combined effects of matching and non-matching interference on the distributed parameter system; Step 4: Using Lyapunov direct method and combining with barrier Lyapunov function, an adaptive boundary controller is proposed and the system stability is proved.
[0007] Furthermore, the distributed parameter system is established using the Hamilton principle, and the main control equation of the system is: ; (1) The boundary conditions are: ; (2) ; (3) ; (4) ; (5) ; (6) in, , , , , , , , ; is the arm length; It represents the mass per unit length of the arm; is the mass of the effective load at the end of the boom; represents the bending stiffness of the flexible manipulator; is the moment of inertia of the rigid hub; Indicates the offset of the flexible manipulator; Indicates that the flexible robotic arm is Moment, in The vibration amplitude or deflection at ; represents the angular displacement of the flexible manipulator; It is the distributed interference to the system; The control force provided by the end effector of the flexible robot arm is The control torque provided to the actuator at the rigid hub of the flexible manipulator; represents the non-matching interference of the position loop subsystem, represents the matching disturbance of the position loop subsystem, represents the non-matching disturbance of the attitude loop subsystem, represents the matching disturbance of the attitude loop subsystem; express , express , express , express .
[0008] Furthermore, in step 2, the saturation function Described as: ; (7) in, is a saturation function, and the known constant and denote the upper and lower saturation levels of the actuator output, respectively, and as well as , , represents the control input of the end effector, represents the control input of the actuator at the rigid hub; The dead zone function is expressed as: ; (8) in, The control force or torque provided to the actuator, represents the dead zone function, with known constants and Respectively represent the upper and lower limits of the dead zone range, and satisfy and ; Normal number and represents a known slope; In order to deal with input nonlinearity, the right inverse function of the dead zone function is defined as for: ; (9) in, The control law for the design; Combining equations (7), (8) and (9), we get a new saturation function: ; (10) Therefore, the saturation and dead zone problem of the actuator is transformed into a new saturation problem; in order to compensate for the difference between the control input and the actuator output under the new form of saturation, the form of the designed auxiliary system is described as: ; (11) ; (12) in, and They are the state quantities of the auxiliary systems designed for the position loop and attitude loop, and is the difference between the control input and the actuator output and The upper bound of , , and The control laws designed for the end effector of the flexible manipulator and the actuator at the rigid hub are respectively; is a positive constant; , , and is an undetermined normal number; a normal number , are the upper bounds of the range in which the slope of the flexible manipulator end deflection and the angular displacement tracking error are limited, namely, , , is the angular displacement tracking error; represents a symbolic function; Auxiliary variables for construction.
[0009] Furthermore, in step 3, the form of the parameter adaptation law is described as: ; (13) ; (14) ; (15) in, , is a composite interference defined, and there exists a positive constant , and satisfy , as well as , ; , and They are the unknown constants , and The estimated value of , and ; and is the auxiliary variable for construction; is a positive constant, , is a positive constant to be determined, .
[0010] Furthermore, in step 4, the form of the adaptive boundary controller is: ; (16) ; (17) The barrier Lyapunov function has the form: ; (18) ; (19) ; (20) ;(twenty one) in, is the energy term, is the cross term, and For auxiliary items; is a positive constant to be determined, .
[0011] Furthermore, by adopting the proposed adaptive boundary controller, the flexible manipulator can stably track the set angular displacement signal. During this process, the slope of the arm end deflection and the angular displacement tracking error are constrained within the set range. and angular tracking error Converges to the following range: ;(twenty two) ;(twenty three) in, , , , , in, , and is a normal number and satisfies ; is a positive constant, .
[0012] Beneficial technical effects brought by the present invention: Based on the designed auxiliary system and adaptive law, the adaptive boundary anti-disturbance vibration reduction control scheme is proposed, which effectively compensates for the error between the actuator output and the control input caused by input saturation and dead zone, as well as the combined influence of matching and non-matching interference on the system; the slope of the flexible robot arm's angle tracking error and the arm end deflection are limited to the set safety range; at the same time, by selecting appropriate parameters, the angular displacement tracking error and the arm deflection converge to a small neighborhood of zero, thereby realizing the angular displacement tracking and anti-disturbance vibration reduction control of the flexible robot arm system under constraints. BRIEF DESCRIPTION OF THE DRAWINGS
[0013] Figure 1 It is a schematic structural diagram of the flexible robotic arm system of the present invention.
[0014] Figure 2 The flowchart is a method for adaptive boundary anti-disturbance vibration reduction control of a flexible manipulator of the present invention.
[0015] Figure 3 It is a principle diagram of the adaptive boundary anti-disturbance vibration reduction control method of the present invention. DETAILED DESCRIPTION
[0016] The specific implementation of the present invention is further described below in conjunction with specific embodiments: In order to avoid the control overflow problem caused by the centralized parameter model, the present invention uses a distributed parameter model to characterize the flexible manipulator system; for the flexible manipulator system, due to the limitation of physical factors, the actuator often has input saturation and dead zone phenomenon, which makes the deviation between the ideal control input and the actual actuator, affecting the accuracy and stability of the control system. The present invention takes into account the input limitation of the actuator; for safety reasons, the slope of the deflection of the end of the flexible manipulator of the present invention and the angular displacement tracking error will be limited to a safe range. Since the non-matching interference caused by factors such as parameter disturbance, unmodeled dynamics and external wind field can directly act on the system state, the present invention takes into account the combined impact of matching and non-matching interference on the system.
[0017] Based on the above analysis, the present invention proposes an adaptive boundary anti-disturbance vibration reduction control method for a flexible manipulator system under input and output constraints.
[0018] like Figure 1 The flexible robotic arm system shown in the figure consists of a single arm, a rigid hub and an end load; two controllers are located at the rigid hub and at the end of the arm respectively; is the effective load mass at the end of the boom, is the moment of inertia of the rigid hub; is the inertial coordinate system, is the coordinate system of the flexible manipulator arm. Indicates that the flexible robotic arm is at time t. The vibration amplitude or deflection at axis s; Indicates the offset of the flexible manipulator; It is the distributed interference to the system; represents the angular displacement of the flexible manipulator; The control force provided by the end effector of the flexible robot arm is The control torque provided to the actuator at the rigid hub of the flexible manipulator; represents the non-matching interference of the position loop subsystem, represents the matching disturbance of the position loop subsystem, represents the non-matching disturbance of the attitude loop subsystem, Represents the matching interference of the attitude loop subsystem.
[0019] like Figure 2 and Figure 3 As shown, the control method of the present invention specifically includes the following steps: Step 1: Using Hamilton's principle, the flexible robotic arm system is modeled as a distributed parameter system; Step 1.1, considering the distributed interference and boundary matching interference, the flexible manipulator system is modeled as a distributed parameter system, and the main control equation of the system is: ; (1) And the boundary conditions are: ; (2) ; (3) ; (4) in, , , , , , , , ; is the arm length; represents the mass per unit length of the arm, represents the bending stiffness of the flexible manipulator; , They represent the matching interference of the position loop and attitude loop subsystems respectively.
[0020] Step 1.2: Consider the non-matching interference at the boundary and write the boundary conditions (2) and (3) in the form of state equations: ; (5) ; (6) ; (7) ; (8) in, Indicates the non-matching interference of the position loop subsystem, Indicates the non-matching interference of the attitude loop subsystem; express , express , express , express .
[0021] Step 2: For input limitation, the input saturation and dead zone problems are transformed into new saturation problems, and the difference between the control input and the actuator output is forward compensated by designing an auxiliary system; Step 2.1: First, consider the input saturation and dead zone phenomenon of the actuator, and transform the saturation and dead zone problems into new saturation problems. Saturation function Described as: ; (9) in, is a saturation function, and the known constant and denote the upper and lower saturation levels of the actuator output, respectively, and as well as , , represents the control input of the end effector represents the control input of the actuator at the rigid hub; The dead zone function is expressed as: ; (10) in, The control force or torque provided to the actuator, represents the dead zone function, with known constants and Respectively represent the upper and lower limits of the dead zone range, and satisfy and ; Normal number and represents a known slope; In order to deal with input nonlinearity, the right inverse function of the dead zone function is defined as for: ; (11) in, The control law for the design; Combining equations (7), (8) and (9), we get a new saturation function: ; (12) Therefore, the actuator saturation and dead zone problem is transformed into a new saturation problem.
[0022] Step 2.2. Design an auxiliary system to forward compensate the difference between the control input and the actuator output. Define the error , , and The control laws designed for the flexible manipulator end effector and the rigid hub actuator are given, and the following assumptions are given: Assumption 1: Error , Bounded, that is, there is a normal number , satisfy , , .
[0023] In order to compensate for the difference between the control input and the actuator output under the new form of saturation, the auxiliary system proposed by the present invention is described as follows: ; (13) ; (14) in, and They are the state quantities of the auxiliary systems designed for the position loop and attitude loop, and is the difference between the control input and the actuator output and The upper bound of is a positive constant; , , and is an undetermined normal number; a normal number , are the upper bounds of the range in which the slope of the flexible manipulator end deflection and the angular displacement tracking error are limited, namely, , , is the angular displacement tracking error; Represents a symbolic function.
[0024] Step 3: Design a parameter adaptive law to compensate for the combined effects of various interferences including non-matching interference on the distributed parameter system.
[0025] First, the following assumptions are made: Assumption 2: Unknown boundary interference Bounded, that is , there is an unknown positive constant satisfy , .
[0026] Defining composite interference , , from Assumption 2, we know that there is an unknown positive constant and satisfy as well as ; In order to better analyze the stability of the flexible robotic arm system, two auxiliary variables are constructed: , ,in is the angular displacement tracking error, , To set the angular displacement signal.
[0027] The parameter adaptation law is described as: ; (15) ; (16) ; (17) in, , and They are the unknown constants , and The estimated value of , , , ; Define the estimation error , and ; and Auxiliary variables for construction; is a positive constant, , is a positive constant to be determined, ; Step 4: For output limitation, Lyapunov direct method is used, combined with barrier Lyapunov function, to propose an adaptive boundary controller, and the system stability is proved. The following assumptions and lemmas are used in the process: Assumption 3: Unknown distributed interference is bounded, that is, there exists a normal number Make , .
[0028] Lemma 1: For any function , there exists a normal number So that the following inequality holds: ; (18) Lemma 2: For , and any , , the following inequality holds: ; (19) in, is a positive real number. If and , then the following inequality holds: ; (20) ;(twenty one) Step 4.1, the form of the adaptive boundary controller is: ;(twenty two) ;(twenty three) in, is a positive constant to be determined, .
[0029] The form of the selected barrier Lyapunov function is: ;(twenty four) in, ; (25) ; (26) ; (27) ; (28) in, is the energy term, is the cross term, and As auxiliary items, , and is a normal number and satisfies .
[0030] Step 4.2, barrier Lyapunov function proves its positive definiteness.
[0031] function The positive definiteness condition needs to be satisfied to prove the uniform boundedness of the flexible robotic arm system. Positive definiteness cannot be determined, and Lemma 2 shows that and Relationship: ; (29) in, , Combining (26), we can get: ; (30) Here the parameters , , The selection makes , so the barrier Lyapunov function is selected It is positive.
[0032] Step 4.3, derive the barrier Lyapunov function to prepare for further proof.
[0033] right Taking the derivative, substituting it into equation (1) and combining it with the method of integration by parts, we can obtain: ; (31) Depend on Knowable , and substituting the boundary condition (4), equation (31) is further written as: ; (32) Depend on , square both sides of the equation and move the terms to get: ; (33) Substituting formula (33) into formula (32) and combining it with Lemma 2, we can obtain: ; (34) in, and is a normal number.
[0034] right The derivative is: ; (35) make: ; (36) ; (37) ; (38) ; (39) Substituting equation (1) into equation (36), combined with assumption 3, Lemma 2 and integration by parts, and substituting boundary condition (4), we can obtain: ; (40) in, is a positive constant. Consider , combining the method of integration by parts, Lemma 2 and the boundary condition (4), we can obtain: ; (41) in, , is a positive constant. Substituting into equation (1), combining the method of integration by parts, Lemma 2 and Assumption 3, and bringing in boundary conditions (4), we obtain: ; (42) in, is a positive constant. Consider , combining the method of integration by parts, Lemma 2 and the boundary condition (4), we can obtain: ; (43) in, , is a positive constant. Combining (40), (41), (42) and (43), we can obtain: ; (44) right Regarding the time derivative, substitute into equations (5), (6), (13), (15), (18) and , combined with Lemma 1 and Lemma 2, we can get: ; (45) in, is a normal number.
[0035] right Regarding the time derivative, substitute into equations (7), (8), (14), (16), (17), (19) and , combined with Lemma 1 and Lemma 2, we can get: ; (46) in, , , is a normal number.
[0036] consider , as well as , Lemma 2 and Lagrange's mean value theorem, we can get: as well as .in, is a normal number. According to Lemma 2, we can get , is a positive constant. Combining equations (24), (34), (44), (45) and (46), we get Regarding the form of time derivative: ; (47) in, , , , And the parameter selection should satisfy: , , , , , , , , , .
[0037] Step 4.4. Prove that under the proposed control scheme, the deflection and angular displacement tracking errors of the flexible manipulator converge to a small neighborhood of zero.
[0038] Multiply both sides of the inequality (47) by have to: ; (48) The above formula can be further written as: ; (49) Taking definite integrals on both sides of the inequality sign in the above equation, we can get: ; (50) in, yes Combining Lemma 2 and formula (30), we can get: ; (51) From formula (28), we get: ; (52) Combining equations (50), (51) and (52), we can obtain: ; (53) ; (54) Further we get: ; (55) ; (56) By selecting appropriate parameters, the deflection of the flexible manipulator arm and angular tracking error It eventually converges to a small neighborhood of zero, and the proof is complete.
[0039] Through the present invention, the following theorem can be obtained: Theorem 1: Considering the flexible manipulator system with limited actuator input and output described by equations (1), (4), and (5)-(8), under the proposed adaptive boundary disturbance rejection vibration reduction control schemes (13)-(17), and (22)-(23), assuming that W(0) is bounded, when When the flexible manipulator arm deflection and angular displacement tracking errors converge to a compact set and ,Right now: ; (57) ; (58) The present invention studies the anti-disturbance vibration reduction control problem of a flexible manipulator system considering input-output constraints and the combined influence of multiple interferences, and proposes an adaptive anti-disturbance vibration reduction control scheme: first, the Hamilton principle is used to model the flexible manipulator system as a distributed parameter system; the input saturation and dead zone problems are transformed into new saturation problems, and an auxiliary system is designed to compensate for the error between the control input and the actuator output; then an adaptive law is designed to compensate for the combined influence of matching and non-matching interferences on the system; finally, based on the barrier Lyapunov function, an adaptive boundary controller is proposed to limit the slope of the arm end deflection and the angular displacement tracking error within a safe range, thereby achieving the control goals of arm vibration suppression and tracking the set angular displacement signal; under the proposed adaptive boundary anti-disturbance vibration reduction control scheme, the closed-loop system is proved to be uniformly bounded.
[0040] Of course, the above description is not a limitation of the present invention, and the present invention is not limited to the above examples. Changes, modifications, additions or substitutions made by technicians in this technical field within the essential scope of the present invention should also fall within the protection scope of the present invention.
Claims
1. An adaptive boundary disturbance rejection vibration reduction control method for a flexible manipulator system, characterized in that: The following steps are involved: Step 1: Using Hamilton's principle, the flexible robotic arm system is modeled as a distributed parameter system; Step 2: Convert the input saturation and dead zone problem into a new saturation problem by designing an auxiliary system to forward compensate the difference between the control input and the actuator output; Step 3: Design a parameter adaptation law to compensate for the combined effects of matching and non-matching interference on the distributed parameter system; Step 4: Using Lyapunov direct method and combining with barrier Lyapunov function, an adaptive boundary controller is proposed and the system stability is proved.
2. The adaptive boundary disturbance rejection vibration reduction control method of a flexible manipulator system according to claim 1 is characterized in that: In step 1, a distributed parameter system is established using the Hamilton principle, and the main control equation of the system is: ;(1) The boundary conditions are: ;(2) ;(3) ;(4) ;(5) ;(6) in, , , , , , , , ; is the arm length; It represents the mass per unit length of the arm; is the mass of the effective load at the end of the boom; represents the bending stiffness of the flexible manipulator; is the moment of inertia of the rigid hub; Indicates the offset of the flexible manipulator; Indicates that the flexible robotic arm is Moment, in The vibration amplitude or deflection at ; represents the angular displacement of the flexible manipulator; It is the distributed interference to the system; The control force provided by the end effector of the flexible robot arm is The control torque provided to the actuator at the rigid hub of the flexible manipulator; represents the non-matching interference of the position loop subsystem, represents the matching disturbance of the position loop subsystem, represents the non-matching disturbance of the attitude loop subsystem, represents the matching disturbance of the attitude loop subsystem; express , express , express , express .
3. The adaptive boundary disturbance rejection vibration reduction control method of a flexible manipulator system according to claim 2 is characterized in that: In step 2, the saturation function Described as: ;(7) in, is a saturation function, and the known constant and denote the upper and lower saturation levels of the actuator output, respectively, and as well as , , represents the control input of the end effector, represents the control input of the actuator at the rigid hub; The dead zone function is expressed as: ;(8) in, The control force or torque provided to the actuator, represents the dead zone function, with known constants and Respectively represent the upper and lower limits of the dead zone range, and satisfy and ; Normal number and represents a known slope; In order to deal with input nonlinearity, the right inverse function of the dead zone function is defined as for: ;(9) in, The control law for the design; Combining equations (7), (8) and (9), we get a new saturation function: ;(10) Therefore, the saturation and dead zone problem of the actuator is transformed into a new saturation problem; in order to compensate for the difference between the control input and the actuator output under the new form of saturation, the form of the designed auxiliary system is described as: ;(11) ;(12) in, and They are the state quantities of the auxiliary systems designed for the position loop and attitude loop, and is the difference between the control input and the actuator output and The upper bound of , , and The control laws designed for the end effector of the flexible manipulator and the actuator at the rigid hub are respectively; is a positive constant; , , and is an undetermined normal number; a normal number , are the upper bounds of the range in which the slope of the flexible manipulator end deflection and the angular displacement tracking error are limited, namely, , , is the angular displacement tracking error; represents a symbolic function; Auxiliary variables for construction.
4. The adaptive boundary disturbance rejection vibration reduction control method of a flexible manipulator system according to claim 3 is characterized in that: In step 3, the form of the parameter adaptation law is described as: ;(13) ;(14) ;(15) in, , is a composite interference defined, and there exists a positive constant , and satisfy , as well as , ; , and They are the unknown constants , and The estimated value of , and ; and is the auxiliary variable for construction; is a normal number, , is a positive constant to be determined, .
5. The adaptive boundary disturbance rejection vibration reduction control method of a flexible manipulator system according to claim 4 is characterized in that: In step 4, the form of the adaptive boundary controller is: ;(16) ;(17) The barrier Lyapunov function has the form: ;(18) ;(19) ; (20) ; (21) in, is the energy term, is the cross term, and For auxiliary items; is a positive constant to be determined, .
6. The adaptive boundary disturbance rejection vibration reduction control method of a flexible manipulator system according to claim 5, characterized in that: By adopting the proposed adaptive boundary controller, the flexible manipulator can stably track the set angular displacement signal. During the process, the slope of the arm end deflection and the angular displacement tracking error are constrained within the set range. and angular tracking error Converges to the following range: ;(22) ;(23) in, , , , , in, , and is a normal number and satisfies ; is a positive constant, .
Citation Information
Patent Citations
Near space vehicle preset performance attitude tracking control method with input nonlinearity
CN106444368A
Finite-time neural network control method of motor-driven single-connection rod manipulator
CN108549235A
Method and device for flexible riser vibration control
CN109933102A
Rope-tied aircraft vibration suppression control method considering nonlinearity of actuator
CN116859743A
Control method for single-connecting-rod mechanical arm with embedded direct-current motor
CN117506896A
