Abstract
Since there has been an important increase in unmanned vehicles systems research such as quadrotors, a mathematical model and PID control laws are studied. Based on some dynamic variables, PID control is applied to compute a controller to be then use in autopilot simulations. As this kind of VTOL vehicle seems to be unstable, the aim of this work is to change even other flight mechanics parameters and control gains to study attitude and altitude variations. A well-known computational tool is used for simulation purposes, performance analysis and validation.
Access provided by Autonomous University of Puebla. Download conference paper PDF
Similar content being viewed by others
Keywords
1 Introduction
Unmanned aerial devices have been developing significant capacities to fly. Therefore, many researchers from multidisciplinaty areas have shown interest in aerial vehicles in which the human influence can be greatly reduced. Different engineering areas such as aerodynamics, control, path planning and for instance autonomous platforms play an important role in this research area. These type of flying vehicles can be designed nowadays to carry or hold different payloads. Likewise, path planning and path following control are being utilized to achieve autonomous tasks. A multirotor type that has vertical takeoff and landing (VTOL) capabilities is the quadrotor. Currently, these kind of vehicles have a large use in aerospace businesses. They can fly autonomously to perform several missions such as environmental research, rescue, traffic or infrastructure inspections, agricultural monitoring, image and video, scientific research, inspections of places with very difficult access and even products delivery. Hence, their uses are not just restricted to dangerous works. [9, 10].
2 Reference Frames
For a math description model and control issues, at least one reference frame is required. If other reference frames are employed, it will be easier to get the derivation of the motion equations. Once multiple reference frames are used, important matters are related to vector transformations from one frame to another. The rotation matrices are based on Euler angles. A reference fixed frame is taken to obtain distance and direction. A coordinate system is considered for measurements. There are two reference frames clearly defined, the Earth Fixed Frame and Body Fixed Frame. [3, 6, 7, 10] The E-frame is selected as the inertial frame. \((0_E\ X_E\ Y_E\ Z_E)\). Its origin is at \(O_E\). In this reference frame, both the linear position (\(\xi ^E\)) and angular position (\(\varTheta ^E\)) are defined. There is another reference frame required as the body frame \((0_B\ X_B\ Y_B\ Z_B)\) and is attached to the body of the quadrotor. The origin is at the reference point \(O_B\). In this B-frame some dynamic variables such as the linear velocity, the angular velocity and the forces and torques are determined. (Fig. 1).
3 Quadrotor System Variables
A quadrotor commonly has six degrees of freedom (6DOF) and are defined as: \(\xi \) = (x, y, z) represents the linear position and \(\varTheta \) = (\(\theta \), \(\phi \), \(\psi \)) is the attitude or also known as Euler angles pitch, roll and yaw. Thus, if \(\varTheta \) = (\(\theta \), \(\phi \), \(\psi \)) and \(\xi \) = (x, y, z), we obtain the general position vector \(\varPhi \) as:
The following are the linear and angular velocities v = (u, v, w) \(\omega \) = (p, q, r) are:
3.1 Mathematical Model
For vector transformations from the E-frame to the B-frame, there is a matrix which is known as the direction cosine matrix. If the rotations are first around x axis next about y and the final one around z axis, the rotation matrix got is: \(R_\Upsilon = R(\phi , \theta , \psi )= R_x(\phi ) R_y (\theta ) R_z (\psi )\). [7, 8, 10, 11]
Hence, the rotation matrix product is as follows:
If smalls angles of motion are taken \([\dot{\phi }\ \dot{\theta }\ \dot{\psi }]^T\) = \([p\ q\ r]^T\), therefore, the dynamic model is: [7, 8]
4 Control Model of a Quadrotor
Four torques are needed to control a quadrotor \((\tau _1\ \tau _2\ \tau _3\ \tau _4)\), which are given to the motors to generate the thrust forces \((F_1\ F_2\ F_3\ F_4)\) in z. The net torques acting on the body can be calculated by using the inputs \(U = (U_1\ U_2\ U_3\ U_4)\) that can be applied to control the quadrotor. As an aerodynamic consideration forces and torques are proportional to the squared propeller’s speed. [1]. Therefore the relationship between motions and propellers’ squared speed is as follows:
The motor \(\varOmega \) \([rad\ s^{-1}]\) and vector speeds \(\varvec{\varOmega }\) are the following: [1].
\(\varOmega _1\) \([rad\ s^{-1}]\) and \(\varOmega _3\) \([rad\ s^{-1}]\) are the motor speeds (front and rear), also \(\varOmega _2\) \([rad\ s^{-1}]\) and \(\varOmega _4\) \([rad\ s^{-1}]\) are the right and left motor speeds. The relationship between the control inputs and the speeds of the motor is:
l [m] is the quadrotor center distance and \([U_1\ U_2\ U_3\ U_4]\) are the control inputs. \(U_1\) is the thrust force responsible for altitude z. \(U_2\) is the thrust difference between propellers 2 and 4 that originates the roll moment. \(U_3\) represents the thrust variation between motors 1 and 3 that generate the pitch moment. Finally, \(U_4\) is the mixing of the single torques between the clockwise and counterclockwise rotors that are responsible for yaw rotation. Similarly, \(U_1\) creates the desired altitude. \(U_2\) and \(U_3\) generate the respective roll and pitch angles and \(U_4\) originates the yaw angle. [1, 4, 5]. In addition, the linearization about a point of equilibrium is: \(\dot{\mathbf{x }} = f(x,u)\). Hence, as a linear model we obtain: [1, 5, 11].
5 Simplified Control Model
A quadrotor is certainly an underactuated system. It is a 6DOF machine with just four control inputs. So, it may be really difficult to control 6 degrees of freedom having only four control inputs. Mainly, the control work is carried out on attitude and the yaw angle. Hence, the reduced dynamics model considered for control is:
5.1 Control Laws for Attitude and Altitude
The following PID control law is the taken for altitude:
\(K_p\), \(K_d\), \(K_i\) are the gains (proportional, derivative and integral), \(\dot{e}_z\) represents the desired altitude change and \(z_d\) is defined as the desired altitude. If matrix 10 is inverted, we get the relationship between U and \(\varOmega ^2\) as follows:
Also, the control laws for attitude or orientation angles (roll, pitch and yaw) are taken as:
Similarly, \(K_p\), \(K_d\), \(K_i\) are the proportional, derivative and integral gains, \(\dot{e}_\phi , \dot{e}_\theta , \dot{e}_\psi \) are the adjustments for the desired angles and \(\phi _d, \theta _d, \psi _d\) are the desired angles.
5.2 Transfer Functions
The following are the attitude transfer functions:
And for altitude we have,
6 PID Controller Computation
The transfer function considered for a PID controller is (Table 1):
Some autopilot devices just implement PD control. Thus, the transfer function is as follows:
The PD controller values are:
For the PID controllers are given as:
Thus, the controller variables are:
Finally, the parameters for the PID controller are given by (Table 2):
Other variables are also taken for control simulation (Table 3) and (Figs. 2, 3, 4, 5, 6 and 7).
7 Results
The dynamics values are separately taken for all models. It can be noticed that in the PD control simulations for models 1, 2 and 3, there is initially some overshoot. However, after some adjustments a proper attitude stabilization is achieved. Regarding to altitude performance, an important overshoot is also evident and the control signal obtained tends to deviate from the desired. This issue may appear due to some kind of altitude increase or some PID gains tuning variation still needed. For models 4, 5 and 6, a superior PD and PID control capability is noted. Some very small peaks are originated for attitude. Although, these signals are very similar or not so far from to the desired ones. A slow reaction can be noticed for the yaw angle. In spite of this fact, finally the vehicle could stabilize. The mean of the dynamics values taken is acceptable. Despite this, it is definitely necessary to make some additional changes. Some simulations show that there are some kind of changes or oscillations especially for position. It seems that there are some small oscillations when the inertia moments values are increased. Moreover, oscillations rise as the moments of inertia are small. Therefore, this the fact could be created because of some abrupt changes in attitude. These changes are perceived in simulation. It is possible to be associated to the increase or reduction of the thrust force and configuration type (X, \(+\)).
8 Conclusions
A mathematical model of a quadrotor is provided based on the Newton-Euler method. Another mathematical and linearization approach for further studies may be considered with Taylor series as presented in [2, 10]. Besides the analytical computation of the PID gains, it is required to use a computational tool such as MATLAB (PID option) to adjust or get more precise gains values for better controller performance. It seems that it is feasible to accomplish appropriate results with just a PD controller. It might be suitable for a stable flight (attitude). Although some very small peaks are observed in attitude control signals, they are not far from the desired settings. It is also seen a slow response of the yaw angle. However, after a while the platform can be stabilized. The altitude behaviour is not so right and the state error increases. On the other hand, a much better altitude and attitude performance is got for models 4, 5, and 6. Some negative estimations are acquired for orientation angles. This may be possible due to motors configuration (X, \(+\)). These values just give an inclination and don’t affect the angle magnitude. It is inferred that the dynamic parameters certainly can have an significant effect on the PID controller efficiency.
Change history
16 May 2020
The chapter was inadvertently published with an incorrect version of an author’s affiliation as “Universidad Manuel Beltrán” whereas it should correctly read “Universidad Manuela Beltrán”.
References
Bresciani, T.: Modelling, identification and control of a quadrotor helicopter. M.Sc. theses (2008)
Collazos, C., et al.: State estimation of a dehydration process by interval analysis. In: Figueroa-García, J.C., López-Santana, E.R., Rodriguez-Molano, J.I. (eds.) WEA 2018. CCIS, vol. 915, pp. 66–77. Springer, Cham (2018). https://doi.org/10.1007/978-3-030-00350-0_6
Cork, L.R.: Aircraft dynamic navigation for unmanned aerial vehicles. Ph.D. thesis, Queensland University of Technology (2014)
Cowling, I.: Towards autonomy of a quadrotor UAV (2008)
Habib, M.K., Abdelaal, W.G.A., Saad, M.S., et al.: Dynamic modeling and control of a Quadrotor using linear and nonlinear approaches (2014)
Lugo-Cárdenas, I., Flores, G., Salazar, S., Lozano, R.: Dubins path generation for a fixed wing UAV. In: 2014 International Conference on Unmanned Aircraft Systems (ICUAS), pp. 339–346. IEEE (2014)
Mulder, S.: Flight Dynamics. Princeton University Press, Princeton (2007)
Swartling, J.O.: Circumnavigation with a group of quadrotor helicopters (2014)
Pharpatara, P.: Trajectory planning for aerial vehicles with constraints. Theses, Université Paris-Saclay, Université d’Evry-Val-d’Essonne, September 2015. https://tel.archives-ouvertes.fr/tel-01206423
Poyi, G.T.: A novel approach to the control of quad-rotor helicopters using fuzzy-neural networks (2014)
Sabatino, F.: Quadrotor control: modeling, nonlinearcontrol design, and simulation (2015)
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2020 Springer Nature Switzerland AG
About this paper
Cite this paper
Cárdenas R., C.A., Grisales, V.H., Collazos Morales, C.A., Cerón-Muñoz, H.D., Ariza-Colpas, P., Caputo-Llanos, R. (2020). Quadrotor Modeling and a PID Control Approach. In: Tiwary, U., Chaudhury, S. (eds) Intelligent Human Computer Interaction. IHCI 2019. Lecture Notes in Computer Science(), vol 11886. Springer, Cham. https://doi.org/10.1007/978-3-030-44689-5_25
Download citation
DOI: https://doi.org/10.1007/978-3-030-44689-5_25
Published:
Publisher Name: Springer, Cham
Print ISBN: 978-3-030-44688-8
Online ISBN: 978-3-030-44689-5
eBook Packages: Computer ScienceComputer Science (R0)