MOve dubins path plotting to an external function
MOve dubins path plotting to an external function

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