Analysis of waypoint range uncertainty

The effect on waypoint projection of pose uncertainty is approximately time invariant: However, the overall projection quality improves significantly as we approach the waypoint:

Note that strictly speaking, the quality improves as we close on the waypoint, which is not necessarily the same as improving as time passes. We might be moving away from the waypoint due collision avoidance, etc. It nevertheless seems reasonable to approximate this effect by doing a running average that gives more weight to recent projections (e.g. a low-pass filter.)


Home | Mail to CMU TMR-members