Add Dubins3d path demo script
Add Dubins3d path demo script

It helps identifying regressions in the sampling code

fire-rs-laas/fire-rs-saop,fire-rs-laas/fire-rs-saop,fire-rs-laas/fire-rs-saop,fire-rs-laas/fire-rs-saop