Robot State Publisher (C++)