Add recompute entry method

[hubacji1/bcar.git] / src / pslot.cc

diff --git a/src/pslot.cc b/src/pslot.cc
index ec88e634f8bea7861a16d6028a8b956d15702228..773394b94c1ae83abfb63de8774fa023a8697cb8 100644 (file)
--- a/src/pslot.cc
+++ b/src/pslot.cc
@@ -259,6 +259,18 @@ ParkingSlot::fe(BicycleCar c, unsigned int& max)
        return pr;
 }
 
+PoseRange
+ParkingSlot::recompute_entry(PoseRange p)
+{
+       p.rotate(Point(0.0, 0.0), this->h());
+       p.x(p.x() + this->lrx());
+       p.y(p.y() + this->lry());
+       if (!this->right()) {
+               p.reflect(this->entry_);
+       }
+       return p;
+}
+
 std::ostream&
 operator<<(std::ostream& o, ParkingSlot const& s)
 {