psp.fer();
WVPASS(psp.left());
+ // find entry
+ psp.cc() = BicycleCar(psp.gc());
+ WVPASS(!psp.left());
+ psp.fe();
+ WVPASS(psp.left());
+
// collide
auto tmpi1 = intersect(1, 1, 3, 3, 1, 3, 3, 1);
WVPASS(std::get<0>(tmpi1));
WVPASS(!psp.left());
psp.fer();
WVPASS(psp.left());
+
+ // find entry
+ psp.cc() = BicycleCar(psp.gc());
+ WVPASS(!psp.left());
+ psp.fe();
+ WVPASS(psp.left());
}
WVTEST_MAIN("forward perpendicullar parking slot planner")
WVPASS(!psp.left());
psp.fer();
WVPASS(psp.left());
+
+ // find entry
+ psp.cc() = BicycleCar(psp.gc());
+ WVPASS(!psp.left());
+ psp.fe();
+ WVPASS(psp.left());
}