X-Git-Url: http://rtime.felk.cvut.cz/gitweb/hubacji1/bcar.git/blobdiff_plain/727dec6700bd5b79f2441e7a8f17858f72ddc289..e45d4c43b154667bff3d4f265f58529273f67512:/src/pslot.cc

diff --git a/src/pslot.cc b/src/pslot.cc
index 91bf5e9..64deb5b 100644
--- a/src/pslot.cc
+++ b/src/pslot.cc
@@ -264,7 +264,11 @@ PoseRange
 ParkingSlot::fe(BicycleCar c)
 {
 	assert(this->parallel());
-	assert(this->right());
+	bool swapped = false;
+	if (!this->right()) {
+		this->swap_side();
+		swapped = true;
+	}
 	c.h(this->h());
 	double clen = -this->offset_ + this->len() - c.df();
 	double cw = c.w() / 2.0;
@@ -306,7 +310,12 @@ ParkingSlot::fe(BicycleCar c)
 	}
 	auto& c1 = entries.front().front();
 	auto& c2 = entries.back().front();
-	return PoseRange(c1, c2);
+	PoseRange p(c1, c2);
+	if (swapped) {
+		this->swap_side();
+		p.reflect(this->entry_);
+	}
+	return p;
 }
 
 PoseRange