1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (c) 2013, Google Inc.
12 #include <u-boot/fdt-libcrypto.h>
13 #include <openssl/bn.h>
14 #include <openssl/ec.h>
15 #include <openssl/rsa.h>
16 #include <openssl/pem.h>
17 #include <openssl/err.h>
18 #include <openssl/ssl.h>
19 #include <openssl/evp.h>
20 #include <openssl/engine.h>
22 #if OPENSSL_VERSION_NUMBER >= 0x10000000L
23 #define HAVE_ERR_REMOVE_THREAD_STATE
26 #if OPENSSL_VERSION_NUMBER < 0x10100000L || \
27 (defined(LIBRESSL_VERSION_NUMBER) && LIBRESSL_VERSION_NUMBER < 0x02070000fL)
28 static void RSA_get0_key(const RSA *r,
29 const BIGNUM **n, const BIGNUM **e, const BIGNUM **d)
40 static int rsa_err(const char *msg)
42 unsigned long sslErr = ERR_get_error();
44 fprintf(stderr, "%s", msg);
45 fprintf(stderr, ": %s\n",
46 ERR_error_string(sslErr, 0));
52 * rsa_pem_get_pub_key() - read a public key from a .crt file
54 * @keydir: Directory containins the key
55 * @name Name of key file (will have a .crt extension)
56 * @evpp Returns EVP_PKEY object, or NULL on failure
57 * @return 0 if ok, -ve on error (in which case *evpp will be set to NULL)
59 static int rsa_pem_get_pub_key(const char *keydir, const char *name, EVP_PKEY **evpp)
71 snprintf(path, sizeof(path), "%s/%s.crt", keydir, name);
74 fprintf(stderr, "Couldn't open RSA certificate: '%s': %s\n",
75 path, strerror(errno));
79 /* Read the certificate */
81 if (!PEM_read_X509(f, &cert, NULL, NULL)) {
82 rsa_err("Couldn't read certificate");
87 /* Get the public key from the certificate. */
88 key = X509_get_pubkey(cert);
90 rsa_err("Couldn't read public key\n");
109 * rsa_engine_get_pub_key() - read a public key from given engine
111 * @keydir: Key prefix
113 * @engine Engine to use
114 * @evpp Returns EVP_PKEY object, or NULL on failure
115 * @return 0 if ok, -ve on error (in which case *evpp will be set to NULL)
117 static int rsa_engine_get_pub_key(const char *keydir, const char *name,
118 ENGINE *engine, EVP_PKEY **evpp)
120 const char *engine_id;
122 EVP_PKEY *key = NULL;
129 engine_id = ENGINE_get_id(engine);
131 if (engine_id && !strcmp(engine_id, "pkcs11")) {
133 if (strstr(keydir, "object="))
134 snprintf(key_id, sizeof(key_id),
135 "pkcs11:%s;type=public",
138 snprintf(key_id, sizeof(key_id),
139 "pkcs11:%s;object=%s;type=public",
142 snprintf(key_id, sizeof(key_id),
143 "pkcs11:object=%s;type=public",
145 } else if (engine_id) {
147 snprintf(key_id, sizeof(key_id),
151 snprintf(key_id, sizeof(key_id),
155 fprintf(stderr, "Engine not supported\n");
159 key = ENGINE_load_public_key(engine, key_id, NULL, NULL);
161 return rsa_err("Failure loading public key from engine");
169 * rsa_get_pub_key() - read a public key
171 * @keydir: Directory containing the key (PEM file) or key prefix (engine)
172 * @name Name of key file (will have a .crt extension)
173 * @engine Engine to use
174 * @evpp Returns EVP_PKEY object, or NULL on failure
175 * @return 0 if ok, -ve on error (in which case *evpp will be set to NULL)
177 static int rsa_get_pub_key(const char *keydir, const char *name,
178 ENGINE *engine, EVP_PKEY **evpp)
181 return rsa_engine_get_pub_key(keydir, name, engine, evpp);
182 return rsa_pem_get_pub_key(keydir, name, evpp);
186 * rsa_pem_get_priv_key() - read a private key from a .key file
188 * @keydir: Directory containing the key
189 * @name Name of key file (will have a .key extension)
190 * @evpp Returns EVP_PKEY object, or NULL on failure
191 * @return 0 if ok, -ve on error (in which case *evpp will be set to NULL)
193 static int rsa_pem_get_priv_key(const char *keydir, const char *name,
194 const char *keyfile, EVP_PKEY **evpp)
196 char path[1024] = {0};
204 snprintf(path, sizeof(path), "%s/%s.key", keydir, name);
206 snprintf(path, sizeof(path), "%s", keyfile);
210 f = fopen(path, "r");
212 fprintf(stderr, "Couldn't open RSA private key: '%s': %s\n",
213 path, strerror(errno));
217 if (!PEM_read_PrivateKey(f, evpp, NULL, path)) {
218 rsa_err("Failure reading private key");
228 * rsa_engine_get_priv_key() - read a private key from given engine
230 * @keydir: Key prefix
232 * @engine Engine to use
233 * @evpp Returns EVP_PKEY object, or NULL on failure
234 * @return 0 if ok, -ve on error (in which case *evpp will be set to NULL)
236 static int rsa_engine_get_priv_key(const char *keydir, const char *name,
238 ENGINE *engine, EVP_PKEY **evpp)
240 const char *engine_id;
242 EVP_PKEY *key = NULL;
247 engine_id = ENGINE_get_id(engine);
249 if (engine_id && !strcmp(engine_id, "pkcs11")) {
250 if (!keydir && !name) {
251 fprintf(stderr, "Please use 'keydir' with PKCS11\n");
255 if (strstr(keydir, "object="))
256 snprintf(key_id, sizeof(key_id),
257 "pkcs11:%s;type=private",
260 snprintf(key_id, sizeof(key_id),
261 "pkcs11:%s;object=%s;type=private",
264 snprintf(key_id, sizeof(key_id),
265 "pkcs11:object=%s;type=private",
267 } else if (engine_id) {
269 snprintf(key_id, sizeof(key_id),
273 snprintf(key_id, sizeof(key_id),
277 snprintf(key_id, sizeof(key_id), "%s", keyfile);
282 fprintf(stderr, "Engine not supported\n");
286 key = ENGINE_load_private_key(engine, key_id, NULL, NULL);
288 return rsa_err("Failure loading private key from engine");
296 * rsa_get_priv_key() - read a private key
298 * @keydir: Directory containing the key (PEM file) or key prefix (engine)
300 * @engine Engine to use for signing
301 * @evpp Returns EVP_PKEY object, or NULL on failure
302 * @return 0 if ok, -ve on error (in which case *evpp will be set to NULL)
304 static int rsa_get_priv_key(const char *keydir, const char *name,
305 const char *keyfile, ENGINE *engine, EVP_PKEY **evpp)
308 return rsa_engine_get_priv_key(keydir, name, keyfile, engine,
310 return rsa_pem_get_priv_key(keydir, name, keyfile, evpp);
313 static int rsa_init(void)
317 #if OPENSSL_VERSION_NUMBER < 0x10100000L || \
318 (defined(LIBRESSL_VERSION_NUMBER) && LIBRESSL_VERSION_NUMBER < 0x02070000fL)
319 ret = SSL_library_init();
321 ret = OPENSSL_init_ssl(0, NULL);
324 fprintf(stderr, "Failure to init SSL library\n");
327 #if OPENSSL_VERSION_NUMBER < 0x10100000L || \
328 (defined(LIBRESSL_VERSION_NUMBER) && LIBRESSL_VERSION_NUMBER < 0x02070000fL)
329 SSL_load_error_strings();
331 OpenSSL_add_all_algorithms();
332 OpenSSL_add_all_digests();
333 OpenSSL_add_all_ciphers();
339 static int rsa_engine_init(const char *engine_id, ENGINE **pe)
344 ENGINE_load_builtin_engines();
346 e = ENGINE_by_id(engine_id);
348 fprintf(stderr, "Engine isn't available\n");
350 goto err_engine_by_id;
353 if (!ENGINE_init(e)) {
354 fprintf(stderr, "Couldn't initialize engine\n");
356 goto err_engine_init;
359 if (!ENGINE_set_default_RSA(e)) {
360 fprintf(stderr, "Couldn't set engine as default for RSA\n");
374 #if OPENSSL_VERSION_NUMBER < 0x10100000L || \
375 (defined(LIBRESSL_VERSION_NUMBER) && LIBRESSL_VERSION_NUMBER < 0x02070000fL)
381 static void rsa_remove(void)
383 #if OPENSSL_VERSION_NUMBER < 0x10100000L || \
384 (defined(LIBRESSL_VERSION_NUMBER) && LIBRESSL_VERSION_NUMBER < 0x02070000fL)
385 CRYPTO_cleanup_all_ex_data();
387 #ifdef HAVE_ERR_REMOVE_THREAD_STATE
388 ERR_remove_thread_state(NULL);
396 static void rsa_engine_remove(ENGINE *e)
404 static int rsa_sign_with_key(EVP_PKEY *pkey, struct padding_algo *padding_algo,
405 struct checksum_algo *checksum_algo,
406 const struct image_region region[], int region_count,
407 uint8_t **sigp, uint *sig_size)
416 size = EVP_PKEY_size(pkey);
419 fprintf(stderr, "Out of memory for signature (%zu bytes)\n",
425 context = EVP_MD_CTX_create();
427 ret = rsa_err("EVP context creation failed");
430 EVP_MD_CTX_init(context);
432 ckey = EVP_PKEY_CTX_new(pkey, NULL);
434 ret = rsa_err("EVP key context creation failed");
438 if (EVP_DigestSignInit(context, &ckey,
439 checksum_algo->calculate_sign(),
441 ret = rsa_err("Signer setup failed");
445 #ifdef CONFIG_FIT_ENABLE_RSASSA_PSS_SUPPORT
446 if (padding_algo && !strcmp(padding_algo->name, "pss")) {
447 if (EVP_PKEY_CTX_set_rsa_padding(ckey,
448 RSA_PKCS1_PSS_PADDING) <= 0) {
449 ret = rsa_err("Signer padding setup failed");
453 #endif /* CONFIG_FIT_ENABLE_RSASSA_PSS_SUPPORT */
455 for (i = 0; i < region_count; i++) {
456 if (!EVP_DigestSignUpdate(context, region[i].data,
458 ret = rsa_err("Signing data failed");
463 if (!EVP_DigestSignFinal(context, sig, &size)) {
464 ret = rsa_err("Could not obtain signature");
468 #if OPENSSL_VERSION_NUMBER < 0x10100000L || \
469 (defined(LIBRESSL_VERSION_NUMBER) && LIBRESSL_VERSION_NUMBER < 0x02070000fL)
470 EVP_MD_CTX_cleanup(context);
472 EVP_MD_CTX_reset(context);
474 EVP_MD_CTX_destroy(context);
476 debug("Got signature: %d bytes, expected %zu\n", *sig_size, size);
483 EVP_MD_CTX_destroy(context);
490 int rsa_sign(struct image_sign_info *info,
491 const struct image_region region[], int region_count,
492 uint8_t **sigp, uint *sig_len)
494 EVP_PKEY *pkey = NULL;
502 if (info->engine_id) {
503 ret = rsa_engine_init(info->engine_id, &e);
508 ret = rsa_get_priv_key(info->keydir, info->keyname, info->keyfile,
512 ret = rsa_sign_with_key(pkey, info->padding, info->checksum, region,
513 region_count, sigp, sig_len);
519 rsa_engine_remove(e);
528 rsa_engine_remove(e);
535 * rsa_get_exponent(): - Get the public exponent from an RSA key
537 static int rsa_get_exponent(RSA *key, uint64_t *e)
550 RSA_get0_key(key, NULL, &key_e, NULL);
551 if (BN_num_bits(key_e) > 64)
554 *e = BN_get_word(key_e);
556 if (BN_num_bits(key_e) < 33) {
561 bn_te = BN_dup(key_e);
565 if (!BN_rshift(bn_te, bn_te, 32))
568 if (!BN_mask_bits(bn_te, 32))
571 te = BN_get_word(bn_te);
584 * rsa_get_params(): - Get the important parameters of an RSA public key
586 int rsa_get_params(RSA *key, uint64_t *exponent, uint32_t *n0_invp,
587 BIGNUM **modulusp, BIGNUM **r_squaredp)
589 BIGNUM *big1, *big2, *big32, *big2_32;
590 BIGNUM *n, *r, *r_squared, *tmp;
592 BN_CTX *bn_ctx = BN_CTX_new();
595 /* Initialize BIGNUMs */
600 r_squared = BN_new();
604 if (!big1 || !big2 || !big32 || !r || !r_squared || !tmp || !big2_32 ||
606 fprintf(stderr, "Out of memory (bignum)\n");
610 if (0 != rsa_get_exponent(key, exponent))
613 RSA_get0_key(key, &key_n, NULL, NULL);
614 if (!BN_copy(n, key_n) || !BN_set_word(big1, 1L) ||
615 !BN_set_word(big2, 2L) || !BN_set_word(big32, 32L))
619 if (!BN_exp(big2_32, big2, big32, bn_ctx))
622 /* Calculate n0_inv = -1 / n[0] mod 2^32 */
623 if (!BN_mod_inverse(tmp, n, big2_32, bn_ctx) ||
624 !BN_sub(tmp, big2_32, tmp))
626 *n0_invp = BN_get_word(tmp);
628 /* Calculate R = 2^(# of key bits) */
629 if (!BN_set_word(tmp, BN_num_bits(n)) ||
630 !BN_exp(r, big2, tmp, bn_ctx))
633 /* Calculate r_squared = R^2 mod n */
634 if (!BN_copy(r_squared, r) ||
635 !BN_mul(tmp, r_squared, r, bn_ctx) ||
636 !BN_mod(r_squared, tmp, n, bn_ctx))
640 *r_squaredp = r_squared;
649 fprintf(stderr, "Bignum operations failed\n");
656 int rsa_add_verify_data(struct image_sign_info *info, void *keydest)
658 BIGNUM *modulus, *r_squared;
666 EVP_PKEY *pkey = NULL;
669 debug("%s: Getting verification data\n", __func__);
670 if (info->engine_id) {
671 ret = rsa_engine_init(info->engine_id, &e);
675 ret = rsa_get_pub_key(info->keydir, info->keyname, e, &pkey);
677 goto err_get_pub_key;
678 #if OPENSSL_VERSION_NUMBER < 0x10100000L || \
679 (defined(LIBRESSL_VERSION_NUMBER) && LIBRESSL_VERSION_NUMBER < 0x02070000fL)
680 rsa = EVP_PKEY_get1_RSA(pkey);
682 rsa = EVP_PKEY_get0_RSA(pkey);
684 ret = rsa_get_params(rsa, &exponent, &n0_inv, &modulus, &r_squared);
687 bits = BN_num_bits(modulus);
688 parent = fdt_subnode_offset(keydest, 0, FIT_SIG_NODENAME);
689 if (parent == -FDT_ERR_NOTFOUND) {
690 parent = fdt_add_subnode(keydest, 0, FIT_SIG_NODENAME);
693 if (ret != -FDT_ERR_NOSPACE) {
694 fprintf(stderr, "Couldn't create signature node: %s\n",
695 fdt_strerror(parent));
702 /* Either create or overwrite the named key node */
703 snprintf(name, sizeof(name), "key-%s", info->keyname);
704 node = fdt_subnode_offset(keydest, parent, name);
705 if (node == -FDT_ERR_NOTFOUND) {
706 node = fdt_add_subnode(keydest, parent, name);
709 if (ret != -FDT_ERR_NOSPACE) {
710 fprintf(stderr, "Could not create key subnode: %s\n",
714 } else if (node < 0) {
715 fprintf(stderr, "Cannot select keys parent: %s\n",
721 ret = fdt_setprop_string(keydest, node, FIT_KEY_HINT,
725 ret = fdt_setprop_u32(keydest, node, "rsa,num-bits", bits);
727 ret = fdt_setprop_u32(keydest, node, "rsa,n0-inverse", n0_inv);
729 ret = fdt_setprop_u64(keydest, node, "rsa,exponent", exponent);
732 ret = fdt_add_bignum(keydest, node, "rsa,modulus", modulus,
736 ret = fdt_add_bignum(keydest, node, "rsa,r-squared", r_squared,
740 ret = fdt_setprop_string(keydest, node, FIT_ALGO_PROP,
743 if (!ret && info->require_keys) {
744 ret = fdt_setprop_string(keydest, node, FIT_KEY_REQUIRED,
751 ret = ret == -FDT_ERR_NOSPACE ? -ENOSPC : -EIO;
753 #if OPENSSL_VERSION_NUMBER < 0x10100000L || \
754 (defined(LIBRESSL_VERSION_NUMBER) && LIBRESSL_VERSION_NUMBER < 0x02070000fL)
760 rsa_engine_remove(e);