From 96ed4a0e4a12b11795f5a85b99f96ae926d7fd37 Mon Sep 17 00:00:00 2001
From: Jiri Vlasak <hubacji1@fel.cvut.cz>
Date: Tue, 10 Sep 2019 18:03:40 +0200
Subject: [PATCH] First steer to goal

---
 base/main.cc | 1 +
 1 file changed, 1 insertion(+)

diff --git a/base/main.cc b/base/main.cc
index 77ab2e1..115fa09 100644
--- a/base/main.cc
+++ b/base/main.cc
@@ -162,6 +162,7 @@ int main()
                         jvi["goal"][2].asFloat()
                 )
         );
+        p.firsts().push(p.goal());
         jvo["init"][0] = p.root()->x();
         jvo["init"][1] = p.root()->y();
         jvo["init"][2] = p.root()->h();
-- 
2.39.2