Professional Documents
Culture Documents
Yasuhiro Kawakami, Yasuhito Eguchi, Tsuyoshi Nimiya, Haruo Suemitsu and Takami Matsuo
Yasuhiro Kawakami, Yasuhito Eguchi, Tsuyoshi Nimiya, Haruo Suemitsu and Takami Matsuo
Yasuhiro Kawakami, Yasuhito Eguchi, Tsuyoshi Nimiya, Haruo Suemitsu and Takami Matsuo
2, 2013
113
114
Y Kawakami et al.
This paper
of velocity
Conference
Agriculture
1 Introduction
The necessity to evaluate the time-derivative of signals
arises frequently in many areas of research. For
position/speed controller, good measurements of position,
velocity, and frequency are required. Nevertheless, in
practical implementation, only the position is measured
by position sensors such as an optical encoder. Hence,
the velocity should be estimated in some ways with the
position measurement. Moreover, in tracking or detecting
moving objects in an image sequence, the need of velocity
estimation from measured position data is still a difficult
task and a challenging problem. The simplest numerical
method for differentiating a signal is the backward
difference. However, the backward difference operator
has a noise-amplifying characteristic (Tille and Montanari,
2001).
Many approaches to estimate the derivative of noisy
signals have been proposed. The use of low-pass
filters causes additional phase delay that decreases the
performance of the closed loop. Assuming that the position
can be approximated with a low-degree polynomial, a
differentiator based on the Newton predictor was proposed
(Tille and Montanari, 2001). The extended Kalman filter
base estimation approach can be used under the assumption
that the velocity is expressed as one of the state variables
generated by passing white noise through a linear and
stable all-integrator model (Belanger et al., 1998). Ibrir
(2004) presented a time-varying linear observer to estimate
the first (n 1)th derivative of any bounded signal. The
time-derivative observer was formulated as a high-gain
observer where the observer gain was calculated through
a Lyapunov-like dynamical equation (Ibrir, 2004). Levant
(1998) also presented a differentiator that is exact on
signals with a given upper bound for Lipshitzs constant
of the derivatives via the sliding mode technique. The
exact differentiator does not need a mathematical model
of the signal and provides for exact finite-time-convergent
estimation for noise-free signals. However, in the presence
of considerable measurement noises, the implementation
of a simple smoothing element is recommended (Levant,
1998).
We have recently proposed the adaptive velocity,
acceleration, and frequency estimators based on the
adaptive control theory (Matsuo et al., 2008a, 2008b).
Especially, in Nomura et al. (2010) and Kitsuka et al.
(2010a, 2010b), we presented two types of adaptive
differentiators to estimate the first and second order
derivatives of an output signal. In the case of the output
signal with unknown dynamic structure, a velocity estimator
was proposed based on the gradient-type adaptive update
law. Then, a non-passifiable adaptive scheme was proposed
using the high-gain input observer (Fomichev, 1998) in
(1)
Velocity and acceleration estimation by iterative learning observer and performance validation
By estimating 1 (t) with the measurement signal x(t),
we obtain the estimate of the velocity signal. We apply
the adaptive observer with the parameter adjustment law
to estimate the parameter 1 (t) under the assumption the
velocity is slow time-varying. Since the relative degree
of the system (1) is one, we can adopt the parameter
adjustment law with = 0, i.e., the adaptive law is
equivalent to the gradient-type law.
The time-varying parameter, 1 (t), is written by the
following equation:
1 (t) = 10 + (t),
(2)
(3)
x(t),
of the derivative of the signal x(t) is given by the
following adaptive observer and the update laws:
x
(t) = k(
x(t) x(t)) + 1 (t) (t)sgn(
x(t) x(t))
1 (t) = 1 (
x(t) x(t))
(t) = |
x(t) x(t)|
where 1 > 0, k > 0. The estimate of x(t)
is given by
x(t)
= 1 (t) =
1 (
x( ) x( ))d
(4)
115
e = k(e n) + (t)
and its Laplace transform is
E(s) =
{(s)
+ kN (s)}
s+k
where
E(s) = L{e(t)}, (s)
= L{(t)},
and
N (s) = L{n(t)}. When the additional noise is added to
the output, the parameter update law is given by
= 1 (e(t) n(t)).
The Laplace transform of the parameter update law is
obtained by
s(s)
= 1 (E(s) N (s)).
We have the transfer function form N (s) to the estimation
(s)
=
1 s
N (s).
s2 + ks + 1
(5)
(6)
(7)
1 (t) = 1 (
x(t) y(t)), (t) = |
x(t) y(t)|.
We have the error dynamics as
(t)sgn(e n) (t).
e = k(e n) + (t)
116
Y Kawakami et al.
}
(8)
Theorem 3.1: Consider the system (8) and the ILO (9). If
there exists a positive definite matrix P satisfying
(A LC)T P + P (A LC) = Q < 0
and the ILO parameters, K1 and K2 , can be selected such
that
0 < K1T K1 I
P F = (K2 C)T
> > 1,
then both the state estimation error and the parameter
estimation error are bounded.
Remark 3.1: In this paper, we point out that the system (8)
has to satisfy the strictly positive realness condition. The
sufficient condition to construct the ILO is the existence of
the matrix P > 0 such that
(A LC)T P + P (A LC) = Q
(11)
P F = C T K2T .
(12)
x
(t) = A
x(t) + Bu(t) + L(y(t) y(t)) + F v(t)
(9)
y(t) = C x
(t)
}
(10)
where x
(t) = x(t) x
(t), y(t) = y(t) y(t).
Comparing with integrator-based adaptive observers,
Chen asserted that it possesses the following advantages
(Chen and Chowdhury, 2007):
1
(13)
Velocity and acceleration estimation by iterative learning observer and performance validation
Figure 1
d1 (t)
= 2 (t).
dt
0.5
0.45
0.4
x and x
0.35
0.3
0.25
0.2
0.15
0.1
0.05
0
0
10
time
Figure 2
117
1.5
(16)
x 10
4
3
2
and
and
0.5
0.5
1
0
1
2
3
1.5
0
10
time
5
0
10
time
(14)
1.5
[ ]
01
0
A=
,B =
00
0
[ ]
[ ]
0
C = 10 ,F =
1
and
0.5
0
0.5
1
1.5
0
6
time
dx(t)
= 1 (t)
dt
(15)
10
118
Y Kawakami et al.
Figure 5
(a) The yaw angle, (b) the yaw angular velocity, and (c) the acceleration estimate
100
yaw[deg]
50
50
100
10
15
20
25
30
35
20
25
30
35
20
25
30
35
time[s]
(a)
200
100
0
100
200
300
10
15
time[s]
(b)
2000
1500
1000
500
0
500
1000
1500
10
15
time[s]
(c)
Position/velocity
Attitude (angle)
Velocity and acceleration estimation by iterative learning observer and performance validation
Acceleration
angular rate[deg/s]
Angular rate
200
0
200
400
0
10
15
20
25
30
35
20
25
30
35
time[s]
5 Experimental results
rate[deg/s]
angular angular
rate[deg/s]
119
(a)
400
200
0
200
400
0
10
15
time[s]
(b)
angular rate[deg/s]
We can obtain the roll, pitch, and yaw angles and their
angular velocities (rates) by NAV440 measurement. Since
the angular acceleration cannot be obtained, we use the
output of the adaptive velocity estimator using the angular
velocity instead of the angular acceleration measurement.
In this paper, we adopt the yaw angle and the
yaw angular velocity as the measurement data. Figure 5
shows the angle, the angular velocities of yaw obtained
by NAV440 measurement, and the acceleration estimate
obtained by the adaptive velocity estimator with the angular
velocity.
To verify the performance of the proposed differential
filter, we add the Gaussian noise N (0, 102 ) or N (0, 0.5)
to the measurement signal of the yaw angle.
200
0
200
400
10
15
20
25
30
35
20
25
30
35
time[s]
(a)
400
angular rate[deg/s]
200
0
200
400
10
15
time[s]
(b)
Y Kawakami et al.
120
AVE
ILO1
ILO2
ILO3
AD
ED
0.01
0.5
11.1
12.4
18.1
31.6
11.0
13.9
10.9
15.3
18.7
71.7
14.7
26.7
Figure 8
ILO3
1
4
0.9
5
0.7
1
104
104
104
0.2
16
10
7
20
4
acceleration [rad/s2]
2000
1000
0
1000
2000
0
10
15
20
25
30
35
15
20
time[s]
25
30
35
time[s]
(a)
2000
1000
0
1000
2000
0
1000
10
(b)
0
1000
2000
0
10
15
20
25
30
35
20
25
30
35
time[s]
]
(a)
2000
acceleration [rad/s2]
2000
acceleration [rad/s2]
ILO2
K1
L
K2
Q
ILO1
acceleration [rad/s2]
Parameter
1000
0
1000
2000
0
10
15
time[s]
(b)
Velocity and acceleration estimation by iterative learning observer and performance validation
Table 3 The mean square errors of acceleration estimators
2
AVE
ILO1
ILO2
ILO3
AD
ED
0.01
0.5
232.3
261.0
500.8
500.9
212.4
246.3
222.6
275.7
289.5
297.8
378.6
392.1
K1
L
K2
Q
ILO1
ILO2
ILO3
1
5
0.9
3
0.7
1
104
104
104
0.01
0.1
3.333
20
8.333
5
6 Conclusions
We proposed a velocity estimator based on the ILO. The
experimental results using the inertial measurement unit
show that the proposed differentiators are robust against
additive noises.
Acknowledgements
This work is partially supported by the Grant-in-Aid for
Scientific Research (21656108), Japan Society for the
Promotion of Science.
References
Belanger, P.R., Dobrovolny, P., Helmy, A. and Zhang, X.
(1998) Estimation of angular velocity and acceleration from
shaft-encoder measurements, Int. J. Robot Res., Vol. 17,
No. 11, pp.12251233.
Chen, W. and Chowdhury, F.N. (2007) Simultaneous
identification of time-varying parameters and estimation
of system states using iterative learning observers,
International Journal of Systems Science, Vol. 38, No. 1,
pp.3945.
121