CN111259546B - Circumferential formation control method and system for self-driven vehicles and storage medium - Google Patents

Circumferential formation control method and system for self-driven vehicles and storage medium Download PDF

Info

Publication number
CN111259546B
CN111259546B CN202010043472.0A CN202010043472A CN111259546B CN 111259546 B CN111259546 B CN 111259546B CN 202010043472 A CN202010043472 A CN 202010043472A CN 111259546 B CN111259546 B CN 111259546B
Authority
CN
China
Prior art keywords
controller
autonomous
vehicle
designing
phase angle
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202010043472.0A
Other languages
Chinese (zh)
Other versions
CN111259546A (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.)
University of Science and Technology of China USTC
Original Assignee
University of Science and Technology of China USTC
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 University of Science and Technology of China USTC filed Critical University of Science and Technology of China USTC
Priority to CN202010043472.0A priority Critical patent/CN111259546B/en
Publication of CN111259546A publication Critical patent/CN111259546A/en
Application granted granted Critical
Publication of CN111259546B publication Critical patent/CN111259546B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention discloses a self-driven vehicle circumference formation control method, a system and a storage medium, which comprises the following steps executed by computer equipment: s100, establishing a dynamic model of the autonomous driving vehicle; s200, designing a controller based on the dynamic model in the step S100; and S300, acquiring information of the autonomous driving vehicles and realizing circular formation based on the controller in the step S200. The invention designs the circle center controller, and compared with the traditional method of giving the circle center in advance, the invention can be combined with other intelligent algorithms to be improved so as to complete complex tasks, such as signal source searching through a particle algorithm. The invention establishes a dynamic model of the autonomous driving vehicle, and the model can describe the motion state of the actual autonomous driving vehicle more than a single integral or double integral model.

Description

Circumferential formation control method and system for self-driven vehicles and storage medium
Technical Field
The invention relates to the technical field of intelligent systems, in particular to a method and a system for controlling circumferential formation of self-driven vehicles and a storage medium.
Background
With the rapid development of communication technology, perception network and chip computing power, the coordination problem of a multi-agent system in the past two decades has aroused the interest of a plurality of experts and scholars, and the coordination problem is that a group of agents which can communicate with each other can jointly complete a complex task through design. The cooperative control problem of multiple intelligent agents has many engineering applications, such as unmanned aerial vehicle formation, intelligent factories, environmental monitoring, intelligent buildings and intelligent monitoring. Among the multi-agent cooperative control problems, the distributed round robin control problem, in which all agents trace a circle with a fixed center, is an attractive and challenging research direction.
Inspired by three major rules proposed by Akira Okubo ("dynamic aspects of animal grouping: swarms, zools, flocks, and circles," Advances in biophysics,1986,22:1-94.), n.e.leonard and e.firellin.at the 40 th conference of control and decision ("visual drivers, intellectual properties and coordinated control of groups," Orlando, FL, USA,2001, pp.2968-2973), it was initially proposed how to design a controller to complete a circular formation of fully driven objects, wherein a non-linear function was introduced to assist the fully driven objects to keep a certain distance. Compared with the single-integral or double-integral model used by the two scientific documents, the dynamic model provided by the invention is more consistent with the actual motion situation of the general vehicles.
Sepulture et al ("Stabilization of planar collective movement with limited communication," IEEE Transactions Automatic Control, vol.53, No.3, pp.706-719,2008.) propose a Control algorithm that allows multiple agents to complete circular queuing when the network conditions can be described as directed cyclic graphs. A new circumferential queuing method is proposed by a jain and d.ghose (Stabilization of the circumferential movement in synchronized, balanced and space phase arrangements on a determined circle, "in proc. am. control con. (ACC), Chicago, IL, USA,2015, pp.731-736) so that multiple agents can perform circumferential queuing around a specified center of circle. However, these methods have two disadvantages. Firstly, the circle center is either given or unpredictable, so that the algorithm portability is poor; the second is that the algorithm requires extremely reliable network communication conditions, which requires a large amount of capital to implement.
Disclosure of Invention
The invention provides a method, a system and a storage medium for controlling circumferential formation of self-driven vehicles, which can solve the technical problems that the algorithm portability is poor, reliable network communication conditions are required and the cost is high because the existing method cannot realize prediction.
In order to achieve the purpose, the invention adopts the following technical scheme:
a method of circle formation control of self-propelled vehicles, comprising performing, by a computer device, the steps of:
s100, establishing a dynamic model of the autonomous driving vehicle;
s200, designing a controller based on the dynamic model in the step S100;
and S300, acquiring information of the autonomous driving vehicles and realizing circular formation based on the controller in the step S200.
Further, the S100 establishes a dynamic model of the autonomous-driven vehicle, including:
establishing a system state equation:
Figure GDA0003547018800000021
Figure GDA0003547018800000022
i-1, 2, … …, n. wherein
Figure GDA0003547018800000023
Position information for autonomously driven vehicles, vi(t) cruise speed of the autonomous vehicle, θi(t) steering angle of autonomous-driving vehicle, ui(t) is a control input, i.e.
Figure GDA0003547018800000024
Further, the controller of S200 is designed by a reverse step design method, and specifically includes the following steps:
setting initial conditions: c. Ci(0),i=1,2,……,N,d0,w0The network condition being the presence of a constant TObtaining a union graph with any time period with the length larger than T, wherein the union graph is in undirected communication;
wherein, ci(0) For the initial estimation of the center of a circle for the ith autonomous vehicle, d0For a previously set radius of rotation, w0Is a rotational angular velocity set in advance;
s201, distributed design initial phase angle position:
s2011, maximum consistency algorithm:
inputting:
Figure GDA0003547018800000031
n,a,T
and (3) outputting: m isi
k=1;
Figure GDA0003547018800000032
Figure GDA0003547018800000033
Figure GDA0003547018800000034
k++;
end
mi=xi(t+ka).
Where a is the time required for one data exchange, ceil (-) is an upward rounding function, Ni(t) a set of autonomous vehicles communicating with the ith autonomous vehicle at time t;
s2012, an improved sequential arrangement algorithm:
inputting: idi,n,a,T
And (3) outputting: mi
fi=idi,k=n;
whilek≥1
miMaximum agreement algorithm (c)fi,n,a,T);
if idi==mi
Mi=k,fi=-∞;
end
k--;
end;
S2013, assigning an initial phase angle position:
Figure GDA0003547018800000035
s202, setting the controller:
s2021, designing a function h (x) satisfying the following conditions
a. The function h (x) is bounded;
b. the function h (x) is strictly increasing;
c.xh(x)≥0.
s2022, designing a circle center controller as follows:
Figure GDA0003547018800000041
s2023, ith phase angle controller settings are as follows:
Figure GDA0003547018800000042
Figure GDA0003547018800000043
Figure GDA0003547018800000044
Figure GDA0003547018800000045
Figure GDA0003547018800000046
Figure GDA0003547018800000047
Figure GDA0003547018800000048
Figure GDA0003547018800000049
Figure GDA00035470188000000410
Figure GDA00035470188000000411
wherein k is1,k2,k3Is a constant greater than zero, I is a 2 x 2 unit array,
Figure GDA00035470188000000412
eiand (t) is a phase angle configuration error.
Meanwhile, the invention also discloses a circumferential formation control system of the self-driven vehicle, which comprises the following modules:
a model establishing unit for establishing a dynamic model of the autonomous driving vehicle;
a controller designing unit for designing the controller based on the kinetic model established by the model establishing unit;
and the circumference formation control unit is used for acquiring the information of the autonomous driving vehicle and realizing circumference formation based on the controller of the controller design unit.
The model establishing unit specifically executes the following steps:
establishing a system state equation:
Figure GDA0003547018800000051
Figure GDA0003547018800000052
i-1, 2, … …, n. wherein
Figure GDA0003547018800000053
Position information for autonomously driven vehicles, vi(t) cruise speed of the autonomous vehicle, θi(t) steering angle of autonomous-driving vehicle, ui(t) is a control input, i.e.
Figure GDA0003547018800000054
The controller design unit is designed by adopting a backstepping design method, and comprises the following specific steps:
setting initial conditions: c. Ci(0),i=1,2,……,N,d0,w0The network condition is that a constant T exists, so that the union graph is in undirected communication in any time period with the length larger than T;
wherein, ci(0) For the initial estimation of the center of a circle for the ith autonomous vehicle, d0For a previously set radius of rotation, w0Is a rotational angular velocity set in advance;
s201, distributed design initial phase angle position:
s2011, maximum consistency algorithm:
inputting:
Figure GDA0003547018800000055
n,a,T
and (3) outputting: m isi
k=1;
Figure GDA0003547018800000056
Figure GDA0003547018800000057
Figure GDA0003547018800000058
k++;
end
mi=xi(t+ka).
Where a is the time required for one data exchange, ceil (-) is an upward rounding function, Ni(t) a set of autonomous vehicles communicating with the ith autonomous vehicle at time t;
s2012, an improved sequential arrangement algorithm:
inputting: idi,n,a,T
And (3) outputting: mi
fi=idi,k=n;
while k≥1
miMaximum agreement algorithm (f)i,n,a,T);
if idi==mi
Mi=k,fi=-∞;
end
k--;
end;
S2013, assigning an initial phase angle position:
Figure GDA0003547018800000061
s202, setting the controller:
s2021, designing a function h (x) satisfying the following conditions
a. The function h (x) is bounded;
b. the function h (x) is strictly increasing;
c.xh(x)≥0.
s2022, designing a circle center controller as follows:
Figure GDA0003547018800000062
s2023, ith phase angle controller settings are as follows:
Figure GDA0003547018800000063
Figure GDA0003547018800000064
Figure GDA0003547018800000065
Figure GDA0003547018800000066
Figure GDA0003547018800000071
Figure GDA0003547018800000072
Figure GDA0003547018800000073
Figure GDA0003547018800000074
Figure GDA0003547018800000075
Figure GDA0003547018800000076
wherein k is1,k2,k3Is a constant greater than zero, I is a 2 x 2 unit array,
Figure GDA0003547018800000077
eiand (t) is a phase angle configuration error.
In a third aspect, the present invention also discloses a storage medium, on which a computer program is stored, which, when executed by a processor, can implement the self-driven vehicle circular formation control method described above.
According to the technical scheme, the circle center controller and the phase angle controller can be kept in parallel by the circle center controller circumference formation control method of the self-driven vehicle, wherein the circle center controller is designed, can be combined with other intelligent algorithms to monitor circle center change in real time, and can be used for monitoring moving targets, forest fire spreading trends and the like; the initial value of the phase angle does not need to be manually designed, but is given by a distributed sorting algorithm, so that the applicability of the algorithm in various occasions is improved; in addition, the invention does not need an extremely reliable network environment and can endure the condition of temporary disconnection of the network.
The invention has the following beneficial effects:
1. the invention designs the circle center controller, and compared with the traditional method of giving the circle center in advance, the invention can be combined with other intelligent algorithms to be improved so as to complete complex tasks, such as signal source searching through a particle algorithm. The invention establishes a dynamic model of the autonomous driving vehicle, and the model can describe the motion state of the actual autonomous driving vehicle more than a single integral or double integral model.
2. In a general method for controlling the circular formation of self-driven vehicles, a communication network between the self-driven vehicles is required to be extremely reliable, and a large amount of money is spent to obtain the communication network condition, so that waste is caused. The circumference formation control method of the self-driven vehicle can complete the circumference formation task in a poor network environment and can tolerate the packet loss of a communication network.
Drawings
FIG. 1 is a flow chart of a method of the present invention;
fig. 2 is a schematic diagram of the method of the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are some, but not all, embodiments of the present invention.
As shown in fig. 1 and fig. 2, the method for controlling circumferential formation of self-propelled vehicles according to the present embodiment includes the following steps performed by a computer device:
s100, establishing a dynamic model of the autonomous driving vehicle;
s200, designing a controller based on the dynamic model in the step S100;
and S300, acquiring information of the autonomous driving vehicles and realizing circular formation based on the controller in the step S200.
The following is a detailed description:
the dynamic model of the autonomous driving vehicle in step S100 is as follows:
establishing a system state equation:
Figure GDA0003547018800000081
Figure GDA0003547018800000082
i-1, 2, … …, n. wherein
Figure GDA0003547018800000083
Position information for autonomously driven vehicles, vi(t) cruise speed of the autonomous vehicle, θi(t) steering angle of autonomous-driving vehicle, ui(t) is a control input, i.e.
Figure GDA0003547018800000084
In step S200, the controller is designed by a reverse step design method, specifically including the steps of:
setting initial conditions: c. Ci(0),i=1,2,……,N,d0,w0The network condition is that a constant T exists, so that the union graph is in undirected communication in any time period with the length larger than T;
wherein, ci(0) For the initial estimation of the center of a circle for the ith autonomous vehicle, d0For a previously set radius of rotation, w0Is a rotational angular velocity set in advance;
the method comprises the following specific steps:
1) distributed design initial phase angle position:
1.1) maximum agreement algorithm:
inputting:
Figure GDA0003547018800000091
n,a,T
and (3) outputting: m isi
k=1;
Figure GDA0003547018800000092
Figure GDA0003547018800000093
Figure GDA0003547018800000094
k++;
end
mi=xi(t+ka).
Where a is the time required for one data exchange, ceil (-) is an upward rounding function, Ni(t) is the set of autonomous vehicles that communicate with the ith autonomous vehicle at time t.
1.2) improved sequencing algorithm:
inputting: idi,n,a,T
And (3) outputting: mi
fi=idi,k=n;
while k≥1
miMaximum agreement algorithm (f)i,n,a,T);
if idi==mi
Mi=k,fi=-∞;
end
k--;
end;
1.3) assigning an initial phase angle position:
Figure GDA0003547018800000095
2) the controller is provided with:
2.1) designing a function h (x) satisfying the following conditions
a. The function h (x) is bounded;
b. the function h (x) is strictly increasing;
c.xh(x)≥0.
2.2) the circle center controller is designed as follows:
Figure GDA0003547018800000101
2.3) ith phase angle controller settings are as follows:
Figure GDA0003547018800000102
Figure GDA0003547018800000103
Figure GDA0003547018800000104
Figure GDA0003547018800000105
Figure GDA0003547018800000106
Figure GDA0003547018800000107
Figure GDA0003547018800000108
Figure GDA0003547018800000109
Figure GDA00035470188000001010
Figure GDA00035470188000001011
wherein k is1,k2,k3Is a constant greater than zero, I is a 2 x 2 unit array,
Figure GDA00035470188000001012
eiand (t) is a phase angle configuration error.
Therefore, the self-driven vehicle circumference formation control method provided by the embodiment of the invention is different from the conventional circumference formation control method, firstly, the requirement on network reliability is low, the communication is not required to be ensured to be uninterrupted every moment among the self-driven vehicles, and the difficulty and the capital cost of network arrangement are greatly reduced. Secondly, the circle center controller is introduced to enable the self-driven vehicles to form a team quickly, compared with an artificial designated center, the problems that the circle center position is unreasonable in design and the like are solved, and other intelligent algorithms can be introduced to design the circle center controller to enable the self-driven vehicles to complete complex tasks, such as monitoring forest fire propagation, harmful gas diffusion range, tracking moving objects and the like. Different from the design of a common controller, the invention provides a distributed algorithm for designing phase angle parameters, so that self-driven vehicles can be uniformly distributed near the circle center, and the portability of the algorithm is greatly improved.
Meanwhile, the embodiment of the invention also discloses a circumferential formation control system of the self-driven vehicle, which comprises the following modules:
a model establishing unit for establishing a dynamic model of the autonomous driving vehicle;
a controller designing unit for designing the controller based on the kinetic model established by the model establishing unit;
and the circumference formation control unit is used for acquiring the information of the autonomous driving vehicle and realizing circumference formation based on the controller of the controller design unit.
The model establishing unit specifically executes the following steps:
establishing a system state equation:
Figure GDA0003547018800000111
Figure GDA0003547018800000112
i-1, 2, … …, n. wherein
Figure GDA0003547018800000113
Position information for autonomously driven vehicles, vi(t) cruise speed of the autonomous vehicle, θi(t) steering angle of autonomous-driving vehicle, ui(t) is a control input, i.e.
Figure GDA0003547018800000114
The controller design unit is designed by adopting a backstepping design method, and comprises the following specific steps:
setting initial conditions: c. Ci(0),i=1,2,……,N,d0,w0The network condition is that a constant T exists, so that the union graph is in undirected communication in any time period with the length larger than T;
wherein, ci(0) For the initial estimation of the center of a circle for the ith autonomous vehicle, d0For a previously set radius of rotation, w0Is a rotational angular velocity set in advance;
s201, distributed design initial phase angle position:
s2011, maximum agreement algorithm:
inputting:
Figure GDA0003547018800000115
n,a,T
and (3) outputting: m isi
k=1;
Figure GDA0003547018800000121
Figure GDA0003547018800000122
Figure GDA0003547018800000123
k++;
end
mi=xi(t+ka).
Where a is the time required for one data exchange, ceil (-) is an upward rounding function, Ni(t) a set of autonomous vehicles communicating with the ith autonomous vehicle at time t;
s2012, an improved sequential arrangement algorithm:
inputting: idi,n,a,T
And (3) outputting: mi
fi=idi,k=n;
whilek≥1
miMaximum agreement algorithm (f)i,n,a,T);
if idi==mi
Mi=k,fi=-∞;
end
k--;
end;
S2013, assigning an initial phase angle position:
Figure GDA0003547018800000124
s202, setting the controller:
s2021, designing a function h (x) satisfying the following conditions
a. The function h (x) is bounded;
b. the function h (x) is strictly increasing;
c.xh(x)≥0.
s2022, designing a circle center controller as follows:
Figure GDA0003547018800000131
s2023, ith phase angle controller settings are as follows:
Figure GDA0003547018800000132
Figure GDA0003547018800000133
Figure GDA0003547018800000134
Figure GDA0003547018800000135
Figure GDA0003547018800000136
Figure GDA0003547018800000137
Figure GDA0003547018800000138
Figure GDA0003547018800000139
Figure GDA00035470188000001310
Figure GDA00035470188000001311
wherein k is1,k2,k3Is a constant greater than zero, I is a 2 x 2 unit array,
Figure GDA00035470188000001312
eiand (t) is a phase angle configuration error.
It is understood that the system provided by the embodiment of the present invention corresponds to the method provided by the embodiment of the present invention, and the explanation, the example and the beneficial effects of the related contents can refer to the corresponding parts in the method.
The embodiment of the application also provides an electronic device, which comprises a processor, a communication interface, a memory and a communication bus, wherein the processor, the communication interface and the memory complete mutual communication through the communication bus,
a memory for storing a computer program;
the processor is used for realizing the self-driven vehicle circumference formation control method when executing the program stored in the memory, and the method comprises the following steps:
establishing a dynamic model of an autonomous driving vehicle;
designing a controller based on a dynamic model;
based on the controller, information of the autonomous driving vehicle is obtained and circular formation is realized.
The communication bus mentioned in the electronic device may be a Peripheral Component Interconnect (PCI) bus or an Extended Industry Standard Architecture (EISA) bus. The communication bus may be divided into an address bus, a data bus, a control bus, etc. For ease of illustration, only one thick line is shown, but this does not mean that there is only one bus or one type of bus.
The communication interface is used for communication between the electronic equipment and other equipment.
The Memory may include a Random Access Memory (RAM), or may include a Non-Volatile Memory (NVM), such as at least one disk Memory. Optionally, the memory may also be at least one memory device located remotely from the processor.
The Processor may be a general-purpose Processor, including a Central Processing Unit (CPU), a Network Processor (NP), and the like; the Integrated Circuit may also be a Digital Signal Processor (DSP), an Application Specific Integrated Circuit (ASIC), a Field Programmable Gate Array (FPGA), or other Programmable logic devices, discrete gate or transistor logic devices, or discrete hardware components.
In yet another embodiment provided by the present application, a computer-readable storage medium is further provided, in which a computer program is stored, and the computer program, when executed by a processor, implements the steps of any of the above-mentioned methods for controlling formation of a self-propelled vehicle circumference.
In yet another embodiment provided by the present application, there is also provided a computer program product containing instructions that, when run on a computer, cause the computer to perform any of the self-propelled vehicle circular formation control methods of the above embodiments.
In the above embodiments, all or part of the implementation may be realized by software, hardware, firmware, or any combination thereof. When implemented in software, may be implemented in whole or in part in the form of a computer program product. The computer program product includes one or more computer instructions. When loaded and executed on a computer, cause the processes or functions described in accordance with the embodiments of the application to occur, in whole or in part. The computer may be a general purpose computer, a special purpose computer, a network of computers, or other programmable device. The computer instructions may be stored in a computer readable storage medium or transmitted from one computer readable storage medium to another, for example, from one website site, computer, server, or data center to another website site, computer, server, or data center via wired (e.g., coaxial cable, fiber optic, Digital Subscriber Line (DSL)) or wireless (e.g., infrared, wireless, microwave, etc.). The computer-readable storage medium can be any available medium that can be accessed by a computer or a data storage device, such as a server, a data center, etc., that incorporates one or more of the available media. The usable medium may be a magnetic medium (e.g., floppy Disk, hard Disk, magnetic tape), an optical medium (e.g., DVD), or a semiconductor medium (e.g., Solid State Disk (SSD)), among others.
It is noted that, herein, relational terms such as first and second, and the like may be used solely to distinguish one entity or action from another entity or action without necessarily requiring or implying any actual such relationship or order between such entities or actions. Also, the terms "comprises," "comprising," or any other variation thereof, are intended to cover a non-exclusive inclusion, such that a process, method, article, or apparatus that comprises a list of elements does not include only those elements but may include other elements not expressly listed or inherent to such process, method, article, or apparatus. Without further limitation, an element defined by the phrase "comprising an … …" does not exclude the presence of other identical elements in a process, method, article, or apparatus that comprises the element.
The above examples are only intended to illustrate the technical solution of the present invention, but not to limit it; although the present invention has been described in detail with reference to the foregoing embodiments, it will be understood by those of ordinary skill in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some technical features may be equivalently replaced; and such modifications or substitutions do not depart from the spirit and scope of the corresponding technical solutions of the embodiments of the present invention.

Claims (3)

1. A circle formation control method for self-driven vehicles is characterized by comprising the following steps: performing, by a computer device, the steps of:
s100, establishing a dynamic model of the autonomous driving vehicle;
s200, designing a controller based on the dynamic model in the step S100;
s300, acquiring information of the autonomous driving vehicles and realizing circular formation based on the controller in the step S200;
wherein the S100 establishes a dynamic model of the autonomous-driven vehicle, including:
establishing a system state equation:
Figure FDA0003547018790000011
Figure FDA0003547018790000012
1,2
Figure FDA0003547018790000013
Position information for autonomously driven vehicles, vi(t) is the cruising speed of the ith autonomous-powered vehicle, thetai(t) is the steering angle of the ith autonomous-powered vehicle, ui(t) is a control input to the controller,
Figure FDA0003547018790000014
the controller of S200 is designed by a backstepping design method, and the specific steps are as follows:
setting initial conditions: c. Ci(0) 1,2,.. 7., N and d0,w0The network condition is that a constant T exists, so that the union graph is in undirected communication in any time period with the length larger than T;
wherein, ci(0) For the initial estimation of the center of a circle for the ith autonomous vehicle, d0For a previously set radius of rotation, w0Is a rotational angular velocity set in advance;
s201, distributed design initial phase angle position:
s2011, maximum consistency algorithm:
inputting:
Figure FDA0003547018790000015
n,a,T
and (3) outputting: m isi
k=1;
Figure FDA0003547018790000016
Figure FDA0003547018790000017
Figure FDA0003547018790000018
k++;
end
mi=xi(t+ka);
Where a is the time required for one data exchange, ceil (-) is an upward rounding function, Ni(t) a set of autonomous vehicles communicating with the ith autonomous vehicle at time t;
s2012, an improved sequential arrangement algorithm:
inputting: idi,n,a,T
And (3) outputting: mi
fi=idi,k=n;
while k≥1
miMaximum agreement algorithm (f)i,n,a,T);
if idi==mi
Mi=k,fi=-∞;
end
k--;
end;
S2013, assigning an initial phase angle position:
Figure FDA0003547018790000021
s202, setting the controller:
s2021, designing a function h (x) satisfying the following conditions
a. The function h (x) is bounded;
b. the function h (x) is strictly increasing;
c.xh(x)≥0;
s2022, designing a circle center controller as follows:
Figure FDA0003547018790000022
s2023, ith phase angle controller settings are as follows:
Figure FDA0003547018790000031
Figure FDA0003547018790000032
Figure FDA0003547018790000033
Figure FDA0003547018790000034
Figure FDA0003547018790000035
Figure FDA0003547018790000036
Figure FDA0003547018790000037
Figure FDA0003547018790000038
Figure FDA0003547018790000039
Figure FDA00035470187900000310
wherein k is1,k2,k3Is a constant greater than zero, I is a 2 x 2 unit array,
Figure FDA00035470187900000311
eiand (t) is a phase angle configuration error.
2. A self-propelled vehicle circumferential formation control system, characterized by:
the system comprises the following modules:
a model establishing unit for establishing a dynamic model of the autonomous driving vehicle;
a controller designing unit for designing the controller based on the kinetic model established by the model establishing unit;
the circumference formation control unit is used for acquiring the information of the autonomous driving vehicle and realizing circumference formation based on the controller of the controller design unit;
the model establishing unit specifically executes the steps of:
establishing a system state equation:
Figure FDA00035470187900000312
Figure FDA00035470187900000313
1,2
Figure FDA00035470187900000314
Position information for autonomously driven vehicles, vi(t) cruise speed of the autonomous vehicle, θi(t) steering angle of autonomous-driving vehicle, ui(t) is a control input to the controller,
Figure FDA0003547018790000041
the controller design unit is designed by adopting a reverse step design method and comprises the following specific steps:
setting initial conditions: c. Ci(0) 1,2,.. 7., N and d0,w0The network condition is that a constant T exists, so that the union graph is in undirected communication in any time period with the length larger than T;
wherein, ci(0) For the initial estimation of the center of a circle for the ith autonomous vehicle, d0For a previously set radius of rotation, w0Is a rotational angular velocity set in advance;
s201, distributed design initial phase angle position:
s2011, maximum consistency algorithm:
inputting:
Figure FDA0003547018790000042
n,a,T
and (3) outputting: m isi
k=1;
Figure FDA0003547018790000043
Figure FDA0003547018790000044
Figure FDA0003547018790000045
k++;
end
mi=xi(t+ka);
Where a is the time required for one data exchange, ceil (-) is an upward rounding function, Ni(t) a set of autonomous vehicles communicating with the ith autonomous vehicle at time t;
s2012, an improved sequential arrangement algorithm:
inputting: idi,n,a,T
And (3) outputting: mi
fi=idi,k=n;
while k≥1
miMaximum agreement algorithm (f)i,n,a,T);
if idi==mi
Mi=k,fi=-∞;
end
k--;
end;
S2013, assigning an initial phase angle position:
Figure FDA0003547018790000051
s202, setting the controller:
s2021, designing a function h (x) satisfying the following conditions
a. The function h (x) is bounded;
b. the function h (x) is strictly increasing;
c.xh(x)≥0;
s2022, designing a circle center controller as follows:
Figure FDA0003547018790000052
s2023, ith phase angle controller settings are as follows:
Figure FDA0003547018790000053
Figure FDA0003547018790000054
Figure FDA0003547018790000055
Figure FDA0003547018790000056
Figure FDA0003547018790000057
Figure FDA0003547018790000058
Figure FDA0003547018790000059
Figure FDA00035470187900000510
Figure FDA00035470187900000511
Figure FDA0003547018790000061
wherein k is1,k2,k3Is a constant greater than zero, I is a 2 x 2 unit array,
Figure FDA0003547018790000062
eiand (t) is a phase angle configuration error.
3. A storage medium on which a computer program is stored, wherein the computer program, when executed by a processor, implements the self-propelled vehicle circular formation control method of claim 1.
CN202010043472.0A 2020-01-15 2020-01-15 Circumferential formation control method and system for self-driven vehicles and storage medium Active CN111259546B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010043472.0A CN111259546B (en) 2020-01-15 2020-01-15 Circumferential formation control method and system for self-driven vehicles and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010043472.0A CN111259546B (en) 2020-01-15 2020-01-15 Circumferential formation control method and system for self-driven vehicles and storage medium

Publications (2)

Publication Number Publication Date
CN111259546A CN111259546A (en) 2020-06-09
CN111259546B true CN111259546B (en) 2022-05-13

Family

ID=70945197

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010043472.0A Active CN111259546B (en) 2020-01-15 2020-01-15 Circumferential formation control method and system for self-driven vehicles and storage medium

Country Status (1)

Country Link
CN (1) CN111259546B (en)

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1901153A1 (en) * 2006-09-12 2008-03-19 OFFIS e.V. Control system for unmanned 4-rotor-helicopter
CN104076689A (en) * 2014-07-17 2014-10-01 山东省科学院海洋仪器仪表研究所 Full-actuating type autonomous underwater vehicle cooperative control method
CN105138010A (en) * 2015-08-31 2015-12-09 哈尔滨工业大学 Distributed limited time tracking control method for formation-flying satellites
CN105955274A (en) * 2016-05-25 2016-09-21 重庆大学 Multi-robot circular formation control method based on distributed circle center and radius estimation
CN106845371A (en) * 2016-12-31 2017-06-13 中国科学技术大学 A kind of city road network automotive emission remote sensing monitoring system
CN107179777A (en) * 2017-06-03 2017-09-19 复旦大学 Multiple agent cluster Synergistic method and multiple no-manned plane cluster cooperative system
CN107844127A (en) * 2017-09-20 2018-03-27 北京飞小鹰科技有限责任公司 Towards the formation flight device cooperative control method and control system of finite time
CN108764453A (en) * 2018-06-08 2018-11-06 中国科学技术大学 The modeling method and action prediction system of game are synchronized towards multiple agent
CN109508035A (en) * 2018-12-24 2019-03-22 南京邮电大学 Multizone stagewise unmanned plane formation paths planning method based on distributed AC servo system
CN110109351A (en) * 2019-04-08 2019-08-09 广东工业大学 A kind of multiple agent consistency control method based on specified performance
CN110597061A (en) * 2019-09-18 2019-12-20 中国人民解放军火箭军工程大学 Multi-agent fully-distributed active-disturbance-rejection time-varying formation control method

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101416916B1 (en) * 2013-12-13 2014-07-09 국방과학연구소 Optimization distribution system of items in military logistics based on multi agent system and control method of the same
US10915108B2 (en) * 2018-03-29 2021-02-09 Mitsubishi Electric Research Laboratories, Inc. Robust source seeking and formation learning-based controller
CN108983786A (en) * 2018-08-08 2018-12-11 华南理工大学 A kind of communication context constrains the formation control method of lower mobile robot
CN110488845A (en) * 2019-09-18 2019-11-22 中国人民解放军火箭军工程大学 A kind of barrier, which blocks lower multiple agent active disturbance rejection time-varying, forms into columns tracking and collision avoidance control method

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1901153A1 (en) * 2006-09-12 2008-03-19 OFFIS e.V. Control system for unmanned 4-rotor-helicopter
CN104076689A (en) * 2014-07-17 2014-10-01 山东省科学院海洋仪器仪表研究所 Full-actuating type autonomous underwater vehicle cooperative control method
CN105138010A (en) * 2015-08-31 2015-12-09 哈尔滨工业大学 Distributed limited time tracking control method for formation-flying satellites
CN105955274A (en) * 2016-05-25 2016-09-21 重庆大学 Multi-robot circular formation control method based on distributed circle center and radius estimation
CN106845371A (en) * 2016-12-31 2017-06-13 中国科学技术大学 A kind of city road network automotive emission remote sensing monitoring system
CN107179777A (en) * 2017-06-03 2017-09-19 复旦大学 Multiple agent cluster Synergistic method and multiple no-manned plane cluster cooperative system
CN107844127A (en) * 2017-09-20 2018-03-27 北京飞小鹰科技有限责任公司 Towards the formation flight device cooperative control method and control system of finite time
CN108764453A (en) * 2018-06-08 2018-11-06 中国科学技术大学 The modeling method and action prediction system of game are synchronized towards multiple agent
CN109508035A (en) * 2018-12-24 2019-03-22 南京邮电大学 Multizone stagewise unmanned plane formation paths planning method based on distributed AC servo system
CN110109351A (en) * 2019-04-08 2019-08-09 广东工业大学 A kind of multiple agent consistency control method based on specified performance
CN110597061A (en) * 2019-09-18 2019-12-20 中国人民解放军火箭军工程大学 Multi-agent fully-distributed active-disturbance-rejection time-varying formation control method

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
Collective circular motion of multi-vehicle systems;N.Ceccarelli .etal;《Automatica》;20081231;第44卷(第12期);3025页 *
Cooperative circumnavigation of a moving target with multiple nonholonomic robots using backstepping design;Zhiqiang Miao 等;《Systems & Control Letters》;20170410(第103期);58,60,64页 *
N.Ceccarelli .etal.Collective circular motion of multi-vehicle systems.《Automatica》.2008,第44卷(第12期),3025-3035页. *
Zhiqiang Miao 等.Cooperative circumnavigation of a moving target with multiple nonholonomic robots using backstepping design.《Systems & Control Letters》.2017,(第103期),58-65页. *
具有时滞的多智能体系统三维空间环绕控制问题研究;吴雪琪;《中国优秀硕士学位论文全文数据库 (信息科技辑)》;20190115(第1期);I140-36页 *

Also Published As

Publication number Publication date
CN111259546A (en) 2020-06-09

Similar Documents

Publication Publication Date Title
US20230325722A1 (en) Model training method, data processing method, and apparatus
Ge et al. Distributed controller–estimator for target tracking of networked robotic systems under sampled interaction
Lorencik et al. Cloud robotics: Current trends and possible use as a service
US10762616B2 (en) Method and system of analytics system balancing lead time and accuracy of edge analytics modules
Yu et al. Practical time‐varying formation tracking for multiple non‐holonomic mobile robot systems based on the distributed extended state observers
Zhao et al. A hierarchical cooperative mission planning mechanism for multiple unmanned aerial vehicles
Wu et al. SDP-based robust formation-containment coordination of swarm robotic systems with input saturation
JP7196189B2 (en) Method, device and control system for controlling a mobile robot
CN111259546B (en) Circumferential formation control method and system for self-driven vehicles and storage medium
CN111319041A (en) Robot pose determining method and device, readable storage medium and robot
Meng et al. A discrete-time distributed optimization algorithm for cooperative transportation of multi-robot system
Hou et al. Adaptive fuzzy formation control for heterogeneous multi-agent systems using time-varying IBLFs
CN115576332A (en) Task-level multi-robot collaborative motion planning system and method
Kurbatsky et al. Optimal training of artificial neural networks to forecast power system state variables
Zhang et al. Fixed-Time Control of a Robotic Arm Based on Disturbance Observer Compensation
Santoso et al. Trusted Operations of a Military Ground Robot in the Face of Man-in-the-Middle Cyber-Attacks Using Deep Learning Convolutional Neural Networks: Real-Time Experimental Outcomes
Xu et al. MADDPG: Multi-agent Deep Deterministic Policy Gradient Algorithm for Formation Elliptical Encirclement and Collision Avoidance
Zheng et al. Adaptive consensus tracking of first-order multi-agent systems with unknown control directions
Eisaabadi et al. Fuzzy distributed containment tracking of multi-agent systems with uncertain granular fuzzy linear dynamics
Hu et al. Adaptive filtering and smoothing algorithm based on variable structure interactive multiple model
Yang et al. Backstepping Fuzzy Adaptive Control Based on RBFNN for a Redundant Manipulator
CN116679573B (en) Consistency tracking control method and device, electronic equipment and storage medium
CN113596780B (en) Vehicle interaction information generation method, device, equipment and computer readable medium
Hamami et al. Dragonfly Algorithm for Multi-target Search Problem in Swarm Robotic with Dynamic Environment Size
CN117311346B (en) Robot transverse stability cooperative steering control method, device, terminal and medium

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