Mathematical Problems in Engineering

Volume 2013, Article ID 498739, 8 pages

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

## Design of an Attitude and Heading Reference System Based on Distributed Filtering for Small UAV

^{1}Science and Technology on Aircraft Control Laboratory, Beihang University, Beijing 100191, China^{2}School Aeronautic Science and Engineering, Beihang University, Beijing 100191, China

Received 8 April 2013; Accepted 22 May 2013

Academic Editor: Wenwu Yu

Copyright © 2013 Long Zhao and Qing Yun Wang. 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

A development procedure for a low-cost attitude and heading reference system (AHRS) based on the distributed filter has been proposed. The AHRS consists of three single-axis accelerometers, three single-axis gyroscopes, and one 3-axis digital compass. The initial attitude estimation is readily accomplished by using the complementary filtering. The attitude estimation for UAV flying in the real time is realized by using the three low orders EKF. The validation results show that the estimated orientations of the developed AHRS are within the acceptable region, and AHRS can give a stabilized attitude and heading information for a long time.

#### 1. Introduction

Recent advances in autonomous vehicle technologies have made unmanned aerial vehicles (UAV) to become an attractive solution for the modern military and civilian applications such as aerial surveying, pipeline and power line inspection, post-disaster assessment, remote sensing, and cruise missiles [1, 2]. A 2011 report by the Teal Group, who is specialized in aerospace market analysis, forecasts that UAV expenditures worldwide will double within the next ten years to reach $11.3 billion dollars annually in 2020 [3]. By 2018, analysts expect that over 15,000 UAVs could be operating within United States Airspace [4]. Commonly, it needs to know the UAV’s orientation, velocity, and position to be operated, whether manually or with computer assistance. When cost or weight is an issue, inertial navigation using very accurate inertial sensors has been excluded. Instead, low-cost systems using inertial sensors based on microelectromechanical systems (MEMS) have been widely used. To ensure safe and reliable flight of UAV, an accurate attitude and heading reference system (AHRS) is a key component and can give information about the UAV’s orientation in three-dimensional spaces. MEMS-based AHRS are of low cost, light weight, and consume little power. However, the advantages of inexpensive MEMS sensors are coupled with the drawback of having greater potential error in reported roll, pitch, and yaw due to increased sensor noise and drift. Most of the previous works at fusing are based on inertial sensors with GPS for attitude determination [5, 6]. However, GPS signals are susceptible to interference and deception. GPS is unreliable in hostile jammed environments or caused by shadowing effects since the possibility of the outage of GPS. More importantly, the transmitters cannot afford long-term, stable, and reliable positioning information because of the risk of destruction. Recently, many AHRS based on low-cost MEMS gyroscopes, accelerometers, and magnetometers have been developed [7–10]. A number of estimation filters have been proposed since 1970s. The basic idea is to blend several different measurements to obtain the best approximation of the signals. Although many filtering techniques have been proposed and studied to design observers for attitude determination [11–15], the Extended Kalman Filter (EKF) is still one of the most well-known and widely adopted filtering algorithms to design such estimators [16, 17]. The Kalman filter provides the best estimates based on the system dynamics and a priori knowledge of the noise characteristics of the signals. However, EKF divergence due to the linearization of the system and large-state initialization error is a frequent stumbling block to the implementation of the filter. Major difficulties when implementing a centralized Kalman filter (CKF) on a microcontroller arise from the complexity caused by the need for inverting certain matrices. This problem is exacerbated by the need to implement an EKF in case the system is nonlinear and with a large number of states. In contrast to the CKF, the distributed filter is simple, easy to implement, and it has been successfully used for decades on a low-performance micro-controller [18].

The attitude and heading estimation filter proposed in this work is based on the distributed filtering theory, initial attitude estimation is based on the complementary filtering theory, and the real-time attitude estimation will use the three low orders EKF for UAV flying.

The paper is organized as follows. The design of attitude estimation filter is presented in Section 2. Section 3 focuses on the implementation of the attitude estimation filter. Experimental results obtained during UAV flying are presented in Section 4 to illustrate the performance of the proposed AHRS. Concluding remarks and future work are pointed out in Section 5.

#### 2. Problem Statement and System Design

The Euler angles describe the body-axis orientation of UAV body coordinate frame ( frame) in North, East, and Up navigation coordinates frame ( frame). Here, is the yaw angle, is the pitch angle, and is the roll angle, as illustrated in Figure 1. The initial attitude and heading of the UAV are needed to initialize the AHRS. When UAV is stationary, Initial attitude and heading of UAV are computed by accelerators and digital compass. The calculation formulas are described as follows: where, , , and are the specific force of the accelerometers in body coordinate frame ( frame). , , and are the components of the magnetic field strength in body coordinate frame.

However, stationary UAV is difficult owing to wind and engine vibration in actual test, the initial attitude and heading are seriously influenced by high-frequency noise when the initial attitude and heading are computed by using (1). When the condition of UAV is stationary or low dynamic, the attitude and heading of UAV are accurate and have good low-pass property. However, the error of attitude and heading computed from the gyroscopes output is large since it is easily influenced by drift of the gyroscope. There is complementary property between the attitude derived from the gyroscope outputs and the attitude derived from the accelerometer outputs. The complementary filters theory provides an estimate of the true signal by employing two complementary high-pass and low-pass filters, and an unknown signal can be estimated using corrupted measurements from one or more sensors whose information naturally stands in distinct and complementary frequency bands [19–21]. The initial attitude estimation filter based on complementary filter is to pass the attitude derived from the gyroscope through a high-pass filter and the attitude derived from the accelerometer through a low-pass filter and then to fuse those signals to obtain the estimated attitude; thus, compensating for the drift on the gyroscope and for the slow dynamics of the accelerometer, the block is shown in Figure 2.

The real attitude and heading are processed on an embedded processor in actual flying test, major difficulties when implementing a centralized extended Kalman filter (CEKF) on a embedded processor arise from the complexity caused by the need of the Jacobian matrix computing and the system equation linearizing, and this problem is exacerbated by the need to implement an EKF with a large number of states. To solve this problem, the attitude and heading estimation filter based on the distributed filtering is designed and completed, three low-order parallel EFK are implemented on the ARM 9 embedded processor. The block diagram of the orientation estimating filter based on the distributed filtering is shown in Figure 3.

#### 3. Attitude and Heading Estimation Filter

##### 3.1. Initial Alignment Filter

Complementary filters have been widely used to combine two independent noisy measurements of the same signal, where each measurement is corrupted by different types of spectral noise [19]. The complementary filters have first-order filter and second-order filter; the second-order complementary filter consists of a second-order high-pass filter and a second-order low-pass filter. The second-order complementary filter of the attitude is described as follows [22]: where is the differential operator, is the natural frequency, and is the damping ratio.

With the estimated roll and pitch, the yaw can be derived from the measured strength of the magnetic field in body coordinate frame by the digital compass: where , , and are the components of the magnetic field strength in navigation coordinate frame ( frame). The relationship between real heading and is described as follows [23]:

##### 3.2. Attitude and Heading Estimation Filter

According to the initial attitude and heading, the initial strapdown attitude matrix is computed as follow [23]:

Attitude and heading estimation depend on the updated quaternion; the system state equation selected the system state is built as follows: where , , and is the ideal value, real output value, and drift of gyroscopes in body coordinate frame ( frame), respectively. is the state transition matrix; is the covariance matrix of noise.

According to (1) and (5), the measurement equation is built by the attitude derived from the gyroscope output and the attitude derived from the accelerometers output. The measurement equation is described as follows: where is the error of the attitude and heading. is the yaw derived from the digital compass. and is respectively the pitch, and roll derived from the accelerators; the computing equations are described in (1) , , and is respectively the yaw, pitch, and roll derived from the quaternion, the computing equation is described as follows [23]:

The measurement matrix (See Appendix) is obtained by linearizing (6) and (7):

The quaternion is updated by (6) and (7), the principal value of pitch, roll and yaw are derived from the updated [23], for example,

The domain of yaw, pitch, and roll is , and , respectively. The domain and range of pitch are the same; the real value of pitch is the principal value, for example, . The real value of yaw and roll is computed as follows, respectively [23],

#### 4. Experimental Test and Results Analysis

Experiments are conducted using an autopilot self-developed from Digital Navigation Center (DNC), BUAA (see Figure 4). This system is composed of three single-axis accelerometers, three single-axis gyroscopes, one 3-axis digital compass, one barometer, one airspeed meter, and one Global Positioning System (GPS) receiver. In order to test the proposed attitude and heading calculation method based on distributed filtering, the dynamic test on the ground and flying test are implemented by using the autopilot from DNC. In the process of dynamic testing, the autopilot is put on the ground, the pitch and roll of UAV do not change, the autopilot is turned around the axis from the initial yaw to 360°, the yaw is turned to make a quarter turn, and the autopilot is stationary for a period of time. The outputs of the AHRS and the reference values for the dynamic test on the ground is represented in Figure 5. The error between of AHRS outputs and the reference values are represented in Figure 6 and Table 1.

Seen from Figures 5 and 6, and Table 1 the attitude calculated output from the AHRS system this paper proposed is stable and can track the reference value. The pitch, roll, and yaw have big fluctuation because when the yaw is turned manually, the MIMU cannot maintain horizontality, and the precision of pitch, roll, and yaw is 0.069°, 0.089°, and 0.15°, respectively.

In order to further test the AHRS system this article proposed, the flight test is carried out using a fixed-wing UAV. After the plane takes off through manual manipulation, the condition is changed to automated driving condition during aircruise phases and the acceleration, gyroscope, and magnetic compass data are stored in an SD card. The test verification is based on the actual data and the results are shown in Figure 7 and Table 2.

Seen from Figure 7 and Table 2, the attitude calculated output from the AHRS system this paper proposed is also stable under the dynamic condition through actual flight test. The attitude error between AHRS outputs and reference value is small and the precisions of pitch and roll are 3.73° and 4.43°, respectively. So, AHRS can give a stabilized attitude and heading information in long time.

#### 5. Conclusions

In this paper, based on the distributed filter, the low-cost attitude and heading reference system has been developed. The dynamic test on the ground and actual flight test are implemented, and the test results show that the presented AHRS based on the distributed filter can give the stabilized attitude and heading information for a long time and can implement the automatic flight control of UAV.

#### Appendix

The attitude and heading based on quaternion were updated as follows:

#### Acknowledgments

This project is supported by the Key Program of the National Natural Science Foundation of China (Grant no. 61039003), the National Natural Science Foundation of China (Grant no. 41274038), the Aeronautical Science Foundation of China (Gratis no. 20100851018), and the Aerospace Innovation Foundation of China (CASC201102).

#### References

- T. H. Cox, C. J. Nagy, M. A. Skoog, and I. A. Somers, “Civil UAV capabil it y assessment,”
*The National Aeronautics and Space Administration*, pp. 1–10, 2006. View at Google Scholar - Z. Wachter, “A cost effective motion platform for performance testing of MEMS-based attitude and heading reference systems,”
*Journal of Intelligent & Robotic Systems*, vol. 70, no. 411, pp. 1–9, 2013. View at Google Scholar - S. J. Zaloga, D. Rockwell, and P. Finnegan,
*World Unmanned Aerial Vehicle Systems Market Profile and Forecast*, Teal Group Corporation, 2011. - R. Schneiderman, “Unmanned drones are flying high in the military/aerospace sector,”
*IEEE Signal Processing Magazine*, vol. 29, no. 1, pp. 8–11, 2012. View at Publisher · View at Google Scholar · View at Scopus - R. Wolf, G. W. Hein, B. Eissfeller, and E. Loehnert, “Integrated low cost GPS/INS attitude determination and position location system,” in
*Proceedings of the 9th International Technical Meeting of the Satellite Division of the Institute of Navigation (ION GPS '96)*, pp. 975–981, September 1996. View at Scopus - Y. Li, A. Dempster, B. H. Li, J. L. Wang, and C. Rizos, “A low-cost at t itude heading reference system by combinat ion of GPS and magnetometers and MEMS inert ial sensors for mobile applicat ions,”
*Journal of Global Positioning Systems*, vol. 5, no. 1-2, pp. 88–95, 2006. View at Google Scholar - P. Martin and E. Salaün, “Design and implementation of a low-cost aided attitude and heading reference system,” in
*Proceedings of the AIAA Guidance, Navigation, and Control Conference*, 2008. - W. Geiger, J. Bartholomeyczik, U. Breng et al., “MEMS IMU for AHRS applications,” in
*Proceedings of the IEEE/ION Position, Location and Navigation Symposium (PLANS '08)*, pp. 225–231, May 2008. View at Publisher · View at Google Scholar · View at Scopus - S. Sukkarieh, P. Gibbens, B. Grocholsky, K. Willis, and H. F. Durrant-Whyte, “Low-cost, redundant inertial measurement unit for unmanned air vehicles,”
*International Journal of Robotics Research*, vol. 19, no. 11, pp. 1089–1103, 2000. View at Publisher · View at Google Scholar · View at Scopus - L. Sherry, C. Brown, B. Motazed, and D. Vos, “Performance of automotive-grade MEMS sensors in low cost AHRS for general aviation,” in
*Proceeding of the 22nd Digital Avionics Systems Conference*, vol. 2, pp. 12.C.2/1–12.C.2/5, October 2003. View at Scopus - M. L. Psiaki, “Attitude-determination filtering via extended quaternion estimation,”
*Journal of Guidance, Control, and Dynamics*, vol. 23, no. 2, pp. 206–214, 2000. View at Google Scholar · View at Scopus - J. L. Marins, X. Yun, E. R. Bachmann, R. B. McGhee, and M. J. Zyda, “An extended Kalman filter for quaternion-based orientation estimation using MARG sensors,” in
*Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems*, pp. 2003–2011, November 2001. View at Scopus - J. L. Crassidis, “Sigma-point Kalman filtering for integrated GPS and inertial navigation,”
*IEEE Transactions on Aerospace and Electronic Systems*, vol. 42, no. 2, pp. 750–756, 2006. View at Publisher · View at Google Scholar · View at Scopus - R. D. Van Merwe, E. A. Wan, and S. I. Julier, “Sigma-point kalman filters for nonlinear estimation and sensor-fusion—applications to integrated navigation,” in
*Proceedings of the AIAA Guidance, Navigation, and Control Conference*, pp. 1735–1764, August 2004. View at Scopus - C. Hide, T. Moore, and M. Smith, “Adaptive Kalman filtering for low-cost INS/GPS,”
*Journal of Navigation*, vol. 56, no. 1, pp. 143–152, 2003. View at Publisher · View at Google Scholar · View at Scopus - J. L. Crassidis, F. Landis Markley, and Y. Cheng, “Survey of nonlinear attitude estimation methods,”
*Journal of Guidance, Control, and Dynamics*, vol. 30, no. 1, pp. 12–28, 2007. View at Publisher · View at Google Scholar · View at Scopus - F. L. Markley, “Attitude error representations for Kalman filtering,”
*Journal of Guidance, Control, and Dynamics*, vol. 26, no. 2, pp. 311–317, 2003. View at Google Scholar · View at Scopus - J. L. Speyer, “Computation and transmission requirements for a decentralized Linear-Quadratic-Gaussian control problem,”
*IEEE Transaction on Automatic Control*, vol. 24, no. 2, pp. 266–269, 1979. View at Google Scholar - D. W. Jung and P. Tsiotras,
*Inertial Attitude and Position Reference System Development for a Small UAV*, American Institute of Aeronautics and Astronautics, 2007. - W. T. Higgins Jr., “A comparison of complementary and Kalman filtering,”
*IEEE Transactions on Aerospace and Electronic Systems*, vol. 11, no. 3, pp. 321–325, 1975. View at Google Scholar · View at Scopus - J. F. Vasconcelos, C. Silvestre, P. Oliveira, P. Batista, and B. Cardeira, “Discrete time-varying attitude complementary filter,” in
*Proceedings of the American Control Conference (ACC '09)*, pp. 4056–4061, June 2009. View at Publisher · View at Google Scholar · View at Scopus - Y.-C. Lai, S.-S. Jan, and F.-B. Hsiao, “Development of a low-cost attitude and heading reference system using a three-axis rotating platform,”
*Sensors*, vol. 10, no. 4, pp. 2472–2491, 2010. View at Publisher · View at Google Scholar · View at Scopus - Z. Chen,
*Strapdown Inertial Navigation System*, China Astronautic Publishing House, 1986.