Manipulator event triggering fuzzy control method and system with state constraint
By introducing an event-triggered fuzzy control method with state constraints in the robot system, using the fuzzy logic system and the obstacle Liyapunov function, the problem of precise tracking and control of the robot system under external interference is solved, and the accurate tracking and state of joint position and speed is achieved. Constraints improve control performance.
Patent Information
- Application Number
- CN202411199175.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-29
- Publication Date
- 2024-11-08
AI Technical Summary
When the robotic system is disturbed externally, it is difficult to achieve accurate tracking control, and the system model state value deviation is too large, resulting in a degradation of tracking control performance.
The robot event-triggered fuzzy control method adopts state constraints. By establishing a dynamic model in the form of the Lagrangian equation, the event-triggering mechanism is designed, the uncertainty is estimated using a fuzzy logic system, and the obstacle Liyapunov function is introduced to construct the Control law of state constraints.
In the presence of external disturbances and uncertainties, the precise tracking control of the joint position and speed of the robot is realized, ensuring the constraints of the state variables, saving the communication resources of the control system, and improving the model response speed.
Smart Images

Figure CN118906059A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the field of robot control, and in particular relates to a manipulator event-triggered fuzzy control method and system with state constraints. Background Art
[0002] In the past few decades, robots have been widely used in various fields such as industrial automation, industrial manufacturing, medical assistance, space exploration, etc. With the development of science and technology, the performance requirements of robot manipulators are constantly increasing. Among them, the precise tracking control of the manipulator is a key performance requirement. The tracking control of the manipulator is a typical nonlinear control problem. In practical applications, the dynamic model of the manipulator is often affected by various external disturbances and uncertainties. At the same time, we all expect the manipulator to achieve fast and high-precision tracking control. Therefore, it is of great significance to design a controller to improve the tracking performance of the robot manipulator under the premise of considering system uncertainty, external disturbances, and state constraints. Summary of the invention
[0003] The purpose of the present invention is to solve the problem that when the existing manipulator system is subjected to external interference, the deviation of the system model state value is too large, making it difficult to achieve precise tracking control, and to provide a manipulator event-triggered fuzzy control method and system with state constraints.
[0004] In order to achieve the above object, the present invention adopts the following technical solutions:
[0005] A method and system for event-triggered fuzzy control of a manipulator with state constraints, comprising the following steps:
[0006] S1, considering the parts of the robot system dynamics model that cannot be accurately modeled and the influence of external interference, establish the robot dynamics model;
[0007] S2, design the event trigger mechanism by defining the measurement error;
[0008] S3, using fuzzy logic system to estimate the parts of the system model that cannot be accurately modeled;
[0009] S4, introduce the obstacle Lyapunov function to realize the state constraint of system variables and construct the manipulator event-triggered fuzzy control law with state constraints.
[0010] A further improvement of the present invention is:
[0011] The step S1 comprises the following steps:
[0012] Considering the parts of the robot system dynamics model that cannot be accurately modeled and the influence of external interference, the robot dynamics model satisfies the following Lagrange equation form:
[0013]
[0014] in, Represent the joint position, velocity and acceleration vectors respectively, represents the number of degrees of freedom, represents the mechanical inertia, is the viscous friction coefficient matrix, Indicates the length of the chain link, Indicates the load mass, represents the acceleration due to gravity, represents the control instruction to be calculated, Refers to the external interference to the model. represents the model uncertainty caused by measurement error.
[0015] The step S2 comprises the following steps:
[0016] At each triggering moment, the state variable tracking error is sampled and the system control law is updated accordingly. The interval length between two consecutive triggering moments is called the event interval time.
[0017] The event triggering mechanism is as follows:
[0018]
[0019] in, , , , , .
[0020] The step S2 further comprises the following steps:
[0021] In order to design the event triggering mechanism, the measurement error is defined as follows:
[0022]
[0023] in, is a state variable The tracking error relative to the desired state or filtered virtual controller, is called the triggering moment. For the sake of generality, assume that the first triggering occurs at time. Note that once the event occurs, the measurement error will be reset to 0.
[0024] The step S3 comprises the following steps:
[0025] The output of a typical fuzzy logic system can be expressed as:
[0026]
[0027] in, and are the input and output of the fuzzy logic system, represents the number of fuzzy inference rules, , and is a fuzzy set, and They are and The membership function of .
[0028] definition and . Parts that cannot be accurately modeled in this model It can be expressed as:
[0029]
[0030] in, represents the optimal fuzzy weight vector, is the fuzzy basis function. represents the approximation error of the fuzzy logic system.
[0031] The step S4 comprises the following steps:
[0032] Consider constructing a barrier Lyapunov function of the following form:
[0033]
[0034] Because of the inequality , In the interval holds, so the state variable tracking error is constrained to within the range. is the tracking error of the state variable, Yes constraints.
[0035] Based on the Lyapunov function in the above formula, the virtual controller and the actual control instruction are designed respectively to ensure that the state variable tracking error The constraint is bounded because , so the state variable There are state constraints.
[0036] The step S4 further comprises the following steps:
[0037] In order to ensure that the robot accurately tracks the desired signal, the tracking error is first defined , is the expected tracking signal, then ,
[0038] Here, the virtual controller is designed as follows:
[0039]
[0040] in, is the design parameter, Yes The constraints here are
[0041] New variables introduced by first-order filters ,have:
[0042]
[0043] is a scalar greater than 0, defined
[0044] According to the above, we have:
[0045]
[0046] Therefore, the following control instructions can be designed:
[0047]
[0048] in, is the design parameter, is a normal number, , represents the approximation error of the fuzzy logic system, Represents the optimal parameters The estimate, , in order to compensate for the unknown nonlinear uncertainties , we introduce the fuzzy logic system here According to step 4 above, we can get , Represents the optimal parameters The estimate, Both estimates will be computed online based on an event-triggered update scheme, i.e., both parameter estimates will remain constant during the inter-event interval and will be updated only at the triggering moment.
[0049] At the triggering moment , two parameters Update now. The update plan is as follows:
[0050]
[0051]
[0052] in, , For normalization, is a small positive constant, is a positive design parameter, , It is a positive design parameter and has the same correction effect as in traditional adaptive control.
[0053] A manipulator event-triggered fuzzy control system with state constraints, comprising:
[0054] A model building unit, used to build a manipulator dynamics model in the form of Lagrangian equations;
[0055] An event trigger building unit is used to design an event trigger mechanism based on the state variable tracking error and the measurement error caused by the event trigger;
[0056] An uncertainty estimation unit, used to estimate the parts of the system model that cannot be accurately modeled using a fuzzy logic system;
[0057] The control law construction unit is used to introduce the obstacle Lyapunov function to realize the state constraint of the system variables and construct the manipulator event-triggered fuzzy control law with state constraints.
[0058] A terminal device comprises a memory, a processor and a computer program stored in the memory and executable on the processor, wherein the processor implements the steps of any one of the methods of the present invention when executing the computer program.
[0059] A computer-readable storage medium storing a computer program, wherein the computer program, when executed by a processor, implements the steps of any one of the methods of the present invention.
[0060] Compared with the prior art, the present invention has the following beneficial effects:
[0061] The present invention discloses a manipulator event-triggered fuzzy control method and system with state constraints. First, a manipulator dynamics model in the form of Lagrange equations is established, and the external disturbance and uncertainty of the manipulator are mathematically characterized, and finally a control-oriented second-order system model is obtained. Secondly, in view of the uncertainty existing in the model, a fuzzy logic system is used for approximation, and the obstacle Lyapunov function is used to ensure that the joint position and speed of the manipulator do not violate the constraints. Finally, in order to save the communication resources of the control system, an event triggering mechanism is designed, and based on this, a manipulator event-triggered fuzzy control law with state constraints is constructed. BRIEF DESCRIPTION OF THE DRAWINGS
[0062] In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings required for use in the embodiments are briefly introduced below. It should be understood that the following drawings only show certain embodiments of the present invention and therefore should not be regarded as limiting the scope. For ordinary technicians in this field, other related drawings can be obtained based on these drawings without creative work.
[0063] Figure 1 A flow chart of the control method disclosed in the present invention;
[0064] Figure 2 The figure is a simulation result diagram using the method of the present invention. DETAILED DESCRIPTION
[0065] In the following, the terms "first", "second", "third", and "fourth" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Therefore, a feature defined as "first", "second", "third", and "fourth" may explicitly or implicitly include one or more of the features.
[0066] The co-shooting method provided in the embodiment of the present application can be applied to terminal devices such as mobile phones, tablet computers, wearable devices, vehicle-mounted devices, augmented reality (AR) / virtual reality (VR) devices, laptop computers, ultra-mobile personal computers (UMPC), netbooks, personal digital assistants (PDA), etc. The embodiment of the present application does not impose any restrictions on the specific type of the terminal device.
[0067] It should be noted that the terms "first", "second", etc. in the specification and drawings of the present invention are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.
[0068] The present invention is further described in detail below in conjunction with the accompanying drawings:
[0069] See also Figure 1 The first aspect of the present invention discloses a manipulator event-triggered fuzzy control method with state constraints. The control law proposed based on the event trigger mechanism saves communication resources, uses the fuzzy logic system to approximate the uncertainty that cannot be accurately modeled inside the system, improves the model response speed, and introduces the barrier Lyapunov function to ensure that the state variable constraint is not violated. Specifically, it includes the following steps:
[0070] Step 1: Build a dynamic model of the robot system
[0071] Specifically, considering the parts of the robot system dynamics model that cannot be accurately modeled and the influence of external interference, the robot dynamics model satisfies the following Lagrange equation form:
[0072]
[0073] in, Represent the joint position, velocity and acceleration vectors respectively, represents the number of degrees of freedom, represents the mechanical inertia, is the viscous friction coefficient matrix, Indicates the length of the chain link, Indicates the load mass, represents the acceleration due to gravity, represents the control instruction to be calculated, Refers to the external interference to the model. represents the model uncertainty caused by measurement error.
[0074] The above-mentioned dynamic model of the manipulator system can be expressed in the following state space form:
[0075]
[0076] in , .
[0077] Step 2: Design the event trigger mechanism by defining the measurement error;
[0078] In order to design the event triggering mechanism, the measurement error is first defined as follows:
[0079]
[0080] in, is a state variable The tracking error relative to the desired state or filtered virtual controller, is called the triggering moment. For the sake of generality, assume that the first triggering occurs at time. Note that once the event occurs, the measurement error will be reset to 0.
[0081] At each triggering moment, the state variable tracking error is sampled and the system control law is updated accordingly. The interval length between two consecutive triggering moments is called the event interval time.
[0082] The event triggering mechanism is as follows:
[0083]
[0084] in, , , , , .
[0085] It can be seen that an exponential convergence term is added to avoid Zeno behavior. Zeno behavior refers to infinite triggering within a finite time in event-triggered control. For the designed event trigger condition, the trigger condition is constantly satisfied and the controller cannot effectively adjust the trigger. It can be seen from formula (4) that the exponential convergence term of is added to the event trigger mechanism to avoid Zeno behavior. If, then the exponential convergence term is reduced to a positive constant.
[0086] Step 3: Use fuzzy logic system to estimate the parts of the system model that cannot be accurately modeled;
[0087] The output of a typical fuzzy logic system can be expressed as:
[0088]
[0089] in, and are the input and output of the fuzzy logic system, represents the number of fuzzy inference rules, and is a fuzzy set, and They are and The membership function of .
[0090] Here, the following membership functions are used to characterize the fuzzy sets:
[0091]
[0092] The fuzzy basis function is defined as:
[0093]
[0094] definition and . Parts that cannot be accurately modeled in this model It can be expressed as:
[0095]
[0096] in, represents the optimal fuzzy weight vector, is the fuzzy basis function. represents the approximation error of the fuzzy logic system.
[0097] Step 4: Introduce the obstacle Lyapunov function to realize the state constraint of system variables and construct the manipulator event-triggered fuzzy control law with state constraints.
[0098] Consider constructing a barrier Lyapunov function of the following form:
[0099]
[0100] Because of the inequality , In the interval holds, so the state variable tracking error is constrained to within the range. is the tracking error of the state variable, Yes constraints.
[0101] Based on the Lyapunov function in the above formula, the virtual controller and the actual control instruction are designed respectively to ensure that the state variable tracking error The constraint is bounded because , so the state variable There are state constraints.
[0102] In order to ensure that the robot accurately tracks the desired signal, the tracking error is first defined , is the expected tracking signal, then ,
[0103] Here, the virtual controller is designed as follows:
[0104]
[0105] in, is the design parameter, Yes The constraints here are
[0106] New variables introduced by first-order filters ,have:
[0107]
[0108] is a scalar greater than 0, defined
[0109] Here we have:
[0110]
[0111] So, The derivatives of can be expressed as:
[0112]
[0113] According to the above, we have:
[0114]
[0115] Therefore, the following control instructions can be designed:
[0116]
[0117] in, is the design parameter, is a normal number, , represents the approximation error of the fuzzy logic system, Represents the optimal parameters The estimate, , in order to compensate for the unknown nonlinear uncertainties , we introduce the fuzzy logic system here According to step 4 above, we can get , Represents the optimal parameters The estimate, Both estimates will be computed online based on an event-triggered update scheme, i.e., both parameter estimates will remain constant during the inter-event interval and will be updated only at the triggering moment.
[0118] At the triggering moment , two parameters Update now. The update plan is as follows:
[0119]
[0120]
[0121] in, , For normalization, is a small positive constant, is a positive design parameter, , It is a positive design parameter and has the same correction effect as in traditional adaptive control.
[0122] See also Figure 2 The simulation diagram shown is a curve diagram of the designed control law tracking the expected signal without violating the state constraints. , uncertainty , external disturbance At 1.8s, the control law signal accurately tracks the expected signal, indicating that the designed control method can quickly track the expected signal.
[0123] The second aspect of the present invention discloses a manipulator event-triggered fuzzy control system with state constraints, comprising:
[0124] A model building unit, used to build a manipulator dynamics model in the form of Lagrangian equations;
[0125] An event trigger building unit is used to design an event trigger mechanism based on the state variable tracking error and the measurement error caused by the event trigger;
[0126] An uncertainty estimation unit, used to estimate the parts of the system model that cannot be accurately modeled using a fuzzy logic system;
[0127] The control law construction unit is used to introduce the obstacle Lyapunov function to realize the state constraint of the system variables and construct the manipulator event-triggered fuzzy control law with state constraints.
[0128] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims
1. A manipulator event-triggered fuzzy control method with state constraints, characterized in that: The following steps are involved: S1, considering the parts of the robot system dynamics model that cannot be accurately modeled and the influence of external interference, establish the robot dynamics model; S2, design the event trigger mechanism by defining the measurement error; S3, using fuzzy logic system to estimate the parts of the system model that cannot be accurately modeled; S4, introduce the obstacle Lyapunov function to realize the state constraint of system variables and construct the manipulator event-triggered fuzzy control law with state constraints.
2. The method for event-triggered fuzzy control of a manipulator with state constraints according to claim 1, characterized in that: The step S1 comprises the following steps: Considering the parts of the robot system dynamics model that cannot be accurately modeled and the influence of external interference, the robot dynamics model satisfies the following Lagrange equation form: in, Represent the joint position, velocity and acceleration vectors respectively, represents the number of degrees of freedom, represents the mechanical inertia, is the viscous friction coefficient matrix, Indicates the length of the chain link, Indicates the load mass, represents the acceleration due to gravity, represents the control instruction to be calculated, Refers to the external interference to the model. represents the model uncertainty caused by measurement error.
3. The method for event-triggered fuzzy control of a manipulator with state constraints according to claim 1, characterized in that: The step S2 comprises the following steps: At each triggering moment, the state variable tracking error is sampled and the system control law is updated accordingly. The interval length between two consecutive triggering moments is called the event interval time. The event triggering mechanism is as follows: in, , , , , .
4. The method for event-triggered fuzzy control of a manipulator with state constraints according to claim 3, characterized in that: The step S2 also The following steps are involved: In order to design the event triggering mechanism, the measurement error is defined as follows: in, is a state variable The tracking error relative to the desired state or filtered virtual controller, is called the triggering moment. For the sake of generality, assume that the first triggering occurs at time. Note that once the event occurs, the measurement error will be reset to 0.
5. The method for event-triggered fuzzy control of a manipulator with state constraints according to claim 1, characterized in that: The step S3 comprises the following steps: The output of a typical fuzzy logic system can be expressed as: in, and are the input and output of the fuzzy logic system, represents the number of fuzzy inference rules, , and is a fuzzy set, and They are and The membership function of . definition and . Parts that cannot be accurately modeled in this model It can be expressed as: in, represents the optimal fuzzy weight vector, is the fuzzy basis function. represents the approximation error of the fuzzy logic system.
6. The method for event-triggered fuzzy control of a manipulator with state constraints according to claim 1, characterized in that: The step S4 comprises the following steps: Consider constructing a barrier Lyapunov function of the following form: Because of the inequality , In the interval holds, so the state variable tracking error is constrained to within the range. is the tracking error of the state variable, Yes constraints. Based on the Lyapunov function in the above formula, the virtual controller and the actual control instruction are designed respectively to ensure that the state variable tracking error The constraint is bounded because , so the state variable There are state constraints.
7. The method for event-triggered fuzzy control of a manipulator with state constraints according to claim 6, characterized in that: The step S4 further comprises the following steps: In order to ensure that the robot accurately tracks the desired signal, the tracking error is first defined , is the expected tracking signal, then , Here, the virtual controller is designed as follows: in, is the design parameter, Yes The constraints here are New variables introduced by first-order filters ,have: is a scalar greater than 0, defined According to the above, we have: Therefore, the following control instructions can be designed: in, is the design parameter, is a normal number, , represents the approximation error of the fuzzy logic system, Represents the optimal parameters The estimate, , in order to compensate for the unknown nonlinear uncertainties , we introduce the fuzzy logic system here According to step 4 above, we can get , Represents the optimal parameters The estimate, Both estimates will be computed online based on an event-triggered update scheme, i.e., both parameter estimates will remain constant during the inter-event interval and will be updated only at the triggering moment. At the triggering moment , two parameters Update now. The update plan is as follows: in, , For normalization, is a small positive constant, is a positive design parameter, , It is a positive design parameter and has the same correction effect as in traditional adaptive control.
8. A manipulator event-triggered fuzzy control system with state constraints, characterized in that: include: A model building unit, used to build a manipulator dynamics model in the form of Lagrangian equations; An event trigger building unit is used to design an event trigger mechanism based on the state variable tracking error and the measurement error caused by the event trigger; An uncertainty estimation unit, used to estimate the parts of the system model that cannot be accurately modeled using a fuzzy logic system; The control law construction unit is used to introduce the obstacle Lyapunov function to realize the state constraint of the system variables and construct the manipulator event-triggered fuzzy control law with state constraints.
9. A terminal device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the computer program, the steps of the method according to any one of claims 1 to 7 are implemented.
10. A computer-readable storage medium storing a computer program, characterized in that: When the computer program is executed by a processor, the steps of the method according to any one of claims 1 to 7 are implemented.
