Add ScenePublisher for composite robots
Update CMakeLists.txt