Moved obstacle points to SubPointSystem class