Indigo fixes

I had to add include _directories and include_definitions in order for catkin_make to find Eigen.
I also had to remove the reference to getCostmapCopy in order for the code to compile.