New significantly improved way finding algorithm