Fix RandomShortcut
Fix RandomShortcut

* Initial time is not necessarily 0.
* Recomputing the path length do not work with ReedsSheppPath. Either
* the distance function should take into account the possible
* non-holonomy or we should trust path lengths. Current implementation
* trusts the path length.

humanoid-path-planner/hpp-core