Merge pull request #116 from DLu/hydro

Fix bounds on clear costmap recovery