Page 266 - Introduction to Autonomous Mobile Robots
P. 266

Mobile Robot Localization


                                                                         Map                   251



                                                              Map Building and Maintenance
                                                      Refine Feature   Add New     Remove Offensive
                             Encoder                   Parameters      Features       Features
                                                     increase credibility  extend map  decrease credibility

                                             position
                             Prediction of Mea-  estimate  Estimation (fusion)
                             surement and Posi-       using confirmed
                              tion (odometry)             map matched predic-

                                 predicted feature  observations  YES  and observations YES  observations  unobserved
                                                                             unexpected
                                                                tions
                                                                                          predictions


                                                       Matching  NO   Unexpected  NO
                                                                      Observation?


                                                             raw sensor data or
                                                              extracted features
                                                   Perception  on-board sensors
                                                       Observation



                           Figure 5.38
                           General schematic for concurrent localization and map building (see [23]).



                           localization [23]. The added arcs represent the additional flow of information that occurs
                           when there is an imperfect match between observations and measurement predictions.
                             Unexpected observations will effect the creation of new features in the map, whereas
                           unobserved measurement predictions will effect the removal of features from the map. As
                           discussed earlier, each specific prediction or observation has an unknown exact value and
                           so it is represented by a distribution. The uncertainties of all of these quantities must be con-
                           sidered throughout this process.
                             The new type of map we are creating not only has features in it, as did previous maps,
                           but it also has varying degrees of probability that each feature is indeed part of the environ-
                                                                                           ˆ
                                                                                           z
                                                                n
                           ment. We represent this new map M   with a set   of probabilistic feature locations  , each
                                                                                            t
   261   262   263   264   265   266   267   268   269   270   271