Add psa_crypto_output_copy_free() implementation

Signed-off-by: David Horstmann <david.horstmann@arm.com>
diff --git a/library/psa_crypto.c b/library/psa_crypto.c
index 669087c..9330d40 100644
--- a/library/psa_crypto.c
+++ b/library/psa_crypto.c
@@ -5615,4 +5615,24 @@
     return PSA_SUCCESS;
 }
 
+psa_status_t psa_crypto_output_copy_free(psa_crypto_output_copy_t *output_copy)
+{
+    if (output_copy->buffer == NULL) {
+        output_copy->len = 0;
+        return PSA_SUCCESS;
+    }
+    if (output_copy->original == NULL) {
+        /* We have an internal copy but nothing to copy back to. */
+        return PSA_ERROR_CORRUPTION_DETECTED;
+    }
+
+    memcpy(output_copy->original, output_copy->buffer, output_copy->len);
+
+    mbedtls_free(output_copy->buffer);
+    output_copy->buffer = NULL;
+    output_copy->len = 0;
+
+    return PSA_SUCCESS;
+}
+
 #endif /* MBEDTLS_PSA_CRYPTO_C */