private void publish(byte level, Object message) { rosgraph_msgs.Log logMessage = publisher.newMessage(); logMessage.getHeader().setStamp(defaultNode.getCurrentTime()); logMessage.setLevel(level); logMessage.setName(defaultNode.getName().toString()); logMessage.setMsg(message.toString()); // TODO(damonkohler): Should update the topics field with a list of all // published and subscribed topics for the node that created this logger. // This helps filter the rosoutconsole. publisher.publish(logMessage); }