Merge pull request #115 from DLu/hydro

Remove unimplemented method from Costmap
Fix bounds on clear costmap recovery