Documentation fixes
Costmap_2d Doc cleanup
Merge branch 'hydro_doc_fix' into hydro