Professional Documents
Culture Documents
the peaks of resonance are slightly shifted with respect to the corre-
sponding harmonic frequency, and second, an almost imperceptible
phase shift appears at the tuned harmonic frequencies. The sensitivity
functions with respect to parameters L and K are given by
sLKesL KesL
SL = SK =
s + 1 + KesL s + 1 + KesL
respectively, which are bounded by SL < K/ (1 K) and
SK < K/(1 K), with 0 < K < 1.
Fig. 1(d) shows the theoretical Bode plots of G(s) for various values
of K. For K = 1, the plot goes to innite at the resonant frequencies
and the minimum magnitude is 6 dB. These plots show clearly that as
gain K decreases, the peak amplitude is reduced while the bandwidth
of each peak increases, thus increasing its robustness with respect to
frequency variations.
where compensation of only odd harmonics is required, like in many systems [3]. In these problems, in addition to accuracy, the speed of
power electronics systems. A simple low-cost analog circuit to im- estimation is important.
plement the proposed repetitive control scheme was shown. Finally, A main sensor for attitude estimation is an inclinometer. However,
experimental evidence using the proposed circuit is provided to assess an inclinometer has a bandwidth that is too low to be able to estimate
the performance of the repetitive control scheme. fast-changing attitudes such as UAVs. Thus, a rate gyroscope is used
to supplement the estimation bandwidth. The gyroscope output can be
R EFERENCES integrated to give a high-bandwidth estimation. The main drawback is
that the integration error increases as time goes by. How to combine
[1] B. Francis and W. Wonham, The internal model principle for linear
multivariable regulators, Appl. Math. Optim., vol. 2, no. 2, pp. 170194, these two sensors is a key issue in attitude estimation.
Jun. 1975. In [4], a complementary lter is used to combine a gyroscope and an
[2] S. Hara, T. Omata, and M. Nakano, Synthesis of repetitive control sys- inclinometer, where the one-dimensional attitude estimation of an au-
tems and its applications, in Proc. 24th Conf. Decision and Control, tonomous helicopter is considered. In [3], a complementary separate-
1985, vol. 3, pp. 13841392.
bias Kalman lter is used to combine gyroscopes, inclinometers, and a
[3] T. Omata, S. Hara, and M. Nakano, Repetitive control for linear periodic
systems, Elect. Eng. Jpn., vol. 105, no. 3, pp. 131138, MayJun. 1985. uxgate compass, where the three-dimensional attitude estimation of
[4] S. Hara, Y. Yamamoto, T. Omata, and M. Nakano, Repetitive con- an inertial tracker is considered. To prevent linear acceleration from
trol system: A new type servo system for periodic exogenous sig - affecting attitude estimation, an adaptive algorithm is used.
nals, IEEE Trans. Autom. Control, vol. 33, no. 7, pp. 659668, Jul. In this paper, an attitude estimation algorithm is proposed using a
1988.
[5] J. Ghosh and B. Paden, Nonlinear repetitive control, IEEE Trans. gyroscope and an accelerometer [5]. The proposed algorithm is devel-
Autom. Control, vol. 45, no. 5, pp. 949954, May 2000. oped with attitude estimation of UAVs in mind, where vibration of an
[6] P. Mattavelli and F. P. Marafao, Selective active lters using repet- aerial vehicle is the major source of noises. To cope with the vibration,
itive control techniques, IEEE Trans. Ind. Electron., vol. 51, no. 5, an adaptive algorithm is proposed.
pp. 10181024, Oct. 2004.
[7] S. Xu and F. Yang, A novel three-phase AC/DC converter without front-
end lter based on repetitive control technique, in Proc. 3rd PIEMC,
Aug. 1518, 2000, vol. 3, pp. 11111115. II. I NTRODUCTION TO G YROSCOPE AND A CCELEROMETER
[8] Y.-Y. Tzou, S.-L. Jung, and H.-C. Yeh, Adaptive repetitive control
of PWM inverters for very low THD AC-voltage regulation with un- A piezoelectrical vibrating gyroscope (Murata ENV-05DB) is used
known loads, IEEE Trans. Power Electron., vol. 14, no. 5, pp. 973981, to measure angular velocity. The gyroscope output y1 (t) is propor-
Sep. 1999. tional to the angular velocity and is given by
[9] K. Zhang, Y. Kang, J. Xiong, and J. Chen, Direct repetitive control of
SPWM inverter for UPS purpose, IEEE Trans. Power Electron., vol. 18,
no. 3, pp. 784792, May 2003. y1 (t) = c1 (t) + v1 (t) (1)
[10] G. Escobar, A. Stankovic, and P. Mattavelli, Dissipative-based adaptive
and robust control of UPS in unbalanced operation, IEEE Trans. Power
Electron., vol. 18, no. 4, pp. 10561062, Jul. 2003. where c1 is a scale coefcient and v1 (t) denotes gyroscope mea-
surement noises. The measurement noises include scale factor error
and drift.
Since the gyroscope measures angular velocity, angular position can
Attitude Estimation by Multiple-Mode Kalman Filters be obtained by integrating the angular velocity. However, integration
error tends to diverge as time goes by due to the v1 (t) term and
Young Soo Suh numerical integration error.
A micromechanical accelerometer (Analog Devices ADXL202) can
measure acceleration in two orthogonal directions: X and Y . The
AbstractThis letter proposes a multiple-mode Kalman lter for one- angular position is determined by measuring gravitational acceleration.
dimensional attitude estimation using low-cost accelerometer and gyro-
scope. The nonlinearity and time-varying parameters are partitioned into The X-direction accelerometer is located orthogonally to the gravita-
several modes; for each mode, a linear time-invariant Kalman lter is tional eld, whereas the Y -direction accelerometer is located in the
selected. Experimental results are given to verify the proposed Kalman opposite direction of the gravitational eld. Thus, the accelerometer
lter. output in direction X is given by
Index TermsAccelerometer, attitude estimation, gyroscope, Kalman
ltering.
y2 (t) = c2 sin (t) + v2 (t) (2)
I. I NTRODUCTION
where c2 is a scale coefcient and v2 (t) denotes accelerometer mea-
Attitude in this letter is dened with respect to an inertial coordinate surement noises in direction X. The accelerometer output in direction
xed on the Earth: the attitude refers to either pitch angle or roll Y is given by
angle. Attitude estimation plays an important role in many control
problems, e.g., control of unmanned aerial vehicles (UAVs) [1], control y2y (t) = c2 cos (t) + v2y (t) (3)
of walking robots [2], and an inertial head-tracker for virtual reality
where v2y (t) denotes accelerometer measurement noises in
Manuscript received June 23, 2003; revised May 24, 2005. Abstract pub- direction Y .
lished on the Internet May 18, 2006. This work was supported by the University The major source of the accelerometer measurement noises in UAVs
of Ulsan Research Fund 2003.
The author is with the Department of Electrical Engineering, University of
is the vibration of the object. To reduce high-frequency vibration
Ulsan, Ulsan 680-749, Korea (e-mail: suh@ieee.org). noises, a low-pass lter is required. This limits the bandwidth of the
Digital Object Identier 10.1109/TIE.2006.878292 accelerometer, and a phase delay is introduced in the ltered result.