From 286e34b6440ea7f18aa4d6ace7e1491ee5b44e79 Mon Sep 17 00:00:00 2001
From: Jiri Vlasak <hubacji1@fel.cvut.cz>
Date: Mon, 22 Jul 2019 09:50:01 +0200
Subject: [PATCH] Add init ut

---
 ut/psp.t.cc | 15 +++++++++++++++
 1 file changed, 15 insertions(+)

diff --git a/ut/psp.t.cc b/ut/psp.t.cc
index ca09657..1b350b7 100644
--- a/ut/psp.t.cc
+++ b/ut/psp.t.cc
@@ -6,4 +6,19 @@
 WVTEST_MAIN("parking slot planner basic test")
 {
         PSPlanner *psp = new PSPlanner();
+        psp->ps()->border(3, 3, 5, 3, 5, 8, 3, 8);
+        psp->gc()->x(4);
+        psp->gc()->y(4);
+        psp->gc()->h(M_PI / 2);
+        psp->gc()->mtr(10);
+        psp->gc()->wb(2);
+        psp->gc()->w(1);
+        psp->gc()->l(3);
+        psp->gc()->he(1.5);
+        psp->gc()->df(2 + 0.5);
+        psp->gc()->dr(0.5);
+
+        // init orientation
+        WVPASS(psp->gc() != nullptr);
+        WVPASSEQ_DOUBLE(psp->ps()->heading(), psp->gc()->h(), 0.00001);
 }
-- 
2.39.2