Prescribed-time distributed cooperative formation control method for multiple robots
By constructing a multi-robot dynamics model and introducing a virtual spring potential energy function, a time-varying gain gradient descent distributed controller was designed, which solved the problem of rapid formation reconfiguration of multi-robot systems in dynamic environments, and achieved precise formation control and efficient response within a specified time.
Patent Information
- Application Number
- PCT/CN2026/081526
- Authority / Receiving Office
- WO · WO
- Patent Type
- Applications
- Current Assignee / Owner
- Priority Date
- 2025-05-08
- Filing Date
- 2026-03-05
- Publication Date
- 2026-11-12
AI Technical Summary
Existing multi-robot cooperative formation control methods cannot accurately achieve formation goals within a limited time, especially in dynamic environments where response is lagging. Furthermore, centralized control architectures face problems such as limited communication bandwidth and exponentially increasing computational complexity in large-scale systems.
A distributed cooperative formation control method under specified time conditions is adopted. By constructing a multi-robot dynamics model, introducing a virtual spring potential energy function, designing a time-varying gain gradient descent distributed controller and a specified time controller, and using a regression matrix observer for parameter estimation and compensation, the robot system achieves accurate convergence and fast response.
Achieve precise formation control of multi-robot systems within a specified time, reduce communication load, increase system fault tolerance and scalability, adapt to complex dynamic environments, and provide real-time control assurance.
Smart Images

Figure CN2026081526_12112026_PF_FP_ABST
Abstract
Description
A Multi-Robot Distributed Cooperative Formation Control Method for a Specified Time Technical Field
[0001] This invention belongs to the field of intelligent agent collaborative work control technology, specifically relating to a multi-robot distributed collaborative formation control method under a specified time. Background Technology
[0002] Multi-robot cooperative formation control, as a core problem in the field of distributed intelligent system control, is widely used in defense, intelligent manufacturing, and automation fields such as ship formation navigation, underwater robot cooperative exploration, mobile robots, multi-manipulator precision assembly, and UAV swarm reconnaissance. Current typical control methods mainly include the following three theoretical frameworks: achieving state convergence through local interaction protocols, but its convergence rate is limited by the consistency control of the algebraic connectivity of the network topology; relying on preset trajectories to achieve formation tracking, but exhibiting single-point vulnerability and insufficient adaptability to dynamic environments—the leader-follower architecture; and methods based on fusion of obstacle avoidance and aggregation behavior rules, which, while possessing strong flexibility and capable of solving multi-agent systems under the nonlinear dynamics Eulerian-Lagrange framework commonly encountered in engineering practice, cannot guarantee system convergence time. Existing common methods face two major challenges: First, traditional asymptotic convergence mechanisms cannot accurately achieve formation targets within a finite time, especially in sudden mission scenarios, potentially leading to system response lag; second, centralized control architectures require global communication, high computing power, and strong hardware resources, facing problems such as limited communication bandwidth and exponentially increasing computational complexity in large-scale systems. For example, while the classic cooperative algorithm based on Lyapunov functions can guarantee asymptotic stability, its convergence time is strongly correlated with the initial state and design parameters, making it difficult to meet the stringent requirements of ±0.5mm synchronization accuracy for industrial handling and flexible assembly.
[0003] In summary, there is an urgent need for a new multi-robot distributed collaborative formation control method to effectively solve the problem of rapid reconfiguration of formation in complex dynamic environments such as dynamic obstacle avoidance of UAV swarms and collaborative work of multiple robotic arms, and to provide verifiable real-time control assurance for scenarios such as intelligent manufacturing and national defense reconnaissance. Summary of the Invention
[0004] To address the shortcomings of existing technologies, this invention proposes a multi-robot distributed cooperative formation control method within a specified time period, the method comprising:
[0005] S1: Obtain a robot system consisting of multiple robots and construct a multi-robot dynamics model;
[0006] S2: Construct the communication topology of the multi-robot formation and determine the desired formation pattern;
[0007] S3: Introduce virtual springs between robots to construct potential energy functions and calculate the formation error of the robot system;
[0008] S4: Design of a time-varying gain-based gradient descent distributed controller for the formation error of a robot system at the task level;
[0009] S5: Design of a controller for joint-level specified time based on the passive characteristics of Euler systems;
[0010] S6: Real-time estimation and compensation of unknown parameters of robot dynamics model to obtain online parameter estimation adaptive law based on time-varying gain;
[0011] S7: Obtain the overall formation controller based on the adaptive law of all controllers and online estimated parameters, and use the overall formation controller to realize distributed cooperative formation control of multiple robots.
[0012] The preferred multi-robot dynamics model is expressed as follows:
[0013]
[0014] in, Indicates the first The inertial matrix of the robot, Indicates the first The Coriolis force matrix of the robots Indicates the first The gravitational torque of the robot; This represents the total number of robots in the entire formation system. They represent the first The generalized joint rotation angles, velocities, and acceleration vectors of a robot. Indicates the first A known bounded compact set of constant system parameter vectors for a robot. Indicates the first The total control input vector of the robot.
[0015] Preferably, the desired formation of the robot system is represented as follows:
[0016]
[0017] in, This represents the set of desired formation patterns. Indicates by A robot A stacked global state vector in dimensional space. Represented as The identity matrix, Represents the rotation matrix of the desired formation transformation. For reference formation configuration, Let be the dimension of the Cartesian coordinate system. It is a translation vector. It is a column vector consisting entirely of 1s; Let be a rotation matrix in a special orthogonal group. Indicates by all A linear space consisting of a column of real vectors.
[0018] Preferably, the formation error of the robot system is obtained by scaling the original formation error in the task space using a time-varying gain function. The original formation error in the task space is expressed as:
[0019]
[0020] in, This represents the actual Euclidean distance corresponding to the k-th edge. This represents the expected distance corresponding to the k-th edge. for The original error signal in the task space corresponding to the k-th edge at time k;
[0021] The formation error of the robot system is expressed as:
[0022]
[0023] in, express The formation error corresponding to the k-th edge at time k. This represents the time-varying gain function.
[0024] Preferably, the control law of the task-level gradient descent distributed controller based on time-varying gain is expressed as:
[0025]
[0026] in, Indicates the first Control laws for a robot at the task level Indicates positive control gain. For the first The generalized Jacobian matrix of the robot after transformation by the linear regression matrix. Indicates the first The generalized joint rotation vector of a robot, Represents the actual vector of kinematic parameters. Represents the time t. The gradient vector of the potential energy function of a robot.
[0027] Preferably, the control law of the controller at the joint level for a specified time is expressed as follows:
[0028]
[0029] in, Indicates the first Control laws for a robot at the joint level Indicates the design control gain. Indicates the first The joint velocity vectors of the robot. Indicates the first The gravity vector of the robot system Indicates the first The generalized joint rotation vector of a robot, Indicates the first A known bounded compact set of constant system parameter vectors for a robot.
[0030] Preferably, the adaptive law for online estimation parameters based on time-varying gain is expressed as:
[0031]
[0032] in, Indicates the first Parameter estimates for each robot The time derivative vector, Represents the time-varying gain function. Indicates the first The linear regression matrix of the robots, Indicates the first The gradient vector of the potential energy function of each robot. This represents a positive design gain parameter. Indicates the first The generalized joint rotation vector of a robot, Indicates the first The kinematic parameter estimation vector of a robot Indicates the first The joint velocity vector of a robot.
[0033] Preferably, the formation master controller is represented as:
[0034]
[0035] in, Indicates the first The total control input vector of the robot Indicates positive control gain. Indicates the first The generalized Jacobian matrix of the robot after transformation by the linear regression matrix. Indicates the first The generalized joint rotation vector of a robot, Indicates the first The actual vector of the robot's kinematic parameters Represents the time t. The gradient vector of the potential energy function of each robot. Indicates the design control gain. Indicates the first The joint velocity vectors of the robot. Indicates the first The gravity vector of the robot system Indicates the first A known bounded compact set of constant system parameter vectors for a robot. Indicates the first Parameter estimates for each robot The time derivative vector, Represents the time-varying gain function. Indicates the first The kinematic regression matrix of the robot Indicates the design gain parameter. Indicates the first The kinematic parameter estimation vector of a robot.
[0036] The beneficial effects of this invention are as follows:
[0037] This invention addresses the problem of identifying unknown parameters in robot dynamics models by constructing a linear observer architecture based on a regression matrix. This observer, through the introduction of a time-varying gain mechanism, achieves global convergence of parameter estimation errors within a user-preset time interval. Compared to existing technologies, the proposed observer can achieve more accurate parameter estimation within a specified time, further improving the convergence speed of the observer.
[0038] Compared with existing technologies, this invention proposes a distributed cooperative formation control method for multi-agent systems under a specified time. The designed specified-time gradient descent controller achieves accurate convergence within a user-preset time. Through a distributed control architecture, cooperative parallel computing reduces communication load, while increasing the system's fault tolerance and scalability to node failures and reducing the hardware requirements of the system. This method improves the feasibility in practical engineering applications and provides a new methodological framework for real-time parameter identification and cooperative control of complex dynamic systems.
[0039] This invention effectively solves the problem of rapid reconfiguration of formation in complex dynamic environments such as dynamic obstacle avoidance in UAV swarms and collaborative work of multiple robotic arms. It also provides verifiable real-time control assurance for scenarios such as intelligent manufacturing and national defense reconnaissance, demonstrating significant practical engineering application value. Attached Figure Description
[0040] Figure 1 is a flowchart of the multi-robot distributed cooperative formation control method under a specified time in this invention;
[0041] Figure 2 is a schematic diagram of the virtual coupling and topology communication relationship between multiple robots in this invention;
[0042] Figure 3 is a simulation diagram of the position and velocity of the multi-robot end effector in this invention;
[0043] Figure 4 is a schematic diagram of the multi-robot cooperative formation control formation and trajectory under a specified time in this invention;
[0044] Figure 5 is a comparison of errors in the multi-robot collaborative formation under different specified times in this invention;
[0045] Figure 6 is a schematic diagram showing the changes in the estimated values of kinematic parameters estimated by the regression matrix observer in this invention. Detailed Implementation
[0046] The technical solutions of the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings. Obviously, the described embodiments are only some embodiments of the present invention, and not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative effort are within the scope of protection of the present invention.
[0047] This invention proposes a multi-robot distributed cooperative formation control method under a specified time, as shown in Figure 1. The method includes the following:
[0048] S1: Obtain a robot system consisting of multiple robots and construct a multi-robot dynamics model.
[0049] To obtain a robotic system consisting of multiple robots, the dynamic model of each robot can be represented as:
[0050]
[0051] in, Indicates the first The inertial matrix of the robot, Indicates the first The Coriolis force matrix of a robot (mainly including Coriolis force and centrifugal force). Indicates the first The gravitational torque of a robot. This represents the total number of robots in the entire formation system. They represent the first The generalized joint rotation angles, velocities, and acceleration vectors of a robot. Indicates the first Known bounded compact sets of robots The constant system parameter vector, Indicates the first The control torque (input torque) of each robot arm is the total control input vector. Indicates the first Each robot has Each joint.
[0052] The time-limited convergence criterion for the control system is:
[0053]
[0054] in, This represents the time derivative of the Lyapunov function of the system. To represent a positive integer, Represents the time-varying gain function. This represents the system's Lyapunov function. It represents a bounded unknown perturbation.
[0055] This can be further expressed as: Consider a time-varying function If there exists a positive function : ,satisfy: .
[0056] For unknown disturbances Bounded and positive real constants ,So exist The interior is bounded, and .
[0057] Wherein, time-varying gain function The expression is:
[0058]
[0059] In the formula, For the time of the system control process, This indicates the user-preset convergence time. Indicates the initial coefficient of the safe transition interval. This is the upper limit of the time-varying gain. This indicates the lower limit of the stable gain.
[0060] S2: Construct the communication topology of the multi-robot formation and determine the desired formation pattern;
[0061] As shown in Figure 2, the communication topology between the robot arms is derived from graph theory. This indicates that graph theory... An undirected graph that satisfies either minimum rigidity or infinitesimal rigidity. The vertex set is... Representing the The end effector of a robot. Edge set Each edge Indicates end effector and The need to maintain a coordinated relationship between them, end effector Neighbor sets can be accessed through Indicated. Respectively using and Representation Graph Theory The number of vertices and edges, graph theory Correlation matrix The elements can be represented as: if the vertex For the first The head of the edge, then the correlation matrix elements Equal to 1; if vertex For the first The tail of the edge, then the correlation matrix elements Equal to -1; otherwise element It is zero.
[0062] Given a reference configuration Define the expected formation set , can be represented as:
[0063]
[0064] in, Describes the set of desired formation configurations, where each configuration By reference formation Generated through rotation and translation Indicates by A robot The global state vector formed by stacking in dimensional space is , Represented as The identity matrix is used to represent the rotation matrix. It applies to all robots. Represents the rotation matrix of the desired formation transformation. For reference formation configuration, this represents the desired relative positional relationship of the robots. Let be the dimension of the Cartesian coordinate system. Let be the translation vector, representing the translational degrees of freedom of the entire formation. A column vector consisting entirely of 1s. , Let be a rotation matrix in a special orthogonal group, satisfying: , Represented as The identity matrix guarantees It is an orthogonal rotation matrix. Represents an orthogonal rotation matrix The determinant is 1. It is made by all A linear space consisting of a column of real vectors.
[0065] definition The set of reachable subsets of the end effector can be represented as .in, The set of generalized joint positions without kinematic singularities can be represented as:
[0066]
[0067] in, Indicates positive kinematics, For the first The base coordinate position of the robot Let the set of singularities in the robot's avoidance motion be represented by the following expression:
[0068] , For the first Robot at joint angles The geometric Jacobian matrix at the location.
[0069] S3: Introduce virtual springs between robots to construct potential energy functions and calculate the formation error of the robot system.
[0070] For each robot, on its edges Each end effector in the process constructs a potential energy function. :
[0071] Define the formation error of a robot system:
[0072] The formation error of the system represents the first digit in the task space. Position error of the robot end effector Its expression is:
[0073]
[0074] in, This represents the position error of the kth edge of the robot's end effector at time t. The original error signal in the task space corresponding to the k-th edge at time k. This represents the actual Euclidean distance corresponding to the k-th edge, i.e. , For robots and The position coordinates at time t ( Or 3) Represents robots and robots The expected distance corresponding to the k-th edge can be used express, This represents the L2 norm (Euclidean distance). Indicates the first The position of a robot end effector in the task space can be linearly mapped from the robot joint space to the task space using forward kinematics, and its expression is as follows:
[0075]
[0076] In the formula: : For the robot's positive kinematics, let represent the joint angle from joint space. A linear mapping to the spatial position of the robot arm end effector in the task space, where Represented as the first The base position of the robot in the mission space.
[0077] The original error is scaled using a time scaling function to obtain the scaled error, which is the final formation error of the robot system. It can be represented as:
[0078]
[0079] in, for The original error signal in the task space corresponding to the k-th edge at time k. This represents the time-varying gain function.
[0080] S4: Design of a time-varying gain-based gradient descent distributed controller for the formation error of a robot system.
[0081] Gradient descent is used as the control input for each end effector to achieve a minimum stable cooperative formation. Value, potential energy function right The gradient is given by The expression for this is:
[0082]
[0083] in, Represents the time t. The gradient vector of the potential energy function of each robot. It is a diagonal matrix. ; Representation of the correlation matrix elements, The normalized incidence matrix is... , This represents the error signal after the task space error has been scaled by a time-varying gain.
[0084] Because virtual coupling is distributed between end effectors, the actuators are embedded into the joints, the first The distributed control law of a robot's task space can be expressed as:
[0085]
[0086] in, Indicates the first The control law (control input) of a robot at the task level. Indicates positive control gain. For the first The generalized Jacobian matrix of the robot after transformation by the linear regression matrix. Indicates the first The generalized joint angle of a robot, The Jacobian matrix represents the actual vector of kinematic parameters, including the equivalent inertia of the link, coupling terms, gravity terms, etc., and can be expressed by the following expression: We obtain, among which This indicates positive kinematics.
[0087] S5: Design a controller for a specified time at the joint level by utilizing the passive characteristics of the Euler system.
[0088] To solve the static formation problem, the control law design must ensure that the joint velocities converge to zero. The first... The joint speed of the robot is .
[0089] As a classic Euler-Lagrange system, the robotic arm, based on the passive characteristics of joint torque to joint velocity, is designed with a predetermined time control law at the joint level. It can be represented as:
[0090]
[0091] in, Indicates the first The control law (control input) of a robot at the joint level. Indicates the design control gain. Indicates the first The joint velocity vector of a robot.
[0092] Hypothetical graph theory An undirected graph that satisfies minimum or infinitesimal rigidity. The minimum number of edges in the topology is ,in Let be the number of agents in the entire multi-agent system, and for any target formation, given the known dynamic parameters. The solution can be found using the following control law:
[0093]
[0094] S6: Real-time estimation and compensation of unknown parameters of robot dynamics model to obtain online parameter adaptive law based on time-varying gain.
[0095] A regression matrix linear observer is used to estimate and compensate for unknown parameters of the robot dynamics model in real time. The regression matrix linear observer is expressed as follows:
[0096] Velocity kinematics depends on the kinematic parameter vector (i.e., there exists a smooth function) and For any vector , satisfy:
[0097]
[0098] in It is a known kinematic regression equation. For the dimension of the kinematic parameter vector, there exists a smooth matrix function value. It can be represented as:
[0099]
[0100] Using the linear observer based on the regression matrix described above, a novel adaptive estimation method for the Jacobian matrix is introduced. Controller, online parameter estimation based on time-varying gain The adaptive law can be expressed as:
[0101]
[0102] in, Indicates the first Parameter estimates for each robot The time derivative vector (i.e., the update rate). Indicates the first The linear regression matrix of the robot depends on the generalized joint angle. and time t The gradient of the robot's potential energy function , This represents a positive design gain parameter. Indicates the first The kinematic parameter estimation vector of a robot.
[0103] estimation error of kinematic parameters It can be represented as:
[0104]
[0105] S7: Obtain the overall formation controller based on the adaptive law of all controllers and online estimated parameters, and use the overall formation controller to realize distributed cooperative formation control of multiple robots.
[0106] Consider a set The parameters of the robot's dynamics model are unknown, and the graph theory formed between the robots is also unknown. To satisfy either minimum or infinitesimal stiffness, select an appropriate gain parameter. For the reference configuration The resulting formation can be determined by the following time controller, i.e., the overall formation controller:
[0107]
[0108] Based on the above control law, the collaborative formation control of multiple robot systems within a specified time can be finally achieved.
[0109] Simulation verification of the present invention:
[0110] To verify the effectiveness of the method of the present invention, a simulation experiment was conducted using Matlab 2024a, as detailed below:
[0111] Numerical simulation experiments were conducted to construct four sets of two-degree-of-freedom manipulator systems by selecting model parameters. The proposed distributed cooperative formation control method under a specified time was systematically verified. Considering that the parameters of the four sets of two-degree-of-freedom manipulators are consistent, their dynamic parameters are shown in Table 1. The total simulation time was set to 10 seconds. The sampling period is Other relevant simulation parameters are shown in Tables 1, 2, and 3. Table 1 lists the parameters of the two-degree-of-freedom robotic arm system, Table 2 lists the nominal model parameters of the regression matrix observer, and other relevant parameters are shown in Table 3.
[0112] Table 1 Parameters of the Dual Robotic Arm System
[0113]
[0114] Table 1 lists only the system parameters of a single two-degree-of-freedom robotic arm; the system parameters of the other three robotic arms are exactly the same as those listed above. Represented as the first in the robotic arm The mass of each link. Represented as the first in the robotic arm Moment of inertia of each link Represented as the first The length of each link Indicates the first The distance from each link to its center of mass.
[0115] Table 2 Nominal model parameters of the regression matrix observer
[0116]
[0117] Note that Table 2 only lists the nominal model of the regression matrix observer for a single two-degree-of-freedom robotic arm. The nominal models of the regression matrix observers for the other three robotic arms are exactly the same as those in Table 2. Indicates the first The equivalent inertia of link 1 in a robotic arm Indicates the first The equivalent inertia of link 2 in the robotic arm Indicates the first The coupled inertial terms (i.e., Coriolis force and centrifugal force coefficients) in a robotic arm. Indicates the first The gravity term of joint 1 in a robotic arm. Indicates the first The gravity term of joint 2 in a robotic arm.
[0118] Table 3 Other relevant parameters
[0119]
[0120] As shown in Table 3, among which, Indicates the first design gain parameter. This represents the second design gain parameter. This represents the third design gain parameter. This represents the upper bound of the adjustment of the time-varying gain function, preventing the time-varying gain from growing unbounded. This represents the steady-state lower bound of the time-varying gain. This represents the initial coefficient of the safe transition range of the time-varying gain.
[0121] To further illustrate, the kinematic model of each two-joint robotic arm can be represented as:
[0122]
[0123] The Jacobian matrix can be represented as:
[0124]
[0125] in, The length of the connecting rod is Then the set of singularity configurations for robot motion is The initial joint angles of each robotic arm in this simulation are: , , , The initial base coordinates of the four robotic arms are as follows: All robotic arms have an initial joint velocity of zero, and the initial kinematic parameters are estimated as follows: Consider the desired formation of the robots as having a side length of 4. The square, and the corresponding correlation matrix of the formation diagram. for:
[0126]
[0127] Since all robots are considered to operate in a horizontal plane, the gravity matrix is always zero, i.e. in, .
[0128] The simulation results are shown in Figures 3 to 6. Figure 3 shows the position and velocity changes of all robotic arm end effectors. It can be clearly observed from the figure that the time-varying gain function effectively defines the position and velocity fluctuation error, effectively enabling each robotic arm to reach the target position within a specified time and the motion speed to converge to zero.
[0129] Figure 4 clearly shows the convergence process of the robot's end effector from the initial pose (marked as "×") to the target pose (marked as "○"). Experimental data shows that the desired formation was achieved in the two-dimensional workspace, verifying the feasibility of the proposed formation control method. Figure 5 shows the error graphs under different user-preset times (a represents the specified convergence time). The following is an error plot, where b represents the specified convergence time. The error graph below (as shown in Figure 5a) shows the preset time. At this time, the relative distance between the end effectors of the four robotic arms can precisely match the set relative desired distance, as shown in Figure 5b. When the preset convergence time is shortened to The system exhibits strong stability, with the formation error converging precisely to zero within 1.5 seconds, fully validating its high accuracy and rapid response capabilities. Figure 6 shows the dynamic characteristic curves of the kinematic parameter estimation error obtained through the regression matrix observer. The results indicate that the parameter estimation exhibits some fluctuations in the initial stage, but with the application of the time-varying gain, the kinematic parameter estimates are effectively brought to a uniform value within a specified time. It converges to the nominal value.
[0130] In summary, this invention, combining a predetermined time convergence mechanism, a distributed control architecture, and adaptive parameter estimation, proposes a multi-robot distributed cooperative formation control method under predetermined time conditions. This offers a possible solution for millimeter-level response and synchronization requirements in industrial automation and defense cluster reconnaissance fields. Firstly, predetermined time control constructs a time basis function or time-varying control gain to ensure that the entire system error signal remains within a user-preset time. The system achieves strict convergence to zero, overcoming the limitations of traditional asymptotic convergence time uncertainty and finite-time convergence dependence on initial conditions and design parameters. Secondly, it constructs a distributed control strategy based on neighborhood information interaction, reducing communication load through collaborative parallel computing while increasing the system's fault tolerance and scalability to node failures. Finally, addressing uncertainties such as perturbations of system dynamic model parameters, load changes, and environmental disturbances in practical engineering, it designs an adaptive observer based on a regression matrix to estimate Jacobian matrix kinematic parameters online, effectively compensating for the uncertainty of the dynamic model and enhancing its adaptability to unstructured environments. This collaborative design effectively solves the problem of rapid formation reconfiguration in complex dynamic environments such as UAV swarm dynamic obstacle avoidance and multi-robotic arm collaborative work, providing verifiable real-time control assurance for intelligent manufacturing, defense reconnaissance, and other scenarios, demonstrating significant practical engineering application value.
[0131] The above-described embodiments further illustrate the purpose, technical solution, and advantages of the present invention. It should be understood that the above-described embodiments are merely preferred embodiments of the present invention and are not intended to limit the present invention. Any modifications, equivalent substitutions, improvements, etc., made to the present invention within the spirit and principles of the present invention should be included within the protection scope of the present invention.
Claims
1. A method for distributed cooperative formation control of multiple robots within a specified time, characterized in that, include: S1: Obtain a robot system consisting of multiple robots and construct a multi-robot dynamics model; S2: Construct the communication topology of the multi-robot formation and determine the desired formation pattern; S3: Introduce virtual springs between robots to construct potential energy functions and calculate the formation error of the robot system; S4: Design of a task-level gradient descent distributed controller based on time-varying gain for robot system formation error; the control law of the task-level gradient descent distributed controller based on time-varying gain is expressed as: ; in, Indicates the first Control laws for a robot at the task level Indicates positive control gain. For the first The generalized Jacobian matrix of the robot after transformation by the linear regression matrix. Indicates the first The generalized joint rotation vector of a robot. Represents the actual vector of kinematic parameters. Represents the time t. The gradient vector of the potential energy function of each robot; S5: Design of a joint-level controller under specified time based on the passive characteristics of Euler systems; the control law of the joint-level controller under specified time is expressed as: ; in, Indicates the first Control laws for a robot at the joint level Indicates the design control gain. Indicates the first The joint velocity vectors of the robot. Indicates the first The gravity vector of the robot system Indicates the first A known bounded compact set of constant system parameter vectors for a robot; S6: Real-time estimation and compensation of unknown parameters of the robot dynamics model to obtain an online parameter estimation adaptive law based on time-varying gain; the online parameter estimation adaptive law based on time-varying gain is expressed as: ; in, Indicates the first Parameter estimates for each robot The time derivative vector, Represents the time-varying gain function. Indicates the first The linear regression matrix of the robots, Indicates the first The gradient vector of the potential energy function of each robot. This represents a positive design gain parameter. Indicates the first A vector of estimated kinematic parameters for a robot; S7: Based on the adaptive law of all controllers and online estimated parameters, the overall formation controller is obtained, and the overall formation controller is used to realize distributed cooperative formation control of multiple robots; the overall formation controller is represented as: ; in, Indicates the first The total control input vector of the robot Represents the time t. The gradient vector of the potential energy function of a robot.
2. The multi-robot distributed cooperative formation control method under a specified time according to claim 1, characterized in that, The multi-robot dynamics model is represented as follows: ; in, Indicates the first The inertial matrix of the robot, Indicates the first The Coriolis force matrix of the robots Indicates the first The gravitational torque of the robot; This represents the total number of robots in the entire formation system. They represent the first The generalized joint rotation angles, velocities, and acceleration vectors of a robot. Indicates the first A known bounded compact set of constant system parameter vectors for a robot. Indicates the first The total control input vector of the robot.
3. The multi-robot distributed cooperative formation control method under a specified time according to claim 1, characterized in that, The desired formation of the robot system is represented as follows: ; in, This represents the set of desired formation patterns. Indicates by A robot A stacked global state vector in dimensional space. Represented as The identity matrix, Represents the rotation matrix of the desired formation transformation. For reference formation configuration, Let be the dimension of the Cartesian coordinate system. It is a translation vector. It is a column vector consisting entirely of 1s; Let be a rotation matrix in a special orthogonal group. Indicates by all A linear space consisting of a column of real vectors.
4. The multi-robot distributed cooperative formation control method under a specified time according to claim 1, characterized in that, The formation error of the robot system is obtained by scaling the original formation error in the task space using a time-varying gain function. The original formation error in the task space is expressed as follows: ; in, This represents the actual Euclidean distance corresponding to the k-th edge. This represents the expected distance corresponding to the k-th edge. for The original error signal in the task space corresponding to the k-th edge at time k; The formation error of the robot system is expressed as: ; in, express The formation error corresponding to the k-th edge at time k. This represents the time-varying gain function.
