Costmap plugins renamed layers plus bug-fixes