improved RoutePlanner tests and added GotoClosestRoutePlanner