CN113534666B - Trajectory tracking control method of single-joint mechanical arm system under multi-target constraint - Google Patents
Trajectory tracking control method of single-joint mechanical arm system under multi-target constraint Download PDFInfo
- Publication number
- CN113534666B CN113534666B CN202110866514.5A CN202110866514A CN113534666B CN 113534666 B CN113534666 B CN 113534666B CN 202110866514 A CN202110866514 A CN 202110866514A CN 113534666 B CN113534666 B CN 113534666B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- joint mechanical
- law
- arm system
- following
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
The invention provides a track tracking control method of a single-joint mechanical arm system under preset performance, which is based on the current situation that few researches are based on a fuzzy state observer, a fixed time command filter triggered by a self-adaptive event and a barrier Lyapunov function method are combined and applied to a nonlinear system of a single-joint mechanical arm, the track tracking control is researched by taking the nonlinear system with typical repeated motion, such as the single-joint mechanical arm, as an object, and compared with a finite time algorithm, the track tracking control method has higher convergence speed; compared with the general self-adaptive backstepping control, the method can reduce the communication burden and the calculation amount, so that the method has higher engineering practical value for the research of the single-joint mechanical arm.
Description
Technical Field
The invention relates to a control method of a single-joint mechanical arm system, in particular to a track tracking control method of the single-joint mechanical arm system under multi-target constraint.
Background
The mechanical arm is an important component of the joint robot, plays an important role in the fields of industry, manufacturing industry, national defense and military and the like, can be used for production operation in various environments with high cost, danger and complexity of alternative manpower, and gradually goes to practicality in various fields through years of research and development, for example: (1) In the civil field, for example, the etiquette robot provides welcome service, navigation information service, talent performance and the like for the public; (2) In the industrial field, such as mechanical arms for welding and reinforcing screws on an automobile production line, a rapid brick-moving and building robot on a construction site, a conveying and packaging conveying in a warehouse, an assembling robot and the like; (3) In special fields, such as explosive disposal and dangerous work for national defense and military, armed police, troops and the like; (4) The aerospace field, such as replacing human beings to clamp and mount objects in an outer space workstation. With the wide application of multi-joint mechanical arms in robots, in order to achieve comprehensive optimization of performance indexes of multi-joint mechanical arms (controlled systems), an optimal control method of the multi-joint mechanical arms gradually becomes a key point of design of the joint robots.
The self-adaptive backstepping control method is an effective algorithm capable of processing the control problem of a nonlinear system, and is mainly applied to the tracking control problem of the system. The backstepping method is actually a design method which recurs from front to back, wherein the introduced virtual control is essentially a static compensation idea, and the front subsystem must achieve the purpose of stabilization through the virtual control of the back subsystem. In practical systems, there are mostly unknown functions, and the unknown terms can be approximated by using a fuzzy logic system or a neural network. Meanwhile, in a backstepping frame, because the problem of complexity explosion of calculated amount is generated by repeated derivation of a virtual control signal, the problem is perfectly solved by introducing a dynamic surface control technology, G.Sun et al combines an adaptive fuzzy technology with DSC to eliminate the influence of uncertain nonlinearity in a system, however, the method does not consider the influence of first-order filtering error; farrell et al further propose a command filtering technique to reduce the influence of filtering errors by constructing an error compensation mechanism, but the above back-step controller based on command filtering can only achieve asymptotic stability.
Unlike asymptotic control methods, finite time control methods can ensure that tracking errors converge to a balance point quickly, and recently, y. -x.li et al have studied the finite time command filtering backstepping situation of uncertain nonlinear systems, in which the set convergence time is closely related to the initial state, but once the initial state is far from the balance point, the convergence time may be ineffective. At present, M.Chen et al firstly researches an adaptive actual fixed time tracking algorithm of a strict feedback nonlinear system, the predicted convergence time of the algorithm is irrelevant to an initial value, and a natural problem is that: how to extend these conventional non-linear controls to account for the communication burden. By introducing an event trigger control strategy, communication burden can be effectively relieved, waste of unnecessary communication resources is reduced, and W.Yang et al further solve the problem of fixed time control based on event trigger, but still cannot ignore the influence of constraint conditions in an actual system.
Related constraint problems typically occur in engineering instances such as cranes, articulated robots, etc. If these constraint problems are not properly addressed, it may degrade the performance of the system. However, the problem of multi-objective constraints has not led to much research. For example: in the material conveying process, the shortest distance and the lowest transportation cost proposed by J.Liu et al belong to multi-target constraints, so that a basic control method becomes more interesting and challenging, L.Liu et al further provides self-adaptive finite time control of a nonlinear system with multi-target constraints, and finally the stability of the system is ensured by utilizing a Lyapunov stability theory, so that the track tracking control of the single-joint mechanical arm is realized.
In summary, few studies are currently conducted on the basis of a fuzzy state observer, and a fixed-time command filter triggered by an adaptive event and a barrier Lyapunov function method are combined and applied to a nonlinear system of a single-joint mechanical arm.
Disclosure of Invention
In view of this, the present invention provides a self-adaptive fixed time command filtering tracking control strategy combining a state observer and a barrier lyapunov function for a non-strict feedback nonlinear system with multi-target constraint and an unmeasured state, and specifically provides a trajectory tracking control method for a single-joint mechanical arm system under multi-target constraint.
In order to achieve the purpose, the technical scheme adopted by the invention is as follows: the track tracking control method of the single-joint mechanical arm system under multi-target constraint comprises the following steps:
and 5, introducing an event trigger strategy to reduce the communication burden on the basis of the steps, so that the single-joint mechanical arm system meets the actual fixed time stability condition, and the track tracking control of the single-joint mechanical arm system is completed.
Further, step 1 specifically includes:
step 1.1, firstly, according to a system structure diagram of the single-joint mechanical arm, establishing a nonlinear mathematical model of the single-joint mechanical arm as follows:
whereinq represents the acceleration, velocity and position of the stick, respectively, v represents the torque induced by the power subsystem, u represents the control input, D =1.5kg m 2 Represents mechanical inertia, B =1Nms/rad is represented inA viscous friction coefficient at the joint, H =1 Ω represents armature resistance, M = H represents armature inductance, and L =0.2Nm/a represents a back electromotive force coefficient;
step 1.2, define the system state variable x 1 = q, system statusx 3 And = ν, and the output signal y of the single-joint mechanical arm control system = q, the nonlinear model of the single-joint mechanical arm system can be represented as follows:
wherein f is 1 (x)=0,g 1 (x 1 )=1,f 2 (x)=-10sin(x 1 )-x 2 ,g 2 (x 2 )=1,f 3 (x)=-0.2x 2 -x 3 ,g 3 (x 3 )=1;f 1 (x),f 2 (x),f 3 (x),g 1 (x 1 ),g 2 (x 2 ) And g 3 (x 3 ) Are all in the domain of definitionA non-linear function with fully smooth inner surface and satisfying g 1 (x 1 )≠0,g 2 (x 2 ) Not equal to 0 and g 3 (x 3 )≠0;
Step 1.3, representing the nonlinear model of the single-joint mechanical arm system as a state space model as follows:
in the formula (I), the compound is shown in the specification,K=(k 1 ,k 2 ,k 3 ) T ,B i =(0,1,0) T ,B=(0,0,1) T ,C=(1,00); a is a strict Hurwitz matrix, and by choosing the appropriate K, there is a positive definite matrix Q = Q T >0,P=P T Is greater than 0 and satisfies A T P+PA=-Q;
Step 1.4, setting the corresponding state observer as follows:
based on the fuzzy logic rules, we can get:
in the formula of i Which represents the minimum approximation error, is,represents the optimal weight vector, if anySatisfy the requirement of
Step 1.5, constructing a corresponding Lyapunov function as:
derivation of this can yield:
further, step 2 specifically includes:
step 2.1, the barrier function is designed as follows:
wherein the content of the first and second substances,m i (i = 1.... N) represents a weighting coefficient;
step 2.2, defining the following coordinate transformation:
z 1 (t)=ξ-y d ,
where xi is the barrier function, z i As systematic state error, y d As a reference signal, the reference signal is,to compensate for error signals, eta i An error compensation signal;
step 2.3, the following error compensation mechanism is introduced to solve the filtering errorThe influence of (a):
whereinIs the output signal of a first-order filter, alpha i Input signal, beta, representing a first order filter i > 0 is a time constant; eta i (0)=0,χ j,1 =1(j=2,...,n),k i1 >0,k i2 > 0 is a design parameter;
constructing the Lyapunov functionWhereinIn order to estimate the error for the parameter,at the same time to V 1 The derivation can be:
where τ > 0, the above formula can be substituted:
law of virtual controlAnd law of parameter adaptationAndwherein k is 11 ,k 12 ,τ,σ 1 ,c 1 ,r 1 ,Are all normal numbers;
the virtual control law and the parameter adaptive law are brought into the following conditions:
Further, step 3 specifically includes:
combining the state space model of the single-joint mechanical arm system in the step 2 and the coordinate transformation, the following can be obtained:
And introducing an error compensation signal to solve the influence of filtering errors:
constructing a second Lyapunov function for ensuring the stability of the single-joint mechanical arm system:
the derivation of which is:
replacing the corresponding formula can be:
law of virtual controlAnd law of parameter adaptationAndwherein k is 21 ,k 22 ,τ,σ 2 ,c 2 ,r 2 ,Are all normal numbers;
the virtual control law and the parameter adaptive law are brought into being available:
Further, step 4 specifically includes:
the state space model and the coordinate transformation of the single-joint mechanical arm system combined with the steps can obtain:
and introducing an error compensation signal to solve the influence of filtering errors:
constructing a third Lyapunov function for ensuring the stability of the single-joint mechanical arm system:the derivation of which is:
before setting the actual event-triggered controller u, the virtual control law α is set as follows 4 And law of parameter adaptation
Further, step 5 specifically includes:
defining the event trigger error as P (t) = v (t) -u (t)
Wherein, the first and the second end of the pipe are connected with each other,ρ,μ 1 ,μ 2 are all normal numbers and satisfyt k ,k∈z + Representing an input update time;
at interval time t k ,t k+1 In the method, | v (t) -u (t) | < τ | u (t) | + μ is obtained based on the event-triggered control strategy 2 The controller u is set asWhereinThe following can be obtained:
compared with the prior art, the invention has the beneficial effects that: the invention takes a nonlinear system with typical repeated motion, such as a single-joint mechanical arm, as an object to carry out the research of track tracking control, and has faster convergence speed compared with a finite time algorithm; compared with the general self-adaptive backstepping control, the method can reduce the communication burden and the calculation amount, so that the method has higher engineering practical value for the research of the single-joint mechanical arm.
Drawings
FIG. 1 is a diagram of the structure of a single joint robotic arm system and its force analysis;
FIG. 2 is a flow chart diagram of a trajectory tracking control method of a single-joint mechanical arm system under multi-target constraint according to the invention;
FIG. 3 is a trace of the output signal, the observation signal and the reference signal of the single joint mechanical arm;
FIG. 4 is a schematic view of a tracking error for a single joint robotic arm.
Detailed Description
In order to make the objects, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be described clearly and completely with reference to the accompanying drawings in the present invention, and it is obvious that the described embodiments are some embodiments of the present invention, but not all embodiments, and all other embodiments obtained by a person of ordinary skill in the art based on the embodiments of the present invention without creative efforts belong to the protection scope of the present invention.
A track tracking control method of a single-joint mechanical arm system under multi-target constraint is shown in figure 2 and comprises the following steps:
and 5, introducing an event trigger strategy to reduce the communication burden on the basis of the steps, so that the system meets the actual fixed time stability condition, namely completing the track tracking control of the single-joint mechanical arm system.
The technical scheme of each step is explained in detail as follows:
step 1.1, firstly, according to a structure diagram of a single-joint mechanical arm system, as shown in fig. 1, establishing a nonlinear mathematical model of the single-joint mechanical arm as follows:
whereinq represents the acceleration, velocity and position of the stick, v represents the torque induced by the power subsystem, u represents the control input, D =1.5kg m 2 Representing mechanical inertia, B =1Nms/rad representing the viscous friction coefficient at the joint, H =1 Ω representing the armature resistance, M = H representing the armature inductance, L =0.2Nm/a representing the back emf coefficient;
step 1.2, define the system state variable x 1 = q, system statusx 3 = ν order output signal y of single-joint mechanical arm control system = q, then the nonlinear model of the single-joint mechanical arm system can be expressed as follows
Wherein f is 1 (x)=0,g 1 (x 1 )=1,f 2 (x)=-10sin(x 1 )-x 2 ,g 2 (x 2 )=1,f 3 (x)=-0.2x 2 -x 3 ,g 3 (x 3 )=1;f 1 (x),f 2 (x),f 3 (x),g 1 (x 1 ),g 2 (x 2 ) And g 3 (x 3 ) Are all thatIn the definition domainA non-linear function with fully smooth inner surface and satisfying g 1 (x 1 )≠0,g 2 (x 2 ) Not equal to 0 and g 3 (x 3 )≠0;
Step 1.3, considering that some state variables in the system may be unobservable, a fuzzy state observer needs to be designed to estimate these unobservable states. Thus, the above system can be expressed as the following state space equation:
K=(k 1 ,k 2 ,k 3 ) T ,B i =(0,1,0) T ,B=(0,0,1) T C = (1,0,0). A is a strict Hurwitz matrix, and by choosing the appropriate K, there is a positive definite matrix Q = Q T >0,P=P T > 0 satisfies A T P+PA=-Q
Step 1.4, setting the corresponding state observer as follows:
Based on the fuzzy logic rules, we can get:
in the formula of i Which represents the minimum approximation error, is,represents the optimal weight vector, if anySatisfy the requirement of
Step 1.5, constructing a corresponding Lyapunov function as:
derivation of this can yield:
step 2.1, the barrier function is designed as follows:
wherein the content of the first and second substances,m i (i = 1.... N) represents a weighting coefficient; the appropriate weighting coefficients are chosen to ensure that the overall objective function is constrained within a specified range. Since I is x 1 In the open set Ω, the initial value I (0) is in the domain. If it is usedOrξ → ∞. Briefly, theI also follows the constraint as long as ξ is guaranteed to be bounded.
Thus, the constraint problem of satisfying the objective function can translate into guaranteeing the boundedness of ξ.
Derivation of I yields:
whereinAndat the same time, χ can be deduced 1,0 Not equal to 0. If x 1,1 Not equal to 0, then x 1,1 =χ 1,0 sign(χ 1,0 )。
As long as I = x 1 Then the multi-objective constraint problem is transformed into an output constraint, which is the content of the constraint studied in engineering.
Step 2.2, the following coordinate transformation is defined:
z 1 (t)=ξ-y d ,
where xi is the barrier function, z i As systematic state error, y d As a reference signal, the reference signal is,to compensate for error signals, η i Is an error compensation signal.
Step 2.3, the first order command filter is required to be introduced in the applicationTo overcome the defect of the existing framework based on the self-adaptive backstepping method that the virtual control signal alpha is subjected to i To reduce the corresponding computational burden. However, the filtering error caused by the first order command filter is mostly ignored in the existing resultsWhen we introduce the following error compensation mechanism to solve the filtering errorIn whichIs a first order filter output signal, alpha i Input signal, beta, representing a first order filter i > 0 is a time constant.
Wherein eta i (0)=0,χ j,1 =1(j=2,...,n),k i1 >0,k i2 > 0 is a design parameter.
constructing the Lyapunov functionWhereinIn order to estimate the error for the parameter,at the same time to V 1 Derivation can be obtained:
the Lyapunov function is selected according to the Lyapunov function selected by the similar reference:
where τ > 0, the above formula can be substituted:
law of virtual controlAnd law of parameter adaptationAndwherein k is 11 ,k 12 ,τ,σ 1 ,c 1 ,r 1 ,Are all normal numbers;
the virtual control law and the parameter adaptive law are brought into being available:
combining the state space model of the single-joint mechanical arm system in the step 2 with coordinate transformation:
And introducing an error compensation signal to solve the influence of filtering errors:
constructing a second Lyapunov function for ensuring the stability of the single-joint mechanical arm system:
the derivation of which is:
the corresponding formula would be substituted:
law of virtual controlAnd law of parameter adaptationAndwherein k is 21 ,k 22 ,τ,σ 2 ,c 2 ,r 2 ,Are all normal numbers;
the virtual control law and the parameter adaptive law are brought into being available:
the state space model and the coordinate transformation of the single-joint mechanical arm system combined with the steps can obtain:
and introducing an error compensation signal to solve the influence of filtering errors:
constructing a third Lyapunov function for ensuring the stability of the single-joint mechanical arm system:
the derivation of which is:
before setting the actual event trigger controller u, the following virtual control law α is set in the present application 4 And law of parameter adaptation
by introducing an event trigger control strategy based on a relative threshold value, the corresponding communication burden and the waste of communication resources are reduced.
The relative threshold based event-triggered control strategy is described in detail below:
t k+1 =inf{t∈R||P(t)|≥τ|u(t)|+μ 2 }
defining an event trigger error P (t) = v (t) -u (t), 0 < τ < 1, ρ, μ 1 ,μ 2 Are all normal numbers and satisfyt k ,k∈z + Representing the input update time. It is noted that at time t e t k ,t k+1 ) U can be regarded as v (t) k ),
Each time t k+1 =inf{t∈R||P(t)|≥τ|u(t)|+μ 2 When triggered, the time instant will be marked as t k+1 Actual control input u (t) k+1 ) Will be applied to the system. Therefore, we can find the parameter l satisfying the following equation 1 (t),l 2 (t):
v(t)=(1+l 1 (t)τ)u+l 2 (t)μ 2
Wherein | l 1 (t)|≤1,|l 2 (t) | ≦ 1, thus giving the controller:
at interval time t k ,t k+1 In the method, based on the event trigger control strategy, | v (t) -u (t) | < tau | u (t) | + mu can be obtained 2 The controller u is set asWhereinThe following can be obtained:
wherein M is 3 =M 2 +0.557ρ;
based on the theory 3: h n ∈R,i=1,...,n,κ∈[0,1]
(|H 1 |+…+|H n |) κ ≤|H 1 | κ +…+|H n | κ
And (4) introduction: x is a radical of a fluorine atom 1 ,y 2 Represents an arbitrary variable, k 1 ,k 2 And B represents an arbitrary constant, and B represents,
here τ 1 =0.11;
Definition ofAccording toAnd applying lemmas 2 and 3 as above, the above formula can be converted to:
at this time, it is assumed that there is an unknown constantSatisfy the requirement ofThe following two cases were analyzed:
Thus can obtain
Summarizing the above two cases can be found:
According to the theory 5: if V (x) is a positive definite function and has the form
In the formula 1 ,φ 2 Each of α, β, γ represents a normal number, and satisfies α γ ∈ (0,1), β γ ∈ (1, ∞), ρ > 0.
It can be demonstrated that the origin of the system has reached actual fixed time stability (the advantage of actual fixed time stability as chosen herein has the advantage that the convergence time can be predicted normally regardless of the initial conditions, as opposed to asymptotic stability or finite time stability).
Referring to the existing literature, the parameters were selected as followsβ =2 and γ =1 are more convenient for practical design.
Therefore, the single-joint mechanical arm system can meet the actual fixed time stability condition.
The design goal of the present application is to design the controller u such that the output signal y can be constrained to a limited range (k) c1 ,k c2 ) Internal simultaneous tracking reference signal y d And ensures the tracking error z 1 The convergence to the small neighborhood range of zero in a fixed time interval effectively reduces the calculated amount and accelerates the convergence speed; the tracking tracks of the output signal, the observation signal and the reference signal of the single-joint mechanical arm are shown in fig. 3. A schematic of the tracking error for a single joint robotic arm is shown in fig. 4.
The track tracking control research is carried out by taking a typical repeated motion nonlinear system such as a single-joint mechanical arm as an object, and compared with a finite time algorithm, the track tracking control research has higher convergence rate; compared with the general self-adaptive backstepping control, the method can reduce the communication burden and the calculated amount, so that the method has higher engineering practical value for the research of the single-joint mechanical arm.
The previous description of the disclosed embodiments is provided to enable any person skilled in the art to make or use the present invention. Various modifications to these embodiments will be readily apparent to those skilled in the art, and the generic principles defined herein may be applied to other embodiments without departing from the spirit or scope of the invention. Thus, the present invention is not intended to be limited to the embodiments shown herein but is to be accorded the widest scope consistent with the principles and novel features disclosed herein.
Claims (1)
1. The track tracking control method of the single-joint mechanical arm system under multi-target constraint is characterized by comprising the following steps of:
step 1, establishing a state space model of a single-joint mechanical arm according to a mathematical model of a single-joint mechanical arm system, constructing a corresponding state observer to estimate an unmeasured state, and finally performing luggage Jaconov stability analysis by referring to an observation error system;
the step 1 specifically comprises the following steps:
step 1.1, firstly, according to a system structure diagram of the single-joint mechanical arm, establishing a nonlinear mathematical model of the single-joint mechanical arm as follows:
whereinq represents the acceleration, velocity and position of the stick, respectively, v represents the torque induced by the power subsystem, u represents the control input, D =1.5kg m 2 Representing mechanical inertia, B =1Nm s/rad representing the viscous friction coefficient at the joint, H =1 Ω representing the armature resistance, M = H representing the armature inductance, L =0.2Nm/a representing the back emf coefficient;
step 1.2, define the system state variable x 1 = q, system statusx 3 And = ν, and let the output signal y of the single-joint mechanical arm control system = q, the nonlinear model of the single-joint mechanical arm system can be represented as follows:
wherein f is 1 (x)=0,g 1 (x 1 )=1,f 2 (x)=-10sin(x 1 )-x 2 ,g 2 (x 2 )=1,f 3 (x)=-0.2x 2 -x 3 ,g 3 (x 3 )=1;
f 1 (x),f 2 (x),f 3 (x),g 1 (x 1 ),g 2 (x 2 ) And g 3 (x 3 ) Are all in the domain of definitionA non-linear function with fully smooth inner surface and satisfying g 1 (x 1 )≠0,g 2 (x 2 ) Not equal to 0 and g 3 (x 3 )≠0;
Step 1.3, representing the nonlinear model of the single-joint mechanical arm system as a state space model as follows:
in the formula (I), the compound is shown in the specification,K=(k 1 ,k 2 ,k 3 ) T ,B i =(0,1,0) T ,B=(0,0,1) T c = (1,0,0); a is a strict Hurwitz matrix, and by choosing the appropriate K, there is a positive definite matrix Q = Q T >0,P=P T Is greater than 0 and satisfies A T P+PA=-Q;
Step 1.4, setting the corresponding state observer as follows:
based on fuzzy logic rules, we can get:
in the formula of i Which represents the minimum approximation error, is,represents the optimal weight vector, if anySatisfy the requirements of
Step 1.5, constructing a corresponding Lyapunov function as:
derivation of this can yield:
Step 2, according to the state space model of the single-joint mechanical arm system established in the step 1, introducing a barrier function to solve the problem of multi-target constraint, constructing a first Lyapunov function, and setting a corresponding virtual control law and a parameter self-adaptation law;
the step 2 specifically comprises the following steps:
step 2.1, the barrier function is designed as follows:
wherein the content of the first and second substances,m i i = 1.. And n denotes a weighting coefficient;
step 2.2, the following coordinate transformation is defined:
z 1 (t)=ξ-y d ,
where xi is the barrier function, z i As systematic state error, y d As a reference signal, to be used as a reference signal,to compensate for error signals, eta i An error compensation signal;
step 2.3, the following error compensation mechanism is introduced to solve the filteringWave errorThe influence of (a):
whereinIs the output signal of a first-order filter, alpha i Input signal, beta, representing a first order filter i > 0 is a time constant; eta i (0)=0,χ j,1 =1(j=2,...,n),k i1 >0,k i2 > 0 is a design parameter;
constructing the Lyapunov functionWhereinIn order to estimate the error for the parameter,at the same time to V 1 The derivation can be:
where τ > 0, the above formula can be substituted:
law of virtual controlAnd law of parameter adaptationAndwherein k is 11 ,k 12 ,τ,σ 1 ,c 1 ,r 1 ,Are all normal numbers;
the virtual control law and the parameter adaptive law are brought into being available:
Step 3, constructing a second Lyapunov function according to the state space model of the single-joint mechanical arm system established in the step 1, and setting a corresponding virtual control law and a corresponding parameter self-adaptive law;
the step 3 specifically comprises the following steps:
combining the state space model of the single-joint mechanical arm system in the step 2 and the coordinate transformation, the following can be obtained:
And introducing an error compensation signal to solve the influence of filtering errors:
constructing a second Lyapunov function for ensuring the stability of the single-joint mechanical arm system:
the derivation of which is:
replacing the corresponding formula can be:
law of virtual controlAnd law of parameter adaptationAndwherein k is 21 ,k 22 ,τ,σ 2 ,c 2 ,r 2 ,Are all normal numbers;
the virtual control law and the parameter adaptive law are brought into being available:
Step 4, constructing a third Lyapunov function according to the state space model of the single-joint mechanical arm system established in the step 1, and setting a corresponding virtual control law and a corresponding parameter self-adaptive law;
the step 4 specifically comprises the following steps:
the state space model and the coordinate transformation of the single-joint mechanical arm system combined with the steps can obtain:
and introducing an error compensation signal to solve the influence of filtering errors:
constructing a third Lyapunov function for ensuring stability of the single-joint mechanical arm systemThe derivation of which is:
before setting the actual event-triggered controller u, the virtual control law α is set as follows 4 And law of parameter adaptation
Step 5, introducing an event trigger strategy to reduce the communication burden on the basis of the steps, so that the single-joint mechanical arm system meets the actual fixed time stability condition, and the track tracking control of the single-joint mechanical arm system is completed;
the step 5 specifically comprises the following steps:
defining the event trigger error as P (t) = v (t) -u (t)
Wherein, the first and the second end of the pipe are connected with each other,ρ,μ 1 ,μ 2 are all normal numbers and satisfyt k ,k∈z + Representing an input update time;
at interval time t k ,t k+1 ) In the method, | v (t) -u (t) | < τ | u (t) | + μ is obtained based on the event-triggered control strategy 2 The controller u is set asWhereinThe following can be obtained:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110866514.5A CN113534666B (en) | 2021-07-29 | 2021-07-29 | Trajectory tracking control method of single-joint mechanical arm system under multi-target constraint |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110866514.5A CN113534666B (en) | 2021-07-29 | 2021-07-29 | Trajectory tracking control method of single-joint mechanical arm system under multi-target constraint |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113534666A CN113534666A (en) | 2021-10-22 |
CN113534666B true CN113534666B (en) | 2023-03-03 |
Family
ID=78089743
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110866514.5A Active CN113534666B (en) | 2021-07-29 | 2021-07-29 | Trajectory tracking control method of single-joint mechanical arm system under multi-target constraint |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113534666B (en) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114003002B (en) * | 2021-11-01 | 2024-02-20 | 南京师范大学 | Finite time tracking control method for six-degree-of-freedom hydraulic manipulator |
CN114114928B (en) * | 2021-12-01 | 2024-05-07 | 吉林大学 | Fixed time self-adaptive event trigger control method for piezoelectric micro-positioning platform |
CN114488791B (en) * | 2021-12-15 | 2023-07-21 | 西北工业大学 | Teleoperation event triggering fixed time control method based on intention understanding of operator |
CN114310894B (en) * | 2021-12-31 | 2023-09-01 | 杭州电子科技大学 | Measurement output feedback control method of fourth-order uncertain nonlinear mechanical arm system |
CN114851198B (en) * | 2022-05-17 | 2023-05-16 | 广州大学 | Consistent tracking fixed time stable control method for multiple single-link mechanical arms |
CN114932561B (en) * | 2022-07-26 | 2022-10-14 | 珞石(北京)科技有限公司 | Robot single joint position control method |
CN116141339B (en) * | 2023-04-19 | 2023-07-21 | 珞石(北京)科技有限公司 | Seven-degree-of-freedom mechanical arm preset time track tracking control method |
CN116880165B (en) * | 2023-05-30 | 2024-01-30 | 济宁医学院 | Model reference self-adaptive finite time control method of non-contact suspension grabbing system |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108519740A (en) * | 2018-05-05 | 2018-09-11 | 曲阜师范大学 | A kind of cooperative control method of total state constraint mechanical arm track following |
CN108845493A (en) * | 2018-08-21 | 2018-11-20 | 曲阜师范大学 | The set time tracking and controlling method of mechanical arm system with output constraint |
CN110262255A (en) * | 2019-07-16 | 2019-09-20 | 东南大学 | A kind of mechanical arm Trajectory Tracking Control method based on adaptive terminal sliding mode controller |
CN110687787A (en) * | 2019-10-11 | 2020-01-14 | 浙江工业大学 | Mechanical arm system self-adaptive control method based on time-varying asymmetric obstacle Lyapunov function |
CN112817231A (en) * | 2020-12-31 | 2021-05-18 | 南京工大数控科技有限公司 | High-precision tracking control method for mechanical arm with high robustness |
CN113110059A (en) * | 2021-04-26 | 2021-07-13 | 杭州电子科技大学 | Control method for actual tracking of single-link mechanical arm system based on event triggering |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102114068B1 (en) * | 2018-04-19 | 2020-05-25 | 한국과학기술연구원 | Computed-torque based controller, and its parameter determination and performance analysis methods |
CN110275435B (en) * | 2019-05-24 | 2022-07-05 | 广东工业大学 | Observer-based multi-single-arm manipulator output consistent adaptive command filtering control method |
CN112276954B (en) * | 2020-10-29 | 2021-11-09 | 青岛大学 | Multi-joint mechanical arm impedance control method based on limited time output state limitation |
-
2021
- 2021-07-29 CN CN202110866514.5A patent/CN113534666B/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108519740A (en) * | 2018-05-05 | 2018-09-11 | 曲阜师范大学 | A kind of cooperative control method of total state constraint mechanical arm track following |
CN108845493A (en) * | 2018-08-21 | 2018-11-20 | 曲阜师范大学 | The set time tracking and controlling method of mechanical arm system with output constraint |
CN110262255A (en) * | 2019-07-16 | 2019-09-20 | 东南大学 | A kind of mechanical arm Trajectory Tracking Control method based on adaptive terminal sliding mode controller |
CN110687787A (en) * | 2019-10-11 | 2020-01-14 | 浙江工业大学 | Mechanical arm system self-adaptive control method based on time-varying asymmetric obstacle Lyapunov function |
CN112817231A (en) * | 2020-12-31 | 2021-05-18 | 南京工大数控科技有限公司 | High-precision tracking control method for mechanical arm with high robustness |
CN113110059A (en) * | 2021-04-26 | 2021-07-13 | 杭州电子科技大学 | Control method for actual tracking of single-link mechanical arm system based on event triggering |
Non-Patent Citations (1)
Title |
---|
关于机器人的机械臂对目标轨迹跟踪优化控制;石佳玉等;《计算机仿真》;20161231;第33卷(第12期);第338-341、389页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113534666A (en) | 2021-10-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113534666B (en) | Trajectory tracking control method of single-joint mechanical arm system under multi-target constraint | |
CN110170992B (en) | Multi-fault-tolerant control method for modular mechanical arm based on dynamic programming | |
Chang et al. | Adaptive fuzzy backstepping tracking control for flexible robotic manipulator | |
CN112817231B (en) | High-precision tracking control method for mechanical arm with high robustness | |
CN109514564B (en) | Optimal control method for composite quadratic multi-joint mechanical arm | |
CN110673472B (en) | Adaptive robust control method based on neural network compensation dead zone inversion error | |
CN110687796B (en) | Neural network-based adaptive finite time command filtering backstepping control method | |
Zhang et al. | Command filter-based finite-time adaptive fuzzy control for nonlinear systems with uncertain disturbance | |
CN108555914B (en) | DNN neural network self-adaptive control method based on tendon-driven dexterous hand | |
Chen et al. | Robust adaptive inverse dynamics control for uncertain robot manipulator | |
Jin et al. | Observer-based fixed-time tracking control for space robots in task space | |
Vo et al. | An output feedback tracking control based on neural sliding mode and high order sliding mode observer | |
Koofigar | Adaptive tracking with external force disturbance rejection for uncertain robotic systems | |
CN113359443A (en) | Composite anti-interference control method of generalized time-lag Markov jump system | |
Wang et al. | Co-ordinated control of multiple robotic manipulators handling a common object—theory and experiments | |
CN114063457A (en) | Event-triggered fault-tolerant control method for mechanical arm system | |
Alavandar et al. | New hybrid adaptive neuro-fuzzy algorithms for manipulator control with uncertainties–Comparative study | |
CN116141333A (en) | Joint space trajectory tracking control method for serial mechanical arms | |
Abdel-Salam et al. | Fuzzy logic controller design for PUMA 560 robot manipulator | |
Zhu et al. | Online parameter estimation for uncertain robot manipulators with fixed-time convergence | |
CN113296398A (en) | Command filtering control method of flexible single-chain mechanical arm based on event triggering | |
Asl et al. | Prescribed performance velocity field control of robotic exoskeletons with neural network | |
Macnab | Neural-adaptive backstepping for flexible-joint robots with neither extra parameters, extra networks, nor robust terms | |
Chen et al. | Neural network compensator-based robust iterative learning control scheme for mobile robots nonlinear systems with disturbances and uncertain parameters | |
Liu et al. | Adaptive fuzzy sliding mode control for collaborative robot based on nominal model |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |