We should not be doing formatting with ROS_ <log> commands. Perhaps fill a string stream and pass it to ROS_DEBUG? This is not so important so it can be left unfixed for the merge.