From: Jiri Vlasak <hubacji1@fel.cvut.cz>
Date: Fri, 23 Aug 2019 19:24:03 +0000 (+0200)
Subject: Implement naive fe_perpendicular
X-Git-Tag: v0.3.0~5^2~2
X-Git-Url: https://rtime.felk.cvut.cz/gitweb/hubacji1/psp.git/commitdiff_plain/62754b82ca2c0900500d43b2e5773873d75ae9a3

Implement naive fe_perpendicular
---

diff --git a/src/psp.cc b/src/psp.cc
index 395deec..6cc5701 100644
--- a/src/psp.cc
+++ b/src/psp.cc
@@ -266,7 +266,13 @@ void PSPlanner::fe_perpendicular()
         //
         //      Another approach could be testing angles from the
         //      beginning of the escape parkig slot maneuver.
-        return fer_perpendicular();
+        if (this->forward())
+                this->cc().sp(-0.01);
+        else
+                this->cc().sp(0.01);
+        while (!this->left())
+                this->cc().next();
+        return;
 }
 
 void PSPlanner::fer()