Initial commit

This was forked from navigation/global_planner
It probably doesn't work as is. I haven't tried.
Now it builds

I can start hacking seriously now.
Merge follow_planner

It is not ready for use yet.
Merge branch 'follow' into hydro-devel