Make task manager publish waypoints to rviz.
Let users input the polygon in register_task.
Add clipping with libclippoly in stead of boost::geometry
Merge branch 'hydro-devel'

Conflicts:
	CMakeLists.txt