- fixed more bugs/tests, moved static methods in AbstractRoadTrackingFilter to PathUtils