# Formation Control of Unmanned Surface Vehicles with Sensing Constraints Using Exponential Remapping Method

Authors: Jian Wang; Jing-Yang Liu; Hong Yi
Journal: Mathematical Problems in Engineering
 (2017)

---

## Abstract

This paper presents a formation control strategy for unmanned surface vehicles (USVs) with sensing constraints moving in a leader-follower formation. Each USV is assumed to be equipped with a vision-based sensor, which is able to get the line-of-sight (LOS) range and bearing information. Most existing literature assumes that the USVs in formation control are with no sensing limitations or with 360-degree sensing fields; however, in our research, the vision-based sensor’s capability is restricted due to limited Field of View (FOV) and visual range. We consider that each USV in formation problem is equipped with a sector-like sensing field sensor for the leader-follower formation in two-dimensional space. The formation controller is developed by employing backstepping control technique and exponential remapping. The backstepping controller is designed to stabilize the triangular formation of three USVs, and the proposed exponential remapping method is to deal with the sector-like sensing constraint problem. Comparative analysis with three exponential remapping methods using numerical simulations is given to demonstrate the effectiveness of the proposed method.


---

## Body

## 1. Introduction

Over the past few years, due to the increasing need for utilizing multiple vehicles to perform difficult tasks as a team, the formation control of multivehicle systems has gained enormous interests in the research of system and control. Maintaining a desired formation enables multiple vehicles to cooperate with each other to accomplish some difficult tasks which are not executable by a single one. And it can reduce system cost, enhance work efficiency, and provide redundancy against individual failures [1]. The relevant applications have arisen in marine engineering including collaborative antisubmarine, costal patrols, environmental monitoring, disaster search, and underway ship replenishment, to name just a few. Many researchers have made contributions to the formation control, and several methods have been proposed including leader-follower method [1–5], virtual structure strategy [6, 7], behavior-based approach [8, 9], graph theory-based method [10–12], and artificial potential method [13].Leader-follower (L-F) method is most preferred in practice because of its simplicity and scalability [3]. In a leader-follower formation, one or more individual of the group is designated as the leader, and the others are designated as followers; the followers follow the leader to keep the desired distances or angles; then the formation will be achieved ultimately. During the last decade, the formation control has been focused on the marine vehicles, and most works appear to have been done within the leader-follower framework. A method for formation control of marine surface craft inspired by Lagrangian mechanics was presented in [14], and the method is also suitable for underactuated ships. In [15], within a leader-follower framework, fully actuated ships were controlled as a formation by applying the integrator backstepping and cascade theory. In [16], the problem of path following and formation control for underactuated surface vessels in the presence of unknown ocean currents was considered, and the proposed controllers were based on line-of-sight (LOS) guidance, adaptive control, and cascaded systems theory. In [4], formation control of multiple underactuated autonomous underwater vehicles (AUVs) was concerned, where a virtual vehicle was constructed such that its trajectory converged to the reference trajectory of the follower. Also, using a nonlinear observer to estimate the leader’s velocity and acceleration, a leader-follower output synchronization control scheme was developed in [17] for ship replenishment operations. In [18], a new implementable cooperative adaptive backstepping controller was proposed for a group of AUVs to track a time-varying virtual leader, where the singular perturbation theory was also used so that the velocity information of the neighbor was precluded in the cooperative design. In [19], the neural network and approach angle were used to implement formation control of AUVs without the velocity information of the leader. In general, among these control designs, two types of their information exchange methods can be summarized. One type for L-F formation control has wireless communication between leaders and followers, and the main issues they need to handle are communication delay, packet lose [20, 21], and so forth. The other type for L-F formation control requires the local sensors such as radar or sonar to measure the vehicles’ states and copes with noises which are bad for measurements, such that the robots in [2, 22] were equipped with omnidirectional cameras, which had 360-degree views of surroundings. In [5], each unicycle robot was equipped with a panoramic camera that only provides the view angle to the other robots. In [23], a constructive method was proposed to force a group of multimobile robots to stabilize at a desired location, where the robots were with limited sensing ranges. A robust adaptive formation controller was developed by employing neural network and dynamic surface control technique to keep the underactuated autonomous surface vehicles (ASVs) moving in an L-F formation in [1], where the proposed method only used the measurements of LOS range and angle by local sensors. Robots in [24] could measure the relative positions of any object if the object was within a given sensing distance and there were no obstacles in between. The author in [25] presented a constructive method to design cooperative controllers that forced a group of several underactuated ships with limited sensing ranges to perform a desired formation and guaranteed no collisions between the ships. The agents considered in most of these existing works are assumed to be without sensing limitations or with 360-degree sensing fields. However, in practice, it is inevitable that there are some sensing constraints on sensing fields, for example, Lidar and camera. Lidar is widely used on robots and unmanned ground vehicles; however, some Lidars can only scan a sector area in a special plane. Cameras are also frequently used on-board sensors; most of them (except for the omnidirectional camera) have the cone-like sensing fields. Some attempts have been made to solve the similar problem about sensing constraints. In [26], a leader-follower formation control strategy was presented for underactuated marine vehicles which moved under sensing and communication constraints in the presence of bounded persistent environmental disturbances, and the sensing area was limited as a circular sector. The proposed control design guarantees that the follower always keeps sensing with the leader. However the follower is centered in the camera field, which is inapplicable for two or more followers to obtain a triangular formation. A shortest path algorithm was proposed for a robot with unicycle kinematics to go to a goal position in [27], and an on-board camera with limited Field of View (FOV) was used. The algorithm is able to make the robot follow shortest paths to its goal position while keeping a given feature in sight. Frequent turning, going forward or backward, is required, which is easy to do for unicycle robots, but it is not practical for USVs. In [28], the author presented a novel navigation method for a nonholonomic robot based on Model Predictive Control (MPC). The method can keep sensing with a stationary target although there exist FOV sensing constraints. However the algorithm pays close attention to maintain the target in its sensing center, and it cannot be used directly for leader-follower formation control.In this study, we focus on the formation control of USVs considering sensing field constraints. Each USV is assumed to be equipped with a vision-based sensor, which is able to get the LOS range and bearing information of its leader. And each sensor has a cone-like sensing field just like a camera. Some related research like vision-based target tracking of USVs have been done by some researchers, such as in [29]; the relative velocity and position of the USV’s target were estimated using calibrated projective camera model. In [30], an approach to detect and track long distance boat with high resolution image was proposed for USVs. In [31], a robust computer vision system for an USV was developed to track a moving marine vehicle from the USV. In [32], autonomous detection and tracking of a surface ship using a monocular camera mounted on an USV were addressed, and the bearing and range to the target ship with respect to the USV were obtained by computer vision techniques. On the basis of these studies, the follower can be able to get the leader’s information. In this research, how the on-board vision-based sensor obtains the target’s information is not the main attention; we assume that the follower can be able to get its leader’s information clearly. For efficiency and reality, we consider the formation control with the leader-follower structure in two-dimensional (2D) space; that is to say, the on-board sensor’s cone-like sensing field is simplified as a sector one. Because of the leader-follower structure and the sector-like sensing field, two priority rules are considered to hold by USVs in this research. First, the follower should be able to keep sensing with the leader(s) so that it can always get the information of the leader(s) and the formation will be maintained. Second, on the basis of followers keeping sensing with the leader(s), the control strategy should be able to get one optimal formation structure. In our previous work [33], we have made an effort on the formation control of unmanned surface vehicles with vision sensor constraints. However, in this work, when the follower’s on-border sensor loses the information of its leader, the switch control will then work to control the follower to turn its yaw to try to find the leader again, which will not keep the information of the leader and the formation of the USVs will not be guaranteed. So in this paper, we design a formation controller by employing backstepping control technique and exponential remapping method, under which the follower can be able to keep sensing with the leader(s) so as to maintain the formation. The backstepping controller is designed to stabilize the triangular formation of three USVs, and an exponential remapping method is proposed to deal with the sector-like sensing constraint problem.The contribution of this paper is twofold:(i)
In contrast to the leader-follower formation control problems in [1–5, 16–18], this paper addresses sensor constraint problems of leader-follower formation control of USVs. Unlike the agents without sensing limitations or with 360-degree sensing fields considered in [2, 5, 22–25], the proposed control scheme based on backstepping control technique and exponential remapping method enables the USVs with sector-like sensing constraints to form a stable formation.(ii)
The contributions in [26, 28] are developing the formation controllers for USVs under leader-follower structure considering sector-like sensing constraints, and the follower keeps its target in the center of its center, which is hard to form a triangle formation. The contributions in [31] are developing the shortest path control for a robot with FOV constraints to reach a target. In contrast to the contributions of the previous work, the control scheme in this paper can form a triangle formation under sector-like sensing constraints and at the same time get the optimal formation structure.The remainder of the paper is organized as follows: in Section2, the modeling of the system is provided and the sensing constraints of FOV are stated. Section 3 shows the proposed formation control of the system. In Section 4, simulation results are shown. Concluding remarks are given in Section 5.


## 2. Preliminary

### 2.1. Kinematics and Dynamics of USV

The general 6-DOF can be decoupled to surge/forward, sway/lateral, and heading/yaw pairs, while the dynamics associated with the motion in roll, pitch, and heave are generally neglected. Assuming that the inertia, added mass, and hydrodynamic damping matrices are diagonal, which holds good for ships having port/starboard and fore/aft symmetry [34], the kinematics and dynamics of the USV with no external disturbances can be described as in [35] by(1)x˙=ucos⁡φ-vsin⁡φy˙=usin⁡φ+vcos⁡φφ˙=r(2)u˙=m2m1vr-d1m1u+1m1τuv˙=-m1m2ur-d2m2vr˙=m1-m2m3uv-d3m3r+1m3τr.Here,(x,y) denotes the position and φ is the heading angle of the USV in the earth-fixed frame; u, v, and r are the velocities of the USV in the body-fixed frame (u: surge velocity; v: sway velocity; r: angular velocity in yaw); mi(i=1,2,3) is the inertia of the USV including added masses; di(i=1,2,3) is the hydrodynamic damping in surge, sway, and yaw; τu and τr are the control signal (τu: surge force; τr: yaw moment). For the actual USV, the velocities and input forces are limited, so we make the following assumption.Assumption 1.
The velocities and input forces of the USV are bounded assupt⁡u=u-max, supt⁡v=v-max, supt⁡r=r-max, supt⁡τu=τ-umax, and supt⁡τr=τ-rmax with known bounds u-max>0, v-max>0, r-max>0, τ-umax>0, and τ-rmax>0.


### 2.2. Leader-Follower Formation

In this paper, the leader vehicle will be denoted with a subscript “L,” while the ith follower vehicle will be denoted with a subscript “Fi.” We use the Cartesian coordinates rather than the commonly used polar coordinates because of the models having singularity problem in the polar coordinate representation as shown in [36]. Figure 1 presents the basic geometric structure of two USVs moving in the leader-follower formation in Cartesian coordinates, where (XL,YL,φL) are the position and yaw angle of the leader, (XFi,YFi,φFi) are the position and yaw angle of the follower i, and (lLFi,αLi) denotes the LOS range and bearing information between the leader and the follower i. And λLFi is the relative angle with respect to the leader.Figure 1
Leader-follower formation.The formation is defined asFLFi=lLFiλLFiT, where lLFi∈R≥ND, λLFi∈(π/2,3π/2). ND denotes the minimum distance between leader and followers in case collisions between them. The desired formation is defined as FLFid=lLFidλLFidT. Given the leader’s position and yaw angle, and as long as FLFi is known and fixed, the follower’s position will be unique. So the desired formation FLFid will be maintained.In Figure1, lx and ly are the projects of lLFi along x and y directions relative to the leader; lxd and lyd are the desired values of lx and ly. They can be got as follows:(3)lx=-XL-XFcos⁡φL-YL-YFsin⁡φLly=XL-XFsin⁡φL-YL-YFcos⁡φL,(4)lxd=lLFidsin⁡λLFid+φL-π2,lyd=lLFidcos⁡λLFid+φL-π2.Then combining (1) and (3), we can obtain the following kinematic equations:(5)l˙x=uL-uFcos⁡eφ-vFsin⁡eφ+lyφ˙Ll˙y=vL+uFsin⁡eφ-vFcos⁡eφ-lxφ˙Le˙φ=φ˙L-φ˙F=rL-rF.The control objective is to design the formation controller for the follower that follows the leader keeping the desired values lxd,  lyd, and eφ stable.


### 2.3. Sensing Constraints

In this paper, each USV is assumed to be equipped with a vision-based sensor, which is able to get the LOS range and bearing information of its sensing object. The vision-based sensor’s capability is restricted due to limited FOV and visual range, as shown in Figure2. As mentioned in Section 1, we consider the formation control with the leader-follower structure in two-dimensional (2D) space; that is to say, the on-board sensor’s sensing field is simplified as a sector-like one, as shown in Figure 3.Figure 2
USV equipped with a vision-based sensor.Figure 3
Sector-like sensing field.The circular sector of radiusDrange and angle 2α in Figure 3 define the effective sensing field of each USV. Thus each vehicle can get the measurements of the objects moving within its sensing field. Drange and 2α are the maximum sensing range and maximum sensing angle of the on-board vision-based sensor. αL and lL-Fi denote the leader’s orientation and distance relative to the follower i measured by the follower i’s on-board vision-based sensor; that is to say, they are the follower’s sensing angle and distance. The two USVs shown in Figure 3 can form a formation if and only if the follower i maintains sensing with the leader. To facilitate the control design, we make the following assumptions.Assumption 2.
The formation state vectorFLFi can be measured accurately by the follower’s on-board sensor. And the leader’s velocities, acceleration, and orientation are assumed to be able to be measured and calculated by the follower.Assumption 3.
The FOV of the on-board sensor has a constraint angle2α. The sensing range of the sensor dv is bounded as sup(dv)=Drange. And the desired range lLFid between leader and follower is bounded as sup(lLFid)≪Drange.Assumption 4.
The single USV can be able to obtain its orientation and velocities data accurately from its on-board sensors. No disturbances and obstacles are considered in this formation system.


## 2.1. Kinematics and Dynamics of USV

The general 6-DOF can be decoupled to surge/forward, sway/lateral, and heading/yaw pairs, while the dynamics associated with the motion in roll, pitch, and heave are generally neglected. Assuming that the inertia, added mass, and hydrodynamic damping matrices are diagonal, which holds good for ships having port/starboard and fore/aft symmetry [34], the kinematics and dynamics of the USV with no external disturbances can be described as in [35] by(1)x˙=ucos⁡φ-vsin⁡φy˙=usin⁡φ+vcos⁡φφ˙=r(2)u˙=m2m1vr-d1m1u+1m1τuv˙=-m1m2ur-d2m2vr˙=m1-m2m3uv-d3m3r+1m3τr.Here,(x,y) denotes the position and φ is the heading angle of the USV in the earth-fixed frame; u, v, and r are the velocities of the USV in the body-fixed frame (u: surge velocity; v: sway velocity; r: angular velocity in yaw); mi(i=1,2,3) is the inertia of the USV including added masses; di(i=1,2,3) is the hydrodynamic damping in surge, sway, and yaw; τu and τr are the control signal (τu: surge force; τr: yaw moment). For the actual USV, the velocities and input forces are limited, so we make the following assumption.Assumption 1.
The velocities and input forces of the USV are bounded assupt⁡u=u-max, supt⁡v=v-max, supt⁡r=r-max, supt⁡τu=τ-umax, and supt⁡τr=τ-rmax with known bounds u-max>0, v-max>0, r-max>0, τ-umax>0, and τ-rmax>0.


## 2.2. Leader-Follower Formation

In this paper, the leader vehicle will be denoted with a subscript “L,” while the ith follower vehicle will be denoted with a subscript “Fi.” We use the Cartesian coordinates rather than the commonly used polar coordinates because of the models having singularity problem in the polar coordinate representation as shown in [36]. Figure 1 presents the basic geometric structure of two USVs moving in the leader-follower formation in Cartesian coordinates, where (XL,YL,φL) are the position and yaw angle of the leader, (XFi,YFi,φFi) are the position and yaw angle of the follower i, and (lLFi,αLi) denotes the LOS range and bearing information between the leader and the follower i. And λLFi is the relative angle with respect to the leader.Figure 1
Leader-follower formation.The formation is defined asFLFi=lLFiλLFiT, where lLFi∈R≥ND, λLFi∈(π/2,3π/2). ND denotes the minimum distance between leader and followers in case collisions between them. The desired formation is defined as FLFid=lLFidλLFidT. Given the leader’s position and yaw angle, and as long as FLFi is known and fixed, the follower’s position will be unique. So the desired formation FLFid will be maintained.In Figure1, lx and ly are the projects of lLFi along x and y directions relative to the leader; lxd and lyd are the desired values of lx and ly. They can be got as follows:(3)lx=-XL-XFcos⁡φL-YL-YFsin⁡φLly=XL-XFsin⁡φL-YL-YFcos⁡φL,(4)lxd=lLFidsin⁡λLFid+φL-π2,lyd=lLFidcos⁡λLFid+φL-π2.Then combining (1) and (3), we can obtain the following kinematic equations:(5)l˙x=uL-uFcos⁡eφ-vFsin⁡eφ+lyφ˙Ll˙y=vL+uFsin⁡eφ-vFcos⁡eφ-lxφ˙Le˙φ=φ˙L-φ˙F=rL-rF.The control objective is to design the formation controller for the follower that follows the leader keeping the desired values lxd,  lyd, and eφ stable.


## 2.3. Sensing Constraints

In this paper, each USV is assumed to be equipped with a vision-based sensor, which is able to get the LOS range and bearing information of its sensing object. The vision-based sensor’s capability is restricted due to limited FOV and visual range, as shown in Figure2. As mentioned in Section 1, we consider the formation control with the leader-follower structure in two-dimensional (2D) space; that is to say, the on-board sensor’s sensing field is simplified as a sector-like one, as shown in Figure 3.Figure 2
USV equipped with a vision-based sensor.Figure 3
Sector-like sensing field.The circular sector of radiusDrange and angle 2α in Figure 3 define the effective sensing field of each USV. Thus each vehicle can get the measurements of the objects moving within its sensing field. Drange and 2α are the maximum sensing range and maximum sensing angle of the on-board vision-based sensor. αL and lL-Fi denote the leader’s orientation and distance relative to the follower i measured by the follower i’s on-board vision-based sensor; that is to say, they are the follower’s sensing angle and distance. The two USVs shown in Figure 3 can form a formation if and only if the follower i maintains sensing with the leader. To facilitate the control design, we make the following assumptions.Assumption 2.
The formation state vectorFLFi can be measured accurately by the follower’s on-board sensor. And the leader’s velocities, acceleration, and orientation are assumed to be able to be measured and calculated by the follower.Assumption 3.
The FOV of the on-board sensor has a constraint angle2α. The sensing range of the sensor dv is bounded as sup(dv)=Drange. And the desired range lLFid between leader and follower is bounded as sup(lLFid)≪Drange.Assumption 4.
The single USV can be able to obtain its orientation and velocities data accurately from its on-board sensors. No disturbances and obstacles are considered in this formation system.


## 3. Control Strategy

In this section, we will apply the backstepping control method and exponential remapping method to design the torque controlsτu and τr to achieve the formation control. In the first step, virtual controls are designed using formation errors. In the second step, actual controls τu and τr are designed. At last, considering the sensing constraints, position errors, and yaw angle errors are remapped using exponential remapping method.


### 3.1. Virtual Controls

Define the formation position errors inx and y directions as(6)E=exey=lx-lxdly-lyd.Combining (4), (5), and (6), then the error dynamics of the system are given as(7)e˙xe˙ye˙φ=l˙x-l˙xdl˙y-l˙ydφ˙L-φ˙F=-uFcos⁡eφ-vFsin⁡eφ+eyφ˙L+uL+lydφ˙L-l˙xduFsin⁡eφ-vFcos⁡eφ-exφ˙L+vL-lxdφ˙L-l˙ydrL-rF.The followers are the controlled objects; however, we note that the formation position errorE is in the leader’s body-fixed frame. So using an Euler angle rotation matrix, we can get the formation position error Σ as(8)Σ=ε1ε2=cos⁡eφ-sin⁡eφsin⁡eφcos⁡eφE.Then we can get (9)ε˙1ε˙2=uF+ξ1cos⁡eφ-ξ2sin⁡eφ+ε2rFvF+ξ1sin⁡eφ+ξ2cos⁡eφ-ε1rF,where ξ1=-uL+lydφ˙L-l˙xd,  ξ2=-vL-lxdφ˙L-l˙yd.Step 1.
Define the control Lyapunov function (CLF):(10)V1=12ε12+12ε22,whose time derivative combined with (9) is given by (11)V˙1=ε1ε˙1+ε2ε˙2=ε1uF+ξ1cos⁡eφ-ξ2sin⁡eφ+ε2vF+ξ1sin⁡eφ+ξ2cos⁡eφ.Choose the kinematics virtual control law as(12)uFv=-k1ε1-ξ1cos⁡eφ+ξ2sin⁡eφ,(13)vFv=-k2ε2-ξ1sin⁡eφ-ξ2cos⁡eφ,where k1,k2>0∈R.
Then (11) becomes(14)V˙1=-k1ε12-k2ε22≤0.So the system Σ is asymptotically stable.Step 2.
Define the sway velocity error asve=vF-vFv, whose time derivative combined with (2) and (13) is given by(15)v˙e=v˙F-v˙Fv=-d2m2vF-m1m2k1ε1rF+m1m2ξ1cos⁡eφrF-m1m2ξ2sin⁡eφrF+k2vF-k2ξ1sin⁡eφ-k2ξ2cos⁡eφ-k2ε1rF-ξ˙1sin⁡eφ-ξ˙2cos⁡eφ-ξ1cos⁡eφe˙φ+ξ2sin⁡eφe˙φ.Choosing k1=d2/m1 and k2=d2/m2, then (15) becomes(16)v˙e=m1m2-1ξ2sin⁡eφ-ξ1cos⁡eφrF-d2m2ξ1sin⁡eφ+ξ2cos⁡eφ+ξ2sin⁡eφ-ξ1cos⁡eφrL-ξ˙1sin⁡eφ-ξ˙2cos⁡eφ.Define the control Lyapunov function (CLF):(17)V2=12ve2+2k3sin2⁡eφ2,k3>0∈R.Then we get the time derivative of (17), giving(18)V˙2=vev˙e+k3rL-rFsin⁡eφ=vem1m2-1λrF-d2m2ζ+λrL-ξ˙1sin⁡eφ-ξ˙2cos⁡eφ+k3rLsin⁡eφ-k3rFsin⁡eφ,where λ=ξ2sin⁡eφ-ξ1cos⁡eφ,  ζ=ξ1sin⁡eφ+ξ2cos⁡eφ.
Choose the virtual control:(19)rFv=rL+k4sin⁡eφ-k5m1m2-1veλ+Θ,where(20)Θ=-sgn⁡vek4+k3k5m1/m2-1+d2/m2ζm1/m2-1ζ+k3.Then (18) becomes(21)V˙2=-k5m1m2-12ve2λ2-k3k4sin2⁡eφ+veλm1rLm2+m1m2-1k4+k3k5sin⁡eφ-ξ˙1sin⁡eφ-ξ˙2cos⁡eφ-d2ζm2+vem1m2-1λ-k3sin⁡eφΘ≤-k5m1m2-12ve2λ2-k3k4sin2⁡eφ+veζrLm1m2+m1m2-1k4+k3k5+d2m2+ξ˙1+ξ˙2+vem1m2-1ζ+k3Θ≤-k5m1m2-12ve2λ2-k3k4sin2⁡eφ+σ,where σ is an arbitrary bounded infinitesimal constant, so the system (ve,eφ) is bounded.


### 3.2. Dynamics Controls

The virtual controlsuFv and rFv are proposed; then the dynamics controls should be designed to generate torque controls τuF and τrF for the followers to make the vessels achieve the desired formation.Step 1.
Define the velocity error in surge asue=uF-uFv, and define the CLF as V3=1/2ue2; then we can get V˙3=ue(m2/m1vFrF-d1/m1uF+1/m1τuF-u˙Fv).
So the torque controlτuF can be chosen as(22)τuF=m1-k6ue-m2m1vFrF+d1m1uF+u˙Fv,k6>0∈R.Then V˙3=-k6ue2≤0.Step 2.
Define the angle velocity error asre=rF-rFv, and define the CLF as V4=1/2re2; then the time derivative of V4 is given by(23)V˙4=rem1-m2m3uFvF-d3m3rF+1m3τrF-r˙Fv.So we can choose the torque control τrF as(24)τrF=m3-k7re-m1-m2m3uFvF+d3m3rF+r˙Fv,k7>0∈R.Then V˙4=-k7re2≤0.
Define a CLF as(25)V5=V1+V2+12re2+12ue2,and then the time derivative of V5 is given by(26)V˙5=V˙1+V˙2+rer˙e+ueu˙e=ε1ε˙1+ε2ε˙2+vev˙e+k3rL-rFsin⁡eφ+rer˙e+ueu˙e=ε1uF+ξ1cos⁡eφ-ξ2sin⁡eφ+ε2vF+ξ1sin⁡eφ+ξ2cos⁡eφ+vem1m2-1λrF-d2m2ζ+λrL-ξ˙1sin⁡eφ-ξ˙2cos⁡eφ+k3rLsin⁡eφ-k3rFsin⁡eφ+rem1-m2m3uFvF-d3m3rF+1m3τrF-r˙Fv+uem2m1vFrF-d1m1uF+1m1τuF-u˙Fv.Substituting (12), (13), (19), (22), and (24) into V˙5, we can get(27)V˙5=-k1ε12-k2ε22-k5m1m2-12ve2λ2-k3k4sin2⁡eφ+veλm1rLm2+m1m2-1k4+k3k5sin⁡eφ-ξ˙1sin⁡eφ-ξ˙2cos⁡eφ-d2ζm2+vem1m2-1λ-k3sin⁡eφΘ-k6ue2-k7re2≤-k1ε12-k2ε22-k5m1m2-12ve2λ2-k3k4sin2⁡eφ-k6ue2-k7re2+σ,where σ is an arbitrary bounded infinitesimal constant, so the control system (ε1,ε2,ve,eφ,ue,re) is asymptotically stable.


### 3.3. Sensing Field Remapping

In this research, each USV is equipped with a vision-based sensor which has a sector-like sensing field. In some cases leader will be out of the follower’s sensing field such as turning and leader decelerating suddenly. Once this happens, followers will lose the leader’s information. In particular, when the leader moves to the border of the follower’s sensor, the formation will be lost easily.There can be three ways to solve this problem. The first one is position errors remapping. When the leader is moving close to the border of the follower’s sensor, we adjust the formation position errors; that is to say, we change the follower’s position to ensure the sensing angle being not too close to the sensor’s border. So the formation will be maintained. The second one is Heading Angle Error Remapping. When the leader is at or near the border of the follower’s sensor, we adjust the follower’s heading angle error; that is to say, control the follower to turn so as to ensure the sensing angle being not too close to the sensor’s border. The third one is Position Errors Remapping and Heading Angle Error Remapping. This method uses the above two methods in cascade. Next how to design the three methods is shown in detail.


#### 3.3.1. The First Method: Position Errors Remapping (PER)

According to Assumption2, we know that the position errors are measured by the on-board vision-based sensor. If the sensing angle αL is changed, the position errors will be changed at the same time. Here we design an exponential remapping method (ERM) to adjust the sensing angle αL.Define ERM as(28)KαLFiRe≔Me·esignαLFi·Kα·αLFi-1+Ne,where αLFi is the actual sensing angle of the follower i relative to the leader, Me and Kα are the weights of ERM, and Ne is the remapping deviation set value. So the remapping sensing angle αLFiRe is defined as(29)αLFiRe≔αLFi·KαLFiRe.In this research, we assume the border of the follower’s sensor is±60°; that is to say, the sensing constraint 2α=120°, αLFi∈[-60°,60°]. Choose Me=1/3600,Kα=1/8,Ne=1, we can make a figure using (29) to show the remapping relationship between the actual sensing angle αLFi and the remapping sensing angle αLFiRe. Figure 4 shows the sensing angle remapping relationship.Figure 4
Sensing angle remapping relationship.NextαLFiRe is used as the feedback sensing angle instead of the actual sensing angle, so the position errors are changed; then the follower must adjust its position to converge to zero. Figure 5 shows the position adjusting of the follower.Figure 5
Follower positon adjustment.From Figure5, we can get αLFi=-φFi+βi+Ξ, where βi=atan⁡(ΔYi/ΔXi),βi∈(-π/2,0)∪(0,π/2), (30)Ξi=0,ΔXi>0,signΔYi·π2+π,ΔXi=0,π,ΔXi<0 and ΔXi=XL-XFi, ΔYi=YL-YFi.The follower in Figure5 is moving at position Fi; the sensing angle is αLFi. However, at this time, the feedback sensing angle is αLFiRe, which is greater than αLFi, so the follower will change its position to make sensing angle be a smaller sensing angle αLFi′. From Figure 5 we can see that there are many positions for the follower to achieve the sensing angle αLFi′ as long as the follower is on the line lLFiRe. For example, the sensing angle αLFi′ will be achieved when the follower moves at positons 1~, 2~, 3~, and 4~, and so forth. However, moving to position 3~ is the only shortest path, so we choose the shortest path to do the position errors remapping. Because of remapping sensing angle αLFiRe, we can get σi=αLFi-αLFiRe.The follower adjusts its position from positionFi to position 3~, and we choose lFi-3~ to denote the distance between position Fi and position 3~. From Figure 5 we can see that ΔXiRe and ΔYiRe are the projections of lFi-3~ along X-axis and Y-axis; they are calculated as follows:(31)ΔXiRe=sin⁡βi-σi·lFi-3~=sin⁡φFi-Ξi+αLFiRe·lFi-3~=sin⁡φFi-Ξi+αLFiRe·sin⁡αLFi-αLFiRe·lLFiΔYiRe=cos⁡βi-σi·lFi-3~=cos⁡φFi-Ξi+αLFiRe·lFi-3~=cos⁡φFi-Ξi+αLFiRe·sin⁡αLFi-αLFiRe·lLFi.So the projections along X-axis and Y-axis of remapping distance lLFiRe are(32)ΔXL-FiRe=ΔXL-Fi+signΔXL-Fi·ΔXiReΔYL-FiRe=ΔYL-Fi-signΔXL-Fi·ΔYiRe.Using an Euler angle rotation matrix, we can get the formation remapping position as (33)lxiRelyiRe=cos⁡φL-sin⁡φLsin⁡φLcos⁡φLΔXL-FiReΔYL-FiRe=ΔXL-FiRecos⁡φL-ΔYL-FiResin⁡φLΔXL-FiResin⁡φL+ΔYL-FiRecos⁡φL.So formation error from (6) can be written as the remapping form: (34)ERe=exiReeyiRe=lxiRe-lxdlyiRe-lyd.Using this position remapping error as the feedback error to control the formation system will ensure that the formation is being stable and make the follower move along the shortest path to the remapping position, which will help the system get one optimal formation structure under the sensing constraints.


#### 3.3.2. The Second Method: Heading Angle Error Remapping (HAER)

According to (7), the follower should track the yaw angle with the leader. If the leader’s heading angle changes, the follower’s heading angle will track the error change. So when the leader is at or near the border of the follower’s sensor, we change the leader’s feedback yaw angle, and the follower will turn its heading so as to ensure the sensing angle is not too close to the sensor’s border. Here we design an exponential remapping method (ERM) to adjust the yaw angle φL of the leader.Define ERM as(35)KφLRe≔0,αLFi≤αLFi0signαLFi·exp⁡signαLFi·Kyaw·αLFi-signαLFi·αLFi0-1,αLFi0≤αLFi≤αLFimax,where αLFi is the actual sensing angle of the follower i relative to the leader, Kyaw is the weight of ERM, αLFi0 is the given safe sensing angle, abd αLFimax is max sensing angle. So the remapping heading angle is defined as(36)φLRe≔φL+KφLRe.So heading angle error from (7) can be wrote as the remapping form:(37)eφ=φLRe-φF.Using this heading angle remapping error as the feedback error to control the formation system will keep the follower being sensing with the leader.In this research, we assume the border of the follower’s sensor is±60°; that is to say, the sensing constraint 2α=120°, αLFi∈[-60°,60°], αLFimax=60°. Choosing Kyaw=0.185, αLFi0=45°, we can make a figure (Figure 6) using (36) to show the remapping relationship between the actual sensing angle αLFi and the remapping value KφLRe.Figure 6
Relationship between actual sensing angle and remapping value.


#### 3.3.3. The Third Method: Position Errors Remapping and Heading Angle Error Remapping (PER&HAER)

This method uses the above two methods in cascade.


## 3.1. Virtual Controls

Define the formation position errors inx and y directions as(6)E=exey=lx-lxdly-lyd.Combining (4), (5), and (6), then the error dynamics of the system are given as(7)e˙xe˙ye˙φ=l˙x-l˙xdl˙y-l˙ydφ˙L-φ˙F=-uFcos⁡eφ-vFsin⁡eφ+eyφ˙L+uL+lydφ˙L-l˙xduFsin⁡eφ-vFcos⁡eφ-exφ˙L+vL-lxdφ˙L-l˙ydrL-rF.The followers are the controlled objects; however, we note that the formation position errorE is in the leader’s body-fixed frame. So using an Euler angle rotation matrix, we can get the formation position error Σ as(8)Σ=ε1ε2=cos⁡eφ-sin⁡eφsin⁡eφcos⁡eφE.Then we can get (9)ε˙1ε˙2=uF+ξ1cos⁡eφ-ξ2sin⁡eφ+ε2rFvF+ξ1sin⁡eφ+ξ2cos⁡eφ-ε1rF,where ξ1=-uL+lydφ˙L-l˙xd,  ξ2=-vL-lxdφ˙L-l˙yd.Step 1.
Define the control Lyapunov function (CLF):(10)V1=12ε12+12ε22,whose time derivative combined with (9) is given by (11)V˙1=ε1ε˙1+ε2ε˙2=ε1uF+ξ1cos⁡eφ-ξ2sin⁡eφ+ε2vF+ξ1sin⁡eφ+ξ2cos⁡eφ.Choose the kinematics virtual control law as(12)uFv=-k1ε1-ξ1cos⁡eφ+ξ2sin⁡eφ,(13)vFv=-k2ε2-ξ1sin⁡eφ-ξ2cos⁡eφ,where k1,k2>0∈R.
Then (11) becomes(14)V˙1=-k1ε12-k2ε22≤0.So the system Σ is asymptotically stable.Step 2.
Define the sway velocity error asve=vF-vFv, whose time derivative combined with (2) and (13) is given by(15)v˙e=v˙F-v˙Fv=-d2m2vF-m1m2k1ε1rF+m1m2ξ1cos⁡eφrF-m1m2ξ2sin⁡eφrF+k2vF-k2ξ1sin⁡eφ-k2ξ2cos⁡eφ-k2ε1rF-ξ˙1sin⁡eφ-ξ˙2cos⁡eφ-ξ1cos⁡eφe˙φ+ξ2sin⁡eφe˙φ.Choosing k1=d2/m1 and k2=d2/m2, then (15) becomes(16)v˙e=m1m2-1ξ2sin⁡eφ-ξ1cos⁡eφrF-d2m2ξ1sin⁡eφ+ξ2cos⁡eφ+ξ2sin⁡eφ-ξ1cos⁡eφrL-ξ˙1sin⁡eφ-ξ˙2cos⁡eφ.Define the control Lyapunov function (CLF):(17)V2=12ve2+2k3sin2⁡eφ2,k3>0∈R.Then we get the time derivative of (17), giving(18)V˙2=vev˙e+k3rL-rFsin⁡eφ=vem1m2-1λrF-d2m2ζ+λrL-ξ˙1sin⁡eφ-ξ˙2cos⁡eφ+k3rLsin⁡eφ-k3rFsin⁡eφ,where λ=ξ2sin⁡eφ-ξ1cos⁡eφ,  ζ=ξ1sin⁡eφ+ξ2cos⁡eφ.
Choose the virtual control:(19)rFv=rL+k4sin⁡eφ-k5m1m2-1veλ+Θ,where(20)Θ=-sgn⁡vek4+k3k5m1/m2-1+d2/m2ζm1/m2-1ζ+k3.Then (18) becomes(21)V˙2=-k5m1m2-12ve2λ2-k3k4sin2⁡eφ+veλm1rLm2+m1m2-1k4+k3k5sin⁡eφ-ξ˙1sin⁡eφ-ξ˙2cos⁡eφ-d2ζm2+vem1m2-1λ-k3sin⁡eφΘ≤-k5m1m2-12ve2λ2-k3k4sin2⁡eφ+veζrLm1m2+m1m2-1k4+k3k5+d2m2+ξ˙1+ξ˙2+vem1m2-1ζ+k3Θ≤-k5m1m2-12ve2λ2-k3k4sin2⁡eφ+σ,where σ is an arbitrary bounded infinitesimal constant, so the system (ve,eφ) is bounded.


## 3.2. Dynamics Controls

The virtual controlsuFv and rFv are proposed; then the dynamics controls should be designed to generate torque controls τuF and τrF for the followers to make the vessels achieve the desired formation.Step 1.
Define the velocity error in surge asue=uF-uFv, and define the CLF as V3=1/2ue2; then we can get V˙3=ue(m2/m1vFrF-d1/m1uF+1/m1τuF-u˙Fv).
So the torque controlτuF can be chosen as(22)τuF=m1-k6ue-m2m1vFrF+d1m1uF+u˙Fv,k6>0∈R.Then V˙3=-k6ue2≤0.Step 2.
Define the angle velocity error asre=rF-rFv, and define the CLF as V4=1/2re2; then the time derivative of V4 is given by(23)V˙4=rem1-m2m3uFvF-d3m3rF+1m3τrF-r˙Fv.So we can choose the torque control τrF as(24)τrF=m3-k7re-m1-m2m3uFvF+d3m3rF+r˙Fv,k7>0∈R.Then V˙4=-k7re2≤0.
Define a CLF as(25)V5=V1+V2+12re2+12ue2,and then the time derivative of V5 is given by(26)V˙5=V˙1+V˙2+rer˙e+ueu˙e=ε1ε˙1+ε2ε˙2+vev˙e+k3rL-rFsin⁡eφ+rer˙e+ueu˙e=ε1uF+ξ1cos⁡eφ-ξ2sin⁡eφ+ε2vF+ξ1sin⁡eφ+ξ2cos⁡eφ+vem1m2-1λrF-d2m2ζ+λrL-ξ˙1sin⁡eφ-ξ˙2cos⁡eφ+k3rLsin⁡eφ-k3rFsin⁡eφ+rem1-m2m3uFvF-d3m3rF+1m3τrF-r˙Fv+uem2m1vFrF-d1m1uF+1m1τuF-u˙Fv.Substituting (12), (13), (19), (22), and (24) into V˙5, we can get(27)V˙5=-k1ε12-k2ε22-k5m1m2-12ve2λ2-k3k4sin2⁡eφ+veλm1rLm2+m1m2-1k4+k3k5sin⁡eφ-ξ˙1sin⁡eφ-ξ˙2cos⁡eφ-d2ζm2+vem1m2-1λ-k3sin⁡eφΘ-k6ue2-k7re2≤-k1ε12-k2ε22-k5m1m2-12ve2λ2-k3k4sin2⁡eφ-k6ue2-k7re2+σ,where σ is an arbitrary bounded infinitesimal constant, so the control system (ε1,ε2,ve,eφ,ue,re) is asymptotically stable.


## 3.3. Sensing Field Remapping

In this research, each USV is equipped with a vision-based sensor which has a sector-like sensing field. In some cases leader will be out of the follower’s sensing field such as turning and leader decelerating suddenly. Once this happens, followers will lose the leader’s information. In particular, when the leader moves to the border of the follower’s sensor, the formation will be lost easily.There can be three ways to solve this problem. The first one is position errors remapping. When the leader is moving close to the border of the follower’s sensor, we adjust the formation position errors; that is to say, we change the follower’s position to ensure the sensing angle being not too close to the sensor’s border. So the formation will be maintained. The second one is Heading Angle Error Remapping. When the leader is at or near the border of the follower’s sensor, we adjust the follower’s heading angle error; that is to say, control the follower to turn so as to ensure the sensing angle being not too close to the sensor’s border. The third one is Position Errors Remapping and Heading Angle Error Remapping. This method uses the above two methods in cascade. Next how to design the three methods is shown in detail.


### 3.3.1. The First Method: Position Errors Remapping (PER)

According to Assumption2, we know that the position errors are measured by the on-board vision-based sensor. If the sensing angle αL is changed, the position errors will be changed at the same time. Here we design an exponential remapping method (ERM) to adjust the sensing angle αL.Define ERM as(28)KαLFiRe≔Me·esignαLFi·Kα·αLFi-1+Ne,where αLFi is the actual sensing angle of the follower i relative to the leader, Me and Kα are the weights of ERM, and Ne is the remapping deviation set value. So the remapping sensing angle αLFiRe is defined as(29)αLFiRe≔αLFi·KαLFiRe.In this research, we assume the border of the follower’s sensor is±60°; that is to say, the sensing constraint 2α=120°, αLFi∈[-60°,60°]. Choose Me=1/3600,Kα=1/8,Ne=1, we can make a figure using (29) to show the remapping relationship between the actual sensing angle αLFi and the remapping sensing angle αLFiRe. Figure 4 shows the sensing angle remapping relationship.Figure 4
Sensing angle remapping relationship.NextαLFiRe is used as the feedback sensing angle instead of the actual sensing angle, so the position errors are changed; then the follower must adjust its position to converge to zero. Figure 5 shows the position adjusting of the follower.Figure 5
Follower positon adjustment.From Figure5, we can get αLFi=-φFi+βi+Ξ, where βi=atan⁡(ΔYi/ΔXi),βi∈(-π/2,0)∪(0,π/2), (30)Ξi=0,ΔXi>0,signΔYi·π2+π,ΔXi=0,π,ΔXi<0 and ΔXi=XL-XFi, ΔYi=YL-YFi.The follower in Figure5 is moving at position Fi; the sensing angle is αLFi. However, at this time, the feedback sensing angle is αLFiRe, which is greater than αLFi, so the follower will change its position to make sensing angle be a smaller sensing angle αLFi′. From Figure 5 we can see that there are many positions for the follower to achieve the sensing angle αLFi′ as long as the follower is on the line lLFiRe. For example, the sensing angle αLFi′ will be achieved when the follower moves at positons 1~, 2~, 3~, and 4~, and so forth. However, moving to position 3~ is the only shortest path, so we choose the shortest path to do the position errors remapping. Because of remapping sensing angle αLFiRe, we can get σi=αLFi-αLFiRe.The follower adjusts its position from positionFi to position 3~, and we choose lFi-3~ to denote the distance between position Fi and position 3~. From Figure 5 we can see that ΔXiRe and ΔYiRe are the projections of lFi-3~ along X-axis and Y-axis; they are calculated as follows:(31)ΔXiRe=sin⁡βi-σi·lFi-3~=sin⁡φFi-Ξi+αLFiRe·lFi-3~=sin⁡φFi-Ξi+αLFiRe·sin⁡αLFi-αLFiRe·lLFiΔYiRe=cos⁡βi-σi·lFi-3~=cos⁡φFi-Ξi+αLFiRe·lFi-3~=cos⁡φFi-Ξi+αLFiRe·sin⁡αLFi-αLFiRe·lLFi.So the projections along X-axis and Y-axis of remapping distance lLFiRe are(32)ΔXL-FiRe=ΔXL-Fi+signΔXL-Fi·ΔXiReΔYL-FiRe=ΔYL-Fi-signΔXL-Fi·ΔYiRe.Using an Euler angle rotation matrix, we can get the formation remapping position as (33)lxiRelyiRe=cos⁡φL-sin⁡φLsin⁡φLcos⁡φLΔXL-FiReΔYL-FiRe=ΔXL-FiRecos⁡φL-ΔYL-FiResin⁡φLΔXL-FiResin⁡φL+ΔYL-FiRecos⁡φL.So formation error from (6) can be written as the remapping form: (34)ERe=exiReeyiRe=lxiRe-lxdlyiRe-lyd.Using this position remapping error as the feedback error to control the formation system will ensure that the formation is being stable and make the follower move along the shortest path to the remapping position, which will help the system get one optimal formation structure under the sensing constraints.


### 3.3.2. The Second Method: Heading Angle Error Remapping (HAER)

According to (7), the follower should track the yaw angle with the leader. If the leader’s heading angle changes, the follower’s heading angle will track the error change. So when the leader is at or near the border of the follower’s sensor, we change the leader’s feedback yaw angle, and the follower will turn its heading so as to ensure the sensing angle is not too close to the sensor’s border. Here we design an exponential remapping method (ERM) to adjust the yaw angle φL of the leader.Define ERM as(35)KφLRe≔0,αLFi≤αLFi0signαLFi·exp⁡signαLFi·Kyaw·αLFi-signαLFi·αLFi0-1,αLFi0≤αLFi≤αLFimax,where αLFi is the actual sensing angle of the follower i relative to the leader, Kyaw is the weight of ERM, αLFi0 is the given safe sensing angle, abd αLFimax is max sensing angle. So the remapping heading angle is defined as(36)φLRe≔φL+KφLRe.So heading angle error from (7) can be wrote as the remapping form:(37)eφ=φLRe-φF.Using this heading angle remapping error as the feedback error to control the formation system will keep the follower being sensing with the leader.In this research, we assume the border of the follower’s sensor is±60°; that is to say, the sensing constraint 2α=120°, αLFi∈[-60°,60°], αLFimax=60°. Choosing Kyaw=0.185, αLFi0=45°, we can make a figure (Figure 6) using (36) to show the remapping relationship between the actual sensing angle αLFi and the remapping value KφLRe.Figure 6
Relationship between actual sensing angle and remapping value.


### 3.3.3. The Third Method: Position Errors Remapping and Heading Angle Error Remapping (PER&HAER)

This method uses the above two methods in cascade.


## 3.3.1. The First Method: Position Errors Remapping (PER)

According to Assumption2, we know that the position errors are measured by the on-board vision-based sensor. If the sensing angle αL is changed, the position errors will be changed at the same time. Here we design an exponential remapping method (ERM) to adjust the sensing angle αL.Define ERM as(28)KαLFiRe≔Me·esignαLFi·Kα·αLFi-1+Ne,where αLFi is the actual sensing angle of the follower i relative to the leader, Me and Kα are the weights of ERM, and Ne is the remapping deviation set value. So the remapping sensing angle αLFiRe is defined as(29)αLFiRe≔αLFi·KαLFiRe.In this research, we assume the border of the follower’s sensor is±60°; that is to say, the sensing constraint 2α=120°, αLFi∈[-60°,60°]. Choose Me=1/3600,Kα=1/8,Ne=1, we can make a figure using (29) to show the remapping relationship between the actual sensing angle αLFi and the remapping sensing angle αLFiRe. Figure 4 shows the sensing angle remapping relationship.Figure 4
Sensing angle remapping relationship.NextαLFiRe is used as the feedback sensing angle instead of the actual sensing angle, so the position errors are changed; then the follower must adjust its position to converge to zero. Figure 5 shows the position adjusting of the follower.Figure 5
Follower positon adjustment.From Figure5, we can get αLFi=-φFi+βi+Ξ, where βi=atan⁡(ΔYi/ΔXi),βi∈(-π/2,0)∪(0,π/2), (30)Ξi=0,ΔXi>0,signΔYi·π2+π,ΔXi=0,π,ΔXi<0 and ΔXi=XL-XFi, ΔYi=YL-YFi.The follower in Figure5 is moving at position Fi; the sensing angle is αLFi. However, at this time, the feedback sensing angle is αLFiRe, which is greater than αLFi, so the follower will change its position to make sensing angle be a smaller sensing angle αLFi′. From Figure 5 we can see that there are many positions for the follower to achieve the sensing angle αLFi′ as long as the follower is on the line lLFiRe. For example, the sensing angle αLFi′ will be achieved when the follower moves at positons 1~, 2~, 3~, and 4~, and so forth. However, moving to position 3~ is the only shortest path, so we choose the shortest path to do the position errors remapping. Because of remapping sensing angle αLFiRe, we can get σi=αLFi-αLFiRe.The follower adjusts its position from positionFi to position 3~, and we choose lFi-3~ to denote the distance between position Fi and position 3~. From Figure 5 we can see that ΔXiRe and ΔYiRe are the projections of lFi-3~ along X-axis and Y-axis; they are calculated as follows:(31)ΔXiRe=sin⁡βi-σi·lFi-3~=sin⁡φFi-Ξi+αLFiRe·lFi-3~=sin⁡φFi-Ξi+αLFiRe·sin⁡αLFi-αLFiRe·lLFiΔYiRe=cos⁡βi-σi·lFi-3~=cos⁡φFi-Ξi+αLFiRe·lFi-3~=cos⁡φFi-Ξi+αLFiRe·sin⁡αLFi-αLFiRe·lLFi.So the projections along X-axis and Y-axis of remapping distance lLFiRe are(32)ΔXL-FiRe=ΔXL-Fi+signΔXL-Fi·ΔXiReΔYL-FiRe=ΔYL-Fi-signΔXL-Fi·ΔYiRe.Using an Euler angle rotation matrix, we can get the formation remapping position as (33)lxiRelyiRe=cos⁡φL-sin⁡φLsin⁡φLcos⁡φLΔXL-FiReΔYL-FiRe=ΔXL-FiRecos⁡φL-ΔYL-FiResin⁡φLΔXL-FiResin⁡φL+ΔYL-FiRecos⁡φL.So formation error from (6) can be written as the remapping form: (34)ERe=exiReeyiRe=lxiRe-lxdlyiRe-lyd.Using this position remapping error as the feedback error to control the formation system will ensure that the formation is being stable and make the follower move along the shortest path to the remapping position, which will help the system get one optimal formation structure under the sensing constraints.


## 3.3.2. The Second Method: Heading Angle Error Remapping (HAER)

According to (7), the follower should track the yaw angle with the leader. If the leader’s heading angle changes, the follower’s heading angle will track the error change. So when the leader is at or near the border of the follower’s sensor, we change the leader’s feedback yaw angle, and the follower will turn its heading so as to ensure the sensing angle is not too close to the sensor’s border. Here we design an exponential remapping method (ERM) to adjust the yaw angle φL of the leader.Define ERM as(35)KφLRe≔0,αLFi≤αLFi0signαLFi·exp⁡signαLFi·Kyaw·αLFi-signαLFi·αLFi0-1,αLFi0≤αLFi≤αLFimax,where αLFi is the actual sensing angle of the follower i relative to the leader, Kyaw is the weight of ERM, αLFi0 is the given safe sensing angle, abd αLFimax is max sensing angle. So the remapping heading angle is defined as(36)φLRe≔φL+KφLRe.So heading angle error from (7) can be wrote as the remapping form:(37)eφ=φLRe-φF.Using this heading angle remapping error as the feedback error to control the formation system will keep the follower being sensing with the leader.In this research, we assume the border of the follower’s sensor is±60°; that is to say, the sensing constraint 2α=120°, αLFi∈[-60°,60°], αLFimax=60°. Choosing Kyaw=0.185, αLFi0=45°, we can make a figure (Figure 6) using (36) to show the remapping relationship between the actual sensing angle αLFi and the remapping value KφLRe.Figure 6
Relationship between actual sensing angle and remapping value.


## 3.3.3. The Third Method: Position Errors Remapping and Heading Angle Error Remapping (PER&HAER)

This method uses the above two methods in cascade.


## 4. Simulation and Discussion

To demonstrate the effectiveness of the control scheme proposed for leader-follower formation control of USVs with vision-based sensing constraints, several computer simulations are performed. Three USVs with the same parameters are chosen and modeled. The vehicles’ parameters are(38)m1=120×103kg,m2=217.9×103kg,m3=636×105kg,d1=215×102kg·s-1,d2=117×103kg·s-1,d3=802×104kg·s-1,which are taken from [37]. First, three methods proposed in Section 3 are simulated, respectively. Second, we make comparisons and analysis of the three methods. Last, a triangular formation of three USVs is simulated using the best one of the three methods.


### 4.1. Several Cases Results

Three cases of simulation are done in this section. The border of the follower’s sensor is set as±60°, that is to say the sensing constraint 2α=120°, sensing angle αLFi∈[-60°,60°], and the max sensing angle αLFimax=60°. We choose two USVs to do the simulations; one of them is used as the leader, and another one is the follower. The desired formation is chosen as FLF1d=lLF1dλLF1dT=20,2π/3T. It is easy to know that the sensing angle αLF1 is expected to converge to -60° when λLF1d is chosen as 2π/3. However the sensing field is limited between -60° and 60°; this means the leader is at the border of the follower’s sensing field, which is dangerous for the formation. So we use this desired formation to demonstrate the proposed control strategies. Other parameters of PER and HAER are chosen according to Section 3.3.Case 1 (position errors remapping (PER)).
In this case, the initial positions of the vehicles are chosen asLeader: [XL,YL]=[0,0],Follower: [XF1,YF1]=[-40,50]. And the initial velocities are chosen asLeader: uL=1m/s, vL=0m/s, rL=0rad/s;Follower: [uF1,vF1,rF1]=[0,0,0].The simulation results are shown in Figures7 and 8. The formation trajectories of the two USVs using PER are shown in Figure 7, and Figure 8 shows the sensing angle of follower 1 relative to the leader using PER. The total simulation time is 1000 seconds. The leader’s yaw angle velocity and the surge velocity are assumed to remain unchanged during the simulation. αLFiRe from (28) is set to be 0 before 300th second, which means before 300th PER does not work. After 300th second, the PER begins to work.Figure 7
Formation trajectories using PER.Figure 8
Sensing angle of follower 1 relative to the leader using PER.From the simulation results, we can see that, before the PER works, the formation converges to be stable, and the sensing angle is stabilized at-60°, which is not safe for keeping the formation. At 300th second, the PER begins to work; under the control of PER, the formation shrinks; however, the sensing angle converges to be around -48°, which will make the formation be more safe and stable.Case 2 (heading angle error remapping (HAER)).
In this case, the initial positions of the vehicles are chosen as follows:Leader: [XL,YL]=[0,0],Follower: [XF1,YF1]=[-40,50]
The initial velocities are as follows:Leader: uL=1m/s, vL=0m/s, rL=0rad/sFollower: [uF1,vF1,rF1]=[0,0,0]
The given safe sensing angleαLF10 is 45°.The simulation results are shown in Figures9 and 10. The formation trajectories of the two USVs using HAER are shown in Figure 9, and Figure 10 shows the sensing angle of follower 1 relative to the leader using HAER. The total simulation time is 1000 seconds. The leader’s yaw angle velocity and the surge velocity are assumed to remain unchanged during the simulation. KφLRe from (35) is set to be 0 before 300th second, which means before 300th HAER does not work. After 300th second, the HAER begins to work.Figure 9
Formation trajectories using HAER.Figure 10
Sensing angle of follower 1 relative to the leader using HAER.From the simulation results, we can see that, before the HAER works, the formation converges to be stable, and the sensing angle is stabilized at-60°, which is not safe for keeping the formation. At 300th second, the HAER begins to work; under the control of HAER, the formation shrinks; however the sensing angle converges to the desired safe sensing angle -45°, which will ensure that the follower keeps sensing with the leader.Case 3 (double remapping (PER&HAER)).
This case uses the above two methods PER and HAER in cascade. All of the parameters are the same as those in Cases1 and 2.The simulation results are shown in Figures11 and 12. The formation trajectories of the two USVs using double remapping PER&HAER are shown in Figure 11, and Figure 12 shows the sensing angle of follower 1 relative to the leader. The total simulation time is 1000 seconds. αLFiRe from (28) and KφLRe from (35) are set to be 0 before 300th second, which means before 300th PER&HAER does not work. After 300th second, the double remapping begins to work.Figure 11
Formation trajectories using PER&HAER.Figure 12
Sensing angle of follower 1 relative to the leader using PER&HAER.From the simulation results, we can see that the formation shrinks after PER&HAER works, and the sensing angle converges to be around-55°, which will ensure that the follower keeps sensing with the leader.


### 4.2. Comparison and Analysis

The differences between the above three cases are shown in this section. Next we will make some comparisons in three ways to analyze the characteristics and effectiveness of the three different methods.


#### 4.2.1. Convergence Rate

Figure13 shows the comparison of formation trajectories. All the four formation trajectories are able to converge to be stable. However, after 300th second, the ERM begins to work, the formation convergence rate is the slowest using HAER. The formation convergence rates using PER and PER&HAER are close. But there exists overshoot using PER. Compared with “no remapping” formation trajectory, the formation trajectory using HAER shrinks more than the formation trajectories using PER&HAER and PER, which means its formation is worst. There is little difference between PER&HAER trajectory and PER trajectory, and the two methods are better than HAER.Figure 13
Comparison of formation trajectories.


#### 4.2.2. Safety

The simulation results of sensing angle shown together in Figure14. From Figure 13 we know that all the four formation trajectories converge to be stable. So the sensing angles are also stable in the end. In this research, the border of the follower’s sensor is ±60°. Figure 14 shows that under no remapping the sensing angle is stabilized at -60°, and this is dangerous for the formation. And the sensing angles converge to be around -45°, -48°, and -54° using HAER, PER, and PER&HAER, respectively, whose absolute values are smaller than the sensing border angle, so they can ensure that the follower keeps sensing with the leader. We can see that all the three remapping methods can be able to adjust the sensing angle. The sensing angle is safest using HAER method, but it has a slow convergence. The other two methods can converge quickly. However the sensing angle has negative overshoot using PER and, during 300th second and 320th second the sensing angle, is beyond -60°, which means the worst situation happens: vision lost. Thus PER&HAER achieves the best result.Figure 14
Comparison of sensing angles.


#### 4.2.3. Formation Errors

The core idea of ERM is to design a remapping error as the feedback for the control. It controls the followers to change their positions to converge to the remapping errors rather than the actual errors. So there must be actual steady-state errors. Figures15 and 16 show the formation errors in lx direction and ly direction. The steady formation error in ly direction using PER is smallest compared with the errors using HAER and PER&HAER; however, it achieves the biggest error in lx direction. The steady formation error in lx direction using HAER achieves the smallest value compared with the errors using PER and PER&HAER; however, it is biggest in ly direction. Compared with the errors in lx direction and ly direction using PER and HAER, the PER&HAER method achieves the best formation error. However there is also yaw angle steady-state error using PER&HAER, which is shown in Figure 17.Figure 15
Comparison of formation errors inlx direction.Figure 16
Comparison of formation errors inly direction.Figure 17
Comparison of yaw tracking errors.According to the above comparisons from Figures13–17, we can see all the three methods can be able to deal with the sensing constraints problem; however there exist different effects. The HAER method can be able to achieve a safest formation ensuring the follower keeping sensing with the leader; however its convergence speed is slow, and the steady-state formation error in ly direction is biggest. The advantage of PER is that it can be able to make the follower reach its remapping position along an optimal path; however its remapping sensing angle has undershoot and the steady-state formation error in lx direction is biggest. The PER&HAER method owns the advantages of the other two methods, so PER&HAER is the best one.


### 4.3. Three USVs Simulation Results

According to the proposed ERM, the intensity of remapping result is decided by the EPM parameters. The more intense the remapping is, the safer the formation will be, but the more errors the formation will achieve. Though all the three methods may achieve the best formation, PER and HAER have their own disadvantages, which are undershoot and slow convergence. Considering the comparisons from the three methods, PER&HAER method which is better than the other two methods is chosen. A triangular formation of three USVs is simulated here using PER&HAER. The initial positions of the vehicles are chosen asLeader: [XL,YL]=[0,0],Follower 1: [XF1,YF1]=[-40,50],Follower 2: [XF2,YF2]=[-40,-50]. The initial velocities are as follows.Leader:uL=1m/s, vL=0m/s, rL=0rad/s (during the simulation time 0~200 s), rL=0.01rad/s (during the simulation time 200~260s), rL=-0.01rad/s (during the simulation time 260~410 s), rL=0.01rad/s (during the simulation time 410~550 s), rL=0rad/s (during the simulation time 550~1000 s).Follower 1:[uF1,vF1,rF1]=[0,0,0], Follower 2: [uF2,vF2,rF2]=[0,0,0]. The other parameters are set to be the same as in Section 4.1. The total simulation time is 1000 seconds; the leader’s initial angle velocity in yaw is set to be 0rad/s before 200th second, and changes to 0.01rad/s at 200th second, then turns to -0.01rad/s at 260th second, turns to be 0.01rad/s again at 410th second, and keeps 0rad/s during 550th to the end. The surge velocity of the leader is assumed to remain unchanged during the simulation.Two simulations were done: one is the triangular formation control simulation which did not use the PER&HAER method and another one used PER&HAER. Figure18 shows the triangular formation trajectories using no remapping method. We can see that the formation collapses after around 230th second. This is because of the leader’s turning which results in the fact that it moves out of the follower’s sensing field and losing the leader’s information.Figure 18
Triangular formation trajectories using no remapping method.Figure19 shows the triangular formation trajectories using PER&HAER; the formation converges to be stable. And the sensing angles of the two followers relative to the leader using PER&HAER are shown in Figure 20. We can see that in Figure 20(a) follower 1’s sensing angle converges to be around -48.5°, and in Figure 20(b) follower 2’s sensing angle is around 48.5°, all of which are not beyond the sensing constraint angle.Figure 19
Triangular formation trajectories using PER&HAER.Figure 20
Sensing angles of two followers relative to the leader using PER&HAER.
(a)
(b)As one can see, the USVs achieve the stable formation successfully for both straight-line and curved-line paths. And the followers keep sensing with the leader effectively. This means that PER&HAER works well. Triangular formation errors using PER&HAER are shown in Figure21, which can be able to converge to be stable. Therefore, from the simulation results, one can see that the proposed control system is effective in achieving the stable formation dealing with sensing constraints.Figure 21
Triangular formation errors using PER&HAER.
(a)
(b)
(c)


## 4.1. Several Cases Results

Three cases of simulation are done in this section. The border of the follower’s sensor is set as±60°, that is to say the sensing constraint 2α=120°, sensing angle αLFi∈[-60°,60°], and the max sensing angle αLFimax=60°. We choose two USVs to do the simulations; one of them is used as the leader, and another one is the follower. The desired formation is chosen as FLF1d=lLF1dλLF1dT=20,2π/3T. It is easy to know that the sensing angle αLF1 is expected to converge to -60° when λLF1d is chosen as 2π/3. However the sensing field is limited between -60° and 60°; this means the leader is at the border of the follower’s sensing field, which is dangerous for the formation. So we use this desired formation to demonstrate the proposed control strategies. Other parameters of PER and HAER are chosen according to Section 3.3.Case 1 (position errors remapping (PER)).
In this case, the initial positions of the vehicles are chosen asLeader: [XL,YL]=[0,0],Follower: [XF1,YF1]=[-40,50]. And the initial velocities are chosen asLeader: uL=1m/s, vL=0m/s, rL=0rad/s;Follower: [uF1,vF1,rF1]=[0,0,0].The simulation results are shown in Figures7 and 8. The formation trajectories of the two USVs using PER are shown in Figure 7, and Figure 8 shows the sensing angle of follower 1 relative to the leader using PER. The total simulation time is 1000 seconds. The leader’s yaw angle velocity and the surge velocity are assumed to remain unchanged during the simulation. αLFiRe from (28) is set to be 0 before 300th second, which means before 300th PER does not work. After 300th second, the PER begins to work.Figure 7
Formation trajectories using PER.Figure 8
Sensing angle of follower 1 relative to the leader using PER.From the simulation results, we can see that, before the PER works, the formation converges to be stable, and the sensing angle is stabilized at-60°, which is not safe for keeping the formation. At 300th second, the PER begins to work; under the control of PER, the formation shrinks; however, the sensing angle converges to be around -48°, which will make the formation be more safe and stable.Case 2 (heading angle error remapping (HAER)).
In this case, the initial positions of the vehicles are chosen as follows:Leader: [XL,YL]=[0,0],Follower: [XF1,YF1]=[-40,50]
The initial velocities are as follows:Leader: uL=1m/s, vL=0m/s, rL=0rad/sFollower: [uF1,vF1,rF1]=[0,0,0]
The given safe sensing angleαLF10 is 45°.The simulation results are shown in Figures9 and 10. The formation trajectories of the two USVs using HAER are shown in Figure 9, and Figure 10 shows the sensing angle of follower 1 relative to the leader using HAER. The total simulation time is 1000 seconds. The leader’s yaw angle velocity and the surge velocity are assumed to remain unchanged during the simulation. KφLRe from (35) is set to be 0 before 300th second, which means before 300th HAER does not work. After 300th second, the HAER begins to work.Figure 9
Formation trajectories using HAER.Figure 10
Sensing angle of follower 1 relative to the leader using HAER.From the simulation results, we can see that, before the HAER works, the formation converges to be stable, and the sensing angle is stabilized at-60°, which is not safe for keeping the formation. At 300th second, the HAER begins to work; under the control of HAER, the formation shrinks; however the sensing angle converges to the desired safe sensing angle -45°, which will ensure that the follower keeps sensing with the leader.Case 3 (double remapping (PER&HAER)).
This case uses the above two methods PER and HAER in cascade. All of the parameters are the same as those in Cases1 and 2.The simulation results are shown in Figures11 and 12. The formation trajectories of the two USVs using double remapping PER&HAER are shown in Figure 11, and Figure 12 shows the sensing angle of follower 1 relative to the leader. The total simulation time is 1000 seconds. αLFiRe from (28) and KφLRe from (35) are set to be 0 before 300th second, which means before 300th PER&HAER does not work. After 300th second, the double remapping begins to work.Figure 11
Formation trajectories using PER&HAER.Figure 12
Sensing angle of follower 1 relative to the leader using PER&HAER.From the simulation results, we can see that the formation shrinks after PER&HAER works, and the sensing angle converges to be around-55°, which will ensure that the follower keeps sensing with the leader.


## 4.2. Comparison and Analysis

The differences between the above three cases are shown in this section. Next we will make some comparisons in three ways to analyze the characteristics and effectiveness of the three different methods.


### 4.2.1. Convergence Rate

Figure13 shows the comparison of formation trajectories. All the four formation trajectories are able to converge to be stable. However, after 300th second, the ERM begins to work, the formation convergence rate is the slowest using HAER. The formation convergence rates using PER and PER&HAER are close. But there exists overshoot using PER. Compared with “no remapping” formation trajectory, the formation trajectory using HAER shrinks more than the formation trajectories using PER&HAER and PER, which means its formation is worst. There is little difference between PER&HAER trajectory and PER trajectory, and the two methods are better than HAER.Figure 13
Comparison of formation trajectories.


### 4.2.2. Safety

The simulation results of sensing angle shown together in Figure14. From Figure 13 we know that all the four formation trajectories converge to be stable. So the sensing angles are also stable in the end. In this research, the border of the follower’s sensor is ±60°. Figure 14 shows that under no remapping the sensing angle is stabilized at -60°, and this is dangerous for the formation. And the sensing angles converge to be around -45°, -48°, and -54° using HAER, PER, and PER&HAER, respectively, whose absolute values are smaller than the sensing border angle, so they can ensure that the follower keeps sensing with the leader. We can see that all the three remapping methods can be able to adjust the sensing angle. The sensing angle is safest using HAER method, but it has a slow convergence. The other two methods can converge quickly. However the sensing angle has negative overshoot using PER and, during 300th second and 320th second the sensing angle, is beyond -60°, which means the worst situation happens: vision lost. Thus PER&HAER achieves the best result.Figure 14
Comparison of sensing angles.


### 4.2.3. Formation Errors

The core idea of ERM is to design a remapping error as the feedback for the control. It controls the followers to change their positions to converge to the remapping errors rather than the actual errors. So there must be actual steady-state errors. Figures15 and 16 show the formation errors in lx direction and ly direction. The steady formation error in ly direction using PER is smallest compared with the errors using HAER and PER&HAER; however, it achieves the biggest error in lx direction. The steady formation error in lx direction using HAER achieves the smallest value compared with the errors using PER and PER&HAER; however, it is biggest in ly direction. Compared with the errors in lx direction and ly direction using PER and HAER, the PER&HAER method achieves the best formation error. However there is also yaw angle steady-state error using PER&HAER, which is shown in Figure 17.Figure 15
Comparison of formation errors inlx direction.Figure 16
Comparison of formation errors inly direction.Figure 17
Comparison of yaw tracking errors.According to the above comparisons from Figures13–17, we can see all the three methods can be able to deal with the sensing constraints problem; however there exist different effects. The HAER method can be able to achieve a safest formation ensuring the follower keeping sensing with the leader; however its convergence speed is slow, and the steady-state formation error in ly direction is biggest. The advantage of PER is that it can be able to make the follower reach its remapping position along an optimal path; however its remapping sensing angle has undershoot and the steady-state formation error in lx direction is biggest. The PER&HAER method owns the advantages of the other two methods, so PER&HAER is the best one.


## 4.2.1. Convergence Rate

Figure13 shows the comparison of formation trajectories. All the four formation trajectories are able to converge to be stable. However, after 300th second, the ERM begins to work, the formation convergence rate is the slowest using HAER. The formation convergence rates using PER and PER&HAER are close. But there exists overshoot using PER. Compared with “no remapping” formation trajectory, the formation trajectory using HAER shrinks more than the formation trajectories using PER&HAER and PER, which means its formation is worst. There is little difference between PER&HAER trajectory and PER trajectory, and the two methods are better than HAER.Figure 13
Comparison of formation trajectories.


## 4.2.2. Safety

The simulation results of sensing angle shown together in Figure14. From Figure 13 we know that all the four formation trajectories converge to be stable. So the sensing angles are also stable in the end. In this research, the border of the follower’s sensor is ±60°. Figure 14 shows that under no remapping the sensing angle is stabilized at -60°, and this is dangerous for the formation. And the sensing angles converge to be around -45°, -48°, and -54° using HAER, PER, and PER&HAER, respectively, whose absolute values are smaller than the sensing border angle, so they can ensure that the follower keeps sensing with the leader. We can see that all the three remapping methods can be able to adjust the sensing angle. The sensing angle is safest using HAER method, but it has a slow convergence. The other two methods can converge quickly. However the sensing angle has negative overshoot using PER and, during 300th second and 320th second the sensing angle, is beyond -60°, which means the worst situation happens: vision lost. Thus PER&HAER achieves the best result.Figure 14
Comparison of sensing angles.


## 4.2.3. Formation Errors

The core idea of ERM is to design a remapping error as the feedback for the control. It controls the followers to change their positions to converge to the remapping errors rather than the actual errors. So there must be actual steady-state errors. Figures15 and 16 show the formation errors in lx direction and ly direction. The steady formation error in ly direction using PER is smallest compared with the errors using HAER and PER&HAER; however, it achieves the biggest error in lx direction. The steady formation error in lx direction using HAER achieves the smallest value compared with the errors using PER and PER&HAER; however, it is biggest in ly direction. Compared with the errors in lx direction and ly direction using PER and HAER, the PER&HAER method achieves the best formation error. However there is also yaw angle steady-state error using PER&HAER, which is shown in Figure 17.Figure 15
Comparison of formation errors inlx direction.Figure 16
Comparison of formation errors inly direction.Figure 17
Comparison of yaw tracking errors.According to the above comparisons from Figures13–17, we can see all the three methods can be able to deal with the sensing constraints problem; however there exist different effects. The HAER method can be able to achieve a safest formation ensuring the follower keeping sensing with the leader; however its convergence speed is slow, and the steady-state formation error in ly direction is biggest. The advantage of PER is that it can be able to make the follower reach its remapping position along an optimal path; however its remapping sensing angle has undershoot and the steady-state formation error in lx direction is biggest. The PER&HAER method owns the advantages of the other two methods, so PER&HAER is the best one.


## 4.3. Three USVs Simulation Results

According to the proposed ERM, the intensity of remapping result is decided by the EPM parameters. The more intense the remapping is, the safer the formation will be, but the more errors the formation will achieve. Though all the three methods may achieve the best formation, PER and HAER have their own disadvantages, which are undershoot and slow convergence. Considering the comparisons from the three methods, PER&HAER method which is better than the other two methods is chosen. A triangular formation of three USVs is simulated here using PER&HAER. The initial positions of the vehicles are chosen asLeader: [XL,YL]=[0,0],Follower 1: [XF1,YF1]=[-40,50],Follower 2: [XF2,YF2]=[-40,-50]. The initial velocities are as follows.Leader:uL=1m/s, vL=0m/s, rL=0rad/s (during the simulation time 0~200 s), rL=0.01rad/s (during the simulation time 200~260s), rL=-0.01rad/s (during the simulation time 260~410 s), rL=0.01rad/s (during the simulation time 410~550 s), rL=0rad/s (during the simulation time 550~1000 s).Follower 1:[uF1,vF1,rF1]=[0,0,0], Follower 2: [uF2,vF2,rF2]=[0,0,0]. The other parameters are set to be the same as in Section 4.1. The total simulation time is 1000 seconds; the leader’s initial angle velocity in yaw is set to be 0rad/s before 200th second, and changes to 0.01rad/s at 200th second, then turns to -0.01rad/s at 260th second, turns to be 0.01rad/s again at 410th second, and keeps 0rad/s during 550th to the end. The surge velocity of the leader is assumed to remain unchanged during the simulation.Two simulations were done: one is the triangular formation control simulation which did not use the PER&HAER method and another one used PER&HAER. Figure18 shows the triangular formation trajectories using no remapping method. We can see that the formation collapses after around 230th second. This is because of the leader’s turning which results in the fact that it moves out of the follower’s sensing field and losing the leader’s information.Figure 18
Triangular formation trajectories using no remapping method.Figure19 shows the triangular formation trajectories using PER&HAER; the formation converges to be stable. And the sensing angles of the two followers relative to the leader using PER&HAER are shown in Figure 20. We can see that in Figure 20(a) follower 1’s sensing angle converges to be around -48.5°, and in Figure 20(b) follower 2’s sensing angle is around 48.5°, all of which are not beyond the sensing constraint angle.Figure 19
Triangular formation trajectories using PER&HAER.Figure 20
Sensing angles of two followers relative to the leader using PER&HAER.
(a)
(b)As one can see, the USVs achieve the stable formation successfully for both straight-line and curved-line paths. And the followers keep sensing with the leader effectively. This means that PER&HAER works well. Triangular formation errors using PER&HAER are shown in Figure21, which can be able to converge to be stable. Therefore, from the simulation results, one can see that the proposed control system is effective in achieving the stable formation dealing with sensing constraints.Figure 21
Triangular formation errors using PER&HAER.
(a)
(b)
(c)


## 5. Conclusion

This paper presents a formation control strategy for USVs under sensing constraints. The controller uses backstepping method which makes it possible to achieve the desired formation under the leader-follower strategy. Three exponential remapping methods dealing with the sensing constraints problem are proposed to track straight-line as well as curved-line paths, which can be able to make the followers keep sensing with the leader so as to maintain the stable formation. Comparisons are done among the three methods. Simulation results demonstrate the effectiveness of the proposed control scheme PER&HAER for achieving a stable triangular formation tracking straight-line and curved-line paths. This control method does not account for environmental disturbances, and the sensor error problems such as noise, random error, and sampling rate which are inherent in the sensor are not taken in account either. For real applications, this should be considered in further researches.



---

*Source: 7619086-2017-09-13.xml*