Abstract

In this paper, the attitude control of aircraft with multiple inertial measurement units under the influence of unknown gyro zero drift and external disturbance is studied. First of all, the observers are designed to estimate the zero drift biases based on the consensus algorithm. The angular velocity used for aircraft control is obtained by compensating the biases. Then, considering the external disturbance in the aircraft motion, this paper introduces a super-twisting sliding-mode algorithm to design the observer in order to compensate the disturbance. In addition, based on the proposed observers, a controller is designed to realize attitude control of the aircraft with the gyro zero drift and the external disturbance. Finally, the simulation results are given to verify the effectiveness of the proposed control law.

1. Introduction

The aircraft is the unmanned robot operated by radio remote control equipment or self-contained program control device. It is widely used in transportation, reconnaissance, photography, and other fields [1]. In recent years, the research on the aircraft is hot at home and abroad because of many advantages of the aircraft, such as the easy maintenance, high maneuverability, and high reliability [2]. In this paper, the hot spot field of aircraft-attitude control is studied. It is worth mentioning that there are two main factors that interfere with the attitude control of the aircraft: external disturbance of the aircraft and measurement deviation of the inertial measurement unit (IMU). The external disturbance of the aircraft, such as the disturbance of air flow, will lead to the unstable movement of the aircraft and lead to the failure of control. Measurement deviations, such as zero drift biases, can lead to inaccurate angular velocity of the aircraft, resulting in aircraft control failure. In addition, the attitude information obtained by a single IMU cannot meet the requirements of attitude control.

For the external disturbance, most of the current research results use the observer to estimate the disturbance and compensate the controller. As a class of nonlinear observers, sliding mode observers can work under less conservative conditions [3, 4]. Mofid et al. [5] proposed an adaptive sliding mode disturbance observer for synchronization of a fractional-order Dadras–Momeni chaotic system with time-varying disturbances is presented. Hou et al. [6] proposed a novel disturbance observer with the super-twisting sliding mode technique in order to improve the performance of the permanent magnet synchronous motor speed regulation system. To deal with the effect of the angular velocity biases caused by the zero drift, there are two main solutions in the current literature: (1) through the physical calibration of the gyro to solve the effect of zero drift bias on the measurement results [710] and (2) the zero drift biases can be estimated and compensated by attitude estimation [1113], which is like the idea of disturbance estimation and compensation [14]. The authors in [15] proposed a novel analytic calibration of gyro biases with arbitrary double position based on the transformation model of gyro biases. According to the analytic-coarse-alignment principle, the sensitivities of Euler angles with respect to inertial sensor biases are analyzed uniquely. The authors in [16] proposed a bias compensation and parameter calibration method based on Gauss–Newton algorithm. The method can effectively suppress zero drift, but its operation is cumbersome. Unscented Kalman filters (UKF) [17], extended Kalman filters (EKF) [18], and nonlinear complementary filters [19] are the popular methods of attitude estimation in the literature. However, small aircrafts are often equipped with low-precision gyros, which often carry non-Gaussian noise during the measurement process. This will cause the Kalman estimation algorithm to fail. The authors in [20] proposed a solution by constructing an observer. This work designed an observer for estimating the constant biases caused by the zero drift and proposed a coupled nonlinear spacecraft attitude controller. The authors in [21] presented a nonlinear attitude estimator based on an alternate error function, and this estimator can be implemented using a low-cost inertial measurement unit.

The conventional IMU consists of an accelerometer and a gyro for aircraft attitude control. IMU has also been widely used in smart wearable devices [22], navigation of unmanned systems [23, 24], guidance of military equipment [25], and so forth. Due to the increasing demand for inertial measurement devices in various fields, higher requirements have been placed on the measurement accuracy of inertial devices. In recent years, researchers have also proposed the configuration design of multiple accelerometers and gyro arrays. The authors in [26] analyzed the performance of the IMU and its various sensor configurations. The measurement accuracy is effectively improved by selecting the appropriate geometric configuration and the combination of multiple inertial navigation sensors. The authors in [27] used a single-axis gyro and multiple spatially distributed accelerometers to achieve the correction of the attitude measurement value. The authors in [28] designed three two-axis accelerometer inertial measurement units to measure the angular velocity of six degrees of freedom and compensated the measurement error through data fusion. The authors in [29] studied 12 accelerometers and gyros assigned IMU and proposed an EKF program to estimate the direction and amplitude of angular velocity. Research shows that attitude measurement systems that use multiple sensors have advantages over single sensor. The main difficulty in attitude control of multiple IMUs is how to design the multiple observers to synchronize [3032]. Also, there some results have been reported about the synchronization of multiple observers/controllers [3335].

So far, most of the research results on attitude control adopt single IMU. For the large aircraft, a single IMU can no longer meet its technical requirements [36]. Since the measurement range of a single gyro is easily saturated in high dynamic motion, its application is also limited. In addition, the attitude control of the aircraft will be unstable due to the zero drift and external disturbance. Therefore, considering the above problems, it is necessary to study the anti-interference control of aircraft attitude under multiple IMUs.

Motivated by the above discussions, this paper studies the attitude tracking control law of the aircraft with zero drift and external disturbance based on multiple inertial measurement units. As in the work [37], this paper assumes that the biases caused by the zero drift are constant in this paper. In order to solve this problem, this article will make full use of the data measured by each IMU to design the nonlinear observer, estimate the zero drift biases, and compensate for it. Then, a super-twisting sliding mode observer will be designed to compensate the disturbance. In addition, a tracking controller will be proposed. By constructing a suitable Lyapunov function, the asymptotic stability of the attitude system will be strictly proven. The asymptotic stability of the combined system of the observer and controller will be proved by the theory of cascade system. Finally, a simulation will be given to verify the effectiveness of the proposed control law. The main innovation points/contributions of the method proposed in this paper are as follows. (1) In this paper, multiple IMUs are used for measurement and observers are designed based on consensus algorithm. The observer designed in this paper can estimate the zero drift biases. (2) In this paper, a super-twisting sliding mode observer is used to estimate and eliminate external disturbances. Combined with the proposed attitude observer, the internal disturbance and external disturbance can be eliminated. (3) The aircraft model has highly nonlinear and strong coupling, the design of the control system is very difficult. In this paper, by analyzing the aircraft attitude system, the attitude observer and controller are proposed. By compensating for the zero drift, the attitude tracking control of the aircraft is realized.

2. Preliminaries

2.1. Problem Description

The attitude model is mainly composed of kinematics and dynamics equations. In this article, the Euler angles will be used to describe the attitude with respect to the inertial frame. The Euler vector is given bywhere is the angle of pitch, is the angle of roll, and is the yaw angle.

Based on the Euler angles, the attitude kinematics equation of the aircraft iswhere is the angular velocity which can be measured by gyro, and the matrix is given by

In fact, the inertial measurement unit composed of a single gyro and a single accelerometer cannot meet the measurement accuracy requirements of the aircraft. To this end, this paper will adopt multiple IMUs to attitude control.

In this paper, sets of IMUs are considered for measurement and let . Each IMU is independent, and its measurement results include the angular velocity and the attitude, i.e., . In addition, due to the inherent shortcomings of the device, the gyro will produce zero drift, which leads to the measurement of angular velocity with unknown bias, as shown in [20]. The measured angular velocity of th IMU can be written as follows:where is the unknown gyro bias of th IMU’s gyro.

The control objective of this paper is to obtain accurate attitude data through multisensor measurement data. On this basis, the attitude tracking control of the aircraft is carried out.

Assumption 1. (see [37]). This paper assumes that the zero drift bias of th IMU’s gyro is a constant value, and the zero drift bias of each gyro is different.

2.2. Related Definition and Lemma

Definition 1. For any , the nonlinear function is defined as

Lemma 1. (super-twisting sliding-mode algorithm, see [38]). Consider the systemwhere are the gains to be designed and are the perturbation terms; it satisfieswhere . Under some conditions on , the equilibrium point of system (6) will converge to the origin in a finite time .

2.3. Graph Theory

In this paper, the multiple IMU will be considered. Each IMU can be seen as a node. The information interaction among nodes can be represented by the directed graph . is the set of nodes, is the set of edges, and is the weighted adjacency matrix of the graph with nonnegative adjacency elements . If there is an edge from node to node , i.e., , then , which means there exists an available information channel from node to node . The set of neighbors of node is denoted by . The out-degree of node is defined as . Then, the degree matrix of digraph is and the Laplacian matrix of digraph is .

A path in graph from to is a sequence of of finite nodes starting with and ending with such that for . The graph is connected if there is a path between any two distinct vertices.

3. Main Results

To solve the attitude tracking maneuver in the presence of unknown gyro bias, the main design procedure is divided into two steps:The observer for each IMU to estimate the gyro bias is designed based on the consensus algorithmAn attitude controller based on the observer is designed to realize asymptotically stable attitude tracking

3.1. Design of Nonlinear Observers Based on Consensus Algorithm

Because of the nonlinear structure of attitude system (2), it is difficult to design an observer under multiple IMUs. In this paper, let denote the estimation of the gyro unknown bias for the th IMU’s gyro and denote the estimated value of the real-time attitude of the aircraft for the th IMU’s accelerometer. Based on models (2) and (4), we can design the following observer.

Theorem 1. Considering the attitude system (2) and Assumption 1, if the observers are designed aswhere , then the estimation value will globally asymptotically converge to true value .

Proof. First of all, let the estimation error for gyro bias be . Then, the error dynamical equation can be obtained:Choose the Lyapunov function for the error system (9) aswhose derivative isBased on LaSalle’s invariant principle, it is easy to get the conclusion that will globally asymptotically converge to the origin, i.e., will globally asymptotically converge to true value . The proof is completed.

Remark 1. With observer (8), the gyro of th IMU can estimate the true value of the gyro zero drift . By compensating the bias, the angular velocity of the th IMU can be obtained, i.e., . The angular velocity used to control the attitude of the aircraft in this paper is given by

3.2. Design of a Nonlinear Controller Based on a Super-Twist Observer

The dynamic equation of the aircraft is as follows:where and are, respectively, the positive definite inertia matrix, and the control torque of spacecraft, denotes the external disturbance satisfies with a positive constant , and the symbol denotes the skew symmetry matrix, i.e.,

The desired attitude is described as , and it is constant in this paper. Define the attitude error between the true value and the desired value as . To sum up, the attitude error system of the aircraft is

Theorem 2. For the attitude error system (15), if the controller is designed aswhere , represents the estimate of the angular velocity, and denotes the estimate of the external disturbance; then, the asymptotic tracking of attitude can be implemented.

Proof. It can be known from Theorem 1 that will eventually converge to . The observation errors and are defined aswhose derivative isFrom Lemma 1, we know that and will converge to 0 in a finite time. In other words, the estimated disturbance value will converge to the true value in a finite time . After , it follows (15) and (16) thatIt follows (9), (15), and (19) thatwhere . Obviously, system (20) can be regarded as a cascaded system with the cascaded term . Next, we will use cascaded systems’ theory [39] to analyze the stability of system (20). The proof includes two steps:Step 1: proof of global asymptotic stability of subsystems.Consider the following system:Choose the following Lyapunov function for the attitude error system (21):Based on the matrix which is skew symmetric, the derivative of along system (21) isBased on LaSalle’s invariant principle, it can be concluded that as , which implies that system (21) is globally asymptotically stable. It is easy to get the conclusion that as .Clearly, system (9) and system (21) are globally asymptotically stable with equilibrium .Step 2: proof of global state bounded of cascaded system.According to the cascaded systems’ theory [39], cascades of the globally asymptotically stable systems remain globally asymptotically stable if and only if solutions are globally bounded. With these facts in mind, to prove the stability of system (20), we only need to prove that the state of system (20) is globally bounded. To achieve this objective, choose the Lyapunov function:According to (11) and (23), it obtainsSince systems (9) and (21) are globally asymptotically stable, and are globally bounded. There is a constant such that . We haveClearly, when , then . Thus, the state is globally bounded.
With this fact in mind, it can be concluded that the state of system (20) is globally bounded, which implies that this system is asymptotically stable. That is to say the attitude tracking is achieved asymptotically.

Remark 2. According to the previous proof, when the observer gains meet and the controller gains meet , the attitude asymptotic stability tracking can be realized. In practical applications, the observer gain and controller gain can be selected step by step to obtain better performance.

4. Simulation Example

A simulation example is given to verify the effectiveness of the proposed method. In this paper, three inertial measurement units are selected for simulation. Next, the initial values, parameters, and real values required for simulation in this paper are given. The information exchange topology among IMU is shown in Figure 1. The initial values of the observer part are selected as . The observer parameters are . The initial values of the controller are selected as . The controller parameters are . The desired attitude of the aircraft is set as . The true biases of the IMUs’ gyro are selected as . The external disturbance is set as . The inertia matrix of the aircraft is chosen as that in [40]:

The simulation results are shown in Figures 25. First, the bias estimation of the th IMU is given in Figure 2, from which it can be found that the proposed nonlinear observer is effective. The angular velocity of the th IMU is given in Figure 3.

In addition, the response curve of aircraft’s angular velocity is given in Figure 4 and the response curve of aircraft’s attitude is given in Figure 5.

5. Conclusions and Future Directions

5.1. Conclusions

The aircraft adopts a single IMU as the attitude measurement sensor, which can no longer meets the requirements of measurement accuracy. And, due to the shortage of sensors and noise, gyro will produce zero drift, which will lead to constant biases of measured angular velocity. Measurements of angular velocity with constant biases and external disturbance will make the attitude control system unstable. Therefore, the attitude anti-interference control under multiple IMUs is studied in this paper. Firstly, aiming at the zero drift, this paper adopts multiple IMUs for measurement, and the consensus observer is designed to ensure that each IMU converges to the true value of angular velocity. Aiming at the instability of aircraft control caused by external disturbances, this paper introduces a super-twisting sliding mode observer, which compensates for the external disturbances. In addition, a controller is proposed in this paper, and the actual attitude can globally asymptotically converge to the desired attitude based on the observer. Simulation results also demonstrate the effectiveness of the proposed method.

5.2. Future Directions

Future work will focus on designing observers that the zero drift biases of gyros are time-varying conditions and that the attitude information is unknown.

Data Availability

Some or all data, models, or code generated or used during the study are available from the corresponding author upon request.

Conflicts of Interest

The authors declare that there are no conflicts of interest regarding the publication of this paper.

Acknowledgments

This work was supported by the National Natural Science Foundation of China under Grant no. 52075118.