Add assertion about parking speed for fe

diff --git a/src/pslot.cc b/src/pslot.cc
index 20509e1b378552129744398b9d9c4e56ef9628be..dc09581e583f8cdfde5f7eebedd6b082491c0033 100644 (file)
--- a/src/pslot.cc
+++ b/src/pslot.cc
@@ -351,6 +351,7 @@ ParkingSlot::fe(BicycleCar c)
        c.x(this->lrx() + clen * cos(c.h()) + cw * cos(c.h() + M_PI / 2.0));
        c.y(this->lry() + clen * sin(c.h()) + cw * sin(c.h() + M_PI / 2.0));
        c.set_max_steer();
+       assert(this->parking_speed_ < 0.0);
        c.sp(this->parking_speed_);
        auto const rc = c.rf();
        this->curb_.intersects_with(rc, c.len());