From: Jiri Hubacek <hubacji1@fel.cvut.cz>
Date: Fri, 5 Oct 2018 14:32:02 +0000 (+0200)
Subject: Find nn if not goal found else nn is goal
X-Git-Tag: v0.2.0~3^2~2
X-Git-Url: https://rtime.felk.cvut.cz/gitweb/hubacji1/iamcar.git/commitdiff_plain/bbfa3effb1207b1edd72532a70a6a8e2d3761708

Find nn if not goal found else nn is goal
---

diff --git a/base/main.cc b/base/main.cc
index ad73d6b..95080a7 100644
--- a/base/main.cc
+++ b/base/main.cc
@@ -127,12 +127,17 @@ int main()
                         p.next();
                         p.tend();
                 }
+                if (!p.goal_found()) {
 #if NNVERSION > 1
-                nn = p.nn(p.iy_, p.goal(), p.cost);
+                        nn = p.nn(p.iy_, p.goal(), p.cost);
 #else
-                nn = p.nn(p.nodes(), p.goal(), p.cost);
+                        nn = p.nn(p.nodes(), p.goal(), p.cost);
 #endif
-                tr = p.findt(nn);
+                        tr = p.findt(nn);
+                } else {
+                        nn = p.goal();
+                        tr = p.findt();
+                }
                 p.tlog(tr);
 #if JSONLOGEDGES > 0
                 p.logr(p.root());