Fix forward parking last maneuver

diff --git a/src/psp.cc b/src/psp.cc
index 9d8ce2158300ca35f362e2b0f0a61a4dfe7a1492..95e3e32e07145f91d92ed8c5f11a3b6325db4104 100644 (file)
--- a/src/psp.cc
+++ b/src/psp.cc
@@ -164,8 +164,12 @@ std::vector<BicycleCar> PSPlanner::last_maneuver()
                         lm.push_back(BicycleCar(this->cc()));
                 }
         } else {
-                // go 1 m forward
+                // go 0.1 m forward/backward
+#if FORWARD_PARKING > 0
+                this->cc().sp(-0.1);
+#else
                 this->cc().sp(0.1);
+#endif
                 BicycleCar orig_cc(this->cc());
                 for (unsigned int i = 0; i < 10; i++) {
                         this->cc().next();
@@ -302,7 +306,6 @@ void PSPlanner::fe()
                 //this->cc().set_max_steer();
                 //if (this->ps().right())
                 //        this->cc().st(this->cc().st() * -1);
-                this->cc().sp(-0.2);
         }
 }