Quadrotor UAV Guidence For Ground Moving Target Tracking
محورهای موضوعی : Computer Architecture and Digital Systems
1 - School of Mechanical Engineering,University of Tehran,Tehran,Iran
کلید واژه: UAV, Modeling, Target tracking, Intelligent control,
چکیده مقاله :
The studies in aerial vehicles modeling and control have been increased rapidly recently. In this paper , a coordination of two types of heterogeneous robots , namely unmanned aerial vehicle (UAV) and unmanned ground vehicle (UGV) is considered. In this paper the UAV plays the role of a virtual leader for the UGVs. The system consists of a vision- based target detection algorithm that uses the color and image moment of a given target. The modeling of the vertical take off and landing vehicle will be described by using Euler - Newton equations. All of flight controller commands are directly generated based on the offset of the target from the image frame. The image processing and intelligent control algorithms such a Kalman filter and so on have been implemented on a latest computer. Matlab Simulink software has been used to test, analyze and compare the performance of the controllers in simulations .
[1]L. Consolini, F. Morbidi, D. Prattichizzo, and M. Tosques, "Stabilization of a hierarchical formation of unicycle robots with velocity and curvature constraints," IEEE Transactions On Robotics, vol. 25, no. 5, (2009), 1l76-1184.
[2]A. Gessow and G. Myers, Aerodynamics of the helicopter, Fredrick Ungar Publishing Co, New York, 1967.
[3]J. G. Leishman, Principles of Helicopter Aerodynamics, Cambridge University Press, 2000.
[4]M. J. Hirschberg, The American Helicopter: An overview of Helicopter Developments in America 1908-1999, 2000.
[5]P. Castillo, R. Lozano, and A. E. Dzul, Modeling and Control of Mini-flying Machines, Advances in Industrial Control Series, ISSN 1430-9491, Springer, 2005.
[6]H. Y. Chao, Y. C. Cao, and Y. Q. Chen, “Autopilots for small unmanned aerial vehicles: a survey,” International Journal of Control, Automation, and Systems, vol. 8, no. 1, (2010), 36-44.
[7]D. Lee, I. Kaminer, V. Dobrokhodov, and K. Jones, “Autonomous feature following for visual surveillance using a small unmanned aerial vehicle with gimbaled camera system,” International Journal of Control, Automation, and Systems, vol. 8, no. 5, (2010), 957-966.
[8]D. Han, J. Kim, C. Min, S. Jo, J. Kim, and D. Lee, “Development of unmanned aerial vehicle (UAV) system with waypoint tracking and vision-based reconnaissance,” International Journal of Control, Automation, and Systems, vol. 8, no. 5, (2010), 1091-1099.
[9]T. Schmitt, R. Hanek, S. B. Michael Beetz, and B. Radig, “Cooperative probabilistic state estimation for vision-based autonomous mobile robots,” IEEE Transactions on robotics and automation, vol. 18, no. 5, (2002), 670–684.
[10]I. Hwang, H. B. K. Roy, and C. Tomlin, “A distributed multipletarget identity management algorithm in sensor networks,” in Proceedings of the 43rd IEEE Conference on Decision and Control, 2010.
[11]L. Hong, N. Cui, M. T. Pronobis, and S. Scott, “Simultaneous ground moving target tracking and identification using q wavelets features from hrr data,” Information Science, vol. 162, (2004), 249–274.
[12]V. K. Chitrakaran, D. M. Dawson, W. E. Dixon, and J. Chen, “Identification of a moving objects velocity with a fixed camera,” Automatica, vol. 41, no. 3, (2005), 553–562.
[13]A. P. Aguiar and J. P. Hespanha, “Minimum-energy state estimation for systems with perspective outputs,” IEEE Transactions on Automatic Control, vol. 51, no. 2, (2006), 226–241.
[14]S. Martinez and F. Bullo, “Optimal sensor placement and motion coordination for target tracking,” Automatica, vol. 42, no. 4, (2006), 661–668.
[15]F. Khakpur and G. Ardeshir, “USING A NOVEL CONCEPT OF POTENTIAL PIXEL ENERGY FOR OBJECT TRACKING,” International Journal of Engineering Transactions A: Basics, vol. 27, no. 7, (2014), 1023-1032.
[16]F. Rafi, S. Khan, K. Shafiq, and M. Shah, “Autonomous target following by unmanned aerial vehicles,” in Proceedings, May 2006.
[17]R. A. and R. T. Rysdyk, “Uav coordination for autonomous target tracking,” in Proceedings of the AIAA Guidance, Navigation and Control, 2006.
[18]J. Lee, R. Huang, A. Vaughn, X. Xiao, and J. K. Hedrick, “Strategies of path-planning for a uav to track a ground vehicle,” in Proceedings of the 2nd annual Autonomous Intelligent Networks and Systems Conference, Menlo Park, CA, June 2003.
[19]Y. Bar-Shalom and T. E. Fortmann, Tracking and Data Association. MA: Academic Press, Boston, 1988.
[20]B. K. Ghosh and E. P. Loucks, “A realization theory for perspective systems with application to parameter estimation problems in machine vision,” in IEEE Transactions on Automatic Control, vol. 41, (1996), 1706-1722.
[21]K. Hashimoto and T. Noritsugu, “Observer-based control for visual servoing,” in Proc. 13th IFAC World Congress, San Francisco, California, (1996), 453–458.
[22]A. J. Koivo and N. Houshangi, “Real-time vision feed- back for servoing robotic manipulator with self-tuning controller,” in IEEE Transactions Systems, Man, and Cybernetics, vol. 21, (1991), 134–142.
[23]P. K. Allen, A. Timcenko, B. Yoshimi, and P. Michelman, “Trajectory filtering and prediction for automated tracking and grasping of a moving object,” in Proc. IEEE Conference on Robotics and Automation, (1992), 1850–1856.
[24]H. Shariat and K. Price, “Motion estimation with more than two frames,” in IEEE Transactions on PAMI, vol. 12, (1990), 417– 434.
[25]C. Teuliere, L. Eck, and E. Marchand, “Chasing a moving target from a flying uav,” in Int. Conference on Intelligent Robots and Systems, IROS, San Francisco, CA, 25-30 Sept., (2011), 4929 – 4934.
[26]F. Heintz, P. Rudol, and P. Doherty, “From images to traffic behavior - a uav tracking and monitoring application,” in 10th International Conference on Information Fusion, 9-12 July, 2007.
[27]J. Gomez-Balderas, S. Salazar, J. Guerrero, and R. Lozano, “Vision based autonomous hover of a mini-rotorcraft,” in Unmanned Aerial Vehicles Symposium, Dubai, Jun, 2010.
[28]J. Gomez-Balderas, P. Castillo, J. Guerrero, and R. Lozano, “Vision based tracking for a quadrotor using vanishing points,” Journal of Intelligent and Robotic Systems, vol. 65, no. 1-4, (2012) 361–371.
[29]S. S. Ponda, R. M. Kolacinski, and E. Frazzoli, “Trajectory optimization for target localization using small unmanned aerial vehicles,” in AIAA Guidance, Navigation, and Control Conference, Chicago, Illinois, USA, 10-13 August, 2009.
[30]H. Voos, “Nonlinear Control of a Quadrotor Micro-UAV Using Feedback-Linearization,” IEEE International Conference on Mechatronics, (2009), 1-6.
[1] L. Consolini, F. Morbidi, D. Prattichizzo, and M. Tosques, "Stabilization of a hierarchical formation of unicycle robots with velocity and curvature constraints," IEEE Transactions On Robotics, vol. 25, no. 5, (2009), 1l76-1184.
[2] A. Gessow and G. Myers, Aerodynamics of the helicopter, Fredrick Ungar Publishing Co, New York, 1967.
[3] J. G. Leishman, Principles of Helicopter Aerodynamics, Cambridge University Press, 2000.
[4] M. J. Hirschberg, The American Helicopter: An overview of Helicopter Developments in America 1908-1999, 2000.
[5] P. Castillo, R. Lozano, and A. E. Dzul, Modeling and Control of Mini-flying Machines, Advances in Industrial Control Series, ISSN 1430-9491, Springer, 2005.
[6] H. Y. Chao, Y. C. Cao, and Y. Q. Chen, “Autopilots for small unmanned aerial vehicles: a survey,” International Journal of Control, Automation, and Systems, vol. 8, no. 1, (2010), 36-44.
[7] D. Lee, I. Kaminer, V. Dobrokhodov, and K. Jones, “Autonomous feature following for visual surveillance using a small unmanned aerial vehicle with gimbaled camera system,” International Journal of Control, Automation, and Systems, vol. 8, no. 5, (2010), 957-966.
[8] D. Han, J. Kim, C. Min, S. Jo, J. Kim, and D. Lee, “Development of unmanned aerial vehicle (UAV) system with waypoint tracking and vision-based reconnaissance,” International Journal of Control, Automation, and Systems, vol. 8, no. 5, (2010), 1091-1099.
[9] T. Schmitt, R. Hanek, S. B. Michael Beetz, and B. Radig, “Cooperative probabilistic state estimation for vision-based autonomous mobile robots,” IEEE Transactions on robotics and automation, vol. 18, no. 5, (2002), 670–684.
[10] I. Hwang, H. B. K. Roy, and C. Tomlin, “A distributed multipletarget identity management algorithm in sensor networks,” in Proceedings of the 43rd IEEE Conference on Decision and Control, 2010.
[11] L. Hong, N. Cui, M. T. Pronobis, and S. Scott, “Simultaneous ground moving target tracking and identification using q wavelets features from hrr data,” Information Science, vol. 162, (2004), 249–274.
[12] V. K. Chitrakaran, D. M. Dawson, W. E. Dixon, and J. Chen, “Identification of a moving objects velocity with a fixed camera,” Automatica, vol. 41, no. 3, (2005), 553–562.
[13] A. P. Aguiar and J. P. Hespanha, “Minimum-energy state estimation for systems with perspective outputs,” IEEE Transactions on Automatic Control, vol. 51, no. 2, (2006), 226–241.
[14] S. Martinez and F. Bullo, “Optimal sensor placement and motion coordination for target tracking,” Automatica, vol. 42, no. 4, (2006), 661–668.
[15] F. Khakpur and G. Ardeshir, “USING A NOVEL CONCEPT OF POTENTIAL PIXEL ENERGY FOR OBJECT TRACKING,” International Journal of Engineering Transactions A: Basics, vol. 27, no. 7, (2014), 1023-1032.
[16] F. Rafi, S. Khan, K. Shafiq, and M. Shah, “Autonomous target following by unmanned aerial vehicles,” in Proceedings, May 2006.
[17] R. A. and R. T. Rysdyk, “Uav coordination for autonomous target tracking,” in Proceedings of the AIAA Guidance, Navigation and Control, 2006.
[18] J. Lee, R. Huang, A. Vaughn, X. Xiao, and J. K. Hedrick, “Strategies of path-planning for a uav to track a ground vehicle,” in Proceedings of the 2nd annual Autonomous Intelligent Networks and Systems Conference, Menlo Park, CA, June 2003.
[19] Y. Bar-Shalom and T. E. Fortmann, Tracking and Data Association. MA: Academic Press, Boston, 1988.
[20] B. K. Ghosh and E. P. Loucks, “A realization theory for perspective systems with application to parameter estimation problems in machine vision,” in IEEE Transactions on Automatic Control, vol. 41, (1996), 1706-1722.
[21] K. Hashimoto and T. Noritsugu, “Observer-based control for visual servoing,” in Proc. 13th IFAC World Congress, San Francisco, California, (1996), 453–458.
[22] A. J. Koivo and N. Houshangi, “Real-time vision feed- back for servoing robotic manipulator with self-tuning controller,” in IEEE Transactions Systems, Man, and Cybernetics, vol. 21, (1991), 134–142.
[23] P. K. Allen, A. Timcenko, B. Yoshimi, and P. Michelman, “Trajectory filtering and prediction for automated tracking and grasping of a moving object,” in Proc. IEEE Conference on Robotics and Automation, (1992), 1850–1856.
[24] H. Shariat and K. Price, “Motion estimation with more than two frames,” in IEEE Transactions on PAMI, vol. 12, (1990), 417– 434.
[25] C. Teuliere, L. Eck, and E. Marchand, “Chasing a moving target from a flying uav,” in Int. Conference on Intelligent Robots and Systems, IROS, San Francisco, CA, 25-30 Sept., (2011), 4929 – 4934.
[26] F. Heintz, P. Rudol, and P. Doherty, “From images to traffic behavior - a uav tracking and monitoring application,” in 10th International Conference on Information Fusion, 9-12 July, 2007.
[27] J. Gomez-Balderas, S. Salazar, J. Guerrero, and R. Lozano, “Vision based autonomous hover of a mini-rotorcraft,” in Unmanned Aerial Vehicles Symposium, Dubai, Jun, 2010.
[28] J. Gomez-Balderas, P. Castillo, J. Guerrero, and R. Lozano, “Vision based tracking for a quadrotor using vanishing points,” Journal of Intelligent and Robotic Systems, vol. 65, no. 1-4, (2012) 361–371.
[29] S. S. Ponda, R. M. Kolacinski, and E. Frazzoli, “Trajectory optimization for target localization using small unmanned aerial vehicles,” in AIAA Guidance, Navigation, and Control Conference, Chicago, Illinois, USA, 10-13 August, 2009.
[30] H. Voos, “Nonlinear Control of a Quadrotor Micro-UAV Using Feedback-Linearization,” IEEE International Conference on Mechatronics, (2009), 1-6.
2
Journal of Advances in Computer Engineering and Technology
Quadrotor UAV Guidence For Ground Moving Target Tracking
Abstract— The studies in aerial vehicles modeling and control have been increased rapidly recently. In this paper, a coordination of two types of heterogeneous robots, namely unmanned aerial vehicle (UAV) and unmanned ground vehicle (UGV) is considered. The UAV plays the role of a virtual leader for the UGVs. The system consists of a vision- based target detection algorithm that uses the color and image moment of a given target. The modeling of the VTOL vehicle will be described by using Euler-Newton equations. Flight controller commands are directly generated based on the offset of the target from the image frame. The image processing and intelligent control algorithms have been implemented on a latest computer. Matlab Simulink has been used to test, analyze and compare the performance of the controllers in simulations2.
Index Terms— UAV, Intelligent control, Modeling, Target tracking
I. INTRODUCTION
M
ulti agent systems have received considerable attention in recent years. It is due to their advantages in accomplishing complex missions such as discoveries, surveillance, disaster monitoring and so on. One of the attractive scenarios for multi agent systems is formation. Indeed formation control can be considered as controlling relative position and orientation of robots in a team [1]. Formation control has been investigated in three main approaches in the literature, namely: Leader-Follower, behavioral and virtual structures. In the leader-follower approach, one agent, designed as a leader, moves along a predefined trajectory, and the other ones should maintain a desired distance and orientation to the leader [1].
Helicopter design has been the center of attention since the beginning of the 20th century. First full-scale four rotor helicopter (quadrotor) was built by Debothezat in 1921 [2]. Other examples are Breguet Richet helicopter, Oemnichen helicopter, Convertawings Model A and Curtis Wright VZ-7 [3, 4]. At those early times due to the lacking control and sensing technologies, it was not possible to build an unmanned vehicle. Advances in sensors, control technology and electronics enable the possibility of that. Currently, there are various commercial and experimental autonomous unmanned VTOL vehicles are being developed at universities, research centers, and by hobbits [5-8].
UAV hovering over a desired position requires information coming from varied sensors, more precisely, it requires data coming from UAV environment. A sensor capable to obtain abundant information of UAV environment is a vision system. Many results related to this topic have been presented in the last few years. Most of them are related to identification and classification of multiple targets [9-15]. A circular pattern navigation algorithm for autonomous target tracking has been studied in [16] and [17] showing a good performance supported by numerical simulations.
Other work trajectory acquisition from video includes particle filters for moving cameras without any stabilization [18] and the Joint Probabilistic Data Association Filter (JPDAF) for tracking multiple targets with unreliable target identification [19]. If a model for the object’s motion is known, an observer can be used to estimate the object’s velocity [20]. In [21], an observer for estimating the object velocity was utilized; however, a description of the object’s kinematics must be known. In [22] an autoregressive discrete time model is used to predict the location of features of a moving object. In [23], trajectory filtering and prediction techniques are utilized to track a moving object. In [24], object-centered models are utilized to estimate the translation and the center of rotation of the object. Several interesting works have been presented concerning visual tracking of targets using UAVs. In [25] a color based tracker is proposed to estimate the target position, while in [26] thermal images are correlated with a geographical information system (GIS) towards the same goal. In [27] a vision-based control algorithm for stabilizing a UAV equipped with two cameras is presented. The same system has been used in [28] to track a line painted in a wall, using a vanishing points technique. Some methods for designing UAV trajectories that increase the amount of information available are presented in [29].
The description of this paper is about using a vision system to observe a visual target over a ground vehicle and tracking it by using an UAV quadrotor. The main challenge involved in target localization include maintaining the target inside the camera’s field of view. In order to achieve this requirement, a control schema have been proposed that develops a quadrotor tracking, such the target localization estimation error is minimized. To successfully perform this task, a control strategy which will be explained, have been developed.
This paper will be presented a new system for controlling and tracking in the quadrotor. The performances of this method are compared to other methods in the literature, Matlab simulations have been used for this.
The paper is structured as followings: In section 2 the mathematical model of the quadrotor is described. The controllers are presented in section 3. The simulations supporting the objectives of the paper are presented in section 4. And finally concluding remarks are presented in section 5.
II. Matemathical model of the quadrotor
Generally, the quadrotor can be modeled with a four rotors in cross configuration. The throttle movement is provided by increasing (or decreasing) all the rotor speeds by the same amount. It leads a vertical force u1 (N) with respect to body-fixed frame which raises or lowers the quadrotor.
The roll movement is provided by increasing (or decreasing) the left rotor's speed and at the same time decreasing (or increasing) the right rotor's speed. The pitch movement is provided by a same way but with other two motors. The front and rear motors rotate counter-clockwise while other two motors rotate clockwise, so yaw command is derived by increasing (or decreasing) counter-clockwise motors speed and at the same time decreasing (or increasing) clockwise motor speeds.
Fig. 1. Configuration, inertial and body fixed frame [30].
In order to model the quadrotor dynamics, two frames have to be defined as showed in figure 1. The orientation of the quadrotor is given by the three Euler angles, which are roll angle 
, pitch angle 
and yaw angle 
.
These three Euler angles form the vector 
. The position of the vehicle in the inertial frame is given by the vector 
. The transformation of vectors from the body fixed frame to the inertial frame is given by the rotation matrix R where 
for example denotes 
and 
denotes 
.
The thrust force generated by rotor 
is 
, where 
is the thrust factor and 
is the rotational speed of rotor 
. Then the thrust force applied to the airframe from the four rotors is given by
(2)
Now the first set of differential equation that describes the acceleration of the quadrotor can be written as:
(3)
With inertia matrix 
(which is diagonal matrix with the inertias 
and 
on the main diagonal), the rotor inertia 
, the vector 
that describes the torque applied to the vehicle's body and the vector 
of the gyroscopic torques we obtain a second set of differential equations:
(4)
The vector is defined as:
(5)
The four rotational velocities 
of the rotors are the input variables of the real vehicle, but with regard to the obtained model a transformation of the input is suitable. Therefore, the artificial input variables can be defined as follows:
(6)
(7)
(8)
(9)
Where 
(6) denotes the thrust force applied to the quadrotor airframe; 
denotes the force which leads to the roll torque; 
for the pitch torque and 
for the yaw torque.
However, also the gyroscopic torques depend on the rotational velocities of the rotors and hence on the vector 
of the transformed input variables. We assume that:
(10)
And then evaluation of (4) and (5) yields the overall dynamic model in the following form:
(11)
(12)
(13)
(14)
(15)
(16)
Equations (11) to (16) represent the full mathematical model of the quadrotor.
III. Control algorithms design
In this section, a new algorithms for controlling the attitude and position of the quadrotor will be presented; that the proportional Integral Derivative (PID) controllers is assumed to perform this tasks.
As mentioned before the inputs chose like equations (6) to (9). Where 
controls the motion along the z-axis, controls rotation along the x-axis (roll angle), controls the rotation along the y-axis (pitch angle) and controls rotation along the z-axis (yaw angle). Two other controllers which control the position of the quadrotor (x and y) use some equations that comes in follow paragraphs. The designed controllers should set values to 
parameters which determines the four rotor speed parameters by (6) to (9).
First of all, an overview of the algorithms used in the simulation will be shown. The aim of this paper is hunted down a moving target by a quadrotor UAV. Thus a specific algorithm must be able to identify and follow the target by getting the position of the target and predicting desired path of the target by using a certain algorithm. An overview of the work come in the figure 2.
Fig. 2. Overview of the work
Now the system in figure 2 must be simulated to ensure of performances of the applied systems and algorithms. In this paper the MATLAB and Simulink have been used to simulate the system. Now the details of each block in the algorithm, must be explained.
1. Image processing and target detection algorithm
Video tracking use in many applications such as traffic monitoring, detection and identification of unusual behavior in the scene, navigation and human-computer communication such as gestures recognition and other applications.
This project is intended to detect a red moving target by using a digital camera that is fixed on the top of a laboratory environment and estimate path of the object for identifying and tracking by using Kalman filter algorithm. This path will be sent to the quadrotor processing system to follow the moving target. A test sample was carried out for this project is came in figure 3.
Fig. 3. Track the red moving target and path estimation
2. Kalman filter
The Kalman filter is a linear recursive estimator that predicts the next state based on dynamics model and update this result agrees with the measurements obtained.
In this paper for estimating the position of the moving target in a two-dimensional space of a series of noisy inputs and past positions, the Kalman filter have been used.
Fig. 4. Estimation of the path of the moving target using Kalman filter
With this algorithm, in order to estimate the path of the moving target, image processing have been used and data sent to the control center of the quadrotor to pass this estimated path. Figure 4 shows actual path of the moving target achieved by using image processing and the Kalman filter estimated path to have a compare between both of them.
3. Classical PID controller
Due to their simple structure and robust performance, proportional-integral-derivative (PID) controllers are the most commonly used controllers in industrial process control. The equation of a PID controller has the following form:
(17)
Where 
,
and 
are called the propositional, integral and derivative gains, respectively.
For adjusting the controller parameters the Ziegler-Nichols method will be used and response of the system with this adjusting will be showed in the result section.
In the simulations were performed, to control the position or following the path of a moving target, six different controllers is used. In the figure 5 overview of the control system of the quadrotor can be seen which two different control systems have been used for position control (internal and external control system).
Fig. 5. Overview of the position control system of the quadrotor
Internal control system is attitude control and external control system is position controller. In the following some equations for position control of the quadrotor can be seen.
Fig. 6. A view of the current position and desired position of the quadrotor
(18)
and 
are desired coordinates are obtained from Kalman filter algorithm.
The controllers are try to decrease d which is the distance between the current position and desired position. Requirement forces which must be applied into the quadrotor to compensate for the distance created as follows.
To revert to the original path and producing the requirement forces from actuators truly, the quadrotor must be in special attitude. Following equations can be used to obtain Euler angles at any moment.
Output signal of the position control assumed to be 
. The quadrotor need to another controller to have a constant height above the moving target. this height is assumed to be 5 meters.
IV. Results and simulation study
The mathematical dynamical model of the quadrotor vehicle as well as the controllers and algorithms have been developed in Matlab Simulink for simulation. The goal of this analysis is to test how well the controllers can make the quadrotor track the ground moving target. The quadrotor starts from position [0, 0, 5] and target starts from position [4, 0.2, 0]. The quadrotor is commanded to follow the target.
The results of simulations are shown in Figure 7 to Figure 12. From Figure 7 response of the quadrotor for the roll angle control can be seen. Figure 8 shows the response for the pitch angle control and Figure 9 shows response of the quadrotor for the yaw angle control.
Fig. 7. The roll angle control of the quadrotor (red solid line) and desired angle (blue dashed line)
Fig. 8. The Pitch angle control of the quadrotor (red solid line) and desired angle (blue dashed line)
Fig. 9. The yaw angle control of the quadrotor (red solid line) and desired angle (blue dashed line)
Fig. 10. Target tracking, the position of the moving target (green dashed line) and controlled position of the quadrotor (blue solid line)
Fig. 11. Target tracking, the position of the moving target (green dashed line) and controlled position of the quadrotor (blue solid line) (only x and y)
Fig. 12. Target tracking, the position of the moving target (green dashed line) and controlled position of the quadrotor (blue solid line) (only Altitude)
V. Conclusion
In the previous section the control and guidance algorithms are presented and the results are shown using different figures. According to the results, quadrotor always is within a cone with a radius of half a meter and a height of 5 meters above the ground moving target that represents a very good performance of algorithms and designed controllers.
The ground moving target detection and path of target detection algorithm that achieved based on image processing work very well and satisfy any desired commands. Also from figures can understand that using the Kalman filter algorithm to estimate the path of moving target have high performance when images have noise and distortion.
PID controllers which used for attitude and position control of the quadrotor worked very well and the quadrotor is so close to the target any moment.
Appendix
Some constant's values which used in the simulation of the quadrotor are showed in Table. 1. This constant's values selected from a real quadrotor in laboratory of mechatronic in the University of Tehran.
TABLE I Table of constants
|
References
[1] L. Consolini, F. Morbidi, D. Prattichizzo, and M. Tosques, "Stabilization of a hierarchical formation of unicycle robots with velocity and curvature constraints," IEEE Transactions On Robotics, vol. 25, no. 5, (2009), 1l76-1184.
[2] A. Gessow and G. Myers, Aerodynamics of the helicopter, Fredrick Ungar Publishing Co, New York, 1967.
[3] J. G. Leishman, Principles of Helicopter Aerodynamics, Cambridge University Press, 2000.
[4] M. J. Hirschberg, The American Helicopter: An overview of Helicopter Developments in America 1908-1999, 2000.
[5] P. Castillo, R. Lozano, and A. E. Dzul, Modeling and Control of Mini-flying Machines, Advances in Industrial Control Series, ISSN 1430-9491, Springer, 2005.
[6] H. Y. Chao, Y. C. Cao, and Y. Q. Chen, “Autopilots for small unmanned aerial vehicles: a survey,” International Journal of Control, Automation, and Systems, vol. 8, no. 1, (2010), 36-44.
[7] D. Lee, I. Kaminer, V. Dobrokhodov, and K. Jones, “Autonomous feature following for visual surveillance using a small unmanned aerial vehicle with gimbaled camera system,” International Journal of Control, Automation, and Systems, vol. 8, no. 5, (2010), 957-966.
[8] D. Han, J. Kim, C. Min, S. Jo, J. Kim, and D. Lee, “Development of unmanned aerial vehicle (UAV) system with waypoint tracking and vision-based reconnaissance,” International Journal of Control, Automation, and Systems, vol. 8, no. 5, (2010), 1091-1099.
[9] T. Schmitt, R. Hanek, S. B. Michael Beetz, and B. Radig, “Cooperative probabilistic state estimation for vision-based autonomous mobile robots,” IEEE Transactions on robotics and automation, vol. 18, no. 5, (2002), 670–684.
[10] I. Hwang, H. B. K. Roy, and C. Tomlin, “A distributed multipletarget identity management algorithm in sensor networks,” in Proceedings of the 43rd IEEE Conference on Decision and Control, 2010.
[11] L. Hong, N. Cui, M. T. Pronobis, and S. Scott, “Simultaneous ground moving target tracking and identification using q wavelets features from hrr data,” Information Science, vol. 162, (2004), 249–274.
[12] V. K. Chitrakaran, D. M. Dawson, W. E. Dixon, and J. Chen, “Identification of a moving objects velocity with a fixed camera,” Automatica, vol. 41, no. 3, (2005), 553–562.
[13] A. P. Aguiar and J. P. Hespanha, “Minimum-energy state estimation for systems with perspective outputs,” IEEE Transactions on Automatic Control, vol. 51, no. 2, (2006), 226–241.
[14] S. Martinez and F. Bullo, “Optimal sensor placement and motion coordination for target tracking,” Automatica, vol. 42, no. 4, (2006), 661–668.
[15] F. Khakpur and G. Ardeshir, “USING A NOVEL CONCEPT OF POTENTIAL PIXEL ENERGY FOR OBJECT TRACKING,” International Journal of Engineering Transactions A: Basics, vol. 27, no. 7, (2014), 1023-1032.
[16] F. Rafi, S. Khan, K. Shafiq, and M. Shah, “Autonomous target following by unmanned aerial vehicles,” in Proceedings, May 2006.
[17] R. A. and R. T. Rysdyk, “Uav coordination for autonomous target tracking,” in Proceedings of the AIAA Guidance, Navigation and Control, 2006.
[18] J. Lee, R. Huang, A. Vaughn, X. Xiao, and J. K. Hedrick, “Strategies of path-planning for a uav to track a ground vehicle,” in Proceedings of the 2nd annual Autonomous Intelligent Networks and Systems Conference, Menlo Park, CA, June 2003.
[19] Y. Bar-Shalom and T. E. Fortmann, Tracking and Data Association. MA: Academic Press, Boston, 1988.
[20] B. K. Ghosh and E. P. Loucks, “A realization theory for perspective systems with application to parameter estimation problems in machine vision,” in IEEE Transactions on Automatic Control, vol. 41, (1996), 1706-1722.
[21] K. Hashimoto and T. Noritsugu, “Observer-based control for visual servoing,” in Proc. 13th IFAC World Congress, San Francisco, California, (1996), 453–458.
[22] A. J. Koivo and N. Houshangi, “Real-time vision feed- back for servoing robotic manipulator with self-tuning controller,” in IEEE Transactions Systems, Man, and Cybernetics, vol. 21, (1991), 134–142.
[23] P. K. Allen, A. Timcenko, B. Yoshimi, and P. Michelman, “Trajectory filtering and prediction for automated tracking and grasping of a moving object,” in Proc. IEEE Conference on Robotics and Automation, (1992), 1850–1856.
[24] H. Shariat and K. Price, “Motion estimation with more than two frames,” in IEEE Transactions on PAMI, vol. 12, (1990), 417– 434.
[25] C. Teuliere, L. Eck, and E. Marchand, “Chasing a moving target from a flying uav,” in Int. Conference on Intelligent Robots and Systems, IROS, San Francisco, CA, 25-30 Sept., (2011), 4929 – 4934.
[26] F. Heintz, P. Rudol, and P. Doherty, “From images to traffic behavior - a uav tracking and monitoring application,” in 10th International Conference on Information Fusion, 9-12 July, 2007.
[27] J. Gomez-Balderas, S. Salazar, J. Guerrero, and R. Lozano, “Vision based autonomous hover of a mini-rotorcraft,” in Unmanned Aerial Vehicles Symposium, Dubai, Jun, 2010.
[28] J. Gomez-Balderas, P. Castillo, J. Guerrero, and R. Lozano, “Vision based tracking for a quadrotor using vanishing points,” Journal of Intelligent and Robotic Systems, vol. 65, no. 1-4, (2012) 361–371.
[29] S. S. Ponda, R. M. Kolacinski, and E. Frazzoli, “Trajectory optimization for target localization using small unmanned aerial vehicles,” in AIAA Guidance, Navigation, and Control Conference, Chicago, Illinois, USA, 10-13 August, 2009.
[30] H. Voos, “Nonlinear Control of a Quadrotor Micro-UAV Using Feedback-Linearization,” IEEE International Conference on Mechatronics, (2009), 1-6.
[2] Ehsan. Abbasi is with the School of Mechanical Engineering of University, Tehran, IRAN (e-mail: eabbasi86@gmail.com).
Mohammad. Mahjoob is with the School of Mechanical Engineering, University of Tehran, IRAN, IRAN (e-mail: mmahjoob@ut.ac.ir).
