1 /*

     2  * Copyright (c) 2002 Bob Beck <beck@openbsd.org>

     3  * Copyright (c) 2002 Theo de Raadt

     4  * Copyright (c) 2002 Markus Friedl

     5  * All rights reserved.

     6  *

     7  * Redistribution and use in source and binary forms, with or without

     8  * modification, are permitted provided that the following conditions

     9  * are met:

    10  * 1. Redistributions of source code must retain the above copyright

    11  *    notice, this list of conditions and the following disclaimer.

    12  * 2. Redistributions in binary form must reproduce the above copyright

    13  *    notice, this list of conditions and the following disclaimer in the

    14  *    documentation and/or other materials provided with the distribution.

    15  *

    16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND ANY

    17  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED

    18  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE

    19  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY

    20  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES

    21  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;

    22  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND

    23  * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT

    24  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF

    25  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.

    26  *

    27  */

    28 

    29 #include <openssl/objects.h>

    30 #include <openssl/engine.h>

    31 #include <openssl/evp.h>

    32 #include <openssl/bn.h>

    33 

    34 #if (defined(__unix__) || defined(unix)) && !defined(USG) && \

    35 	(defined(OpenBSD) || defined(__FreeBSD_version))

    36 #include <sys/param.h>

    37 # if (OpenBSD >= 200112) || ((__FreeBSD_version >= 470101 && __FreeBSD_version < 500000) || __FreeBSD_version >= 500041)

    38 #  define HAVE_CRYPTODEV

    39 # endif

    40 # if (OpenBSD >= 200110)

    41 #  define HAVE_SYSLOG_R

    42 # endif

    43 #endif

    44 

    45 #ifndef HAVE_CRYPTODEV

    46 

    47 EXPORT_C void

    48 ENGINE_load_cryptodev(void)

    49 {

    50 	/* This is a NOP on platforms without /dev/crypto */

    51 	return;

    52 }

    53 

    54 #else 

    55  

    56 #include <sys/types.h>

    57 #include <crypto/cryptodev.h>

    58 #include <sys/ioctl.h>

    59 #include <errno.h>

    60 #include <stdio.h>

    61 #include <unistd.h>

    62 #include <fcntl.h>

    63 #include <stdarg.h>

    64 #include <syslog.h>

    65 #include <errno.h>

    66 #include <string.h>

    67 

    68 struct dev_crypto_state {

    69 	struct session_op d_sess;

    70 	int d_fd;

    71 };

    72 

    73 static u_int32_t cryptodev_asymfeat = 0;

    74 

    75 static int get_asym_dev_crypto(void);

    76 static int open_dev_crypto(void);

    77 static int get_dev_crypto(void);

    78 static int cryptodev_max_iv(int cipher);

    79 static int cryptodev_key_length_valid(int cipher, int len);

    80 static int cipher_nid_to_cryptodev(int nid);

    81 static int get_cryptodev_ciphers(const int **cnids);

    82 static int get_cryptodev_digests(const int **cnids);

    83 static int cryptodev_usable_ciphers(const int **nids);

    84 static int cryptodev_usable_digests(const int **nids);

    85 static int cryptodev_cipher(EVP_CIPHER_CTX *ctx, unsigned char *out,

    86     const unsigned char *in, unsigned int inl);

    87 static int cryptodev_init_key(EVP_CIPHER_CTX *ctx, const unsigned char *key,

    88     const unsigned char *iv, int enc);

    89 static int cryptodev_cleanup(EVP_CIPHER_CTX *ctx);

    90 static int cryptodev_engine_ciphers(ENGINE *e, const EVP_CIPHER **cipher,

    91     const int **nids, int nid);

    92 static int cryptodev_engine_digests(ENGINE *e, const EVP_MD **digest,

    93     const int **nids, int nid);

    94 static int bn2crparam(const BIGNUM *a, struct crparam *crp);

    95 static int crparam2bn(struct crparam *crp, BIGNUM *a);

    96 static void zapparams(struct crypt_kop *kop);

    97 static int cryptodev_asym(struct crypt_kop *kop, int rlen, BIGNUM *r,

    98     int slen, BIGNUM *s);

    99 

   100 static int cryptodev_bn_mod_exp(BIGNUM *r, const BIGNUM *a,

   101     const BIGNUM *p, const BIGNUM *m, BN_CTX *ctx, BN_MONT_CTX *m_ctx);

   102 static int cryptodev_rsa_nocrt_mod_exp(BIGNUM *r0, const BIGNUM *I,

   103     RSA *rsa);

   104 static int cryptodev_rsa_mod_exp(BIGNUM *r0, const BIGNUM *I, RSA *rsa, BN_CTX *ctx);

   105 static int cryptodev_dsa_bn_mod_exp(DSA *dsa, BIGNUM *r, BIGNUM *a,

   106     const BIGNUM *p, const BIGNUM *m, BN_CTX *ctx, BN_MONT_CTX *m_ctx);

   107 static int cryptodev_dsa_dsa_mod_exp(DSA *dsa, BIGNUM *t1, BIGNUM *g,

   108     BIGNUM *u1, BIGNUM *pub_key, BIGNUM *u2, BIGNUM *p,

   109     BN_CTX *ctx, BN_MONT_CTX *mont);

   110 static DSA_SIG *cryptodev_dsa_do_sign(const unsigned char *dgst,

   111     int dlen, DSA *dsa);

   112 static int cryptodev_dsa_verify(const unsigned char *dgst, int dgst_len,

   113     DSA_SIG *sig, DSA *dsa);

   114 static int cryptodev_mod_exp_dh(const DH *dh, BIGNUM *r, const BIGNUM *a,

   115     const BIGNUM *p, const BIGNUM *m, BN_CTX *ctx,

   116     BN_MONT_CTX *m_ctx);

   117 static int cryptodev_dh_compute_key(unsigned char *key,

   118     const BIGNUM *pub_key, DH *dh);

   119 static int cryptodev_ctrl(ENGINE *e, int cmd, long i, void *p,

   120     void (*f)());

   121 void ENGINE_load_cryptodev(void);

   122 

   123 static const ENGINE_CMD_DEFN cryptodev_defns[] = {

   124 	{ 0, NULL, NULL, 0 }

   125 };

   126 

   127 static struct {

   128 	int	id;

   129 	int	nid;

   130 	int	ivmax;

   131 	int	keylen;

   132 } ciphers[] = {

   133 	{ CRYPTO_DES_CBC,		NID_des_cbc,		8,	 8, },

   134 	{ CRYPTO_3DES_CBC,		NID_des_ede3_cbc,	8,	24, },

   135 	{ CRYPTO_AES_CBC,		NID_aes_128_cbc,	16,	16, },

   136 	{ CRYPTO_BLF_CBC,		NID_bf_cbc,		8,	16, },

   137 	{ CRYPTO_CAST_CBC,		NID_cast5_cbc,		8,	16, },

   138 	{ CRYPTO_SKIPJACK_CBC,		NID_undef,		0,	 0, },

   139 	{ 0,				NID_undef,		0,	 0, },

   140 };

   141 

   142 static struct {

   143 	int	id;

   144 	int	nid;

   145 } digests[] = {

   146 	{ CRYPTO_SHA1_HMAC,		NID_hmacWithSHA1,	},

   147 	{ CRYPTO_RIPEMD160_HMAC,	NID_ripemd160,		},

   148 	{ CRYPTO_MD5_KPDK,		NID_undef,		},

   149 	{ CRYPTO_SHA1_KPDK,		NID_undef,		},

   150 	{ CRYPTO_MD5,			NID_md5,		},

   151 	{ CRYPTO_SHA1,			NID_undef,		},

   152 	{ 0,				NID_undef,		},

   153 };

   154 

   155 /*

   156  * Return a fd if /dev/crypto seems usable, 0 otherwise.

   157  */

   158 static int

   159 open_dev_crypto(void)

   160 {

   161 	static int fd = -1;

   162 

   163 	if (fd == -1) {

   164 		if ((fd = open("/dev/crypto", O_RDWR, 0)) == -1)

   165 			return (-1);

   166 		/* close on exec */

   167 		if (fcntl(fd, F_SETFD, 1) == -1) {

   168 			close(fd);

   169 			fd = -1;

   170 			return (-1);

   171 		}

   172 	}

   173 	return (fd);

   174 }

   175 

   176 static int

   177 get_dev_crypto(void)

   178 {

   179 	int fd, retfd;

   180 

   181 	if ((fd = open_dev_crypto()) == -1)

   182 		return (-1);

   183 	if (ioctl(fd, CRIOGET, &retfd) == -1)

   184 		return (-1);

   185 

   186 	/* close on exec */

   187 	if (fcntl(retfd, F_SETFD, 1) == -1) {

   188 		close(retfd);

   189 		return (-1);

   190 	}

   191 	return (retfd);

   192 }

   193 

   194 /* Caching version for asym operations */

   195 static int

   196 get_asym_dev_crypto(void)

   197 {

   198 	static int fd = -1;

   199 

   200 	if (fd == -1)

   201 		fd = get_dev_crypto();

   202 	return fd;

   203 }

   204 

   205 /*

   206  * XXXX this needs to be set for each alg - and determined from

   207  * a running card.

   208  */

   209 static int

   210 cryptodev_max_iv(int cipher)

   211 {

   212 	int i;

   213 

   214 	for (i = 0; ciphers[i].id; i++)

   215 		if (ciphers[i].id == cipher)

   216 			return (ciphers[i].ivmax);

   217 	return (0);

   218 }

   219 

   220 /*

   221  * XXXX this needs to be set for each alg - and determined from

   222  * a running card. For now, fake it out - but most of these

   223  * for real devices should return 1 for the supported key

   224  * sizes the device can handle.

   225  */

   226 static int

   227 cryptodev_key_length_valid(int cipher, int len)

   228 {

   229 	int i;

   230 

   231 	for (i = 0; ciphers[i].id; i++)

   232 		if (ciphers[i].id == cipher)

   233 			return (ciphers[i].keylen == len);

   234 	return (0);

   235 }

   236 

   237 /* convert libcrypto nids to cryptodev */

   238 static int

   239 cipher_nid_to_cryptodev(int nid)

   240 {

   241 	int i;

   242 

   243 	for (i = 0; ciphers[i].id; i++)

   244 		if (ciphers[i].nid == nid)

   245 			return (ciphers[i].id);

   246 	return (0);

   247 }

   248 

   249 /*

   250  * Find out what ciphers /dev/crypto will let us have a session for.

   251  * XXX note, that some of these openssl doesn't deal with yet!

   252  * returning them here is harmless, as long as we return NULL

   253  * when asked for a handler in the cryptodev_engine_ciphers routine

   254  */

   255 static int

   256 get_cryptodev_ciphers(const int **cnids)

   257 {

   258 	static int nids[CRYPTO_ALGORITHM_MAX];

   259 	struct session_op sess;

   260 	int fd, i, count = 0;

   261 

   262 	if ((fd = get_dev_crypto()) < 0) {

   263 		*cnids = NULL;

   264 		return (0);

   265 	}

   266 	memset(&sess, 0, sizeof(sess));

   267 	sess.key = (caddr_t)"123456781234567812345678";

   268 

   269 	for (i = 0; ciphers[i].id && count < CRYPTO_ALGORITHM_MAX; i++) {

   270 		if (ciphers[i].nid == NID_undef)

   271 			continue;

   272 		sess.cipher = ciphers[i].id;

   273 		sess.keylen = ciphers[i].keylen;

   274 		sess.mac = 0;

   275 		if (ioctl(fd, CIOCGSESSION, &sess) != -1 &&

   276 		    ioctl(fd, CIOCFSESSION, &sess.ses) != -1)

   277 			nids[count++] = ciphers[i].nid;

   278 	}

   279 	close(fd);

   280 

   281 	if (count > 0)

   282 		*cnids = nids;

   283 	else

   284 		*cnids = NULL;

   285 	return (count);

   286 }

   287 

   288 /*

   289  * Find out what digests /dev/crypto will let us have a session for.

   290  * XXX note, that some of these openssl doesn't deal with yet!

   291  * returning them here is harmless, as long as we return NULL

   292  * when asked for a handler in the cryptodev_engine_digests routine

   293  */

   294 static int

   295 get_cryptodev_digests(const int **cnids)

   296 {

   297 	static int nids[CRYPTO_ALGORITHM_MAX];

   298 	struct session_op sess;

   299 	int fd, i, count = 0;

   300 

   301 	if ((fd = get_dev_crypto()) < 0) {

   302 		*cnids = NULL;

   303 		return (0);

   304 	}

   305 	memset(&sess, 0, sizeof(sess));

   306 	for (i = 0; digests[i].id && count < CRYPTO_ALGORITHM_MAX; i++) {

   307 		if (digests[i].nid == NID_undef)

   308 			continue;

   309 		sess.mac = digests[i].id;

   310 		sess.cipher = 0;

   311 		if (ioctl(fd, CIOCGSESSION, &sess) != -1 &&

   312 		    ioctl(fd, CIOCFSESSION, &sess.ses) != -1)

   313 			nids[count++] = digests[i].nid;

   314 	}

   315 	close(fd);

   316 

   317 	if (count > 0)

   318 		*cnids = nids;

   319 	else

   320 		*cnids = NULL;

   321 	return (count);

   322 }

   323 

   324 /*

   325  * Find the useable ciphers|digests from dev/crypto - this is the first

   326  * thing called by the engine init crud which determines what it

   327  * can use for ciphers from this engine. We want to return

   328  * only what we can do, anythine else is handled by software.

   329  *

   330  * If we can't initialize the device to do anything useful for

   331  * any reason, we want to return a NULL array, and 0 length,

   332  * which forces everything to be done is software. By putting

   333  * the initalization of the device in here, we ensure we can

   334  * use this engine as the default, and if for whatever reason

   335  * /dev/crypto won't do what we want it will just be done in

   336  * software

   337  *

   338  * This can (should) be greatly expanded to perhaps take into

   339  * account speed of the device, and what we want to do.

   340  * (although the disabling of particular alg's could be controlled

   341  * by the device driver with sysctl's.) - this is where we

   342  * want most of the decisions made about what we actually want

   343  * to use from /dev/crypto.

   344  */

   345 static int

   346 cryptodev_usable_ciphers(const int **nids)

   347 {

   348 	return (get_cryptodev_ciphers(nids));

   349 }

   350 

   351 static int

   352 cryptodev_usable_digests(const int **nids)

   353 {

   354 	/*

   355 	 * XXXX just disable all digests for now, because it sucks.

   356 	 * we need a better way to decide this - i.e. I may not

   357 	 * want digests on slow cards like hifn on fast machines,

   358 	 * but might want them on slow or loaded machines, etc.

   359 	 * will also want them when using crypto cards that don't

   360 	 * suck moose gonads - would be nice to be able to decide something

   361 	 * as reasonable default without having hackery that's card dependent.

   362 	 * of course, the default should probably be just do everything,

   363 	 * with perhaps a sysctl to turn algoritms off (or have them off

   364 	 * by default) on cards that generally suck like the hifn.

   365 	 */

   366 	*nids = NULL;

   367 	return (0);

   368 }

   369 

   370 static int

   371 cryptodev_cipher(EVP_CIPHER_CTX *ctx, unsigned char *out,

   372     const unsigned char *in, unsigned int inl)

   373 {

   374 	struct crypt_op cryp;

   375 	struct dev_crypto_state *state = ctx->cipher_data;

   376 	struct session_op *sess = &state->d_sess;

   377 	void *iiv;

   378 	unsigned char save_iv[EVP_MAX_IV_LENGTH];

   379 

   380 	if (state->d_fd < 0)

   381 		return (0);

   382 	if (!inl)

   383 		return (1);

   384 	if ((inl % ctx->cipher->block_size) != 0)

   385 		return (0);

   386 

   387 	memset(&cryp, 0, sizeof(cryp));

   388 

   389 	cryp.ses = sess->ses;

   390 	cryp.flags = 0;

   391 	cryp.len = inl;

   392 	cryp.src = (caddr_t) in;

   393 	cryp.dst = (caddr_t) out;

   394 	cryp.mac = 0;

   395 

   396 	cryp.op = ctx->encrypt ? COP_ENCRYPT : COP_DECRYPT;

   397 

   398 	if (ctx->cipher->iv_len) {

   399 		cryp.iv = (caddr_t) ctx->iv;

   400 		if (!ctx->encrypt) {

   401 			iiv = (void *) in + inl - ctx->cipher->iv_len;

   402 			memcpy(save_iv, iiv, ctx->cipher->iv_len);

   403 		}

   404 	} else

   405 		cryp.iv = NULL;

   406 

   407 	if (ioctl(state->d_fd, CIOCCRYPT, &cryp) == -1) {

   408 		/* XXX need better errror handling

   409 		 * this can fail for a number of different reasons.

   410 		 */

   411 		return (0);

   412 	}

   413 

   414 	if (ctx->cipher->iv_len) {

   415 		if (ctx->encrypt)

   416 			iiv = (void *) out + inl - ctx->cipher->iv_len;

   417 		else

   418 			iiv = save_iv;

   419 		memcpy(ctx->iv, iiv, ctx->cipher->iv_len);

   420 	}

   421 	return (1);

   422 }

   423 

   424 static int

   425 cryptodev_init_key(EVP_CIPHER_CTX *ctx, const unsigned char *key,

   426     const unsigned char *iv, int enc)

   427 {

   428 	struct dev_crypto_state *state = ctx->cipher_data;

   429 	struct session_op *sess = &state->d_sess;

   430 	int cipher;

   431 

   432 	if ((cipher = cipher_nid_to_cryptodev(ctx->cipher->nid)) == NID_undef)

   433 		return (0);

   434 

   435 	if (ctx->cipher->iv_len > cryptodev_max_iv(cipher))

   436 		return (0);

   437 

   438 	if (!cryptodev_key_length_valid(cipher, ctx->key_len))

   439 		return (0);

   440 

   441 	memset(sess, 0, sizeof(struct session_op));

   442 

   443 	if ((state->d_fd = get_dev_crypto()) < 0)

   444 		return (0);

   445 

   446 	sess->key = (unsigned char *)key;

   447 	sess->keylen = ctx->key_len;

   448 	sess->cipher = cipher;

   449 

   450 	if (ioctl(state->d_fd, CIOCGSESSION, sess) == -1) {

   451 		close(state->d_fd);

   452 		state->d_fd = -1;

   453 		return (0);

   454 	}

   455 	return (1);

   456 }

   457 

   458 /*

   459  * free anything we allocated earlier when initting a

   460  * session, and close the session.

   461  */

   462 static int

   463 cryptodev_cleanup(EVP_CIPHER_CTX *ctx)

   464 {

   465 	int ret = 0;

   466 	struct dev_crypto_state *state = ctx->cipher_data;

   467 	struct session_op *sess = &state->d_sess;

   468 

   469 	if (state->d_fd < 0)

   470 		return (0);

   471 

   472 	/* XXX if this ioctl fails, someting's wrong. the invoker

   473 	 * may have called us with a bogus ctx, or we could

   474 	 * have a device that for whatever reason just doesn't

   475 	 * want to play ball - it's not clear what's right

   476 	 * here - should this be an error? should it just

   477 	 * increase a counter, hmm. For right now, we return

   478 	 * 0 - I don't believe that to be "right". we could

   479 	 * call the gorpy openssl lib error handlers that

   480 	 * print messages to users of the library. hmm..

   481 	 */

   482 

   483 	if (ioctl(state->d_fd, CIOCFSESSION, &sess->ses) == -1) {

   484 		ret = 0;

   485 	} else {

   486 		ret = 1;

   487 	}

   488 	close(state->d_fd);

   489 	state->d_fd = -1;

   490 

   491 	return (ret);

   492 }

   493 

   494 /*

   495  * libcrypto EVP stuff - this is how we get wired to EVP so the engine

   496  * gets called when libcrypto requests a cipher NID.

   497  */

   498 

   499 /* DES CBC EVP */

   500 const EVP_CIPHER cryptodev_des_cbc = {

   501 	NID_des_cbc,

   502 	8, 8, 8,

   503 	EVP_CIPH_CBC_MODE,

   504 	cryptodev_init_key,

   505 	cryptodev_cipher,

   506 	cryptodev_cleanup,

   507 	sizeof(struct dev_crypto_state),

   508 	EVP_CIPHER_set_asn1_iv,

   509 	EVP_CIPHER_get_asn1_iv,

   510 	NULL

   511 };

   512 

   513 /* 3DES CBC EVP */

   514 const EVP_CIPHER cryptodev_3des_cbc = {

   515 	NID_des_ede3_cbc,

   516 	8, 24, 8,

   517 	EVP_CIPH_CBC_MODE,

   518 	cryptodev_init_key,

   519 	cryptodev_cipher,

   520 	cryptodev_cleanup,

   521 	sizeof(struct dev_crypto_state),

   522 	EVP_CIPHER_set_asn1_iv,

   523 	EVP_CIPHER_get_asn1_iv,

   524 	NULL

   525 };

   526 

   527 const EVP_CIPHER cryptodev_bf_cbc = {

   528 	NID_bf_cbc,

   529 	8, 16, 8,

   530 	EVP_CIPH_CBC_MODE,

   531 	cryptodev_init_key,

   532 	cryptodev_cipher,

   533 	cryptodev_cleanup,

   534 	sizeof(struct dev_crypto_state),

   535 	EVP_CIPHER_set_asn1_iv,

   536 	EVP_CIPHER_get_asn1_iv,

   537 	NULL

   538 };

   539 

   540 const EVP_CIPHER cryptodev_cast_cbc = {

   541 	NID_cast5_cbc,

   542 	8, 16, 8,

   543 	EVP_CIPH_CBC_MODE,

   544 	cryptodev_init_key,

   545 	cryptodev_cipher,

   546 	cryptodev_cleanup,

   547 	sizeof(struct dev_crypto_state),

   548 	EVP_CIPHER_set_asn1_iv,

   549 	EVP_CIPHER_get_asn1_iv,

   550 	NULL

   551 };

   552 

   553 const EVP_CIPHER cryptodev_aes_cbc = {

   554 	NID_aes_128_cbc,

   555 	16, 16, 16,

   556 	EVP_CIPH_CBC_MODE,

   557 	cryptodev_init_key,

   558 	cryptodev_cipher,

   559 	cryptodev_cleanup,

   560 	sizeof(struct dev_crypto_state),

   561 	EVP_CIPHER_set_asn1_iv,

   562 	EVP_CIPHER_get_asn1_iv,

   563 	NULL

   564 };

   565 

   566 /*

   567  * Registered by the ENGINE when used to find out how to deal with

   568  * a particular NID in the ENGINE. this says what we'll do at the

   569  * top level - note, that list is restricted by what we answer with

   570  */

   571 static int

   572 cryptodev_engine_ciphers(ENGINE *e, const EVP_CIPHER **cipher,

   573     const int **nids, int nid)

   574 {

   575 	if (!cipher)

   576 		return (cryptodev_usable_ciphers(nids));

   577 

   578 	switch (nid) {

   579 	case NID_des_ede3_cbc:

   580 		*cipher = &cryptodev_3des_cbc;

   581 		break;

   582 	case NID_des_cbc:

   583 		*cipher = &cryptodev_des_cbc;

   584 		break;

   585 	case NID_bf_cbc:

   586 		*cipher = &cryptodev_bf_cbc;

   587 		break;

   588 	case NID_cast5_cbc:

   589 		*cipher = &cryptodev_cast_cbc;

   590 		break;

   591 	case NID_aes_128_cbc:

   592 		*cipher = &cryptodev_aes_cbc;

   593 		break;

   594 	default:

   595 		*cipher = NULL;

   596 		break;

   597 	}

   598 	return (*cipher != NULL);

   599 }

   600 

   601 static int

   602 cryptodev_engine_digests(ENGINE *e, const EVP_MD **digest,

   603     const int **nids, int nid)

   604 {

   605 	if (!digest)

   606 		return (cryptodev_usable_digests(nids));

   607 

   608 	switch (nid) {

   609 	case NID_md5:

   610 		*digest = NULL; /* need to make a clean md5 critter */

   611 		break;

   612 	default:

   613 		*digest = NULL;

   614 		break;

   615 	}

   616 	return (*digest != NULL);

   617 }

   618 

   619 /*

   620  * Convert a BIGNUM to the representation that /dev/crypto needs.

   621  * Upon completion of use, the caller is responsible for freeing

   622  * crp->crp_p.

   623  */

   624 static int

   625 bn2crparam(const BIGNUM *a, struct crparam *crp)

   626 {

   627 	int i, j, k;

   628 	ssize_t words, bytes, bits;

   629 	u_char *b;

   630 

   631 	crp->crp_p = NULL;

   632 	crp->crp_nbits = 0;

   633 

   634 	bits = BN_num_bits(a);

   635 	bytes = (bits + 7) / 8;

   636 

   637 	b = malloc(bytes);

   638 	if (b == NULL)

   639 		return (1);

   640 

   641 	crp->crp_p = b;

   642 	crp->crp_nbits = bits;

   643 

   644 	for (i = 0, j = 0; i < a->top; i++) {

   645 		for (k = 0; k < BN_BITS2 / 8; k++) {

   646 			if ((j + k) >= bytes)

   647 				return (0);

   648 			b[j + k] = a->d[i] >> (k * 8);

   649 		}

   650 		j += BN_BITS2 / 8;

   651 	}

   652 	return (0);

   653 }

   654 

   655 /* Convert a /dev/crypto parameter to a BIGNUM */

   656 static int

   657 crparam2bn(struct crparam *crp, BIGNUM *a)

   658 {

   659 	u_int8_t *pd;

   660 	int i, bytes;

   661 

   662 	bytes = (crp->crp_nbits + 7) / 8;

   663 

   664 	if (bytes == 0)

   665 		return (-1);

   666 

   667 	if ((pd = (u_int8_t *) malloc(bytes)) == NULL)

   668 		return (-1);

   669 

   670 	for (i = 0; i < bytes; i++)

   671 		pd[i] = crp->crp_p[bytes - i - 1];

   672 

   673 	BN_bin2bn(pd, bytes, a);

   674 	free(pd);

   675 

   676 	return (0);

   677 }

   678 

   679 static void

   680 zapparams(struct crypt_kop *kop)

   681 {

   682 	int i;

   683 

   684 	for (i = 0; i <= kop->crk_iparams + kop->crk_oparams; i++) {

   685 		if (kop->crk_param[i].crp_p)

   686 			free(kop->crk_param[i].crp_p);

   687 		kop->crk_param[i].crp_p = NULL;

   688 		kop->crk_param[i].crp_nbits = 0;

   689 	}

   690 }

   691 

   692 static int

   693 cryptodev_asym(struct crypt_kop *kop, int rlen, BIGNUM *r, int slen, BIGNUM *s)

   694 {

   695 	int fd, ret = -1;

   696 

   697 	if ((fd = get_asym_dev_crypto()) < 0)

   698 		return (ret);

   699 

   700 	if (r) {

   701 		kop->crk_param[kop->crk_iparams].crp_p = calloc(rlen, sizeof(char));

   702 		kop->crk_param[kop->crk_iparams].crp_nbits = rlen * 8;

   703 		kop->crk_oparams++;

   704 	}

   705 	if (s) {

   706 		kop->crk_param[kop->crk_iparams+1].crp_p = calloc(slen, sizeof(char));

   707 		kop->crk_param[kop->crk_iparams+1].crp_nbits = slen * 8;

   708 		kop->crk_oparams++;

   709 	}

   710 

   711 	if (ioctl(fd, CIOCKEY, kop) == 0) {

   712 		if (r)

   713 			crparam2bn(&kop->crk_param[kop->crk_iparams], r);

   714 		if (s)

   715 			crparam2bn(&kop->crk_param[kop->crk_iparams+1], s);

   716 		ret = 0;

   717 	}

   718 

   719 	return (ret);

   720 }

   721 

   722 static int

   723 cryptodev_bn_mod_exp(BIGNUM *r, const BIGNUM *a, const BIGNUM *p,

   724     const BIGNUM *m, BN_CTX *ctx, BN_MONT_CTX *in_mont)

   725 {

   726 	struct crypt_kop kop;

   727 	int ret = 1;

   728 

   729 	/* Currently, we know we can do mod exp iff we can do any

   730 	 * asymmetric operations at all.

   731 	 */

   732 	if (cryptodev_asymfeat == 0) {

   733 		ret = BN_mod_exp(r, a, p, m, ctx);

   734 		return (ret);

   735 	}

   736 

   737 	memset(&kop, 0, sizeof kop);

   738 	kop.crk_op = CRK_MOD_EXP;

   739 

   740 	/* inputs: a^p % m */

   741 	if (bn2crparam(a, &kop.crk_param[0]))

   742 		goto err;

   743 	if (bn2crparam(p, &kop.crk_param[1]))

   744 		goto err;

   745 	if (bn2crparam(m, &kop.crk_param[2]))

   746 		goto err;

   747 	kop.crk_iparams = 3;

   748 

   749 	if (cryptodev_asym(&kop, BN_num_bytes(m), r, 0, NULL) == -1) {

   750 		const RSA_METHOD *meth = RSA_PKCS1_SSLeay();

   751 		ret = meth->bn_mod_exp(r, a, p, m, ctx, in_mont);

   752 	}

   753 err:

   754 	zapparams(&kop);

   755 	return (ret);

   756 }

   757 

   758 static int

   759 cryptodev_rsa_nocrt_mod_exp(BIGNUM *r0, const BIGNUM *I, RSA *rsa)

   760 {

   761 	int r;

   762 	BN_CTX *ctx;

   763 

   764 	ctx = BN_CTX_new();

   765 	r = cryptodev_bn_mod_exp(r0, I, rsa->d, rsa->n, ctx, NULL);

   766 	BN_CTX_free(ctx);

   767 	return (r);

   768 }

   769 

   770 static int

   771 cryptodev_rsa_mod_exp(BIGNUM *r0, const BIGNUM *I, RSA *rsa, BN_CTX *ctx)

   772 {

   773 	struct crypt_kop kop;

   774 	int ret = 1;

   775 

   776 	if (!rsa->p || !rsa->q || !rsa->dmp1 || !rsa->dmq1 || !rsa->iqmp) {

   777 		/* XXX 0 means failure?? */

   778 		return (0);

   779 	}

   780 

   781 	memset(&kop, 0, sizeof kop);

   782 	kop.crk_op = CRK_MOD_EXP_CRT;

   783 	/* inputs: rsa->p rsa->q I rsa->dmp1 rsa->dmq1 rsa->iqmp */

   784 	if (bn2crparam(rsa->p, &kop.crk_param[0]))

   785 		goto err;

   786 	if (bn2crparam(rsa->q, &kop.crk_param[1]))

   787 		goto err;

   788 	if (bn2crparam(I, &kop.crk_param[2]))

   789 		goto err;

   790 	if (bn2crparam(rsa->dmp1, &kop.crk_param[3]))

   791 		goto err;

   792 	if (bn2crparam(rsa->dmq1, &kop.crk_param[4]))

   793 		goto err;

   794 	if (bn2crparam(rsa->iqmp, &kop.crk_param[5]))

   795 		goto err;

   796 	kop.crk_iparams = 6;

   797 

   798 	if (cryptodev_asym(&kop, BN_num_bytes(rsa->n), r0, 0, NULL) == -1) {

   799 		const RSA_METHOD *meth = RSA_PKCS1_SSLeay();

   800 		ret = (*meth->rsa_mod_exp)(r0, I, rsa, ctx);

   801 	}

   802 err:

   803 	zapparams(&kop);

   804 	return (ret);

   805 }

   806 

   807 static RSA_METHOD cryptodev_rsa = {

   808 	"cryptodev RSA method",

   809 	NULL,				/* rsa_pub_enc */

   810 	NULL,				/* rsa_pub_dec */

   811 	NULL,				/* rsa_priv_enc */

   812 	NULL,				/* rsa_priv_dec */

   813 	NULL,

   814 	NULL,

   815 	NULL,				/* init */

   816 	NULL,				/* finish */

   817 	0,				/* flags */

   818 	NULL,				/* app_data */

   819 	NULL,				/* rsa_sign */

   820 	NULL				/* rsa_verify */

   821 };

   822 

   823 static int

   824 cryptodev_dsa_bn_mod_exp(DSA *dsa, BIGNUM *r, BIGNUM *a, const BIGNUM *p,

   825     const BIGNUM *m, BN_CTX *ctx, BN_MONT_CTX *m_ctx)

   826 {

   827 	return (cryptodev_bn_mod_exp(r, a, p, m, ctx, m_ctx));

   828 }

   829 

   830 static int

   831 cryptodev_dsa_dsa_mod_exp(DSA *dsa, BIGNUM *t1, BIGNUM *g,

   832     BIGNUM *u1, BIGNUM *pub_key, BIGNUM *u2, BIGNUM *p,

   833     BN_CTX *ctx, BN_MONT_CTX *mont)

   834 {

   835 	BIGNUM t2;

   836 	int ret = 0;

   837 

   838 	BN_init(&t2);

   839 

   840 	/* v = ( g^u1 * y^u2 mod p ) mod q */

   841 	/* let t1 = g ^ u1 mod p */

   842 	ret = 0;

   843 

   844 	if (!dsa->meth->bn_mod_exp(dsa,t1,dsa->g,u1,dsa->p,ctx,mont))

   845 		goto err;

   846 

   847 	/* let t2 = y ^ u2 mod p */

   848 	if (!dsa->meth->bn_mod_exp(dsa,&t2,dsa->pub_key,u2,dsa->p,ctx,mont))

   849 		goto err;

   850 	/* let u1 = t1 * t2 mod p */

   851 	if (!BN_mod_mul(u1,t1,&t2,dsa->p,ctx))

   852 		goto err;

   853 

   854 	BN_copy(t1,u1);

   855 

   856 	ret = 1;

   857 err:

   858 	BN_free(&t2);

   859 	return(ret);

   860 }

   861 

   862 static DSA_SIG *

   863 cryptodev_dsa_do_sign(const unsigned char *dgst, int dlen, DSA *dsa)

   864 {

   865 	struct crypt_kop kop;

   866 	BIGNUM *r = NULL, *s = NULL;

   867 	DSA_SIG *dsaret = NULL;

   868 

   869 	if ((r = BN_new()) == NULL)

   870 		goto err;

   871 	if ((s = BN_new()) == NULL) {

   872 		BN_free(r);

   873 		goto err;

   874 	}

   875 

   876 	memset(&kop, 0, sizeof kop);

   877 	kop.crk_op = CRK_DSA_SIGN;

   878 

   879 	/* inputs: dgst dsa->p dsa->q dsa->g dsa->priv_key */

   880 	kop.crk_param[0].crp_p = (caddr_t)dgst;

   881 	kop.crk_param[0].crp_nbits = dlen * 8;

   882 	if (bn2crparam(dsa->p, &kop.crk_param[1]))

   883 		goto err;

   884 	if (bn2crparam(dsa->q, &kop.crk_param[2]))

   885 		goto err;

   886 	if (bn2crparam(dsa->g, &kop.crk_param[3]))

   887 		goto err;

   888 	if (bn2crparam(dsa->priv_key, &kop.crk_param[4]))

   889 		goto err;

   890 	kop.crk_iparams = 5;

   891 

   892 	if (cryptodev_asym(&kop, BN_num_bytes(dsa->q), r,

   893 	    BN_num_bytes(dsa->q), s) == 0) {

   894 		dsaret = DSA_SIG_new();

   895 		dsaret->r = r;

   896 		dsaret->s = s;

   897 	} else {

   898 		const DSA_METHOD *meth = DSA_OpenSSL();

   899 		BN_free(r);

   900 		BN_free(s);

   901 		dsaret = (meth->dsa_do_sign)(dgst, dlen, dsa);

   902 	}

   903 err:

   904 	kop.crk_param[0].crp_p = NULL;

   905 	zapparams(&kop);

   906 	return (dsaret);

   907 }

   908 

   909 static int

   910 cryptodev_dsa_verify(const unsigned char *dgst, int dlen,

   911     DSA_SIG *sig, DSA *dsa)

   912 {

   913 	struct crypt_kop kop;

   914 	int dsaret = 1;

   915 

   916 	memset(&kop, 0, sizeof kop);

   917 	kop.crk_op = CRK_DSA_VERIFY;

   918 

   919 	/* inputs: dgst dsa->p dsa->q dsa->g dsa->pub_key sig->r sig->s */

   920 	kop.crk_param[0].crp_p = (caddr_t)dgst;

   921 	kop.crk_param[0].crp_nbits = dlen * 8;

   922 	if (bn2crparam(dsa->p, &kop.crk_param[1]))

   923 		goto err;

   924 	if (bn2crparam(dsa->q, &kop.crk_param[2]))

   925 		goto err;

   926 	if (bn2crparam(dsa->g, &kop.crk_param[3]))

   927 		goto err;

   928 	if (bn2crparam(dsa->pub_key, &kop.crk_param[4]))

   929 		goto err;

   930 	if (bn2crparam(sig->r, &kop.crk_param[5]))

   931 		goto err;

   932 	if (bn2crparam(sig->s, &kop.crk_param[6]))

   933 		goto err;

   934 	kop.crk_iparams = 7;

   935 

   936 	if (cryptodev_asym(&kop, 0, NULL, 0, NULL) == 0) {

   937 		dsaret = kop.crk_status;

   938 	} else {

   939 		const DSA_METHOD *meth = DSA_OpenSSL();

   940 

   941 		dsaret = (meth->dsa_do_verify)(dgst, dlen, sig, dsa);

   942 	}

   943 err:

   944 	kop.crk_param[0].crp_p = NULL;

   945 	zapparams(&kop);

   946 	return (dsaret);

   947 }

   948 

   949 static DSA_METHOD cryptodev_dsa = {

   950 	"cryptodev DSA method",

   951 	NULL,

   952 	NULL,				/* dsa_sign_setup */

   953 	NULL,

   954 	NULL,				/* dsa_mod_exp */

   955 	NULL,

   956 	NULL,				/* init */

   957 	NULL,				/* finish */

   958 	0,	/* flags */

   959 	NULL	/* app_data */

   960 };

   961 

   962 static int

   963 cryptodev_mod_exp_dh(const DH *dh, BIGNUM *r, const BIGNUM *a,

   964     const BIGNUM *p, const BIGNUM *m, BN_CTX *ctx,

   965     BN_MONT_CTX *m_ctx)

   966 {

   967 	return (cryptodev_bn_mod_exp(r, a, p, m, ctx, m_ctx));

   968 }

   969 

   970 static int

   971 cryptodev_dh_compute_key(unsigned char *key, const BIGNUM *pub_key, DH *dh)

   972 {

   973 	struct crypt_kop kop;

   974 	int dhret = 1;

   975 	int fd, keylen;

   976 

   977 	if ((fd = get_asym_dev_crypto()) < 0) {

   978 		const DH_METHOD *meth = DH_OpenSSL();

   979 

   980 		return ((meth->compute_key)(key, pub_key, dh));

   981 	}

   982 

   983 	keylen = BN_num_bits(dh->p);

   984 

   985 	memset(&kop, 0, sizeof kop);

   986 	kop.crk_op = CRK_DH_COMPUTE_KEY;

   987 

   988 	/* inputs: dh->priv_key pub_key dh->p key */

   989 	if (bn2crparam(dh->priv_key, &kop.crk_param[0]))

   990 		goto err;

   991 	if (bn2crparam(pub_key, &kop.crk_param[1]))

   992 		goto err;

   993 	if (bn2crparam(dh->p, &kop.crk_param[2]))

   994 		goto err;

   995 	kop.crk_iparams = 3;

   996 

   997 	kop.crk_param[3].crp_p = key;

   998 	kop.crk_param[3].crp_nbits = keylen * 8;

   999 	kop.crk_oparams = 1;

  1000 

  1001 	if (ioctl(fd, CIOCKEY, &kop) == -1) {

  1002 		const DH_METHOD *meth = DH_OpenSSL();

  1003 

  1004 		dhret = (meth->compute_key)(key, pub_key, dh);

  1005 	}

  1006 err:

  1007 	kop.crk_param[3].crp_p = NULL;

  1008 	zapparams(&kop);

  1009 	return (dhret);

  1010 }

  1011 

  1012 static DH_METHOD cryptodev_dh = {

  1013 	"cryptodev DH method",

  1014 	NULL,				/* cryptodev_dh_generate_key */

  1015 	NULL,

  1016 	NULL,

  1017 	NULL,

  1018 	NULL,

  1019 	0,	/* flags */

  1020 	NULL	/* app_data */

  1021 };

  1022 

  1023 /*

  1024  * ctrl right now is just a wrapper that doesn't do much

  1025  * but I expect we'll want some options soon.

  1026  */

  1027 static int

  1028 cryptodev_ctrl(ENGINE *e, int cmd, long i, void *p, void (*f)())

  1029 {

  1030 #ifdef HAVE_SYSLOG_R

  1031 	struct syslog_data sd = SYSLOG_DATA_INIT;

  1032 #endif

  1033 

  1034 	switch (cmd) {

  1035 	default:

  1036 #ifdef HAVE_SYSLOG_R

  1037 		syslog_r(LOG_ERR, &sd,

  1038 		    "cryptodev_ctrl: unknown command %d", cmd);

  1039 #else

  1040 		syslog(LOG_ERR, "cryptodev_ctrl: unknown command %d", cmd);

  1041 #endif

  1042 		break;

  1043 	}

  1044 	return (1);

  1045 }

  1046 

  1047 EXPORT_C void

  1048 ENGINE_load_cryptodev(void)

  1049 {

  1050 	ENGINE *engine = ENGINE_new();

  1051 	int fd;

  1052 

  1053 	if (engine == NULL)

  1054 		return;

  1055 	if ((fd = get_dev_crypto()) < 0) {

  1056 		ENGINE_free(engine);

  1057 		return;

  1058 	}

  1059 

  1060 	/*

  1061 	 * find out what asymmetric crypto algorithms we support

  1062 	 */

  1063 	if (ioctl(fd, CIOCASYMFEAT, &cryptodev_asymfeat) == -1) {

  1064 		close(fd);

  1065 		ENGINE_free(engine);

  1066 		return;

  1067 	}

  1068 	close(fd);

  1069 

  1070 	if (!ENGINE_set_id(engine, "cryptodev") ||

  1071 	    !ENGINE_set_name(engine, "BSD cryptodev engine") ||

  1072 	    !ENGINE_set_ciphers(engine, cryptodev_engine_ciphers) ||

  1073 	    !ENGINE_set_digests(engine, cryptodev_engine_digests) ||

  1074 	    !ENGINE_set_ctrl_function(engine, cryptodev_ctrl) ||

  1075 	    !ENGINE_set_cmd_defns(engine, cryptodev_defns)) {

  1076 		ENGINE_free(engine);

  1077 		return;

  1078 	}

  1079 

  1080 	if (ENGINE_set_RSA(engine, &cryptodev_rsa)) {

  1081 		const RSA_METHOD *rsa_meth = RSA_PKCS1_SSLeay();

  1082 

  1083 		cryptodev_rsa.bn_mod_exp = rsa_meth->bn_mod_exp;

  1084 		cryptodev_rsa.rsa_mod_exp = rsa_meth->rsa_mod_exp;

  1085 		cryptodev_rsa.rsa_pub_enc = rsa_meth->rsa_pub_enc;

  1086 		cryptodev_rsa.rsa_pub_dec = rsa_meth->rsa_pub_dec;

  1087 		cryptodev_rsa.rsa_priv_enc = rsa_meth->rsa_priv_enc;

  1088 		cryptodev_rsa.rsa_priv_dec = rsa_meth->rsa_priv_dec;

  1089 		if (cryptodev_asymfeat & CRF_MOD_EXP) {

  1090 			cryptodev_rsa.bn_mod_exp = cryptodev_bn_mod_exp;

  1091 			if (cryptodev_asymfeat & CRF_MOD_EXP_CRT)

  1092 				cryptodev_rsa.rsa_mod_exp =

  1093 				    cryptodev_rsa_mod_exp;

  1094 			else

  1095 				cryptodev_rsa.rsa_mod_exp =

  1096 				    cryptodev_rsa_nocrt_mod_exp;

  1097 		}

  1098 	}

  1099 

  1100 	if (ENGINE_set_DSA(engine, &cryptodev_dsa)) {

  1101 		const DSA_METHOD *meth = DSA_OpenSSL();

  1102 

  1103 		memcpy(&cryptodev_dsa, meth, sizeof(DSA_METHOD));

  1104 		if (cryptodev_asymfeat & CRF_DSA_SIGN)

  1105 			cryptodev_dsa.dsa_do_sign = cryptodev_dsa_do_sign;

  1106 		if (cryptodev_asymfeat & CRF_MOD_EXP) {

  1107 			cryptodev_dsa.bn_mod_exp = cryptodev_dsa_bn_mod_exp;

  1108 			cryptodev_dsa.dsa_mod_exp = cryptodev_dsa_dsa_mod_exp;

  1109 		}

  1110 		if (cryptodev_asymfeat & CRF_DSA_VERIFY)

  1111 			cryptodev_dsa.dsa_do_verify = cryptodev_dsa_verify;

  1112 	}

  1113 

  1114 	if (ENGINE_set_DH(engine, &cryptodev_dh)){

  1115 		const DH_METHOD *dh_meth = DH_OpenSSL();

  1116 

  1117 		cryptodev_dh.generate_key = dh_meth->generate_key;

  1118 		cryptodev_dh.compute_key = dh_meth->compute_key;

  1119 		cryptodev_dh.bn_mod_exp = dh_meth->bn_mod_exp;

  1120 		if (cryptodev_asymfeat & CRF_MOD_EXP) {

  1121 			cryptodev_dh.bn_mod_exp = cryptodev_mod_exp_dh;

  1122 			if (cryptodev_asymfeat & CRF_DH_COMPUTE_KEY)

  1123 				cryptodev_dh.compute_key =

  1124 				    cryptodev_dh_compute_key;

  1125 		}

  1126 	}

  1127 

  1128 	ENGINE_add(engine);

  1129 	ENGINE_free(engine);

  1130 	ERR_clear_error();

  1131 }

  1132 

  1133 #endif /* HAVE_CRYPTODEV */