Fast interpolated navigation function for creating plans for a mobile base
https://wiki.ros.org/navfn