Removed replanning on missed waypints. Not much use for it anymore. Can map faster without it.