Page 179 - Designing Autonomous Mobile Robots : Inside the Mindo f an Intellegent Machine
P. 179

Chapter 11






                                                                    A
                            Initial Position Estimate       A''
                                                    U                  U yAz
                                                       Az





                                                                    UxAz





                                     Implied Position and Azimuth
                                          for Full Correction


             Figure 11.11. Apparent position uncertainty as a result of azimuth uncertainty


            Figure 11.11 demonstrates how we might determine the error in the apparent posi-
            tion of the column that could be contributed by azimuth uncertainty. We simply take
            the vector from the robot’s current position estimate to the compensated measured
            position A″ and rotate it by the azimuth uncertainty (U ). The x and y position dif-
                                                                  Az
            ferences between the two vectors’ ends (U  and U ) are the possible x and y errors
                                                     xAz
                                                              yAz
            that could be attributable to the azimuth being incorrect.
            Unfortunately, this observational uncertainty may add to or subtract from the appa-
            rent position error caused by the robot’s lateral and longitudinal uncertainty (its true
            position error). However, we can estimate the likelihood that an observed error was
            the result of the vehicle’s position error vs. its heading error. We will call these factors
            the observational quality for the lateral and longitudinal corrections.

















                                                   162
   174   175   176   177   178   179   180   181   182   183   184