# Leader-Follower Based Locally Rigid Formation Control

Authors: Krishna Raghuwaiya; Bibhya Sharma; Jito Vanualailai
Journal: Journal of Advanced Transportation
 (2018)

---

## Abstract

This paper addresses motion control of a cooperative intelligent transport system (C-ITS) of nonholonomic mobile robots navigating a dynamic environment while maintaining a locally rigid formation. We consider the design of acceleration-based control inputs that govern the motion of cooperative intelligent transport system (C-ITS) using the artificial potential fields method for the avoidance of obstacles and attraction to designated targets. The control scheme utilizes a new leader-follower strategy using Cartesian coordinates to accomplish a collision-free locally rigid formation of an autonomous and intelligent transportation system. The concepts of virtual parking bays andminimum distance technique (MDT) are utilized to attain prescribed orientations of the formation at the final destination. The robustness of the control scheme is established by considering the effect noise on the formation, while the effectiveness of the proposed nonlinear control laws is demonstrated through computer simulations.


---

## Body

## 1. Introduction

Connected and autonomous vehicles play a huge role in the transportation industry worldwide and will govern the industry in the coming years. The connectedness is governed through vehicle-to-vehicle (V2V) and vehicle-to-infrastructure (V2I) communication, which is facilitated using wireless and cellular technologies at current times. Such key communications of thecooperative intelligent transport system (C-ITS) allow respective shareholders to utilize information and coordinate task transfers in a cooperative manner. The networked V2V and V2I interactions deliver substantial social benefits in terms of safer, traffic-efficient, cooperative autonomous driving and energy-efficient transportation systems on our roads and highways [1, 2].Cooperative tasks are more efficiently performed with desired robustness using multiple robots, which may not be possible with single robots. The benefits become apparent when considering distributed tasks, dangerous or hazardous tasks, and tasks that contain redundancies and when providing flexibility to task execution and robustness of systems [3–8]. In addition, there is the added advantage that working with multiple robots is less expensive than with just one specialized robot. To date there have been various applications of the control of C-ITS, for example, collaborative mapping and planning, search and rescue operations, flocking and schooling, transportation of large objects, undersea and space exploration, target seeking, competitive games, service robots, and military reconnaissance and surveillance [4, 8–13]. The ability of C-ITS to autonomously navigate in stable configurations while avoiding obstacles and collisions is also central to real-world applications [8, 14]. In many applications, the execution of the task requires formation control [3], and the accomplishment of the overall operation depends on each mobile robot operating in a prescribed manner. Typical examples include carrying a heavy load on roads and highways, hunting, and enclosing on an enemy to name a few.The concept of formation control of mechanical systems, an integrated branch of motion planning and control of C-ITS, is receiving unprecedented attention from researchers all over the world for real-world applications [14]. The basic idea of formation control algorithms is to ensure that a group of mobile robots move effectively as a whole to jointly perform certain task(s). Examples of formation control tasks include delegation of feasible formations, establishing formations, maintaining and mobilizing different formation shapes, and switching between formations [15]. There are numerous approaches in literature in relation to the observance of a prescribed formation of a flock during motion [14]; however, split/rejoin maneuvers and rigid formations are the prevalent approaches. The split/rejoin maneuvers are frequently cited in flocks of birds, swarms of insects and ants, and herds of animals. The applications of split/rejoin maneuvers in the field of robotics include reconnaissance, sampling, and surveillance. In contrast, rigid formations (globally rigid orlocally rigid) are required in many engineering applications, for example, parallel and simultaneous transportation of vehicles or delivery of payloads [12, 14, 16]. Alterations or distortions in formation must be detected early by a system and allow for reconfiguration for continued operation [7] in a locally rigid formation.In recent literature, a variety of control strategies have been proposed for formation or cooperative control of mobile robots and have been roughly categorized into virtual structure, behavior-based, and leader-follower schemes. The behavior-based approach normally [3] assigns different possible behaviors (e.g., formation keeping, obstacle avoidance, collision avoidance, and target attraction) to each individual robot. The ultimate action of each robot is determined by evaluating the comparative importance of each behavior. The limitation of the behavior-based approach is that it is difficult to analyze its behavioral performance mathematically and therefore it is difficult to guarantee system stability [17]. The virtual structures [6, 18–20] consider the entire formation as a single virtual rigid body. This networked structure can then be considered similar to a physical body and thus it is easy to maintain the formation of the whole group during maneuvers; that is, the virtual rigid body progresses as a whole in a given course with some given bearing. In the leader-follower approach [14, 17, 21–24], one robot in the multirobot formation, a virtual robot, is assigned the role of the leader to pursue some team objective, while the follower robots follow their designated leader. The follower robots then place themselves relative to the leader and maintain a predefined offset with a desired relative position [17]. In [25], Sharma et al. proposed a leader-follower scheme in a Lyapunov-based decentralized formation control planner for a swarm of 2-link mobile manipulators. The acceleration-based controllers ensured a locally rigid formation for the swarm. Locally rigid formation was achieved by integrating maximum and minimum interrobot distance bounds with desired headings in the control scheme.In this paper, we adopt the architecture of the Lyapunov-based Control Scheme (LbCS) of [14], an artificial potential field (APF) method to design attractive and repulsive potential field functions to control the formation of C-ITS. An extension to [25], this paper presents a new set of nonlinear time-invariant control laws through an amalgamation of the LbCS and a new leader-follower scheme to maintain and mobilize a locally rigid formation. The limitation of the approach is twofold; firstly it comes with the disadvantages of APFs, in particular the local minima, and secondly the dependence on the lead robot and the poor disturbance rejection properties [26] of the leader-follower scheme. However, the novelty of the new approach lies in its ability to design continuous nonlinear control laws to translate locally rigid formations of nonholonomic systems tagged with dynamic constraints. The LbCS controllers are elegant and very simple to construct compared to the mathematically and computationally intensive ones in literature, and LbCS has an in-built process of converting these constraints into artificial obstacles and incorporating them into the controllers. Finally, the virtual connectivity from the new leader-follower scheme facilitates diverse tasks compared to merely cooperative agents [26].The advantage of the proposed scheme is that it uses Cartesian coordinate representation to avoid any singular points as encountered when using polar coordinates, even though polar coordinate representation may still be simpler to use. Another advantage of the proposed scheme in this paper is that it has a dual frame methodology, a new leader-follower approach, and the assignment of a single target for the group of vehicles. The overarching framework is a leader-follower scheme for C-ITS to establish, maintain, and translate the whole team in a locally rigid formation around the workplace performing a given task through centralized control laws. Finally, the treatment of several categories of obstacles is also included within the algorithm.


## 2. Vehicle Model

In this section, we derive a new kinematic model for the leader-follower based formation control of multiple vehicles. We will considern (n∈N) car-like vehicles in the Euclidean plane. We let A1 represent the leader and Ai for i=2,…,n take the role of follower robots. With reference to Figure 1, adopted from [27], and for i∈{1,…,n}, (xi,yi) represents the Cartesian coordinates and gives the reference point of each vehicle and θi gives the orientation of the ith car with respect to z1-axis of the z1z2-plane. Moreover, ϕi gives the ith vehicles steering angle with respect to its longitudinal axis. Li represents the distance between the centers of the front and rear axles of the ith robot, and li is the length of each axle.Figure 1
Kinematic model of the car-like mobile robot.Next, to ensure that each vehicle safely steers past an obstacle, we adopt the nomenclature of [14] and construct circular regions that protect the robot. With reference to Figure 1, given theclearance parametersϵ1>0 and ϵ2>0, we enclose each vehicle by a protective circular region centered at (xi,yi) with radius ri=1/2(Li+2ϵ1)2+(li+2ϵ2)2.Furthermore, we assume no slippage condition of the rear and front wheels of the mobile robots ofAi when in contact with a rigid surface, that is, the lateral (or tangential) velocities of the wheels of the cars are assumed to be zero. We have no slippage (i.e., x˙isin⁡θi-y˙icos⁡θi=0) and pure rolling (i.e., x˙icos⁡θi+y˙isin⁡θi=vi) of the car-like mobile robot which generate thenonholonomic constraints on the system. These assumptions of no slippage and pure rolling of the car-like mobile robots are essential to generate the nonholonomic constraints on the system. The kinematics of the system which inherently capture these nonholonomic constraints, adopted from [14], are (1)x˙i=vicos⁡θi-Li2ωisin⁡θi,y˙i=visin⁡θi+Li2ωicos⁡θi,θ˙i=viLitan⁡ϕi≔ωi,v˙i≔σi1,ω˙i≔σi2,for i∈{1,…,n}, and, without any loss of generality, we assume that ϕi=θi. In system (1), vi and ωi are, respectively, the instantaneous translational and rotational velocities, while σi1 and σi2 are the instantaneous translational and rotational accelerations of the ith robot.Now, system (1) is a description of the instantaneous velocities and accelerations of Ai. Let the vector xi≔xi,yi,θi,vi,ωi∈R5 refer to the position (xi,yi), orientation, θi, and the velocities (vi,ωi) of Ai at time t≥0.Now, let(2)fixi=fi1xi,fi2xi,fi3xi,0,0≔x˙i,y˙i,θ˙i,0,0∈R5,and ui(t)≔(σi1(t),σi2(t))∈R2. Then system (1) can be written compactly as (3)x˙i≔fixi+Biuit,where Bi is a 5×2 matrix of the form (4)Bi=0000001001.Let x≔(x1,x2,…,xn)∈R5n refer to the positions, orientations, and the velocities of all the vehicles in the C-ITS.Letf(x)≔(f1(x),f2(x),…,fn(x))∈R5n and u(t)≔(u1(t),u2(t),…,un(t))∈R2n. Then we have the following initial-value problem for Ai: (5)x˙=fx+But,xt0≔x0,t0≥0,where if 0 is a 5×2 matrix of all zero entries, (6)B=B10⋯00B2⋯0⋮⋮⋱⋮00⋯Bn.Now, assume that the final position of Ai is at the point (xi,yi)=(pi1,pi2) and final orientation at this point is θi=pi3. Its final instantaneous velocity vector is (vi,ωi)=(0,0). Then it is clear that the points (7)xi∗≔pi1,pi2,pi3,0,0∈R5are the components of the equilibrium point of system (5) in which we are interested; that is, (8)xe≔x1∗,x2∗,…,xn∗∈R5n.


### 2.1. Leader-Follower Based Formation Scheme

Next we define two reference frames: the body frame which is fixed with the rotating body of the leader,A1, and a space frame, the inertial frame similar to one proposed in [16].We assign a Cartesian coordinate system(X-Y) fixed on the leader body, as shown in Figure 2 adopted from [27], based on the concept of an instantaneous corotating frame of reference. Thus, when the leader A1 rotates, we have a rotation of the X-Y-axes.Figure 2
The proposed scheme utilizing a rotation of axes with the body frame fixed at the leader robot.To define the corotating frame of reference, first an origin is selected on the leader robot at(x1,y1). An axis of rotation is then set up, which is perpendicular to the plane of motion of the leader. Thus, at any selected moment t, the chosen rotating frame of reference rotates at an angular rate equal to the rate of rotation of the leader A1 about (x1,y1). Let r1k represent the straight-line distance between the reference point of the leader and the kth follower, and α1k represents the angle measured between the straight line joining the reference points of the leader and the kth follower and X-axis. Thus, given the leader’s position and orientation, as long as (r1k,α1k), as shown in Figure 2, is fixed, the kth follower robot’s position will be unique. We define the shape of the formation of the mobile robots as ζ=[ζ12,ζ13,…,ζ1n]T, where ζ1k=[r1k,α1k]T for k∈{2,…,n}.Definition 1.
Let2rk<r1kd<2rk+ς, where, for ς>0 and k∈{2,…,n}, the group of mobile robots make a ζd=[ζ12d,ζ13d,…,ζ1nd]T formation, if ∃T>0, ∀t>T: (9)r1k=r1kd,α1k=α1kd.This gives then the polar coordinate representation of the follower’s position relative to that of the leader. However, such representations using polar coordinates lead to certain singularities in the controllers [16]. To avoid such singular points, we consider the position of the kth follower by considering the relative distances of the kth follower from the leader A1 along the given X and Y directions. Thus, we have (10)Ak=-x1-xkcos⁡θ1-y1-yksin⁡θ1,Bk=x1-xksin⁡θ1-y1-ykcos⁡θ1,for k∈{2,…,n}, and Ak and Bk are the kth follower relative positions with respect to the X-Y coordinate system. If Ak and Bk are known and fixed, the follower’s position will be distinct. Thus, to obtain a desired formation, one needs to know the design parameters ak and bk and the desired relative positions along the X-Y directions, such that the control objective would be to achieve Ak→ak and Bk→bk. That is, r1k→r1kd and α1k→α1kd, where r1kd=ak2+bk2 and α1kd=tan⁡ak/bk, hence maintaining local rigidity of any formation.Definition 2.
We define a locally rigid formation as one which is maintained but allows for slight changes or distortions in the distances and angles between any two vehicles temporarily, while enroute to the target and task completion.Remark 3 (formation initialization).
Prescribed formations can be initialized by assigning appropriately the design parametersak and bk. This will initiate the vehicles from their arbitrary initial positions to move into a desired formation pattern.


### 2.2. Formation Control Objective

Design acceleration-based control laws(σi1,σi2) which are functions of xi≔xi,yi,θi,vi,ωi∈R5 for i∈{1,…,n}, for each vehicle such that the C-ITS in a prescribed formation moves towards a predefined target of the leader in an obstacle cluttered environment. In addition, we also want the C-ITS to ensure obstacle and collision avoidance and maintain a prescribed locally rigid formation.


## 2.1. Leader-Follower Based Formation Scheme

Next we define two reference frames: the body frame which is fixed with the rotating body of the leader,A1, and a space frame, the inertial frame similar to one proposed in [16].We assign a Cartesian coordinate system(X-Y) fixed on the leader body, as shown in Figure 2 adopted from [27], based on the concept of an instantaneous corotating frame of reference. Thus, when the leader A1 rotates, we have a rotation of the X-Y-axes.Figure 2
The proposed scheme utilizing a rotation of axes with the body frame fixed at the leader robot.To define the corotating frame of reference, first an origin is selected on the leader robot at(x1,y1). An axis of rotation is then set up, which is perpendicular to the plane of motion of the leader. Thus, at any selected moment t, the chosen rotating frame of reference rotates at an angular rate equal to the rate of rotation of the leader A1 about (x1,y1). Let r1k represent the straight-line distance between the reference point of the leader and the kth follower, and α1k represents the angle measured between the straight line joining the reference points of the leader and the kth follower and X-axis. Thus, given the leader’s position and orientation, as long as (r1k,α1k), as shown in Figure 2, is fixed, the kth follower robot’s position will be unique. We define the shape of the formation of the mobile robots as ζ=[ζ12,ζ13,…,ζ1n]T, where ζ1k=[r1k,α1k]T for k∈{2,…,n}.Definition 1.
Let2rk<r1kd<2rk+ς, where, for ς>0 and k∈{2,…,n}, the group of mobile robots make a ζd=[ζ12d,ζ13d,…,ζ1nd]T formation, if ∃T>0, ∀t>T: (9)r1k=r1kd,α1k=α1kd.This gives then the polar coordinate representation of the follower’s position relative to that of the leader. However, such representations using polar coordinates lead to certain singularities in the controllers [16]. To avoid such singular points, we consider the position of the kth follower by considering the relative distances of the kth follower from the leader A1 along the given X and Y directions. Thus, we have (10)Ak=-x1-xkcos⁡θ1-y1-yksin⁡θ1,Bk=x1-xksin⁡θ1-y1-ykcos⁡θ1,for k∈{2,…,n}, and Ak and Bk are the kth follower relative positions with respect to the X-Y coordinate system. If Ak and Bk are known and fixed, the follower’s position will be distinct. Thus, to obtain a desired formation, one needs to know the design parameters ak and bk and the desired relative positions along the X-Y directions, such that the control objective would be to achieve Ak→ak and Bk→bk. That is, r1k→r1kd and α1k→α1kd, where r1kd=ak2+bk2 and α1kd=tan⁡ak/bk, hence maintaining local rigidity of any formation.Definition 2.
We define a locally rigid formation as one which is maintained but allows for slight changes or distortions in the distances and angles between any two vehicles temporarily, while enroute to the target and task completion.Remark 3 (formation initialization).
Prescribed formations can be initialized by assigning appropriately the design parametersak and bk. This will initiate the vehicles from their arbitrary initial positions to move into a desired formation pattern.


## 2.2. Formation Control Objective

Design acceleration-based control laws(σi1,σi2) which are functions of xi≔xi,yi,θi,vi,ωi∈R5 for i∈{1,…,n}, for each vehicle such that the C-ITS in a prescribed formation moves towards a predefined target of the leader in an obstacle cluttered environment. In addition, we also want the C-ITS to ensure obstacle and collision avoidance and maintain a prescribed locally rigid formation.


## 3. Artificial Potential Field Function

This section formulates collision-free trajectories of the vehicle system under kinodynamic constraints. We want to design the acceleration controllers,σi1 and σi2, so that the team of vehicles moves safely towards the target of the leader while maintaining a prescribed locally rigid formation. We will design the attractive potential field functions which establish and translate formation and the repulsive potential field functions which ensure collision and obstacle avoidances.In the following subsections, we will design these attractive and repulsive potential field functions which are subsequently summed to form the total potentials or artificial potential field of the system.


### 3.1. Attractive Potential Field Functions

#### 3.1.1. Attraction to Target

A target is assigned to the leader. When the leader moves towards its defined target, the follower vehicles move with the leader, maintaining the formation. We want the leaderA1 to start from an initial position, move towards a target, and finally converge at the center of the target.Definition 4.
The stationary target for the leader robotA1 is a circular disk with center (p11,p12) and radius rt.The leaderA1 will move towards its defined target, while the follower vehicles move with their leader maintaining a desired relative position, hence a locally rigid formation. For the attraction of A1 to its target, we consider an attractive potential function: (11)V1x=12x1-p112+y1-p122+v12+ω12.The above function is a measure of its convergence to the target with the inclusion of the velocity components [14]. For the follower vehicle Ai for i=2,…,n to maintain its desired relative position with respect to the leader, A1, we utilize the following potential function: (12)Vix=12Ai-ai2+Bi-bi2+vi2+ωi2,for i=2,…,n, where ai and bi will have unique values as dictated by the shape of the desired formation.


#### 3.1.2. Auxiliary Function

To guarantee the convergence of the vehicles to their designated targets, we design an auxiliary function as(13)G1x=12x1-p112+y1-p122+ρ1θ1-p132,where p13 is the prescribed final orientation of the leader robot, A1, and (14)Gix=12Ai-ai2+Bi-bi2+ρiθi-θ12,for i=2,…,n. The function ensures that the controllers become zero at the leader’s target. The constant ρi is a binary constant denoted in (13) and (14) as theangle-gain parameter for θi, i=1,…,n. Anangle-gain parameter will take a value of one only if a final predefined orientation is warranted; else it takes the default value of zero. This auxiliary function is then multiplied to the repulsive potential field functions.


### 3.2. Repulsive Potential Field Functions

We desire each vehicle to avoid all fixed and moving obstacles intersecting its path. Hence, we construct appropriate obstacle avoidance functions that measure the Euclidean distances between mobile robots and the obstacles on our roads. To obtain the desired avoidance, we generate repulsive potential field around the obstacles by designing a repulsive potential field function for each obstacle in accordance with LbCS. The repulsive potential fields function is an inverse function that encodes an avoidance function to the denominator and a control parameter in the numerator [14].


#### 3.2.1. Fixed Obstacles

Let us fixn∈N solid obstacles on the roads, such as potholes, distance marker posts, or road hazard delineators. We assume that the lth obstacle is a circular disk with center (ol1,ol2) and radius rol. For the ith vehicle to avoid the lth obstacle, we consider an avoidance function: (15)FOilx=12xi-ol12+yi-ol22-rol+ri2,where i=1,…,n and l=1,…,q.Consider, for example, the presence of three obstacles (i.e.,q=3) within the workspace, with 0<z1<70 and 0<z2<70. The total potentials, where α1l>0 is a control or tuning parameter, which govern the motion of the leader A1 are (16)V1x+∑l=13α1lFO1lx.Figure 3 presents a three-dimensional view of the total potentials and Figure 4 presents the corresponding contour plot produced by (16).Figure 3
A three-dimensional view of the total potentials.Figure 4
The contour plot of the total potential.The total potentials are generated for target attraction and avoidance of three stationary disk-shaped obstacles. For better visualization, the target of the leader is located at(p1,p2)=(35,35), and the disks are fixed at (o11,o12)=(15,35), (o21,o22)=(20,20), and (o31,o32)=(50,50), with radii of rol=3, while αl1=1000, for l=1,…,3. Also, the velocity and angular components of the lead vehicle have been treated as constants (v1=0.5, ω1=0, and θ1=0).


### 3.3. Boulevard Limitations

Definition 5.
Consider a section of the road defined, for someη1>2ri, for i=1,…,n, as (17)WS=z1,z2∈R2:0≤z2≤η1.The boundaries of the road section, illustrated in Figure5, are defined as follows:(a)
Lower boundary:B1={(z1,z2)∈R2:z2=0}(b)
Upper boundary:B2={(z1,z2)∈R2:z2=η1}Figure 5
A schematic representation of the road with obstacles.We require the prescribed formation to stay within the boundaries of the road at all timet≥0. In our LbCS, these boundaries are considered asfixed obstacles. For the ith robot to avoid these, we define the following potential functions for the upper and lower boundaries, respectively: (18a)Wi1x=yi-ri,(18b)Wi2x=η1-yi+ri.Now, since η1>2ri, each of the functions is positive in WS, for i=1,…,n. As discussed before, these obstacle avoidance functions will be combined with appropriate tuning parameters to generate repulsive potential field functions for the boundaries of the workspace.


### 3.4. Final Orientation of Formation

Although the final position is reachable, it is virtually impossible to simultaneously harvest exact orientations via continuous feedback controllers of nonholonomic systems [14], a direct result of Brockett’s theorem [28]. We utilize the concepts of ghost wall andminimum distance technique (MDT) from [14] to force final orientations of the vehicles. This is needed to confine the vehicles to within the lane markings and later for parking a vehicle into a parking bay. To begin, we construct ghost walls along the three sides of the final positions of the vehicles, treated as a parking bay, with the orientation depending on the desired final orientation of the vehicles. To avoid the ghost walls of each vehicle’s parking bay, we utilize MDT, which gives the perpendicular distance between the closest point on eachkth ghost wall and (xi,yi). The avoidance of these closet points on a given ghost wall at any time t≥0 essentially results in the avoidance of the entire wall by a vehicle.Now let us consider thekth ghost wall in the z1z2-plane from the point (ak1,bk1) to the point (ak2,bk2). We assume that the point (xi,yi) is closest to it at the tangent line which passes through the point. From geometry, it is known that if (Lxik,Lyik) is the point of intersection of this tangent, then (19)Lxik=ak1+λikak2-ak1,Lyik=bk1+λikbk2-bk1,where (20)λik=xi-ak1dk+yi-bk1rk,dk=ak2-ak1ak2-ak12+bk2-bk12,rk=bk2-bk1ak2-ak12+bk2-bk12.If λik≥1, then we let λik=1; if λik≤0, then we let λik=0; otherwise we accept the value of λik between 0 and 1, in which case there is a perpendicular line to the point (Lxik,Lyik) on the ghost wall from the center (xi,yi) of the ith vehicle at every time t≥0.The leader will be avoiding the1st, 2nd, and 3rd ghost walls, while the ith follower will be avoiding the (3i-2), (3i-1), and (3i) ghost walls for i=2,…,n. Now, for the ith vehicle to avoid the closest point of each of the kth line segments, we consider an avoidance function (21)LSikx=12xi-Lxik2+yi-Lyik2-ri2,for k∈{3i-2,3i-1,3i} and i=1,…,n.


### 3.5. Moving Obstacles

To generate feasible trajectories, we consider moving obstacles in the workspace, in which the C-ITS has prior knowledge. Here, each vehicle has to be treated as a moving obstacle for all other vehicles on the road. The vehicles will have to travel towards their targets while avoiding another vehicle in their path. For the vehicleAi to avoid the vehicle Aj, via vehicle-to-vehicle (V-V) communication, we adopt an avoidance function: (22)MOijx=12xi-xj2+yi-yj2-ri2,fori,j=1,…,nwithi≠j.


#### 3.5.1. Dynamic Constraints

Practically, the steering angle of theith autonomous vehicle is limited due to mechanical singularities, while the translational speed is restricted due to safety reasons [14]. Subsequently, we have the following;(i)
|vi|<vmax, where vmax is themaximal achievable speed of the ith vehicle.(ii)
|ωi|<vmax/|ρmin|, where ρmin≔Li/tanϕmax. This condition arises due to the boundedness of the steering angle ϕi. That is, |ϕi|≤ϕmax<π/2, where ϕmax is themaximal steering angle.Remark 6.
For simplicity, the values ofvmax and ϕmax will be kept the same for each vehicle.As per the LbCS, for each dynamic constraint, we design a correspondingartificial obstacle. For example, we consider the artificial obstacle AOi=vi∈R:vi≤-vmaxorvi≥vmax for the constraint tagged to vi. We can create similar artificial obstacles for the other limitations as well. Hence, we consider the following avoidance functions: (23)Ui1x=12vmax-vivmax+vi,Ui2x=12vmaxρmin-ωivmaxρmin+ωi,fori=1,…,n.


## 3.1. Attractive Potential Field Functions

### 3.1.1. Attraction to Target

A target is assigned to the leader. When the leader moves towards its defined target, the follower vehicles move with the leader, maintaining the formation. We want the leaderA1 to start from an initial position, move towards a target, and finally converge at the center of the target.Definition 4.
The stationary target for the leader robotA1 is a circular disk with center (p11,p12) and radius rt.The leaderA1 will move towards its defined target, while the follower vehicles move with their leader maintaining a desired relative position, hence a locally rigid formation. For the attraction of A1 to its target, we consider an attractive potential function: (11)V1x=12x1-p112+y1-p122+v12+ω12.The above function is a measure of its convergence to the target with the inclusion of the velocity components [14]. For the follower vehicle Ai for i=2,…,n to maintain its desired relative position with respect to the leader, A1, we utilize the following potential function: (12)Vix=12Ai-ai2+Bi-bi2+vi2+ωi2,for i=2,…,n, where ai and bi will have unique values as dictated by the shape of the desired formation.


### 3.1.2. Auxiliary Function

To guarantee the convergence of the vehicles to their designated targets, we design an auxiliary function as(13)G1x=12x1-p112+y1-p122+ρ1θ1-p132,where p13 is the prescribed final orientation of the leader robot, A1, and (14)Gix=12Ai-ai2+Bi-bi2+ρiθi-θ12,for i=2,…,n. The function ensures that the controllers become zero at the leader’s target. The constant ρi is a binary constant denoted in (13) and (14) as theangle-gain parameter for θi, i=1,…,n. Anangle-gain parameter will take a value of one only if a final predefined orientation is warranted; else it takes the default value of zero. This auxiliary function is then multiplied to the repulsive potential field functions.


## 3.1.1. Attraction to Target

A target is assigned to the leader. When the leader moves towards its defined target, the follower vehicles move with the leader, maintaining the formation. We want the leaderA1 to start from an initial position, move towards a target, and finally converge at the center of the target.Definition 4.
The stationary target for the leader robotA1 is a circular disk with center (p11,p12) and radius rt.The leaderA1 will move towards its defined target, while the follower vehicles move with their leader maintaining a desired relative position, hence a locally rigid formation. For the attraction of A1 to its target, we consider an attractive potential function: (11)V1x=12x1-p112+y1-p122+v12+ω12.The above function is a measure of its convergence to the target with the inclusion of the velocity components [14]. For the follower vehicle Ai for i=2,…,n to maintain its desired relative position with respect to the leader, A1, we utilize the following potential function: (12)Vix=12Ai-ai2+Bi-bi2+vi2+ωi2,for i=2,…,n, where ai and bi will have unique values as dictated by the shape of the desired formation.


## 3.1.2. Auxiliary Function

To guarantee the convergence of the vehicles to their designated targets, we design an auxiliary function as(13)G1x=12x1-p112+y1-p122+ρ1θ1-p132,where p13 is the prescribed final orientation of the leader robot, A1, and (14)Gix=12Ai-ai2+Bi-bi2+ρiθi-θ12,for i=2,…,n. The function ensures that the controllers become zero at the leader’s target. The constant ρi is a binary constant denoted in (13) and (14) as theangle-gain parameter for θi, i=1,…,n. Anangle-gain parameter will take a value of one only if a final predefined orientation is warranted; else it takes the default value of zero. This auxiliary function is then multiplied to the repulsive potential field functions.


## 3.2. Repulsive Potential Field Functions

We desire each vehicle to avoid all fixed and moving obstacles intersecting its path. Hence, we construct appropriate obstacle avoidance functions that measure the Euclidean distances between mobile robots and the obstacles on our roads. To obtain the desired avoidance, we generate repulsive potential field around the obstacles by designing a repulsive potential field function for each obstacle in accordance with LbCS. The repulsive potential fields function is an inverse function that encodes an avoidance function to the denominator and a control parameter in the numerator [14].


### 3.2.1. Fixed Obstacles

Let us fixn∈N solid obstacles on the roads, such as potholes, distance marker posts, or road hazard delineators. We assume that the lth obstacle is a circular disk with center (ol1,ol2) and radius rol. For the ith vehicle to avoid the lth obstacle, we consider an avoidance function: (15)FOilx=12xi-ol12+yi-ol22-rol+ri2,where i=1,…,n and l=1,…,q.Consider, for example, the presence of three obstacles (i.e.,q=3) within the workspace, with 0<z1<70 and 0<z2<70. The total potentials, where α1l>0 is a control or tuning parameter, which govern the motion of the leader A1 are (16)V1x+∑l=13α1lFO1lx.Figure 3 presents a three-dimensional view of the total potentials and Figure 4 presents the corresponding contour plot produced by (16).Figure 3
A three-dimensional view of the total potentials.Figure 4
The contour plot of the total potential.The total potentials are generated for target attraction and avoidance of three stationary disk-shaped obstacles. For better visualization, the target of the leader is located at(p1,p2)=(35,35), and the disks are fixed at (o11,o12)=(15,35), (o21,o22)=(20,20), and (o31,o32)=(50,50), with radii of rol=3, while αl1=1000, for l=1,…,3. Also, the velocity and angular components of the lead vehicle have been treated as constants (v1=0.5, ω1=0, and θ1=0).


## 3.2.1. Fixed Obstacles

Let us fixn∈N solid obstacles on the roads, such as potholes, distance marker posts, or road hazard delineators. We assume that the lth obstacle is a circular disk with center (ol1,ol2) and radius rol. For the ith vehicle to avoid the lth obstacle, we consider an avoidance function: (15)FOilx=12xi-ol12+yi-ol22-rol+ri2,where i=1,…,n and l=1,…,q.Consider, for example, the presence of three obstacles (i.e.,q=3) within the workspace, with 0<z1<70 and 0<z2<70. The total potentials, where α1l>0 is a control or tuning parameter, which govern the motion of the leader A1 are (16)V1x+∑l=13α1lFO1lx.Figure 3 presents a three-dimensional view of the total potentials and Figure 4 presents the corresponding contour plot produced by (16).Figure 3
A three-dimensional view of the total potentials.Figure 4
The contour plot of the total potential.The total potentials are generated for target attraction and avoidance of three stationary disk-shaped obstacles. For better visualization, the target of the leader is located at(p1,p2)=(35,35), and the disks are fixed at (o11,o12)=(15,35), (o21,o22)=(20,20), and (o31,o32)=(50,50), with radii of rol=3, while αl1=1000, for l=1,…,3. Also, the velocity and angular components of the lead vehicle have been treated as constants (v1=0.5, ω1=0, and θ1=0).


## 3.3. Boulevard Limitations

Definition 5.
Consider a section of the road defined, for someη1>2ri, for i=1,…,n, as (17)WS=z1,z2∈R2:0≤z2≤η1.The boundaries of the road section, illustrated in Figure5, are defined as follows:(a)
Lower boundary:B1={(z1,z2)∈R2:z2=0}(b)
Upper boundary:B2={(z1,z2)∈R2:z2=η1}Figure 5
A schematic representation of the road with obstacles.We require the prescribed formation to stay within the boundaries of the road at all timet≥0. In our LbCS, these boundaries are considered asfixed obstacles. For the ith robot to avoid these, we define the following potential functions for the upper and lower boundaries, respectively: (18a)Wi1x=yi-ri,(18b)Wi2x=η1-yi+ri.Now, since η1>2ri, each of the functions is positive in WS, for i=1,…,n. As discussed before, these obstacle avoidance functions will be combined with appropriate tuning parameters to generate repulsive potential field functions for the boundaries of the workspace.


## 3.4. Final Orientation of Formation

Although the final position is reachable, it is virtually impossible to simultaneously harvest exact orientations via continuous feedback controllers of nonholonomic systems [14], a direct result of Brockett’s theorem [28]. We utilize the concepts of ghost wall andminimum distance technique (MDT) from [14] to force final orientations of the vehicles. This is needed to confine the vehicles to within the lane markings and later for parking a vehicle into a parking bay. To begin, we construct ghost walls along the three sides of the final positions of the vehicles, treated as a parking bay, with the orientation depending on the desired final orientation of the vehicles. To avoid the ghost walls of each vehicle’s parking bay, we utilize MDT, which gives the perpendicular distance between the closest point on eachkth ghost wall and (xi,yi). The avoidance of these closet points on a given ghost wall at any time t≥0 essentially results in the avoidance of the entire wall by a vehicle.Now let us consider thekth ghost wall in the z1z2-plane from the point (ak1,bk1) to the point (ak2,bk2). We assume that the point (xi,yi) is closest to it at the tangent line which passes through the point. From geometry, it is known that if (Lxik,Lyik) is the point of intersection of this tangent, then (19)Lxik=ak1+λikak2-ak1,Lyik=bk1+λikbk2-bk1,where (20)λik=xi-ak1dk+yi-bk1rk,dk=ak2-ak1ak2-ak12+bk2-bk12,rk=bk2-bk1ak2-ak12+bk2-bk12.If λik≥1, then we let λik=1; if λik≤0, then we let λik=0; otherwise we accept the value of λik between 0 and 1, in which case there is a perpendicular line to the point (Lxik,Lyik) on the ghost wall from the center (xi,yi) of the ith vehicle at every time t≥0.The leader will be avoiding the1st, 2nd, and 3rd ghost walls, while the ith follower will be avoiding the (3i-2), (3i-1), and (3i) ghost walls for i=2,…,n. Now, for the ith vehicle to avoid the closest point of each of the kth line segments, we consider an avoidance function (21)LSikx=12xi-Lxik2+yi-Lyik2-ri2,for k∈{3i-2,3i-1,3i} and i=1,…,n.


## 3.5. Moving Obstacles

To generate feasible trajectories, we consider moving obstacles in the workspace, in which the C-ITS has prior knowledge. Here, each vehicle has to be treated as a moving obstacle for all other vehicles on the road. The vehicles will have to travel towards their targets while avoiding another vehicle in their path. For the vehicleAi to avoid the vehicle Aj, via vehicle-to-vehicle (V-V) communication, we adopt an avoidance function: (22)MOijx=12xi-xj2+yi-yj2-ri2,fori,j=1,…,nwithi≠j.


### 3.5.1. Dynamic Constraints

Practically, the steering angle of theith autonomous vehicle is limited due to mechanical singularities, while the translational speed is restricted due to safety reasons [14]. Subsequently, we have the following;(i)
|vi|<vmax, where vmax is themaximal achievable speed of the ith vehicle.(ii)
|ωi|<vmax/|ρmin|, where ρmin≔Li/tanϕmax. This condition arises due to the boundedness of the steering angle ϕi. That is, |ϕi|≤ϕmax<π/2, where ϕmax is themaximal steering angle.Remark 6.
For simplicity, the values ofvmax and ϕmax will be kept the same for each vehicle.As per the LbCS, for each dynamic constraint, we design a correspondingartificial obstacle. For example, we consider the artificial obstacle AOi=vi∈R:vi≤-vmaxorvi≥vmax for the constraint tagged to vi. We can create similar artificial obstacles for the other limitations as well. Hence, we consider the following avoidance functions: (23)Ui1x=12vmax-vivmax+vi,Ui2x=12vmaxρmin-ωivmaxρmin+ωi,fori=1,…,n.


## 3.5.1. Dynamic Constraints

Practically, the steering angle of theith autonomous vehicle is limited due to mechanical singularities, while the translational speed is restricted due to safety reasons [14]. Subsequently, we have the following;(i)
|vi|<vmax, where vmax is themaximal achievable speed of the ith vehicle.(ii)
|ωi|<vmax/|ρmin|, where ρmin≔Li/tanϕmax. This condition arises due to the boundedness of the steering angle ϕi. That is, |ϕi|≤ϕmax<π/2, where ϕmax is themaximal steering angle.Remark 6.
For simplicity, the values ofvmax and ϕmax will be kept the same for each vehicle.As per the LbCS, for each dynamic constraint, we design a correspondingartificial obstacle. For example, we consider the artificial obstacle AOi=vi∈R:vi≤-vmaxorvi≥vmax for the constraint tagged to vi. We can create similar artificial obstacles for the other limitations as well. Hence, we consider the following avoidance functions: (23)Ui1x=12vmax-vivmax+vi,Ui2x=12vmaxρmin-ωivmaxρmin+ωi,fori=1,…,n.


## 4. Design of the Acceleration-Based Controllers

### 4.1. Lyapunov Function

We now construct the total potentials, that is, a Lyapunov function for system (1). First, for i=1,…,n, we introduce the followingcontrol parameters that we will use in the repulsive potential functions:(i)
αil>0, l=1,…,q, for the collision avoidance of q disk-shaped obstacles.(ii)
βis>0, s=1,2, for the avoidance of the artificial obstacles from dynamic constraints.(iii)
ηij>0, j=1,…,n, i≠j, for the collision avoidance between any two vehicles.(iv)
κip>0, p=1,…,2, for the avoidance of the lane boundaries.(v)
γik>0, k=1,…,3n, for the avoidance of the parking bays.The above parameters are determined via heuristics, but there is also an opportunity to obtain optimal values through optimization techniques. Using these, we now construct the following Lyapunov function for system (1) with two components, namely, the attractive and repulsive potential field functions: (24)L1x=∑i=1nVix+Gix∑l=1qαilFOilx+∑s=12βisUisx+∑p=12κipWipx+∑i=1nGix∑j=1j≠inηijMOijx+∑k=13nγikLSikx.


### 4.2. Nonlinear Acceleration Controllers

The process of designing the feedback controllers begins by noting that the functionsfik to gij for i=1,…,n, j=1,2, and k=1,…,3 are defined as in the Appendix (on suppressing x).Remark 7.
The choice of total potentialL(x) given in (24) with its terms specified in (11)–(16), (18a), (18b), and (21)–(23) has the following properties: (i)
It attains a minimum value when the robots are at their desired locations.(ii)
It goes to infinity whenever one or more robots come in contact with an obstacle.Remark 8.
With the interrobot bounds (see (12) and (22)) in place, it is guaranteed that the robots reestablish the predetermined formation if the robot positions are slightly distorted with the encounter of obstacle(s) soon after the avoidance and before reaching the target.So, we design the following theorem.Theorem 9.
Considern car-like mobile robots in the C-ITS, whose motion is governed by the ODEs described in system (1). The principal goal is to establish and control a prescribed formation, facilitate maneuvers of the vehicles within a constrained environment, and reach the target configuration while maintaining a desired formation. The subtasks include restrictions placed on the workspace, convergence to predefined targets, and consideration of kinodynamic constraints. Utilizing the attractive and repulsive potential field functions, the following continuous time-invariant acceleration control laws can be generated in accordance with the LbCS of system (1):(25)σi1=-δi1vi+fi1cos⁡θi+fi2sin⁡θigi1,σi2=-δi2ωi+Li/2fi2cos⁡θi-fi1sin⁡θi+fi3gi2,for i=1,…,n, where δi1>0 and δi2>0 are constants commonly known as convergence parameters.


## 4.1. Lyapunov Function

We now construct the total potentials, that is, a Lyapunov function for system (1). First, for i=1,…,n, we introduce the followingcontrol parameters that we will use in the repulsive potential functions:(i)
αil>0, l=1,…,q, for the collision avoidance of q disk-shaped obstacles.(ii)
βis>0, s=1,2, for the avoidance of the artificial obstacles from dynamic constraints.(iii)
ηij>0, j=1,…,n, i≠j, for the collision avoidance between any two vehicles.(iv)
κip>0, p=1,…,2, for the avoidance of the lane boundaries.(v)
γik>0, k=1,…,3n, for the avoidance of the parking bays.The above parameters are determined via heuristics, but there is also an opportunity to obtain optimal values through optimization techniques. Using these, we now construct the following Lyapunov function for system (1) with two components, namely, the attractive and repulsive potential field functions: (24)L1x=∑i=1nVix+Gix∑l=1qαilFOilx+∑s=12βisUisx+∑p=12κipWipx+∑i=1nGix∑j=1j≠inηijMOijx+∑k=13nγikLSikx.


## 4.2. Nonlinear Acceleration Controllers

The process of designing the feedback controllers begins by noting that the functionsfik to gij for i=1,…,n, j=1,2, and k=1,…,3 are defined as in the Appendix (on suppressing x).Remark 7.
The choice of total potentialL(x) given in (24) with its terms specified in (11)–(16), (18a), (18b), and (21)–(23) has the following properties: (i)
It attains a minimum value when the robots are at their desired locations.(ii)
It goes to infinity whenever one or more robots come in contact with an obstacle.Remark 8.
With the interrobot bounds (see (12) and (22)) in place, it is guaranteed that the robots reestablish the predetermined formation if the robot positions are slightly distorted with the encounter of obstacle(s) soon after the avoidance and before reaching the target.So, we design the following theorem.Theorem 9.
Considern car-like mobile robots in the C-ITS, whose motion is governed by the ODEs described in system (1). The principal goal is to establish and control a prescribed formation, facilitate maneuvers of the vehicles within a constrained environment, and reach the target configuration while maintaining a desired formation. The subtasks include restrictions placed on the workspace, convergence to predefined targets, and consideration of kinodynamic constraints. Utilizing the attractive and repulsive potential field functions, the following continuous time-invariant acceleration control laws can be generated in accordance with the LbCS of system (1):(25)σi1=-δi1vi+fi1cos⁡θi+fi2sin⁡θigi1,σi2=-δi2ωi+Li/2fi2cos⁡θi-fi1sin⁡θi+fi3gi2,for i=1,…,n, where δi1>0 and δi2>0 are constants commonly known as convergence parameters.


## 5. Stability Analysis

We utilize Lyapunov’s direct method to provide a mathematical proof of stability of system (1).Theorem 10.
Let(p11,p12) be the position of the target of the leader and let pi3, for i=1,…,n, be the prescribed final orientations of the robots. Let pi1 and pi2 satisfy (26)ai=-p11-pi1cos⁡θ1-p12-pi2sin⁡θ1,bi=p11-pi1sin⁡θ1-p12-pi2cos⁡θ1,for any given ai and bi, for i=2,…,n. If xe∈R5n as defined in (8) is an equilibrium point for (1), then xe∈D(L(1)(x)) is a stable equilibrium point of system (1).Proof.
One can easily verify the following, fori∈{1,…,n}: (1)
L(1)(x) is defined as continuous and positive over the domain D(L(1)(x))={x∈R5n:FOil(x)>0,l=1,…,q;MOij(x)>0,j=1,…,n,j≠i;Wip(x)>0,p=1,…,4;LSik(x)>0,k=1,…,3n;Uis(x)>0,s=1,2}.(2)
L(1)(xe)=0; L˙(1)(xe)=0.(3)
L(1)(x)>0∀x∈D(L(1)(x))/xe.(4)
L˙(1)(x)=-∑i=1n‍δi1vi2+δi2ωi2≤0, ∀x∈D(L(1)(x)).(5)
L(1)(x)∈C1D(L(1)(x)).
Hence,L(1)(x) is classified as a Lyapunov function for system (1) and xe is a stable equilibrium point in the sense of Lyapunov.


## 6. Simulation Results

In this section, we illustrate the effectiveness of the proposed continuous controllers by simulating a number of virtual scenarios for the C-ITS on our roads.


### 6.1. Scenario 1: Line Formation in the Presence of Obstacles

We consider the motion of two automated vehicles in aline formation in the presence of obstacles. The follower vehicle is prescribed a position relative to the leader A1 as seen in Figure 6. While the leader moves towards its target, the follower maintains a desired distance and orientation relative to the leader, therefore maintaining a locally rigid formation throughout the journey.Figure 6
The evolution of C-ITS trajectories and the contour plot in the presence of obstacles in Scenario 1.Assuming that the appropriate units have been accounted for, Table1 provides the corresponding initial and final configurations of the two vehicles and other parameters required to simulate Scenario 1.Table 1
Numerical values of initial and final states, constraints, and parameters for Scenario 1.
Initial configuration  Rectangular positions ( x 1 , y 1 ) = ( 7,20 ) and (x2,y2)=(7,17) Velocities v i = 0.5 and ωi=0, for i=1,2 Angular positions θ i = 0, for i=1,2 Parking bays ( a 11 , b 11 ) = ( 57.5,21.3 ) and (a12,b12)=(60.1,21.3) ( a 31 , b 31 ) = ( 57.5,18.7 ) and (a32,b32)=(60.1,18.7) ( a 41 , b 41 ) = ( 57.5,18.2 ) and (a42,b42)=(60.1,18.2) ( a 61 , b 61 ) = ( 57.5,15.6 ) and (a62,b62)=(60.1,15.6)  Constraints and parameters  Dimensions of robots L i = 1.6 and li=1.2 for i=1,2 Leader’s target ( p 11 , p 12 ) = ( 57,20 ); rt=0.5 Final orientations p 13 = p 23 = 0  Max. translational velocity v m a x = 5 Max. steering angle ϕ m a x = π 2 Clearance parameters ϵ 1 = 0.1 and ϵ2=0.05 Fixed obstacles ( o 11 , o 12 ) = ( 15,16 ), (o21,o22)=(25,24), and (o31,o32)=(35,16) ( o 41 , o 42 ) = ( 45,24 ) and rol=2 for l=2,…,4  Control and convergence parameters  Collision avoidance η i j = 0.001, for i,j=1,2, j≠i κ i p = 0.1, for i=1,2, p=1,…,2 γ i k = 0.1, for i=1,2, k=1,…,3n α 11 = 1, α12=α14=0.1, and α13=2 α 2 l = 0.01 for l=1,…,4 Dynamics constraints β i s = 0.01, for i,s=1,2 Convergence δ 11 = 3000, δ12=100, δ21=10, and δ22=100Figure6 also depicts the contour plot of the potential fields of the system enroute to the final destination. Figures 7 and 8 show the orientations and velocities of A1 and A2, respectively. Figure 9 depicts the time evolution of the nonlinear controllers of the leader A1, and Figure 10 compares the relative distance r12 to the desired relative distance r12d. It is evident that the formation is slightly distorted when the pair of cooperative cars encounter an obstacle; however, the desired formation is reestablished before the pair reach the final destination.Figure 7
Orientations ofA1 and A2 for Scenario 1.Figure 8
Translational and rotational velocities for Scenario 1.Figure 9
Accelerationsσ11 and σ12 of A1 for Scenario 1.Figure 10
The relative distance of the follower to the leader vehicle compared to the desired relative distance in Scenario 1.


### 6.2. Scenario 2: Effect of Noise on Line Formation

To evaluate the robustness of the proposed scheme, we look at the effect of noise on the formation of the C-ITS. It is sufficient to include the noise parameters in the componentsAk and Bk which define the follower vehicles’ relative position to the leader vehicle, with respect to the X-Y coordinate system, similar to the one proposed in [29]. Thus we have(27)Ak=-x1-xkcos⁡θ1-y1-yksin⁡θ1+ξγkt,Bk=x1-xksin⁡θ1-y1-ykcos⁡θ1+ξνkt.The terms ξγk(t) and ξνk(t) are the small disturbances, where ξ∈[0,1] is the noise level, while γk(t) and νk(t) are randomized time-dependent variables such that γk(t)∈[-1,1] and νk(t)∈[-1,1]. Figure 11 shows the trajectories and the control signals under the influence of small disturbances, ξ∈[0,1]. It is observed that the pair of cooperative cars maintain the line formation throughout their road journey even under the influence of the noise terms. There are slight distortions in their formation when the pair of cooperative vehicles encounter obstacles but these distortions are temporary. Also, the disturbances in the controllers at t=11,000 units are a result of the parking bays. The two cars align themselves to achieve the desired orientations inside the parking bays. The final orientations are forced as a result of the repulsive potentials created by the walls of the parking bays.Figure 11
Trajectories ofA1 and A2 and the evolution of control signals under various influences of noise.
(a)
Trajectories forξ=0.1 (b)
Control signals,σi1 and σi2, for ξ=0.1 (c)
Trajectories forξ=0.2 (d)
Control signals,σi1 and σi2, for ξ=0.2 (e)
Trajectories forξ=0.5 (f)
Control signals,σi1 and σi2, for ξ=0.5


### 6.3. Scenario 3: Diamond Formation

In this scenario, we have considered the leader vehicle at the center of a Diamond Formation with the followers positioned at each vertex (see Figure12). The figure shows the formation maneuvered from an initial state to a predefined final state, with collision and obstacle avoidance.Figure 12
The evolution of the 5-robot C-ITS and the contour plot in the presence of obstacles in Scenario 3.Figure12 also depicts the contour plot of the potential fields and the corresponding collision-free path over the defined workspace, 0<z1<40, containing the obstacles on the road. Figures 13 and 14 depict the time evolution of the nonlinear controllers of the leader and its follower vehicles. Assuming that the appropriate units have been accounted for, Table 2 (if different from Table 1) provides the corresponding initial and final configurations of the 5-car C-ITS and other parameters required to simulate Scenario 3. The coordinates of the parking bays can be obtained from Figure 12.Table 2
Numerical values of initial and final states, constraints, and parameters for Scenario 3.
Initial configuration  Rectangular positions ( x 1 , y 1 ) = ( 7,20 ), (x2,y2)=(4,20), (x3,y3)=(7,23) ( x 4 , y 4 ) = ( 10,20 ), and (x5,y5)=(7,17) ( a 2 , b 2 ) = ( 3,0 ), (a3,b3)=(0,-3) ( a 4 , b 4 ) = ( - 3,0 ), and (a5,b5)=(0,3) Velocity and angular position v i = 0.5, ωi=0, and θi=0 for i=1,…,5  Constraints and parameters  Leader’s target ( p 11 , p 12 ) = ( 57,37 ); rt=0.5 Final orientations p i 3 = 0 for i=1,…,5  Control and convergence parameters  Obstacle avoidance α i l = 10, for i=1,…,5, l=1,…,3 κ i p = 0.1, for i=1,…,5, p=1,…,2 γ i k = 1.2 × 1 0 - 4, for i=1,…,5, k=1,…,3i, k=1,…,3n Collision avoidance η i j = 0.01, for i,j=1,…,5, j≠i Dynamics constraints β i s = 0.001, for i=1,…,5, s=1,2 Convergence δ 11 = 20,500,  δ12=10,500,  δi1=60, and δi2=60 for i=1,…,5Figure 13
Translational accelerations,σ1i for Scenario 3.Figure 14
Rotational accelerations,σ2i for Scenario 3.Clearly the translational and rotational accelerations of the vehicles decrease as the formation approaches a fixed obstacle and increase once it is able to evade it. Moreover, Figures15 and 16 compare the relative distance Ak to the desired relative distance ak and compares Bk to the desired relative distance bk, respectively. It is evident from the behavior shown in the figures that the formation gets slightly distorted when the C-ITS encounters an obstacle; however, the desired formation is reestablished before the leader A1 reaches its designated target, thus ensuring a locally rigid formation along the trajectory of the C-ITS.Figure 15
Relative distance error,Ak to ak for Scenario 3.Figure 16
Relative distance error,Bk to bk for Scenario 3.


## 6.1. Scenario 1: Line Formation in the Presence of Obstacles

We consider the motion of two automated vehicles in aline formation in the presence of obstacles. The follower vehicle is prescribed a position relative to the leader A1 as seen in Figure 6. While the leader moves towards its target, the follower maintains a desired distance and orientation relative to the leader, therefore maintaining a locally rigid formation throughout the journey.Figure 6
The evolution of C-ITS trajectories and the contour plot in the presence of obstacles in Scenario 1.Assuming that the appropriate units have been accounted for, Table1 provides the corresponding initial and final configurations of the two vehicles and other parameters required to simulate Scenario 1.Table 1
Numerical values of initial and final states, constraints, and parameters for Scenario 1.
Initial configuration  Rectangular positions ( x 1 , y 1 ) = ( 7,20 ) and (x2,y2)=(7,17) Velocities v i = 0.5 and ωi=0, for i=1,2 Angular positions θ i = 0, for i=1,2 Parking bays ( a 11 , b 11 ) = ( 57.5,21.3 ) and (a12,b12)=(60.1,21.3) ( a 31 , b 31 ) = ( 57.5,18.7 ) and (a32,b32)=(60.1,18.7) ( a 41 , b 41 ) = ( 57.5,18.2 ) and (a42,b42)=(60.1,18.2) ( a 61 , b 61 ) = ( 57.5,15.6 ) and (a62,b62)=(60.1,15.6)  Constraints and parameters  Dimensions of robots L i = 1.6 and li=1.2 for i=1,2 Leader’s target ( p 11 , p 12 ) = ( 57,20 ); rt=0.5 Final orientations p 13 = p 23 = 0  Max. translational velocity v m a x = 5 Max. steering angle ϕ m a x = π 2 Clearance parameters ϵ 1 = 0.1 and ϵ2=0.05 Fixed obstacles ( o 11 , o 12 ) = ( 15,16 ), (o21,o22)=(25,24), and (o31,o32)=(35,16) ( o 41 , o 42 ) = ( 45,24 ) and rol=2 for l=2,…,4  Control and convergence parameters  Collision avoidance η i j = 0.001, for i,j=1,2, j≠i κ i p = 0.1, for i=1,2, p=1,…,2 γ i k = 0.1, for i=1,2, k=1,…,3n α 11 = 1, α12=α14=0.1, and α13=2 α 2 l = 0.01 for l=1,…,4 Dynamics constraints β i s = 0.01, for i,s=1,2 Convergence δ 11 = 3000, δ12=100, δ21=10, and δ22=100Figure6 also depicts the contour plot of the potential fields of the system enroute to the final destination. Figures 7 and 8 show the orientations and velocities of A1 and A2, respectively. Figure 9 depicts the time evolution of the nonlinear controllers of the leader A1, and Figure 10 compares the relative distance r12 to the desired relative distance r12d. It is evident that the formation is slightly distorted when the pair of cooperative cars encounter an obstacle; however, the desired formation is reestablished before the pair reach the final destination.Figure 7
Orientations ofA1 and A2 for Scenario 1.Figure 8
Translational and rotational velocities for Scenario 1.Figure 9
Accelerationsσ11 and σ12 of A1 for Scenario 1.Figure 10
The relative distance of the follower to the leader vehicle compared to the desired relative distance in Scenario 1.


## 6.2. Scenario 2: Effect of Noise on Line Formation

To evaluate the robustness of the proposed scheme, we look at the effect of noise on the formation of the C-ITS. It is sufficient to include the noise parameters in the componentsAk and Bk which define the follower vehicles’ relative position to the leader vehicle, with respect to the X-Y coordinate system, similar to the one proposed in [29]. Thus we have(27)Ak=-x1-xkcos⁡θ1-y1-yksin⁡θ1+ξγkt,Bk=x1-xksin⁡θ1-y1-ykcos⁡θ1+ξνkt.The terms ξγk(t) and ξνk(t) are the small disturbances, where ξ∈[0,1] is the noise level, while γk(t) and νk(t) are randomized time-dependent variables such that γk(t)∈[-1,1] and νk(t)∈[-1,1]. Figure 11 shows the trajectories and the control signals under the influence of small disturbances, ξ∈[0,1]. It is observed that the pair of cooperative cars maintain the line formation throughout their road journey even under the influence of the noise terms. There are slight distortions in their formation when the pair of cooperative vehicles encounter obstacles but these distortions are temporary. Also, the disturbances in the controllers at t=11,000 units are a result of the parking bays. The two cars align themselves to achieve the desired orientations inside the parking bays. The final orientations are forced as a result of the repulsive potentials created by the walls of the parking bays.Figure 11
Trajectories ofA1 and A2 and the evolution of control signals under various influences of noise.
(a)
Trajectories forξ=0.1 (b)
Control signals,σi1 and σi2, for ξ=0.1 (c)
Trajectories forξ=0.2 (d)
Control signals,σi1 and σi2, for ξ=0.2 (e)
Trajectories forξ=0.5 (f)
Control signals,σi1 and σi2, for ξ=0.5


## 6.3. Scenario 3: Diamond Formation

In this scenario, we have considered the leader vehicle at the center of a Diamond Formation with the followers positioned at each vertex (see Figure12). The figure shows the formation maneuvered from an initial state to a predefined final state, with collision and obstacle avoidance.Figure 12
The evolution of the 5-robot C-ITS and the contour plot in the presence of obstacles in Scenario 3.Figure12 also depicts the contour plot of the potential fields and the corresponding collision-free path over the defined workspace, 0<z1<40, containing the obstacles on the road. Figures 13 and 14 depict the time evolution of the nonlinear controllers of the leader and its follower vehicles. Assuming that the appropriate units have been accounted for, Table 2 (if different from Table 1) provides the corresponding initial and final configurations of the 5-car C-ITS and other parameters required to simulate Scenario 3. The coordinates of the parking bays can be obtained from Figure 12.Table 2
Numerical values of initial and final states, constraints, and parameters for Scenario 3.
Initial configuration  Rectangular positions ( x 1 , y 1 ) = ( 7,20 ), (x2,y2)=(4,20), (x3,y3)=(7,23) ( x 4 , y 4 ) = ( 10,20 ), and (x5,y5)=(7,17) ( a 2 , b 2 ) = ( 3,0 ), (a3,b3)=(0,-3) ( a 4 , b 4 ) = ( - 3,0 ), and (a5,b5)=(0,3) Velocity and angular position v i = 0.5, ωi=0, and θi=0 for i=1,…,5  Constraints and parameters  Leader’s target ( p 11 , p 12 ) = ( 57,37 ); rt=0.5 Final orientations p i 3 = 0 for i=1,…,5  Control and convergence parameters  Obstacle avoidance α i l = 10, for i=1,…,5, l=1,…,3 κ i p = 0.1, for i=1,…,5, p=1,…,2 γ i k = 1.2 × 1 0 - 4, for i=1,…,5, k=1,…,3i, k=1,…,3n Collision avoidance η i j = 0.01, for i,j=1,…,5, j≠i Dynamics constraints β i s = 0.001, for i=1,…,5, s=1,2 Convergence δ 11 = 20,500,  δ12=10,500,  δi1=60, and δi2=60 for i=1,…,5Figure 13
Translational accelerations,σ1i for Scenario 3.Figure 14
Rotational accelerations,σ2i for Scenario 3.Clearly the translational and rotational accelerations of the vehicles decrease as the formation approaches a fixed obstacle and increase once it is able to evade it. Moreover, Figures15 and 16 compare the relative distance Ak to the desired relative distance ak and compares Bk to the desired relative distance bk, respectively. It is evident from the behavior shown in the figures that the formation gets slightly distorted when the C-ITS encounters an obstacle; however, the desired formation is reestablished before the leader A1 reaches its designated target, thus ensuring a locally rigid formation along the trajectory of the C-ITS.Figure 15
Relative distance error,Ak to ak for Scenario 3.Figure 16
Relative distance error,Bk to bk for Scenario 3.


## 7. Conclusion

This paper presents a set of nonlinear control laws using the LbCS to achieve a novel technique of extracting a locally rigid formation of a C-ITS made up of multiple car-like autonomous robots. A leader-following strategy is proposed to operate within the control scheme for the maintenance of the locally rigid formation for a C-ITS which navigates in a constrained environment. This leader-follower scheme uses a Cartesian coordinate system fixed on the leader’s body based on the concept of an instantaneous corotating frame of reference to uniquely assign a position to each follower. The advantage of such an approach is the complete avoidance of singularities inherent to the polar coordinate representations.The new time-invariant acceleration-based controllers produce feasible trajectories and ensured a nice convergence of the system to its equilibrium state while satisfying the necessary kinematic and dynamic constraints. The scheme enables the vehicles to follow a predetermined leader while maintaining a locally rigid formation. The robustness of the proposed scheme is established by considering the effect of noise on the formation, while stability of the system is guaranteed using the direct method of Lyapunov. The assumptions of no slippage and pure rolling of the car-like mobile robots are also considered to generate the nonholonomic constraints on the given system. Further, the LbCS utilizes theminimum distance technique and parking bays to guarantee desired parking maneuvers and establish feasible prescribed posture of each vehicle in its designated parking bay.This paper is a theoretical exposition into the applicability of an amalgamation of the new artificial potential field method, LbCS, and the leader-follower scheme. We restrict ourselves to showing the effectiveness of the control laws using computer-based simulations of interesting scenarios and numerical proofs. We shall be undertaking experiential design of the above system to see its effectiveness in the future. Future research will also address irregular shaped multimodal obstacles in partially known or completely known environments with the adaptive usage of sensing zones and relevant parameters. The optimization process of parameters within the LbCS still remains an open problem that warrants a careful thought.



---

*Source: 5278565-2018-02-25.xml*