CN112148036A - Bilateral tracking control method of fixed time estimator of networked robot system - Google Patents
Bilateral tracking control method of fixed time estimator of networked robot system Download PDFInfo
- Publication number
- CN112148036A CN112148036A CN202010953886.7A CN202010953886A CN112148036A CN 112148036 A CN112148036 A CN 112148036A CN 202010953886 A CN202010953886 A CN 202010953886A CN 112148036 A CN112148036 A CN 112148036A
- Authority
- CN
- China
- Prior art keywords
- robot
- fixed time
- time
- estimator
- networked
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 39
- 230000002146 bilateral effect Effects 0.000 title claims abstract description 32
- 230000000694 effects Effects 0.000 claims abstract description 5
- 239000011159 matrix material Substances 0.000 claims description 47
- 238000013459 approach Methods 0.000 claims description 26
- 230000003993 interaction Effects 0.000 claims description 26
- 230000014509 gene expression Effects 0.000 claims description 8
- 230000001133 acceleration Effects 0.000 claims description 6
- 230000003190 augmentative effect Effects 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims 1
- 230000009286 beneficial effect Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 6
- 230000008859 change Effects 0.000 description 3
- 230000002860 competitive effect Effects 0.000 description 3
- 238000013461 design Methods 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 230000009471 action Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 239000003795 chemical substances by application Substances 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000002250 progressing effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
The invention discloses a bilateral tracking control method of a fixed time estimator of a networked robot system, which has the beneficial effect of realizing bilateral tracking control of the networked robot system in fixed time. Firstly, the bilateral tracking control method is popularized to a networked robot system, and is mainly applied to the practical problems that the networked robot system is divided into two groups to execute opposite tasks and the like; secondly, the invention provides a fixed time control framework for researching a complex robot system, so that the time required for completing a control target has a clear and knowable range, and the control margin is increased; finally, a robot dynamic model with external disturbance and uncertain control parameters is considered, and the condition that a networked robot system is possibly interfered under the working condition is simulated, so that the control effect is more practical.
Description
Technical Field
The invention relates to the field of intelligent control of robots, in particular to a bilateral tracking control method of a fixed time estimator of a networked robot system.
Background
In recent years, research on cooperative control of networked robot systems has been rapidly progressing. Networked robotic systems are a group of controllable autonomous robots that can accomplish single or multiple complex tasks through local communication. Networked robotic systems can accomplish more complex tasks and use a more efficient and flexible approach than a single robot. Therefore, the control of the networked robot system is widely applied to various fields such as industrial production, medical treatment, aerospace, deep sea exploration, military and the like.
In addition, the distributed control algorithm of multi-agent using networked robot system as carrier has also been widely used, among which the control methods widely studied by the scholars include single-target and multi-target tracking control method, formation and contained control method, bilateral tracking control method including competition and cooperation relation, etc. In a real networked robot system, the connection between the robots is in a cooperative and competitive relationship. Therefore, the control method considered by the patent effectively solves the bilateral tracking problem and has better practical application value.
In a real networked system, a robot is usually required to complete a task within a set time range to improve the efficiency and accuracy of task completion. Therefore, the convergence time required for control is also an important control performance. Among them, the limited time control and the fixed time control are developed most rapidly. The difference between the two is that the convergence time of the finite time control depends on the initial value, whereas the convergence time of the fixed time control is not affected by the initial value. This patent uses a control method based on a fixed time estimator. A method of time base signal generator is used in the estimation layer. Convergence over a fixed time is achieved by adjusting the gain of the generator with the time base signal. The method can control the robot to complete the task within a determined time range, and increases the control margin.
Therefore, in combination with the above requirements of industrial practical application, it is of great significance to design a bilateral tracking control method based on a fixed time estimator for a networked robot system.
Disclosure of Invention
The technical problem to be solved by the present invention is to provide a bilateral tracking control method for a fixed time estimator of a networked robot system, aiming at the bilateral tracking problem of the cooperation and competition relationship between robots which are less considered in the prior art and the problem of completing a control task within a fixed time.
The technical scheme adopted by the invention for solving the technical problems is as follows: a bilateral tracking control method of a fixed time estimator of a networked robot system is constructed, and the bilateral tracking control method comprises the following steps:
s1, performing dynamic modeling on the ith robot in the networked robot system comprising N robots, and constructing a dynamic model:
wherein M isi(qi) A positive definite inertial matrix is represented,denotes the Coriolis centrifuge matrix, gi(qi) Representing a matrix of gravitation, di(t) denotes input disturbance, τiRepresents a control input; q. q.si、Andrespectively representing the position, the speed and the acceleration of the ith robot in a joint space; t represents time; i represents the number of the robot;
setting the (i + 1) th robot as a tracking target, wherein the state information of the tracking target comprises a position q0Velocity v0And acceleration u0Satisfy the following requirements
S2, K. FDescribing information interaction relations among robots by using a symbolic topological graph G { V, E, A }, wherein V { 1., N } represents a vertex set consisting of N robots, and the vertices are used for representing the robots;representing a set of edges connecting any two robots, and being used for representing the direction of information interaction between the robots; a ═ aij]A weight matrix composed of adjacent elements and used for representing the value of mutual information between robots; if the j-th robot and the i-th robot have interaction and cooperative relationship, aijIs greater than 0; if the j-th robot and the i-th robot have interaction and are in competition relationship, aij< 0, otherwise, aij0; and the ith robot itself has no self-circulation connection, i.e. aii=0;
Define diagonal matrix D ═ diag (D)1,d2,...dN),diThe method belongs to +/-1 }, meets the condition that DAD is a semi-positive definite matrix, and divides all robots into two parts to respectively execute opposite tasks; when the robot belongs to the first group, d i1 is ═ 1; when the robot belongs to the second group, di-1; adding a tracking target robot into the directed symbol topological graph G, and defining the graph as an augmented graph G; using the matrix B ═ ai0]A value representing the information interaction between the virtual leader and the robot, a if there is an interaction between the virtual leader and the roboti0Is greater than 0; if there is no interaction between the virtual leader and the robot, then ai0=0。
S3, designing a distributed controller based on a fixed time estimator according to the robot dynamics model established in the step S1 and the directed symbolic topological graph established in the step S2;
the distributed controller comprises a local control layer with fixed time and an estimation layer with fixed time;
the estimation layer of the fixed time is used for obtaining estimation values of the joint position and the joint speed of the ith robot, and the estimation values are obtained through the position information, the movement speed information and the information interaction numerical value of the ith robot and the adjacent robot;
the estimated values of the joint position and the velocity of the ith robot are further input into a local control layer of the fixed time, and the control layer is used for enabling the actual joint position and the actual velocity of the ith robot to converge to the estimated values obtained by the fixed time estimation layer.
And S4, a double-layer control structure consisting of an estimation layer with fixed time and a local control layer with fixed time, and controlling the actual joint position and speed of the ith robot to reach the expected joint position and speed, thereby realizing the bilateral tracking control of the networked robot system.
Further, for the estimation layer of the fixed time in step S3, the corresponding control gain η of the fixed time is designed1(t)、η2(t), the fixed time is mainly realized by a time-base signal generator TBG, and the method comprises the following two steps:
designing a TBG function:
the TBG function is a piecewise time varying function, tfIs an artificially set convergence time point, and the convergence time required by the function control is designed to be tfWithin;
designing a control gain function comprising a TBG function:
wherein,1,2is a normal number and satisfies 0<1,2≤1,MD=DAD+B,InIs an n-dimensional identity matrix, H is a positive definite diagonal matrix, such that MDH is a positive definite matrix, HmaxRepresents the maximum of the diagonal elements of the H matrix,representation matrixThe minimum eigenvalue of (c).
Further, for the position q of the i-th robot in the joint space required in step S1iAnd velocityDesigning a fixed-time state estimator in the mathematical form:
wherein,estimates of positions in joint space for robots i and j;estimates of the velocity in joint space for robots i and j, c1、c2Constant control gain, control gain of fixed time being eta respectively1(t) and η2(t);
Position error of state estimator combined with fixed timeAnd speed errorWhereinThe mathematical form of the fixed-time state estimator translates into:
further, a slip form surface S of a fixed time is designed for the dynamic model obtained in step S1iController tau to assist in designing joint spaceiSaid slip form surface s of fixed timeiThe mathematical expression of (a) is:
wherein the position error between the estimated value and the true valueAnd speed errorAre respectively as K1i、K2iRespectively, are positive definite diagonal matrices,n is the number of joints of the robot,0<Δ≤1,0<p<1, l>1。
further, the controller τ of the joint space of the fixed time is designed for the dynamic model obtained in step S1iThe mathematical expression of (a) is:
wherein, tauiIs composed of three parts: tau isi0An equivalent control term, τ, associated with the robot dynamics modeli1Non-linear term, τ, representing the effect of fixed time controli2Representing a control term for counteracting the external disturbance;an estimated value of joint velocity obtained for a fixed time controller; mi0、Ci0、gi0Are respectively Mi、Ci、giThe expected value of (d); k. b0、b1、b2Is a normal number;is composed ofFunction to variableAnd converts the form of the column vector into the form of a diagonal matrix,is composed ofFunction to variableAnd converts the form of the column vector into the form of a diagonal matrix.
Further, in step S3, specifically, the method includes:
s31, and controller tau of joint space with fixed timeiSubstituting the kinetic model constructed in S1, and adding the fixed-time state estimator, a closed-loop system is obtained as follows:
wherein, K0iIs a positive definite diagonal matrix, and r is a constant satisfying r>1, rho (t) is a disturbance term and an uncertain term in a robot dynamic model,ΔMi(qi)、Δgi(qi) Are respectively Mi(qi)、gi(qi) Uncertainty of term, di(t) is a perturbation term;
s32, analyzing the stability of the state estimator with fixed time in the closed loop system in S31;
constructing a Lyapunov function for errors in position and velocity of the robot in the closed-loop system:
and deriving the time of the Lyapunov by:
therefore, the error of the position and the speed obtained by the correlation theory of the TBG function can be converged into an adjustable boundary within a set time range, and the following conditions are met:
wherein,1、2for autonomous setting of a constant, T, for adjusting the error rangef1、Tf2Respectively setting time in a TBG function in the position estimator and the speed estimator, so that the control time is in a set time range, namely the stability analysis of the fixed time state estimator is completed;
s33, analyzing the stability of a robot dynamic state controller (a controller of a joint space with fixed time) in the closed-loop system S31;
for a fixed time synovial surface siConstructing the Lyapunov functionAnd derived along the trajectory of said closed loop system
According to the theory of fixed time, obtainWithin, s i0; the dynamics of the error system of joint position and velocity are translated into
Further, the discussion is divided into two casesThe time required to converge to the set small constant Δ.
Further, in step S4, the analysis of the fixed time state estimator and the analysis of the robot dynamic state controller (i.e. the controller of the joint space at the fixed time) are respectively performed on the closed-loop system according to the double-layer control structure composed of the fixed time estimation layer and the fixed time local control layer, so as to obtain the fixed time T at the set time Tf1+Tf2+Ts+TeWhen the robot i belongs to the first group: position stateI.e. qiApproach toApproaches to q0Velocity stateI.e. viApproach toApproaches to v0(ii) a When robot i belongs to the second group: position stateI.e. qiApproach toApproaches to-q0Velocity stateI.e. viApproach toApproaches to-v0Therefore, bilateral tracking control of the networked robot system is realized.
In summary, the bilateral tracking control method of the fixed time estimator of the networked robot system according to the present invention is implemented by a layered control structure, and defines an estimation layer of fixed time and a local control layer for the robot, and in consideration of the relationship between the robots, which is both cooperative and competitive, in the estimation layer of fixed time, the estimation layer is used to simplify the complex data required by the control process and to achieve convergence within the fixed time, thereby increasing the control margin; the local control layer is designed, the robot can track an estimated value within a fixed time through the auxiliary design of the slide film surface, the dynamic model of the corresponding robot is accurately measured under the condition of combined action of the estimation layer and the control layer, and the measurement accuracy is further improved through the stability analysis of the steps S32 and S33, the control cost of a multi-robot system is reduced, and the working efficiency is improved.
The bilateral tracking control method based on the fixed time estimator and suitable for the networked robot system has the following beneficial effects that:
1. the practical problems of change of model parameters, external disturbance and the like in a robot dynamics model are considered, and the practicability of research results is higher;
2. the coexistence of cooperation and competition is considered in the information interaction between the robots, so that the bilateral tracking control method has universal applicability;
3. the designed control algorithm comprises two layers of control, the control cost of the multi-robot system is reduced, and the working efficiency is improved.
Drawings
The invention will be further described with reference to the accompanying drawings and examples, in which:
FIG. 1 is a control flow diagram of a control method proposed by the present invention;
FIG. 2 is a directed topology network of a networked robotic system to which the present invention relates;
FIG. 3 is a simplified model of the physical structure of a robot contemplated by the present invention;
FIG. 4 is a trajectory tracking diagram of actual and estimated positions of a networked robotic system in accordance with the present invention;
FIG. 5 is a trajectory tracking diagram of actual and estimated velocities of a networked robotic system in accordance with the present invention;
FIG. 6 is a graph of actual position tracking errors for a networked robotic system in accordance with the present invention;
FIG. 7 is a graph of position tracking error for an estimator of a networked robotic system in accordance with the present invention;
FIG. 8 is a diagram of position tracking errors at the local control layer of a networked robotic system in accordance with the present invention;
fig. 9 is a graph of actual velocity tracking error for the networked robotic system of the present invention.
Detailed Description
For a more clear understanding of the technical features, objects and effects of the present invention, embodiments of the present invention will now be described in detail with reference to the accompanying drawings.
Please refer to fig. 1, which is a control flow chart of the control method of the present invention, specifically including the following steps:
s1, performing dynamics modeling on the ith robot (specifically, refer to fig. 3) in the networked robot system including N robots, and constructing a dynamics model:
wherein M isi(qi) A positive definite inertial matrix is represented,denotes the Coriolis centrifuge matrix, gi(qi) Representing a matrix of gravitation, di(t) denotes input disturbance, τiRepresents a control input; q. q.si、Andrespectively representing the position, the speed and the acceleration of the ith robot in a joint space; t represents time; i represents the ith robot which is the index mark of the robot;
the following table shows the physical parameters of the arm, k ∈ {1,2 }.
These physical parameters are substituted into the intermediate variables of the kinetic model, the expressions for the intermediate variables are given as follows:
further solving a matrix required by the dynamic model, and giving an expression of the matrix:
the state information of the tracking target includes a position q0Velocity v0And acceleration u0Satisfy the following requirements Selecting
S2, establishing a directed symbol topological graph G ═ { V, E, A } to describe information interaction relations among the robots, wherein V ═ 1.. and N } represents a vertex set consisting of N robots, and the vertices are the robots;representing a set of edges connecting any two robots, and being used for representing the direction of information interaction between the robots; a ═ aij]A weight matrix composed of adjacent elements and used for representing the value of mutual information between robots; if the j-th robot and the i-th robot have interaction and cooperative relationship, aijIs greater than 0; if the j-th robot and the i-th robot have interaction and are in competition relationship, aij< 0, otherwise, aij0; and the ith robot itself has no self-circulation connection, i.e. aii0. Define diagonal matrix D ═ diag (D)1,d2,...dN),diE { ± 1}, making DAD a semi-positive definite matrix, and dividing all robots into two parts to perform the opposite task, respectively. When the robot belongs to the first group, d i1 is ═ 1; when the robot belongs to the second group, diIs-1. Defined as an augmented graphAnd adding a virtual leader, namely a tracking target, into the directed symbol topological graph G. Using the matrix B ═ ai0]A numerical value representing the information interaction between the virtual leader and the robot. If there is an interaction between the virtual leader and the robot, then ai0Is greater than 0; if there is no interaction between the virtual leader and the robot, then ai00. Referring to FIG. 2, robots 1-8 are divided into two groups and join virtual leader robot 0, robots 1-4 belong to sub-network A, robots 5-8 belong to sub-network B, robots are in cooperative relationship within the group and in competitive relationship between the groups.
S3, designing a distributed controller based on a fixed time estimator according to the robot dynamics model established in the step S1 and the directed symbolic topological graph established in the step S2;
the distributed controller comprises a local control layer with fixed time and an estimation layer with fixed time;
the estimation layer of the fixed time is used for obtaining estimation values of the joint position and the joint speed of the ith robot, and the estimation values are obtained through the position information, the movement speed information and the information interaction numerical value of the ith robot and the adjacent robot;
the estimated values of the joint position and the velocity of the ith robot are further input into a local control layer of the fixed time, and the control layer is used for enabling the actual joint position and the actual velocity of the ith robot to converge to the estimated values obtained by the fixed time estimation layer.
And S4, a double-layer control structure consisting of an estimation layer with fixed time and a local control layer with fixed time, and controlling the actual joint position and speed of the ith robot to reach the expected joint position and speed, thereby realizing the bilateral tracking control of the networked robot system.
Designing the corresponding fixed-time control gain eta for the fixed-time estimation layer in the step S31(t)、η2(t) implementation by means of a time-base signal generator TBGThe timing is specifically divided into two steps:
designing a TBG function:
the TBG function is a piecewise time varying function, tfIs an artificially set convergence time point, and the convergence time required by the function control is designed to be tfWithin;
designing a control gain function comprising a TBG function:
wherein,1,2is a normal number and satisfies 0<1,2≤1,MD=DAD+B,InIs an n-dimensional identity matrix, H is a positive definite diagonal matrix, such that MDH is a positive definite matrix, HmaxRepresents the maximum of the diagonal elements of the H matrix,representation matrixThe minimum eigenvalue of (c).
For the position q of the i-th robot in the joint space required in step S1iAnd velocityDesigning a fixed-time state estimator in the mathematical form:
wherein,estimates of positions in joint space for robots i and j;estimates of the velocity in joint space for robots i and j, c1、c2Constant control gain, control gain of fixed time being eta respectively1(t) and η2(t);
Position error of state estimator combined with fixed timeAnd speed errorWhereinThe mathematical form of the fixed-time state estimator translates into:
designing a sliding mode surface S with fixed time for the dynamic model obtained in step S1iController tau to assist in designing joint spaceiSaid slip form surface s of fixed timeiThe mathematical expression of (a) is:
wherein the position error between the estimated value and the true valueAnd speed errorAre respectively as K1i、K2iRespectively, are positive definite diagonal matrices,n is the number of joints of the robot,0<Δ≤1,0<p<1, l>1。
design of a constant-time joint space controller τ for the dynamic model obtained in step S1iThe mathematical expression of (a) is:
wherein, tauiIs composed of three parts: tau isi0An equivalent control term, τ, associated with the robot dynamics modeli1Non-linear term, τ, representing the effect of fixed time controli2Representing a control term for counteracting the external disturbance;an estimated value of joint velocity obtained for a fixed time controller; mi0、Ci0、gi0Are respectively Mi、Ci、giThe expected value of (d); k. b0、b1、b2Is a normal number;is composed ofFunction to variableAnd converts the form of the column vector into the form of a diagonal matrix,is composed ofFunction to variableAnd converts the form of the column vector into the form of a diagonal matrix.
Step S3 specifically includes:
s31, and controller tau of joint space with fixed timeiSubstituting the kinetic model constructed in S1, and adding the fixed-time state estimator, a closed-loop system is obtained as follows:
wherein, K0iIs a positive definite diagonal matrix, and r is a constant satisfying r>1, rho (t) is a disturbance term and an uncertain term in a robot dynamic model,ΔMi(qi)、Δgi(qi) Are respectively Mi(qi)、gi(qi) Uncertainty of term, di(t) is a perturbation term;
s32, analyzing the stability of the state estimator with fixed time in the closed loop system in S31;
constructing a Lyapunov function for errors in position and velocity of the robot in the closed-loop system:
and deriving the time of the Lyapunov by:
therefore, the error of the position and the speed obtained by the correlation theory of the TBG function can be converged into an adjustable boundary within a set time range, and the following conditions are met:
wherein,1、2for autonomous setting of a constant, T, for adjusting the error rangef1、Tf2Respectively setting time in a TBG function in the position estimator and the speed estimator, so that the control time is in a set time range, namely the stability analysis of the fixed time state estimator is completed;
s33, analyzing the stability of a robot dynamic state controller (a controller of a joint space with fixed time) in the closed-loop system S31;
construction of Lyapunov function for fixed-time sliding mode surfaceAnd derived along the trajectory of said closed loop system
According to the theory of fixed time, obtainWithin, s i0; so the dynamics of the error system of position and velocity are transformed into
Further, the discussion is divided into two casesThe time required to converge to the set small constant Δ.
When in useError in selecting joint positionLyapunov function Vca2In the same way, the time is derived
In step S4, the analysis of the fixed time state estimator and the analysis of the robot dynamic state controller (i.e. the controller of the joint space at the fixed time) are respectively performed on the closed-loop system according to the double-layer control structure composed of the fixed time estimation layer and the fixed time local control layer, so as to obtain the fixed time T at the set time Tf1+Tf2+Ts+TeWhen the robot i belongs to the first group: position stateI.e. qiApproach toApproaches to q0Velocity stateI.e. viApproach toApproaches to v0(ii) a When robot i belongs to the second group: position stateI.e. qiApproach toApproaches to-q0Velocity stateI.e. viApproach toApproaches to-v0Therefore, bilateral tracking control of the networked robot system is realized.
The required control parameters are as follows: p is 0.5, q is 1.2, r is 1.5, k is 1, b0=12,b1=2.8,b2=0.5,1=0.01,2=0.01,c1=0.01,c2=1,K0i=diag(4,3),K1i=diag(2,2),K2i=diag(2,2),
Please refer to fig. 4 to fig. 9 for simulation results.
Wherein, fig. 4 is a track tracing diagram of the actual position and the estimated position of the networked robot system according to the present invention, which respectively shows that the proposed control method enables the position of the robot joint to reach the expected position within a fixed time and the proposed estimation layer of the fixed time enables the estimated position of the robot joint to reach the expected position within the fixed time;
FIG. 5 is a trajectory tracking diagram of the actual and estimated velocities of the networked robotic system in accordance with the present invention, respectively illustrating that the proposed control method enables the velocity of the robotic joint to reach the desired velocity in a fixed time and the proposed estimation horizon of the fixed time enables the estimated velocity of the robotic joint to reach the desired velocity in a fixed time;
FIG. 6 is a graph of actual position tracking error for a networked robotic system in accordance with the present invention, showing that the actual position tracking error can trend toward 0 over a fixed time;
FIG. 7 is a position tracking error plot of an estimator of a networked robotic system in accordance with the present invention, showing that the position tracking error of a fixed time estimation layer can go to 0 over a fixed time;
FIG. 8 is a position tracking error map of the local control layer of the networked robotic system in accordance with the present invention, illustrating that the position tracking error of the local control layer can go to 0 in a fixed time;
fig. 9 is a graph of the actual speed tracking error of the networked robotic system of the present invention, showing that the actual speed tracking error can go to 0 over a fixed time.
The invention provides a bilateral tracking control algorithm based on a fixed time estimator, which is suitable for a networked robot system, wherein the actual conditions of cooperation and competition among robots, external disturbance existing in a robot model and model parameter change are considered at the same time. The bilateral tracking control method based on the fixed time estimator has the following advantages:
1. the practical problems of change of model parameters, external disturbance and the like in a robot dynamics model are considered, and the practicability of research results is higher;
2. the coexistence of cooperation and competition is considered in the information interaction between the robots, so that the bilateral tracking control method has universal applicability;
3. the designed control algorithm comprises two layers of control, the control cost of the multi-robot system is reduced, and the working efficiency is improved.
While the present invention has been described with reference to the embodiments shown in the drawings, the present invention is not limited to the embodiments, which are illustrative and not restrictive, and it will be apparent to those skilled in the art that various changes and modifications can be made therein without departing from the spirit and scope of the invention as defined in the appended claims.
Claims (7)
1. The bilateral tracking control method of the fixed time estimator of the networked robot system is characterized in that: the method specifically comprises the following steps:
s1, performing dynamic modeling on the ith robot in the networked robot system comprising N robots, and constructing a dynamic model:
wherein M isi(qi) A positive definite inertial matrix is represented,denotes the Coriolis centrifuge matrix, gi(qi) Representing a matrix of gravitation, di(t) denotes input disturbance, τiRepresents a control input; q. q.si、Andrespectively representing the position, the speed and the acceleration of the ith robot in a joint space; t represents time; i represents the number of the robot;
setting the (i + 1) th robot as a tracking target, wherein the state information of the tracking target comprises a position q0Velocity v0And acceleration u0Satisfy the following requirements
S2, establishing a directed symbol topological graph G { V, E, A } to describe information interaction relations among robots, wherein V { 1.... N } represents a vertex set consisting of N robots, and the vertices are used for representing the robots;representing a set of edges connecting any two robots, and being used for representing the direction of information interaction between the robots; a ═ aij]A weight matrix composed of adjacent elements and used for representing the value of mutual information between robots; if the j-th robot and the i-th robot have interaction and cooperative relationship, aijIs greater than 0; if the j-th robot and the i-th robot have interaction and are in competition relationship, aij< 0, otherwise, aij0; and the ith robot itself has no self-circulation connection, i.e. aii=0;
Define diagonal matrix D ═ diag (D)1,d2,...dN),diBelongs to { +/-1 }, satisfies DAD as a semi-positive definite matrix, and divides all robots into two parts to respectively execute opposite tasks(ii) a When the robot belongs to the first group, di1 is ═ 1; when the robot belongs to the second group, di-1; adding a tracking target robot to the directed symbol topological graph G and defining the graph as an augmented graphUsing the matrix B ═ ai0]A value representing the information interaction between the virtual leader and the robot, a if there is an interaction between the virtual leader and the roboti0Is greater than 0; if there is no interaction between the virtual leader and the robot, then ai0=0;
S3, designing a distributed controller based on a fixed time estimator according to the robot dynamics model established in the step S1 and the directed symbolic topological graph established in the step S2;
the distributed controller comprises a local control layer with fixed time and an estimation layer with fixed time;
the estimation layer of the fixed time is used for obtaining estimation values of the joint position and the joint speed of the ith robot, and the estimation values are obtained through the position information, the movement speed information and the information interaction numerical value of the ith robot and the adjacent robot;
the estimated values of the joint position and the speed of the ith robot are further input into a local control layer of the fixed time, and the control layer is used for enabling the actual joint position and the speed of the ith robot to converge to the estimated values obtained by the fixed time estimation layer;
and S4, a double-layer control structure consisting of an estimation layer with fixed time and a local control layer with fixed time, and controlling the actual joint position and speed of the ith robot to reach the expected joint position and speed, thereby realizing the bilateral tracking control of the networked robot system.
2. The bilateral tracking control method of a fixed time estimator of a networked robot system according to claim 1, wherein:
designing the corresponding fixed-time control gain eta for the fixed-time estimation layer in the step S31(t)、η2(t), the fixed time is mainly realized by a time-base signal generator TBG, and the method comprises the following two steps:
designing a TBG function:
the TBG function is a piecewise time varying function, tfIs an artificially set convergence time point, and the convergence time required by the function control is designed to be tfWithin;
designing a control gain function comprising a TBG function:
wherein,1,2is a normal number and satisfies 0<1,2≤1,MD=DAD+B,InIs an n-dimensional identity matrix, H is a positive definite diagonal matrix, such that MDH is a positive definite matrix, HmaxRepresents the maximum of the diagonal elements of the H matrix,representation matrixIs determined by the minimum characteristic value of (c),representing the kronecker product.
3. The bilateral tracking control method of a fixed time estimator of a networked robot system according to claim 2, wherein:
for the position q of the i-th robot in the joint space required in step S1iAnd velocityDesigning a fixed-time state estimator in the mathematical form:
wherein,estimates of positions in joint space for robots i and j;estimates of the velocity in joint space for robots i and j, c1、c2Constant control gain, control gain of fixed time being eta respectively1(t) and η2(t);
Position error of state estimator combined with fixed timeAnd speed errorWhereinThe mathematical form of the fixed-time state estimator translates into:
4. the bilateral tracking control method of a fixed time estimator of a networked robot system according to claim 1, wherein:
designing a sliding mode surface S with fixed time for the dynamic model obtained in step S1iController tau to assist in designing joint spaceiSaid slip form surface s of fixed timeiThe mathematical expression of (a) is:
5. the bilateral tracking control method of a fixed time estimator of a networked robot system according to claim 4, wherein:
controller τ for designing joint space of fixed time for the kinetic model described in step S1iThe mathematical expression is as follows:
wherein, tauiIs composed of three parts: tau isi0An equivalent control term, τ, associated with the robot dynamics modeli1Non-linear term, τ, representing the effect of fixed time controli2Representing a control term for counteracting the external disturbance;an estimated value of joint velocity obtained for a fixed time controller; mi0、Ci0、gi0Are respectively Mi、Ci、giThe expected value of (d); k. b0、b1、b2Is a normal number;is composed ofFunction to variableAnd converts the form of the column vector into the form of a diagonal matrix,is composed ofFunction to variableAnd converts the form of the column vector into the form of a diagonal matrix.
6. The bilateral tracking control method of a fixed time estimator of a networked robot system according to claim 3, wherein:
step S3 specifically includes:
s31, and controller tau of joint space with fixed timeiSubstituting the kinetic model constructed in S1, and adding the fixed-time state estimator, a closed-loop system is obtained as follows:
wherein, K0iIs a positive definite diagonal matrix, and r is a constant satisfying r>1, rho (t) is a disturbance term and an uncertain term in a robot dynamic model,ΔMi(qi)、Δgi(qi) Are respectively Mi(qi)、gi(qi) Uncertainty of term, di(t) is a perturbation term;
s32, analyzing the stability of the state estimator with fixed time in the closed loop system in S31;
constructing a Lyapunov function for errors in position and velocity of the robot in the closed-loop system:
and the lyapunov is subjected to derivation on time to obtain:
by the relevant theorem of the TBG function, the position and speed errors of the robot in the closed-loop system can be converged into an adjustable boundary within a set time range, and the following requirements are met:
wherein,1、2for autonomous setting of a constant, T, for adjusting the error rangef1、Tf2Respectively time set in the TBG function in the position estimator and the speed estimator;
s33, analyzing the stability of the controller of the joint space with fixed time in the closed loop system in S31;
According to the theory of fixed time, it is obtained thatWithin, si0; the dynamics of the error system of joint position and velocity are translated into
Further, the two cases are dividedDiscussion of the related ArtThe time required to converge to a set constant Δ that approaches zero;
When in useError to joint positionSelecting the Lyapunov function Vca2In the same way, the time is derived
7. The bilateral tracking control method of a fixed time estimator of a networked robot system according to claim 1, wherein:
in step S4, the analysis of the fixed time state estimator and the analysis of the controller of the joint space at the fixed time are respectively performed on the closed-loop system according to the double-layer control structure composed of the fixed time estimation layer and the fixed time local control layer to obtain the fixed time Tf1+Tf2+Ts+TeWhen the robot i belongs to the first group: position stateI.e. qiApproach toApproaches to q0Velocity stateI.e. viApproach toApproaches to v0(ii) a When robot i belongs to the second group: position stateI.e. qiApproach toApproaches to-q0Velocity stateI.e. viApproach toApproaches to-v0Therefore, bilateral tracking control of the networked robot system is realized.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010953886.7A CN112148036B (en) | 2020-09-11 | 2020-09-11 | Bilateral tracking control method of fixed time estimator of networked robot system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010953886.7A CN112148036B (en) | 2020-09-11 | 2020-09-11 | Bilateral tracking control method of fixed time estimator of networked robot system |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112148036A true CN112148036A (en) | 2020-12-29 |
CN112148036B CN112148036B (en) | 2021-08-03 |
Family
ID=73890899
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010953886.7A Expired - Fee Related CN112148036B (en) | 2020-09-11 | 2020-09-11 | Bilateral tracking control method of fixed time estimator of networked robot system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112148036B (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113093554A (en) * | 2021-04-14 | 2021-07-09 | 西北工业大学 | Fixed Time Base Generator-based dynamic area tracking control method |
CN113359781A (en) * | 2021-05-26 | 2021-09-07 | 中国地质大学(武汉) | Networked surface vessel tracking control method, device, equipment and storage medium |
CN113400299A (en) * | 2021-05-19 | 2021-09-17 | 中国地质大学(武汉) | Networked robot cooperative control method, device, equipment and storage medium |
CN113625559A (en) * | 2021-07-28 | 2021-11-09 | 杭州电子科技大学 | Multi-agent system cooperative control method based on specified time convergence |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150134386A1 (en) * | 2013-11-08 | 2015-05-14 | Prachi Prasad Jogalekar | Collectively optimizing group schedules to minimize project completion time and cost |
CN107888412A (en) * | 2016-11-08 | 2018-04-06 | 清华大学 | Multi-agent network finite time contains control method and device |
CN108845493A (en) * | 2018-08-21 | 2018-11-20 | 曲阜师范大学 | The set time tracking and controlling method of mechanical arm system with output constraint |
CN109407520A (en) * | 2018-12-26 | 2019-03-01 | 南京航空航天大学 | The fault-tolerant consistency control algolithm of second order multi-agent system based on sliding mode control theory |
CN109471361A (en) * | 2018-12-17 | 2019-03-15 | 中国地质大学(武汉) | A kind of multiple target tracking control method of heterogeneous multi-robot system |
CN110083179A (en) * | 2019-05-07 | 2019-08-02 | 西北工业大学 | A kind of predetermined time multi-agent system consistency tracking and controlling method |
CN110119087A (en) * | 2019-05-05 | 2019-08-13 | 西北工业大学 | Second order multi-agent system consolidates timing consistency tracking under a kind of oriented communication |
CN110221542A (en) * | 2019-06-04 | 2019-09-10 | 西北工业大学 | A kind of second nonlinear multi-agent system set time collaboration tracking and controlling method |
US20190278291A1 (en) * | 2017-07-21 | 2019-09-12 | AI Incorporated | Polymorphic path planning for robotic devices |
CN111258214A (en) * | 2020-02-25 | 2020-06-09 | 西北工业大学 | Fixed-time consistency tracking method of high-order multi-agent system based on directed topology |
-
2020
- 2020-09-11 CN CN202010953886.7A patent/CN112148036B/en not_active Expired - Fee Related
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150134386A1 (en) * | 2013-11-08 | 2015-05-14 | Prachi Prasad Jogalekar | Collectively optimizing group schedules to minimize project completion time and cost |
CN107888412A (en) * | 2016-11-08 | 2018-04-06 | 清华大学 | Multi-agent network finite time contains control method and device |
US20190278291A1 (en) * | 2017-07-21 | 2019-09-12 | AI Incorporated | Polymorphic path planning for robotic devices |
CN108845493A (en) * | 2018-08-21 | 2018-11-20 | 曲阜师范大学 | The set time tracking and controlling method of mechanical arm system with output constraint |
CN109471361A (en) * | 2018-12-17 | 2019-03-15 | 中国地质大学(武汉) | A kind of multiple target tracking control method of heterogeneous multi-robot system |
CN109407520A (en) * | 2018-12-26 | 2019-03-01 | 南京航空航天大学 | The fault-tolerant consistency control algolithm of second order multi-agent system based on sliding mode control theory |
CN110119087A (en) * | 2019-05-05 | 2019-08-13 | 西北工业大学 | Second order multi-agent system consolidates timing consistency tracking under a kind of oriented communication |
CN110083179A (en) * | 2019-05-07 | 2019-08-02 | 西北工业大学 | A kind of predetermined time multi-agent system consistency tracking and controlling method |
CN110221542A (en) * | 2019-06-04 | 2019-09-10 | 西北工业大学 | A kind of second nonlinear multi-agent system set time collaboration tracking and controlling method |
CN111258214A (en) * | 2020-02-25 | 2020-06-09 | 西北工业大学 | Fixed-time consistency tracking method of high-order multi-agent system based on directed topology |
Non-Patent Citations (8)
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113093554A (en) * | 2021-04-14 | 2021-07-09 | 西北工业大学 | Fixed Time Base Generator-based dynamic area tracking control method |
CN113093554B (en) * | 2021-04-14 | 2022-07-05 | 西北工业大学 | Fixed Time Base Generator-based dynamic area tracking control method |
CN113400299A (en) * | 2021-05-19 | 2021-09-17 | 中国地质大学(武汉) | Networked robot cooperative control method, device, equipment and storage medium |
CN113400299B (en) * | 2021-05-19 | 2022-05-03 | 中国地质大学(武汉) | Networked robot cooperative control method, device, equipment and storage medium |
CN113359781A (en) * | 2021-05-26 | 2021-09-07 | 中国地质大学(武汉) | Networked surface vessel tracking control method, device, equipment and storage medium |
CN113359781B (en) * | 2021-05-26 | 2022-07-19 | 中国地质大学(武汉) | Networked surface vessel tracking control method, device, equipment and storage medium |
CN113625559A (en) * | 2021-07-28 | 2021-11-09 | 杭州电子科技大学 | Multi-agent system cooperative control method based on specified time convergence |
CN113625559B (en) * | 2021-07-28 | 2024-10-01 | 杭州电子科技大学 | Multi-agent system cooperative control method based on appointed time convergence |
Also Published As
Publication number | Publication date |
---|---|
CN112148036B (en) | 2021-08-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112148036B (en) | Bilateral tracking control method of fixed time estimator of networked robot system | |
CN110928310B (en) | Unmanned ship navigation following fixed time formation control method | |
CN110597061B (en) | Multi-agent fully-distributed active-disturbance-rejection time-varying formation control method | |
Wang et al. | Neural network based adaptive dynamic surface control for cooperative path following of marine surface vehicles via state and output feedback | |
CN112904728B (en) | Mechanical arm sliding mode control track tracking method based on improved approach law | |
CN113433955B (en) | Multi-AUV formation consistency control method under directed switching topology | |
CN113268064B (en) | Multi-mobile-robot cooperative formation control method considering communication time delay | |
CN110658821B (en) | Multi-robot anti-interference grouping time-varying formation control method and system | |
CN110471438B (en) | Fixed time self-adaptive attitude tracking control method for rigid aircraft | |
CN110543184B (en) | Fixed time neural network control method for rigid aircraft | |
CN112904723B (en) | Air-ground fixed time cooperative fault-tolerant formation control method under non-matching interference | |
CN115793453A (en) | Self-adaptive control method for tracking of rotorcraft by fusing AI deep learning | |
CN109062240B (en) | Rigid aircraft fixed time self-adaptive attitude tracking control method based on neural network estimation | |
CN108549210A (en) | Multiple no-manned plane based on BP neural network PID control cooperates with flying method | |
CN109976161A (en) | A kind of finite time optimization tracking and controlling method of uncertain nonlinear system | |
Aryankia et al. | Neural network-based formation control with target tracking for second-order nonlinear multiagent systems | |
CN112632876A (en) | Unmanned ship cooperative target tracking control method based on DMHE and DMPC | |
CN110488854B (en) | Rigid aircraft fixed time attitude tracking control method based on neural network estimation | |
CN114840003B (en) | Single-pilot multi-AUV co-positioning and track tracking control method | |
CN117369495A (en) | Unmanned aerial vehicle formation track planning method based on model predictive control | |
Enjiao et al. | Finite-time control of formation system for multiple flight vehicles subject to actuator saturation | |
CN116954258A (en) | Hierarchical control method and device for multi-four-rotor unmanned aerial vehicle formation under unknown disturbance | |
CN110095989B (en) | Distributed multi-Lagrange system tracking control strategy based on back stepping method | |
CN111515958A (en) | Network delay estimation and compensation method of robot remote control system | |
CN116382313A (en) | AUH cooperative formation control method considering communication limitation |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210803 |
|
CF01 | Termination of patent right due to non-payment of annual fee |