Close #86 Add waypoint treshold in modifyWP activity