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