Fix find init pose for right perp. parking

diff --git a/decision_control/slotplanner.cc b/decision_control/slotplanner.cc
index da3a193ffdb912e72b2359340f9ad30c5623b72d..7a9eb7482f60a83a5014ca82c6657d15125d4469 100644 (file)
--- a/decision_control/slotplanner.cc
+++ b/decision_control/slotplanner.cc
@@ -145,7 +145,10 @@ void ParallelSlot::fip(
                                 && p->h() < this->slotHeading()
                         ) || (
                                 this->slotSide() == RIGHT
-                                && p->h() > this->slotHeading()
+                                && (
+                                        p->h() > this->slotHeading()
+                                        || p->h() < 0
+                                )
                         ))
                 ) {
                         bool end = false;