WVPASS(inside(psp.gc().rrx(), psp.gc().rry(), slot));
WVPASS(inside(psp.gc().rfx(), psp.gc().rfy(), slot));
- // entry point found by reverse
- WVPASS(!psp.left());
- psp.fer();
- WVPASS(psp.left());
-
- // find entry
- psp.cc() = BicycleCar(psp.gc());
- WVPASS(!psp.left());
- psp.fe();
- WVPASS(psp.left());
-
- // collide
+ // init collide
auto tmpi1 = intersect(1, 1, 3, 3, 1, 3, 3, 1);
WVPASS(std::get<0>(tmpi1));
WVPASSEQ_DOUBLE(std::get<1>(tmpi1), 2, 0.00001);
WVPASS(!tpsp.left());
tpsp.ps().border(3, 4.1, 3, 2.1, 8, 2.1, 8, 4.1);
WVPASS(tpsp.left());
+
+ // entry point found by reverse
+ 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("backward perpendicullar parking slot planner")