Journal of Applied Mathematics

Volume 2014, Article ID 934250, 11 pages

http://dx.doi.org/10.1155/2014/934250

## Mathematical Model of Movement of the Observation and Tracking Head of an Unmanned Aerial Vehicle Performing Ground Target Search and Tracking

Department of Applied Computer Science and Armament Engineering, Faculty of Mechatronics and Machine Design, Kielce University of Technology, 7 Tysiąclecia PP Street, 25-314 Kielce, Poland

Received 24 April 2014; Revised 31 July 2014; Accepted 2 August 2014; Published 8 September 2014

Academic Editor: Zheping Yan

Copyright © 2014 Izabela Krzysztofik and Zbigniew Koruba. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

#### Abstract

The paper presents the kinematics of mutual movement of an unmanned aerial vehicle (UAV) and a ground target. The controlled observation and tracking head (OTH) is a device responsible for observing the ground, searching for a ground target, and tracking it. The preprogrammed movement of the UAV on the circle with the simultaneous movement of the head axis on Archimedes’ spiral during searching for a ground target, both fixed (bunkers, rocket missiles launching positions, etc.) and movable (tanks, infantry fighting vehicles, etc.), is considered. Dynamics of OTH during the performance of the above mentioned activities is examined. Some research results are presented in a graphical form.

#### 1. Introduction

Due to the advantages of unmanned aerial vehicles (UAV) in relation to manned aircrafts, the multitask UAVs have become the basic equipment of a modern army [1]. They can carry out various tasks, such as aerial and radiolocation reconnaissance, observation of the battlefield, radioelectronic fight, adjustment of the artillery fire, target identification, laser indication of the target, assessment of the effects of striking other types of weapons, and imitation of air targets. UAVs can also have a wide civilian application, for example, observation and control of pipelines, electric tractions and road traffic. Because of that, more than 250 UAV models are developed and manufactured all over the world [2]. Many scientific institutions are engaged in developing and identifying models of dynamics and flight control of UAVs. For instance, papers [3, 4] present the comprehensive research on modelling the dynamics of flight of K100 UAV and Thunder Tiger Raptor 50 V2 Helicopter, respectively. Mathematical models of UAV with 6 degrees of freedom (6-DoF) introduced on the basis of the Newton’s rules of dynamics were presented, whereas [5] presents the methodology of modelling the dynamics of UAV flight with the use of neural networks. Paper [6] presents the mathematical model and the experimental research on SUAVI. That vehicle can take off and land vertically. The model was carried out with the use of the Newton-Euler formalism. Moreover, the controllers for controlling the height and stabilizing the vehicle’s location have been developed. Paper [7] describes the problem of flight dynamics of the UAV formation with the use of models with 3 and 6 degrees of freedom.

An operation of UAV during the completion of a task is a complex process requiring comprehensive technical means and systems. The control system of UAV is one of the most important systems. Its task is to measure, evaluate, and control flight parameters, as well as properly control the flight and observation systems. Thanks to the use of complex microprocessor systems, the comprehensive automation of the mentioned processes is possible. Formerly, during the completion of a mission it was necessary to maintain bilateral communications with the ground control point. In modern UAVs, autonomy plays an important role during detecting and tracking a ground target.

Paper [8] presents the model of the UAV autopilot and its sensors in the Matlab-Simulink environment for simulation research. Papers [9–11] pertain to planning and optimizing the trajectory of movement of the vehicle. The aspects of designing PID controllers for the systems of UAV flight control have been discussed in papers [12, 13].

From the quoted review of the literature it appears that the research mainly concentrates on UAV dynamics and control, without the consideration of the model of movement of the observation and tracking head (OTH) which is one of the most significant elements of the unmanned aerial vehicle. OTH is used for automatic searching for and tracking of targets intended for destruction [14]. This paper presents the mathematical model of kinematics of the movement of UAV, the ground target, and the dynamics of the controlled head located on the UAV deck. It needs to be emphasized that the problem of modelling, examining the dynamics, and control of such heads in the conditions of interferences from its base (deck of the manoeuvring UAV) is still topical. The paper examines this type of OTH with the built-in television and thermographic cameras and the laser illuminator.

#### 2. Model of Movement Kinematics of UAV, OTH and Ground Target

General view of the process of searching for a target on the surface of the ground by OTH from UAV deck is shown in Figure 1, whereas the operation algorithm of OTH during scanning the ground surface and tracking a target detected on it is shown in Figure 2.

During the search for a ground target from UAV deck, the axis of OTH should perform the desired movements and circle strictly defined lines on the ground with the use of its extension. The optical system of OTH, having a certain viewing angle, may in this way encounter a light or infrared signal emitted by the moving object. Therefore, one should choose the kinematic parameters of mutual movement of UAV deck and OTH in such a way that the likelihood of detecting a target was the highest [15]. After locating a target, OTH goes to the tracking mode; that is, from that moment its axis has a specific location in space being pointed at the target.

Figure 3 shows the kinematics of mutual movement of the head axis and UAV during searching for a target on the ground surface. Individual coordinate systems have the following meaning: —Earth-fixed reference system, —coordinate system connected with target observation line (TOL), —movable coordinate system connected with UAV velocity vector.

The velocity of changing vector in time, during searching for and tracking a target, is as follows: where is vector of the mutual distance of points and (during scanning the space) or points and (during tracking); are vectors of the velocity of movement of the centre of mass of UAV, of points and , respectively; , , are functions of rectangular impulse; is the moment the scanning the ground is started; is the moment a target is detected; is the moment the tracking the target is started; is the moment the scanning process and tracking the target is finished.

We project the left side of (1) on the axes of the coordinate system (Figure 3) connected with vector . In the result we get where , , are components of angular velocity of TOL and , are angles of deflection and inclination of vector .

Next, we project the right side of (1) (i.e., velocities , and ) on the axes of the system and get

Individual components of velocity vectors , and in the system are as follows:

where , are UAV flight angles, , are angles of deflection and inclination of velocity vector of point , and , are angles of deflection and inclination of velocity vector of point .

For the simplification of reasoning, we assume that the movement of UAV, during searching and tracking, is done on a horizontal plane at a set altitude , whereas the target and point move in the ground plane. Then, we can assume that

We mark that

The derivative of that expression in relation to time is as follows:

Let us substitute (4a)–(6c) into (3). Next, taking into account (7)–(9), (3) will have the following form: where is mutual distance of points and (during scanning) or and (during tracking); is angle of deflection of UAV velocity vector during scanning the ground by the head; is angle of deflection of UAV velocity vector during the passage from preprogrammed flight to tracking flight; and is angle of deflection of UAV velocity vector during the flight tracking the detected target.

We demand that, at the moment of detecting the target, UAV automatically is starting the passage to the flight tracking the detected target; that is, it is moving at a set constant distance from the target (in a horizontal plane at a constant altitude ).

If the mutual distance of points and is different from then the angle of deflection of UAV velocity vector changes in accordance with the relationship: where is the set constant of proportional navigation.

After the fulfillment of the condition the programme of angle change can be determined from (10):

The path of UAV flight during scanning and tracking is as follows: where is vector of location of UAV mass centre (point ) and is angle of deflection of vector .

Path of movement of point is as follows: where is vector of location of point and is angle of deflection of vector .

Path of movement of the target is as follows: where is vector of location of point and is angle of deflection of vector .

Desired angles and angular velocities of deflection of OTH axis can be determined from the following relationships: where

Values (20) are used for determining the preprogrammed controls influencing the head.

##### 2.1. Scanning the Ground Surface during UAV Flight on a Circle

We assume that during scanning the set area of the ground, UAV flight is at a constant altitude in a horizontal plane on the circle of the set radius with constant velocity (Figure 3).

Then the preprogrammed UAV flight can be determined from the following relationships:

At the same time, we control the head axis in such a way that it drawn on the surface of the ground a curve in the shape of Archimedean spiral with angular velocity

Velocity is to be chosen in such a way that OTH mounted on UAV deck could in the set time scan densely enough the set surface of the area in the shape of a circle of the radius .

If the angle of vision of the head’s optical system amounts to then lens coverage embraces the surface similar in shape to a circle of the radius:

After detecting a target at the moment , UAV passes into the tracking flight according to the relationship (12), while the target is lit with a laser beam for the period of time . Hence, the total time of the process of detecting, tracking, and lighting the target amounts to .

#### 3. The Model of Dynamics of the Controlled Observation and Tracking Head

A spatial model of dynamics of the head presented in Figure 4 was adopted for the paper. OTH comprises two basic parts: external frame and internal frame with camera. Movement of the head is determined with the use of two angles: angle of head deflection and angle of head inclination [16].

The following coordinate systems, shown in Figure 5, have been introduced: —the movable system connected with the UAV deck, —the movable system connected with the external frame of the head, —the movable system connected with internal the frame of the head (including camera).

Components of angular velocity of the external frame of the head are where are components of angular velocity of UAV.

Components of angular velocity of the internal frame of the head are

Components of linear velocity of displacement of mass centre of the external frame of the head are

Components of linear velocity of displacement of mass centre of the internal frame of the head are

Using the second order Lagrange equations, the following equations of the head movement have been derived: where are angles of location of OTH axis in space; is the mass of internal frame with camera; is the distance of mass centre of internal frame (camera) from the centre of movement; are moments of inertia of external frame; are moments of inertia of internal frame (with camera); are moments of controlling forces influencing, respectively, external and internal frame; are moments of the force of gravity influencing respectively: external and internal frame; ; and are moments of friction forces in the bearings of, respectively, external and internal frame.

We assume viscous friction: where is friction coefficient in suspension bearing of external frame and is friction coefficient in suspension bearing of internal frame.

Control moments of the head will be presented as follows [17–19]: where are preprogrammed control moments and are tracking control moments.

Preprogrammed control moments , which set the head axis into the required motion, are determined from the following relationships: where are gain coefficients of the OTH control system and are attenuation coefficients of the OTH control system.

Angles and their derivatives will be determined from the relationships (20).

At the moment when the target will appear in the head coverage, that is, head control passes to the tracking mode.

Then, tracking control moments have the following form: Angles will be determined from the relationships (3).

Coefficients are chosen in an optimum way due to the minimum deviation between the real and set path [15].

It should be emphasized that the mathematical model of movement of the controlled observation and tracking head described with (29) allows for conducting a number of simulation tests of searching for and tracking a ground target from the UAV deck. Thanks to that, one can know about the areas of stability and permissible controls with the influence of kinematic excitations from the UAV deck.

#### 4. Results of Computer Simulations

The presented algorithms of control of the movement of OTH performing the search and tracking of a ground target from the UAV deck have been tested on the example of a hypothetical UAV system. The following parameters were adopted: movement parameters of UAV movement parameters of the head movement parameters of the target mass parameters of the head the distance of mass centre of internal frame from the centre of movement friction coefficients in suspension bearings of the head

Kinematic excitations of the base (UAV) were adopted in the following form: For nonoptimum control, regulator coefficients amounted to For optimum control, regulator coefficients amounted to

Figure 6 presents the results of computer simulation of movement kinematics of UAV as well as the head axis during searching the surface of the ground and tracking (laser lighting) a ground target.

Figure 7 presents the trajectory of movement of point during scanning for and the movement of the target on the surface of the ground.

Figures 8–10 present the desired and the real angles of deflection and inclination of the head axis, as well as control moments for the case when the head is influenced by kinematic excitations from UAV deck and the parameters of the regulator are not optimum.

Figures 11, 12, and 13 present the desired and the real angles of deflection and inclination of the head axis, as well as control moments for the case when the head is not influenced by kinematic excitations from UAV deck and the parameters of the regulator are optimum.

Figures 14–16 present the desired and the real angles of deflection and inclination of the head axis, as well as control moments for the case when the head is influenced by kinematic excitations from UAV deck and the parameters of the regulator are optimum.

Kinematic excitations from UAV deck adversely affect the operation of the head. It can particularly be seen in Figures 11 and 14. In case of the nonoptimum choice of the parameters of the regulator, the deviations of the head axis from the set location are particularly visible (Figures 8 and 9). Smaller values of deviations can of course be achieved for optimum head controls (Figures 14 and 15). Control moments take small values.

From the presented theoretical analysis and the simulation research of the process of scanning by OTH from UAV deck of the surface of the ground and then tracking the detected ground target, it can be inferred that(i)it is possible to search for a target on the area of any size, which is only limited to the durability and range of UAV flight;(ii)scanning is sufficiently precise;(iii)the programme of scanning the surface of the ground is simple;(iv)there occur relatively small values of OTH axis angle deviations from the nominal position;(v)full autonomy of UAV during the mission of searching and laser lighting of the detected ground target secures the point of control against detection and destruction by an enemy;(vi)the interference of an operator in controlling UAV may only be limited to cases of the vehicle’s total coming off from the set path or the loss of the target from OTH lens coverage (due to gusts of wind, explosions of missiles, etc.). Hence, the possibility of automatic sending of information about such occurrences to the control point and the possible taking of control over UAV flight by the operator should be introduced.

#### 5. Conclusion

The considerations presented in this paper will allow us to conduct the research on the dynamics of OTH when manoeuvring UAV on which this device is mounted. It may enable the construction engineers to choose such parameters of OTH so that the transient processes occurring in the conditions of kinematic influence of UAV deck and at the moment of passing from scanning to tracking mode were minimized and disappeared in the shortest possible time.

#### Conflict of Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.

#### Acknowledgment

The work reported herein was undertaken as part of a research project supported by the National Centre for Research and Development over the period 2011–2014.

#### References

- R. Austin,
*Unmanned Aircraft Systems: UAVS Design, Development and Deployment*, John Wiley & Sons, Chichester, UK, 2010. - F. Kamrani and R. Ayani,
*UAV Path Planning in Search Operations, Aerial Vehicles*, InTech, 2009, edited by T. M. Lam. - X. Q. Chen, Q. Ou, D. R. Wong et al., “Flight dynamics modelling and experimental validation for unmanned aerial vehicles,” in
*Mobile Robots-State of the Art in Land, Sea, Air, and Collaborative Missions*, X. Q. Chen, Ed., InTech, 2009. View at Google Scholar - S. Bhandari, R. Colgren, P. Lederbogen, and S. Kowalchuk, “Six-DoF dynamic modeling and flight testing of a UAV helicopter,” in
*Proceedings of the AIAA Modeling and Simulation Technologies Conference*, pp. 992–1008, San Francisco, Calif, USA, August 2005. View at Scopus - J. Manerowski and D. Rykaczewski, “Modelling of UAV flight dynamics using perceptron artificial neural networks,”
*Journal of Theoretical and Applied Mechanics*, vol. 43, no. 2, pp. 297–307, 2005. View at Google Scholar - K. T. Öner, E. Çetinsoy, E. Sirimoǧlu et al., “Mathematical modeling and vertical flight control of a tilt-wing UAV,”
*Turkish Journal of Electrical Engineering and Computer Sciences*, vol. 20, no. 1, pp. 149–157, 2012. View at Publisher · View at Google Scholar · View at Scopus - T.-V. Chelaru, V. Pana, and A. Chelaru, “Flight dynamics for UAV formations,” in
*Proceedings of the 10th WSEAS International Conference on Automation & Information*, pp. 287–292, 2009. - P. Kanovsky, L. Smrcek, and C. Goodchild, “Simulation of UAV Systems,”
*Acta Polytechnica*, vol. 45, no. 4, pp. 109–113, 2005. View at Google Scholar - H. Ergezer and K. Leblebicioglu, “Planning unmanned aerial vehicles path for maximum information collection using evolutionary algorithms,” in
*Proceedings of the 18th IFAC World Congress*, pp. 5591–5596, Milano, Italy, 2011. - C. Sabo and K. Cohen, “Fuzzy logic unmanned air vehicle motion planning,”
*Advances in Fuzzy Systems*, vol. 2012, Article ID 989051, 14 pages, 2012. View at Publisher · View at Google Scholar · View at Scopus - H. Chen, K. Chang, and C. S. Agate, “Tracking with UAV using tangent-plus-lyapunov vector field guidance,” in
*Proceedings of the 12th International Conference on Information Fusion (FUSION '09)*, pp. 363–372, Seattle, Wash, USA, July 2009. View at Scopus - K. Turkoglu, U. Ozdemir, M. Nikbay et al., “PID parameter optimization of an UAV longitudinal flight control system,”
*Proceedings of World Academy of Science: Engineering & Technology*, vol. 2, no. 9, pp. 24–29, 2008. View at Google Scholar - B. Kada and Y. Ghazzawi, “Robust PID controller design for an UAV flight control system,” in
*Proceedings of the World Congress on Engineering and Computer Science (WCECS '11)*, vol. 2, San Francisco, Calif, USA, October 2011. - I. Moir and A. Seabridge,
*Military Avionics Systems*, John Wiley & Sons, Chichester, UK, 2007. - J. Awrejcewicz and Z. Koruba,
*Classical Mechanics: Applied Mechanics and Mechatronics*, vol. 30, Springer, New York, NY, USA, 2012. View at MathSciNet - I. Krzysztofik, “The dynamics of the controlled observation and tracking head located on a moving vehicle,”
*Solid State Phenomena*, vol. 180, pp. 313–322, 2012. View at Publisher · View at Google Scholar · View at Scopus - Z. Koruba, “Optimal control of the searching and tracking head (Sth) for self propelled anti aircraft vehicle,”
*Solid State Phenomena*, vol. 180, pp. 27–38, 2012. View at Publisher · View at Google Scholar · View at Scopus - R. Langton,
*Stability and Control of Aircraft Systems*, John Wiley & Sons, Chichester, UK, 2007. - J. E. Takosoglu, P. A. Laski, and S. Blasiak, “A fuzzy logic controller for the positioning control of an electro-pneumatic servo-drive,”
*Proceedings of the Institution of Mechanical Engineers I: Journal of Systems and Control Engineering*, vol. 226, no. 10, pp. 1335–1343, 2012. View at Publisher · View at Google Scholar · View at Scopus