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