Add some basic way-point filter methods. * Filter for way-point outliers.
Add some basic way-point filter methods.