Use find init pose by reverse by default

diff --git a/base/main.cc b/base/main.cc
index af76ff3547f42058c8890bbb538ac3478cc5f094..637d272796dc4c0152d4edef2cecedeb41f96ad1 100644 (file)
--- a/base/main.cc
+++ b/base/main.cc
@@ -170,12 +170,7 @@ int main()
         ps.setAll();
         p.samplingInfo_ = ps.getSamplingInfo();
         if (ps.slot().bnodes().size() > 0)
-                ps.fpose();
-                //ps.fipr(new BicycleCar(
-                //        p.goal()->x(),
-                //        p.goal()->y(),
-                //        p.goal()->h()
-                //));
+                ps.fipr(ps.getFP());
         TEND();
         jvo["ppse"] = ELAPSED;
         TPRINT("ParallelSlot");