Attitude and Altitude Control of Trirotor UAV by Using Adaptive Hybrid Controller

The paper presents an adaptive hybrid scheme which is based on fuzzy regulation, pole-placement, and tracking (RST) control algorithm for controlling the attitude and altitude of trirotor UAV. The dynamic and kinematic model of Unmanned Aerial Vehicle (UAV)isunstableandnonlinearinnaturewith6degreesoffreedom(DOF);thatiswhythestabilizationofaerialvehicleisadifficult task.TostabilizethenonlinearbehaviorofourUAV,anadaptivehybridcontrolleralgorithmisused,inwhichRSTcontroller tuningisperformedbyadaptivegainsoffuzzylogiccontroller.SimulatedresultsshowthatfuzzybasedRSTcontrollergivesbetter robustnessascomparedtotheclassicalRSTcontroller.


Introduction
The automatic control of airborne machines has been a challenge to the researchers for numerous years.Significant attention has been given to the control of UAVs [1].Simple construction, vertical taking off and landing (VTOL) capability, and rapid steering are the main reasons of micro helicopter that attract military and civilian users.UAVs are widely used in surveillance, firefighting, rescue, traffic monitoring, and environmental monitoring scenarios [2,3].
There are two groups in which UAVs are categorized, that is, fixed and rotary wings.In real-world tasks, fixedwing UAVs have existed for years in routine reconnaissance assignments, but they lack the hovering flying ability.Rotorcrafts are foremost complex types of flying machine.They are multi-input multioutput (MIMO) under actuated structures capable of executing vertical takeoff and landing (VTOL) and also quick maneuvering turns.Utmost vertical takeoff and landing flying machines depend on gyro equilibrium or accelerometer systems to endure steady hovering flight [4][5][6].To fulfill the aforementioned necessities, a multirotor UAV is best available resolution for this.Multirotor style UAV has a number of categories together with birotor, trirotor, and quadrotor.In this paper, our main concern relates to trirotor UAV having three rotors situated in the midway from center of gravity [7].
The trirotor UAV has an issue of having a yawing moment brought in due to feedback torque from unpaired rotor.To overcome such condition, a number of strategies of trirotor UAV have been established with their specific explanations such as single trirotor UAV having a servo motor connected with one of its rotor axes to diminish yaw moment by tilting at certain angle.The other category of trirotor UAV is termed as coaxial trirotor, and Draganflyer X6 might be reflected as this type [8].It devises dual rotors mounted on every rotor axis, thus having overall six rotors.Using two counterrotating rotors on every axis, the feedback torque has annulled.This form of trirotor ensures an improved stability compared to the solo trirotor UAV style.
A trirotor UAV has four control parameters, that is, altitude, lateral, longitudinal, and angular moments, which provides 6 degrees of freedom (DOF) and three Cartesian coordinates, that is, , ,  [9], while the output includes rotational velocities, translational velocities, and rotational angles.Rotational and translational subsystems are incorporated to establish sequential control due to the nonlinear behavior of trirotor UAV.Before the real flight test the simulation of UAV parameters is necessary; in this research, we have to check all parameters which are highly unstable and nonlinear like control commands of UAV, Euler angles, and translational and rotational velocity components [10], by resolving the error which is found in the yaw moment of unpaired rotor reaction produced by the turning effect "torque" in a frame.To nullify the tilt angle a Brushless DC Motor (BLDC) is installed in a triangular frame of trirotor.
Different hybrid controller algorithms were previously applied for controlling the attitude and altitude of UAV, like conventional Proportional Integral Derivative (PID) controller with Backstepping Scheme, fuzzy based PID controller, adaptive PID controller, and Adaptive Sliding Mode Controller [11][12][13][14], but no one considers fuzzy based regulation, pole-placement, and tracking (RST) for controlling the dynamics of trirotor UAV.In this paper, we use hybrid controller scheme named as a fuzzy based RST controller, which was previously addressed by [15].The polynomial regulator of RST looks to be the remarkable substitute of the systematic PID controller.RST controller theory is totally based on pole-placement algorithm, and it has potential to execute poles in the closed-loop system to handle in a distinct way the objectives of tracking and regulation.
The robust RST controller of [16] is firstly applied in our highly unstable system and then after that fuzzy based RST controller (F-RST) is applied in it, taking the difference in terms of attitude stability between controllers.The overall performance of RST is good between robustness and complexity, but there are little transient errors to control the dynamics of the UAV as compared to our proposed F-RST approach.
The main contributions in this research are as follows: (1) A novel algorithm to control the highly nonlinear system; (2) fuzzy logic controller with fine tuning gains of RST; (3) transient behavior of our system being realistic same as the experimental point of view; (4) the robustness and nullification of the rotor reaction already proven in yaw control.
The paper is divided into six sections.Section 1 defines the introduction, Section 2 defines the rigid body equations of motion, and the dynamics and representation of the UAV are defined in Section 3. The control approach and control algorithm are defined in Section 4.Moreover, simulations and results are discussed in Section 5. Lastly the whole paper is concluded in Section 6.

Rigid Body Equations
The equations of motion of a rigid body are defined by the second law of Newton, which expresses that the summation of all outside force acts in a body is equivalent to the time period variation of the body momentum.Moreover, the sum of external forces in the body is also equivalent to the rate of change of angular momentum.Trirotor has 6-DOF unstable and nonlinear equations of motion, which can be expressed in "differential" equation.
Following is the equation of motion.The rotational or angular rates of the system are defined by (, , ), and the translational velocity and its position are defined by (, V, ) and (, , ).Euler angles or attitude and external moments of an aircraft fixed body are defined by (, , ) and (, , ) [17][18][19][20].
Rotational velocity components: Translational velocity components: Euler angles: Aerodynamic moments: The rotational and translational velocity of the aircraft in terms of kinetic energy are written as Rotor 1 Rotor 2 the successful flight operation.According to the momentum theory which was proposed by Newton, fluid axial velocity "" through actuator is mostly greater than the speed "V" with which actuator is progressing through the air [21].The generated thrust by the rotors equals the physique of the air passing through the circle in a unit time.The combination of blade theory and momentum is derived from moments and aerodynamic forces.Figure 1(a) shows the model of trirotor aerial vehicle in which two rotors are fixed in the body and one rotor is rotational called tilt rotor, to nullify the reaction torque effects.It has an obvious benefit for the generation of quick motion by using its tilt rotor, but for the stabilization of aerial vehicle it may require a very precise tilt angle [22,23].
The hovering state of trirotor blades depends upon the propeller which becomes ineffective by increasing the number of blades on the propeller and limits its forward flight speed.By utilizing the momentum theory of helicopter aerodynamics which is similar to trirotor UAV theory [24], there are three propellers which are fixed in the rotors.The coefficient of thrust, torque, and nondimensional power are used to elaborate the rotor characteristics which are independent of rotor size, in which radius of blade is denoted by "," angular velocity is given by "," area of blade is "," "" is the air density, shaft of rotor is "," thrust is "," and aerodynamics thrust coefficient is denoted by "   ": The power coefficient is written as By putting the power coefficient, The UAV hovering, identical incursion, and constant coefficient profile drag are supposed to be Cdo = 0.015, the supposition known as the modified momentum theory, while rotor solidarity ratio is given as "."The induced power in    of rigid body movement depend on the rotational and translational subsystems [26].Moreover, the force components of aerodynamics, components of translational and rotational velocity, and moments are described in Table 1.
The configuration of trirotor with tilt angle is shown in Figure 1(a) taken from [6] and system parameter is defined in Figure 1(b) from [3], in which the distance from the centre body is denoted by "."The forces which are created by rotors R1, R2, and R3 are  1 ,  2 , and  3 respectively, and the torque produced by the rotors is denoted by  1 ,  2 ,  3 .The force acting on the frame of the aircraft contains the thrust which is vertical along the positive -axis and we can say that The forces and torques of trirotor are written as where    is thrust coefficient,    is torque coefficients, and  is the angular velocity of the rotor.

Controlling Approach
The control strategy of trirotor is same as conventional helicopter theory.The product of Euler angles controls the orientation of flight.The controlling approach of UAV consists of roll, pitch, yaw, and altitude control and tilt angle also plays a vital role in the displacement of UAV.The "1" is rotor 1, "2" is rotor 2, and "3" is rotor 3 and the speed of rotors is measured in round per minute (RPM).

Roll Control Strategy.
It is divided into two cases, clockwise and anticlockwise movement of rotors.
(1) In clockwise rotation the speed of rotor 2 is 4000 RPM, greater than rotor 1 speed with about 3000 RPM, and rotor 1 speed is greater than rotor 3 speed with about 2000 RPM which is shown in Figure 2(a).Mathematically 2 > 1 > 3.
(2) In anticlockwise rotation the speed of rotor 3 is 4000 RPM, greater than rotor 1 speed with about 3000 RPM, and rotor 1 speed is greater than rotor 2 speed with about 2000 RPM which is also shown in Figure 2(b).Mathematically 3 > 1 > 2.
Pitch Control Strategy.The two conditions for controlling the pitch of the trirotor are as follows: One is Nose-Up and the second is Nose-Down; it could be done by varying the speed of rotors.
(1) For Nose-Up condition the speed of rotor 2 and rotor 3 is the same, about 4000 RPM, as compared   constantly while the thrust angle must change, where "" is the tilt angle which can be used for rapid turn in hazardous environment.Figure 4 shows the change of tilt angle; mathematically we can say that 1 = 2 = 3, with  = 0.
Altitude Control Strategy.To maintain the desired altitude speed of all rotors must be the same.The speed of rotors increases frequently; when reaching the desired altitude, the speed of all rotors is 4000 RPM which is shown in Figure 5, in which angular velocity is also constant for all three rotors.Mathematically 1 = 2 = 3.
Control Algorithm.Our proposed hybrid controller is characterized in this section, in which the gains of RST controller are utilized for the tuning of fuzzy logic controller.The hybrid control algorithm is also used for the accurate tuning of each input parameter.The close-loop response of RST controller is shown in Figure 6, Figure 7 defines the attitude hold condition of trirotor UAV, and Figure 8 defines the complete block diagram of overall control algorithm of our system.The semantics levels of the fuzzy based RST controller are referred to as negative below (NEB), negative small (NES), zero (ZER), positive small (PSS), and positive big (PSB), in which "err" is the error and "/" is its derivative.The fuzzy controller if-then rules are shown in Tables 2-4 for the tuning of fuzzy based regulation, pole-placement, and tracking (RST) gains denoted as   ,   , and   .The membership function of fuzzy logic controller input error "err" and derivative of input "err" are shown in Figures 9 and 10 having ranges −1 to 1 and amplitude is about 0 to 1.

Simulation Results and Discussions
The effectiveness of our proposed hybrid adaptive fuzzy RST controller is presented in this section, along with the nonlinear simulations for the attitude and altitude stabilization control of trirotor UAV on Matlab Simulink and compare fuzzy RST controller with the conventional RST controller.The simulation is done for -, -, and -axis along with attitude control; Table 5 defines the parameter of trirotor UAV.The UAV subsystem is divided into rotational and translational subsystems.Initial errors in the system are controlled and stabilized by rotational subsystem and attitude angle is converging to zero to realize the hovering state.The translational components depend on Euler angles; however the Euler angles and rotational subsystem do not depend on translational subsystem.Figure 15 shows the altitude, lateral, longitudinal, and angular control of UAV.The rise time and settling time for each input channel are between 1 to 2 seconds along with minor "bumps."The altitude of the UAV is set to "unity" as shown in Figure 14. Figure 16 shows the attitude response having different initial angles, but after that it will converge to zero, which means that it will easily hold the attitude control of UAV.The rotational and translational velocity rate responses are shown in Figures 17 and 18 and both converge to the desired values easily.
The sampling time was set to 0.2 seconds for every simulation which was done in five seconds.Our proposed method converges to desired responses abruptly and efficiently as shown in  results in  show that our proposed algorithm has better robustness.All the simulated constraints of UAV yield to original trimmed conditions, especially in the Euler angle responses shown in Figure 16, our proposed algorithm with the conventional RST controller.In Figure 18 translational velocity is  = V = 0,  = 1, which means it easily controlled the attitude of UAV, without any overshoot, undershoot, and transient error, and settling time response is also better than the previously adaptive RST controller.The results show that our proposed controller is able to stabilize the attitude angles and altitude of trirotor UAV.

Conclusion
Fuzzy based RST control algorithm is used to control the unstable and nonlinear behavior of trirotor UAV.However, the translational and rotational subsystems are used to achieve the desired attitude and altitude.The robustness of our algorithm is demonstrated by using the computer simulation, which shows the effectiveness of the controller that has better transient response with very low overshoot and undershoot to achieve the desired attitude.At last, the trirotor converges very fast according to the desired position.

Figure 3 :Figure 4 :
Figure 3: Pitch Control Strategy with respect to Nose-Up (a) and Nose-Down (b) conditions.

Figure 6 :
Figure 6: Internal close-loop block diagram of RST controller.

Figure 16 :
Figure 16: Comparison of F-RST with RST controller for Euler angle responses.

Figure 18 :Figure 19 :
Figure15shows the altitude, lateral, longitudinal, and angular control of UAV.The rise time and settling time for each input channel are between 1 to 2 seconds along with minor "bumps."The altitude of the UAV is set to "unity" as shown in Figure14.Figure16shows the attitude response having different initial angles, but after that it will converge to zero, which means that it will easily hold the attitude control of UAV.The rotational and translational velocity rate responses are shown in Figures17 and 18and both converge to the desired values easily.The sampling time was set to 0.2 seconds for every simulation which was done in five seconds.Our proposed method converges to desired responses abruptly and efficiently as shown in Figures16-19.The initial conditions of Euler angles are  = 0.54,  = 2.4,  = 2.5 radians, and reference input control commands are   =   =  = 0 m/s and   = 1 m, while  = V = 0 and  = 1 are translational velocity components.The rotational velocity converges to zero to maintain the desired attitude hold position easily; the

Table 2 :
If-then rule of fuzzy logic controller for   .

Table 3 :
If-then rule of fuzzy logic controller for   .

Table 4 :
If-then rule of fuzzy logic controller for   . ), pole-placement gain (  ), and tracking gain (  ), whereas the gain values are tuned manually; after that accurate tuning of the system parameters is performed by   ,   , and   .