xref: /optee_os/lib/libmbedtls/mbedtls/library/pkcs12.c (revision b0563631928755fe864b97785160fb3088e9efdc)
1817466cbSJens Wiklander /*
2817466cbSJens Wiklander  *  PKCS#12 Personal Information Exchange Syntax
3817466cbSJens Wiklander  *
47901324dSJerome Forissier  *  Copyright The Mbed TLS Contributors
5*b0563631STom Van Eyck  *  SPDX-License-Identifier: Apache-2.0 OR GPL-2.0-or-later
6817466cbSJens Wiklander  */
7817466cbSJens Wiklander /*
8817466cbSJens Wiklander  *  The PKCS #12 Personal Information Exchange Syntax Standard v1.1
9817466cbSJens Wiklander  *
10817466cbSJens Wiklander  *  http://www.rsa.com/rsalabs/pkcs/files/h11301-wp-pkcs-12v1-1-personal-information-exchange-syntax.pdf
11817466cbSJens Wiklander  *  ftp://ftp.rsasecurity.com/pub/pkcs/pkcs-12/pkcs-12v1-1.asn
12817466cbSJens Wiklander  */
13817466cbSJens Wiklander 
147901324dSJerome Forissier #include "common.h"
15817466cbSJens Wiklander 
16817466cbSJens Wiklander #if defined(MBEDTLS_PKCS12_C)
17817466cbSJens Wiklander 
18817466cbSJens Wiklander #include "mbedtls/pkcs12.h"
19817466cbSJens Wiklander #include "mbedtls/asn1.h"
20*b0563631STom Van Eyck #if defined(MBEDTLS_CIPHER_C)
21817466cbSJens Wiklander #include "mbedtls/cipher.h"
22*b0563631STom Van Eyck #endif /* MBEDTLS_CIPHER_C */
233d3b0591SJens Wiklander #include "mbedtls/platform_util.h"
2411fa71b9SJerome Forissier #include "mbedtls/error.h"
25817466cbSJens Wiklander 
26817466cbSJens Wiklander #include <string.h>
27817466cbSJens Wiklander 
28817466cbSJens Wiklander #if defined(MBEDTLS_DES_C)
29817466cbSJens Wiklander #include "mbedtls/des.h"
30817466cbSJens Wiklander #endif
31817466cbSJens Wiklander 
32*b0563631STom Van Eyck #include "psa_util_internal.h"
3332b31808SJens Wiklander 
34*b0563631STom Van Eyck #if defined(MBEDTLS_ASN1_PARSE_C) && defined(MBEDTLS_CIPHER_C)
35817466cbSJens Wiklander 
pkcs12_parse_pbe_params(mbedtls_asn1_buf * params,mbedtls_asn1_buf * salt,int * iterations)36817466cbSJens Wiklander static int pkcs12_parse_pbe_params(mbedtls_asn1_buf *params,
37817466cbSJens Wiklander                                    mbedtls_asn1_buf *salt, int *iterations)
38817466cbSJens Wiklander {
3911fa71b9SJerome Forissier     int ret = MBEDTLS_ERR_ERROR_CORRUPTION_DETECTED;
40817466cbSJens Wiklander     unsigned char **p = &params->p;
41817466cbSJens Wiklander     const unsigned char *end = params->p + params->len;
42817466cbSJens Wiklander 
43817466cbSJens Wiklander     /*
44817466cbSJens Wiklander      *  pkcs-12PbeParams ::= SEQUENCE {
45817466cbSJens Wiklander      *    salt          OCTET STRING,
46817466cbSJens Wiklander      *    iterations    INTEGER
47817466cbSJens Wiklander      *  }
48817466cbSJens Wiklander      *
49817466cbSJens Wiklander      */
5032b31808SJens Wiklander     if (params->tag != (MBEDTLS_ASN1_CONSTRUCTED | MBEDTLS_ASN1_SEQUENCE)) {
5132b31808SJens Wiklander         return MBEDTLS_ERROR_ADD(MBEDTLS_ERR_PKCS12_PBE_INVALID_FORMAT,
5232b31808SJens Wiklander                                  MBEDTLS_ERR_ASN1_UNEXPECTED_TAG);
5332b31808SJens Wiklander     }
54817466cbSJens Wiklander 
5532b31808SJens Wiklander     if ((ret = mbedtls_asn1_get_tag(p, end, &salt->len, MBEDTLS_ASN1_OCTET_STRING)) != 0) {
5632b31808SJens Wiklander         return MBEDTLS_ERROR_ADD(MBEDTLS_ERR_PKCS12_PBE_INVALID_FORMAT, ret);
5732b31808SJens Wiklander     }
58817466cbSJens Wiklander 
59817466cbSJens Wiklander     salt->p = *p;
60817466cbSJens Wiklander     *p += salt->len;
61817466cbSJens Wiklander 
6232b31808SJens Wiklander     if ((ret = mbedtls_asn1_get_int(p, end, iterations)) != 0) {
6332b31808SJens Wiklander         return MBEDTLS_ERROR_ADD(MBEDTLS_ERR_PKCS12_PBE_INVALID_FORMAT, ret);
6432b31808SJens Wiklander     }
65817466cbSJens Wiklander 
6632b31808SJens Wiklander     if (*p != end) {
6732b31808SJens Wiklander         return MBEDTLS_ERROR_ADD(MBEDTLS_ERR_PKCS12_PBE_INVALID_FORMAT,
6832b31808SJens Wiklander                                  MBEDTLS_ERR_ASN1_LENGTH_MISMATCH);
6932b31808SJens Wiklander     }
70817466cbSJens Wiklander 
7132b31808SJens Wiklander     return 0;
72817466cbSJens Wiklander }
73817466cbSJens Wiklander 
74817466cbSJens Wiklander #define PKCS12_MAX_PWDLEN 128
75817466cbSJens Wiklander 
pkcs12_pbe_derive_key_iv(mbedtls_asn1_buf * pbe_params,mbedtls_md_type_t md_type,const unsigned char * pwd,size_t pwdlen,unsigned char * key,size_t keylen,unsigned char * iv,size_t ivlen)76817466cbSJens Wiklander static int pkcs12_pbe_derive_key_iv(mbedtls_asn1_buf *pbe_params, mbedtls_md_type_t md_type,
77817466cbSJens Wiklander                                     const unsigned char *pwd,  size_t pwdlen,
78817466cbSJens Wiklander                                     unsigned char *key, size_t keylen,
79817466cbSJens Wiklander                                     unsigned char *iv,  size_t ivlen)
80817466cbSJens Wiklander {
81817466cbSJens Wiklander     int ret, iterations = 0;
82817466cbSJens Wiklander     mbedtls_asn1_buf salt;
83817466cbSJens Wiklander     size_t i;
84817466cbSJens Wiklander     unsigned char unipwd[PKCS12_MAX_PWDLEN * 2 + 2];
85817466cbSJens Wiklander 
8632b31808SJens Wiklander     if (pwdlen > PKCS12_MAX_PWDLEN) {
8732b31808SJens Wiklander         return MBEDTLS_ERR_PKCS12_BAD_INPUT_DATA;
8832b31808SJens Wiklander     }
89817466cbSJens Wiklander 
90817466cbSJens Wiklander     memset(&salt, 0, sizeof(mbedtls_asn1_buf));
91817466cbSJens Wiklander     memset(&unipwd, 0, sizeof(unipwd));
92817466cbSJens Wiklander 
93817466cbSJens Wiklander     if ((ret = pkcs12_parse_pbe_params(pbe_params, &salt,
9432b31808SJens Wiklander                                        &iterations)) != 0) {
9532b31808SJens Wiklander         return ret;
9632b31808SJens Wiklander     }
97817466cbSJens Wiklander 
9832b31808SJens Wiklander     for (i = 0; i < pwdlen; i++) {
99817466cbSJens Wiklander         unipwd[i * 2 + 1] = pwd[i];
10032b31808SJens Wiklander     }
101817466cbSJens Wiklander 
102817466cbSJens Wiklander     if ((ret = mbedtls_pkcs12_derivation(key, keylen, unipwd, pwdlen * 2 + 2,
103817466cbSJens Wiklander                                          salt.p, salt.len, md_type,
10432b31808SJens Wiklander                                          MBEDTLS_PKCS12_DERIVE_KEY, iterations)) != 0) {
10532b31808SJens Wiklander         return ret;
106817466cbSJens Wiklander     }
107817466cbSJens Wiklander 
10832b31808SJens Wiklander     if (iv == NULL || ivlen == 0) {
10932b31808SJens Wiklander         return 0;
11032b31808SJens Wiklander     }
111817466cbSJens Wiklander 
112817466cbSJens Wiklander     if ((ret = mbedtls_pkcs12_derivation(iv, ivlen, unipwd, pwdlen * 2 + 2,
113817466cbSJens Wiklander                                          salt.p, salt.len, md_type,
11432b31808SJens Wiklander                                          MBEDTLS_PKCS12_DERIVE_IV, iterations)) != 0) {
11532b31808SJens Wiklander         return ret;
116817466cbSJens Wiklander     }
11732b31808SJens Wiklander     return 0;
118817466cbSJens Wiklander }
119817466cbSJens Wiklander 
120817466cbSJens Wiklander #undef PKCS12_MAX_PWDLEN
121817466cbSJens Wiklander 
122*b0563631STom Van Eyck #if !defined(MBEDTLS_CIPHER_PADDING_PKCS7)
123*b0563631STom Van Eyck int mbedtls_pkcs12_pbe_ext(mbedtls_asn1_buf *pbe_params, int mode,
124*b0563631STom Van Eyck                            mbedtls_cipher_type_t cipher_type, mbedtls_md_type_t md_type,
125*b0563631STom Van Eyck                            const unsigned char *pwd,  size_t pwdlen,
126*b0563631STom Van Eyck                            const unsigned char *data, size_t len,
127*b0563631STom Van Eyck                            unsigned char *output, size_t output_size,
128*b0563631STom Van Eyck                            size_t *output_len);
129*b0563631STom Van Eyck #endif
130*b0563631STom Van Eyck 
131*b0563631STom Van Eyck #if !defined(MBEDTLS_DEPRECATED_REMOVED)
mbedtls_pkcs12_pbe(mbedtls_asn1_buf * pbe_params,int mode,mbedtls_cipher_type_t cipher_type,mbedtls_md_type_t md_type,const unsigned char * pwd,size_t pwdlen,const unsigned char * data,size_t len,unsigned char * output)132817466cbSJens Wiklander int mbedtls_pkcs12_pbe(mbedtls_asn1_buf *pbe_params, int mode,
133817466cbSJens Wiklander                        mbedtls_cipher_type_t cipher_type, mbedtls_md_type_t md_type,
134817466cbSJens Wiklander                        const unsigned char *pwd,  size_t pwdlen,
135817466cbSJens Wiklander                        const unsigned char *data, size_t len,
136817466cbSJens Wiklander                        unsigned char *output)
137817466cbSJens Wiklander {
138*b0563631STom Van Eyck     size_t output_len = 0;
139*b0563631STom Van Eyck 
140*b0563631STom Van Eyck     /* We assume caller of the function is providing a big enough output buffer
141*b0563631STom Van Eyck      * so we pass output_size as SIZE_MAX to pass checks, However, no guarantees
142*b0563631STom Van Eyck      * for the output size actually being correct.
143*b0563631STom Van Eyck      */
144*b0563631STom Van Eyck     return mbedtls_pkcs12_pbe_ext(pbe_params, mode, cipher_type, md_type,
145*b0563631STom Van Eyck                                   pwd, pwdlen, data, len, output, SIZE_MAX,
146*b0563631STom Van Eyck                                   &output_len);
147*b0563631STom Van Eyck }
148*b0563631STom Van Eyck #endif
149*b0563631STom Van Eyck 
mbedtls_pkcs12_pbe_ext(mbedtls_asn1_buf * pbe_params,int mode,mbedtls_cipher_type_t cipher_type,mbedtls_md_type_t md_type,const unsigned char * pwd,size_t pwdlen,const unsigned char * data,size_t len,unsigned char * output,size_t output_size,size_t * output_len)150*b0563631STom Van Eyck int mbedtls_pkcs12_pbe_ext(mbedtls_asn1_buf *pbe_params, int mode,
151*b0563631STom Van Eyck                            mbedtls_cipher_type_t cipher_type, mbedtls_md_type_t md_type,
152*b0563631STom Van Eyck                            const unsigned char *pwd,  size_t pwdlen,
153*b0563631STom Van Eyck                            const unsigned char *data, size_t len,
154*b0563631STom Van Eyck                            unsigned char *output, size_t output_size,
155*b0563631STom Van Eyck                            size_t *output_len)
156*b0563631STom Van Eyck {
157817466cbSJens Wiklander     int ret, keylen = 0;
158817466cbSJens Wiklander     unsigned char key[32];
159817466cbSJens Wiklander     unsigned char iv[16];
160817466cbSJens Wiklander     const mbedtls_cipher_info_t *cipher_info;
161817466cbSJens Wiklander     mbedtls_cipher_context_t cipher_ctx;
162*b0563631STom Van Eyck     size_t iv_len = 0;
163*b0563631STom Van Eyck     size_t finish_olen = 0;
164*b0563631STom Van Eyck     unsigned int padlen = 0;
165817466cbSJens Wiklander 
16632b31808SJens Wiklander     if (pwd == NULL && pwdlen != 0) {
16732b31808SJens Wiklander         return MBEDTLS_ERR_PKCS12_BAD_INPUT_DATA;
16832b31808SJens Wiklander     }
169039e02dfSJerome Forissier 
170817466cbSJens Wiklander     cipher_info = mbedtls_cipher_info_from_type(cipher_type);
17132b31808SJens Wiklander     if (cipher_info == NULL) {
17232b31808SJens Wiklander         return MBEDTLS_ERR_PKCS12_FEATURE_UNAVAILABLE;
17332b31808SJens Wiklander     }
174817466cbSJens Wiklander 
175*b0563631STom Van Eyck     keylen = (int) mbedtls_cipher_info_get_key_bitlen(cipher_info) / 8;
176817466cbSJens Wiklander 
177*b0563631STom Van Eyck     if (mode == MBEDTLS_PKCS12_PBE_DECRYPT) {
178*b0563631STom Van Eyck         if (output_size < len) {
179*b0563631STom Van Eyck             return MBEDTLS_ERR_ASN1_BUF_TOO_SMALL;
180*b0563631STom Van Eyck         }
181*b0563631STom Van Eyck     }
182*b0563631STom Van Eyck 
183*b0563631STom Van Eyck     if (mode == MBEDTLS_PKCS12_PBE_ENCRYPT) {
184*b0563631STom Van Eyck         padlen = cipher_info->block_size - (len % cipher_info->block_size);
185*b0563631STom Van Eyck         if (output_size < (len + padlen)) {
186*b0563631STom Van Eyck             return MBEDTLS_ERR_ASN1_BUF_TOO_SMALL;
187*b0563631STom Van Eyck         }
188*b0563631STom Van Eyck     }
189*b0563631STom Van Eyck 
190*b0563631STom Van Eyck     iv_len = mbedtls_cipher_info_get_iv_size(cipher_info);
191817466cbSJens Wiklander     if ((ret = pkcs12_pbe_derive_key_iv(pbe_params, md_type, pwd, pwdlen,
192817466cbSJens Wiklander                                         key, keylen,
193*b0563631STom Van Eyck                                         iv, iv_len)) != 0) {
19432b31808SJens Wiklander         return ret;
195817466cbSJens Wiklander     }
196817466cbSJens Wiklander 
197817466cbSJens Wiklander     mbedtls_cipher_init(&cipher_ctx);
198817466cbSJens Wiklander 
19932b31808SJens Wiklander     if ((ret = mbedtls_cipher_setup(&cipher_ctx, cipher_info)) != 0) {
200817466cbSJens Wiklander         goto exit;
201817466cbSJens Wiklander     }
202817466cbSJens Wiklander 
203*b0563631STom Van Eyck     if ((ret = mbedtls_cipher_setkey(&cipher_ctx, key, 8 * keylen,
20432b31808SJens Wiklander                                      (mbedtls_operation_t) mode)) != 0) {
20532b31808SJens Wiklander         goto exit;
20632b31808SJens Wiklander     }
20732b31808SJens Wiklander 
208*b0563631STom Van Eyck #if defined(MBEDTLS_CIPHER_MODE_WITH_PADDING)
209*b0563631STom Van Eyck     {
210*b0563631STom Van Eyck         /* PKCS12 uses CBC with PKCS7 padding */
211*b0563631STom Van Eyck         mbedtls_cipher_padding_t padding = MBEDTLS_PADDING_PKCS7;
212*b0563631STom Van Eyck #if !defined(MBEDTLS_CIPHER_PADDING_PKCS7)
213*b0563631STom Van Eyck         /* For historical reasons, when decrypting, this function works when
214*b0563631STom Van Eyck          * decrypting even when support for PKCS7 padding is disabled. In this
215*b0563631STom Van Eyck          * case, it ignores the padding, and so will never report a
216*b0563631STom Van Eyck          * password mismatch.
217*b0563631STom Van Eyck          */
218*b0563631STom Van Eyck         if (mode == MBEDTLS_PKCS12_PBE_DECRYPT) {
219*b0563631STom Van Eyck             padding = MBEDTLS_PADDING_NONE;
220*b0563631STom Van Eyck         }
221*b0563631STom Van Eyck #endif
222*b0563631STom Van Eyck         if ((ret = mbedtls_cipher_set_padding_mode(&cipher_ctx, padding)) != 0) {
22332b31808SJens Wiklander             goto exit;
22432b31808SJens Wiklander         }
22532b31808SJens Wiklander     }
226*b0563631STom Van Eyck #endif /* MBEDTLS_CIPHER_MODE_WITH_PADDING */
22732b31808SJens Wiklander 
228*b0563631STom Van Eyck     ret = mbedtls_cipher_crypt(&cipher_ctx, iv, iv_len, data, len, output, &finish_olen);
229*b0563631STom Van Eyck     if (ret == MBEDTLS_ERR_CIPHER_INVALID_PADDING) {
230817466cbSJens Wiklander         ret = MBEDTLS_ERR_PKCS12_PASSWORD_MISMATCH;
23132b31808SJens Wiklander     }
232817466cbSJens Wiklander 
233*b0563631STom Van Eyck     *output_len += finish_olen;
234*b0563631STom Van Eyck 
235817466cbSJens Wiklander exit:
2363d3b0591SJens Wiklander     mbedtls_platform_zeroize(key, sizeof(key));
2373d3b0591SJens Wiklander     mbedtls_platform_zeroize(iv,  sizeof(iv));
238817466cbSJens Wiklander     mbedtls_cipher_free(&cipher_ctx);
239817466cbSJens Wiklander 
24032b31808SJens Wiklander     return ret;
241817466cbSJens Wiklander }
242817466cbSJens Wiklander 
243*b0563631STom Van Eyck #endif /* MBEDTLS_ASN1_PARSE_C && MBEDTLS_CIPHER_C */
2443d3b0591SJens Wiklander 
pkcs12_fill_buffer(unsigned char * data,size_t data_len,const unsigned char * filler,size_t fill_len)245817466cbSJens Wiklander static void pkcs12_fill_buffer(unsigned char *data, size_t data_len,
246817466cbSJens Wiklander                                const unsigned char *filler, size_t fill_len)
247817466cbSJens Wiklander {
248817466cbSJens Wiklander     unsigned char *p = data;
249817466cbSJens Wiklander     size_t use_len;
250817466cbSJens Wiklander 
25132b31808SJens Wiklander     if (filler != NULL && fill_len != 0) {
25232b31808SJens Wiklander         while (data_len > 0) {
253817466cbSJens Wiklander             use_len = (data_len > fill_len) ? fill_len : data_len;
254817466cbSJens Wiklander             memcpy(p, filler, use_len);
255817466cbSJens Wiklander             p += use_len;
256817466cbSJens Wiklander             data_len -= use_len;
257817466cbSJens Wiklander         }
25832b31808SJens Wiklander     } else {
259039e02dfSJerome Forissier         /* If either of the above are not true then clearly there is nothing
260039e02dfSJerome Forissier          * that this function can do. The function should *not* be called
261039e02dfSJerome Forissier          * under either of those circumstances, as you could end up with an
262039e02dfSJerome Forissier          * incorrect output but for safety's sake, leaving the check in as
263039e02dfSJerome Forissier          * otherwise we could end up with memory corruption.*/
264039e02dfSJerome Forissier     }
265039e02dfSJerome Forissier }
266817466cbSJens Wiklander 
26732b31808SJens Wiklander 
calculate_hashes(mbedtls_md_type_t md_type,int iterations,unsigned char * diversifier,unsigned char * salt_block,unsigned char * pwd_block,unsigned char * hash_output,int use_salt,int use_password,size_t hlen,size_t v)26832b31808SJens Wiklander static int calculate_hashes(mbedtls_md_type_t md_type, int iterations,
26932b31808SJens Wiklander                             unsigned char *diversifier, unsigned char *salt_block,
27032b31808SJens Wiklander                             unsigned char *pwd_block, unsigned char *hash_output, int use_salt,
27132b31808SJens Wiklander                             int use_password, size_t hlen, size_t v)
27232b31808SJens Wiklander {
27332b31808SJens Wiklander     int ret = -1;
27432b31808SJens Wiklander     size_t i;
27532b31808SJens Wiklander     const mbedtls_md_info_t *md_info;
27632b31808SJens Wiklander     mbedtls_md_context_t md_ctx;
27732b31808SJens Wiklander     md_info = mbedtls_md_info_from_type(md_type);
27832b31808SJens Wiklander     if (md_info == NULL) {
27932b31808SJens Wiklander         return MBEDTLS_ERR_PKCS12_FEATURE_UNAVAILABLE;
28032b31808SJens Wiklander     }
28132b31808SJens Wiklander 
28232b31808SJens Wiklander     mbedtls_md_init(&md_ctx);
28332b31808SJens Wiklander 
28432b31808SJens Wiklander     if ((ret = mbedtls_md_setup(&md_ctx, md_info, 0)) != 0) {
28532b31808SJens Wiklander         return ret;
28632b31808SJens Wiklander     }
28732b31808SJens Wiklander     // Calculate hash( diversifier || salt_block || pwd_block )
28832b31808SJens Wiklander     if ((ret = mbedtls_md_starts(&md_ctx)) != 0) {
28932b31808SJens Wiklander         goto exit;
29032b31808SJens Wiklander     }
29132b31808SJens Wiklander 
29232b31808SJens Wiklander     if ((ret = mbedtls_md_update(&md_ctx, diversifier, v)) != 0) {
29332b31808SJens Wiklander         goto exit;
29432b31808SJens Wiklander     }
29532b31808SJens Wiklander 
29632b31808SJens Wiklander     if (use_salt != 0) {
29732b31808SJens Wiklander         if ((ret = mbedtls_md_update(&md_ctx, salt_block, v)) != 0) {
29832b31808SJens Wiklander             goto exit;
29932b31808SJens Wiklander         }
30032b31808SJens Wiklander     }
30132b31808SJens Wiklander 
30232b31808SJens Wiklander     if (use_password != 0) {
30332b31808SJens Wiklander         if ((ret = mbedtls_md_update(&md_ctx, pwd_block, v)) != 0) {
30432b31808SJens Wiklander             goto exit;
30532b31808SJens Wiklander         }
30632b31808SJens Wiklander     }
30732b31808SJens Wiklander 
30832b31808SJens Wiklander     if ((ret = mbedtls_md_finish(&md_ctx, hash_output)) != 0) {
30932b31808SJens Wiklander         goto exit;
31032b31808SJens Wiklander     }
31132b31808SJens Wiklander 
31232b31808SJens Wiklander     // Perform remaining ( iterations - 1 ) recursive hash calculations
31332b31808SJens Wiklander     for (i = 1; i < (size_t) iterations; i++) {
31432b31808SJens Wiklander         if ((ret = mbedtls_md(md_info, hash_output, hlen, hash_output))
31532b31808SJens Wiklander             != 0) {
31632b31808SJens Wiklander             goto exit;
31732b31808SJens Wiklander         }
31832b31808SJens Wiklander     }
31932b31808SJens Wiklander 
32032b31808SJens Wiklander exit:
32132b31808SJens Wiklander     mbedtls_md_free(&md_ctx);
32232b31808SJens Wiklander     return ret;
32332b31808SJens Wiklander }
32432b31808SJens Wiklander 
32532b31808SJens Wiklander 
mbedtls_pkcs12_derivation(unsigned char * data,size_t datalen,const unsigned char * pwd,size_t pwdlen,const unsigned char * salt,size_t saltlen,mbedtls_md_type_t md_type,int id,int iterations)326817466cbSJens Wiklander int mbedtls_pkcs12_derivation(unsigned char *data, size_t datalen,
327817466cbSJens Wiklander                               const unsigned char *pwd, size_t pwdlen,
328817466cbSJens Wiklander                               const unsigned char *salt, size_t saltlen,
329817466cbSJens Wiklander                               mbedtls_md_type_t md_type, int id, int iterations)
330817466cbSJens Wiklander {
33111fa71b9SJerome Forissier     int ret = MBEDTLS_ERR_ERROR_CORRUPTION_DETECTED;
332817466cbSJens Wiklander     unsigned int j;
333817466cbSJens Wiklander 
334817466cbSJens Wiklander     unsigned char diversifier[128];
33532b31808SJens Wiklander     unsigned char salt_block[128], pwd_block[128], hash_block[128] = { 0 };
336*b0563631STom Van Eyck     unsigned char hash_output[MBEDTLS_MD_MAX_SIZE];
337817466cbSJens Wiklander     unsigned char *p;
338817466cbSJens Wiklander     unsigned char c;
339039e02dfSJerome Forissier     int           use_password = 0;
340039e02dfSJerome Forissier     int           use_salt = 0;
341817466cbSJens Wiklander 
342817466cbSJens Wiklander     size_t hlen, use_len, v, i;
343817466cbSJens Wiklander 
344817466cbSJens Wiklander     // This version only allows max of 64 bytes of password or salt
34532b31808SJens Wiklander     if (datalen > 128 || pwdlen > 64 || saltlen > 64) {
34632b31808SJens Wiklander         return MBEDTLS_ERR_PKCS12_BAD_INPUT_DATA;
34732b31808SJens Wiklander     }
348817466cbSJens Wiklander 
34932b31808SJens Wiklander     if (pwd == NULL && pwdlen != 0) {
35032b31808SJens Wiklander         return MBEDTLS_ERR_PKCS12_BAD_INPUT_DATA;
35132b31808SJens Wiklander     }
352039e02dfSJerome Forissier 
35332b31808SJens Wiklander     if (salt == NULL && saltlen != 0) {
35432b31808SJens Wiklander         return MBEDTLS_ERR_PKCS12_BAD_INPUT_DATA;
35532b31808SJens Wiklander     }
356039e02dfSJerome Forissier 
357039e02dfSJerome Forissier     use_password = (pwd && pwdlen != 0);
358039e02dfSJerome Forissier     use_salt = (salt && saltlen != 0);
359039e02dfSJerome Forissier 
360*b0563631STom Van Eyck     hlen = mbedtls_md_get_size_from_type(md_type);
361817466cbSJens Wiklander 
36232b31808SJens Wiklander     if (hlen <= 32) {
363817466cbSJens Wiklander         v = 64;
36432b31808SJens Wiklander     } else {
365817466cbSJens Wiklander         v = 128;
36632b31808SJens Wiklander     }
367817466cbSJens Wiklander 
368817466cbSJens Wiklander     memset(diversifier, (unsigned char) id, v);
369817466cbSJens Wiklander 
37032b31808SJens Wiklander     if (use_salt != 0) {
371817466cbSJens Wiklander         pkcs12_fill_buffer(salt_block, v, salt, saltlen);
372039e02dfSJerome Forissier     }
373039e02dfSJerome Forissier 
37432b31808SJens Wiklander     if (use_password != 0) {
375817466cbSJens Wiklander         pkcs12_fill_buffer(pwd_block,  v, pwd,  pwdlen);
376039e02dfSJerome Forissier     }
377817466cbSJens Wiklander 
378817466cbSJens Wiklander     p = data;
37932b31808SJens Wiklander     while (datalen > 0) {
38032b31808SJens Wiklander         if (calculate_hashes(md_type, iterations, diversifier, salt_block,
38132b31808SJens Wiklander                              pwd_block, hash_output, use_salt, use_password, hlen,
38232b31808SJens Wiklander                              v) != 0) {
383817466cbSJens Wiklander             goto exit;
384817466cbSJens Wiklander         }
385817466cbSJens Wiklander 
386817466cbSJens Wiklander         use_len = (datalen > hlen) ? hlen : datalen;
387817466cbSJens Wiklander         memcpy(p, hash_output, use_len);
388817466cbSJens Wiklander         datalen -= use_len;
389817466cbSJens Wiklander         p += use_len;
390817466cbSJens Wiklander 
39132b31808SJens Wiklander         if (datalen == 0) {
392817466cbSJens Wiklander             break;
39332b31808SJens Wiklander         }
394817466cbSJens Wiklander 
395817466cbSJens Wiklander         // Concatenating copies of hash_output into hash_block (B)
396817466cbSJens Wiklander         pkcs12_fill_buffer(hash_block, v, hash_output, hlen);
397817466cbSJens Wiklander 
398817466cbSJens Wiklander         // B += 1
39932b31808SJens Wiklander         for (i = v; i > 0; i--) {
40032b31808SJens Wiklander             if (++hash_block[i - 1] != 0) {
401817466cbSJens Wiklander                 break;
40232b31808SJens Wiklander             }
40332b31808SJens Wiklander         }
404817466cbSJens Wiklander 
40532b31808SJens Wiklander         if (use_salt != 0) {
406817466cbSJens Wiklander             // salt_block += B
407817466cbSJens Wiklander             c = 0;
40832b31808SJens Wiklander             for (i = v; i > 0; i--) {
409817466cbSJens Wiklander                 j = salt_block[i - 1] + hash_block[i - 1] + c;
410039e02dfSJerome Forissier                 c = MBEDTLS_BYTE_1(j);
411039e02dfSJerome Forissier                 salt_block[i - 1] = MBEDTLS_BYTE_0(j);
412039e02dfSJerome Forissier             }
413817466cbSJens Wiklander         }
414817466cbSJens Wiklander 
41532b31808SJens Wiklander         if (use_password != 0) {
416817466cbSJens Wiklander             // pwd_block  += B
417817466cbSJens Wiklander             c = 0;
41832b31808SJens Wiklander             for (i = v; i > 0; i--) {
419817466cbSJens Wiklander                 j = pwd_block[i - 1] + hash_block[i - 1] + c;
420039e02dfSJerome Forissier                 c = MBEDTLS_BYTE_1(j);
421039e02dfSJerome Forissier                 pwd_block[i - 1] = MBEDTLS_BYTE_0(j);
422039e02dfSJerome Forissier             }
423817466cbSJens Wiklander         }
424817466cbSJens Wiklander     }
425817466cbSJens Wiklander 
426817466cbSJens Wiklander     ret = 0;
427817466cbSJens Wiklander 
428817466cbSJens Wiklander exit:
4293d3b0591SJens Wiklander     mbedtls_platform_zeroize(salt_block, sizeof(salt_block));
4303d3b0591SJens Wiklander     mbedtls_platform_zeroize(pwd_block, sizeof(pwd_block));
4313d3b0591SJens Wiklander     mbedtls_platform_zeroize(hash_block, sizeof(hash_block));
4323d3b0591SJens Wiklander     mbedtls_platform_zeroize(hash_output, sizeof(hash_output));
433817466cbSJens Wiklander 
43432b31808SJens Wiklander     return ret;
435817466cbSJens Wiklander }
436817466cbSJens Wiklander 
437817466cbSJens Wiklander #endif /* MBEDTLS_PKCS12_C */
438