Merge pull request #36 from BFALacerda/hydro-devel

publishers now created with an explicit queue_size (indigo doesnt like i...
stop sleeping and logging every time
adding costmaps to the logging when its the first nav failure