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

Hard Navigation vs. Fuzzy Navigation

                          Q = (U – U ) / U    x                                 (Equation 11.7)
                                        xAz
                                   x
                            Ox
                          And
                          Q = (U – U ) / U                                      (Equation 11.8)
                            Oy     y    yAz   y
                          Where:

                                     U = Platform lateral uncertainty
                                       x
                                     U = Platform longitudinal uncertainty
                                       y
               Again, Q factors less than zero will be taken as being zero quality. As the observa-
               tional uncertainty approaches the platform uncertainty for either axis, the quality of
               the observation for that axis approaches zero. Notice that for the example in Figure
               11.11, the lateral uncertainty of the observation that resulted from azimuth uncer-
               tainty is quite small compared to the corresponding longitudinal component. This
               means that we can have more faith in the lateral observation.

               Now we consider the most fundamental Q factor, and that is just how believable the
               implied correction for an axis is compared to the uncertainty for the same axis.
                          Q = (U – |E |) / U    x                               (Equation 11.9)
                            x
                                        xAz
                                  x
                          And
                          Q = (U – |E |) / U    y                               (Equation 11.10)
                                  y
                            y
                                        yAz
                          Where:
                                     E = Observed lateral error (see Figure 11.10)
                                      x
                                     E = Observed longitudinal error
                                      y
               If the absolute value of an implied correction for an axis is greater than the uncer-
               tainty for that axis, then we will simply discard the correction. We now have two
               quality factors for each axis: the observational quality and the believability. The fit
               quality for each axis as follows:
                          Q FITx  = Q  * Q Ox                                   (Equation 11.11)
                                   x
                          And
                          Q FITy  = Q  * Q Oy                                   (Equation 11.12)
                                   y









                                                       163
   175   176   177   178   179   180   181   182   183   184   185