Clarify debug messages
Costmap Layer comments