Motion control method for single-link robotic arm
Through the dynamic model of a single-link robot arm, the control method of the event trigger mechanism and state constraint function is designed, and the problems of limited communication bandwidth and limited response speed in industrial applications are solved, and the rapid and high The tracking control and constraints of accuracy are satisfied.
Patent Information
- Application Number
- CN202210314212.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-03-28
- Publication Date
- 2024-11-29
- Estimated Expiration
- 2042-03-28
AI Technical Summary
In industrial applications, single-link robotic arms are difficult to achieve fast and high-precision tracking control due to limited communication bandwidth and limited response speed, and are difficult to meet state constraints.
Based on the dynamic model of a single-link robot arm, a control method of event triggering mechanism and state constraint function is designed. By obtaining the control target position and speed, a controller is established, and virtual design is designed using inverse step method and finite time stability theory. Controller, realizes high-precision tracking control for a limited time.
It effectively reduces the communication burden of the control system, ensures that the single-link robot arm can achieve fast and high-precision tracking control within a limited time, and meets the constraints of position and speed.
Smart Images

Figure CN115179274B_ABST
Abstract
Description
Technical Field
[0001] The present invention generally relates to motion control of a single-link robotic arm, and more particularly to a control method for a single-link robotic arm. Background Art
[0002] A single-link robot arm is a common component. It includes two ends and a connecting rod between the two ends (a rigid connecting rod is used in the present invention). One end is the input end and the other end is the output end. For example, a control force is input to the input end, so that the output end generates movement (the output can be expressed as a rotation angle, speed or position).
[0003] Single-link robotic arms are very common in industry and daily life. For example, industrial robots (robotic arms) used in industry and the robotic arms of claw machines seen in daily life all use single-link robotic arms.
[0004] Taking industrial robots as an example, on the one hand, when controlling them, the host computer system needs to provide them with corresponding control data. However, due to limited communication bandwidth, control data may not be able to be transmitted continuously between control system components, or continuous transmission will occupy too many channel resources. On the other hand, the response speed of existing control methods is limited, making it difficult to achieve fast and high-precision tracking control and to always meet state constraints during the tracking control process. Summary of the invention
[0005] The present invention provides a control method for a single-link mechanical arm, which is used to solve the above-mentioned problem.
[0006] According to one aspect of the present invention, a control method for a single-link robotic arm is provided, wherein the control method is based on a dynamic model of the single-link robotic arm, and the control method comprises: obtaining a control target at the output end of the single-link robotic arm, wherein the control target comprises a position y corresponding to a time t. d ; Establishing a state constraint function based on the position and speed of the single-link manipulator; According to the established state constraint function and the control target, establishing a controller based on an event trigger mechanism, wherein the controller includes: Wherein, ρ( is the control input, k and k+1 represent two adjacent moments; and is a parameter related to the event trigger mechanism, 1 =, ι 2 is the parameter to be designed; the single-link robotic arm is controlled according to the controller.
[0007] In one embodiment, the event triggering mechanism is: when the input power difference e(t) between two adjacent moments satisfies t k+1 = inf{t>t k||e(t)|≥ι 1 |v(t)|+ι 2}, update the control input ρ(t k ); where 0 < ι 1 <1, ι 2 >0.
[0008] In one embodiment, the state constraint function is expressed as:
[0009]
[0010] in, is a positive constant, x i The initial state of (t) satisfies x i (0)∈Ω i ,i=1,...,n.
[0011] In one embodiment, the virtual controller α is obtained based on the backstepping method and finite time stability theory. 1 and α 2 ,in
[0012] and The adaptive law is: i=1,2; is the output signal of the first-order filter below; σ 2 Is a positive number.
[0013] In one embodiment, the first-order filter is: where α 1 For virtual controller.
[0014] In one embodiment, the dynamic model of the single-link robotic arm is: Where q represents the position of the robot arm, F represents the input power, M represents the mechanical inertia, N represents the viscosity coefficient, R=mgL, m represents the load mass, g represents the acceleration due to gravity, and L represents the length of the connecting rod.
[0015] In one embodiment, the control objectives include: d =0.1sin(t); the controller includes: ρ(t)=(1-ι 1 )α 2 .
[0016] The control method provided by the present invention can effectively reduce the communication burden of the control system, and can ensure fast and high-precision tracking control of the desired state within a limited time, thereby ensuring that the position and speed of the single-link robotic arm meet the constraint conditions. BRIEF DESCRIPTION OF THE DRAWINGS
[0017] By reading the following detailed description with reference to the accompanying drawings, the above and other objects, features and advantages of the exemplary embodiments of the present invention will become readily understood. In the accompanying drawings, several embodiments of the present invention are shown in an exemplary and non-limiting manner, and the same or corresponding reference numerals represent the same or corresponding parts, wherein:
[0018] Figure 1 is the state x 1 and the desired state y d curve;
[0019] Figure 2 is the state x 2 curve;
[0020] Figure 3 is the tracking error |x 1 -y d |curve;
[0021] Figure 4 is the trigger condition and trigger time interval curve; and
[0022] Figure 5 is the control force curve. DETAILED DESCRIPTION
[0023] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative work are within the scope of protection of the present invention.
[0024] It should be understood that when the terms "first", "second", etc. are used in the claims, descriptions, and drawings of the present invention, they are only used to distinguish different objects, rather than to describe a specific order. The terms "include" and "comprise" used in the description and claims of the present invention indicate the presence of the described features, wholes, steps, operations, elements, and / or components, but do not exclude the presence or addition of one or more other features, wholes, steps, operations, elements, components, and / or their collections.
[0025] In one embodiment, for a single-link robotic arm, its dynamic model is:
[0026]
[0027] Where q represents the position of the robot arm, F represents the control input, and M = 1 kg m 2is the mechanical inertia, N = 1N·m·s / rad is the viscosity coefficient, R = mgL, where m = 1kg is the load mass, g = 10N / kg is the gravity acceleration, and L = 1m is the connecting rod length.
[0028] The method of this embodiment includes:
[0029] Step 1: First determine the control objectives, which include: d =0.1sin(t); According to the above kinetic model, let x 1 =qsum The dynamic system of the single-link robot arm can be expressed as:
[0030] where f 2 (x) = -x 2 -10sinx 1 ; x(0) = [-0.5, 0] T Indicates the initial position.
[0031] Step 2: Establish the state constraint function.
[0032] When controlling a single-link robot arm, consider the position x of the single-link robot arm. 1 and speed x 2 Needs to be satisfied
[0033]
[0034] where κ i and are the upper and lower bounds for position and velocity.
[0035] Establish state constraint function: in is a positive constant, x i The initial state of (t) satisfies x i (0)∈Ω i ,i=1,...,n.
[0036] According to the above formula, we can get in
[0037] Furthermore, we can get x i (t) = γ i χ i (t),i=1,2;
[0038] Step 3: Controller design.
[0039]
[0040] tk+1 = inf{t>t k ||e(t)|≥ι 1 |v(t)|+ι 2}
[0041] Where e(t)=ρ(t)-v(t),0<ι 1 <1 and ι 2 >0 is the parameter to be designed.
[0042] Furthermore, there are In the time interval t∈[t k ,t k+1 )Inside, and The time-varying parameters related to the event trigger mechanism satisfy
[0043] Therefore, we can get:
[0044] According to the above formula, we can get:
[0045] In actual application scenarios, specific parameters can be designed according to specific circumstances. For example, the specific parameters include: 21 =0.002,λ 22 =0.02, κ 1 =1.5, κ 2 =1.4,β=0.3, δ=0.5,∈=0.1,δ=0.5,∈=0.1,ι 1 =0.1,l 2 =0.1; and then the controller of the single-link robotic arm is obtained as:
[0046]
[0047] in
[0048]
[0049] and The adaptive law is: i=1,2.
[0050] Figures 1 to 5The simulation results according to the embodiments of the present invention are shown. It can be seen from the simulation results that the control method can make the closed-loop system semi-globally finite-time stable, so that the system can track the desired trajectory within a finite time, and each state satisfies the constraint conditions. The control method of the present invention is applied to a single-link manipulator. Under the premise of effectively reducing the communication load of the control system, it can not only ensure the fast and high-precision tracking control of the desired state within a finite time, but also ensure that the position and speed of the single-link manipulator meet the constraint conditions.
[0051] From the control theory, the control method of the present invention relates to a finite time event triggered tracking control method for nonlinear uncertain systems under asymmetric full state constraints. The backstepping method has been proven to be an effective controller design method. Since the method was first proposed by scholar Kanellakopouls in 1991, it has played an important role in multi-input multi-output systems and single-input single-output systems. However, when the nonlinear system is an incompletely known system, the backstepping method is no longer applicable. Therefore, in the past few decades, fuzzy logic systems (FLSs) and neural networks (NNs) have been used in the design of adaptive backstepping controllers due to their good nonlinear approximation capabilities. It is worth pointing out that the repeated differentiation of virtual control inputs in traditional backstepping control methods may lead to the problem of "computational expansion". If this problem is not handled correctly, it will inevitably increase the online computing burden and even lead to a decrease in the performance of the control system. Dynamic surface control technology is an effective way to overcome this shortcoming. In recent years, some research results on adaptive control of nonlinear uncertain systems based on dynamic surface control technology have been reported. However, it is worth noting that these designed adaptive backstepping controllers do not consider the constraints of the controlled system. In fact, due to physical limitations, safety issues and performance constraints, the constraints of various engineering systems exist in different forms such as full-state constraints, dead zeros, input saturation, input-output constraints, etc., and these constraints bring new challenges to system control.
[0052] The control method of the present invention is demonstrated from the perspective of control theory, including:
[0053] Step 1: Establish a nonlinear system model with unknown nonlinear terms.
[0054]
[0055] in, is the system status, and is the system input and output, f i (x), i=1,...,n, j=1,...,n-1 are unknown nonlinear terms of the system. Consider that the system is fully controllable and all states of the system are subject to constraints.
[0056] Step 2: Establish state constraint function.
[0057]
[0058] in is a positive constant, x i The initial state of (t) satisfies x i (0)∈Ω i ,i=1,...,n.
[0059] According to the above formula, we can get
[0060] in,
[0061] Further, we can get:
[0062] x i (t) = γ i χ i (t),i=1,2,...,n;
[0063] Step 3: Establish event triggering mechanism.
[0064] Where e(t)=ρ(t)-v(t),0<ι 1 <1 and ι 2 >0 is the parameter to be designed.
[0065] Further:
[0066] In the time interval t∈[t k ,t k+1 )Inside, and The time-varying parameters related to the event trigger mechanism satisfy and
[0067]
[0068] Therefore, it can be obtained;
[0069] Right now
[0070] Step 4: Define the following coordinate transformation
[0071] z 1 = x 1 -ξ 1
[0072] z i = xi -ξ i ,i=2,...,n
[0073] s i =ξ i -α i-1 , i=2,...,n;
[0074] in ξ i is the output signal of the following first-order filter, which is designed as where α i-1 is virtual control, σ i Is a positive number.
[0075] Step 5: Design virtual controller α 1 .
[0076] By designing a Lyapunov function of the following form
[0077]
[0078] Get the virtual controller as
[0079]
[0080] where sgn β (z 1 )=sign(z 1 )|z 1 | β , >0 is a positive number, λ 11 >0 and λ 12 >0 positive number.
[0081] Step 6. Design virtual controller α i i=2,…n-1.
[0082] By designing a Lyapunov function of the following form
[0083]
[0084] The virtual control controller is
[0085]
[0086] Step 7. Design virtual controller α n and the controller ρ(t).
[0087] By designing a Lyapunov function of the following form
[0088]
[0089] The virtual control controller is
[0090]
[0091] According to the obtained virtual controller α n The controller ρ(t)=(1-ι 1 )α n ; where ι 1 >0 is a positive number.
[0092] According to the above proof process, in the embodiment of the present invention, α n =α 2 .
[0093] The technical features of the above-described embodiments may be arbitrarily combined. To make the description concise, not all possible combinations of the technical features in the above-described embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.
[0094] The above-mentioned embodiments only express several implementation methods of the present invention, and the description thereof is relatively specific and detailed, but it cannot be understood as limiting the scope of the patent application. It should be pointed out that, for a person of ordinary skill in the art, several variations and improvements can be made without departing from the concept of the present invention, and these all belong to the protection scope of the present invention. Therefore, the protection scope of the patent of the present invention shall be subject to the attached claims.
Claims
1. A control method for a single-link robotic arm, wherein the control method is based on a dynamic model of the single-link robotic arm, It is characterized in that The control method comprises: Get the control target of the output end of the single-link manipulator, which includes the position y at the corresponding time t d ; Establish state constraint functions based on the position and velocity of the single-link manipulator; According to the state constraint function and the control target, a controller is established based on an event trigger mechanism and a backstepping method, wherein the controller includes: Wherein, ρ is the control input, k and k+1 represent two adjacent moments; and The time-varying parameters related to the event trigger mechanism satisfy and ι 1 , ι 2 is the parameter to be designed; when the input power difference e(t) between two adjacent moments satisfies t k+1 = inf{t>t k ||e(t)|≥ι 1 |v(t)|+ι 2 }, update the control input ρ(t k );where 0<ι 1 <1, ι 2 >0; The establishment state constraint function is expressed as: in, is a positive constant, x i The initial state of (t) satisfies x i (0)∈Ω i ,i=1,…,n; The virtual controller α is obtained by using the backstepping method and finite time control theory. 1 and α 2 ,in, and The adaptive law is: is the output signal of the first-order filter below; σ 2 Is a positive number.
2. The control method according to claim 1, It is characterized in that The first-order filter is: where α 1 For virtual controller.
3. The control method according to claim 2, It is characterized in that The dynamic model of the single-link robotic arm is: Where q represents the position of the robot arm, F represents the input control force, M represents the mechanical inertia, N represents the viscosity coefficient, R = mgL, m represents the load mass, g represents the acceleration due to gravity, and L represents the length of the connecting rod.
4. The control method according to claim 3, It is characterized in that The control objectives include: d =0.1sin(t); the controller includes: ρ(t)=(1-ι 1 )α 2 .
Citation Information
Patent Citations
Fixed time fault-tolerant control method of nonlinear system based on event triggering
CN113359469A
Trajectory tracking control method for single-joint mechanical arm system under multi-target constraint
CN113534666A
