Dynamic planning demo
Added path conversion routines