Page 144 - Autonomous Mobile Robots
P. 144

Data Fusion via Kalman Filter                              127

                                 When the design uses a large Q, the variance of the estimated position is
                              large, but the estimator rapidly adjusts the estimated state so that the estimate
                              does not significantly lag the actual state following the vehicle maneuver. When
                              the design uses a small value for Q, the variance of the estimated position is
                              smaller; however, the estimated state significantly lags the actual state following
                              the vehicle maneuver.
                                 Figure 3.2a and b are intentionally placed side-by-side to emphasize the
                              fact that there is no single optimal choice for the design parameter Q. The
                              desirable setting of Q depends on the application and maneuvering conditions.
                              Some receivers allow the user to effect the receiver estimation procedure (either
                              the model structure or the value of Q) through the user interface. It is the
                              responsibility of the user to understand the settings and their tradeoffs relative
                              to the application. This is especially true when the state estimate is being used
                              as the input to a control system.
                                 Due to the structure of the   k matrix, if the GPS H matrix has a null
                              direction d such that Hd = 0, then position, velocity, and acceleration errors
                              parallel to d will not be observable from the GPS measurements. Note that
                              the rows of the H matrix contain the line-of-sight unit vectors between the
                              receiver antenna and the satellite. Therefore, to accurately and rapidly track the
                              platform motion during (and after) a maneuver, the receiver must be tracking at
                              least one satellite located in a direction such that the line-of-sight unit vector has
                              a significant component in the same direction as the acceleration unit vector;
                              otherwise, the GPS measurements will be insensitive to the acceleration. In
                                                                          1
                              particular, if a receiver is operating in an urban canyon type of environment
                              and accelerates parallel to the direction in which the satellite signals are blocked
                              then the position, velocity, and acceleration accuracy in that direction will
                              deteriorate.
                                 No amount of signal processing can help, unless additional sensors
                              (e.g., inertial, wheel speed, vision, precision clock) are added.
                                 Finally, it is critical to note that estimation errors, even restricted to the
                              GPS measurement epochs, are correlated. They are not white discrete-time
                              processes. This is clearly illustrated in Figure 3.2b for small values of Q, but is
                              also true for larger values of Q. The fact that the position estimation errors are
                              not white is critical to understanding one of the drawbacks of using the GPS
                              position estimates to aid an INS (see Section 3.5.2.1).


                              3.3.3.6 Summary
                              The approaches discussed in the previous three sections have several aspects
                              that should be pointed out. First, as discussed following Equation (3.50),

                              1  This is a canyon created by the urban environment (e.g., a road between tall buildings) that may
                              block satellite signals in specific directions [37–39].




                              © 2006 by Taylor & Francis Group, LLC



                                FRANKL: “dk6033_c003” — 2006/3/31 — 16:42 — page 127 — #29
   139   140   141   142   143   144   145   146   147   148   149