Format prameters, speical resetFlag for time_delay
[success]Add replan in vrep_simulation
Fix bug in sample path, consider back dir