Dynamic Target Tracking of Unmanned Aerial Vehicles Under Unpredictable Disturbances

Yanjie Chen , Yangning Wu , Limin Lan , Hang Zhong , Zhiqiang Miao , Hui Zhang , Yaonan Wang

Engineering ›› 2024, Vol. 35 ›› Issue (4) : 76 -88.

PDF (4525KB)
Engineering ›› 2024, Vol. 35 ›› Issue (4) :76 -88. DOI: 10.1016/j.eng.2023.05.017
Research
Article
Dynamic Target Tracking of Unmanned Aerial Vehicles Under Unpredictable Disturbances
Author information +
History +
PDF (4525KB)

Abstract

This study proposes an image-based visual servoing (IBVS) method based on a velocity observer for an unmanned aerial vehicle (UAV) for tracking a dynamic target in Global Positioning System (GPS)-denied environments. The proposed method derives the simplified and decoupled image dynamics of underactuated UAVs using a constructed virtual camera and then considers the uncertainties caused by the unpredictable rotations and velocities of the dynamic target. A novel image depth model that extends the IBVS method to track a rotating target with arbitrary orientations is proposed. The depth model ensures image feature accuracy and image trajectory smoothness in rotating target tracking. The relative velocities of the UAV and the dynamic target are estimated using the proposed velocity observer. Thanks to the velocity observer, translational velocity measurements are not required, and the control chatter caused by noise-containing measurements is mitigated. An integral-based filter is proposed to compensate for unpredictable environmental disturbances in order to improve the anti-disturbance ability. The stability of the velocity observer and IBVS controller is analyzed using the Lyapunov method. Comparative simulations and multistage experiments are conducted to illustrate the tracking stability, anti-disturbance ability, and tracking robustness of the proposed method with a dynamic rotating target.

Graphical abstract

Keywords

Unmanned aerial vehicle / Visual servoing / Velocity observer / Target tracking

Cite this article

Download citation ▾
Yanjie Chen, Yangning Wu, Limin Lan, Hang Zhong, Zhiqiang Miao, Hui Zhang, Yaonan Wang. Dynamic Target Tracking of Unmanned Aerial Vehicles Under Unpredictable Disturbances. Engineering, 2024, 35(4): 76-88 DOI:10.1016/j.eng.2023.05.017

登录浏览全文

4963

注册一个新账户 忘记密码

1. Introduction

Unmanned aerial vehicles (UAVs) are widely used in aerial photography and patrol inspection due to their flexible flying performance and high maneuverability [1]. Autonomous control of a UAV generally requires feedback on position, velocity, and attitude information. Global Positioning System (GPS) and vision technologies are widely adopted as solutions for UAV position and velocity acquisition [2]. In particular, GPS relies on a sufficient number of available satellites to provide global positional information, which may become challenging in harsh environments due to discontinuous signal feedback from satellites. Vision technology, which provides abundant pixel information and image features, is more suitable for position information acquisition in harsh environments than GPS. Therefore, vision-based methods have been developed to allow UAVs to implement autonomous control in GPS-denied environments [3].

Vision-based control has been widely adopted for UAVs in various fields, such as positioning [4], target tracking [5], and flight landing [6]. In particular, visual servoing has received significant attention [7], [8], [9]. Visual servoing methods focus on the UAV control system, which controls the UAV to maintain a precise relative position with respect to the target object, based on image information. In contrast to simultaneous localization and mapping navigation technologies, visual servoing relies on low-cost sensors to achieve UAV positioning. For UAV target tracking in GPS-denied environments, visual servoing methods provide an efficient and low-cost solution for UAV control tasks. Visual servoing methods are generally divided into position-based visual servoing (PBVS) and image-based visual servoing (IBVS) [10], [11]. In PBVS, the UAV position estimated by image information is taken as the control feedback. The estimated position relies on precise camera parameters. In IBVS, feature pixels are taken as the control feedback, and the kinematics is established directly from image pixels. IBVS does not require pose reconstruction and thus yields a controller with low computational consumption. In addition, IBVS is robust against image noise and camera parameters. Therefore, IBVS methods have become popular and are widely used for the visual servoing control of UAVs. An efficient visual servoing method holds engineering significance for controlling low-cost UAVs in GPS-denied environments.

In IBVS methods for UAV, the translational velocity is essential information for assisting the controller design [12]. The accuracy of translational velocity measurements can affect the performance of the IBVS controller. The chatter phenomenon may occur in the attitude motion as noise-containing velocity measurements are introduced. Hence, velocity observers have been proposed for UAVs to avoid the need for translational velocity measurements. Model- and image-based velocity observers have been adopted in recent studies. For model-based velocity observers, such as those used in Refs. [13], [14], the position information of the UAV must be introduced as observer feedback. The use of positional information limits the accuracy of translational velocity estimation in GPS-denied environments. However, image-based velocity observers utilize image information as observer feedback, making it possible to achieve robust and accurate velocity estimation in GPS-denied environments. Therefore, image-based velocity observers are widely applied in IBVS control designs. In particular, a virtual camera-based velocity observer is an effective method for estimating the translational velocities of UAVs. For example, in Ref. [15], an adaptive observer is proposed to estimate translational velocity. This method shows a reliable performance, since the observer does not introduce noisy measurements. In Ref. [16], the image depth and translational velocities are simultaneously estimated by means of a nonlinear observer using image feedback from an onboard camera.

In recent research, IBVS methods have been extended to complex target-tracking tasks. For an unpredictably moving target, it is challenging to obtain position trajectories using onboard sensors [17], [18]. Hence, image-based velocity observers have been generalized to estimate tracked target translational velocities. For example, the IBVS method combined with an adaptive sliding-mode control method was designed for the moving platform tracking of quadrotors [19]. In Ref. [20], an unknown target motion is considered in the visual servoing, and an observer was utilized for the target velocity estimation. A tracking differentiator is implemented for the trajectory parameters estimation of an unpredictable dynamic target in Ref. [21]. The uncertainties of the unpredictable dynamic target are considered in the abovementioned methods, yielding stable target tracking of the UAV. However, these methods depend on the assumption that the UAV or tracked target velocities are measurable. For a UAV that has onboard sensors with limited accuracy, inaccurate measurements induce noise in the control loop, resulting in attitude chatter.

For target-tracking tasks, it is necessary to address the inaccuracy of image depth estimation caused by the attitude rotation of the tracked target. Generally, in monocular virtual camera-based IBVS methods, image depth is estimated by constructing a virtual camera plane parallel to the target plane [22]. The estimation accuracy of the image depth may be affected by the rotation of the dynamic target. For this case, an improved virtual camera-based IBVS method has been proposed to enable a UAV to track a target with an arbitrary orientation. For example, an inclined target plane is included in a virtual camera-based IBVS controller in Ref. [23]. In Ref. [24], a transformation between real and virtual image planes is proposed based on the kinematic rotation relationship, which extends the virtual camera-based IBVS scheme to enable an underactuated UAV to track a target with an arbitrary orientation. The aforementioned methods extend the virtual camera method and are applicable to situations where the tracked target is arbitrarily inclined. However, in the aforementioned methods, the dynamic target is assumed to be static or quasi-static. A parallel constraint between the virtual camera plane and the target plane may not be guaranteed for rotating targets with arbitrary orientations. Rotating targets may lead to inaccurate image depth estimation and affect the control accuracy. Consequently, the image depth estimation of rotating targets is a practical and challenging field for monocular IBVS control.

Since UAVs usually operate in environments with complex disturbances, their anti-disturbance ability is critical for the stability of target tracking [25], [26], [27]. Anti-disturbance control methods permit the IBVS controller for a UAV to operate in environments with uncertain disturbances. For example, in Ref. [24], an integral filter is proposed for an IBVS controller to compensate for unpredictable disturbances. In Ref. [28], an adaptive IBVS control scheme is proposed to compensate for the constant force disturbance in translational dynamics. These methods realize the stable IBVS control of UAVs under unpredictable disturbances. Nevertheless, they assume that the translational velocities of the UAV or tracked target are measurable. Translational velocity measurements are introduced into the proposed integral filter in Ref. [24], resulting in a control that is limited in GPS-denied environments. In Ref. [28], the tracked target is assumed to be static, resulting in a limitation in the target-tracking control. Adopting translational velocity measurements may lead to control limitations of the IBVS method in GPS-denied environments. Noise-containing velocity measurements may result in chatter in attitude control. Therefore, the visual servoing target-tracking control of a UAV under external disturbances is a critical problem that must be addressed.

Based on the above analysis, the challenges of IBVS control for UAVs primarily include: ① the estimation of unpredictable tracked target translational velocities, ② the image depth estimation of a dynamic rotating target, and ③ tracking stability under uncertain external disturbances. To address these challenges, we further improve the IBVS method for UAVs. To deal with an unpredictable target velocity, the uncertainty caused by a rotating target, and external disturbances in dynamic target-tracking control, we propose corresponding improvement methods. The primary contributions of this study are summarized below.

• A novel image depth model is proposed for the construction of image dynamics. The image depth can be accurately estimated using the proposed image depth model without the rotation information of the tracked target. Based on the image depth model, the proposed IBVS controller can be applied to a UAV to track a dynamic rotating target with an arbitrary orientation.

• A velocity observer is designed for the relative velocity estimation of the UAV and the dynamic target, which enables the proposed method to be utilized in GPS-denied environments. The robustness of the proposed IBVS method is enhanced, as the control chatter caused by noise-containing velocity measurements is mitigated.

• An integral-based filter is designed to estimate unpredictable disturbances, including the acceleration of the dynamic target and environmental disturbances. This enhances the disturbance rejection ability of the UAV in handling unknown movements of the dynamic target and external disturbances.

The remainder of this paper is organized as follows. The image dynamics of the UAV and a novel image depth model are introduced in Section 2. In Section 3, we design a velocity observer, integral-based filter, and dynamic IBVS controller to realize target tracking under unpredictable disturbances. 4 Simulation of target tracking, 5 Experimental results present the comparative simulation and experimental results, respectively. Finally, concluding remarks are presented in Section 6.

2. Image dynamics of the UAV system

This section introduces a virtual camera image to derive image dynamics. More specifically, the pixels of the dynamic target in the virtual camera plane are selected as the image features that decouple the roll/pitch motions and the image motions. Subsequently, an image depth model suitable for a dynamic target with an arbitrary orientation is derived based on the geometric properties of the dynamic target. Finally, image dynamics with a simple and decoupled form are derived based on image moments constructed using multiple feature points.

2.1. UAV dynamics

A UAV system with an inertial measurement unit (IMU) and monocular camera is shown in Fig. 1. The position and attitude dynamic models of the UAV are provided in Ref. [29].

v ˙ = f M R b n 3 g n 3 + d 1
J ω ˙ b = ω b × J ω b + τ

where v 3 is the UAV translational velocity with respect to the inertial frame Oa and v ˙ denotes the time derivative of v. 3 represents the set of three-dimensional real vector. M and J 3 × 3 denote the UAV mass and inertia matrix, respectively. R represents the set of real number. 3 × 3 represents the set of three-dimensional real matrix. Both M and J are constants. g denotes the gravity acceleration, f denotes the UAV thrust, and n 3 = 0 , 0 , 1 T 3 is the unit vector along the z-direction. R b 3 × 3 is the rotation matrix of the body-fixed frame Ob with respect to Oa, and ω b 3 and τ are the UAV angular velocity and torque, respectively. ω ˙ b denotes the time derivative of ω b. d 1 3 represents the environmental disturbance, and f and τ are provided by the rotors of the UAV.

By denoting the visual servoing control input u = f M R b n 3 g n 3, Eq. (1) can be expressed as follows:

v ˙ = u + d 1

Since the environmental disturbance d1 is typically produced by wind, the following assumption can be made.

Assumption 1 The environmental disturbances d1 are bounded: d 1 D 1, where y represents the L2-norm of vector y and D 1 is the upper bound of the disturbances d1.

The attitude controller of the UAV is assumed to be available, based on existing commercial UAVs [30]. The desired Rb and f are adopted as inputs for the IBVS control. Denoting R b = r 1 , r 2 , r 3, where r1, r2, and r3 are the first, second, and third column elements of the rotation matrix R b, respectively. The designed visual servoing control input u can be transformed into the control input of a commercial UAV using the following equations [30]:

f = M u + g n 3
r 1 = r 2 × r 3 r 2 = r 3 × l r 3 × l r 3 = u + g n 3 f

where l = cos ϕ , sin ϕ , 0 T is the heading vector of the UAV and ϕ denotes the UAV yaw angle.

2.2. Virtual camera

The pixel motions and translational velocities are coupled with the roll and pitch motions for the underactuated UAV. The image dynamics are related to the roll and pitch motions, presenting a challenge in the IBVS controller design. Virtual camera methods have been proposed to decouple the image and roll/pitch motions [8], [15]. Inspired by Ref. [15], the attitudes of the virtual camera are constructed in such a way that they remain fixed with the inertial frame, thereby permitting independence of the image motion and UAV rotation.

As shown in Fig. 1, Oc and Ov denote the camera frame and virtual camera frame, respectively. The tracked target frame is defined as Ot. The tracked target is a rotating plane with arbitrary orientation. The rotation of Ov remains fixed with Oa, and the rotation matrix of Ov with respect to Oa is defined as R v. The origin of Ov is set to coincide with that of Oc. The rotation matrix from Ov to Oc is defined as R c v and can be derived using the following equation:

R c v = R v T R b R c b

where R c b SO 3 denotes the rotation matrix of Oc with respect to Ob. R c b is a constant matrix, as the camera is fixed to the UAV.

We denote s k = w k , h k , λ T 3 and s ¯ k = w ¯ k , h ¯ k , λ T as the homogeneous pixel coordinates of the kth point in the virtual camera plane and the real image plane, respectively. w k and w ¯ k are the pixel width coordinates of virtual camera and real camera, respectively. h k and h ¯ k are the pixel height coordinates of virtual camera and real camera, respectively. λ is the focal length of the camera. k is the serial number of feature points in the target plane. Adopting the perspective projection model of the camera, the following equations can be derived:

s k = λ z k p k
s ¯ k = λ z k p ¯ k

where p k = x k , y k , z k T and p ¯ k = x ¯ k , y ¯ k , z ¯ k T denote the kth point positions expressed in Ov and Oc, respectively. zk is image depth of the kth point. xk, yk, and zk are the three components of pk, respectively. x ¯ k, y ¯ k, and z ¯ k are the three components of p ¯ k.

The relationship between p k and p ¯ k can be expressed as follows:

p k = R c v p ¯ k

Subsequently, by combining Eqs. (7), (8), (9), s k can be expressed as follows:

s k = z ¯ k z k R c v s ¯ k

where z ¯ k z k = λ n 3 T R c v s ¯ k is calculated using the third row of the matrix form of Eq. (10). By applying Eq. (10), the feature pixel coordinates of the virtual camera can be derived from real images.

Based on the defined virtual camera, the image kinematics describing the relationship between the translational velocities and virtual camera image pixel motions can be derived as follows [10]:

w ˙ k h ˙ k = 1 z k λ 0 w k 0 λ h k v v v e

where v v = v v 1 , v v 2 , v v3 T denotes the UAV translational velocity with respect to Ov, and v e = v e1 , v e2 , v e 3 T is the translational velocity of the dynamic target. w ˙ k and h ˙ k represent the time derivative of w k and h k, respectively.

Since the rotation matrix Rv is defined as a constant, the following equation can be obtained:

z ˙ k = v v 3 v e 3 v v = R v T v v ˙ v = R v T v ˙

where z ˙ k and v ˙ v represent the time derivative of z k and v v, respectively.

Based on the defined virtual camera, the pixel motion is related only to the translational velocities of the UAV. The image kinematics with a simple form is established as Eq. (11), which can simplify the derivation of the image dynamics and IBVS controller design.

2.3. Depth information acquisition

Since the image depth z k in Eq. (11) cannot be directly measured using a monocular camera, the estimation of z k needs to be addressed. The virtual camera image moment is widely utilized as an effective method for image depth estimation. In the virtual camera method, a virtual plane is constructed parallel to the target plane. Based on this parallel constraint, a reliable depth estimation can be derived from the proportional relationship between the image moment and image depth. For a rotating target with unpredictable attitudes, it is challenging to maintain the parallel constraint of the virtual plane, resulting in chatter in the image depth estimation. To overcome this limitation, an image depth model based on the geometric properties of the rotating target is proposed in order to estimate the image depth. The depth model is independent of the parallel constraints of the virtual image plane. The image depth of a rotating target with an arbitrary orientation can be accurately obtained.

As shown in Fig. 1, a, b, and c are three noncollinear feature points in the target plane. i = {1, 2, 3, …} denote the feature points inside the triangle enclosed by a, b, and c. a, b, c, and i are assumed to be identifiable. Pk is defined as the positions of multiple points expressed in Ot, where k={a, b, c, i} denotes the serial number of feature points in the target plane. Pa, Pb, Pc, and Pi are the positions of a, b, c, and i with respect to Ot, respectively. The virtual image pixels of a, b, c, and i are s a, s b, s c, and s i, respectively. Then, Pi can be expressed as the following equation by using barycentric interpolation.

P i = α i P a + β i P b + γ i P c

where α i , β i , γ i 0 are the interpolation coefficients and satisfy the equation α i + β i + γ i = 1. The values of α i, β i, and γ i are constant and can be uniquely determined by the geometric information of a dynamic target.

The relationship between Pk and pk can be expressed as the following equation:

p k = R t v P k + p t v , k = a , b , c , i

where R t v and p t v are the rotation matrix and the translation from Ov to Ot, respectively.

Combining Eqs. (7), (8), (9) yields the following:

z i s i = α i z a s a + β i z b s b + γ i z c s c

where z a, z b, and z c are the image depth of a, b, and c, respectively. zi is the image depth of feature point i.

By taking the vector operation on both sides of Eq. (15), the equation can be rewritten as follows:

z i s a × s i = β i z b s a × s b + γ i z c s a × s c
z i s b T s a × s i = γ i z c s b T s a × s c

Then, zc can be expressed as follows:

z c = 1 γ i s b T s a × s i s b T s a × s c z i = 1 γ i s i T s a × s b s c T s a × s b z i = r c z i

where r c = 1 γ i s i T s a × s b s c T s a × s b is the image depth parameter of c.

Similarly, z a and z b can be expressed as follows:

z a = 1 α i s i T s b × s c s a T s b × s c z i = r a z i
z b = 1 β i s i T s a × s c s b T s a × s c z i = r b z i

where r a = 1 α i s i T s b × s c s a T s b × s c and r b = 1 β i s i T s a × s c s b T s a × s c are the image depth parameters of a and b, respectively.

Assuming that the geometric features of the dynamic target are invariant, the area enclosed by Pa, Pb, and Pc is constant and can be expressed as follows:

S a , b , c = 1 2 p a p b × p a p c

where Sa,b,c is the area enclosed by feature points a, b, and c. pa, pb, and pc are the positions of feature points a, b, and c with respect to Oc, respectively.

Applying Eqs. (7), (8), (9), Eq. (21) can be rewritten as follows:

S a , b , c = z i 2 λ r a s a r b s b × r a s a r c s c

Then, the image depth of P i can be expressed as follows:

z i = 2 λ S a , b , c ρ i

where ρ i = 1 r a s a r b s b × r a s a r c s c is the image depth parameter of i.

For the points within the area enclosed by Pa, Pb, and Pc, the image depth can be estimated by means of Eq. (23) without the influence of target rotation.

2.4. Virtual camera image dynamics

Consider N visible feature pixels in the target plane. The image features are defined as follows:

q = 1 N i = 1 N ρ i s i

where q is the image moment.

The time derivative of q is derived by

q ˙ = 1 N i = 1 N ρ ˙ i s i + ρ i w ˙ i h ˙ i 0

where ρ ˙ i = z ˙ i 2 λ S a , b , c = v v3 v e3 2 λ S a , b , c is time derivative of ρ i, which can be derived using Eq. (23). w i and h i are the virtual camera pixel width and height coordinates of feature points i, respectively. w ˙ i and h ˙ i are the time derivative of w i and h i, respectively.

Combining Eqs. (7), (8), (9), q ˙ is obtained as follows:

q ˙ = 1 N i = 1 N v v3 v e3 2 λ S a , b , c w i h i λ + z i 2 λ S a , b , c w ˙ i h ˙ i 0 = 1 2 λ S a , b , c 1 N i = 1 N λ 0 0 0 λ 0 0 0 λ v v v e = 1 2 S a , b , c v v v e

Denote m = 1 2 S a , b , c > 0 (where m is the tracked target geometric parameter) and δ = m v v v e (where δ is the UAV velocity relative to the tracked target). The image dynamics can be expressed by applying Eqs. (7), (8), (9), as follows:

q ˙ = δ
δ ˙ = m R v T u + d

where d = m R v T d 1 v ˙ e is the total uncertainty of the image dynamics system.

Since the maneuverability of a dynamic target is usually limited, the following assumption can be adopted.

Assumption 2 The accelerations of the tracked target are bounded: v ˙ e D 2, where D 2 is the upper bound of the tracked target accelerations.

Denote D = m D 1 + D 2. d m R v T d 1 + v ˙ e D is the total uncertainty upper bound and can be obtained by Assumptions 1 and 2, as Rv and m are constants.

Thanks to the constructed virtual camera and image depth model, the image dynamics can be simplified to a decoupled form, as shown in Eqs. (27), (28).

3. Dynamic visual servoing control method

This section derives and analyzes the dynamic visual servoing controller design based on the Lyapunov theory. More specifically, a velocity observer is proposed to estimate the relative velocity between the UAV and the dynamic target. The bounds of the unpredictable disturbances, including the external disturbances, and the dynamic target are considered in the design of the observer and are estimated using an integral-based filter. Subsequently, the velocity observer outputs are adopted in the visual servoing controller. The control flow of the proposed IBVS method is illustrated in Fig. 2.

3.1. Adaptive velocity observer

The estimated values of q and δ are defined as q ^ and δ ^, respectively. q ˜ = q q ^ and δ ˜ = δ δ ^ are the estimated errors of q and δ, respectively. As q is an obtainable state, q ^ acts as an auxiliary variable for the velocity observer.

Theorem 1 The velocity observer is asymptotically stable and yields the observer errors q ˜ and δ ˜ to converge to zero:

q ^ ˙ = δ ^ + k 1 q ˜
δ ^ = δ o + k 2 q ˜
δ ˙ o = m ^ R v T u + k 1 k 2 + 1 q ˜ + D ^ sgn q ˜ ˙ + k 1 q ˜

where q ^ ˙ is the time derivative of q ^. δ o is the auxiliary variable for the velocity observer. δ ˙ o is the time derivative of δ o. k 1 > 0 and k 2 > 0 are the observer gains. D ^ and m ^ are the estimated values of D and m, respectively. The integral-based filters of D ^ and m ^ are designed as follows:

D ^ ˙ = q ˜ ˙ + k 1 q ˜ T sgn q ˜ ˙ + k 1 q ˜
m ^ ˙ = q ˜ ˙ + k 1 q ˜ T R v T u

Proof. Applying Eqs. (27), (28), (29), (30), q ˜ ˙ and δ ˜ ˙ can be expressed as follows:

q ˜ ˙ = k 1 q ˜ + δ ˜
δ ˜ ˙ = m ˜ R v T u k 2 δ ˜ D ^ sgn δ ˜ q ˜ + d

As D and m are constants, D ˙ = 0 and m ˙ = 0 can be derived. Denote D ˜ = D D ^ and m ˜ = m m ^. D ˜ ˙ and m ˜ ˙ can then be expressed as follows:

D ˜ ˙ = δ ˜ T sgn δ ˜
m ˜ ˙ = δ ˜ T R v T u

The velocity observer Lyapunov function Vo is defined as follows:

V o = 1 2 q ˜ T q ˜ + 1 2 δ ˜ T δ ˜ + 1 2 D ˜ 2 + 1 2 m ˜ 2

The time derivative of Vo can be derived as follows:

V ˙ o = q ˜ T q ˜ ˙ + δ ˜ T δ ˜ ˙ D ˜ D ^ ˙ m ˜ m ^ ˙ k 1 q ˜ T q ˜ + q ˜ T δ ˜ m ˜ δ ˜ T R v T u = k 2 δ ˜ T δ ˜ D ^ δ ˜ T sgn δ ˜ δ ˜ T q ˜ + δ ˜ T d D ˜ δ ˜ T sgn δ ˜ + m ˜ δ ˜ T R v T u k 1 q ˜ T q ˜ k 2 δ ˜ T δ ˜

By applying Barbalat’s lemma, q ˜ and δ ˜ converge to zero asymptotically as time t approaches ∞.

By applying Eqs. (29), (30), (31), (32), (33), the estimated δ ^ is adopted instead of δ for the IBVS controller design. D ^ is utilized to compensate for external disturbances in the IBVS controller.

3.2. Dynamic IBVS controller design

The desired image moment is defined as q*, and the image error of q are defined as q 1 = q q *. For target-tracking tasks, the UAV is expected to maintain a stable position with respect to the dynamic target; q ˙ is configured as q ˙ = 0, and q ˙ = q ˙ 1 can be derived. Subsequently, the backstepping control method is utilized for the IBVS controller design.

Consider the Lyapunov function:

V 1 = 1 2 q 1 T q 1

where V1 is preliminary select Lyapunov function in backstepping techniques.

The time derivative of V1 can be derived as follows:

V ˙ 1 = q 1 T q ˙ 1 = q 1 T δ = q 1 T δ ˜ + δ ^

The error term q 2 is defined as q 2 = q 1 + 1 k 3 δ ^, where k 3 > 0 is the IBVS controller gain. V ˙ 1 can be written as follows:

V ˙ 1 = k 3 q 1 T q 1 + k 3 q 1 T q 2 + q 1 T δ ˜

Then, the time derivative of q 2 can be expressed as follows:

q ˙ 2 = q ˙ 1 + 1 k 3 m ^ R v T u + k 2 q ˜ ˙ + k 1 q ˜ + D ^ sgn q ˜ ˙ + k 1 q ˜ + q ˜ = δ ^ + 1 k 3 m ^ R v T u + D ^ sgn q ˜ ˙ + k 1 q ˜ + q ˜ + k 2 k 3 + 1 δ ˜

Theorem 2 The dynamic system provided by Eqs. (27), (28) with the visual servoing controller input u is asymptotically stable and yields the error terms q 1, q 2, q ˜, and δ ˜, which converge to zero:

u = 1 m ^ R v D ^ ssgn q ˜ ˙ + k 1 q ˜ + q ˜ + k 3 δ ^ + k 3 k 4 q 2 + k 3 2 q 1

where k 4 > 0 is the IBVS controller gain.

Proof. Applying Eqs. (43), (44), q ˙ 2 can be expressed as follows:

q ˙ 2 = k 4 q 2 k 3 q 1 + k 2 k 3 + 1 δ ˜

Consider the Lyapunov function:

V 2 = V 1 + 1 2 q 2 T q 2 + V o

where V 2 is final select Lyapunov function in backstepping techniques.

The time derivative of V 2 can be rewritten as follows:

V ˙ 2 = k 3 q 1 T q 1 + k 3 q 1 T q 2 + q 1 T δ ˜ k 4 q 2 T q 2 + k 2 k 3 + 1 q 2 T δ ˜ k 3 q 2 T q 1 k 1 q ˜ T q ˜ k 2 δ ˜ T δ k 3 1 2 q 1 T q 1 k 4 k 2 + k 3 2 k 3 q 2 T q 2 k 1 q ˜ T q ˜ k 2 k 2 2 k 3 1 δ ˜ T δ ˜

From Eq. (47), the controller and observer gains are selected as follows:

k 1 > 0 , k 2 > 2 k 3 2 k 3 1 k 3 > 1 2 , k 4 > k 2 + k 3 2 k 3

According to Barbalat’s lemma, q 1, q 2, q ˜, and δ ˜ converge asymptotically to zero as time t approaches .

4. Simulation of target tracking

In the simulation, the proposed IBVS controller is compared with the controller in Ref. [24]. A comparative simulation is designed using CoppeliaSim (Coppelia Robotics, ltd., Switzerland) to simulate actual flight situations. The simulation results are provided to illustrate the effectiveness of the proposed method.

4.1. Simulation setup

The UAV model is built using CoppeliaSim software to implement the comparative simulations. The proposed IBVS controller and the controller in Ref. [24] are respectively implemented in the simulation platform. The structure of the simulation platform is depicted in Fig. 3. The simulation parameters are as follow: M = 0.8 kg; control time step Δt = 0.02 s; noise of velocities N∼(0, 0.02) m·s−1; d = N∼(0, 0.1); attitude of the tracked target Rot z y x sin t 6 , 0 , cos t 12 rad; position trajectories of the tracked target p t a = 1 , 0.3 cos 0.25 t , 0 m; desired position of the UAV relative to the target p t c = 1 , 0 , 0 m, where N∼(·) denotes Gaussian distribution and Rotzyx(·) represents the rotation matrix corresponding to Euler angle. The desired pixels of s a, s b, s c, and s i are s a = 0 , 27, s b = 24 , 15, s c = 24 , 15, and s i = 0 , 0, respectively. The controller parameters of the proposed method are set as k 1 = 2, k 2 = 3, k 3 = 1, and k 4 = 3. The controller parameters of the comparison method in Ref. [24] are set as k c1 = 1, k c2 = 2, k tg = 1, and k b1 = k b2 = 0.05. In the simulation, the geometric parameters of the dynamic target are α i = 1 3, β i = 1 3, and γ i = 1 3, respectively. Translational velocity measurements are utilized to estimate the dynamic target velocity in the comparison method, while these measurements are avoided in the proposed method. Moreover, in the proposed method, the virtual camera-based IBVS method is extended to track rotating targets with arbitrary orientations. The effect of the noise-containing measurements and rotating target on the control are compared in the simulation.

The comparative simulation is divided into three stages: ① target tracking from t = 0 to 15 s, ② tracking under a disturbance from t = 15 to 30 s, and ③ rotating target tracking from t = 30 to 45 s. The execution process of the dynamic target-tracking task is illustrated in Fig. 4. In the target-tracking stage, the UAV is set to track a nonuniform moving target to verify the effectiveness of the proposed velocity observer. Subsequently, in the tracking under the disturbance stage, external disturbances are applied to the UAV to demonstrate the anti-disturbance capability of the proposed method. Finally, in the rotating target-tracking stage, the attitude of the dynamic target is configured to rotate dynamically to demonstrate the tracking robustness of the rotating target.

4.2. Simulation results and analysis

The comparative simulation results are shown in Fig. 5, Fig. 6, Fig. 7, Fig. 8, Fig. 9, Fig. 10. The position trajectories of the UAV and the tracked target are shown in Fig. 5, Fig. 6, respectively. The image errors, translational velocities, and Euler angles are respectively shown in Fig. 7, Fig. 9, Fig. 10. The feature pixel convergence trajectories are shown in Fig. 8. In the target-tracking stage from t = 0 to 15 s, the image errors converge to zero in 5 s and stabilize around zero afterward. Compared with the method in Ref. [24], the image, attitude, and translational velocity trajectories of the proposed method are smooth. In the tracking during the disturbance stage from t = 15 to 30 s, although external disturbances lead to a slight chatter phenomenon in the translational velocity and attitude motions, the UAV can maintain a stable tracking trajectory. The image errors of the proposed IBVS controller and the controller in Ref. [24] are within ±10 pixels. The attitude chatter of the proposed IBVS controller is within ±0.02 rad, whereas that of the comparison method is within ±0.025 rad. The proposed method realizes an anti-disturbance performance similar to that of the comparison method without translational velocity measurements. In the rotating target-tracking stage from t = 30 to 45 s, the image error in z-direction q 1 , z of the method in Ref. [24] is increased to ±20 pixels and chatter. For comparison, the image errors in the proposed method are maintained within ±10 pixels. The chatter phenomenon in the translational velocities and attitudes of the method in Ref. [24] is also evident. In comparison, the attitude and translational velocity trajectories in the proposed method are smooth. The image errors of the proposed IBVS controller are stable around zero and are bounded within ±10 pixels.

The root mean square error (RMSE) and standard deviation (STD) are presented in Table 1. The RMSE statistics in Table 1 indicate that the steady-state errors of the proposed IBVS controller are smaller than those of the controller in Ref. [24]. In addition, the STD statistics indicate that the attitude motion of the proposed IBVS controller is smoother than that of the comparison controller.

In general, the image, translational velocity, and attitude motions of the proposed IBVS controller are smooth, resulting in the stable tracking performance of the UAV. The proposed IBVS controller achieves proximity anti-disturbance capability as the comparison controller without the condition of translational velocity measurements. The proposed method can achieve satisfactory tracking accuracy for tracking rotating targets.

5. Experimental results

In this section, a custom-built UAV is used to demonstrate the feasibility of the proposed method. The experimental setup and process are described, and experimental data are provided to illustrate the control performance of the proposed method. The experimental video is available from Appendix A.

5.1. Experimental setup

In the experiments, a quadrotor platform is adopted to verify the feasibility of the proposed dynamic IBVS controller. Based on our previous work [31], a custom-built UAV with an onboard computer, an Ardupilot flight controller, and a monocular camera is used as the primary platform. The hardware structure of the UAV system is shown in Fig. 11. In particular, the embedded Ardupilot provides accurate angular velocities and roll-pitch angles for implementing low-level attitude control by means of an extended Kalman filter (EKF). Optical flow and distance sensors are utilized for the loiter mode to ensure flight safety. An onboard computer is utilized for image processing and controller calculating; it connects with the flight controller through micro air vehicle link (Mavlink) for attitude measurement acquisition and control signal transmission. The ground station communicates with the onboard computer through wireless fidelity (WiFi) and is utilized to switch the IBVS controller. The control time step is set to 0.025 s, and the resolution and sampling frequency of the camera are 320 × 240 and 60 Hz, respectively. The open-source tag detection AprilTag2 [32] is adopted to acquire image features and UAV relative positions. The selected feature points s a, s b, s c, and s i are shown in Fig. 11. The geometric parameters of the dynamic target are α i = 0, β i = 0.5, and γ i = 0.5, respectively. A mobile robot is utilized as the dynamic target, and wheel odometry is adopted to obtain the position of the mobile robot. A propeller providing wind with a velocity of 10 m·s−1 is used to simulate external disturbances. The experiments are implemented without external positioning conditions, such as GPS or a Vicon system.

The experiments are executed in four stages: ① visual positioning from t = 0 to 12 s, ② target tracking from t = 12 to 32 s, ③ tracking under a disturbance from t = 32 to 42 s, and ④ positioning under a disturbance from t = 42 to 68 s. First, the IBVS controller is activated to approach and maintain a fixed relative distance from the target. Second, the tracked target moves with a trajectory of p t a = 0.1 , 0.05 cos 0.42 t tanh 0.05 t , 0, and the tracked target rotates correspondingly with a yaw angle of arcsin[ 0.5 cos 0.42 t tanh 0.05 t ]. Then, the UAV enters the area disturbed by the wind and continues tracking the target. Finally, the mobile robot stops moving and the UAV maintains its positioning under the disturbance. Detailed experimental configurations are as follow: M = 0.8 kg; control time step Δt = 0.02 s; desired position of the UAV relative to the target p t c = 1 , 0 , 0 m. The desired pixels of s a, s b, s c, and s i are s a = 20 , 20, s b = 20 , 20, s c = 20 , 20, and s i = 0 , 0, respectively. The controller parameters are set as k 1 = 2, k 2 = 3, k 3 = 1, and k 4 = 3.

5.2. Experimental results and analysis

Snapshots of the experiment are shown in Fig. 12, and the experimental results are shown in Fig. 13, Fig. 14, Fig. 15, Fig. 16, Fig. 17, Fig. 18, Fig. 19. The Euler angle of the tracked target is shown in Fig. 20. The UAV position and three-dimensional (3D) trajectories obtained by the wheel odometer of the mobile robot and AprilTag are depicted in Fig. 13, Fig. 14. The image moments and pixel convergence trajectories are presented in Fig. 15, Fig. 16, respectively. The outputs of the velocity observer and integral-based filters are shown in Fig. 17, Fig. 18.

In the visual positioning stage, the quadrotor converges to the desired position within 5 s when the IBVS controller is activated and hovers at a relative position of approximately 1 m behind the tracked target. The estimation error of the relative velocity δ ˜ converges to zero and remains within ±0.05 m·s−1. The positioning and image errors remain within ±0.1 m and ±10 pixels, respectively. The estimated disturbance of the upper bound converges at approximately 1.1 N. The image depth estimation error remains within ±0.02 m.

In the target-tracking stage, the mobile robot is set to move along the given trajectory, and the UAV starts tracking the target. Due to the unknown acceleration of the tracked target, the tracking errors of the UAV are bounded within ±0.15 m. The estimation errors of the relative velocities and image depth are maintained within ±0.05 m·s−1 and ±0.02 m, respectively. Thanks to the accurate velocity estimation, the UAV can maintain stable dynamic target tracking.

During tracking in the disturbance stage, the UAV enters the disturbance area. Due to the disturbance, the estimation of the disturbance upper bound increases and converges to 1.35 N. The estimation error of the image depth converges to a bounded value within ±0.06 m. The UAV can remain stable and maintain a tracking error of ±0.2 m by compensating for the integral-based filter.

When positioning during the disturbance stage, the UAV stops tracking as the tracked target stops moving. The UAV hovers under the disturbance and remains at a distance of 1 m from the target. Although the tracking error of the UAV increases compared with that in the visual positioning stage, the UAV still hovers with a stable attitude and maintains a positioning accuracy within ±0.2 m.

In general, the proposed IBVS method is effective for UAV tracking dynamic targets in GPS-denied environments. The control uncertainty generated by external disturbances and the dynamic rotation of the tracking target can be mitigated using the proposed IBVS method.

6. Conclusions

This study proposed a dynamic IBVS method based on a velocity observer that improves the tracking performance of a UAV under unpredictable disturbances. The proposed method derives the image dynamics using multiple feature points of a virtual camera. The image dynamics of an underactuated UAV can be decoupled and simplified based on a virtual camera. A novel image depth model was proposed to enable a UAV to track a rotating target with an arbitrary orientation, and a velocity observer was proposed to estimate the relative velocity between the UAV and a dynamic target. Furthermore, unpredictable disturbances were estimated by means of an integral-based filter and were compensated for in the observer and IBVS controller design. The stabilities of the proposed velocity observer and IBVS method were analyzed based on the Lyapunov theory. A comparative simulation and an experiment with multiple stages were conducted to verify the effectiveness and robustness of the proposed dynamic IBVS method. In our future research, the proposed dynamic IBVS method will be applied in practical application scenarios of UAV, for purposes such as capturing dynamic targets and autonomous landing.

Acknowledgments

This work was supported in part by the National Key Research and Development Program of China (2021ZD0114503, 2022YFB4701800, and 2021YFB1714700), the National Natural Science Foundation of China (62273098, 62027810, 61971071, 62133005, 62273138, and 62103140), the Major Research Plan of the National Natural Science Foundation of China (92148204), the Newton International Fellowships 2022 funded by the Royal Society, UK (NIF\R1\221089), Hunan Leading Talent of Technological Innovation (2022RC3063), Hunan Science Fund for Distinguished Young Scholars (2021JJ10025), the Hunan Key Research and Development Program (2021GK4011 and 2022GK2011), the Changsha Science and Technology Major Project (kh2003026), the Natural Science Foundation of Hunan Province (2021JJ20029 and 2021JJ40124), the Science and Technology Innovation Program of Hunan Province (2021RC3060), the Joint Open Foundation of the State Key Laboratory of Robotics (2021-KF-22-17), and the China University Industry-University-Research Innovation Fund (2020HYA06006).

Compliance with ethics guidelines

Yanjie Chen, Yangning Wu, Limin Lan, Hang Zhong, Zhiqiang Miao, Hui Zhang, and Yaonan Wang declare that they have no conflict of interest or financial conflicts to disclose.

Appendix A. Supplementary material

Supplementary data to this article can be found online at https://doi.org/10.1016/j.eng.2023.05.017.

References

[1]

H.M. Chung, S. Maharjan, Y. Zhang, F. Eliassen, K. Strunz. Placement and routing optimization for automated inspection with unmanned aerial vehicles: a study in offshore wind farm. IEEE Trans Industr Inform, 17 (5) (2021), pp. 3032-3043.

[2]

F. Kendoul. Survey of advances in guidance, navigation, and control of unmanned rotorcraft systems. J Field Robot, 29 (2) (2012), pp. 315-378.

[3]

D. Scaramuzza, M.C. Achtelik, L. Doitsidis, F. Friedrich, E. Kosmatopoulos, A. Martinelli, et al. Vision-controlled micro flying robots: from system design to autonomous navigation and mapping in GPS-denied environments. IEEE Robot Autom Mag, 21 (3) (2014), pp. 26-40.

[4]

A. McFadyen, M. Jabeur, P. Corke. Image-based visual servoing with unknown point feature correspondence. IEEE Robot Autom Lett, 2 (2) (2017), pp. 601-607.

[5]

M.A. Rafique, A.F. Lynch. Output-feedback image-based visual servoing for multirotor unmanned aerial vehicle line following. IEEE Trans Aerosp Electron Syst, 56 (4) (2020), pp. 3182-3196.

[6]

P. Serra, R. Cunha, T. Hamel, D. Cabecinhas, C. Silvestre. Landing of a quadrotor on a moving target using dynamic image-based visual servo control. IEEE Trans Robot, 32 (6) (2016), pp. 1524-1535.

[7]

H. Xie, K.H. Low, Z. He. Adaptive visual servoing of unmanned aerial vehicles in GPS-denied environments. IEEE/ASME Trans Mechatron, 22 (6) (2017), pp. 2554-2563.

[8]

X. Zhang, Y. Fang, X. Zhang, J. Jiang, X. Chen. A novel geometric hierarchical approach for dynamic visual servoing of quadrotors. IEEE Trans Ind Electron, 67 (5) (2020), pp. 3840-3849.

[9]

K. Zhang, Y. Shi, H. Sheng. Robust nonlinear model predictive control based visual servoing of quadrotor UAVs. IEEE/ASME Trans Mechatron, 26 (2) (2021), pp. 700-708.

[10]

F. Chaumette. S. Hutchinson. Visual servo control. I. Basic approaches. IEEE Robot Autom Mag, 13 (4) (2006), pp. 82-90.

[11]

F. Chaumette. S. Hutchinson. Visual servo control. II. Advanced approaches. IEEE Robot Autom Mag, 14 (1) (2007), pp. 109-118.

[12]

H. Zhong, Z. Miao, Y. Wang, J. Mao, L. Li, H. Zhang, et al. A practical visual servo control for aerial manipulation using a spherical projection model. IEEE Trans Ind Electron, 67 (12) (2020), pp. 10564-10574.

[13]

N. Sun, T. Yang, H. Chen, Y. Fang. Dynamic feedback antiswing control of shipboard cranes without velocity measurement: theory and hardware experiments. IEEE Trans Industr Inform, 15 (5) (2019), pp. 2879-2891.

[14]

A. Abdessameud, A. Tayebi. Global trajectory tracking control of VTOL-UAVs without linear velocity measurements. Automatica, 46 (6) (2010), pp. 1053-1059.

[15]

X. Zhang, Y. Fang, X. Zhang, J. Jiang, X. Chen. Dynamic image-based output feedback control for visual servoing of multirotors. IEEE Trans Industr Inform, 16 (12) (2020), pp. 7624-7636.

[16]

H. Wang, D. Zheng, J. Wang, W. Chen, J. Yuan. Ego-motion estimation of a quadrotor based on nonlinear observer. IEEE/ASME Trans Mechatron, 23 (3) (2018), pp. 1138-1147.

[17]

X. Shao, J. Zhang, W. Zhang. Distributed cooperative surrounding control for mobile robots with uncertainties and aperiodic sampling. IEEE Trans Intell Transp Syst, 23 (10) (2022), pp. 18951-18961.

[18]

J. Zhang, X. Shao, W. Zhang, J. Na. Path-following control capable of reinforcing transient performances for networked mobile robots over a single curve. IEEE Trans Inst Meas, 72 (2023), pp. 1-12.

[19]

D. Lee, T. Ryan, H.J. Kim. Autonomous landing of a VTOL UAV on a moving platform using image-based visual servoing. Proceedings of 2012 IEEE International Conference on Robotics and Automation (ICRA); 2012 May 14-18; Saint Paul, MN, USA, IEEE (2012), pp. 971-976.

[20]

H. Jabbari Asl, G. Oriolo, H. Bolandi. Output feedback image-based visual servoing control of an underactuated unmanned aerial vehicle. Proc Inst Mech Eng Part I J Syst Control Eng, 228 (7) (2014), pp. 435-448.

[21]

Z. Cao, X. Chen, Y. Yu, J. Yu, X. Liu, C. Zhou, et al. Image dynamics-based visual servoing for quadrotors tracking a target with a nonlinear trajectory observer. IEEE Trans Syst Man Cybern Syst, 50 (1) (2020), pp. 376-384.

[22]

J. Lin, Y. Wang, Z. Miao, H. Zhong, J. Nie, R. Fierro. Robust image-based landing control of a quadrotor on an unknown moving platform using circle features. Proceedings of 2021 IEEE International Conference on Real-Time Computing and Robotics (RCAR);2021 Jul 15-19; Xining, China, IEEE (2021), pp. 177-182.

[23]

D. Zheng, H. Wang, J. Wang, S. Chen, W. Chen, X. Liang. Image-based visual servoing of a quadrotor using virtual camera approach. IEEE/ASME Trans Mechatron, 22 (2) (2017), pp. 972-982.

[24]

J. Li, H. Xie, K.H. Low, J. Yong, B. Li. Image-based visual servoing of rotorcrafts to planar visual targets of arbitrary orientation. IEEE Robot Autom Lett, 6 (4) (2021), pp. 7861-7868.

[25]

J. Liang, Y. Chen, N. Lai, B. He, Z. Miao, Y. Wang. Low-complexity prescribed performance control for unmanned aerial manipulator robot system under model uncertainty and unknown disturbances. IEEE Trans Industr Inform, 18 (7) (2022), pp. 4632-4641.

[26]

W. Zhang, X. Shao, W. Zhang, J. Qi, H. Li. Unknown input observer-based appointed-time funnel control for quadrotors. Aerosp Sci Tech, 126 (2022), 107351.

[27]

Z. Zhang, Y. Chen, Y. Wu, L. Lin, B. He, Z. Miao, et al. Gliding grasping analysis and hybrid force/position control for unmanned aerial manipulator system. ISA Trans, 126 (2022), pp. 377-387.

[28]

H. Xie, A.F. Lynch, K.H. Low, S. Mao. Adaptive output-feedback image-based visual servoing for quadrotor unmanned aerial vehicles. IEEE Trans Control Syst Technol, 28 (3) (2020), pp. 1034-1041.

[29]

V. Kumar, N. Michael. Opportunities and challenges with autonomous micro aerial vehicles. Int J Robot Res, 31 (11) (2012), pp. 1279-1291.

[30]

E. Fresk, G. Nikolakopoulos. Full quaternion based attitude control for a quadrotor. Proceedings of 2013 European Control Conference (ECC);2013 Jul 17-19; Zurich, Switzerland, IEEE (2013), pp. 3864-3869.

[31]

N. Lai, Y. Chen, J. Liang, B. He, H. Zhong, Y. Wang. An onboard-eye-to-hand visual servo and task coordination control for aerial manipulator based on a spherical model. Mechatronics, 82 (2022), 102724.

[32]

J. Wang, E. Olson. AprilTag 2:efficient and robust fiducial detection. Proceedings of 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS); 2016 Oct 9-14; Daejeon, Republic of Korea, IEEE (2016), pp. 3400-3407.

RIGHTS & PERMISSIONS

THE AUTHOR

PDF (4525KB)

Supplementary files

Supplementary Material

8643

Accesses

0

Citation

Detail

Sections
Recommended

/