Add costmaps frame to visualizer
Merge branch 'hydro_timer' of https://github.com/DLu/navigation into hydro_timer