Professional Documents
Culture Documents
Abstract—The motivation for this work stems from the need time of the UAV without any disturbances. This technique
to develop trajectory planning algorithms for small UAVs with has already been applied in many cases, such as autonomous
limited resources. The goal is to address one of the most critical take-off and landing on a moving aircraft carrier [10] and
problems in UAV design, namely weight constraints. Therefore,
in order to reduce the weight, small batteries are used which vessels [11]. Moreover, studies have recently been carried
out that include the implementation of a free autonomous
2021 International Conference on Unmanned Aircraft Systems (ICUAS) | 978-1-6654-1535-4/21/$31.00 ©2021 IEEE | DOI: 10.1109/ICUAS51884.2021.9476875
ized licensed use limited to: National Centre of Scientific Research "Demokritos" - Greek Atomic Energy Commission. Downloaded on March 17,2023 at 09:04:06 UTC from IEEE Xplore. Restrictions
Moreover, the identification of the optimal path of a system
can be explained as an optimal control problem for which two
main algorithms can be used, including direct and indirect
methods. In the direct approach, the parameters involved in
the dynamics of the UAV are optimized to obtain an optimal
cost function. In indirect methods, on the other hand, the opti-
mization algorithm has to compute variations, which leads to
a two-boundary value problem. The indirect method is usually
associated with nonlinear systems with complex dynamics,
since they can benefit from the analytical capabilities of the
indirect approach. The direct method, however, is a numerical
method that considers only linear systems that can be directly
optimized [17].
The main contribution of this paper is to propose a direct
closed-loop optimization method, which is a numerical method
for determining the optimal path and the associated optimal
control of the UAV. The proposed optimization method is
Fig. 1. The free body diagram of the UAV with forces
a Hamiltonian method based on a numerical approach. The
reason for choosing this technique is that there is no specific
algorithm that can define an optimal path for the UAVs. the lift coefficient related to the angle of attack. Further, from
Therefore, due to the linear model and experimental setup, a control point of view, in order to successfully control the
we choose numerical methods since an exact model of the UAV, the normal acceleration required during landing should
system is not available and path planning can be performed be equal to the normal acceleration which the UAV actually
offline in our proposed algorithm [17]. generates during the landing process. Therefore, for satisfying
The rest of this paper is organised as follows. We have this condition, the acceleration is presented in formula (7) [18].
presented the dynamic model of the UAV in Section II. The
dxu
optimal control solution using Hamilton’s principle and singu- = vu cos✓u (1)
lar perturbation technique is described in detail in Section III. dt
The numerical simulation, results and conclusion are discussed
dyu
in Section IV and Section V, respectively. = vu sin✓u (2)
dt
II. DYNAMICAL MODEL
d✓u TF sin↵ + FL gcos✓u
In this section we demonstrate the dynamic system of the = (3)
dt Mu v u vu
UAV with forces in detail. We use the simplified model
of the UAV to obtain a feasible closed-loop solution. The dvu TF cos↵ DF
formulation of the problem is done through the construction = gsin✓u (4)
dt Mu
of the dynamic model illustrated in Figure 1. In this study,
the spatial coordinate system of the UAV and aerial platform TF sin↵ + FL
has been established in the (2D) X-Y axis demonstrated in an = gcos✓u (5)
Mu
Figure 2. The X-axis and the Y-axis are in the same vertical
plane, X-axis is perpendicular to the Y-axis. The UAV and 1
aerial (Drone) carrier have the same direction and positive FL = ⇢sclvu2 (6)
2
in X-axis. The equations describing the motion of the UAV
in the vertical plane are presented in (1) to (7) [18]. By TF sin↵ + FL
ar = gcos✓u (7)
considering the Figure 1, in these formulas, point u represents Mu
the position of the UAV and point d depicts the position of the
Drone carrier, while vector vu and vd illustrates the velocity
of UAV and drone carrier, respectively. (xu , yu ) and (xd , yd ) III. P ROBLEM F ORMULATION
are respectively the positions of the UAV and Carrier, Mu This section contains the mathematical formulation of the
is the total mass of the UAV, ✓u represents the interceptor’s optimal control problem (OCP) to achieve the goal considered
heading angle (the UAV), TF is the total thrust force of the in this paper. We assume that the path planning environment
UAV produced by 4-rotors, DF , and FL are the total drag force for the UAV is free of static and dynamic obstacles, which is
and total lift force that affect the UAV, accordingly. Finally, the primary assumption in this study to reduce the complexity
↵ is the angle of attack of the UAV which is variable and of the computation. Formulas presented in the following
related to the landing direction. Additionally, in formula 6, ⇢ section are based on Figure 2 and Figure 3. To calculate the
is the air density, s is the reference area of the UAV and cl is minimum time, we suppose that the UAV (interceptor) is flying
674
ized licensed use limited to: National Centre of Scientific Research "Demokritos" - Greek Atomic Energy Commission. Downloaded on March 17,2023 at 09:04:06 UTC from IEEE Xplore. Restrictions
at a constant speed of vu in the horizontal plane. Its objective is
to reach the target (Drone Carrier), flying at a constant velocity
of vd in a given direction. For describing the motion, we used a
coordinate system with an origin at the interceptor’s center-of-
mass and with X-Axis direction parallel to the target’s constant
velocity vector (Figure 2). The equations of motion illustrated
at Figure 2 including the UAV and the drone carrier are as
follows:
dx
= vd vu cos✓u (8)
dt
dy
= vu sin✓u (9)
dt
d✓u
= ˜c (10) Fig. 2. The schematic diagram of the UAV and the Drone Carrier in X-Y
dt axis
˜= v u
(11)
Rc
By considering this separation unit, the right-hand side of the
where x and y are relative displacements, ✓u is the intercep- first two equations (8) and (9) will be of the order of R vu
and
tor’s heading angle, and Rc is the minimum turning radius vd
. Furthermore, we assumed that R >> R , (as in
c
the case
0 c
of the interceptor. The variable c is the controller and its Rc
in many interception scenarios), and then we can define a small
magnitude is bounded by unity, |c| 1. For simplifying parameters like as the ratio between the two parameters R0
the problem, the time dependency of all variables has been and Rc . Taking to account that the more maneuverable the
eliminated. We initiate the process at t0 = 0 to tf in the interceptor is, the smaller becomes. Then, by multiplying
following optimal control problem (OCP). the equation (10) by its right-hand sides becomes of the
vu
minimize: order of R c
as do the first two equations (8) and (9). Finally,
Z tf we introduced a new variable ⌥ in order to transfer the OCP
'(x(t0 ), x(tf )) + f0 (t, x(t), c(t))dt in (13) to the Mayer’s formulation as follows:
t0
minimize:
subject to equations (8-11) and the following boundary conditions:
x(0) = 0 D = tf + ⌥(tf )
x(tf ) = 0 subject to:
d⌥
y(0) = y0 = ⌥0 (t) = c2
dt
y(tf ) = 0 dx
= x0 (t) = vd vu cos✓u
✓u (0) = 0 dt
✓u (tf ) = f ree (12) dy
= y 0 (t) = vu sin✓u
dt
The primary purpose of the cost function in this paper is d✓u
dedicated to finding the minimum time required for the UAV = c
dt
to reach the charging platform while imposing a soft bound ⌥(0) = 0
on the control variable via a positive weighting factor and Rc ˜
quadratic form. This factor can be used to ensure that the =
R0
control remains within its prescribed bounds. Consequently,
(15)
the objective function in optimal control problem (Bloza
problem) is presented as follows: The solution to the OCP problem presented in (15), various
approaches may be used. In this study, we employed the
minimize: Hamiltonian principle technique. The Hamiltonian is a func-
Z tf tion used to solve the optimal control problem of a dynamic
D = tf + ( c2 )dt (13) system. It can be observed as an instantaneous increment of the
0
Lagrangian expression of a problem that can be optimized over
subject to equations (8-11) and set of boundary conditions on a certain time horizon. By using the definition of principle the
(12). In order to scale the problem, we used the unit distance Hamiltonian function H and B for boundary value problem
of R0 in formula (14) as the initial separation range between (BVP) [19], we have:
the UAV (interceptor) and drone carrier (target) as follows:
q H(t, x, c, ✓u , µx , µy , µ✓u ) = f0 (t, x, c) + µx (x0 (t)) (16)
R0 = x20 + y02 (14) 0
+µy (y (t)) + µ✓u ( .✓u0 )
675
ized licensed use limited to: National Centre of Scientific Research "Demokritos" - Greek Atomic Energy Commission. Downloaded on March 17,2023 at 09:04:06 UTC from IEEE Xplore. Restrictions
By putting the related equation from (15) in (16), the Hamil-
tonian function computed as follows:
H(t, x, c, ✓u , µx , µy , µ✓u ) = µ⌥ ( c2 ) + µx (vd vu cos✓u )
(17)
+µy ( vu sin✓u ) + µ✓u c
Now because:
@H
µ0⌥ = =0 (18)
@⌥
and from the transversality condition we have:
D⌥f = µ0 (19)
Then, we can obtain that:
Fig. 3. Collision triangle
D ⌥ = µ0 (20)
✓ ◆ ✓ ◆
By taking to account the autonomous conditions in our prob- y0 y0 vd
✓˙u = = arctan arcsin p 2
lem we can have: x0 x0 + y02 vu
Dtf = µ0 = H(tf ) = H(t) (21) (27)
Finally, based on equation (26, 27), we derived µ0 from the
Thus, the Hamiltonian is equal to µ0 , and the remaining
ad-joint variables required for the Hamiltonian function by
ad-joint equations are as follows:
using E > 0, to compute the µ0x and µ0y as follows:
@H µ0x = Ecos✓˙u
µ0x = =0 (22)
@x µ0y = Esin✓˙u
µ0
@H E= (28)
µ0y = =0 (23) vu vd cos✓˙u
@y
For the calculation of the t˙f on the basis of the collision
@H triangle, we have chosen a technique of order reduction in
.µ0✓u = =0 (24)
@✓u connection with the singular perturbation technique (SPT),
From (24), we have: which is particularly noticeable in the design of the optimal
control, which requires the solution of state and cost functions
µx vu sin✓u + µy vu cos✓u = 0 (25) including initial and final conditions [21]. Consequently, by
Finally, the control equation is: applying the method of order reduction in equations (8-10)
we have found:
@H µ ✓u dẋ
= 2 µ0 c + µ✓u = 0 ) c(t) = (26) = vd vu cos✓˙u (29)
@c 2 µ0 dt
The next step is dedicated to finding the ✓˙u corresponding to dẏ
= vu sin✓˙u (30)
the triangular collision in Figure 3 between the UAV and the dt
drone carrier, which first illustrates the path from the point of 0 = ċ (31)
view of an astatic observer located at the initial position of dµ˙x
=0 (32)
the UAV, then defines the collision triangle between the two dt
moving objects from an initial to a final configuration and dµ˙y
=0 (33)
determines where they would interact with each other. Based dt
on the collision triangle and taking into account that the line 0 = µ˙x vu sin✓˙u + µ˙y vu sin✓˙u (34)
of sight should not rotate with respect to the law of parallel
navigation [20], we approached ✓˙u as follows: Taking to account that, u̇ = 0, µ˙u = 0, and ✓˙u is constant. In
y0 order to intercept the target (Drone carrier) at t˙f , the following
vu sin( ) vd sin( ) = 0 ) sin( ) = p 2 conditions are required:
x0 + y02
xf = x0 + (vd vu cos✓˙u )t˙f (35)
y0
) vu sin( ) vd p =0 yf = y0 + ( vu sin✓˙u )t˙f (36)
x20 + y02
✓ ◆ Finally, from (36), we have:
y0 vd
) sin( ) = p 2 x0
x 0 + y0 v u
2 t˙f = (37)
vu cos✓˙u vd
676
ized licensed use limited to: National Centre of Scientific Research "Demokritos" - Greek Atomic Energy Commission. Downloaded on March 17,2023 at 09:04:06 UTC from IEEE Xplore. Restrictions
TABLE I
10 4
N UMERICAL PARAMETERS FOR THE SMALL UAV AND D RONE C ARRIER 4
open-Loop
Closed-Loop
Symbol Values Parameter’s name 3
Y (ft)
We use practical data based on an average Dji Mavic Pro drone [22]. -1
-2
(multiplier) has been adjusted so that the hard limit of control Closed-Loop
open-Loop
677
ized licensed use limited to: National Centre of Scientific Research "Demokritos" - Greek Atomic Energy Commission. Downloaded on March 17,2023 at 09:04:06 UTC from IEEE Xplore. Restrictions
0 1
Closed-Loop
open-Loop
-0.1
0
-0.2
-1
-0.3
psi
-2
n
-0.4
-0.5
-3
-0.6
-4
-0.7
open-Loop
Closed-Loop
-5
20 40 60 80 100 120 140 160 180 0 20 40 60 80 100 120 140
Time (Sec) Time (Sec)
Fig. 6. Heading Time History at ( = 0.08). Fig. 8. Control Time History at ( = 0.02).
10 4
4 [8] D. Patil, M. Ansari, D. Tendulkar, R. Bhatlekar, V. N. Pawar and S.
open-Loop
Closed-Loop
Aswale, ”A Survey On Autonomous Military Service Robot,” ic-ETITE,
3
Vellore, India, 2020, pp. 1-7, doi: 10.1109/ic-ETITE47903.2020.78.
[9] P. R. Palafox, M. Garzón, J. Valente, J. J. Roldán and A. Barrientos,
2
”Robust Visual-Aided Autonomous Takeoff, Tracking, and Landing of
1 a Small UAV on a Moving Landing Platform for Life-Long Operation”,
Appl. Sci. 2019, 9, 2661; doi:10.3390/app9132661.
0 [10] L. Coutard and F. Chaumette,” Visual detection and 3D model-based
tracking for landing on a aircraft carrier”, in Proc.IEEE International
Y (ft)
-1
Conference on Robotics and Automation, Shanghai, China, 2011, pp.
1746-1751.
-2
[11] L. Tan, J. Wu, X. Yang and S. Song, “Research on Optimal Landing
-3 path Planning Method between an UAV and a Moving Vessel”, mdpi,
Appl. Sci. 2019, 9, 3708.
-4 [12] F. Alarcon, M. Garcia, I. Maza, A. Viguria and A. Ollero, “A precise and
gnss-free landing system on moving platforms for rotary-wing UAVs”,
-5 Sensors,2019, 19(4):886.
[13] G. Pietro and A. Marini,” Air-to-air automatic landing for multirotor
-6
2 3 4 5 6 7 8 9 10 11 12 UAVs”, ING-IND/05 IMPIANTI E SISTEMI AEROSPAZIALI, Po-
X (ft) 10 4 litechnico Milano, Italy, 2018.
[14] M. Jun and R. D’Andrea, ”Path planning for Unmanned aerial vehicles
in uncertainty and adversarial environments”, In the Book Chapter of
“Cooperative Control: Models, Applications and Algorithms”, 2003.
Fig. 7. The flying trajectory of the UAV towards the Drone Carrie ( = 0.02). [15] K. Mina, ”Fast nonlinear model predictive control for multi-copter atti-
tude tracking on so (3)”, 2015 IEEE Conference on Control Applications
(CCA). IEEE, 2015.
[16] M. Neunert,”Fast nonlinear model predictive control for unified trajec-
R EFERENCES tory optimization and tracking”, 2016 IEEE international conference on
[1] P. Simek, J. Pavlik, J. Jarolimek, V.Ocenasek and M. Stoces, “Use of robotics and automation (ICRA).
Unmanned Aerial Vehicles for Wildlife Monitoring”, in Proc.HAICTA, [17] H. Tourajizadeh and O. Gholami, ”Optimal Control and Path Planning
Chania, Greece, 2017, pp.795—804. of a 3PRS Robot Using Indirect Variation Algorithm”, Robotica, 38(5),
[2] N. Kitpo and M. Inoue, “Early Rice Disease Detection and Position 903-924. doi:10.1017/S0263574719001152, 2020.
Mapping System using Drone and IoT Architecture”, in Proc. 12th- [18] M. Alijani and A. Osman, ”Autonomous Landing of UAV on Moving
SEATUC, Yogyakarta, Indonesia, 2018, pp. 978-983. Platform: A Mathematical Approach,” 2020 International Conference
[3] S.G. Gupta, M.M. Ghonge and P.M. Jawandhiya, “Review of unmanned on Control, Automation and Diagnosis (ICCAD), 2020, pp. 1-6, doi:
aircraft system”, Technology,vol. 2 (4), USA, 2013. 10.1109/ICCAD49821.2020.9260498..
[4] Amazon teases new details of planned prime air drone delivery service. [19] A. E. Bryson, “Applied Optimal Control: Optimization, Estimation and
[Online]. Available: http://appleinsider.com/articles/15/11/30/ Control”,Taylor Francis, 1975.
[5] Two delivery drones built google soon tested us.[Online]. [20] R.Yanushevsky, “Modern Missile Guidance”,CRC Press, 2007. ISBN
Available:http://www.techspot.com/news/62412 978-1420062267.
[6] M. Heutger, “Unmanned Aerial Vehicle in Logistics: A DHL Perspec- [21] D. S. Naidu and A. J. Calise, ”Singular Perturbations and Time
tive on Implications and use Cases for the Logistics Industry”, DHL Scales in Guidance and Control of Aerospace Systems: A Sur-
Customer Solutions Innovation, Troisdorf, Germany, 2014. vey”,Journal of Guidance Control and Dynamics 24(6):1057-1078, DOI:
[7] K. Römer, “Tracking Real-world Phenomena with Smart Dust”, Euro- 10.2514/2.4830, 2001.
pean Workshop on Wireless Sensor Networks, Springer, Berlin Heidel- [22] https://www.dji.com/it/mavic/info
berg, 2004, pp.28–43.
678
ized licensed use limited to: National Centre of Scientific Research "Demokritos" - Greek Atomic Energy Commission. Downloaded on March 17,2023 at 09:04:06 UTC from IEEE Xplore. Restrictions