Update carmen_publisher.cpp