CN110554607A - Cooperative control method and system with obstacle avoidance and navigation protection tasks for multi-Euler-Lagrange system - Google Patents

Cooperative control method and system with obstacle avoidance and navigation protection tasks for multi-Euler-Lagrange system Download PDF

Info

Publication number
CN110554607A
CN110554607A CN201910877456.9A CN201910877456A CN110554607A CN 110554607 A CN110554607 A CN 110554607A CN 201910877456 A CN201910877456 A CN 201910877456A CN 110554607 A CN110554607 A CN 110554607A
Authority
CN
China
Prior art keywords
task
robot
obstacle avoidance
control method
euler
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
Application number
CN201910877456.9A
Other languages
Chinese (zh)
Other versions
CN110554607B (en
Inventor
宋锐
高嵩
李贻斌
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shandong University
Original Assignee
Shandong University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shandong University filed Critical Shandong University
Priority to CN201910877456.9A priority Critical patent/CN110554607B/en
Publication of CN110554607A publication Critical patent/CN110554607A/en
Application granted granted Critical
Publication of CN110554607B publication Critical patent/CN110554607B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention discloses a cooperative control method and a system with an obstacle avoidance and navigation protection task for a multi-Euler-Lagrange system, wherein the cooperative control method comprises the following steps: describing a physical model of the convoy task by adopting a multi-Euler-Lagrange system; the controller adopts an inner and outer ring control structure, the outer ring adopts a space behavior control framework considering obstacles, and expected speed and expected movement track required by an inner ring physical model are generated; and the inner ring applies an adaptive proportional-differential sliding mode control method, so that each physical model tracks the expected speed and the expected motion trail. The invention has the beneficial effects that: in the presence of model uncertainty, interference and obstacles, a robust hierarchical control structure is established. A vacant space behavior controller is put forward in an outer ring to avoid obstacles and protect and send targets; while producing the required velocity of the inner ring. An adaptive proportional differential-sliding mode control law is adopted in the inner ring to track the required speed and ensure fast convergence and robustness.

Description

Cooperative control method and system with obstacle avoidance and navigation protection tasks for multi-Euler-Lagrange system
Technical Field
The invention relates to the technical field of cooperative control in an obstacle environment, in particular to a cooperative control method and system with an obstacle avoidance and navigation protection task for a multi-Euler-Lagrange system.
background
the statements in this section merely provide background information related to the present disclosure and may not necessarily constitute prior art.
In recent years, the control of multi-robot systems has attracted considerable attention because these systems can overcome the limitation of using only a single robot. Many scholars are concerned with studying the coordinated control of multiple agents, have uncertain nonlinear dynamics, non-integrity mobile robots, and generally multi-mechanical systems. More and more research has found that modeling some practical applications using only single or double integral dynamics, ignoring non-linear dynamics, is not acceptable in reality. Thus, many researchers have begun studying the euler-lagrange system because it can represent many mechanical systems, such as rigid body pose dynamics, robotic arms, mobile robots, and walking robots, among others. However, most of the existing research results can only be applied to ideal environments, and they are not suitable for being applied to complex environments, such as the situation of obstacles. Therefore, it is crucial to study the coordinated control of the multi-euler-lagrange system, especially when obstacles, model uncertainty, external disturbances, parameter uncertainty and unknown non-linear dynamics need to be considered.
the task of convoying can be viewed as a task of surrounding objects and maintaining formation. When the target moves, the formation moves along with the target and ensures that the target is at the center of the formation, a specified distance is kept between the robot and the target, and the robot is evenly distributed around the target. A number of documents have previously studied the convoy mission of many robots. However, most of the strategies proposed by previous studies can only be applied to planar cases, and they cannot be simply extended to the multi-euler-lagrange system in the three-dimensional case either. Therefore, in the case of the p-dimension (p ≧ 3 is a positive integer), it is more meaningful to design a controller for a suitable convoy mission while avoiding obstacles and providing strict proof of convergence and stability.
Behavior-based approaches have been extensively studied in a number of multi-robot system coordinated control frameworks. Space-time behavior (NSB) control is a task-first inverse kinematics control method; the main feature of space-behavior (NSB) control is that basic tasks are prioritized and combined by a space-space projection matrix of high-priority tasks to form a final behavior, so that multiple tasks are activated simultaneously. Furthermore, unlike the classical behavior control method, the space-time behavior (NSB) control method has an analytical structure, allowing the stability of the task to be elaborated. The present study discusses the convoy mission in detail in the space-behavior (NSB) control scheme, which has the advantages of flexibility and versatility. However, the space-time behavior (NSB) control method still has some unsolved problems, such as how to realize more accurate nonlinear dynamic control under the behavior control architecture.
sliding Mode Control (SMC) is considered as a powerful technique to help nonlinear systems handle uncertainties, external disturbances, etc. in the system; the Sliding Mode Control (SMC) method includes an equivalent control term that requires some knowledge of the dynamics of the system, and a robust term, which is difficult to obtain in practice for complex systems. There is a high frequency oscillation, known as buffeting, of the control signal of a Sliding Mode Controller (SMC), which causes the signal to oscillate rapidly around the sliding mode face.
The prior art proposes a hybrid control law that can switch between proportional-derivative control (PD) and Sliding Mode Control (SMC) for tracking control of a robot arm. It is proposed to apply proportional derivative control (PD) instead of the equivalent part of Sliding Mode Control (SMC) and the proposed control scheme does not require an accurate dynamic model of the robot arm, which means that the proposed scheme is model independent, although it shows quite good performance, the switching between Proportional Derivative (PD) and Sliding Mode Control (SMC) is indeed a matter that needs to be carefully considered in practice. The prior art proposes a proportional-derivative controller (PD) and sliding-mode controller (SMC) based approach for linear robot systems and assumes that the gain of the sliding-mode controller (SMC) is larger than the upper limit of the dynamical system, however, in most cases this gain will be overestimated because it is difficult to obtain an upper limit of uncertainty of the dynamical system.
disclosure of Invention
In order to solve the problems, the invention provides a cooperative control method and a cooperative control system with an obstacle avoidance and navigation protection task for a multi-Euler-Lagrange system, wherein an inner-outer loop control structure is adopted, and an empty space behavior (NSB) control is adopted in an outer loop to generate a reference speed vector required by the inner loop; adaptive proportional differential-sliding mode control (APD-SMC) techniques are used for the design of the dynamic structure of the robot to follow the reference speed in the inner ring.
In some embodiments, the following technical scheme is adopted:
the cooperative control method of the multi-Euler-Lagrange system with the obstacle avoidance and navigation protection task comprises the following steps:
describing a physical model of the convoy task by adopting a multi-Euler-Lagrange system;
The controller adopts an inner and outer ring control structure, the outer ring adopts a space behavior control framework considering obstacles, and expected speed and expected movement track required by an inner ring physical model are generated; and the inner ring applies an adaptive proportional-differential sliding mode control method, so that each physical model tracks the expected speed and the expected motion trail.
in other embodiments, the following technical solutions are adopted:
The multi-Euler-Lagrange system is provided with a cooperative control system for avoiding obstacles and protecting navigation tasks, and is characterized by comprising the following steps: the controller adopts an inner ring and outer ring control structure, the outer ring adopts a space behavior control framework considering obstacles, and the expected speed and the expected motion track of the physical model required by the inner ring are generated; and the inner ring applies an adaptive proportional-differential sliding mode control method, so that each physical model tracks the expected speed and the expected motion trail.
in some embodiments, the following technical scheme is adopted:
a terminal device comprising a processor and a computer-readable storage medium, the processor being configured to implement instructions; a computer readable storage medium stores a plurality of instructions adapted to be loaded by a processor and executed as described above
The Lagrange system is provided with a cooperative control method of an obstacle avoidance and navigation protection task.
compared with the prior art, the invention has the beneficial effects that:
The invention establishes a hierarchical control structure with robustness under the condition of model uncertainty, interference and obstacles. A space-time behavior (NSB) controller is proposed in the outer loop to avoid obstacles and escort targets; while producing the required velocity of the inner ring. An adaptive proportional differential-sliding mode control law (APD-SMC) is employed in the inner loop to track the required speed and ensure fast convergence and robustness. The feasibility of the control scheme is illustrated by Lyapunov theorem and simulation experiment results.
Drawings
Fig. 1 is a block diagram of cooperative control with an obstacle avoidance and navigation protection task in a multi-euler-lagrange system according to an embodiment of the present invention;
FIG. 2 is a block diagram of the control of the empty space of three tasks according to a first embodiment of the present invention;
FIG. 3 is a block diagram of the combined total speed of two task speeds according to one embodiment of the present invention;
FIG. 4 is a diagram of the positions of six robots and a target in a three-dimensional space according to a first embodiment of the present invention;
FIGS. 5(a) - (c) are respectively a distance between a robot and an object, a distance between adjacent robots, and a position tracking error when APD-SMC is used in a two-dimensional space for a scene 1 according to an embodiment of the present invention;
Fig. 6(a) - (c) are diagrams illustrating the distance between a robot and a target, the distance between adjacent robots, and the position tracking error, respectively, in a two-dimensional space using ASMC in scene 1 according to a first embodiment of the present invention;
FIG. 7 is a diagram illustrating a trajectory of a robot and an object in a three-dimensional space using APD-SMC according to a first embodiment of the present invention;
FIGS. 8(a) - (c) are diagrams illustrating the use of APD-SMC in a two-dimensional space for the distance between a robot and a target, the distance between adjacent robots, and the position tracking error in scene 2, respectively, according to a first embodiment of the present invention;
FIG. 9 illustrates the use of APD-SMC in a two-dimensional space for the location of five robots and objects when scene 2 encounters an obstacle in accordance with a first embodiment of the present invention;
FIG. 10 is a diagram illustrating the use of APD-SMC in a two-dimensional space for the relative distance between a robot and an obstacle when scene 2 encounters an obstacle according to a first embodiment of the present invention;
FIG. 11 is a diagram illustrating a trajectory of a robot and an object in scene 2 using APD-SMC in three-dimensional space according to a first embodiment of the present invention;
FIGS. 12(a) - (c) are diagrams illustrating the use of APD-SMC in three-dimensional space for the distance between a robot and a target, the distance between adjacent robots, and the position tracking error in scene 2, respectively, according to a first embodiment of the present invention;
Fig. 13(a) - (c) are diagrams illustrating the distance between a robot and a target, the distance between adjacent robots, and the position tracking error, respectively, in a three-dimensional space using ASMC according to a first embodiment of the present invention;
FIG. 14 is a diagram illustrating a trajectory of a robot and an object in a two-dimensional space using APD-SMC according to a first embodiment of the present invention;
15(a) - (c) are respectively the distance between a robot and a target, the distance between adjacent robots and the position tracking error when APD-SMC is used in a three-dimensional space for a scene 3 according to a first embodiment of the present invention;
FIG. 16 illustrates the use of APD-SMC in three-dimensional space for the location of six robots and objects when an obstacle is encountered in scene 3 in accordance with a first embodiment of the present invention;
Fig. 17 illustrates the use of APD-SMC in three dimensions for the relative distance between the robot and the object when scene 3 encounters an obstacle in accordance with a first embodiment of the present invention.
Detailed Description
it should be noted that the following detailed description is exemplary and is intended to provide further explanation of the disclosure. Unless defined otherwise, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this application belongs.
It is noted that the terminology used herein is for the purpose of describing particular embodiments only and is not intended to be limiting of example embodiments according to the present application. As used herein, the singular forms "a", "an" and "the" are intended to include the plural forms as well, and it should be understood that when the terms "comprises" and/or "comprising" are used in this specification, they specify the presence of stated features, steps, operations, devices, components, and/or combinations thereof, unless the context clearly indicates otherwise.
Example one
In one or more embodiments, a cooperative control method with an obstacle avoidance and navigation protection task for a multi-Euler-Lagrange system is disclosed, which includes the following steps:
Describing a physical model of the convoy task by adopting a multi-Euler-Lagrange system; the physical model may be: multi-robot arms, multi-mobile robots, multi-step robots, multi-spacecraft, and the like; in this embodiment, a multi-euler-lagrange system is used to describe the multi-mobile robot system.
The controller adopts an inner and outer ring control structure, the outer ring adopts a space behavior control framework considering obstacles, and expected speed and expected movement track required by an inner ring physical model are generated; the inner ring applies an adaptive proportional-derivative sliding mode control method, so that each physical model tracks the expected speed and the expected motion track (the total expected speed is integrated to obtain the expected track).
1. Consider a set of n mobile robots whose dynamics can be described as a multi-Euler-Lagrangian system, expressed as:
Wherein M isi(qi)∈Rp×pIs a positive definite inertia matrix, qi∈RpIs a vector of coordinates in a broad sense,Is the vector and centrifugal moment of Coriolis, gi(qi) Is the moment of gravity, τiIs the control input vector for robot i,Representing an unknown disturbance force.
assume that the multi-euler-lagrange system has the following properties.
Property 1.1 boundedness:
For any oneI, the existence of a normal number m i,kCiAnd kgiso thatAnd Ci(x，y)||≤kCifor all vectors, | y | |and gi(qi)||≤kgiThis is true.
property 1.2 skew symmetry:
Is diagonally symmetrical.
Property 1.3 dynamic parameter linearization:
For all vectors Is a regression vector, and ΘiIs a common parameter vector associated with the ith robot.
Properties 1.4: assumption of disturbance forceIs that the material is bounded by the surface,In which ξi＞0。
2. to perform the convoy and obstacle avoidance tasks, an empty space behavior (NSB) control merging behavior is proposed in the outer loop to define the final motion of the robot. Adaptive proportional differential-sliding mode control (APD-SMC) is used for an inner loop of a multi-Euler-Lagrange system to compensate unknown disturbance, uncertain parameters and the like. A block diagram of the entire control system is shown in fig. 1.
2.1 space-time behavior (NSB) control
Aiming at the navigation task with the obstacle avoidance requirement, three different tasks are considered, namely the obstacle avoidance task, the subtask of the robot around the target and the subtask of the robot maintained on the surface of a sphere or a hyper-sphere taking the target as the center are uniformly distributed, and the two next subtasks belong to the navigation task. The expected speed of the convoy mission with the obstacle avoidance requirement is designed as
Wherein the content of the first and second substances,AndRepresenting the desired speed required for the obstacle avoidance task,AndIs the desired speed required for the convoy mission. J. the design is a square1Is a Jacobian matrix of the obstacle avoidance task,Is the pseudo-inverse, J of the jacobian matrix of the obstacle avoidance task2Is a Jacobian matrix that evenly distributes the subtasks of the robot around the target,is the pseudo-inverse of the jacobian matrix of the uniformly distributed robot subtasks around the target, and n is the number of robots.
The priority of the task depends on the actual considered factors (e.g. safety actions, such as obstacle avoidance generally having the highest priority) or on the actions that have to be implemented in case of a conflict).
Fig. 2 depicts a space-time behavior (NSB) control architecture with three different tasks, each of which may be prioritized by the administrator depicted in fig. 2. If new requirements are given, the administrator can change the priorities (and weights) of the different tasks during the whole task.
To eliminate conflicting elements, different task speeds need to be projected into the empty space behavior (NSB) control framework, created by the jacobian matrix of the high priority tasks. As shown in figure 3 of the drawings,needs to be projected atIn the empty space of (a). This means that the active elements of each task combine to build an integrated overall speed command to drive the robot.
2.1.1 obstacle avoidance task
The obstacle avoidance task maintains a specified distance between the robot and the obstacle. Each robot is virtualized spaceIs surrounded byRepresents the position of the current obstacle for the ith robot, and Bi,oRepresents sigmai,1d＝diRegion of where diIs the minimum allowable safe distance between the ith robot and the obstacle.
the obstacle avoidance task function and the task function error are expressed as:
Wherein q isiIs the position, σ, of the ith roboti,1Is the ith machinetask function, sigma of robot obstacle avoidance taski,1dis an expected task function of the ith robot obstacle avoidance task,Is the task function error of the ith robot obstacle avoidance task.
definition ofWhereinIn the form of a jacobian matrix,Is a unit vector, λ, pointing to the nearest obstaclei,1> 0 is a state dependent gain, andIf and only if the robot is close enough to the obstacle,and when the task is not active,This task is built independently for each robot, rather than a cumulative task function.
2.1.2 convoy mission
In the convoy mission, all robots are evenly distributed around the target. The motion of the target is not known in advance, but can be measured in real time. The robot convinces the target in a p-dimensional space at a fixed distance (where p ≧ 2 is a positive integer). Two subtasks are defined here, a subtask that evenly distributes the robot around the target and a subtask that is maintained on a spherical or hypersphere surface centered on the target.
2.1.2.1 evenly distributing the subtasks of the robot around the target
In the case of a reference plane, the requirement that n robots are evenly distributed around the target is met by staying n robots at the vertices of a regular n polygon, wherein the distances between adjacent vertices of the regular n polygon are equal.
In the planar case, the vector k is defined as an identifying index of the circle position. Thus k does not necessarily refer to the kth robot but only to an index, kjAnd kj+1Are meant to refer to two consecutive positions along the loop. Obviously, the position of any robot on the circle can be set to k1And k is1And knIs a continuous position index.
The task function, the desired task function and the task function error are respectively expressed as:
wherein liIs a suitable distance between two adjacent robots.
The desired speed for this task isThe corresponding jacobian matrix is:
The pseudo-inverse is:
Represents a constantThe gain of the matrix is determined positively.
2.1.2.2 subtasks maintained on a spherical or hypersphere surface centred on the target
the task function of the subtask, the expected task function and the task function error are respectively expressed as:
Wherein q is1Is the position of the 1 st robot, qnIs the location of the nth robot;Is the ideal velocity vector on the sphere/hypersphere surface that maintains the robot at a distance R from the target c, the corresponding jacobian matrix is:and the pseudo-inverse is:
and Λ2Similarly, it is also a constant positive definite matrix of the gain.
In the case of a plane, the robot is distributed over the vertices of a positive polymorphism, liCan be arranged asHowever, in three-dimensional space and p-dimensional (p > 3) space, the problem of how to distribute points on spheres and hyperspheres is considered to be a Tohmthe problem of the son. Many scholars have studied this problem and there are indeed suitable distances.
If any robot is out of control and enters the virtual area B of another roboti,oIt will be seen as an obstacle that the rest of the robots must avoid. If two or more obstacles are considered simultaneously, the nearest obstacle will be processed first.
2.2 inner Loop controller design
the inner loop is a combination of linear proportional-derivative control (PD) and non-linear sliding-mode control (SMC) with adaptive control. A Proportional Derivative (PD) control part is used for stabilizing the equivalent part, a Sliding Mode Controller (SMC) part is used for compensating external interference and uncertainty of the system, and an adaptive control part is used for estimating unknown system parameters.
2.2.1 adaptive proportional differential-sliding mode control law (APD-SMC)
the control problem involves designing the controller so that each robot tracks the desired trajectoryCan be obtained by comparing the equation (2)is obtained by the integration of (a) to (b),Are similarly defined, they are all bounded functions.AndRespectively tracking error and tracking velocity error.
The equivalent reference state is defined as follows:
Wherein the content of the first and second substances,And γ ═ diag (γ)1,γ2...γn) Is a positive diagonal matrix defined as a sliding mode constant, and a sliding mode surface is defined as:
wherein the content of the first and second substances,Based on property 1.3, the reference torque is described as follows:
Based on the cooperative control of the multi-Euler-Lagrange system, the following adaptive proportional differential sliding mode control law (APD-SMC) is provided
wherein k ispiAnd kdiProportional and differential control gains, k, respectivelyiIs a robust control gain. All three gain matrices are set to be positive,Is the reference torque ρiAnd updated with the adaptive law. Due to the use of the adaptive proportional differential-sliding mode control law (APD-SMC), the large control gain required in the proportional differential controller to compensate for the unknown term is avoided.
Wherein, muiIs a diagonal matrix, representing the adaptive update rate,An initial value representing the estimated torque vector.
It can be seen that the adaptive proportional differential-sliding mode control law (APD-SMC) in equation (9) is only related to the tracking error eiand tracking velocity errorIt is related. Thus, the control laws are modeless and easily implemented in practice.
3. Stability analysis
From equation (7), one can obtain:
With respect to equations (1), (8), and (11), it can be found that:
Theorem 3.1 consider the mission function error in equations (3) - (5), the multi-Euler-Lagrangian system equation (1) and the adaptive proportional-derivative sliding-mode control law (APD-SMC) (9) and adaptive update rate (10). Assuming that properties 1.1-1.4 hold, one can obtain:
(1) if there are no conflicts between the three tasks, they can be completed simultaneously. The system is globally asymptotically stable and the tracking error eiMay converge to zero.
(2) if the obstacle avoidance task is active and conflicts with the convoy task, the gain may be set toWhereinIs based on robustness against noise, such as measurement noise. The obstacle avoidance task is completed first, and in addition, the system can be obtained to be globally asymptotically stable, and the tracking error eiMay converge to zero.
Proves that the Lyapunov function V of the whole system is designed as
V＝V1+V2
Wherein the content of the first and second substances,η1,η2And η3Is a design parameter, andInertia matrix MiIs positive, kpi,kdi,η1,η2And η3Is set to positive. It can easily be demonstrated that V is a positive function. Based on equations (9) and (12), the following equation can be obtained
Will V1Is differentiated with respect to time to obtain
Substituting equations (7), (10) and (14) into (15) can result in
lyapunov function V1Is positive, the time derivative thereofIs negative. It can be obtained that the inner loop system is globally asymptotically stable and the tracking error eiconvergence to zero can be obtained according to the Lyapunov method. In the above equation, onlyEquation of timeIs satisfied.
In practice, the discontinuous term function sign () in equation (9) may cause buffeting problems. To avoid the chattering problem, a saturation function tanh (-) is introduced instead of the discontinuous function sign (-).
control law modification in equation (9)
Wherein the content of the first and second substances,
Using equation (13), one can obtain:
in the following, two cases are discussed separately: conflicting tasks and non-conflicting tasks. Assuming that there is no conflict between every two tasks, an interesting property of the jacobian matrix can be exploited, i.e. the non-conflicting relation between three tasks can be expressed as
This means that the three tasks project to the robot velocity space are orthogonal; thus, they can be implemented simultaneously. Substituting equation (19) into equation (18) may result in
Thus, from the above analysis, it was found that the outer ring subsystem is asymptotically stable if there is no conflict between each pair of tasks. At the same time, if the obstacle avoidance task is activated and conflicts with the convoy taskIt is in this form
WhereinAnd P ═ Pij]i, j is 1,2,3, the submatrices are p respectively11＝η1λ1,
For any oneApplication of 2| ab | < a2+b2to obtain
Wherein p isij,mAnd pij,MRespectively represent the Induction subblocks pijUpper and lower limits of (d).
It can be seen that because | | J1||＝||J2||＝||J3||＝1，p22,m＝p22,M0 and p33,m＝p33,M0, lossAndIn this case V2should be reset toTo obtainSimilarly, the outer ring subsystem is globally asymptotically stable.
In this case, the conclusion of theorem 4.1 is reached, which means that the obstacle avoidance task has a higher priority and is first achieved when it conflicts with the convoy task. And when no conflict exists, the convoy mission is executed again. Since the space-time behavior (NSB) control method is a kinematics that reacts to dynamics with a desired velocity rather than a desired position, λ is appropriately designedi,1so that the velocity error dominates the position error.
Sliding-mode equation (7) contains position and velocity errors by substituting equation (2) into equation (7) and taking into account the fact that every two tasks collide ifThen, thenAndCan be removed and thuscan obtain
by using inequality (23) as an equation and taking norm on both sides, it is possible to obtain
Thus, by selectingWhereinIs based on robustness to noise, which constant ensures that the robot is far from the obstacle.
It should be noted that if only two subtasks in the convoy mission conflict, each robot only completes the first two higher-level tasks. No collision will occur, wherein
If a robot collides frontally with an obstacle and the projection in the tangential direction is empty, the robot will stop moving. Measuring noiseLocal minima caused by this situation can be avoided.
4. Simulation verification
the simulation verification proves that the proposed algorithm is more effective than an Adaptive Sliding Mode Control (ASMC) method in two-dimensional and three-dimensional spaces under three scenes respectively.
The kinetic equation of each robot is set as
Where the parameters are defined similarly to equation (1), the noise is considered to be contained in a tight setAnd the measurement state isandAnd assuming the control force | | τi||≤10N。
consider five robots in two-dimensional space, assuming that the system parameters, controller parameters, and adaptive law parameters are M, respectivelyi＝1，Ci＝0，kpi＝30,kdi＝50,ki＝1,γ＝diag(20,...,20),μi20, where i 1. The task parameters are R-5 and d respectivelyi＝2,Λ2＝Λ3＝0.8I,The parameter of the external disturbance isThe initial positions of the five robots are q1(0)＝[5,10]T,q2(0)＝[-5,5]T,q3(0)＝[-5,-5]T,q4(0)＝[5,-10]T,q5(0)＝[5,0]T。
In three-dimensional space, six robots are considered during simulation, and corresponding parameters and initial positions are set q1(0)＝[-10,1,0]T,q2(0)＝[-1,-10,0.3]T,q3(0)＝[10,0,1]T,q4(0)＝[0,0.5,10]T,q5(0)＝[0,10,0.3]T,q6(0)＝[0,0,-10]T. The other parameters are similar to the parameter settings in the two-dimensional case.
ASMC is designed according to an adaptive control law (10)Wherein the controller parameter is kai＝80。
In three-dimensional control, six robots eventually reach the apex position of the octahedron, where the target is the center of the octahedron, the lenz of which is the distance between adjacent robots, as shown in fig. 4. Thus, the pseudo-inverse of the task function and the Jacobian matrix can be rewritten as
Equation (2) can be rewritten as
All simulation experiments are carried out withruns under MATLAB R2016a installed by a computer of Core I5-4590, a 3.6-GHz CPU,12GB of RAM,1000-GB solid-state disk drive.
4.1 convoying a stationary target
4.1.1 two-dimensional case
Five robots convoy a stationary object c ═ 3,0]TFig. 5(a) - (c) show the distance between the robot and the target, the distance between adjacent robots and the position tracking error, respectively, under adaptive proportional differential-sliding mode control (APD-SMC).
The results show that all robots can maintain a fixed distance from the target and surround it evenly. Fig. 6(a) - (c) show poor control performance compared to using adaptive proportional differential-sliding mode control (APD-SMC). This further verifies that adaptive proportional differential-sliding mode control (APD-SMC) achieves convergence faster and with higher control accuracy than Adaptive Sliding Mode Control (ASMC).
4.1.2 three-dimensional case
Fig. 7 shows the trajectory of the robot and the target in three-dimensional space. This verifies the effectiveness of adaptive proportional differential-sliding mode control (APD-SMC) in three dimensions.
4.2 convoying a constant speed target
4.2.1 two-dimensional case
fig. 8 shows the proposed control algorithm for convoy c ═ 3+0.1t,0]TThe performance of the target.
The validity of the proposed control laws when there are two obstacles is verified below. As a result of the simulation, as shown in fig. 9 and 10, when two obstacles enter the threshold circles of the robot 1 and the robot 4, respectively, all the robots change their positions to avoid the collision between the obstacle and the robots.
5.2.2 three-dimensional case
Fig. 11 and fig. 12(a) - (c) show convoying target c ═ 0.1t,0 in three-dimensional space using the proposed law]TThe simulation experiment result of (2). FIGS. 13(a) - (c) show the results when ASMC is used; and slower convergence speed and lower control accuracy are observed compared to using APD-SMC.
4.3 convoying a target of varying speed
4.3.1 two-dimensional case
Fig. 14 and 15(a) - (c) depict convoying a target c ═ 3+0.1t, sin (0.1t) in two-dimensional space]TAnd (4) obtaining a simulation result.
5.3.2. Three dimensional situation
in three dimensions, there is an obstacle q0＝[15,3,-4.5]TWhen the convoy target c is [0.1t, sin (0.1t),0]TAs shown in fig. 16 and 17.
In summary, the simulation results show that the control strategy proposed by the present embodiment has faster and higher control performance than Adaptive Sliding Mode Control (ASMC), and also shows good performance when avoiding obstacles.
Example two
In one or more embodiments, a cooperative control system with an obstacle avoidance and navigation protection task for a multi-euler-lagrange system is disclosed, which includes: the controller adopts an inner ring and outer ring control structure, the outer ring adopts a space behavior control framework considering obstacles, and expected speed and expected motion trail required by an inner ring physical model are generated; and the inner ring applies an adaptive proportional-differential sliding mode control method, so that each physical model tracks the expected speed and the expected motion trail.
EXAMPLE III
In one or more embodiments, a terminal device is disclosed that includes a processor and a computer-readable storage medium, the processor to implement instructions; the computer-readable storage medium is used for storing a plurality of instructions, and the instructions are suitable for being loaded by a processor and executing the cooperative control method with the obstacle avoidance and navigation protection task of the euler-lagrange system in the embodiment one.
although the embodiments of the present invention have been described with reference to the accompanying drawings, it is not intended to limit the scope of the present invention, and it should be understood by those skilled in the art that various modifications and variations can be made without inventive efforts by those skilled in the art based on the technical solution of the present invention.

Claims (10)

1. The cooperative control method of the multi-Euler-Lagrange system with the obstacle avoidance and navigation protection task is characterized by comprising the following steps:
Describing a physical model of the convoy task by adopting a multi-Euler-Lagrange system;
The controller adopts an inner and outer ring control structure, the outer ring adopts a space behavior control framework considering obstacles, and expected speed and expected movement track required by an inner ring physical model are generated; and the inner ring applies an adaptive proportional-differential sliding mode control method, so that each physical model tracks the expected speed and the expected motion trail.
2. The cooperative control method with obstacle avoidance and navigation protection task for multi-Euler-Lagrange system of claim 1, wherein the physical model comprises: any one of a multi-robot arm, a multi-mobile robot, a multi-step robot, and a multi-spacecraft.
3. the cooperative control method with the obstacle avoidance and navigation protection task for the multi-Euler-Lagrange system according to claim 1, wherein the space behavior control architecture considering the obstacle specifically comprises:
The following are respectively described by an empty space behavior control method: the method comprises the following steps of (1) avoiding an obstacle task, namely uniformly distributing subtasks around a target and a subtask maintained on the surface of a sphere or a hyper-sphere with the target as a center, wherein the subtasks are subtasks of a navigation task, and defining the priority of the tasks;
The desired velocities of the individual tasks are projected into the empty space created by the Jacobian matrix of high priority tasks, building an integrated total desired velocity command to drive the physical model.
4. The cooperative control method with the obstacle avoidance and navigation protection task for the multi-Euler-Lagrange system according to claim 3, wherein the integrated total desired speed is specifically as follows:
Wherein the content of the first and second substances,a desired speed output for the outer loop;the expected speed required by the obstacle avoidance task;andDesired speeds required for evenly distributing the robot's subtasks around the target and the subtasks maintained on the surface of a sphere or hyper-sphere centered on the target, respectively; j. the design is a square1Is a Jacobian matrix of the obstacle avoidance task,Is to avoid the barrierPseudo-inverse, J, of a task Jacobian matrix2is a Jacobian matrix that evenly distributes the subtasks of the robot around the target,Is the pseudo-inverse of the jacobian matrix of the uniformly distributed robot subtasks around the target, and n is the number of robots.
5. the cooperative control method with the obstacle avoidance and navigation protection task for the multi-Euler-Lagrange system as claimed in claim 3, wherein the task function and the task function error of the obstacle avoidance task are respectively expressed as:
Wherein the content of the first and second substances,Representing the current obstacle position for the ith robot, diIs the minimum allowable safe distance between the ith robot and the obstacle, qiIs the position, σ, of the ith roboti,1Is a task function, sigma, of the ith robot obstacle avoidance taski,1dIs an expected task function of the ith robot obstacle avoidance task,is the task function error of the ith robot obstacle avoidance task.
6. The cooperative control method with the obstacle avoidance and navigation protection task for the multi-Euler-Lagrange system according to claim 3, wherein the task functions of the subtasks uniformly distributed around the target, the expected task functions and the task function errors are respectively expressed as:
wherein liIs the distance between two adjacent robots, the vector k is defined as the identification index of the circle position,Indicating the position of the robot on the circle.
7. The cooperative control method with obstacle avoidance and navigation protection task for multi-Euler-Lagrange system as claimed in claim 3, wherein the subtask maintained on the surface of the sphere or the hyper-sphere with the target as the center has a task function, an expected task function and a task function error respectively expressed as:
Wherein the content of the first and second substances,is the ideal velocity vector, q, on the surface of the sphere/hypersphere that maintains the robot at a distance R from the target c1Is the 1 st robotPosition qnis the position of the nth robot.
8. the cooperative control method with the obstacle avoidance and navigation protection task for the multi-Euler-Lagrange system according to claim 1, wherein the inner loop applies an adaptive proportional differential sliding mode control method, which specifically comprises:
Wherein k ispiand kdiProportional and differential control gains, k, respectivelyiIs a robust control gain;Is the reference torque ρiAnd updated with an adaptive law; e.g. of the typeiandrespectively tracking error and tracking velocity error, siIs a slip form surface.
9. The multi-Euler-Lagrange system is provided with a cooperative control system for avoiding obstacles and protecting navigation tasks, and is characterized by comprising the following steps: the controller adopts an inner ring and outer ring control structure, the outer ring adopts a space behavior control framework considering obstacles, and the expected speed and the expected motion track of the physical model required by the inner ring are generated; and the inner ring applies an adaptive proportional-differential sliding mode control method, so that each physical model tracks the expected speed and the expected motion trail.
10. A terminal device comprising a processor and a computer-readable storage medium, the processor being configured to implement instructions; the computer-readable storage medium is configured to store a plurality of instructions, wherein the instructions are adapted to be loaded by a processor and to execute the cooperative control method with obstacle avoidance and navigation task for the multi-Euler-Lagrangian system according to any one of claims 1-8.
CN201910877456.9A 2019-09-17 2019-09-17 Cooperative control method and system with obstacle avoidance and navigation protection tasks for multi-Euler-Lagrange system Active CN110554607B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910877456.9A CN110554607B (en) 2019-09-17 2019-09-17 Cooperative control method and system with obstacle avoidance and navigation protection tasks for multi-Euler-Lagrange system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910877456.9A CN110554607B (en) 2019-09-17 2019-09-17 Cooperative control method and system with obstacle avoidance and navigation protection tasks for multi-Euler-Lagrange system

Publications (2)

Publication Number Publication Date
CN110554607A true CN110554607A (en) 2019-12-10
CN110554607B CN110554607B (en) 2020-11-24

Family

ID=68740585

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910877456.9A Active CN110554607B (en) 2019-09-17 2019-09-17 Cooperative control method and system with obstacle avoidance and navigation protection tasks for multi-Euler-Lagrange system

Country Status (1)

Country Link
CN (1) CN110554607B (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111158242A (en) * 2020-01-17 2020-05-15 山东大学 Convoy task cooperative control method and system based on obstacle environment and bounded input
CN111396268A (en) * 2020-03-11 2020-07-10 上海电机学院 Wind turbine generator cabin environment monitoring method and device
CN111722625A (en) * 2019-12-18 2020-09-29 北京交通大学 Stability analysis method for time-varying number group robot relay target tracking system
CN112643673A (en) * 2020-12-14 2021-04-13 山东大学 Mobile mechanical arm robust control method and system based on non-linear disturbance observer
CN113625781A (en) * 2021-08-16 2021-11-09 北京航空航天大学 Tracking control method of Euler-Lagrange system based on event

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103335651A (en) * 2013-06-19 2013-10-02 北京航空航天大学 Double-speed-ring control method of aerial remote sensing inertial-stabilized platform
CN103713641A (en) * 2013-12-19 2014-04-09 北京航空航天大学 Formation splitting method of aircraft intensive autonomous formation
CN106483964A (en) * 2015-08-31 2017-03-08 中南大学 A kind of robot Shared control method based on contact force observer
CN106707759A (en) * 2017-02-17 2017-05-24 中国空气动力研究与发展中心计算空气动力研究所 Airplane Herbst maneuvering control method
CN106933104A (en) * 2017-04-21 2017-07-07 苏州工业职业技术学院 A kind of quadrotor attitude based on DIC PID and the mixing control method of position
CN108388270A (en) * 2018-03-21 2018-08-10 天津大学 Cluster unmanned plane track posture cooperative control method towards security domain
CN108445766A (en) * 2018-05-15 2018-08-24 山东大学 Model-free quadrotor drone contrail tracker and method based on RPD-SMC and RISE
CN108958289A (en) * 2018-07-28 2018-12-07 天津大学 Cluster unmanned plane collision prevention method based on relative velocity obstacle

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103335651A (en) * 2013-06-19 2013-10-02 北京航空航天大学 Double-speed-ring control method of aerial remote sensing inertial-stabilized platform
CN103713641A (en) * 2013-12-19 2014-04-09 北京航空航天大学 Formation splitting method of aircraft intensive autonomous formation
CN106483964A (en) * 2015-08-31 2017-03-08 中南大学 A kind of robot Shared control method based on contact force observer
CN106707759A (en) * 2017-02-17 2017-05-24 中国空气动力研究与发展中心计算空气动力研究所 Airplane Herbst maneuvering control method
CN106933104A (en) * 2017-04-21 2017-07-07 苏州工业职业技术学院 A kind of quadrotor attitude based on DIC PID and the mixing control method of position
CN108388270A (en) * 2018-03-21 2018-08-10 天津大学 Cluster unmanned plane track posture cooperative control method towards security domain
CN108445766A (en) * 2018-05-15 2018-08-24 山东大学 Model-free quadrotor drone contrail tracker and method based on RPD-SMC and RISE
CN108958289A (en) * 2018-07-28 2018-12-07 天津大学 Cluster unmanned plane collision prevention method based on relative velocity obstacle

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
SONG GAO.ETC: "《Cooperative Control of Multiple Nonholonomic Robots for Escorting and Patrolling Mission Based on Vector Field》", 《IEEE ACCESS》 *
张学胜等: "《多体***动力学Eulre-Lagrange方程的非线性规划方法》", 《工程力学》 *

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111722625A (en) * 2019-12-18 2020-09-29 北京交通大学 Stability analysis method for time-varying number group robot relay target tracking system
CN111158242A (en) * 2020-01-17 2020-05-15 山东大学 Convoy task cooperative control method and system based on obstacle environment and bounded input
CN111396268A (en) * 2020-03-11 2020-07-10 上海电机学院 Wind turbine generator cabin environment monitoring method and device
CN112643673A (en) * 2020-12-14 2021-04-13 山东大学 Mobile mechanical arm robust control method and system based on non-linear disturbance observer
CN112643673B (en) * 2020-12-14 2022-05-03 山东大学 Mobile mechanical arm robust control method and system based on nonlinear disturbance observer
CN113625781A (en) * 2021-08-16 2021-11-09 北京航空航天大学 Tracking control method of Euler-Lagrange system based on event

Also Published As

Publication number Publication date
CN110554607B (en) 2020-11-24

Similar Documents

Publication Publication Date Title
CN110554607B (en) Cooperative control method and system with obstacle avoidance and navigation protection tasks for multi-Euler-Lagrange system
Zhou et al. Fast, on-line collision avoidance for dynamic vehicles using buffered voronoi cells
Lopez et al. Aggressive 3-D collision avoidance for high-speed navigation.
Gohari et al. Using chaotic maps for 3D boundary surveillance by quadrotor robot
Tran et al. Switching time-invariant formation control of a collaborative multi-agent system using negative imaginary systems theory
García-Aracil et al. Continuous visual servoing despite the changes of visibility in image features
Jafari et al. Brain emotional learning-based intelligent controller for flocking of multi-agent systems
CN110561417B (en) Multi-agent collision-free track planning method
Saleh et al. Optimal trajectory tracking control for a wheeled mobile robot using fractional order PID controller
Villarreal-Cervantes et al. Stabilization of a (3, 0) mobile robot by means of an event-triggered control
Tran et al. Switching formation strategy with the directed dynamic topology for collision avoidance of a multi‐robot system in uncertain environments
Park et al. Path planning for autonomous mobile robot based on safe space
Wang et al. Collision-free trajectory design for 2-d persistent monitoring using second-order agents
Di Lillo et al. Safety-related tasks within the set-based task-priority inverse kinematics framework
Umemoto et al. Dynamic cooperative transportation control using friction forces of n multi-rotor unmanned aerial vehicles
Shen et al. Multi-robot cooperative hunting
Li et al. A model predictive obstacle avoidance method based on dynamic motion primitives and a Kalman filter
CN111158242B (en) Convoy task cooperative control method and system based on obstacle environment and bounded input
Yin et al. Formation control for multiple unmanned aerial vehicles in constrained space using modified artificial potential field
Tugal et al. Manipulation at optimum locations for maximum force transmission with mobile robots under environmental disturbances
Park et al. Formation reconfiguration control with collision avoidance of nonholonomic mobile robots
Brandstätter et al. Multi-agent spatial predictive control with application to drone flocking (extended version)
Hong et al. Mobile robot control architecture for reflexive avoidance of moving obstacles
Skyrda Decentralized autonomous unmanned aerial vehicle swarm formation and flight control
Chetty et al. Coordination control of wheeled mobile robots? A hybrid approach

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