V rep path planning simulation