2 * Wrapper functions for libnettle and libgmp
3 * Copyright (c) 2017, Jouni Malinen <j@w1.fi>
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
10 #include <nettle/nettle-meta.h>
11 #include <nettle/des.h>
13 #include <nettle/hmac.h>
14 #include <nettle/aes.h>
17 #include <nettle/arcfour.h>
18 #include <nettle/bignum.h>
29 int des_encrypt(const u8 *clear, const u8 *key, u8 *cypher)
32 u8 pkey[8], next, tmp;
35 /* Add parity bits to the key */
37 for (i = 0; i < 7; i++) {
39 pkey[i] = (tmp >> i) | next | 1;
40 next = tmp << (7 - i);
44 nettle_des_set_key(&ctx, pkey);
45 nettle_des_encrypt(&ctx, DES_BLOCK_SIZE, cypher, clear);
46 os_memset(&ctx, 0, sizeof(ctx));
51 static int nettle_digest_vector(const struct nettle_hash *alg, size_t num_elem,
52 const u8 *addr[], const size_t *len, u8 *mac)
60 ctx = os_malloc(alg->context_size);
64 for (i = 0; i < num_elem; i++)
65 alg->update(ctx, len[i], addr[i]);
66 alg->digest(ctx, alg->digest_size, mac);
67 bin_clear_free(ctx, alg->context_size);
72 int md4_vector(size_t num_elem, const u8 *addr[], const size_t *len, u8 *mac)
74 return nettle_digest_vector(&nettle_md4, num_elem, addr, len, mac);
78 int md5_vector(size_t num_elem, const u8 *addr[], const size_t *len, u8 *mac)
80 return nettle_digest_vector(&nettle_md5, num_elem, addr, len, mac);
84 int sha1_vector(size_t num_elem, const u8 *addr[], const size_t *len, u8 *mac)
86 return nettle_digest_vector(&nettle_sha1, num_elem, addr, len, mac);
90 int sha256_vector(size_t num_elem, const u8 *addr[], const size_t *len, u8 *mac)
92 return nettle_digest_vector(&nettle_sha256, num_elem, addr, len, mac);
96 int sha384_vector(size_t num_elem, const u8 *addr[], const size_t *len, u8 *mac)
98 return nettle_digest_vector(&nettle_sha384, num_elem, addr, len, mac);
102 int sha512_vector(size_t num_elem, const u8 *addr[], const size_t *len, u8 *mac)
104 return nettle_digest_vector(&nettle_sha512, num_elem, addr, len, mac);
108 int hmac_md5_vector(const u8 *key, size_t key_len, size_t num_elem,
109 const u8 *addr[], const size_t *len, u8 *mac)
111 struct hmac_md5_ctx ctx;
117 hmac_md5_set_key(&ctx, key_len, key);
118 for (i = 0; i < num_elem; i++)
119 hmac_md5_update(&ctx, len[i], addr[i]);
120 hmac_md5_digest(&ctx, MD5_DIGEST_SIZE, mac);
121 os_memset(&ctx, 0, sizeof(ctx));
126 int hmac_md5(const u8 *key, size_t key_len, const u8 *data, size_t data_len,
129 return hmac_md5_vector(key, key_len, 1, &data, &data_len, mac);
133 int hmac_sha1_vector(const u8 *key, size_t key_len, size_t num_elem,
134 const u8 *addr[], const size_t *len, u8 *mac)
136 struct hmac_sha1_ctx ctx;
142 hmac_sha1_set_key(&ctx, key_len, key);
143 for (i = 0; i < num_elem; i++)
144 hmac_sha1_update(&ctx, len[i], addr[i]);
145 hmac_sha1_digest(&ctx, SHA1_DIGEST_SIZE, mac);
146 os_memset(&ctx, 0, sizeof(ctx));
151 int hmac_sha1(const u8 *key, size_t key_len, const u8 *data, size_t data_len,
154 return hmac_sha1_vector(key, key_len, 1, &data, &data_len, mac);
160 int hmac_sha256_vector(const u8 *key, size_t key_len, size_t num_elem,
161 const u8 *addr[], const size_t *len, u8 *mac)
163 struct hmac_sha256_ctx ctx;
169 hmac_sha256_set_key(&ctx, key_len, key);
170 for (i = 0; i < num_elem; i++)
171 hmac_sha256_update(&ctx, len[i], addr[i]);
172 hmac_sha256_digest(&ctx, SHA256_DIGEST_SIZE, mac);
173 os_memset(&ctx, 0, sizeof(ctx));
178 int hmac_sha256(const u8 *key, size_t key_len, const u8 *data,
179 size_t data_len, u8 *mac)
181 return hmac_sha256_vector(key, key_len, 1, &data, &data_len, mac);
184 #endif /* CONFIG_SHA256 */
189 int hmac_sha384_vector(const u8 *key, size_t key_len, size_t num_elem,
190 const u8 *addr[], const size_t *len, u8 *mac)
192 struct hmac_sha384_ctx ctx;
198 hmac_sha384_set_key(&ctx, key_len, key);
199 for (i = 0; i < num_elem; i++)
200 hmac_sha384_update(&ctx, len[i], addr[i]);
201 hmac_sha384_digest(&ctx, SHA384_DIGEST_SIZE, mac);
202 os_memset(&ctx, 0, sizeof(ctx));
207 int hmac_sha384(const u8 *key, size_t key_len, const u8 *data,
208 size_t data_len, u8 *mac)
210 return hmac_sha384_vector(key, key_len, 1, &data, &data_len, mac);
213 #endif /* CONFIG_SHA384 */
218 int hmac_sha512_vector(const u8 *key, size_t key_len, size_t num_elem,
219 const u8 *addr[], const size_t *len, u8 *mac)
221 struct hmac_sha512_ctx ctx;
227 hmac_sha512_set_key(&ctx, key_len, key);
228 for (i = 0; i < num_elem; i++)
229 hmac_sha512_update(&ctx, len[i], addr[i]);
230 hmac_sha512_digest(&ctx, SHA512_DIGEST_SIZE, mac);
231 os_memset(&ctx, 0, sizeof(ctx));
236 int hmac_sha512(const u8 *key, size_t key_len, const u8 *data,
237 size_t data_len, u8 *mac)
239 return hmac_sha512_vector(key, key_len, 1, &data, &data_len, mac);
242 #endif /* CONFIG_SHA512 */
245 void * aes_encrypt_init(const u8 *key, size_t len)
251 ctx = os_malloc(sizeof(*ctx));
255 nettle_aes_set_encrypt_key(ctx, len, key);
261 int aes_encrypt(void *ctx, const u8 *plain, u8 *crypt)
263 struct aes_ctx *actx = ctx;
264 nettle_aes_encrypt(actx, AES_BLOCK_SIZE, crypt, plain);
269 void aes_encrypt_deinit(void *ctx)
271 struct aes_ctx *actx = ctx;
272 bin_clear_free(actx, sizeof(*actx));
276 void * aes_decrypt_init(const u8 *key, size_t len)
282 ctx = os_malloc(sizeof(*ctx));
286 nettle_aes_set_decrypt_key(ctx, len, key);
292 int aes_decrypt(void *ctx, const u8 *crypt, u8 *plain)
294 struct aes_ctx *actx = ctx;
295 nettle_aes_decrypt(actx, AES_BLOCK_SIZE, plain, crypt);
300 void aes_decrypt_deinit(void *ctx)
302 struct aes_ctx *actx = ctx;
303 bin_clear_free(actx, sizeof(*actx));
307 int crypto_dh_init(u8 generator, const u8 *prime, size_t prime_len, u8 *privkey,
310 size_t pubkey_len, pad;
312 if (os_get_random(privkey, prime_len) < 0)
314 if (os_memcmp(privkey, prime, prime_len) > 0) {
315 /* Make sure private value is smaller than prime */
319 pubkey_len = prime_len;
320 if (crypto_mod_exp(&generator, 1, privkey, prime_len, prime, prime_len,
321 pubkey, &pubkey_len) < 0)
323 if (pubkey_len < prime_len) {
324 pad = prime_len - pubkey_len;
325 os_memmove(pubkey + pad, pubkey, pubkey_len);
326 os_memset(pubkey, 0, pad);
333 int crypto_dh_derive_secret(u8 generator, const u8 *prime, size_t prime_len,
334 const u8 *order, size_t order_len,
335 const u8 *privkey, size_t privkey_len,
336 const u8 *pubkey, size_t pubkey_len,
337 u8 *secret, size_t *len)
342 if (pubkey_len > prime_len ||
343 (pubkey_len == prime_len &&
344 os_memcmp(pubkey, prime, prime_len) >= 0))
348 mpz_import(pub, pubkey_len, 1, 1, 1, 0, pubkey);
349 if (mpz_cmp_d(pub, 1) <= 0)
356 /* verify: pubkey^q == 1 mod p */
357 mpz_inits(p, q, tmp, NULL);
358 mpz_import(p, prime_len, 1, 1, 1, 0, prime);
359 mpz_import(q, order_len, 1, 1, 1, 0, order);
360 mpz_powm(tmp, pub, q, p);
361 failed = mpz_cmp_d(tmp, 1) != 0;
362 mpz_clears(p, q, tmp, NULL);
367 res = crypto_mod_exp(pubkey, pubkey_len, privkey, privkey_len,
368 prime, prime_len, secret, len);
375 int crypto_mod_exp(const u8 *base, size_t base_len,
376 const u8 *power, size_t power_len,
377 const u8 *modulus, size_t modulus_len,
378 u8 *result, size_t *result_len)
380 mpz_t bn_base, bn_exp, bn_modulus, bn_result;
384 mpz_inits(bn_base, bn_exp, bn_modulus, bn_result, NULL);
385 mpz_import(bn_base, base_len, 1, 1, 1, 0, base);
386 mpz_import(bn_exp, power_len, 1, 1, 1, 0, power);
387 mpz_import(bn_modulus, modulus_len, 1, 1, 1, 0, modulus);
389 mpz_powm(bn_result, bn_base, bn_exp, bn_modulus);
390 len = mpz_sizeinbase(bn_result, 2);
392 if (*result_len < len)
394 mpz_export(result, result_len, 1, 1, 1, 0, bn_result);
398 mpz_clears(bn_base, bn_exp, bn_modulus, bn_result, NULL);
403 struct crypto_cipher {
404 enum crypto_cipher_alg alg;
406 struct arcfour_ctx arcfour_ctx;
411 struct crypto_cipher * crypto_cipher_init(enum crypto_cipher_alg alg,
412 const u8 *iv, const u8 *key,
415 struct crypto_cipher *ctx;
417 ctx = os_zalloc(sizeof(*ctx));
424 case CRYPTO_CIPHER_ALG_RC4:
425 nettle_arcfour_set_key(&ctx->u.arcfour_ctx, key_len, key);
436 int crypto_cipher_encrypt(struct crypto_cipher *ctx, const u8 *plain,
437 u8 *crypt, size_t len)
440 case CRYPTO_CIPHER_ALG_RC4:
441 nettle_arcfour_crypt(&ctx->u.arcfour_ctx, len, crypt, plain);
451 int crypto_cipher_decrypt(struct crypto_cipher *ctx, const u8 *crypt,
452 u8 *plain, size_t len)
455 case CRYPTO_CIPHER_ALG_RC4:
456 nettle_arcfour_crypt(&ctx->u.arcfour_ctx, len, plain, crypt);
466 void crypto_cipher_deinit(struct crypto_cipher *ctx)
468 bin_clear_free(ctx, sizeof(*ctx));