Mathematical Problems in Engineering

Volume 2014, Article ID 472815, 9 pages

http://dx.doi.org/10.1155/2014/472815

## An Adaptive Nonlinear Control for Gyro Stabilized Platform Based on Neural Networks and Disturbance Observer

Fundamental Science on Novel Inertial Instrument & Navigation System Technology Laboratory, Beijing University of Aeronautics and Astronautics, Beijing 100191, China

Received 3 July 2014; Revised 30 October 2014; Accepted 10 November 2014; Published 25 November 2014

Academic Editor: Vu Ngoc Phat

Copyright © 2014 Jiancheng Fang and Rui Yin. 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

In order to improve the tracking performance of gyro stabilized platform with disturbances and uncertainties, an adaptive nonlinear control based on neural networks and reduced-order disturbance observer for disturbance compensation is developed. First the reduced-order disturbance observer estimates the disturbance directly. The error of the estimated disturbance caused by parameter variation and measurement noise is then approximated by neural networks. The phase compensation is also introduced to the proposed control law for the desired sinusoidal tracking. The stability of the proposed scheme is analyzed by the Lyapunov criterion. Experimental results show the validity of the proposed control approach.

#### 1. Introduction

In order to obtain high resolution and definition imaging for many applications including surveillance, target tracking, and missile guidance, gyro stabilized platform (GSP) is used to stabilize and point the line-of-sight (LOS) of cameras, sensors, or other payload [1–6]. So, the tracking and stabilizing accuracy of GSP must be improved for high quality imaging. However, in a practical GSP system, the motion precision may seriously be degraded due to large quantities of disturbances and uncertainties, for example, unmodeled dynamics, parameter variation, friction force, imbalance, cable and spring torques, coupling torques, gyro and sensor noise, gear reactions, and load disturbances [1].

Therefore, to compensate for disturbances of GSP, different control strategies have been developed [7–11]. In [7], a reduced-order observer was designed according to linear control theory for an inertially stabilized line-of-sight control system. The method can be simply completed but requires an accurate system model to achieve satisfactory performance. The disturbance observer based internal-loop compensator was introduced in [8] to estimate the disturbance of GSP. However, this method is also dependent on the accurate system model. An extended-state-observer was used to estimate disturbance for a floated inertial platform in [9]. Unmodeled dynamics, parameters uncertainty, and sensor noise considered as the internal disturbance are estimated together with the external disturbance and are compensated to the control system as feed-forward control. However, due to the extension of the dimension of the system and the need of adjusting many parameters, the method is complicated and it is hard to obtain optimal parameters tuning. In [10], based on PI disturbance observer (DOB), an integral sliding mode controller (SMC) was presented for three-axis inertial platform. The method combines DOB with SMC to improve the precision of system, but the parameters of control system are without autotuning in the process of control. In order to attenuate the platform disturbance, two-degree-of-freedom internal model controller (IMC) was used in [11]. The IMC method has robustness on parameter perturbation, but the disturbance structure is needed to be known. Since neural networks (NN) have distinct advantages of learning and approximating nonlinear functions and are independent of the system model or disturbance structure, they have received considerable attention in control systems for modeling and compensation purposes [12–16].

An adaptive nonlinear control using NN and reduced-order disturbance observer is proposed for disturbance compensation in this paper. All disturbances including friction force, imbalance, cable and spring torques, coupling torques, load disturbances and equivalent disturbance caused by unmodeled dynamics, parameter variation, gyro and sensor noise, and gear reactions are considered a total disturbance, which is estimated by the reduced-order disturbance observer first. The error of the estimated disturbance is then approximated by NN. Phase compensation is introduced in the proposed control law for the desired sinusoidal tracking. The stability of the proposed scheme is analyzed by the Lyapunov criterion. Experimental results show that the tracking performance can be improved significantly with the use of the NN + DOB as compared to the case only with DOB compensation.

This paper is organized as follows. First, in Section 2, the system of GSP is modeled with the introduction of basic reduced-order DOB, and noise coupling characteristics and sensitivity to parameters variation of the DOB are analyzed. Then, Section 3 is devoted to designing adaptive nonlinear controller for disturbance compensation. Experiments are developed in Section 4. Finally, Section 5 concludes this paper.

#### 2. Statement of the Problem

In this section, some preliminaries are introduced first, including GSP model and basic reduced-order DOB design, and then noise coupling characteristics and sensitivity to parameters variation of the DOB are analyzed by the simulation results, to facilitate the proposal of the new methods.

##### 2.1. GSP Model

The assumptions made for the development of GSP model are as follows: (1) motor inductance is ignored and (2) the gimbal is considered rigid. Then, the one gimbal model of GSP can be expressed as follows: where is the moment of inertia of gimbal; is the motor input voltage; is the motor torque constant; is the back-EMF coefficient; is the motor resistance; is the motor current; is the command torque from the gimbal drive motor; is the gear ratio; is the gimbal rate relative to the inertial coordinate; and is the torque-equivalent representation of all disturbance torques, which can disrupt the behavior of the gimbal system.

##### 2.2. Basic Reduced-Order DOB Design

Figure 1 shows the block diagram of single-axis GSP control system combined with a single-state observer [7]. The control system is configured as a high bandwidth negative-feedback rate loop inside a lower bandwidth negative-feedback pointing or tracking position loop. The two loops, the track loop and the rate loop, must be stable, responsive to command inputs, and insensitive to disturbances, noise, and parameters variation. Here, is estimated disturbance torque. is observer gain. is gyro scale factor. is gyro measurement noise. is rate command. is angle command. is the feedback controller for rate loop. is the feedback controller for position loop. is the transfer function for the gyroscope. is the estimated angle velocity. is the Laplace variable. , , , , and denote the best known values available for , , , , and , respectively.

*(**1) Disturbance Rejection Characteristics*. The disturbance rejection ratio , which is used to estimate the angular motion due to the disturbance torque, can directly reflect the disturbance rejection characteristics of control system. The nature and quality of the disturbance rejection with different observer gains are interesting, so the simulation for the disturbance rejection characteristics is under the assumption that there is no parameters variation and . The parameters of single-axis GSP control system for simulation are listed in Table 1; the feedback controllers ; the transfer function ; angle command . The observer gain is selected as 0, 100, 500, and 1000, respectively. The disturbance torque , with selected as 0.5, 5, and 50, respectively. Figure 2 shows the frequency response of disturbance rejection transfer function with different observer gains, at the angle displacement, which is . Figure 3 shows the angle displacement and the estimated disturbance torque with different observer gains under the condition of . Figure 4 shows the angle displacement and the estimated disturbance torque error () with different disturbance torque under the condition of .

Disturbance rejection ability is enhanced with at lower frequencies. The higher the value of , the less the error of the estimated disturbance torque. However, at higher frequencies, the reduced-order observer has less effect on disturbance rejection characteristics. With the increment of disturbance frequency, the estimated disturbance torque error increases significantly. The disturbance rejection is mainly dependent on the basic control structure.

*(**2) Noise Coupling*. Fiber optic gyroscope noise, which always exists in real GSP control system, is complicated and consisted of angular random walk, bias instability, rate random walk, rate ramp, quantization noise, exponential correlation noise, sinusoidal noise, and so forth. The expression of gyro noise is simplified in this paper as follows:
where is the measured gyro rate; is low frequency noise; is high frequency noise; , , and are the amplitude, frequency, and initial phase of high frequency noise, respectively.

The following simulations are under the assumption that there is no parameters variation and . Figure 5 shows the frequency response of noise coupling transfer function with different observer gains, at the angle displacement, which is . Figure 6 shows the angle displacement with different observer gains under high frequency noise and low frequency noise , respectively.

At higher frequencies measurement noise, with the increment of , the measurement noise couples more deeply, which leads to more angle displacement, while, at lower frequencies measurement noise, the observer has less effect on noise coupling, and a large angle error emerges because of the lower frequencies measurement noise.

*(**3) Variation of Parameters*. The reduced-order observer shown in Figure 1 needs the most approximate parameter values of the single-axis GSP system, such as , , , , and . In these parameters, and are the motor parameter, is the gyro parameter, and is the gear parameter, which have less parameter fluctuations than the gimbal inertia , for the whole system includes many components, and the gimbal inertia is difficult to confirm by measurement. So, the effect of the variation of the gimbal inertia on the disturbance rejection is mainly analyzed. The difference between the estimated and the actual inertia is , which may be assumed to be known within about ±20%. Figure 7 shows the estimated disturbance torque with and without parameter variation under the condition of . Figure 8 shows the error of estimated disturbance torque with different observer gains, under the condition of .

The parameter variations seriously reduce the accuracy of the estimated disturbance torque, which has no obvious change with different observer gains.

#### 3. Nonlinear Control for the GSP System

In this section, in order to overcome the problem of low frequency gyro noise and parameter variation, a method of phase compensation is proposed first and, then, an adaptive nonlinear control for disturbance compensations is derived.

##### 3.1. Phase Compensation

The block diagram of the single-axis GSP control system without disturbance is shown in Figure 9.

The transfer function of the system can be derived as follows:

Let , , , , , and . The frequency response figure of the transfer function () is shown in Figure 10. As the frequency of angle command is increasing, the phase delay is obvious, so compensating the phase is necessary for tracking system.

Define the tracking error as and the velocity error as , and . The following control law for phase compensation is proposed, as shown in Figure 11:

The transfer function of the system with the control law (4) can be obtained as follows, and the system gets an ideal result theoretically:

##### 3.2. Disturbance Compensation

Differentiating the velocity error and using (1) and (4), the single-axis GSP control system dynamics can be expressed as

The effect of all disturbance torques is too complicated to be modeled, so the common compensation based on disturbance model is hardly complemented in this system. The reduced-order disturbance observer and neural networks compensator will be used to design a nonlinear controller for disturbance compensation. The disturbance is estimated by the reduced-order disturbance observer, and the neural networks compensator based on radial basis function (RBF) approximates the error of estimated disturbance caused by parameter variations, lower frequencies measurement noise, and so forth.

As shown in Figure 1, the estimated disturbance can be expressed as

Define the disturbance estimated error as . NN compensator based on RBF is used to approximate it as where denotes the optimal estimate value of ; is the optimal weight vector with the node number ; is chosen as the commonly used Gaussian radial basis functions; is the network input vector; and is the NN approximation error satisfying with .

Since the ideal weights are unknown, let be the estimates of ; thus, the NN compensator is designed as where is the estimated value of .

The following adaptive nonlinear control law is proposed shown in Figure 12: where is the estimated value of .

Substituting (10) and (8) into (6), where is the weight-estimation errors.

The adaptation laws for the parameters and are where is a dimensionally compatible constant matrix, and .

Then, the stability of the proposed scheme can be analyzed by Lyapunov criterion as follows.

Theorem 1. *Assuming that the angle commands , , and are bounded, the control laws (10), together with the parameter update laws (13), guarantee the tracking errors and to be uniformly ultimately bounded.*

*Proof. *Consider the following Lyapunov function:
where .

By applying (11)–(14), the time derivative of is given by

From Lyapunov stability theory, the Lyapunov function is an energy function of errors , , and , and , which is derived from expression (15). Therefore, the errors can then asymptotically converge to zero as time goes to infinity. So, for GSP system in this paper, the designed control system is stable and the variables will converge to a neighborhood of zero in a finite time. Because is a stable system, the tracking error will also converge to a neighborhood of zero by adjusting some control design parameters.

#### 4. Experiments

##### 4.1. Experimental Setup

To demonstrate the effectiveness of the proposed method, real-time experiments are carried out on the outer gimbal of GSP shown in Figure 13. The gimbal position is measured by accelerometer, dc current is measured by high bandwidth Hall effect current sensor, and the angle velocity of the gimbal is measured by fiber optic gyroscope and fed to a controller through analog-to-digital converter. The controller, which is programmed using a DSP TMS320F28335 with 30 MHz oscillator, is employed to generate necessary control input signals for high tracking and stabilized precision in the condition of unknown disturbance torque. The sampling period for our test is chosen as 0.01 s. The parameters of the single-axis GSP control system are listed in Table 1.

##### 4.2. Adaptive Nonlinear Controller

In order to avoid the well-known chattering phenomenon in actual experiment, saturation function shown in (16) is used to replace the sign function in the control law (10): where is a small positive content.

The radial basis function (RBF) NN is selected as the NN learning model as follows:

The RBF NN contains 5 nodes with centers evenly spaced in and widths . The NN weights are simply initialized at zero, and the initial value of is selected as 0.01. The adaptation laws for adjusting the controller are given by (13) with the adaptation rates and . During the experimental test, the parameters and in the control law (10) are chosen as 3 and 5.5, respectively. The gain of reduced-order disturbance observer ; the parameter of saturation function .

*Remark 2. *The parameters have effects on the system performance. Theoretically, the larger the , the smaller the tracking error; however, is limited by the rigidity of the mechanism, since large may lead to the system vibration. If is too small, the convergence of the neural weights is slow, which will degrade the system precision. However, if it is large, the convergence may be too fast and leads to undesirable transient response because of large overshoot. So, these parameter values should be chosen by trial-and-error until good performance is obtained.

*(**1) Tracking Experiment*. The efficacy of the proposed controller in reducing the tracking error is first analyzed. The control objective is to follow a sine wave signal . From Figure 14 it is found that the tracking error using DOB + NN decreases by 60% compared with the controller only with DOB. Figure 15 shows the estimated disturbance torque with the two methods.

*(**2) Stabilizing Experiment*. Next, the efficacy of the proposed controller in improving the stabilizing accuracy is analyzed. The desired position is zero. A constant disturbance is added at and is cancelled after 100 s. Figure 16 shows the tracking error of the single-axis GSP system with two methods. The method with DOB has obvious error when adding a constant disturbance, while the method with DOB + NN has more disturbance suppression ability since the tracking error stays almost unchanged. Figure 17 shows the estimated disturbance torque with two methods.

It is thus readily concluded that the proposed controller can reduce the effect of external disturbance and significantly improve the tracking and stabilizing accuracy, for more accurate estimate of the disturbance of the GSP system is compensated with the proposed controller.

#### 5. Conclusion

The reduced-order disturbance observer and neural networks compensator are used to design an adaptive nonlinear controller for disturbance compensation. The disturbance is estimated by the reduced-order disturbance observer, and the neural networks compensator based on radial basis function approximates the error of estimated disturbance. It is found that the tracking error using the proposed method has been reduced by 60% compared with the conventional DOB, and the method with DOB + NN also has more disturbance suppression ability compared with DOB.

#### Conflict of Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.

#### Acknowledgments

This work was supported by Chinese National Innovation Community Foundation (nos. 61121003, 61273033, and 61473019) and the National Natural Science Foundation of China (no. 51205019).

#### References

- J. M. Hilkert, “Inertially stabilized platform technology: concepts and principles,”
*IEEE Control Systems Magazine*, vol. 28, no. 1, pp. 26–46, 2008. View at Publisher · View at Google Scholar · View at MathSciNet · View at Scopus - M. K. Masten, “Inertially stabilized platforms for optical imaging systems,”
*IEEE Control Systems*, vol. 28, no. 1, pp. 47–64, 2008. View at Publisher · View at Google Scholar · View at MathSciNet · View at Scopus - H. G. Wang and T. C. Williams, “Strategic inertial navigation systems—high-accuracy inertially stabilized platforms for hostile environments,”
*IEEE Control Systems*, vol. 28, no. 1, pp. 65–85, 2008. View at Publisher · View at Google Scholar - J. L. Miller, S. Way, B. Ellison, and C. Archer, “Design challenges regarding high-definition electro-optic/infrared stabilized imaging systems,”
*Optical Engineering*, vol. 52, no. 6, Article ID 061310, 2013. View at Publisher · View at Google Scholar · View at Scopus - R. Miller, G. Mooty, and J. M. Hilkert, “Gimbal system configurations and line-of-sight control techniques for small UAV applications,” in
*Airborne Intelligence, Surveillance, Reconnaissance (ISR) Systems and Applications X*, vol. 8713 of*Proceedings of SPIE*, pp. 1–15, 2013. View at Publisher · View at Google Scholar - J. Hilkert and D. L. Amil, “Structural effects and techniques in precision pointing and tracking systems—a tutorial overview,” in
*Automatic Target Recognition XX; Acquisition, Tracking, Pointing, and Laser Systems Technologies XXIV; and Optical Pattern Recognition XXI*, vol. 7696 of*Proceedings of SPIE, 76961C*, p. 1-12, 2010. - J. M. Hilkert and B. Pautler, “A reduced-order disturbance observer applied to inertially stabilized Line-of-Sight control,” in
*25th Acquisition, Tracking, Pointing, and Laser Systems Technologies*, vol. 8052 of*Proceedings of SPIE*, p. 80520H, Orlando, Fla, USA, April 2011. View at Publisher · View at Google Scholar - C. Wu and Z. Lin, “Disturbance observer based control system design for inertially stabilized platform,” in
*Electro-Optical Remote Sensing, Photonic Technologies, and Applications VI, 85420T*, vol. 8542 of*Proceedings of SPIE*, Edinburgh, UK, September 2012. View at Publisher · View at Google Scholar - A. Li, C. Hong, S. Zhang, and C. Yuan, “High-precision stabilization control for a floated inertial platform,” in
*Proceedings of the 25th Chinese Control and Decision Conference (CCDC '13)*, pp. 1193–1199, May 2013. View at Publisher · View at Google Scholar · View at Scopus - Y. Hu, Y. Cao, and S. Zhang, “Design of sliding mode control with disturbance observers for inertial platform,” in
*Proceedings of the 25th Chinese Control and Decision Conference (CCDC '13)*, pp. 4652–4656, May 2013. View at Publisher · View at Google Scholar · View at Scopus - S. Mondal, S. Sadhu, and A. Banerjee, “Platform motion disturbances attenuation in a missile seeker subsystem using Internal Model Control,” in
*Proceedings of the International Conference on Control, Automation, Robotics and Embedded Systems (CARE ’13)*, pp. 1–4, Jabalpur, India, December 2013. View at Publisher · View at Google Scholar - Z. Yang, J. Wu, and J. Mei, “Motor-mechanism dynamic model based neural network optimized computed torque control of a high speed parallel manipulator,”
*Mechatronics*, vol. 17, no. 7, pp. 381–390, 2007. View at Publisher · View at Google Scholar · View at Scopus - X. Sun, L. Chen, Z. Yang, and H. Zhu, “Speed-sensorless vector control of a bearingless induction motor with artificial neural network inverse speed observer,”
*IEEE/ASME Transactions on Mechatronics*, vol. 18, no. 4, pp. 1357–1366, 2013. View at Publisher · View at Google Scholar · View at Scopus - J.-F. Couchot, K. Deschinkel, and M. Salomon, “Active MEMS-based flow control using artificial neural network,”
*Mechatronics*, vol. 23, no. 7, pp. 898–905, 2013. View at Publisher · View at Google Scholar · View at Scopus - X. Ren, C. Y. Lai, V. Venkataramanan, F. L. Lewis, S. S. Ge, and T. Liew, “Feedforward control based on neural networks for disturbance rejection in hard disk drives,”
*IET Control Theory & Applications*, vol. 3, no. 4, pp. 411–418, 2009. View at Publisher · View at Google Scholar · View at MathSciNet · View at Scopus - K. K. Ahn and H. P. H. Anh, “Design and implementation of an adaptive recurrent neural networks (ARNN) controller of the pneumatic artificial muscle (PAM) manipulator,”
*Mechatronics*, vol. 19, no. 6, pp. 816–828, 2009. View at Publisher · View at Google Scholar · View at Scopus