]> rtime.felk.cvut.cz Git - hubacji1/iamcar.git/blobdiff - base/main.cc
Output JSON goals as RRT found goal
[hubacji1/iamcar.git] / base / main.cc
index f65d560762c6f3c0273512ed9143c2d5ed090c4b..77ab2e1bffdf69059c57ef237c9a3e1d29c62fde 100644 (file)
@@ -444,6 +444,9 @@ escapeloop:
                 }
                 j++;
         }
+        jvo["goals"][0][0] = p.tlog()[p.tlog().size() - 1].front()->x();
+        jvo["goals"][0][1] = p.tlog()[p.tlog().size() - 1].front()->y();
+        jvo["goals"][0][2] = p.tlog()[p.tlog().size() - 1].front()->h();
 #ifdef JSONLOGEDGES
         i = 0;
         j = 0;