Please use boost::shared_ptr here for rviz::Shape.