Route finding partially working: tests need some revision