Remove unimplemented method from Costmap

This screwed me up when I was writing some other code. But it was my own fault.