You are on page 1of 9

IJCSI International Journal of Computer Science Issues, Vol.

7, Issue 2, No 2, March 2010 15


ISSN (Online): 1694-0784
ISSN (Print): 1694-0814

Adaptive Neuro-Fuzzy Extended Kalman


Filtering for Robot Localization
Ramazan Havangi, Mohammad Ali Nekoui and Mohammad Teshnehlab

Faculty of Electrical Engineering, K.N. Toosi University of Technology


Tehran, Iran

the vehicle is operating. The methods to obtain absolute


Abstract measurements can be divided into methods based on the
Extended Kalman Filter (EKF) has been a popular approach to use of landmarks and methods based on the use of maps.
localization a mobile robot. However, the performance of the The main drawback of absolute measures is their
EKF and the quality of the estimation depends on the correct a dependence on the characteristics of the environment.
priori knowledge of process and measurement noise covariance Possible changes to environmental parameters may give
matrices ( Q k and R k , respectively). Imprecise knowledge of rise to erroneous interpretation of the measures provided
these statistics can cause significant degradation in performance. by the localization algorithm. In this paper, we integrate
This paper proposed the development of an Adaptive Neuro- the advantages of "the relative localization" and "the
Fuzzy Extended Kalman Filtering (ANFEKF) for localization of absolute localization" and make them complementary,
robot. The Adaptive Neuro-Fuzzy attempts to estimate the
which will enable the mobile robot to localize itself more
elements of Q k and R k matrices of the EKF algorithm, at each
accurately. To this purpose, data provided from odometric,
sampling instant when measurement update step is carried out. laser range finder and MAP are combined together
The ANFIS supervises the performance of the EKF with the aim
through EKF. The localization based on EKF proposed in
of reducing the mismatch between the theoretical and actual
covariance of the innovation sequences. The free parameters of
the literatures [1-9] for the estimation of robot pose.
ANFIS are trained using the steepest gradient descent (SD) to However, a significant difficulty in designing an EKF can
minimize the differences of the actual value of the covariance of often be traced to incomplete a priori knowledge of the
the residual with its theoretical value as much possible. The process covariance matrix Q k and measurement noise
simulation results show the effectiveness of the proposed covariance matrix R k [10-13]. In most robot localization
algorithm.
application these matrices are unknown. On the other
Keywords: Extended Kalman Filter, Localization, Fuzzy hand, it is well known how poor estimates of noise
Inference System and Neuro-Fuzzy statistics may seriously degrade the Kalman filter
performance [12], [16]. One of the efficient ways to
overcome the above weakness is to use an adaptive
1. Introduction algorithm for localization. There have been many
investigations in the area of adaptive algorithm for robot
Mobile robot localization is the problem of estimating a localization [5], [8], [9], [18], [19], [20]. In [15] a Neuro-
robot pose (position, orientation) relative to its fuzzy assisted extended kalman filter-based approach for
environments. Two different kinds of localization exist: simultaneous localization and mapping (SLAM) problem
relative and absolute. Relative localization is also known is presented. In this algorithm, a Neuro-fuzzy approach is
as dead-reckoning (DR). It is realized through the employed to adapt the matrix R k only while Q k is
measures provided by sensors measuring the dynamics of completely known.
variables internal to the vehicle. Typical internal sensors Also, as the computational load of this algorithm is very
are encoders which are fixed to the axis of the driving high, it cannot be implemented in real-time application. In
wheels. The basic drawback of this method is that the this paper the EKF coupled with adaptive Neuro-Fuzzy
error of robot’s position and orientation generally grows Inference System has been presented to adjust the matrices
unbounded with time. Absolute localization is performed Q k and R k . Main advantage of this algorithm, compared
processing the data provided by a proper set of sensors
to prior ones, is its fast and efficient approach in terms of
measuring some parameters of the environment in which
IJCSI International Journal of Computer Science Issues, Vol. 7, Issue 2, No 2, March 2010 16
www.IJCSI.org

the computational cost and therefore its suitability for real- W   r   related to observation noise.
T

time applications.

2. Kinematics Modeling Robot and its 3. Extended Kalman Filter (EKF)


Kalman filter (KF) is widely used in studies of dynamic
Odometery
systems, analysis, estimation, prediction, processing and
The state of robot can be modeled as ( x , y ,  ) that control. Kalman filter is an optimal solution for the
( x , y ) are the Cartesian coordinates and  is the discrete data linear filtering problem. KF is a set of
orientation respectively to global environment. The mathematical equations which provide an efficient
kinematics equations for the mobile robot are in the computational solution to sequential systems. The filter is
following form [1-2] and [4]: very powerful in several aspects: It supports estimation of
past, present, and future states (prediction), and it can do
  so even when the precise nature of the modeled system is
 x   (V  v v ) cos(  [  v  ])  unknown. The filter is derived by finding the estimator for
 y   f ( X )   (V  v ) sin(  [  v ])  a linear system, subject to additive white Gaussian noise.
   v   (1)
However, the real system is non-linear; Linearization
  
  (V  v v )  using the approximation technique has been used to
 sin(  v  ) 
 B  handle the non-linear system. This extension of the
Where B is the base line of the vehicle and nonlinear system is called the Extended Kalman Filter
(EKF). The general non-linear system and measurement
u  V   is the control input consisting of a velocity
T

form is as given by equations (3) and (4) as follows:


input V and a steer input  , as shown in Fig.1. x k 1  f (x k , u k )  w k (3)
z k  h (x k )  v k (4)
The system, measurement noises are assumed to be
Gaussian with zero mean and are represented by their
covariance matrices Q k and R k :
E {w k }  0
Q kj (5)
E [w k w Tj ]   k
0 kj
E {v k }  0
R kj (6)
E [v k v Tj ]   k
0 kj
Fig.1 The robot and Feature
The Extended kalman filter algorithm has two groups of
equations [14]:
1) The prediction equations:

 
T The extended Kalman filter predicts the future state of
The process noise v  v v v is assumed to be applied
system xˆ k1 based on the available system model f (.)
to the control input, v v to velocity input, and v  to the 
and projects ahead the state error covariance matrix Pk 1
steer angle input. The vehicle is assumed to be equipped
with a sensor (range-laser finder) that provides a using the time update equations:
measurement of range ri and bearing  i to an observed xˆ k 1  f (x k , u k ) (7)

feature i relative to the vehicle as following: P k 1  f k Pk f k
T
 GuQ k G T
u (8)
Where
 ( x  x i ) 2  ( y  y i ) 2  r 
i
r  
   h ( X )   tan 1 y  y i      (2)
 i  

x xi
where ( x i , y i ) is the position landmark in map and
IJCSI International Journal of Computer Science Issues, Vol. 7, Issue 2, No 2, March 2010 17
www.IJCSI.org

 f 1 f 1 f 1  4. Localization Based on EKF


 x y  
We assume that robot knows map of environment. The
 EKF estimates a robot pose given a map of the
f  f f 2 f 2  environment and range-bearing of landmarks
f k   2  (9) measurements. For this purpose, the data provided by
X  x y   odometric, map and laser range-finder are fused together
 f 3 f 3 f 3  by means of an EKF. To design EKF, The continuous time
  model formulated must be reformulated in the discrete
 x y   time. The discrete time kinematics model is:
 f 1 f 1   
   x (k  1)   x (k ) T (V (k )  v v (k )) cos( (k )  [ (k )  v  (k )]) 
 u1 u 2   y (k  1)    y (k ) T (V (k )  v (k )) sin( (t )  [ (t )  v (k )]) 
   v  
f  f f 2    (k  1)  
 (k ) T
(V (k )  v v (k ))
sin( (k )  v  (k ))

Gu   2  (10) 



u  u1 u 2  B

 f 3 f 3  (17)
 
 u1 u 2  And the discrete time observation model is:

 (x (k )  x (k )) 2  ( y (k )  y (k )) 2   (k ) 
2) Measurement updates equations  ri (k )   i i r 
 (k )    1 y ( k )  y i ( k ) 
Once measurements z k become available the Kalman  i   tan   ( k )   ( k ) 
 x ( k )  x i ( k ) 
gain matrix K k is computed and used to incorporate the (18)
measurement into the state estimate xˆ k . The state error Fig.2 briefly describes the cyclic localization procedure
covariance for the updated state estimate Pk is also during the localization procedure using EKF.
computed using the following measurement update
equations:
K k  Pk H kT (H k Pk H kT  R k ) 1 (11)
 
xˆ k  xˆ  K k (z k  h (xˆ ))
k k (12)

Pk  (I  K k H k )P k (13)
Where I is an identity matrix and H k is following:
h
Hk  (14)
X
In the above equations, xˆ k is an estimation of the system
sate vector x k and Pk is the covariance matrix
Fig.2 Localization algorithm based on EKF
corresponding to the state estimation error defined by
Pk  E {(x k  xˆ k )(x k  xˆ k )T ) (15)
The algorithm consists of such steps as position
The difference between the prediction and observed
prediction, observation, measurement prediction, matching
measurements is called the measurement innovation, or
and estimation. The detailed discussion of these steps will
residual, generally denoted as rk : be followed.
rk  z k  h (xˆ k ) (16) Step1) Initialization
Initialize the state vector xˆ 0 and covariance matrix P0 of
The innovation represents the additional information
variable to the filter in consequence to the observation the mobile robot
z k . For an optimal filter the innovation sequence is a Step 2) Robot Position Prediction
The robot position at time step k+1 is predicted based on
sequence of independent Gaussian random variables. its old localization (at time step k) and its movement due
the control input u k :
IJCSI International Journal of Computer Science Issues, Vol. 7, Issue 2, No 2, March 2010 18
www.IJCSI.org

xˆ k 1  f (x k , u k ) (19) measurement noise statistics; matrices Q k and R k .



P k 1  f k Pk f k
T
 GuQ k G T
u (20) However, in most application these matrices are unknown.
An incorrect a prior knowledge of Q k and R k may lead
Where
f f to performance degradation [12] and it can even lead to
f k  Gu  (21) practical divergence [13].One of the effective ways to
X u overcome the above mentioned weakness is to use an
Step3) Measurement prediction adaptive algorithm. Two major approaches that have

B y using the predicted robot position xˆ k 1 and the proposed for adaptive EKF are Multiple Model Adaptive
Estimation (MMAE) and Innovation Adaptive Estimation
current map we can generate the predicted measurement
(IAE) [12]. In this paper IAE adaptive scheme of the EKF
zˆ k according to equation (22).
coupled with ANFIS to adjust the matrix Q k and R k is
 (xˆ  x ) 2  ( yˆ  y ) 2  purposed. The ANFIS is used to adjust the EKF and is
 i i

zˆ k   
prevented the filter from divergence.
ˆ 
ˆ
y y (22)
 tan xˆ  x  
1 i

 i  5.1 Localization based on ANFEKF ( Q k is fixed)
The error between the actual measurement z k and the The covariance matrix R k represents the accuracy of
predicted measurement based on estimation of the state is: measurement instrument. Assuming that the noise
v k  z k  zˆ k (23) covariance Q k is completely known, an algorithm to
Where v k is innovation sequence (or residual) with the estimate the measurement noise covariance R k can be
covariance: derived. In this case, an innovation based adaptive

S k  h k Pk h k  R k estimation (IAE) algorithm to adapt the measurement
T
(24)
Where noise covariance matrix R k is derived. In particular, the
 h1 h1 h1  technique known as covariance matching is used. The

h
 x y  
basic idea behind this technique is to make the actual
h k    (25) value of the covariance of the residual to be consistent
X  h2 h2 h2  with its theoretical value [12]. The innovation sequence
 x y   rk has a theoretical covariance S k that is obtained from

Step 4) Matching EKF algorithm. The actual residual covariance Cˆ k can be
The goal of the matching procedure is to produce an approximated by its sample covariance, through averaging
assignment from measurements to the landmarks (stored in inside a moving window of size N as the following:
the map). If the measurement result satisfies the following 1 k

inequality, it is thought to be eligible, otherwise, it is not, Cˆ k 


N
 ( riT ri ) (30)
i  k  N 1
and it will be abnegated.
Where i 0 is first sample inside the estimation window. If
v k S kv k T  G (26)
the actual value of covariance Cˆ k has discrepancies with
Step 5) Estimation
  its theoretical value, then the diagonal elements of
xˆ k  xˆ k  K k ( z k  h ( xˆ k )) (27)
R k based on the size of this discrepancy can be adjusted.
Where K k is gain the kalman gain: The objective of these adjustments is to correct this
 T  T 1
K k  Pk h k (h k Pk h k  R k ) (28) mismatch as far as possible. The size of the mentioned
discrepancy is given by a variable called the degree of
The new state covariance matrix is:
mismatch ( DOM k ), defined as
Pk  ( I  K k h k ) Pk

(29)
DOM  S  Cˆ (31)
Step 6) Return to step 2 k k k

The basic idea used by an ANFIS, to adapt the matrix


5. Localization Based on Adaptive Neuro- R k is as follows:
Fuzzy EKF (ANFEKF) From equation (24) an increment in R k will increase
As stated earlier, localization based on EKF assumes
complete a priori knowledge of the process and S k and vice versa. Thus, R k can be used to vary S k in
IJCSI International Journal of Computer Science Issues, Vol. 7, Issue 2, No 2, March 2010 19
www.IJCSI.org

accordance with the value of DOM k in order to reduce


the discrepancies between S k and Cˆ k .The adaptation of
the (i , i ) element of R k is made in accordance with
the (i , i ) element of DOM k .The general rules of
adaptation are as following:
If DOM k (i , i )  0 then maintain R k unchanged
If DOM k (i , i )  0 then decrease R k
If DOM k (i , i )  0 then increase R k
In this paper IAE adaptive scheme of the EKF coupled
with adaptive Neuro-fuzzy inference system (ANFIS) is
presented to adjust R .

5.1.1 The ANFIS Architecture ( Q k is fixed)


Fig.6 Localization Based on ANFEKF ( Q k Fixed)
The ANFIS model has been considered as two-input-
single-output system. The inputs ANFIS are DOM k and
where R k is ANFIS output and membership function of
DeltaDOM k . Here, DeltaDOM k is defined as following:
R k is shown in fig.5. As size DOM k and R is two, two
DeltaDOM k  DOM k  DOM k 1 (32)
system ANFIS to adjust EKF is used as shown in Fig.6.
Fig.3 and Fig.4 present membership functions for The following structure which is a five layers network is
DOM (i , i ) and DeltaDOM k as shown.
k
proposed in fig .7.

Fig.3 Membership function DOM k

Fig .4 Membership function DeltaDOM k


Fig .7 The ANFIS Architecture ( Q k is fixed)

Let u il and o il denote the input to output from the i th


node of the l th layer, respectively. To provide a clear
understanding of an ANFIS, the function of layer 1 to
Fig .5.Membership function AjdR k layer 5 are defined as follows:
In addition, adjustments of R k is performed using the Layer 1: The node in this layer only transmits input
following relation values to the next layer directly, i.e.
R k  R k  R k (33) o i1  u i1 (34)
Layer2: In this layer, each node only performs a
membership function. Here, the input variable is fuzzified
by using five membership functions (MFs).The output of
the i th MF is given as:
IJCSI International Journal of Computer Science Issues, Vol. 7, Issue 2, No 2, March 2010 20
www.IJCSI.org

 (u ij2  m ij ) 2  the error defined in (39) is less than a desired threshold


o ij2  ij (u 2 )  exp   (35) value after a given number of training cycles. The well-
 ( ij ) 2  known BP algorithm may be written as:
Where m ij and  ij are the mean and with of the Gaussian E (k )
W (k  1)  W (k )   ( ) (41)
membership function, respectively. The subscript W (k )
ij indicates the jth term of the ith input. Each node in Here  and W represent the learning rate and tuning
this layer has two adjustable parameters: m ij and  ij parameter of ANFIS respectively. Let W  [m ,  ,w ]T be
Layer3: The nodes in this layer are rule nodes. The rule the weighting vector of ANFIS. The gradient of E with
node performs a fuzzy and operation (or product respect to an arbitrary weighting vector W is as the
inference) for calculating the firing strength. following:
o l3   u i3 (36) E (k )  R (k ) 
 e (k )   (42)
i
W (k )  W (k ) 
Layer4: The node in this layer performs the normalization
By recursive applications of chain rule, the error term for
of firing strengths from layer 3,
each layer is first calculated, and then the parameters in
u4
o l4  9 l (37) the corresponding layers are adjusted.
 l 1u l4
Layer5: This layer is the output layer. The link weights in 5.2 Localization based on ANFEKF ( R k Fixed)
this layer represent the singleton constituents (W i ) of the Assuming that the noise covariance matrix R k is
output variable. The output node integrates all the
normalization firing strength from layer 4 with the completely known an algorithm to estimate matrix Q k can
corresponding singleton constituents and acts as be derived. The idea behind the process of adaptation of
defuzzfier, Q k is as follows:Equation (8) can be rewritten as
25
R i   u l5w l S k  h k (f k Pk f k  Gu Q k Gu )hk  R k
T T T
(38) (43)
l 1 It may be deduced from equation (43) that a variation in
The fuzzy rules which complete the ANFIS rule base are Q k will affect the value of S k . If Q k is increased, then
as table.1.
S k is increased, and vice versa. Thus, if a mismatch
Table.1: Rule Table
between S and Cˆ is observed then a correction can be
k k
made through augmenting or diminishing the value of
Q k .The tree general adaptation rules are defined as
following
1. If DOM k (1,1) is L and DOM k (2, 2) is L hen Q k is
H
2. If DOM k (1,1) is Z and DOM k (2, 2) is Z then
Q k is Z
3. If DOM (1,1) is H DOM (2, 2) is H then Q k is L

Then Q k is adapted in this way


5.1.2 Learning Algorithm Q k  Q k Q k (44)
The aim of the training algorithm is to adjust the network Where Q k is the ANFIS output and DOM k (1,1) and
weights through the minimization of following cast
DOM k (2, 2) are ANFIS input.
function:
1 The ANFIS model has been considered as a two-input-
E  ek 2 (39) single-output system as previous section. Fig.8 shows the
2 block diagram of Localization based on ANFEKF while
Where
R k is Fixed.
e k  S k  Cˆ k (40)
By using the back propagation (BP) learning algorithm,
the weighting vector of the ANFIS is adjusted such that
IJCSI International Journal of Computer Science Issues, Vol. 7, Issue 2, No 2, March 2010 21
www.IJCSI.org

Robot proposed method starts with the same Q k and


Odometery
R k matrices, but it keeps adapting the Q k and R k matrices
according to the proposed scheme. The localization based
on is known as a good choice when the associated
Range Laser
Pose statistical models are well known. Fig.10 shows
EKF performance of Localization based EKF and proposed
method in this situation. It is observed that performance
Matching both algorithms are almost same.
Sˆk Ĉ k
Q k
Map +
ANFIS
-
DOM

Fig.8 Localization Based on ANFEKF ( R k Fixed)

6. Implementation and Results


Experiments have been carried out to evaluate the
performance of the proposed approach in comparison with
classical method.
60

Fig.10 The figure shows the RMS error in localization Based on AFEKF
40
and EKF (the results obtain over 50 Monte Carlo runs). In this
experiment, measurement noise is  r  0.1 ,    1.0 and control
20

noise is v  0.3 m/s ,    3o .


Y(m)

However, the performance of localization based of EKF


-20
degrades when the knowledge of such statistics is
-40
inappropriate. For this purpose, we first consider the
situation where the sensor statistics are set wrongly as:
-60
-60 -40 -20 0 20 40 60 80
 r  2.0 and    0.1 and the noise covariance Q k is
X(m)
completely known. The proposed algorithm starts with a
Fig.9 The experiment environment: The star point “*” denote the wrongly know statistics and then it adapts the R k matrix,
landmark
online, on the basis of ANFIS attempts to minimize the
Fig.9 shows the robot trajectory and landmark location. mismatch between the theoretical and actual values of the
The star points (*) depict location of the Landmarks that innovation sequence. The free parameters of ANFIS are
are known. The initial position of the robot is assumed to automatically learned by SD during training. Fig.11 shows
be x 0  0 . The robot moves at a speed 3m/s and with a
the root mean square error (RMSE) of localization based
on EKF and FAEKF for 25 different runs. It is observed
maximum steering angle 30 deg. Also, the robot has 4 that state estimates from the FAEK are more accurate than
meters wheel base and is equipped with a range-bearing the EKF.
sensor with a maximum range of 20 meters and a 180
degrees frontal field-of-view. The control noise
is v  0.3 m/s and    3o . A control frequency is 40 HZ
and observation scans are obtained very 5 HZ . The
measurement noise is 0.1 m in range and 1o in bearing.
The performance of the proposed method is compared
with localization based on EKF where matrices Q k and
R k are kept static throughout the experiment The
IJCSI International Journal of Computer Science Issues, Vol. 7, Issue 2, No 2, March 2010 22
www.IJCSI.org

1.5 1
Finally, the consistency of both localizations Based on
AFEKF and EKF are compared. In this regard, we have
1 considered the situation where the sensor statistics are set
X(m)

Y(m)
wrongly as:  r  2.0 and    0.5 and the noise
0.5
0.5

0 0
covariance Q k is completely known. To verify the
0 50 100 150 0 50 100 150
time(s) time(s) consistency of both algorithms, average Normalized
0.4 Estimation Error Squared (NEES) is used as a measure
RMS-EKF
0.3 RMS-FAEKF factor. For an available ground truth x k and an estimated
 
Teta(deg)

0.2 mean and covariance xˆ, Pˆ , we can use NEES to


0.1
characterize the filter performance:
 k  (x x  xˆ k )T Pk1 (x x  xˆ k ) .
0
0 50
time(s)
100 150 (45)
Fig.11 The figure shows the RMS error in localization Based on AFEKF
Consistency is evaluated by performing multiple Monte
and EKF (the results obtain over 50 Monte Carlo runs). In this Carlo runs and computing the average NEES. Given
experiment, measurement noise is wrongly considered as  r  2 , N runs, the average NEES is computed as
   0.1 and control noise is truly considered as  v 1 N
 0.3 m/s ,  k    ik (46)
N i 1
  3 o
.
Given the hypothesis of a consistent linear-Gaussian
Now, we consider the situation where the uncertainties in filter, N  k has a  2 density with N dim(x k ) degrees of
control inputs are wrongly considered as:    0.03 m/s freedom [17]. Thus, for the 3-dimensional vehicle pose,
with Twenty Monte Carlo simulations, the two sided 95%
,    0.5 deg and measurement covariance R k is probability concentration region for  k is bounded by
completely known. The proposed algorithm starts with a interval [2.02, 4.17].
wrongly know statistics and then adapt the Q k matrix,
online, on the basis of ANFIS attempts to minimize the
mismatch between the theoretical and actual values of the
innovation sequence. Fig.12 shows RMSE for this
situation. Such as previous situation, it is observed that
localization based on FAEKF is more accurate than
localization based on EKF.
0.2 0.2

0.15 0.15
X(m)

Y(m)

0.1 0.1

0.05 0.05

0 0
Fig.13 Consistency of localization based on EKF
0 50 100 150 0 50 100 150
time(s) time(s)

0.4
RMS-EKF
0.3 RMS-FAEKF
Teta(deg)

0.2

0.1

0
0 50 100 150
time(s)

Fig.12 The figure shows the RMS error in localization Based on AFEKF
and EKF (the results obtain over 50 Monte Carlo runs). In this
experiment, measurement noise is truly considered as  r  2 ,
   0.1 and control noise is wrongly considered as  v  0.03 m/s , Fig.14 Consistency of localization based on AFEKF
   0.5 o

Fig.13 and Fig.14 show that the consistency of


localization Based on AFEKF is more than that of
localization Based on EKF.
IJCSI International Journal of Computer Science Issues, Vol. 7, Issue 2, No 2, March 2010 23
www.IJCSI.org

7. Conclusion [9] L.Jetto, S.Longhi, "Development and experimental validation


of an adaptive extended kalman filter for the localization of
The preset paper has proposed the development of a
mobile robots", IEEE Trans on robotics and automation,
adaptive Neuro-Fuzzy inference system for localization vol.15, No.2, April 1999.
based EKF when a priori knowledge is incorrect. The EKF [10] E.E.EI Madbouly, A. E. Abdalla, Gh. M. EI Banby, "Fuzzy
is known as a choice for localization when a priori adaptive kalman filter for multi sensor system", 2009 IEEE
knowledge is well known. However, incorrect knowledge [11] Wei Qin, Weizheng Yuan, Honglong Chang, Liang Xue,
of these statistics can cause significant degradation in Guangmin Yuan, "Fuzzy Adaptive Extended Kalman Filter
performance. The present scheme proposes to start the for miniature Attitude and Heading Reference System,"
system with a wrongly known statistics and adapt the 4th IEEE International Conference on Nano/Micro
matrices R k and Q k , online, on the basis of ANFIS that Engineered and Molecular Systems, 2009.
[12] R.K.Mehra, “On the identification of variances and
attempt to minimize the mismatch between the theoretical adaptive kalman filtering”, IEEE Trans, Autom. Control, Vol.
and actual values of the innovation sequence. The free AC-15, No. 2, pp. 175–184, Apr. 1970.
parameters of ANFIS are automatically learned by [13] R.J.Fitzgerald, “Divergence of the kalman filter”, IEEE
employing the steepest gradient descent during the Trans. Autom. Control, Vol. AC-16, No. 6, pp. 736–747, Dec.
training. Main advantage of proposed method is that 1971.
consistency of this approach is more than localization [14] M.S.Grewal and A.P.Andrews, "Kalman filtering: Theory
based EKF. This is because that theoretical value of the and practice", Prentice-HALL, 1993.
[15]Chatterjee, A. Matsuno, F. “A Neuro-Fuzzy Assisted
innovation sequence is match with its actual value in
Extended Kalman Filter-Based Approach for Simultaneous
proposed method. The two experiments in simulation have Localization and Mapping (SLAM) Problems”, IEEE
been carried out to study of performance the proposed Transactions on Fuzzy Systems, Oct. 2007, 15: 5, 984-997
method. The simulation results are shown that localization [16] Wu, Z. Q. and Harris, C. J. Adaptive Neurofuzzy Kalman
based on AFEKF is more accurate than localization based Filter. In: FUZZ-IEEE '96 - Proceedings of the fifth IEEE
on EKF. International Conference on Fuzzy Systems. pp. 1344-1350.
[17] Y. Bar-Shalom, X.R. Li, and T. Kirubarajan. Estimation
References with Applications to Tracking and Navigation. John
Wiley and Sons, 2001.
[1] F.Kong, Y.Chen, J.Xie, Gang, "Mobile robot localization
[18] J. Z. Sasiadek, Q.Wang, and M. B. Zeremba, “Fuzzy
based on extended kalman filter", Proceedings of the 6th
adaptive Kalman filtering for INS/GPS data fusion,” in
World Congress on Intelligent Control and Automation, June
proc. 15th Int. Symp. Intell. Control,Patras, Greece, Jul
21-23, 2006.
2000.
[2] J.Kim, Y.Kim, and S.Kim, "An accurate localization for
[19] D. Loebis, R. Sutton, J. Chudley, and W. Naeem, Adaptive
mobile robot using extended kalman filter and sensor fusion",
tuning of a Kalman filter via fuzzy logic for an intelligent
Proceeding of the 2008 International Joint Conference on
auv navigation system,” Control Eng. Pract., vol. 12, pp.
Neural Networks (IJCNN 2008).
1531–1539, 2004.
[3] Tran Huu Cong, Young Joong Kim and Myo-Taeg Lim,
[20] L. Jetto, S. Longhi, and D. Vitali, .Localization of a
"Hybrid Extended Kalman Filter-based Localization with a
wheeled mobile robot by sensor data fusion based on a
Highly Accurate Odometry Model of a Mobile Robot",
fuzzy logic adapted Kalman filter ,. Control Engineering
International Conference on Control, Automation and
Practice, vol. 7, pp. 763-771, 1999.
Systems 2008
[4] Sangjoo Kwon, Kwang Woong Yang and Sangdeok Park,
Ramazan Havangi received the M.S. degree in Electrical Engineering
"An Effective Kalman filter Localization Method for mobile from K.N.T.U University, Tehran, Iran, in 2004; He is currently working
Robots", Proceeding of the 2006 IEEE/RSJ, International toward the Ph.D. degree in K.N.T.U University. His current research
Conference on Intelligent Robots and Systems. interests include Inertial Navigation, Integrated Navigation, Estimation
[5] G.Reina, A.Vargas, KNagatani and K.Yoshida "Adaptive and Filtering, Evolutionary Filtering, Simultaneous Localization and
Kalman Filtering for GPS-based Mobile Robot Localization", Mapping, Fuzzy, Neural Network, and Soft Computing.
in Proceedings of the 2007 IEEE, International Workshop on
Safety, Security and Rescue Robotics. Mohammad Ali Nekoui is assistant professor at Department of Control,
[6] M.Betke and L.Gurvits, "Mobile robot localization using Faculty of Electrical Engineering K.N.T.U University. His current
research interests include Optimal Control Theory, Convex Optimization,
landmarks",IEEE Trans on Robotics And Automation, Vol. Estimation and Filtering, simultaneous localization and mapping,
13, No. 2, APRIL 1997. Evolutionary Filtering, Simultaneous Localization and Mapping.
[7] I.Roumeliotis and A.Bekey, "An extended kalman filter for
frequent local and infrequent global sensor data fusion". in Mohammad Teshnehlab is professor at Department of Control, Faculty
SPIE International Symposium on Intelligent Systems and of Electrical Engineering, K.N.T.U University. His current research
Advanced Manufacturing,1997. interests include Fuzzy, Neural Network, Soft Computing, Evolutionary
[8] W.Jin, X.Zhan, A modified kalman filtering via fuzzy logic Filtering, and Simultaneous Localization and Mapping.
system for ARVs Localization", Proceeding of the 2007
IEEE, International Conference on Mechatronics and
Automation.

You might also like