@param B The pose to start from.
*/
BicycleCar *getISPP(BicycleCar *B);
+ BicycleCar *getISPPf(BicycleCar *B); // perp. forward parking
/** Return true if car is inside slot */
bool isInside(BicycleCar *c);
/** Return values to set sampling function of RRT */