Professional Documents
Culture Documents
Adaptive 2010 1 30 40029
Adaptive 2010 1 30 40029
I.
INTRODUCTION
ISBN: 978-1-61208-109-0
14
ADAPTIVE 2010 : The Second International Conference on Adaptive and Self-Adaptive Systems and Applications
ISBN: 978-1-61208-109-0
15
ADAPTIVE 2010 : The Second International Conference on Adaptive and Self-Adaptive Systems and Applications
& a ( t ) =
III.
a n (t)
Va ( t )
(3)
x& ( t ) = f ( x ( t )) + w x ( t )
where
ISBN: 978-1-61208-109-0
v x (t)
a t ( t )f
v y (t)
f ( x ( t )) =
a t ( t )f
0
0
x (t)
v (t)
x
y(t)
x(t) =
,
v y (t)
a ( t )
t
a n (t)
f
vx
v x (t)
2
v x (t) + v y (t)
, f
vy
vx
+ a n ( t )f
vy
vy
a n ( t )f
vx
v y (t)
v x (t) + v y (t)
Q ( t ) = diag Q x ( t ) Q vx ( t ) Q y ( t ) Q vy ( t ) Q at ( t ) Q an ( t )
with E [a t ( t ) ] = a t 0
(5)
a& n ( t ) = w nt ( t )
with E [a n ( t ) ] = a n 0
(6)
where at0 and an0 are mean acceleration values that are
constants, and wat(t) and wnt(t) are tangential and normal
16
ADAPTIVE 2010 : The Second International Conference on Adaptive and Self-Adaptive Systems and Applications
(f (x ( t ) )) =
x
1
0
0 a ( t ) f vx + a ( t ) f vy
t
vx
n
vx
0
0
vy
vx
0 a t ( t ) f vx a n ( t ) f vx
0
0
0
0
0
0 a t ( t ) f vyvx
0
0 a t ( t ) f vyvy
0
0
0
0
0
+ a n ( t ) f vyvy f vx f vy
1
0
0
vx
vx
a n ( t ) f vy f
f vy
0
0
0
0
0
0
(7)
where
2
f vxvx =
vy
vx
v x (t)
(v
2
x
(t) + v y (t)
3/ 2
2
x
(t) + v y (t)
v y (t)v x (t)
(v
2
x
(t) + v y (t)
3/2
v x (t)v y (t)
(v
f vyvx =
3/2
vy
vy
v y (t)
(v
2
x
(t) + v y (t)
3/2
z ( k ) = h ( x ( k )) + w z ( k )
(h (x ( k ) )) =
x
0 0 1 0 0 0
(9)
2) Measurement Model
z ( k ) = h ( x ( k )) + w z ( k )
(11)
w z ( k ) ~ N (0 , R ( k ) ), k = 1, 2 ,...
where
z x (k )
x (k )
z (k ) =
, h ( x ( k )) =
0
z y (k )
0
0
0
y(k )
0
0
0
0
0
0
E [w z ( k ) ] = 0 , E [w z ( k ); w z ( k ) ] = [R ( k ) ]
3) Error Conditions
and zx(k) and zy(k) are measurements of x and y positions of
the target vessel, and wy(k) is a white Gaussian measurement
noise with zero mean and covariance R(k). The covariance
R(k) can be written as:
R ( k ) = diag R x ( k ) R y ( k )
ISBN: 978-1-61208-109-0
~
x ( k ) = x ( k ) x ( k )
(12)
where ~
x (t ) is the state error and x (t ) the estimated states
of the system.
17
ADAPTIVE 2010 : The Second International Conference on Adaptive and Self-Adaptive Systems and Applications
(13)
(14)
(15)
Figure 2. EKF Trajectory Estimation
F ( x ( k )) =
F ( x ( k ))
x ( k )
x (k )= x (k )
(16)
x ( k + ) = x ( k ) + K ( k ) z ( k ) h k x ( k )
)]
(17)
( ( ))] P ( k
P ( k + ) = 1 K ( k ) H k x k
(18)
where P(k-) and P(k+) are the prior and posterior error
covariance of the system state respectively.
10) Kalman Filter Gain
K (k) =
( ( ))[H (x (k ))P ( k
P ( k ) H x k
( ( ))
) H x k
R (k )
(19)
ISBN: 978-1-61208-109-0
18
ADAPTIVE 2010 : The Second International Conference on Adaptive and Self-Adaptive Systems and Applications
IV.
COMPUTATIONAL SIMULATIONS
CONCLUSION
ISBN: 978-1-61208-109-0
[3]
[4]
[5]
EMSA
Report,
European
maritime
safety
agency,
http://www.emsa.europa.eu/, [retrieved: August, 2010].
Directive 2002/59/EC of the European Parliament and of the Council,
Establish a community vessel traffic monitoring and information
system and repealing council directive 93/75/eec, Official Journal of
the European Communities, no. 208, pp. 1027, 2002.
F. Farina, Introduction to radar signal & data processing : The
opportunity, RTO SET Lecture Series on : Knowledge-Based Radar
Signal and Data Processing, November 2004, RTO-EN-SET-063,
Gdansk, Porland.
L. P. Perera and C. Guedes Soares, Laser measurement system based
maneuvering target tracking formulated by adaptive competitive
neural networks, in In Proc. 2nd ADPTIVE, Lisbon, Portugal, 2010,
(In Print).
K. Hasegawa, Advanced marine traffic automation and management
system for congested waterways and coastal areas, in Proceedings of
International Conference in Ocean Engineering (ICOE), 2009, pp. 1
10.
19
ADAPTIVE 2010 : The Second International Conference on Adaptive and Self-Adaptive Systems and Applications
[6]
[7]
[8]
[9]
[10]
[11]
[12]
[13]
[14]
[15]
[16]
[17]
[18]
[19]
[20]
[21]
[22]
[23]
ISBN: 978-1-61208-109-0
20