Mathematical Problems in Engineering

Volume 2013, Article ID 464938, 9 pages

http://dx.doi.org/10.1155/2013/464938

## Disturbance Observer Based Control of Small Unmanned Aerial Rotorcraft

^{1}Science and Technology on Inertial Laboratory, Beijing 100191, China^{2}Department of Electrical Engineering, National University of Singapore, Singapore 119613

Received 27 February 2013; Accepted 31 March 2013

Academic Editor: Zheng-Guang Wu

Copyright © 2013 Xusheng Lei et al. 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

As a complex system, the control performance of small unmanned aerial rotorcraft is easily affected by the dynamic model errors, measurement errors, and environment disturbances. This paper proposes a disturbance observer based control method to improve performance. The disturbance observer based control is constructed by the feedback control and a series of integral filters. The system stability can be guaranteed by the feedback control method. Furthermore, the disturbances can be estimated and eliminated quickly by the integral filters. Therefore, the control performance can be improved effectively. The control performance of the disturbance observer based control has been validated by a series of flight tests. Compared with feedback control, the disturbance observer based control yields a better tracking performance in the presence of disturbances.

#### 1. Introduction

With the ability of taking off and landing vertically, as well as hovering, small unmanned aerial rotorcrafts (SUARs) have been widely used in many fields, including city map data acquisition, road traffic monitoring, and power line inspection [1–3].

Since there exist dynamic model errors, measurement errors, and environment disturbances in the flight process of SUAR system, it is hard to realize stable control [4]. Therefore, how to improve the control performance for SUAR system has attracted many attentions in recent years [5]. PID, robust control, and intelligent control methods have been proposed for SUAR system [6–12]. Due to its simple structure, PID control method is often used in SUAR systems [13, 14]. However, PID control has little robustness to environment disturbances. With high performance in dealing with system disturbances, Robust control, such as , , and LQR, are often used to improve system stability [15, 16]. Robust control has its limitation in system dynamic response characteristics. Intelligent control can cope with parameter uncertainties effectively [17, 18]. But it needs a lot of training time and sample data to realize stable control [19].

Generally, there exist dynamic model errors, measurement errors, and environment disturbances for SUAR system. The dynamic model errors and measurement errors can be treated as disturbances with certain bound. Disturbance observer based control strategies have been applied in many control areas to improve control performance [20, 21]. With the disturbance observer based control, system disturbances can be estimated and compensated effectively. The objective of this paper is to propose a disturbance observer based control method to improve system stability and dynamic response performance. The disturbance observer based control is constructed by the feedback control and a series of integral filters. The system stability can be guaranteed by the feedback control method. Furthermore, the disturbances can be estimated and eliminated quickly by the integral filters. Therefore, the control performance can be improved effectively.

This paper is organized as follows. Section 2 describes the dynamic model of SUAR system. In Section 3, the disturbance observer based control method is presented, and system stability is proved by the Lyapnov function. Then, a series of flight tests validate the effectiveness of the proposed control method in Section 4, followed by the conclusion in Section 5.

#### 2. Dynamic Model of SUAR System

The dynamic model of SUAR can be derived from a rigid body with six degrees of freedom. The main rotor, tail rotor, horizontal tail, vertical tail, and fuselage generate control forces and moments to realize stable control. Therefore, the dynamic model of SUAR can be defined as follows: where is the mass of SUAR system. is velocity vector, and are the velocities along the inertial coordinate frame. is angular rate vector, and are the corresponding angle rates along the body coordinate frame. and are vectors of external forces and external moments, respectively. is the system inertial tensor.

Based on the Newton-Euler equations, the line motion and angular motion of SUAR system can be derived from (1), that is, where are the pitch, roll, and yaw angle in earth coordinate frame, respectively. The subscript mr, fus, tr, vf, and ht indicate the forces or moments generated by the main rotor, fuselage aerodynamics effects, tail rotor, vertical fin and horizontal tail, respectively. Since weight force acts in the vertical position, it does not produce a moment directly. The corresponding forces generated by the weigh force are introduced by coordinate transformation. is the torque produced by the tail rotor to counteract with the aerodynamic torque on the main rotor blades.

With the relationship between the earth coordinate frame and body coordinate frame, the kinematic transformation matrix of SUAR system can be described by the Euler angles, that is,

For SUAR system, Bell-Hiller stabilizer bar is used as a lagged rate feedback to improve system stability. Since the flapping motion is a periodic motion, the general solution for the flapping equation can be represented by an Infinite Fourier Series. Therefore, the dynamic model of rotor flapping motion can be defined as follows: where and are longitudinal blade angle and lateral blade angle, respectively. and are longitudinal cyclic input and lateral cyclic input, respectively. , , , are identification parameters.

With the small perturbation theory, the dynamic equation and kinematic equation of SUAR can be linearized to reduce computation complexity. Therefore, the dynamic model of SUAR can be constructed as follows: where is state variable, representing the corresponding angle, velocity, angle velocity, and blade angle information. is control input, representing longitudinal cyclic input, lateral cyclic input, collective and heading, respectively. and are the dimension of state variable and control input, respectively. and are the coefficient matrixes. is the bounded disturbance, denoting wind disturbances, atmospheric turbulences, measurement errors, and system parametric uncertainties of SUAR system.

*Assumption 1. *The is controllable.

*Assumption 2. *The disturbance is bounded with an unknown bound.

The control objective is to construct the control strategy to estimate and eliminate the disturbances effectively.

#### 3. Disturbance Observer Based Control

From Assumption 1, the SUAR system is controllable. Thus, the control input can be constructed by two parts. One is the state feedback control input , and the other is the estimation of system disturbances , that is, where is the estimation value of system disturbances, and is the weight matrix of the feedback control.

Therefore, the dynamic model of the SUAR system can be transformed as follows:

Define the error between the desired state variable and the real state variable as

Therefore, the error dynamic model can be defined as follows: where .

Since is the state variable with upper bound, is the state variable with upper bound. Based on Assumption 2, is the system disturbance with bound. Thus, is a function vector with bound. If the disturbance can be estimated by the disturbance observer , the control performance can be improved effectively.

Lemma 1. *Considering the following integral filters:
**
where and are positive constant values. and are initial values, and is the estimation value of .*

Define the error between the estimation value and real value as

With the integral filters, the true value can be converged by the estimation value quickly, that is, where are positive constant values.

The estimation value can be obtained from the following integral equation: where where , .

The proof can be found in Appendix A.

Theorem 2. *According to Lemma 1, with the controller (6) and the observer (10), the system (5) is stable. The system disturbances can be estimated and eliminated effectively, and the tracking error , as .*

The proof can be found in Appendix B.

#### 4. Flight Test

The SUAR system is constructed by a radio-controlled hobby helicopter, shown in Figure 1. The SUAR is 1.46 m in span and 1.3 m in length. The total weight is 5 kg. The SUAR is powered by a piston engine running on a mixture of methanol and oil. Five motors are used to control throttle, longitudinal cyclic input, lateral cyclic input, collective and heading. With the constraint of weight and size, the micro guidance, navigation and control (MGNC) system with small weight is developed to realize stable control, shown in Figure 2. The MGNC is only 207 g. It consists of a horizontal main board, housing three angular rate gyros and two 2-axis accelerometers. The angular rate gyro employs the LCG50 gyro that the constant drift is 80 degree/hour. The accelerometer employs the Model 1221 that the bias is 1 mg. The Novatel RTK DGPS is utilized to provide position and velocity information. And the bias error is 0.3 m. Furthermore, the compass that was generated by the Honeywell is used to provide heading information and the measurement error is less than 1 degree. Moreover, Motorola MPXA 6115 is chosen as the barometer to provide altitude information. Based on the ARM chip AT91RM200 and a DSP chip ADSP21364, MGNC system can get sensor information from angular rate gyros, accelerometers, DGPS, and barometer sensors. With the adaptive KF algorithm, the attitude error in pitch and roll angles are less than 0.5 degree, and the error for yaw angle is less than 0.8 degree. The navigation frequency is 50 Hz [20].

The flight control system of SUAR is composed by the flight scheduling layer and the kernel control layer. The flight scheduling layer is to guarantee the trajectory following performance for the preschedule flight tasks. Based on the DGPS and compass information, system generates the planned attitude angles to keep it asymptotically stable. The kernel control layer is to realize attitude control. Based on the proposed method, the system adjusts throttle, longitudinal cyclic input, lateral cyclic input, collective and heading to realize high performance control. The update cycles of the kernel control layer and the flight scheduling layer are 20 ms and 100 ms, respectively.

With the adaptive GA, the weight matrixes and can be got from the flight data [21]:

Based on the pole assignment theory, the feedback control matrix can be defined as

To test the effectiveness of the disturbance observer based control method, a comparison flight test between the feedback control and the disturbance observer based control has been done on the SUAR system. The same feedback control parameter was chosen for the feedback control method and the disturbance observer based control method. The flight task included a straight flight with low speed and a hovering flight test. The start point was set as (0, −100, 20), and the end point was set as (0, 0, 20). The SUAR flied from the start point to end point directly and then hovered at the end point. The largest and the smallest wind disturbances were 4.37 m/s and 2.41 m/s, respectively. The flight trajectories generated by the feedback control method and the disturbance observer based control are shown in Figure 3. The corresponding pitch and roll angles are shown in Figures 4 and 5, respectively. The dot line and solid line are the control trajectories generated by the feedback control and the disturbance observer based control, respectively. From Figures 3–5, it is easy to see that the two control methods can realize stable control under wind disturbances. In the straight flight with low speed phase, the maximum deviation from the planned trajectories and the mean deviation error generated by the disturbance observer based control are 0.37 m and 0.18 m, respectively, that are nearly 38 percent of the values generated by the feedback control method. For the feedback control method, there exists a large distance deviation from the end point due to wind disturbance, and the maximum deviation is 1.97 m. The disturbance observer based control can make a good estimation for wind disturbances, and the maximum distance deviation from the end point is 0.35 m. The largest pitch and roll angles are 2.1 degree and 4.2 degree, respectively, that are the permission range of SUAR system.

Furthermore, a rectangle cruise flight with different height has also been tested on the SUAR system. Point 1 (0, 0, 20), point 2 (50, 0, 20), point 3 (50, 30, 20), point 4 (50, 30, 30), point 5 (50, 50, 30), point 6 (0, 50, 30), point 7 (0, 30, 30), and point 8 (0, 30, 20) were set as the hovering points. When the SUAR received the auto pilot command, it hovered at the point 1, and then adjusted the heading based on the coordinate relationship between point 1 and point 2. When the error of position and speed satisfied the criteria threshold of hovering stage, the SUAR flied to point 2. With the same flight process, the SUAR cruised hovering point 1–8 and then hovered at the point 1. In the flight process, the SUAR pulled up the height from point 3 to point 4, and dropped the height form point 7 to point 8. The wind disturbance was from 2.3 m/s to 3.8 m/s, measured by the anemometer. The 3D flight trajectories and the projection of 3D flight trajectories on the coordinate plane of the east and north are shown in Figures 6 and 7, respectively. The dot line, solid line, and dash line are the planned trajectories, the control trajectories generated by the disturbance observer based control and the feedback control, respectively. The corresponding pitch and roll angles are shown in Figures 8 and 9, respectively. For the disturbance observer based control, the maximum deviation error is 1.21 m that is similar with value generated by the feedback control method, but the mean error is 0.47 m that is nearly 68 percent of the mean error generated by the feedback control method. In the flight process, the disturbance observer based control could make a good estimation for system disturbances and made the corresponding adjustments to improve control performance. The ranges of pitch angle and roll angle are 9.3 degree and 3.1 degree, respectively, that is less than the values generated by the feedback control method.

#### 5. Conclusion

In this paper, a disturbance observer based control method is proposed to deal with system disturbances in flight process. Based on the feedback control, system stability can be guaranteed. With a series of integral filters, the disturbances can be estimated and eliminated quickly, thus the control performance can be improved effectively. The effectiveness of the disturbance observer based control has been demonstrated by a series of hovering and straight flight tests for the SUAR system. The maximum deviation from the planned trajectories and the mean position error generated are 0.37 m and 0.18 m, respectively, in the straight flight process, that are nearly 38 percent of the values generated by the feedback control method. Since the same feedback control parameters are used for the disturbance observer based control method and feedback control method, the flight tests show that the disturbance observer based control can make a good estimation for system disturbances and improve the control performance effectively.

#### Appendices

#### A. Proof of Lemma 1

Consider the following differential equation:

Its solution is .

Thus, can converge to quickly.

For (10), the solution is

Submit (A.2) into (A.1), then where

Defining the auxiliary variable

Differentiating (A.5), then

Submitting (A.5) and (A.6) into (A.3)

The solution is

Differentiating (A.7)

Differentiating (A.6), then

Submitting (A.3) to (A.11) where , , and are constant values, .

Therefore, where .

From (7)

Submitting the (A.14) to the (A.3) where

Based on (A.5), the following equation can be got: where The proof is completed.

#### B. Proof of Theorem 2

According to Lemma 1, the error between the estimate value and the real disturbance is

Hence, with the , the

The disturbance estimation can converge to its true value .

For error dynamic model of SUAR in (4), consider the nonnegative function where the is the symmetric definite matrix solution to where is the symmetric definite matrix solution.

Thus, the time derivative of the nonnegative function can be defined as follows

By using Young’s inequality, the following inequality holds:

Therefore,

With the , the

Then, , as .

That is, the error dynamic model of the SUAR system is asymptotically stable.

Then, it can prove that the tracking error , as .

The proof is completed.

#### Acknowledgments

The research is supported by the National Natural Science Foundation of China (Grant no. 61273033, 60905056, and 60904093), and Beijing Municipal Natural Science Foundation (Grant no. 4132043).

#### References

- A. J. de Voogt, S. Uitdewilligen, and N. Eremenko, “Safety in high-risk helicopter operations: the role of additional crew in accident prevention,”
*Safety Science*, vol. 47, no. 5, pp. 717–721, 2009. View at Publisher · View at Google Scholar · View at Scopus - I. Maza, K. Kondak, M. Bernard, and A. Ollero, “Multi-UAV cooperation and control for load transportation and deployment,”
*Journal of Intelligent and Robotic Systems*, vol. 57, no. 1–4, pp. 417–449, 2010. View at Publisher · View at Google Scholar · View at Scopus - N. Metni and T. Hamel, “A UAV for bridge inspection: visual servoing control law with orientation limits,”
*Automation in Construction*, vol. 17, no. 1, pp. 3–10, 2007. View at Publisher · View at Google Scholar · View at Scopus - G. W. Cai, B. M. Chen, T. H. Lee, and M. B. Dong, “Design and implementation of a hardware-in-the-loop simulation system for small-scale UAV helicopters,”
*Mechatronics*, vol. 19, no. 7, pp. 1057–1066, 2009. View at Publisher · View at Google Scholar · View at Scopus - P. Fabiani, V. Fuertes, A. Piquereau, R. Mampey, and F. Teichteil-Königsbuch, “Autonomous flight and navigation of VTOL UAVs: from autonomy demonstrations to out-of-sight flights,”
*Aerospace Science and Technology*, vol. 11, no. 2-3, pp. 183–193, 2007. View at Publisher · View at Google Scholar · View at Scopus - C. J. Liu, W. H. Chen, and J. Andrews, “Tracking control of small scale helicopters using explicit nonlinear MPC augmented with disturbance observers,”
*Control Engineering Practice*, vol. 20, pp. 258–268, 2012. View at Google Scholar - J. Gadewadikar, F. L. Lewis, K. Subbarao, K. Peng, and B. M. Chen, “H-infinity static output-feedback control for rotorcraft,”
*Journal of Intelligent and Robotic Systems*, vol. 54, no. 4, pp. 629–646, 2009. View at Publisher · View at Google Scholar · View at Scopus - K. M. Peng, G. W. Cai, B. M. Chen, M. B. Dong, K. Y. Lum, and T. H. Lee, “Design and implementation of an autonomous flight control law for a UAV helicopter,”
*Automatica*, vol. 45, no. 10, pp. 2333–2338, 2009. View at Publisher · View at Google Scholar · View at MathSciNet - L. Marconi and R. Naldi, “Robust full degree-of-freedom tracking control of a helicopter,”
*Automatica*, vol. 43, no. 11, pp. 1909–1920, 2007. View at Publisher · View at Google Scholar · View at MathSciNet - C. H. Luo, R. F. Liu, C. D. Yang, and Y. H. Chang, “Helicopter ${H}_{\infty}$ control design with robust flying quality,”
*Aerospace Science and Technology*, vol. 7, no. 2, pp. 159–169, 2003. View at Google Scholar - A. Isidori, L. Marconi, and A. Serrani, “Robust nonlinear motion control of a helicopter,”
*IEEE Transactions on Automatic Control*, vol. 48, no. 3, pp. 413–426, 2003. View at Publisher · View at Google Scholar · View at MathSciNet - A. Budiyono and S. S. Wibowo, “Optimal tracking controller design for a small scale helicopter,”
*Journal of Bionic Engineering*, vol. 4, no. 4, pp. 271–280, 2007. View at Publisher · View at Google Scholar · View at Scopus - S. S. Ge, B. Ren, K. P. Tee, and T. H. Lee, “Approximation-based control of uncertain helicopter dynamics,”
*IET Control Theory & Applications*, vol. 3, no. 7, pp. 941–956, 2009. View at Publisher · View at Google Scholar · View at MathSciNet - W. Adiprawita, A. S. Ahmad, and J. Sembiring, “Automated flight test and system identification for rotary wing aerial platform using frequency responses analysis,”
*Journal of Bionic Engineering*, vol. 4, no. 4, pp. 237–244, 2007. View at Publisher · View at Google Scholar · View at Scopus - L. David, R. Gerardo, S. Anand, L. Rogelio, and G. Alfredo, “Robustness margin for attitude control of a four rotor mini-rotorcraft: case of study,”
*Mechatronics*, vol. 20, no. 1, pp. 143–152, 2010. View at Publisher · View at Google Scholar · View at Scopus - P. Apkarian, C. Champetier, and J.-F. Magni, “Design of a helicopter output feedback control law using modal and structured-robustness techniques,”
*International Journal of Control*, vol. 50, no. 4, pp. 1195–1215, 1989. View at Publisher · View at Google Scholar · View at MathSciNet - D. Martens, “Neural networks as a tool for the assessment of human pilot behaviour in wind shear,”
*Aerospace Science and Technology*, vol. 3, no. 1, pp. 39–48, 1999. View at Google Scholar · View at Scopus - A. Douik, “Optimized eigenstructure assignment by ant system and LQR approaches,”
*Computer Science and Applications*, vol. 5, no. 4, pp. 45–56, 2008. View at Google Scholar - S. Suzuki, K. Hayashi, and T. Uemura, “Analysis of human pilot behavior at landing with neural network combined with GA,”
*Japan Society For Aeronautical and Space Sciences*, vol. 51, pp. 109–113, 2003. View at Google Scholar - X. S. Lei and J. J. Li, “An adaptive altitude information fusion method for autonomous landing processes of small unmanned aerial rotorcraft,”
*Sensors*, vol. 12, no. 10, pp. 13212–13214, 2012. View at Google Scholar - X. S. Lei and Y. H. Du, “A linear domain system identification for small unmanned aerial rotorcraft based on adaptive genetic algorithm,”
*Journal of Bionic Engineering*, vol. 7, no. 2, pp. 142–149, 2010. View at Publisher · View at Google Scholar · View at Scopus