some debug statements to help find issues with hydro-devel costmap