Professional Documents
Culture Documents
Abstract In this paper, we presents a systematic approach computational complexity. Here, due to hardware limitation
to the vision based ground object tracking problem of a low of AR.Drone, color based thresholding method is employed
cost AR.Drone quadrotor, using Hybrid Terminal Sliding to identify and estimate the targets position on the relative
Mode Controller (HTSM), based on nonsingular terminal reference of image frames captured from its integrated
sliding mode (NTSM) and higher order sliding mode (HOSM).
In this approach, NTSM manifold is used to provide fast
vision aids.
convergence and better tracking precision while HOSM control Here, the current scope of this paper is the systematic
law is utilized to eliminate chattering phenomenon. The formulation of the tracking problem into a closed-loop
Experimental results demonstrate that the proposed HTSM control system design which requires an explicit
approach outperforms conventional PD and sliding mode mathematical model of AR.Drone coordinate motion with
tracking controllers in terms of response speed, tracking respect to the target being tracked and appropriate control
precision and robustness.
algorithm. In this study, due to a number of factors including
poor resolution of AR.Drones vision systems, external
I. INTRODUCTION
environment noise and disturbance, model of such a system
In recent years, the miniature UAV as quadrotor has will consist of significant uncertainty in its parameters which
gained much popularity in a wide range of research and provide promising space for sliding mode controller to work.
application, i.e. [1]-[15]. Micro-quadcopter such as the That is in comparison with other methods, sliding mode
commercially available AR.Drone has been used as a controller has been attractively proven to be advantageous in
common research platform in educational laboratories due to terms of robustness to disturbance and low sensitivity to the
its low cost, small size, stability as well as agility to fly in systems parameters. However, chattering phenomenon has
small indoor environment [5]. been the major drawback of conventional sliding mode
The AR.Drone is equipped with a number of relevant on- control. That is switching control input will cause
board sensors and vision systems which enable the undesirable phenomenon of oscillation having finite
application of various vision based control and estimation frequency and amplitude. In order to avoid or at least reduce
algorithms [5]. However, its application are rather more this phenomenon, several attempts have been made. One of
restrictive than the ones normally bearing on micro UAV such is to use saturation or sigmoid function in replacement
applications. The challenge here is the problem of localizing of the discontinuous control in a boundary layer of the
the robot purely from its sensors and the capability to sliding mode manifold [16]. This method however could not
robustly navigate it under potential sensor loss. This is even guarantee the convergence of tracking error to zero within
at great importance to be addressed under low cost hardware such a boundary layer.
with inaccurate actuators, noisy sensors, low quality on- Another way to avoid chattering is to use higher order
board vision system, significant delays and limited sliding mode (HOSM) since HOSM uses continuous signals
computational resources. It, in turn, initiates a number of instead of discontinuous switching signals [17-22]. Here, in
interesting research questions. this paper, we combine Nonsingular Terminal Sliding Mode
One of the most popular vision based problems that UAV Manifold and HOSM in order to formulate the so called
has to solve is to track target by processing images acquired hybrid terminal sliding mode (HTSM) control system [21-
by its integrated cameras, i.e. [6]-[15]. This can be 22] for the tracking problem of AR.Drone. Within this set-
accomplished by a number of methods, ranging from shape / up, NTSM manifold is designed to improve convergence
pattern matching, i.e. [9] , using given targets model to speed and tracking precision; while HOSM control law
much simpler non-model based approach like color based guarantees the systems stability. In such a manner, the
detection using thresholding, i.e. [10], which is easy to control signal is continuous instead of being discontinuous
construct real time operation for its relatively low switching signal as in the conventional sliding mode control,
thus provide smooth control over the quadrotor objects
tracking problem.
Chi-Tinh Dang and Hoang-The Pham are students at the Department of
Mechatronics Engineering, HCMC University of Technical Education,
Vietnam. Email:{ ctdang, htpham }@irobotics.ac.vn The paper is organized as follows. Section 2 briefly
Thanh-Binh Pham and Nguyen-Vu Truong are with the Institute of describes the hardware platform (the AR.Drone Ver 1.0).
Applied Mechanics and Informatics, Vietnam Academy of Science and
Technology. Email: {tbpham,nvtruong}@irobotics.ac.vn The vision based target detection algorithm is presented in
Section 3. Section 4 concerns the data based system
1. Tracking Initialization
Fig. 1 AR.Drone quadrotor version 1.0 The easiest way to excavate and segmentation an object
from a image is based on colors which are significantly
different from the object to its background. The acquired
AR.Drone is controlled by ARM9 processor (CPUs clock image of Ar. Drones camera is RGB format (Figure 4).
speed of 468MHz with 128MB DDRAM at 200MHz. Parrot, Here, in order to facilitate the color based image
the manufacturer, provides a console via ad-hoc wireless segmentation, the image is converted into HSV color space.
networks to control the drone using Ipad/ Iphone or Android
devices. Thanks to the supplied open-source SDK, several
control parameters of flight can be set via its API which also
provides access to the sensors data and images from the
cameras.
Similarly, HSV color space is consists of 3 matrices, 'Hue', IV. CONTROL SYSTEM DESIGN
'Saturation' and 'Value'. In OpenCV, value range for 'Hue',
In order to systematically and properly design the tracking
'Saturation' and 'Value' are respectively 0-179, 0-255 and 0-
controllers for AR. Drone, mathematical models for such a
255. 'Hue' represents the color, while 'Saturation' and
system performing such a task are required. Here, empirical
Value refer to the amount to which that respective color is
modeling approach, system identification technique, is
mixed with white and black correspondingly. In this study,
employed using the experimental input-output data acquired
the target (in red color as in Figure 5) has HSV values in
from the Drone (sampled at 20ms).
between 170-180, 160-255, 60-255 respectively, in which
the Hue is unique for that specific color distribution of the A. System Identification
object, while Saturation and Value may vary according to Data collection exercise has been performed with the (1)
the environments lighting conditions. inputs as the control commands Ux and Uy command sent to
AR.Drone to make it move left-right or forward-backward ,
and (2) outputs as error in pixels of the object on ground
against the central point of each video frame acquired from
its vertical camera. Note that X direction in 2D video frame
is controlled by roll angle while Y direction is controlled by
pitch angle (Figure 7).
2. On-line Tracking
0.97035 - 0.094315
Ax =
0.024882 0.95547
(3)
0.0057989
Bx = , C x = [391.43 - 7.2361]
- 0.0033453
0.9468 0.11246
Ay =
- 0.037014 0.91153
(4)
- 0.013124
By = , C y = [- 185.89 - 3.2416]
- 0.0056251
Fig.10 Experiment Set-up Fig.11 X_direction: models predicted output (black) superimposed
on the actual measurement (blue)
dl x
= Ax l x + Bx u x
dt (1)
x = C xl x
Y_Direction:
dl y
= Ay l y + B y u y
dt (2)
y = C yl y
In which, {l x , x, u x }, {l y , y, u y } are the {state variable,
Fig.12 Y_direction: models predicted output (black) superimposed
position measured, control input} for X_direction and on the actual measurement (green)
Y_direction respectively; and
. .
The conventional sliding mode control law as in (6) is robust = ref ,i Ci Ai li ( ref ,i Ci Ai li + Ci Bi u n.i )
with respect to both the internal parameters uncertainties = Ci Bi u n ,i
and external disturbances of the system. However, this
discontinuous switching signal causes undesirable
chattering phenomenon of oscillation having finite .. . q . 2 p / q
e i = Ci Bi u n ,i = [ ei + K i sign( si ) + i si ]
frequency and amplitude. In order to eliminate such a p i
phenomenon, higher order sliding mode control based on . . p / q 1
nonsingular terminal sliding mode manifold (NTSM) is Vi = ei [ K i sign( si ) + i si ]si
applied to control such a system. . p / q 1
( K i sign( si ) si + i si )
2
= ei
C. HTSM Design . p / q 1
( K i || si || + i si )
2
With regarding to system represented by (5), in order to = ei
achieve better performance in term of fast convergence and
tracking precision, the NTSM manifold [21-22] is designed ( p q )
as below: . p / q 1 . 1/ q
ei = ei 0 since ( p q) is even number.
. p/q
si = ei + i e i (8)
where, i > 0;1 < p / q < 2 and p,qare odd numbers. .
This NTSM manifold (8) is used in order to realize second For || si || 0 , Vi 0 . There are two cases here. The first
order sliding mode control, and eliminate chattering . .
case is when ei = 0 , Vi = 0 but ei 0 . In this case, the
phenomenon. When s reaches zero in finite time, both ei and
.
state variable will not always stay at the point
.
ei will reach zero in finite time, and the system will stay on
( ei = 0 , ei 0 ), but will continue to cross the axis
.
the second order sliding mode ei = ei =0. Here, the HOSM . .
ei = 0 in the phase plane 0 ei ei [22].
control law is designed based on the following theorem.
.
Theorem 1. Consider a system which is represented by (5),
The second case is when ei 0 , then
and the NTSM manifold is chosen as in (8), the control law
is designed as . . p / q 1
( K i || si || + i si ) < 0
2
ui (t ) = ueq ,i (t ) + un ,i (t ) (9) Vi = ei
The study in [22] has shown that the system state can reach
with
the sliding manifold in finite time. Given t r ,i be the time
V. EXPERIMENTAL RESULTS
VI. CONCLUSION
A systematic approach for vision based ground target
tracking problem of AR.Drone using the so called Hybrid
Terminal Sliding Mode Control system is presented in this
paper. Hardware constraint of AR.Drones integrated vision
systems, in turn, creates a very interesting control problem
which involves both internal uncertainty, noise and external
disturbance.
The experimental results proves the superiority of HTSM
over conventional SM and classical PD controllers in
Fig.14 Stationary ground target tracking using conventional sliding providing smooth, precise tracking performance,its
mode controller: AR.Drone in blue, Target in yellow lines. robustness against noise, disturbance and internal
parameters uncertainty.
Here in order to facilitate the comparison, both HTSM and
conventional sliding mode controller are implemented in the REFERENCES
tracking of both stationary and moving target. As it shows in [1] R. W. Beard, Multiple UAV cooperative search under collision
Figure 13 and 14, HTSM control provides much better avoidance and limited range communication constraints, In Proc.
performance over the conventional sliding mode control. 2003 IEEE Conference on Decision and Control (CDC), 2003, pp.
2530.
[2] T. Tomic, K. Schmid, P. Lutz, A. Domel, M. Kassecker, E. Mair,I.L.
Figure 15 compares the tracking performance of HTSM Grixa, F. Ruess, M. Suppa, and D. Burschka, Toward a fully
controller versus conventional sliding mode and classical PD autonomous UAV: research platform for indoor and outdoor urban
controllers in the tracking exercise of ground moving target search and rescue, IEEE Robotics& Automation Magazine, 2012,
Vol. 19, No. 3, 46-56.
(where the ground target is moving in a triangle trajectory).