Abstract

This paper proposes a robust optimal attitude control design for multiple-input, multiple-output (MIMO) uncertain hexarotor micro aerial vehicles (MAVs) in the presence of parametric uncertainties, external time-varying disturbances, nonlinear dynamics, and coupling. The parametric uncertainties, external time-varying disturbances, nonlinear dynamics, and coupling are treated as the total disturbance in the proposed design. The proposed controller is achieved in two simple steps. First, an optimal linear-quadratic regulator (LQR) controller is designed to guarantee that the nominal closed-loop system is asymptotically stable without considering the total disturbance. After that, a disturbance observer is integrated into the closed-loop system to estimate the total disturbance acting on the system. The total disturbance is compensated by a compensation input based on the estimated total disturbance. Robust properties analysis is given to prove that the state is ultimately bounded in specified boundaries. Simulation results illustrate the robustness of the disturbance observer-based optimal attitude control design for hovering and aggressive flight missions in the presence of the total disturbance.

1. Introduction

In recent years, a great deal of research has been conducted on the control of multirotor micro aerial vehicles (MAVs) around the world as their ability to perform certain task that are unable or difficult to complete by humans. The interest for these aerial vehicles is growing in civilian and military applications such as search and rescue mission, inspection (for wind turbines, power lines, pipelines, and etc.), surveillance, security, and agriculture. For most recent applications, multirotor MAVs have been used to create damage assessment maps for disaster efforts. In contrast to traditional helicopters and fixed wing aerial vehicles, multirotor MAVs are much safer to operate, are highly manoeuvrable, can easily hover above target, are able to do vertical takeoff and landing, are able to fly at low altitude, and are a low cost solution. However, the multirotor MAV is an underactuated system because it has six degrees of freedom but only four control inputs are available. Thus, the autonomous flight control design of multirotor MAV is a challenging task.

Quadrotor is the most popular multirotor MAVs among researchers in the previous studies. Based on reported results, the quadrotor MAVs have successfully achieved their stability in hovering condition by the proportional-integral-derivative (PID) control method [1, 2]. In general, the PID control design is straightforward and can easily be implemented in a real-time embedded system. However, the performances of the PID controller will be degraded under the effects of nonlinear dynamics and coupling. Therefore, many model-based control methods have been extensively studied to restrain the influence of nonlinearities and coupling in dynamic model of multirotor MAVs such as a flatness-based nonlinear control method [3], a dynamic inversion control method [4], a hierarchical control method [5], a nonlinear control method using nested saturations [6], a backstepping-based control method [7], a model predictive controller (MPC) [8], a quaternion-based nonlinear feedback controller [9], an optimal LQR controller [10], and a backstepping-based inverse optimal controller [11]. Actually, those controllers require an accurate model of hexarotor in order to restrain the effects of nonlinear dynamics and coupling. Based on the accurate model, the steady-state and dynamical tracking performances can be achieved. However, the effects of parametric uncertainties and external disturbances were not fully covered in those model-based controllers. In reality, an exact mathematical model of a complex dynamic system like the multirotor MAVs cannot be obtained because the model is only an approximation of the real system. The multirotor MAVs are small and lightweight vehicles and, thus, it is easier to be affected by the payload mass variation. Furthermore, the exact vehicle parameters are difficult to be measured or obtained and normally regarded as constants thus subject to parametric uncertainties. In practice, the closed-loop system can be affected by the external disturbances (e.g., wind disturbances) and instability may happen.

Therefore, many flight control methods have been proposed in literature to encounter the effect of parametric uncertainties and external disturbances. In previous studies, many researches focused on parametric uncertainties problems only such as an adaptive command-filtered backstepping controller [12], a model reference adaptive controller [13], an adaptive dynamic feedback-linearization controller [14], and a nonlinear adaptive controller [15]. However, those controllers are not suitable for practical applications in outdoor environments since the closed-loop system will be affected by the external wind disturbances. The new approaches of adaptive scheme called robust adaptive control have been proposed in the presence of modelling errors and external disturbances [1620]. The proposed method in [16, 18] does not require a priori knowledge of the modelling errors and external disturbances. However, the implementation issues of adaptive law need to be addressed. In [17], the proposed method introduced a new approach using robust integral of the signum of the error (RISE) and immersion and invariance- (I&I-) based adaptive control method to compensate the modelling errors and external disturbances. The proposed method in [20] has considered the presence of constant wind disturbances only. In general, those adaptive controllers could achieve the robust asymptotically tracking performances for the closed-loop system, but the desired robust properties of the controller cannot be specified. Based on sliding mode control (SMC) method, the new developed and higher order SMC schemes were proposed in [2124] to deal with parametric uncertainties and external disturbances. In [21], the SMC is driven by sliding mode disturbance observer to provide robustness against external disturbances and uncertainties while [24] has proposed a second-order sliding mode observer to reconstruct disturbances. In [22, 23], the use of higher order sliding mode control and adequate controller tuning was developed to decrease the chattering phenomenon encountered with SMC approach. However, their algorithms are very complicated and difficult to implement. The attitude control problem of quadrotor subject to time-varying disturbances was considered in [25] by combining an extended observer to estimate disturbances and a feedback controller with sliding mode term for stabilization. But the effects of parametric uncertainties were neglected.

In this paper, a new robust optimal attitude control design for multiple-input multiple-output (MIMO) uncertain hexarotor micro aerial vehicles (MAVs) in the presence of parametric uncertainties, external time-varying disturbances, nonlinear dynamics, and coupling is proposed. The parametric uncertainties, external time-varying disturbances, nonlinear dynamics, and coupling are treated as the total disturbance in the proposed design. The proposed controller is achieved in two simple steps. First, an optimal linear-quadratic regulator (LQR) controller is designed to guarantee that the nominal closed-loop system is asymptotically stable without considering the total disturbance. After that, a disturbance observer based on [26, 27] is integrated into the closed-loop system to estimate the total disturbance in the system. Then, the total disturbance is compensated from the system by the compensation input based on the estimated total disturbance. Robust properties analysis is given to prove that the state is ultimately bounded in specified boundaries. The simulation results are presented to demonstrate the robustness of the proposed control design for hovering and aggressive flight missions in the presence of the total disturbance, to prove that the state is ultimately bounded in specified boundaries and to demonstrate excellent steady-state and dynamic tracking performances of the closed-loop system.

Compared to previous studies in [16, 823, 25], this paper focuses on another potential multirotor MAV platform called hexarotor which has better stability and fault tolerance as shown in Figure 1. Two additional rotors can increase payload, reliability, and manoeuvrability compared to quadrotor because at least four rotors will contribute to each angular rotation. Therefore, the forces and torques generated by two additional rotors will result in different torques about each axis and thus affect the dynamical response. Compared to several researches on hexarotor [2830], the present paper treats hexarotor MAV as the MIMO system rather than the combination of multiple single-input single-output (SISO) systems. This paper also demonstrates the effectiveness of the proposed method for aggressive manoeuvres under the effects of multiple uncertainties. Compared to [311], the proposed controller does not require an accurate model and is able to compensate the total disturbance. In addition, the proposed controller can improve the steady-state and dynamic attitude tracking performances by introducing the disturbance observer to estimate the total disturbance acting on the system. Compared to [1620, 29, 30], the desired robust properties can be specified by the proposed controller where the nominal responses can be specified by the optimal LQR controller and the effects of the total disturbance can be compensated by the compensation input based on the estimated total disturbance.

This paper is structured as follows. The model of a hexarotor is described in Section 2. Section 3 presents the proposed robust optimal attitude control design. Then, the robust properties are analysed and are proven in Section 4. After this, the simulation results are presented and discussed. Finally, this paper is summarized in Section 6.

2. Model of Hexarotor

The hexarotor is a rigid body that consists of six rotors to generate the required forces and torques as shown in Figure 1. Let denote unit vectors along the respective body-fixed frame expressed in for the hexarotor airframe as presented in Figure 2. Let denote the attitude that represents roll , pitch , and yaw angles. Then, the orientation of hexarotor is given by a rotation matrix in the special orthogonal group using -- Euler angles convention, expressed aswhere and denote cosine and sine, respectively. Let denote the angular velocity expressed in and the standard attitude kinematics are given bywhere represents the skew-symmetric matrix, such that for vector cross product and any vector , where

As described in [31], the mathematical model of angular dynamics of hexarotor can be derived aswhere denote the inertia matrix, denote the torque applied to the airframe in by the aerodynamics of the rotors, and denote the external time-varying disturbance (e.g., wind disturbances). The hexarotor’s mass distribution is assumed to be symmetrical with respect to coordinate frame and thus the products of inertia in are zero. Therefore, becomes a diagonal matrix that consists of moments of inertia, .

Let denote the hover thrust force generated by individual rotor and it can be expressed as [31]where is the positive lift constant that can be obtained from static thrust tests and it depends on the chord length of the blade, the number of blades, the blade radius, and the air density. is the angular velocity of the rotors. Based on [31], there exist the secondary aerodynamic forces on the translational dynamics when the rotor is not in hover. However, these effects can be ignored for attitude control design which depends on angular dynamics of hexarotor only.

The reaction torque generated by each hovering rotor can be modelled as [31]where is a positive torque constant that has relation with and it can be determined by static thrust tests as well.

The total thrust force for hovering is the sum of thrusts from each rotor:and its control input to compensate the gravitational force can be defined as

The torque can be expressed aswhere is the distance from the centre of the rotor to the centre of mass.

The control input of attitude system can be defined as

Actually, the motion of hexarotor can be controlled directly using control input and because, in practice, the values of and will be combined through control mixer and then will be transformed to pulse width modulation values (PWM) (based on embedded flight controller specifications) with certain limit (upper and lower saturation values). Then, the PWM values will be distributed to each rotor by an electronic speed controller (ESC). Based on (4), (9), and (10), the attitude control input is proportional to torque such that , where vehicle parameter matrix can be defined as

The vehicle parameter is a combination of nominal and uncertain parts as

Finally, the hexarotor model in (4) can be rewritten asBased on (13), let us compute the tracking error model of hexarotor aswhere is the desired angular acceleration in and is the total disturbance which consists of multiple uncertainties with the following form:

Assumption 1. The uncertain part is bounded. The nominal part has positive values and satisfies .

Assumption 2. The pitch angle satisfies , where .

Assumption 3. The external time-varying disturbance is bounded.

Assumption 4. The output of attitude system is attitude and the reference signal is desired attitude denoted by . The reference signals and its derivatives are piecewise uniformly bounded.

Remark 5. There is a singularity when pitch angle . Therefore, it is required to avoid .

Remark 6. Equation (15) consists of parametric uncertainties, external time-varying disturbances, nonlinear dynamics, and coupling.

3. Robust Optimal Control Design

Let us denote as state vector, where , , and . Actually, , , and are the attitude tracking error, the rate of change in the attitude tracking error (angular velocity tracking error), and the sum of the previous attitude tracking errors, respectively. As can be seen, the tracking error will be managed in three parts, to handle the present, through , to anticipate the future, through , and to recover from the past, through .

Let us definewhere and are a identity matrix and a zero matrix, respectively.

From (14), the state equation is

The proposed controller consists of the optimal LQR controller and the disturbance observer as depicted in Figure 3. The attitude control input can be defined aswhere is the control input computed by the optimal LQR controller and is the compensation input derived based on the estimated total disturbance. The proposed method can be achieved in two simple steps. First, the optimal LQR controller is designed for the nominal system without considering the total disturbance . After that, the disturbance observer is designed and integrated to the closed-loop system to estimate the total disturbance which consists of parametric uncertainties, external disturbances, nonlinear dynamics, and coupling. Then, the total disturbance is compensated from the system by the compensation input in (18).

3.1. Step  1: Optimal LQR Control Design

First, the optimal controller is designed based on the LQR control approach for the nominal system without considering the total disturbance :

The quadratic cost functions are minimized:where is a positive-definite and symmetric matrix and is a weighting matrix. Let us solve the Riccati equation to return the positive-definite matrices :

Therefore, the linear-quadratic controller is the unique, optimal, full state feedback law:with

Let us substitute (22) into (19); then,The closed-loop dynamics are guaranteed to be asymptotically stable if the state is available for feedback, is stabilizable, and .

3.2. Step  2: Disturbance Observer

The system which consists of the total disturbance is considered by substituting (22) and (18) into (17); one can have where is Hurwitz. The performance of the optimal LQR controller in previous step will be degraded when the hexarotor system is subject to the total disturbance especially from external time-varying disturbances (e.g., wind disturbances in outdoor environments). In this section, the disturbance observer is designed based on [26, 27] in order to estimate the total disturbance acting on the system and then eliminate it in (18).

In practice, the actual value of total disturbance cannot be determined. From (17), can be derived as

Equation (26) can be rewritten in terms of domain aswhere is the Laplace operator.

Then, both sides of (27) are multiplied by a low-pass filter matrix in order to estimate the total disturbance:where the low-pass filter matrix is defined to be

Let us define the term in (28) as estimated total disturbance . Based on [26, 27], if positive constants , , and are sufficiently large, the filter will have sufficient wide frequency bandwidths. Therefore, the estimated total disturbance is almost equal to actual total disturbance .

Let us define the compensation input as

However, the compensation input in (30) is not suitable for practical implementation because it is in domain. Therefore, from (28) and (30), the compensation input can be derived mathematically by introducing two new states and :where , , , , ,

Remark 7. As can be seen, the designed control input in (18) is achieved by the combination of the control input computed by the optimal LQR controller in (22) and the compensation input in (33). The proposed robust control design is linear time-invariant controller and can easily be implemented in practical applications.

Remark 8. For real-time implementation in an embedded system, (31) and (32) can be realised in discrete form by using several methods such as fourth-order Runge-Kutta, Euler, and Adams-Bashforth methods [32].

4. Robust Properties Analysis

Theorem 9. If Assumptions 14 are met, there is a sufficiently large , , and , a finite-positive constant for any bounded initial state , and a specified positive constant . Therefore, the state is bounded, satisfying , .

Proof. From (25) and (30),where , is an unit matrix, , and is a vector with zeros except one on the th row. If positive constants , , and are sufficiently large, then can be made as small as desired because the gains of the low-pass filter are gotten closer to .
From (15), there exist positive constants , , and such thatwhere . Based on (18), (22), and (30), one hasSubstituting (37) into (36), it can be obtained thatwhere , , and .
If is sufficiently small and satisfy therefore, from (35) and (38), it can be obtained thatwhere is a positive constant with . From (25), (30), and (40), one hasSubstituting (40) into (35) can be expressed asTherefore, by choosing sufficiently large positive constants , , and , the state is bounded and satisfies , .
From (39), the attractive region of can be computed aswhere satisfyIf starts from the attractive region and the following inequality is met can remain in the attractive region. The inequality (45) can hold if is sufficiently small. If the initial state isthen the inequality (39) can hold.

Remark 10. Actually, the values of uncertainties bounds are difficult to obtain in real situations. However, the disturbance observer parameters , , and can be determined by an online tuning procedure: set from a small positive value (e.g., 0.5) and increase it in small step until satisfactory tracking performance is achieved. The similar tuning procedure is applied for and .

5. Simulation Results

Several simulation tests were carried out to evaluate the attitude tracking performances of the proposed robust optimal attitude control design in the presence of the total disturbance which includes parametric uncertainties, external time-varying disturbances, nonlinear dynamics, and coupling. The nominal parameters of hexarotor model are based on the actual hexarotor research platform as presented in Table 1. The nominal values of thrust coefficient and torque constant were obtained by the static thrust test. Figure 4 shows the result and experimental setup of the static thrust test. The details of the static thrust test for rotor identification can be found in [31, 33]. Based on Table 1, the parameter matrix . Simulation tests were conducted in MATLAB and Simulink environments. The dynamics model of the hexarotor used in this section consists of nonlinearities and coupling. In this section, the hexarotor is assumed to be attached on the spherical joint for attitude test only without translational motion (e.g., see [19]). The control input is assumed to be in order to produce the thrust equal to the weight of the hexarotor in hovering conditions [34]. In practice, will be produced by altitude controller.

Three different cases are presented in this section. Firstly, the optimal LQR attitude controller is designed and evaluated without the effects of parametric uncertainties and external time-varying disturbances. After that, the total disturbance is considered and the optimal LQR attitude controller design is evaluated under the effects of the total disturbance. Finally, the proposed robust optimal attitude controller is evaluated under the effects of the total disturbance and its performances are compared with the optimal LQR controller. For each case, two different missions have been considered which are hovering and aggressive missions. In hovering mission, the hexarotor has to stabilize and the desired attitude is . In aggressive mission, the large attitude reference is considered aswhere , , and are periodic square waveforms.

5.1. Case  1: Optimal LQR Attitude Controller without the Effects of Parametric Uncertainties and External Time-Varying Disturbances

The optimal LQR attitude controller is designed to achieve good attitude tracking performances for the nominal system. In this case, the total disturbance is small because it is only influenced by nonlinearities and coupling effects. Thus, the effects of the total disturbance can be ignored. However, the initial attitude in hovering mission is in order to show the transients when reaching the hover. The optimal LQR parameters and used in this case are presented in Table 2. Figures 5 and 7 show the attitude tracking responses of the optimal LQR controller for hovering and aggressive missions, respectively. The attitude control inputs for hovering and aggressive missions are presented in Figures 6 and 8, respectively. Based on the attitude tracking responses, the optimal LQR controller achieved excellent attitude tracking performances for both missions without the effects of parametric uncertainties and external time-varying disturbances. It is proven that the influence of the nonlinear dynamics and coupling could be restrained based on the accurate dynamics model of hexarotor. Based on LQR control theory [35], the closed-loop dynamics are guaranteed to be asymptotically stable if the state is available for feedback, is stabilizable, and .

5.2. Case  2: Optimal LQR Attitude Controller under the Effects of the Total Disturbance

In this case, the effects of the total disturbance are considered which includes parametric uncertainties, external time-varying disturbances, nonlinear dynamics, and coupling. The uncertain part of parameter matrix is assumed to be 90% of the nominal value which represents a large amount of parametric uncertainties and the external time-varying disturbance is assumed to be

Then, the performances of the designed optimal LQR attitude controller from previous case are evaluated under the effects of the total disturbance. The initial attitude for hovering mission in this case is . Based on Figures 9 and 11, the optimal LQR controller is unable to sufficiently track the reference signals for both hovering and aggressive missions. Thus, the attitude tracking errors are increased. The attitude control inputs for hovering and aggressive missions are presented in Figures 10 and 12, respectively. Based on results, the optimal LQR controller is not robust against the total disturbance due to imperfections of the dynamics model. Actually, the model-based control approach like the optimal LQR controller needs an accurate model in order to achieve the desired tracking performances. However, in reality, an exact mathematical model of hexarotor cannot be obtained especially in outdoor flying environments because the model is only an approximation of the real system.

5.3. Case  3: Proposed Robust Optimal Attitude Controller under the Effects of the Total Disturbance

In this case, the uncertain part of parameter matrix and the external time-varying disturbance are similar to those in Case  2. The disturbance observer was integrated into the existing closed-loop system to estimate the total disturbance. The disturbance observer parameters are presented in Table 2. Please refer to Remark 10 in Section 4 for online tuning procedure of disturbance observer parameters. It should be highlighted that the proposed robust optimal controller is a combination of the optimal LQR controller from previous case and the disturbance observer.

First, the proposed robust optimal controller is evaluated in hovering mission. The initial attitude in hovering mission is . Figures 13 and 14 show the attitude tracking responses and the attitude control inputs of the proposed robust optimal controller in hovering mission, respectively. As can be seen, the proposed robust control scheme achieved good steady-state tracking performances in the presence of the total disturbance. It is also proven that the attitude tracking errors are ultimately bounded in , , and for roll, pitch, and yaw angles, respectively. The total disturbance is successfully estimated by disturbance observer as presented in Figure 15. As can be seen, the estimated total disturbance is almost similar to the external time-varying disturbance which is the major part of the total disturbance. In practical applications, the external time-varying disturbance would be the additional torque caused by wind disturbances.

Then, the proposed robust optimal controller is evaluated in aggressive mission. The attitude tracking responses and the attitude control inputs of the proposed robust optimal controller in aggressive mission are presented in Figures 16 and 17, respectively. As can be seen, the proposed attitude controller achieved excellent dynamical tracking performances. The estimated total disturbance against the external time-varying disturbance is illustrated in Figure 18. As can be seen, there is a small glitch that occurred sometimes on the estimated total disturbance due to high coupling effects in aggressive mission. However, the total disturbance in the system has been successfully rejected. The attitude tracking errors are ultimately bounded in , , and for roll, pitch, and yaw angles, respectively.

Compared to optimal LQR attitude controller as presented in Case  2 and previous model-based attitude controller design in [311], the proposed robust optimal controller is robust against multiple uncertainties and it does not require an accurate model in order to achieve the desired tracking performances. In addition, the proposed controller can improve the steady-state and dynamic attitude tracking performances by introducing the disturbance observer to estimate the total disturbance acting on the system. Compared to [1620], the proposed method can specify the desired robust properties (e.g., the desired boundaries of attitude tracking errors). Based on the results in Case  3, the attitude tracking errors are ultimately bounded in specified boundaries for both missions (, , and for roll, pitch, and yaw angles, resp.).

6. Conclusion

This paper has proposed a robust optimal attitude control design for multiple-input multiple-output (MIMO) uncertain hexarotor micro aerial vehicles (MAVs) in the presence of parametric uncertainties, external time-varying disturbances, nonlinear dynamics, and coupling. The parametric uncertainties, external time-varying disturbances, nonlinear dynamics, and coupling have been treated as the total disturbance in the proposed design. The proposed controller is designed by the combination of the optimal linear-quadratic regulator (LQR) controller and the disturbance observer. The total disturbance is estimated by the disturbance observer and is compensated from the system by the compensation input. Robust properties analysis proved that the state is ultimately bounded in specified boundaries. The simulation results demonstrated the robustness of the proposed controller for hovering and aggressive flight missions in the presence of the total disturbance, with excellent steady-state and dynamic attitude tracking performances. This research aims to integrate with the position controller for trajectory tracking.

Competing Interests

The authors declare that they have no competing interests.

Acknowledgments

This research was mainly supported by Malaysia-Japan International Institute of Technology, Universiti Teknologi Malaysia (UTM), Autonomous Control Systems Laboratory Ltd. in Japan, Chiba University, and Robotic Systems Enterprise.