Refined constants for NonLinearDataFilter.java

Also added a method to return the waypoint associated with the most linear point