Page 243 - Introduction to Autonomous Mobile Robots
P. 243

228

                                      System error                                        Chapter 5
                                        source



                           Control      System


                                            System state
                                            (desired but
                                            not known)


                                                     Observed                Optimal estimate
                                       Measuring   measurement   Kalman       of system state
                                        devices                    filter




                                     Measurement
                                     error sources

                           Figure 5.25
                           Typical Kalman filter application [106].


                           uncertainty in the dynamics models. Thus the Kalman filter fuses sensor signals and system
                           knowledge in an optimal way. Optimality depends on the criteria chosen to evaluate the
                           performance and on the assumptions. Within the Kalman filter theory the system is
                           assumed to be linear and white with Gaussian noise. As we have discussed earlier, the
                           assumption of Gaussian error is invalid for our mobile robot applications but, nevertheless,
                           the results are extremely useful. In other engineering disciplines, the Gaussian error
                           assumption has in some cases been shown to be quite accurate [106].
                             We begin with a section that introduces Kalman filter theory, then we present an appli-
                           cation of that theory to the problem of mobile robot localization (5.6.3.2). Finally, section
                           5.6.3.2 presents a case study of a mobile robot that navigates indoor spaces by virtue of
                           Kalman filter localization.

                           5.6.3.1   Introduction to Kalman filter theory
                           The basic Kalman filter method allows multiple measurements to be incorporated opti-
                           mally into a single estimate of state. In demonstrating this, first we make the simplifying
                           assumption that the state does not change (e.g., the robot does not move) between the acqui-
                           sition of the first and second measurement. After presenting this static case, we can intro-
                           duce dynamic prediction readily.
   238   239   240   241   242   243   244   245   246   247   248