From 3e229b9b26fd2460e8bc62b79542f7b2c9d24498 Mon Sep 17 00:00:00 2001 From: Jiri Vlasak Date: Fri, 7 Jun 2019 14:22:48 +0200 Subject: [PATCH] Fix find init pose for right perp. parking --- decision_control/slotplanner.cc | 5 ++++- 1 file changed, 4 insertions(+), 1 deletion(-) diff --git a/decision_control/slotplanner.cc b/decision_control/slotplanner.cc index da3a193..7a9eb74 100644 --- 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; -- 2.39.2