hector_vision: fixed compile errors on indigo
Merge remote-tracking branch 'origin/indigo' into hydro-devel
sbpl_lattice_planner: use find_library() to find absolute path of sbpl library