Based on AugustoPB's work https://github.com/AugustoPB/vfh_local_planner. Updated tf package inside to the newer tf2 package. If you have any question on how to work this project, please feel free to contact with me or pull issues. And welcome any discussions or exchanges on path planning issues.