I recommend overloading the ">>" operator.  If you do, ROS_*_STREAM methods and gtest ( https://code.google.com/p/googletest/wiki/AdvancedGuide#Teaching_Google_Test_How_to_Print_Your_Values ) will show you love.