Abstract

This paper is concerned with the target tracking problem of an autonomous surface vehicle in the presence of a maneuvering target. The velocity information of target is totally unknown to the follower vehicle, and only the relative distance and angle between the target and follower are obtained. First, a reduced-order extended state observer is used to estimate the unknown relative dynamics due to the unavailable velocity of the target. Based on the reduced-order extended state observer, an antidisturbance guidance law for target tracking is designed. The input-to-state stability of the closed-loop target tracking guidance system is analyzed via cascade theory. Furthermore, the above result is extended to the case that collisions between the target and leader are avoided during tracking, and a collision-free target tracking guidance law is developed. The main feature of the proposed guidance law is twofold. First, the target tracking can be achieved without using the velocity information of the target. Second, collision avoidance can be achieved during target tracking. Simulation results show the effectiveness of the proposed antidisturbance guidance law for tracking a maneuvering target with the arbitrary bounded velocity.

1. Introduction

Recently, advanced motion control of marine vehicles has received significant attention due to its wide applications in hydrological monitoring, channel exclusion, search and rescue, biological detection, and so on [17]. Numerous motion control scenarios of marine vehicles have been considered including path following [821], path tracking [22, 23], trajectory tracking [4, 2426], and target tracking [2, 2734]. Target tracking is to track a maneuvering target where no information about the target behavior is known in advance except its instantaneous motion.

Various control methods have been developed for the target tracking of marine vehicles [2, 2734]. In [2], a position tracking controller is developed for an underactuated autonomous underwater vehicle based on a backstepping technique and neural networks. In [27], a straight-line target tracking controller is developed for an underactuated unmanned surface vehicle. In [28], a target tracking controller is developed for underactuated autonomous surface vehicles (ASVs) with limited control torques. In [29], a fault tolerant target tracking controller is developed for underactuated ASVs. In [2, 2729], the velocities of the targets are known as a priori. In practice, however, the velocity information of the target may not be available by the follower. In order to track the leader in the absence of velocity information of target, a variety of methods are available [30, 31]. In [30], a robust controller is designed for target tracking of marine vessels where unknown velocity of the leader is handled by using a sliding model control. In [31], an adaptive leader-follower formation controller is designed for ASVs based on a dynamic surface control and single-hidden-layer neural networks, and an adaptive term is used to estimate the unknown velocity of target. In recent years, collision avoidance has been considered in motion control [35, 36]. However, the collision avoidance problem during target tracking is not considered in [2, 2729].

Extended state observer as a key part of active disturbance rejection control method was proposed by Han [3739]. It is a powerful tool to deal with the nonlinear systems in the presence of large uncertainty including internal model uncertainties and external disturbances [40]. It has been widely used in numerous engineering applications [11, 41, 42]. A reduced-order extended state observer (RESO) is able to decrease the phase lag and simplify the observer structure to reduce computation load. It has the advantages of fast observation and no overshooting. Because of its advantages, it is desirable to employ the extended state observer to address the uncertainty during target tracking.

In this paper, an antidisturbance guidance law for target tracking is designed based on the reduced-order extended state observer (RESO), where an ASV is requested to track a maneuvering target. Only relative line-of-sight range and angle between the follower and target are available for feedback design. At first, a RESO is used to estimate the unknown relative dynamics due to the unavailable velocity of the target. Then, an antidisturbance guidance law is proposed based on the RESO and the stability of closed-loop guidance system is analyzed via cascade analysis. The above result is extended to target tracking with collision avoidance of ASVs, and a collision-free RESO-based guidance law is developed. Simulation results are used to show the proposed collision-free guidance law for tracking a maneuvering target.

The contributions of this paper is twofold. First, an antidisturbance guidance law for target tracking is designed based on the reduced-order extended state observer where target dynamics is not required to be known. Second, a collision-free guidance law for target tracking is developed such that the collision between the target and follower vehicle can be avoided. The main features of the proposed guidance law are presented in this paper as follows. First, compared with the target tracking controllers proposed in [2, 2729] where the velocity of the target should be known in advance, the velocity of the target is not required to be known and only the relative line-of-sight distance and angle between the target and the follower are needed. Second, compared with the target tracking controllers proposed in [2, 10, 2730, 34] where the collision avoidance problem is not considered, a collision-free RESO-based guidance law is proposed for target tracking of underactuated ASVs where the collision between the target and follower can be avoided.

This paper is organized as follows: Section 2 states the preliminaries and problem formulation. Section 3 gives the target tracking guidance law design and analysis. Section 4 introduces the collision-free target tracking guidance law design and analysis. Section 5 presents the simulation results. Section 6 concludes this paper.

2. Preliminaries and Problem Formulation

2.1. Collision Avoidance

In order to assure collision-free target tracking, the following collision avoidance potential functions are introduced [35]:where , is the detection region, is the radius of the avoidance, and is the distance between the target and follower vehicles defined asand are positions of a target and are positions of a follower.

Function (1) will be infinity when the distance between the vehicle and obstacle approaches avoidance region and is zero outside the detection region. In other words, the function will affect the surge velocity when is inside the detection region.

Taking the partial derivative of the potential function with respect to , we can obtain [36]and the partial derivative of function with respect to is

2.2. Vehicle Kinematics

The kinematics of an ASV can be expressed by using an earth-fixed frame and a body-fixed frame as shown in Figure 1. Let and be the position and orientation of the target and follower, respectively. denote the surge velocity, sway velocity, and angular rate of the target vehicle; represent the surge velocity, sway velocity, and angular rate of the follower vehicle, respectively. The kinematics of the target ASV isand the kinematics of follower ASV is

From Figure 1, the line-of-sight range and angle between the target and the follower are defined as

In the following sections, we first consider the target tracking guidance law design being lack of velocity information of the target. Next, the result is extended to collision-free RESO-based guidance law design.

3. Target Tracking

At first, the relative dynamics between the target and follower is derived. Then, a RESO is used to estimate the unknown relative dynamics due to the unavailable velocity of the target. Next, an antidisturbance guidance law is designed based on the RESO. Finally, the stability of closed-loop guidance system is analyzed via cascade analysis.

3.1. Relative Dynamics

Two target tracking errors are defined as follows:where is a desired range and is a sideslip angle. Taking the time derivative of and in (8) and using (5) and (6), we have

The control objective of target tracking of ASVs in the presence of unknown target kinematics is to design a surge velocity and yaw rate such thatfor some small constants and .

3.2. RESO Design

We first use a RESO to estimate the unknown relative dynamics due to the unavailable velocity of the target. To facilitate controller design, the relative dynamics in (9) is rewritten in the following form:where

Since , , and of the target are not available, and are unknown. To address it, a reduced-order extended state observer is proposed as follows [43]:where are the auxiliary states of the observer; are the observer gains; and denote the estimation of and . The initial values of and are set to and .

Assumption 1. The time derivatives of and are bounded by and , where and are positive constants.
Since the velocities and accelerations of the target and follower ASVs are naturally bounded, Assumption 1 is reasonable.
The estimation errors are defined as follows:Taking the derivative of (14) along (13), we haveThe stability of subsystem (15) is stated as follows.

Lemma 2. Subsystem (15), viewed as a system with the states being and and the inputs being and , is input-to-state stability (ISS).

Proof. Construct the following Lyapunov function:Taking the time derivative of along (15) results inwhere , , , and , . Noting thatrenderswhere . As a consequence, subsystem (15) is ISS, andwhere is a class function, are the class function, and

3.3. Guidance Law Design

Based on the estimated terms and from the RESO, an antidisturbance guidance law is proposed as follows:where and are positive constants; and are positive constants, which are used to limit the maximum value of control laws.

Substituting (14) and (22) into (11) results in

The ISS property of subsystem (23) is stated as follows.

Lemma 3. Subsystem (23), viewed as a system with the states being and and the inputs being and , is ISS.

Proof. Construct the following Lyapunov function:Taking the time derivative of along (23) results inwhere , , , , , and .
Noting thatrenderswhere . As a consequence, subsystem (23) is ISS, andwhere is a class function, and are the class functions, andwith .
The proposed guidance law can be augmented with other methods such as PID control, adaptive control [44, 45], sliding mode control [46], and robust control at the kinetic level for achieving the desired target tracking control performance.

3.4. Stability Analysis

To analyze the stability of the entire closed-loop guidance system, rewrite the disturbance estimation subsystem (15) and target tracking error subsystem (23) in a compact form asand

The stability of the cascade of subsystem and subsystem is given by the following theorem.

Theorem 4. Under Assumption 1, the closed-loop system cascaded by subsystem (15) and subsystem (23) is ISS, and the target tracking errors converge to a small neighborhood of the origin.

Proof. Subsystem with states and exogenous inputs and subsystem with states , and exogenous inputs and are ISS. By Lemma C.4 in [47], it follows that the cascade systems and with states and exogenous inputs are ISS, i.e., there exist class function and function , , , and , such thatwhere . As , , it follows thatimplying (10) with . Note that and are bounded by and . Then, the errors , , and are all bounded. Note that only uniform ultimate boundedness of closed-loop system can be achieved due to the existence of and . If and , the closed-loop system is asymptotical stable.

4. Collision-Free Target Tracking

4.1. Guidance Law Design

In previous section, a target tracking controller is developed for ASVs without using the velocity of the target. In this section, a collision-free target tracking controller is developed based on a RESO and an artificial potential function. To achieve a collision-free target tracking, a desired orientation is defined as follows:and the angle tracking error is redefined as

The guidance law for collision-free target tracking based on RESO is designed as follows:where and are positive constants; and are positive constants, which are employed to limit the maximum value of control laws.

Substituting (14) and (36) into (11) results in

The ISS property of subsystem (37) is stated as follows.

Lemma 5. Subsystem (37), viewed as a system with the states being and and the inputs being and , is ISS.

Proof. Construct a Lyapunov function for system (37) asTaking the time derivative of along (37), (3), and (4), we havewhere , , , and .
Noting thatrenderswhere . As a consequence, subsystem (37) is ISS. Since is negative definite, then is not increasing inside the detection region. Sincewhere and , then collision avoidance is guaranteed.

4.2. Stability Analysis

Finally, we analyze the cascade stability of subsystem (15) and subsystem (37) in a compact form:and

The following theorem presents the stability of the cascade system consisting of subsystem (15) and subsystem (37).

Theorem 6. Consider the closed-loop guidance system consisting of follower ASV with kinematics (6), the target ASV with kinematics (5), and the guidance law (36) (13). If Assumption 1 is satisfied, the proposed guidance law can achieve the control objective described in Section 3.1. The closed-loop system cascaded by subsystem (15) and subsystem (37) is ISS. Besides,
(1) outside the detection range, the tracking errors converge to a small neighborhood of the origin,
(2) inside the detection range, collision avoidance is guaranteed, i.e., for all for some constant .

Proof. Part A. The cascade system consisting of subsystem and subsystem with the relative distance () is ISS. The proof is the same as the proof of Theorem 4.
Part B. The cascade system consisting of subsystem and subsystem with the relative distance () is ISS. It has been proved that subsystem with states and exogenous inputs and subsystem with states , and exogenous inputs and are ISS. By Lemma C.4 [47], it follows that the cascade systems and with states and exogenous inputs are ISS. Note that the errors , , , and are all bounded. Then, collision avoidance is guaranteed for all , where with being a constant.

A parameter selection guideline is provided as follows. The parameters and determine the speed of observer. The parameters , , , and can be chosen according to the desired response of the closed-loop system. The parameters , , , and can be used to regulate the transient performance.

5. Simulation Results

In this section, simulation results are given to show the performance of the proposed guidance law for collision-free target tracking. Two cases are presented: the velocity of target is constant; the velocity of target is time-varying. The vehicle tracks the target with relative distance (, ). The initial configurations of the follower and target vehicle are and , respectively. The control parameters are chosen as follows: , , , , , , , , , , , , , and .

5.1. Target Tracking and Collision Avoidance with a Target of Constant Velocity

Consider the ASV model (6) controlled by the guidance law (22) with constant velocity and . Simulation results are shown in Figures 25, and Figure 2 shows the trajectories of target and follower ASV. It reveals that the follower vehicle heads for the target in a short time while holding a desired distance although the target dynamics is uncertain. Figure 3 shows that the follower vehicle tracks the target with distance when the distance satisfies . After , the distance is changed from to , and the tracking distance becomes . It reveals that the proposed guidance law can achieve collision avoidance well. The output of RESO and the relative dynamics of target are compared in Figure 4. It shows that the RESO can compensate the uncertain target kinematics efficiently. Figure 5 shows the guidance signals of the proposed guidance law. It reveals that the guidance signals are all bounded.

5.2. Target Tracking and Collision Avoidance with a Target of Time-Varying Velocity

The guidance law (36) is employed to track a target with time-varying velocity and . Figures 69 show the simulation results. Figure 6 shows that the follower vehicle can track the target with given relative distance. The relative distance is shown in Figure 7. It implies that the follower vehicle tracks the target with given distance when the distance is designed as . After , the distance is changed from to . The tracking distance becomes rather than the given distance . It indicates that the proposed guidance law for target tracking extended to collision avoidance is effective with the time-varying velocity of target. The output of the RESO and relative dynamics of target are compared in Figure 8. It shows that the RESO can compensate the uncertain target dynamics efficiently. Figure 9 shows the guidance signals of the proposed guidance law. It observed that the guidance signals are all bounded.

6. Conclusions

This paper considers the target tracking problem of an ASV in the presence of a maneuvering target where the velocity information of the target is totally unknown to the follower ASV. A reduced-order extended state observer is used to estimate the unknown relative dynamics. Then, an antidisturbance guidance law is developed based on the reduced-order extended state observer for target tracking. The stability of closed-loop target tracking guidance system is analyzed via cascade analysis. Finally, the result is extended to the case that collisions between the target and leader are avoided during tracking, and a collision-free target tracking guidance law is developed. Simulation results verify the effectiveness of the proposed guidance law for tracking a maneuvering target with arbitrary velocity and having the ability to avoid collision in the presence of a maneuvering target.

Data Availability

The data used to support the findings of this study are included within the article.

Conflicts of Interest

The authors declare that they have no conflicts of interest.

Acknowledgments

Zhouhua Peng and Dan Wang were supported in part by the National Natural Science Foundation of China under Grants 51579023 and 61673081, in part by the Innovative Talents in Universities of Liaoning Province under Grant LR2017014, in part by High Level Talent Innovation and Entrepreneurship Program of Dalian under Grant 2016RQ036, in part by the National Key Research and Development Program of China under Grant 2016YFC0301500, and in part by the Fundamental Research Funds for the Central Universities under Grant 3132016313.