Robot path planning VC code