From dde1f8e388390faff77a29f6ecbac439a98932f5 Mon Sep 17 00:00:00 2001 From: Jiri Vlasak Date: Fri, 23 Aug 2019 16:04:15 +0200 Subject: [PATCH] Implement possible inits method --- src/psp.cc | 6 ++++++ 1 file changed, 6 insertions(+) diff --git a/src/psp.cc b/src/psp.cc index 86e6533..b5bf121 100644 --- a/src/psp.cc +++ b/src/psp.cc @@ -115,6 +115,12 @@ bool PSPlanner::parked() std::vector PSPlanner::possible_inits() { std::vector pi; + BicycleCar orig_cc(this->cc()); + for (unsigned int i = 0; i < 20; i++) { + this->cc().next(); + pi.push_back(BicycleCar(this->cc())); + } + this->cc() = BicycleCar(orig_cc); return pi; } -- 2.39.2