Head

GCC Code Coverage Report

Directory:	./		Exec	Total	Coverage
File:	usr.bin/ssh/ssh-pkcs11-helper/../ssh-pkcs11.c	Lines:	0	323	0.0 %
Date:	2017-11-07	Branches:	0	188	0.0 %


/* $OpenBSD: ssh-pkcs11.c,v 1.25 2017/05/31 09:15:42 deraadt Exp $ */
/*
 * Copyright (c) 2010 Markus Friedl.  All rights reserved.
 *
 * Permission to use, copy, modify, and distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

#include <sys/types.h>
#include <sys/queue.h>
#include <stdarg.h>
#include <stdio.h>

#include <string.h>
#include <dlfcn.h>

#include <openssl/x509.h>

#define CRYPTOKI_COMPAT
#include "pkcs11.h"

#include "log.h"
#include "misc.h"
#include "sshkey.h"
#include "ssh-pkcs11.h"
#include "xmalloc.h"

struct pkcs11_slotinfo {
	CK_TOKEN_INFO		token;
	CK_SESSION_HANDLE	session;
	int			logged_in;
};

struct pkcs11_provider {
	char			*name;
	void			*handle;
	CK_FUNCTION_LIST	*function_list;
	CK_INFO			info;
	CK_ULONG		nslots;
	CK_SLOT_ID		*slotlist;
	struct pkcs11_slotinfo	*slotinfo;
	int			valid;
	int			refcount;
	TAILQ_ENTRY(pkcs11_provider) next;
};

TAILQ_HEAD(, pkcs11_provider) pkcs11_providers;

struct pkcs11_key {
	struct pkcs11_provider	*provider;
	CK_ULONG		slotidx;
	int			(*orig_finish)(RSA *rsa);
	RSA_METHOD		rsa_method;
	char			*keyid;
	int			keyid_len;
};

int pkcs11_interactive = 0;

int
pkcs11_init(int interactive)
{
	pkcs11_interactive = interactive;
	TAILQ_INIT(&pkcs11_providers);
	return (0);
}

/*
 * finalize a provider shared libarary, it's no longer usable.
 * however, there might still be keys referencing this provider,
 * so the actuall freeing of memory is handled by pkcs11_provider_unref().
 * this is called when a provider gets unregistered.
 */
static void
pkcs11_provider_finalize(struct pkcs11_provider *p)
{
	CK_RV rv;
	CK_ULONG i;

	debug("pkcs11_provider_finalize: %p refcount %d valid %d",
	    p, p->refcount, p->valid);
	if (!p->valid)
		return;
	for (i = 0; i < p->nslots; i++) {
		if (p->slotinfo[i].session &&
		    (rv = p->function_list->C_CloseSession(
		    p->slotinfo[i].session)) != CKR_OK)
			error("C_CloseSession failed: %lu", rv);
	}
	if ((rv = p->function_list->C_Finalize(NULL)) != CKR_OK)
		error("C_Finalize failed: %lu", rv);
	p->valid = 0;
	p->function_list = NULL;
#ifdef HAVE_DLOPEN
	dlclose(p->handle);
#endif
}

/*
 * remove a reference to the provider.
 * called when a key gets destroyed or when the provider is unregistered.
 */
static void
pkcs11_provider_unref(struct pkcs11_provider *p)
{
	debug("pkcs11_provider_unref: %p refcount %d", p, p->refcount);
	if (--p->refcount <= 0) {
		if (p->valid)
			error("pkcs11_provider_unref: %p still valid", p);
		free(p->slotlist);
		free(p->slotinfo);
		free(p);
	}
}

/* unregister all providers, keys might still point to the providers */
void
pkcs11_terminate(void)
{
	struct pkcs11_provider *p;

	while ((p = TAILQ_FIRST(&pkcs11_providers)) != NULL) {
		TAILQ_REMOVE(&pkcs11_providers, p, next);
		pkcs11_provider_finalize(p);
		pkcs11_provider_unref(p);
	}
}

/* lookup provider by name */
static struct pkcs11_provider *
pkcs11_provider_lookup(char *provider_id)
{
	struct pkcs11_provider *p;

	TAILQ_FOREACH(p, &pkcs11_providers, next) {
		debug("check %p %s", p, p->name);
		if (!strcmp(provider_id, p->name))
			return (p);
	}
	return (NULL);
}

/* unregister provider by name */
int
pkcs11_del_provider(char *provider_id)
{
	struct pkcs11_provider *p;

	if ((p = pkcs11_provider_lookup(provider_id)) != NULL) {
		TAILQ_REMOVE(&pkcs11_providers, p, next);
		pkcs11_provider_finalize(p);
		pkcs11_provider_unref(p);
		return (0);
	}
	return (-1);
}

/* openssl callback for freeing an RSA key */
static int
pkcs11_rsa_finish(RSA *rsa)
{
	struct pkcs11_key	*k11;
	int rv = -1;

	if ((k11 = RSA_get_app_data(rsa)) != NULL) {
		if (k11->orig_finish)
			rv = k11->orig_finish(rsa);
		if (k11->provider)
			pkcs11_provider_unref(k11->provider);
		free(k11->keyid);
		free(k11);
	}
	return (rv);
}

/* find a single 'obj' for given attributes */
static int
pkcs11_find(struct pkcs11_provider *p, CK_ULONG slotidx, CK_ATTRIBUTE *attr,
    CK_ULONG nattr, CK_OBJECT_HANDLE *obj)
{
	CK_FUNCTION_LIST	*f;
	CK_SESSION_HANDLE	session;
	CK_ULONG		nfound = 0;
	CK_RV			rv;
	int			ret = -1;

	f = p->function_list;
	session = p->slotinfo[slotidx].session;
	if ((rv = f->C_FindObjectsInit(session, attr, nattr)) != CKR_OK) {
		error("C_FindObjectsInit failed (nattr %lu): %lu", nattr, rv);
		return (-1);
	}
	if ((rv = f->C_FindObjects(session, obj, 1, &nfound)) != CKR_OK ||
	    nfound != 1) {
		debug("C_FindObjects failed (nfound %lu nattr %lu): %lu",
		    nfound, nattr, rv);
	} else
		ret = 0;
	if ((rv = f->C_FindObjectsFinal(session)) != CKR_OK)
		error("C_FindObjectsFinal failed: %lu", rv);
	return (ret);
}

/* openssl callback doing the actual signing operation */
static int
pkcs11_rsa_private_encrypt(int flen, const u_char *from, u_char *to, RSA *rsa,
    int padding)
{
	struct pkcs11_key	*k11;
	struct pkcs11_slotinfo	*si;
	CK_FUNCTION_LIST	*f;
	CK_OBJECT_HANDLE	obj;
	CK_ULONG		tlen = 0;
	CK_RV			rv;
	CK_OBJECT_CLASS		private_key_class = CKO_PRIVATE_KEY;
	CK_BBOOL		true_val = CK_TRUE;
	CK_MECHANISM		mech = {
		CKM_RSA_PKCS, NULL_PTR, 0
	};
	CK_ATTRIBUTE		key_filter[] = {
		{CKA_CLASS, &private_key_class, sizeof(private_key_class) },
		{CKA_ID, NULL, 0},
		{CKA_SIGN, &true_val, sizeof(true_val) }
	};
	char			*pin = NULL, prompt[1024];
	int			rval = -1;

	if ((k11 = RSA_get_app_data(rsa)) == NULL) {
		error("RSA_get_app_data failed for rsa %p", rsa);
		return (-1);
	}
	if (!k11->provider || !k11->provider->valid) {
		error("no pkcs11 (valid) provider for rsa %p", rsa);
		return (-1);
	}
	f = k11->provider->function_list;
	si = &k11->provider->slotinfo[k11->slotidx];
	if ((si->token.flags & CKF_LOGIN_REQUIRED) && !si->logged_in) {
		if (!pkcs11_interactive) {
			error("need pin entry%s", (si->token.flags &
			    CKF_PROTECTED_AUTHENTICATION_PATH) ?
			    " on reader keypad" : "");
			return (-1);
		}
		if (si->token.flags & CKF_PROTECTED_AUTHENTICATION_PATH)
			verbose("Deferring PIN entry to reader keypad.");
		else {
			snprintf(prompt, sizeof(prompt),
			    "Enter PIN for '%s': ", si->token.label);
			pin = read_passphrase(prompt, RP_ALLOW_EOF);
			if (pin == NULL)
				return (-1);	/* bail out */
		}
		rv = f->C_Login(si->session, CKU_USER, (u_char *)pin,
		    (pin != NULL) ? strlen(pin) : 0);
		if (pin != NULL) {
			explicit_bzero(pin, strlen(pin));
			free(pin);
		}
		if (rv != CKR_OK && rv != CKR_USER_ALREADY_LOGGED_IN) {
			error("C_Login failed: %lu", rv);
			return (-1);
		}
		si->logged_in = 1;
	}
	key_filter[1].pValue = k11->keyid;
	key_filter[1].ulValueLen = k11->keyid_len;
	/* try to find object w/CKA_SIGN first, retry w/o */
	if (pkcs11_find(k11->provider, k11->slotidx, key_filter, 3, &obj) < 0 &&
	    pkcs11_find(k11->provider, k11->slotidx, key_filter, 2, &obj) < 0) {
		error("cannot find private key");
	} else if ((rv = f->C_SignInit(si->session, &mech, obj)) != CKR_OK) {
		error("C_SignInit failed: %lu", rv);
	} else {
		/* XXX handle CKR_BUFFER_TOO_SMALL */
		tlen = RSA_size(rsa);
		rv = f->C_Sign(si->session, (CK_BYTE *)from, flen, to, &tlen);
		if (rv == CKR_OK)
			rval = tlen;
		else
			error("C_Sign failed: %lu", rv);
	}
	return (rval);
}

static int
pkcs11_rsa_private_decrypt(int flen, const u_char *from, u_char *to, RSA *rsa,
    int padding)
{
	return (-1);
}

/* redirect private key operations for rsa key to pkcs11 token */
static int
pkcs11_rsa_wrap(struct pkcs11_provider *provider, CK_ULONG slotidx,
    CK_ATTRIBUTE *keyid_attrib, RSA *rsa)
{
	struct pkcs11_key	*k11;
	const RSA_METHOD	*def = RSA_get_default_method();

	k11 = xcalloc(1, sizeof(*k11));
	k11->provider = provider;
	provider->refcount++;	/* provider referenced by RSA key */
	k11->slotidx = slotidx;
	/* identify key object on smartcard */
	k11->keyid_len = keyid_attrib->ulValueLen;
	if (k11->keyid_len > 0) {
		k11->keyid = xmalloc(k11->keyid_len);
		memcpy(k11->keyid, keyid_attrib->pValue, k11->keyid_len);
	}
	k11->orig_finish = def->finish;
	memcpy(&k11->rsa_method, def, sizeof(k11->rsa_method));
	k11->rsa_method.name = "pkcs11";
	k11->rsa_method.rsa_priv_enc = pkcs11_rsa_private_encrypt;
	k11->rsa_method.rsa_priv_dec = pkcs11_rsa_private_decrypt;
	k11->rsa_method.finish = pkcs11_rsa_finish;
	RSA_set_method(rsa, &k11->rsa_method);
	RSA_set_app_data(rsa, k11);
	return (0);
}

/* remove trailing spaces */
static void
rmspace(u_char *buf, size_t len)
{
	size_t i;

	if (!len)
		return;
	for (i = len - 1;  i > 0; i--)
		if (i == len - 1 || buf[i] == ' ')
			buf[i] = '\0';
		else
			break;
}

/*
 * open a pkcs11 session and login if required.
 * if pin == NULL we delay login until key use
 */
static int
pkcs11_open_session(struct pkcs11_provider *p, CK_ULONG slotidx, char *pin)
{
	CK_RV			rv;
	CK_FUNCTION_LIST	*f;
	CK_SESSION_HANDLE	session;
	int			login_required;

	f = p->function_list;
	login_required = p->slotinfo[slotidx].token.flags & CKF_LOGIN_REQUIRED;
	if (pin && login_required && !strlen(pin)) {
		error("pin required");
		return (-1);
	}
	if ((rv = f->C_OpenSession(p->slotlist[slotidx], CKF_RW_SESSION|
	    CKF_SERIAL_SESSION, NULL, NULL, &session))
	    != CKR_OK) {
		error("C_OpenSession failed: %lu", rv);
		return (-1);
	}
	if (login_required && pin) {
		rv = f->C_Login(session, CKU_USER,
		    (u_char *)pin, strlen(pin));
		if (rv != CKR_OK && rv != CKR_USER_ALREADY_LOGGED_IN) {
			error("C_Login failed: %lu", rv);
			if ((rv = f->C_CloseSession(session)) != CKR_OK)
				error("C_CloseSession failed: %lu", rv);
			return (-1);
		}
		p->slotinfo[slotidx].logged_in = 1;
	}
	p->slotinfo[slotidx].session = session;
	return (0);
}

/*
 * lookup public keys for token in slot identified by slotidx,
 * add 'wrapped' public keys to the 'keysp' array and increment nkeys.
 * keysp points to an (possibly empty) array with *nkeys keys.
 */
static int pkcs11_fetch_keys_filter(struct pkcs11_provider *, CK_ULONG,
    CK_ATTRIBUTE [], CK_ATTRIBUTE [3], struct sshkey ***, int *)
	__attribute__((__bounded__(__minbytes__,4, 3 * sizeof(CK_ATTRIBUTE))));

static int
pkcs11_fetch_keys(struct pkcs11_provider *p, CK_ULONG slotidx,
    struct sshkey ***keysp, int *nkeys)
{
	CK_OBJECT_CLASS		pubkey_class = CKO_PUBLIC_KEY;
	CK_OBJECT_CLASS		cert_class = CKO_CERTIFICATE;
	CK_ATTRIBUTE		pubkey_filter[] = {
		{ CKA_CLASS, &pubkey_class, sizeof(pubkey_class) }
	};
	CK_ATTRIBUTE		cert_filter[] = {
		{ CKA_CLASS, &cert_class, sizeof(cert_class) }
	};
	CK_ATTRIBUTE		pubkey_attribs[] = {
		{ CKA_ID, NULL, 0 },
		{ CKA_MODULUS, NULL, 0 },
		{ CKA_PUBLIC_EXPONENT, NULL, 0 }
	};
	CK_ATTRIBUTE		cert_attribs[] = {
		{ CKA_ID, NULL, 0 },
		{ CKA_SUBJECT, NULL, 0 },
		{ CKA_VALUE, NULL, 0 }
	};

	if (pkcs11_fetch_keys_filter(p, slotidx, pubkey_filter, pubkey_attribs,
	    keysp, nkeys) < 0 ||
	    pkcs11_fetch_keys_filter(p, slotidx, cert_filter, cert_attribs,
	    keysp, nkeys) < 0)
		return (-1);
	return (0);
}

static int
pkcs11_key_included(struct sshkey ***keysp, int *nkeys, struct sshkey *key)
{
	int i;

	for (i = 0; i < *nkeys; i++)
		if (sshkey_equal(key, (*keysp)[i]))
			return (1);
	return (0);
}

static int
pkcs11_fetch_keys_filter(struct pkcs11_provider *p, CK_ULONG slotidx,
    CK_ATTRIBUTE filter[], CK_ATTRIBUTE attribs[3],
    struct sshkey ***keysp, int *nkeys)
{
	struct sshkey		*key;
	RSA			*rsa;
	X509 			*x509;
	EVP_PKEY		*evp;
	int			i;
	const u_char		*cp;
	CK_RV			rv;
	CK_OBJECT_HANDLE	obj;
	CK_ULONG		nfound;
	CK_SESSION_HANDLE	session;
	CK_FUNCTION_LIST	*f;

	f = p->function_list;
	session = p->slotinfo[slotidx].session;
	/* setup a filter the looks for public keys */
	if ((rv = f->C_FindObjectsInit(session, filter, 1)) != CKR_OK) {
		error("C_FindObjectsInit failed: %lu", rv);
		return (-1);
	}
	while (1) {
		/* XXX 3 attributes in attribs[] */
		for (i = 0; i < 3; i++) {
			attribs[i].pValue = NULL;
			attribs[i].ulValueLen = 0;
		}
		if ((rv = f->C_FindObjects(session, &obj, 1, &nfound)) != CKR_OK
		    || nfound == 0)
			break;
		/* found a key, so figure out size of the attributes */
		if ((rv = f->C_GetAttributeValue(session, obj, attribs, 3))
		    != CKR_OK) {
			error("C_GetAttributeValue failed: %lu", rv);
			continue;
		}
		/*
		 * Allow CKA_ID (always first attribute) to be empty, but
		 * ensure that none of the others are zero length.
		 * XXX assumes CKA_ID is always first.
		 */
		if (attribs[1].ulValueLen == 0 ||
		    attribs[2].ulValueLen == 0) {
			continue;
		}
		/* allocate buffers for attributes */
		for (i = 0; i < 3; i++) {
			if (attribs[i].ulValueLen > 0) {
				attribs[i].pValue = xmalloc(
				    attribs[i].ulValueLen);
			}
		}

		/*
		 * retrieve ID, modulus and public exponent of RSA key,
		 * or ID, subject and value for certificates.
		 */
		rsa = NULL;
		if ((rv = f->C_GetAttributeValue(session, obj, attribs, 3))
		    != CKR_OK) {
			error("C_GetAttributeValue failed: %lu", rv);
		} else if (attribs[1].type == CKA_MODULUS ) {
			if ((rsa = RSA_new()) == NULL) {
				error("RSA_new failed");
			} else {
				rsa->n = BN_bin2bn(attribs[1].pValue,
				    attribs[1].ulValueLen, NULL);
				rsa->e = BN_bin2bn(attribs[2].pValue,
				    attribs[2].ulValueLen, NULL);
			}
		} else {
			cp = attribs[2].pValue;
			if ((x509 = X509_new()) == NULL) {
				error("X509_new failed");
			} else if (d2i_X509(&x509, &cp, attribs[2].ulValueLen)
			    == NULL) {
				error("d2i_X509 failed");
			} else if ((evp = X509_get_pubkey(x509)) == NULL ||
			    evp->type != EVP_PKEY_RSA ||
			    evp->pkey.rsa == NULL) {
				debug("X509_get_pubkey failed or no rsa");
			} else if ((rsa = RSAPublicKey_dup(evp->pkey.rsa))
			    == NULL) {
				error("RSAPublicKey_dup");
			}
			if (x509)
				X509_free(x509);
		}
		if (rsa && rsa->n && rsa->e &&
		    pkcs11_rsa_wrap(p, slotidx, &attribs[0], rsa) == 0) {
			if ((key = sshkey_new(KEY_UNSPEC)) == NULL)
				fatal("sshkey_new failed");
			key->rsa = rsa;
			key->type = KEY_RSA;
			key->flags |= SSHKEY_FLAG_EXT;
			if (pkcs11_key_included(keysp, nkeys, key)) {
				sshkey_free(key);
			} else {
				/* expand key array and add key */
				*keysp = xrecallocarray(*keysp, *nkeys,
				    *nkeys + 1, sizeof(struct sshkey *));
				(*keysp)[*nkeys] = key;
				*nkeys = *nkeys + 1;
				debug("have %d keys", *nkeys);
			}
		} else if (rsa) {
			RSA_free(rsa);
		}
		for (i = 0; i < 3; i++)
			free(attribs[i].pValue);
	}
	if ((rv = f->C_FindObjectsFinal(session)) != CKR_OK)
		error("C_FindObjectsFinal failed: %lu", rv);
	return (0);
}

#ifdef HAVE_DLOPEN
/* register a new provider, fails if provider already exists */
int
pkcs11_add_provider(char *provider_id, char *pin, struct sshkey ***keyp)
{
	int nkeys, need_finalize = 0;
	struct pkcs11_provider *p = NULL;
	void *handle = NULL;
	CK_RV (*getfunctionlist)(CK_FUNCTION_LIST **);
	CK_RV rv;
	CK_FUNCTION_LIST *f = NULL;
	CK_TOKEN_INFO *token;
	CK_ULONG i;

	*keyp = NULL;
	if (pkcs11_provider_lookup(provider_id) != NULL) {
		debug("%s: provider already registered: %s",
		    __func__, provider_id);
		goto fail;
	}
	/* open shared pkcs11-libarary */
	if ((handle = dlopen(provider_id, RTLD_NOW)) == NULL) {
		error("dlopen %s failed: %s", provider_id, dlerror());
		goto fail;
	}
	if ((getfunctionlist = dlsym(handle, "C_GetFunctionList")) == NULL) {
		error("dlsym(C_GetFunctionList) failed: %s", dlerror());
		goto fail;
	}
	p = xcalloc(1, sizeof(*p));
	p->name = xstrdup(provider_id);
	p->handle = handle;
	/* setup the pkcs11 callbacks */
	if ((rv = (*getfunctionlist)(&f)) != CKR_OK) {
		error("C_GetFunctionList for provider %s failed: %lu",
		    provider_id, rv);
		goto fail;
	}
	p->function_list = f;
	if ((rv = f->C_Initialize(NULL)) != CKR_OK) {
		error("C_Initialize for provider %s failed: %lu",
		    provider_id, rv);
		goto fail;
	}
	need_finalize = 1;
	if ((rv = f->C_GetInfo(&p->info)) != CKR_OK) {
		error("C_GetInfo for provider %s failed: %lu",
		    provider_id, rv);
		goto fail;
	}
	rmspace(p->info.manufacturerID, sizeof(p->info.manufacturerID));
	rmspace(p->info.libraryDescription, sizeof(p->info.libraryDescription));
	debug("provider %s: manufacturerID <%s> cryptokiVersion %d.%d"
	    " libraryDescription <%s> libraryVersion %d.%d",
	    provider_id,
	    p->info.manufacturerID,
	    p->info.cryptokiVersion.major,
	    p->info.cryptokiVersion.minor,
	    p->info.libraryDescription,
	    p->info.libraryVersion.major,
	    p->info.libraryVersion.minor);
	if ((rv = f->C_GetSlotList(CK_TRUE, NULL, &p->nslots)) != CKR_OK) {
		error("C_GetSlotList failed: %lu", rv);
		goto fail;
	}
	if (p->nslots == 0) {
		debug("%s: provider %s returned no slots", __func__,
		    provider_id);
		goto fail;
	}
	p->slotlist = xcalloc(p->nslots, sizeof(CK_SLOT_ID));
	if ((rv = f->C_GetSlotList(CK_TRUE, p->slotlist, &p->nslots))
	    != CKR_OK) {
		error("C_GetSlotList for provider %s failed: %lu",
		    provider_id, rv);
		goto fail;
	}
	p->slotinfo = xcalloc(p->nslots, sizeof(struct pkcs11_slotinfo));
	p->valid = 1;
	nkeys = 0;
	for (i = 0; i < p->nslots; i++) {
		token = &p->slotinfo[i].token;
		if ((rv = f->C_GetTokenInfo(p->slotlist[i], token))
		    != CKR_OK) {
			error("C_GetTokenInfo for provider %s slot %lu "
			    "failed: %lu", provider_id, (unsigned long)i, rv);
			continue;
		}
		if ((token->flags & CKF_TOKEN_INITIALIZED) == 0) {
			debug2("%s: ignoring uninitialised token in "
			    "provider %s slot %lu", __func__,
			    provider_id, (unsigned long)i);
			continue;
		}
		rmspace(token->label, sizeof(token->label));
		rmspace(token->manufacturerID, sizeof(token->manufacturerID));
		rmspace(token->model, sizeof(token->model));
		rmspace(token->serialNumber, sizeof(token->serialNumber));
		debug("provider %s slot %lu: label <%s> manufacturerID <%s> "
		    "model <%s> serial <%s> flags 0x%lx",
		    provider_id, (unsigned long)i,
		    token->label, token->manufacturerID, token->model,
		    token->serialNumber, token->flags);
		/* open session, login with pin and retrieve public keys */
		if (pkcs11_open_session(p, i, pin) == 0)
			pkcs11_fetch_keys(p, i, keyp, &nkeys);
	}
	if (nkeys > 0) {
		TAILQ_INSERT_TAIL(&pkcs11_providers, p, next);
		p->refcount++;	/* add to provider list */
		return (nkeys);
	}
	debug("%s: provider %s returned no keys", __func__, provider_id);
	/* don't add the provider, since it does not have any keys */
fail:
	if (need_finalize && (rv = f->C_Finalize(NULL)) != CKR_OK)
		error("C_Finalize for provider %s failed: %lu",
		    provider_id, rv);
	if (p) {
		free(p->slotlist);
		free(p->slotinfo);
		free(p);
	}
	if (handle)
		dlclose(handle);
	return (-1);
}
#else
int
pkcs11_add_provider(char *provider_id, char *pin, struct sshkey ***keyp)
{
	error("dlopen() not supported");
	return (-1);
}
#endif


Generated by: GCOVR (Version 3.3)

Line	Branch	Exec	Source
1			/* $OpenBSD: ssh-pkcs11.c,v 1.25 2017/05/31 09:15:42 deraadt Exp $ */
2			/*
3			* Copyright (c) 2010 Markus Friedl. All rights reserved.
4			*
5			* Permission to use, copy, modify, and distribute this software for any
6			* purpose with or without fee is hereby granted, provided that the above
7			* copyright notice and this permission notice appear in all copies.
8			*
9			* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
10			* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
11			* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
12			* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
13			* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
14			* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
15			* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
16			*/
17
18			#include <sys/types.h>
19			#include <sys/queue.h>
20			#include <stdarg.h>
21			#include <stdio.h>
22
23			#include <string.h>
24			#include <dlfcn.h>
25
26			#include <openssl/x509.h>
27
28			#define CRYPTOKI_COMPAT
29			#include "pkcs11.h"
30
31			#include "log.h"
32			#include "misc.h"
33			#include "sshkey.h"
34			#include "ssh-pkcs11.h"
35			#include "xmalloc.h"
36
37			struct pkcs11_slotinfo {
38			CK_TOKEN_INFO token;
39			CK_SESSION_HANDLE session;
40			int logged_in;
41			};
42
43			struct pkcs11_provider {
44			char *name;
45			void *handle;
46			CK_FUNCTION_LIST *function_list;
47			CK_INFO info;
48			CK_ULONG nslots;
49			CK_SLOT_ID *slotlist;
50			struct pkcs11_slotinfo *slotinfo;
51			int valid;
52			int refcount;
53			TAILQ_ENTRY(pkcs11_provider) next;
54			};
55
56			TAILQ_HEAD(, pkcs11_provider) pkcs11_providers;
57
58			struct pkcs11_key {
59			struct pkcs11_provider *provider;
60			CK_ULONG slotidx;
61			int (orig_finish)(RSA rsa);
62			RSA_METHOD rsa_method;
63			char *keyid;
64			int keyid_len;
65			};
66
67			int pkcs11_interactive = 0;
68
69			int
70			pkcs11_init(int interactive)
71			{
72			pkcs11_interactive = interactive;
73			TAILQ_INIT(&pkcs11_providers);
74			return (0);
75			}
76
77			/*
78			* finalize a provider shared libarary, it's no longer usable.
79			* however, there might still be keys referencing this provider,
80			* so the actuall freeing of memory is handled by pkcs11_provider_unref().
81			* this is called when a provider gets unregistered.
82			*/
83			static void
84			pkcs11_provider_finalize(struct pkcs11_provider *p)
85			{
86			CK_RV rv;
87			CK_ULONG i;
88
89			debug("pkcs11_provider_finalize: %p refcount %d valid %d",
90			p, p->refcount, p->valid);
91			if (!p->valid)
92			return;
93			for (i = 0; i < p->nslots; i++) {
94			if (p->slotinfo[i].session &&
95			(rv = p->function_list->C_CloseSession(
96			p->slotinfo[i].session)) != CKR_OK)
97			error("C_CloseSession failed: %lu", rv);
98			}
99			if ((rv = p->function_list->C_Finalize(NULL)) != CKR_OK)
100			error("C_Finalize failed: %lu", rv);
101			p->valid = 0;
102			p->function_list = NULL;
103			#ifdef HAVE_DLOPEN
104			dlclose(p->handle);
105			#endif
106			}
107
108			/*
109			* remove a reference to the provider.
110			* called when a key gets destroyed or when the provider is unregistered.
111			*/
112			static void
113			pkcs11_provider_unref(struct pkcs11_provider *p)
114			{
115			debug("pkcs11_provider_unref: %p refcount %d", p, p->refcount);
116			if (--p->refcount <= 0) {
117			if (p->valid)
118			error("pkcs11_provider_unref: %p still valid", p);
119			free(p->slotlist);
120			free(p->slotinfo);
121			free(p);
122			}
123			}
124
125			/* unregister all providers, keys might still point to the providers */
126			void
127			pkcs11_terminate(void)
128			{
129			struct pkcs11_provider *p;
130
131			while ((p = TAILQ_FIRST(&pkcs11_providers)) != NULL) {
132			TAILQ_REMOVE(&pkcs11_providers, p, next);
133			pkcs11_provider_finalize(p);
134			pkcs11_provider_unref(p);
135			}
136			}
137
138			/* lookup provider by name */
139			static struct pkcs11_provider *
140			pkcs11_provider_lookup(char *provider_id)
141			{
142			struct pkcs11_provider *p;
143
144			TAILQ_FOREACH(p, &pkcs11_providers, next) {
145			debug("check %p %s", p, p->name);
146			if (!strcmp(provider_id, p->name))
147			return (p);
148			}
149			return (NULL);
150			}
151
152			/* unregister provider by name */
153			int
154			pkcs11_del_provider(char *provider_id)
155			{
156			struct pkcs11_provider *p;
157
158			if ((p = pkcs11_provider_lookup(provider_id)) != NULL) {
159			TAILQ_REMOVE(&pkcs11_providers, p, next);
160			pkcs11_provider_finalize(p);
161			pkcs11_provider_unref(p);
162			return (0);
163			}
164			return (-1);
165			}
166
167			/* openssl callback for freeing an RSA key */
168			static int
169			pkcs11_rsa_finish(RSA *rsa)
170			{
171			struct pkcs11_key *k11;
172			int rv = -1;
173
174			if ((k11 = RSA_get_app_data(rsa)) != NULL) {
175			if (k11->orig_finish)
176			rv = k11->orig_finish(rsa);
177			if (k11->provider)
178			pkcs11_provider_unref(k11->provider);
179			free(k11->keyid);
180			free(k11);
181			}
182			return (rv);
183			}
184
185			/* find a single 'obj' for given attributes */
186			static int
187			pkcs11_find(struct pkcs11_provider p, CK_ULONG slotidx, CK_ATTRIBUTE attr,
188			CK_ULONG nattr, CK_OBJECT_HANDLE *obj)
189			{
190			CK_FUNCTION_LIST *f;
191			CK_SESSION_HANDLE session;
192			CK_ULONG nfound = 0;
193			CK_RV rv;
194			int ret = -1;
195
196			f = p->function_list;
197			session = p->slotinfo[slotidx].session;
198			if ((rv = f->C_FindObjectsInit(session, attr, nattr)) != CKR_OK) {
199			error("C_FindObjectsInit failed (nattr %lu): %lu", nattr, rv);
200			return (-1);
201			}
202			if ((rv = f->C_FindObjects(session, obj, 1, &nfound)) != CKR_OK \|\|
203			nfound != 1) {
204			debug("C_FindObjects failed (nfound %lu nattr %lu): %lu",
205			nfound, nattr, rv);
206			} else
207			ret = 0;
208			if ((rv = f->C_FindObjectsFinal(session)) != CKR_OK)
209			error("C_FindObjectsFinal failed: %lu", rv);
210			return (ret);
211			}
212
213			/* openssl callback doing the actual signing operation */
214			static int
215			pkcs11_rsa_private_encrypt(int flen, const u_char from, u_char to, RSA *rsa,
216			int padding)
217			{
218			struct pkcs11_key *k11;
219			struct pkcs11_slotinfo *si;
220			CK_FUNCTION_LIST *f;
221			CK_OBJECT_HANDLE obj;
222			CK_ULONG tlen = 0;
223			CK_RV rv;
224			CK_OBJECT_CLASS private_key_class = CKO_PRIVATE_KEY;
225			CK_BBOOL true_val = CK_TRUE;
226			CK_MECHANISM mech = {
227			CKM_RSA_PKCS, NULL_PTR, 0
228			};
229			CK_ATTRIBUTE key_filter[] = {
230			{CKA_CLASS, &private_key_class, sizeof(private_key_class) },
231			{CKA_ID, NULL, 0},
232			{CKA_SIGN, &true_val, sizeof(true_val) }
233			};
234			char *pin = NULL, prompt[1024];
235			int rval = -1;
236
237			if ((k11 = RSA_get_app_data(rsa)) == NULL) {
238			error("RSA_get_app_data failed for rsa %p", rsa);
239			return (-1);
240			}
241			if (!k11->provider \|\| !k11->provider->valid) {
242			error("no pkcs11 (valid) provider for rsa %p", rsa);
243			return (-1);
244			}
245			f = k11->provider->function_list;
246			si = &k11->provider->slotinfo[k11->slotidx];
247			if ((si->token.flags & CKF_LOGIN_REQUIRED) && !si->logged_in) {
248			if (!pkcs11_interactive) {
249			error("need pin entry%s", (si->token.flags &
250			CKF_PROTECTED_AUTHENTICATION_PATH) ?
251			" on reader keypad" : "");
252			return (-1);
253			}
254			if (si->token.flags & CKF_PROTECTED_AUTHENTICATION_PATH)
255			verbose("Deferring PIN entry to reader keypad.");
256			else {
257			snprintf(prompt, sizeof(prompt),
258			"Enter PIN for '%s': ", si->token.label);
259			pin = read_passphrase(prompt, RP_ALLOW_EOF);
260			if (pin == NULL)
261			return (-1); /* bail out */
262			}
263			rv = f->C_Login(si->session, CKU_USER, (u_char *)pin,
264			(pin != NULL) ? strlen(pin) : 0);
265			if (pin != NULL) {
266			explicit_bzero(pin, strlen(pin));
267			free(pin);
268			}
269			if (rv != CKR_OK && rv != CKR_USER_ALREADY_LOGGED_IN) {
270			error("C_Login failed: %lu", rv);
271			return (-1);
272			}
273			si->logged_in = 1;
274			}
275			key_filter[1].pValue = k11->keyid;
276			key_filter[1].ulValueLen = k11->keyid_len;
277			/* try to find object w/CKA_SIGN first, retry w/o */
278			if (pkcs11_find(k11->provider, k11->slotidx, key_filter, 3, &obj) < 0 &&
279			pkcs11_find(k11->provider, k11->slotidx, key_filter, 2, &obj) < 0) {
280			error("cannot find private key");
281			} else if ((rv = f->C_SignInit(si->session, &mech, obj)) != CKR_OK) {
282			error("C_SignInit failed: %lu", rv);
283			} else {
284			/* XXX handle CKR_BUFFER_TOO_SMALL */
285			tlen = RSA_size(rsa);
286			rv = f->C_Sign(si->session, (CK_BYTE *)from, flen, to, &tlen);
287			if (rv == CKR_OK)
288			rval = tlen;
289			else
290			error("C_Sign failed: %lu", rv);
291			}
292			return (rval);
293			}
294
295			static int
296			pkcs11_rsa_private_decrypt(int flen, const u_char from, u_char to, RSA *rsa,
297			int padding)
298			{
299			return (-1);
300			}
301
302			/* redirect private key operations for rsa key to pkcs11 token */
303			static int
304			pkcs11_rsa_wrap(struct pkcs11_provider *provider, CK_ULONG slotidx,
305			CK_ATTRIBUTE keyid_attrib, RSA rsa)
306			{
307			struct pkcs11_key *k11;
308			const RSA_METHOD *def = RSA_get_default_method();
309
310			k11 = xcalloc(1, sizeof(*k11));
311			k11->provider = provider;
312			provider->refcount++; /* provider referenced by RSA key */
313			k11->slotidx = slotidx;
314			/* identify key object on smartcard */
315			k11->keyid_len = keyid_attrib->ulValueLen;
316			if (k11->keyid_len > 0) {
317			k11->keyid = xmalloc(k11->keyid_len);
318			memcpy(k11->keyid, keyid_attrib->pValue, k11->keyid_len);
319			}
320			k11->orig_finish = def->finish;
321			memcpy(&k11->rsa_method, def, sizeof(k11->rsa_method));
322			k11->rsa_method.name = "pkcs11";
323			k11->rsa_method.rsa_priv_enc = pkcs11_rsa_private_encrypt;
324			k11->rsa_method.rsa_priv_dec = pkcs11_rsa_private_decrypt;
325			k11->rsa_method.finish = pkcs11_rsa_finish;
326			RSA_set_method(rsa, &k11->rsa_method);
327			RSA_set_app_data(rsa, k11);
328			return (0);
329			}
330
331			/* remove trailing spaces */
332			static void
333			rmspace(u_char *buf, size_t len)
334			{
335			size_t i;
336
337			if (!len)
338			return;
339			for (i = len - 1; i > 0; i--)
340			if (i == len - 1 \|\| buf[i] == ' ')
341			buf[i] = '\0';
342			else
343			break;
344			}
345
346			/*
347			* open a pkcs11 session and login if required.
348			* if pin == NULL we delay login until key use
349			*/
350			static int
351			pkcs11_open_session(struct pkcs11_provider p, CK_ULONG slotidx, char pin)
352			{
353			CK_RV rv;
354			CK_FUNCTION_LIST *f;
355			CK_SESSION_HANDLE session;
356			int login_required;
357
358			f = p->function_list;
359			login_required = p->slotinfo[slotidx].token.flags & CKF_LOGIN_REQUIRED;
360			if (pin && login_required && !strlen(pin)) {
361			error("pin required");
362			return (-1);
363			}
364			if ((rv = f->C_OpenSession(p->slotlist[slotidx], CKF_RW_SESSION\|
365			CKF_SERIAL_SESSION, NULL, NULL, &session))
366			!= CKR_OK) {
367			error("C_OpenSession failed: %lu", rv);
368			return (-1);
369			}
370			if (login_required && pin) {
371			rv = f->C_Login(session, CKU_USER,
372			(u_char *)pin, strlen(pin));
373			if (rv != CKR_OK && rv != CKR_USER_ALREADY_LOGGED_IN) {
374			error("C_Login failed: %lu", rv);
375			if ((rv = f->C_CloseSession(session)) != CKR_OK)
376			error("C_CloseSession failed: %lu", rv);
377			return (-1);
378			}
379			p->slotinfo[slotidx].logged_in = 1;
380			}
381			p->slotinfo[slotidx].session = session;
382			return (0);
383			}
384
385			/*
386			* lookup public keys for token in slot identified by slotidx,
387			* add 'wrapped' public keys to the 'keysp' array and increment nkeys.
388			* keysp points to an (possibly empty) array with *nkeys keys.
389			*/
390			static int pkcs11_fetch_keys_filter(struct pkcs11_provider *, CK_ULONG,
391			CK_ATTRIBUTE [], CK_ATTRIBUTE [3], struct sshkey **, int )
392			__attribute__((__bounded__(__minbytes__,4, 3 * sizeof(CK_ATTRIBUTE))));
393
394			static int
395			pkcs11_fetch_keys(struct pkcs11_provider *p, CK_ULONG slotidx,
396			struct sshkey **keysp, int nkeys)
397			{
398			CK_OBJECT_CLASS pubkey_class = CKO_PUBLIC_KEY;
399			CK_OBJECT_CLASS cert_class = CKO_CERTIFICATE;
400			CK_ATTRIBUTE pubkey_filter[] = {
401			{ CKA_CLASS, &pubkey_class, sizeof(pubkey_class) }
402			};
403			CK_ATTRIBUTE cert_filter[] = {
404			{ CKA_CLASS, &cert_class, sizeof(cert_class) }
405			};
406			CK_ATTRIBUTE pubkey_attribs[] = {
407			{ CKA_ID, NULL, 0 },
408			{ CKA_MODULUS, NULL, 0 },
409			{ CKA_PUBLIC_EXPONENT, NULL, 0 }
410			};
411			CK_ATTRIBUTE cert_attribs[] = {
412			{ CKA_ID, NULL, 0 },
413			{ CKA_SUBJECT, NULL, 0 },
414			{ CKA_VALUE, NULL, 0 }
415			};
416
417			if (pkcs11_fetch_keys_filter(p, slotidx, pubkey_filter, pubkey_attribs,
418			keysp, nkeys) < 0 \|\|
419			pkcs11_fetch_keys_filter(p, slotidx, cert_filter, cert_attribs,
420			keysp, nkeys) < 0)
421			return (-1);
422			return (0);
423			}
424
425			static int
426			pkcs11_key_included(struct sshkey **keysp, int nkeys, struct sshkey *key)
427			{
428			int i;
429
430			for (i = 0; i < *nkeys; i++)
431			if (sshkey_equal(key, (*keysp)[i]))
432			return (1);
433			return (0);
434			}
435
436			static int
437			pkcs11_fetch_keys_filter(struct pkcs11_provider *p, CK_ULONG slotidx,
438			CK_ATTRIBUTE filter[], CK_ATTRIBUTE attribs[3],
439			struct sshkey **keysp, int nkeys)
440			{
441			struct sshkey *key;
442			RSA *rsa;
443			X509 *x509;
444			EVP_PKEY *evp;
445			int i;
446			const u_char *cp;
447			CK_RV rv;
448			CK_OBJECT_HANDLE obj;
449			CK_ULONG nfound;
450			CK_SESSION_HANDLE session;
451			CK_FUNCTION_LIST *f;
452
453			f = p->function_list;
454			session = p->slotinfo[slotidx].session;
455			/* setup a filter the looks for public keys */
456			if ((rv = f->C_FindObjectsInit(session, filter, 1)) != CKR_OK) {
457			error("C_FindObjectsInit failed: %lu", rv);
458			return (-1);
459			}
460			while (1) {
461			/* XXX 3 attributes in attribs[] */
462			for (i = 0; i < 3; i++) {
463			attribs[i].pValue = NULL;
464			attribs[i].ulValueLen = 0;
465			}
466			if ((rv = f->C_FindObjects(session, &obj, 1, &nfound)) != CKR_OK
467			\|\| nfound == 0)
468			break;
469			/* found a key, so figure out size of the attributes */
470			if ((rv = f->C_GetAttributeValue(session, obj, attribs, 3))
471			!= CKR_OK) {
472			error("C_GetAttributeValue failed: %lu", rv);
473			continue;
474			}
475			/*
476			* Allow CKA_ID (always first attribute) to be empty, but
477			* ensure that none of the others are zero length.
478			* XXX assumes CKA_ID is always first.
479			*/
480			if (attribs[1].ulValueLen == 0 \|\|
481			attribs[2].ulValueLen == 0) {
482			continue;
483			}
484			/* allocate buffers for attributes */
485			for (i = 0; i < 3; i++) {
486			if (attribs[i].ulValueLen > 0) {
487			attribs[i].pValue = xmalloc(
488			attribs[i].ulValueLen);
489			}
490			}
491
492			/*
493			* retrieve ID, modulus and public exponent of RSA key,
494			* or ID, subject and value for certificates.
495			*/
496			rsa = NULL;
497			if ((rv = f->C_GetAttributeValue(session, obj, attribs, 3))
498			!= CKR_OK) {
499			error("C_GetAttributeValue failed: %lu", rv);
500			} else if (attribs[1].type == CKA_MODULUS ) {
501			if ((rsa = RSA_new()) == NULL) {
502			error("RSA_new failed");
503			} else {
504			rsa->n = BN_bin2bn(attribs[1].pValue,
505			attribs[1].ulValueLen, NULL);
506			rsa->e = BN_bin2bn(attribs[2].pValue,
507			attribs[2].ulValueLen, NULL);
508			}
509			} else {
510			cp = attribs[2].pValue;
511			if ((x509 = X509_new()) == NULL) {
512			error("X509_new failed");
513			} else if (d2i_X509(&x509, &cp, attribs[2].ulValueLen)
514			== NULL) {
515			error("d2i_X509 failed");
516			} else if ((evp = X509_get_pubkey(x509)) == NULL \|\|
517			evp->type != EVP_PKEY_RSA \|\|
518			evp->pkey.rsa == NULL) {
519			debug("X509_get_pubkey failed or no rsa");
520			} else if ((rsa = RSAPublicKey_dup(evp->pkey.rsa))
521			== NULL) {
522			error("RSAPublicKey_dup");
523			}
524			if (x509)
525			X509_free(x509);
526			}
527			if (rsa && rsa->n && rsa->e &&
528			pkcs11_rsa_wrap(p, slotidx, &attribs[0], rsa) == 0) {
529			if ((key = sshkey_new(KEY_UNSPEC)) == NULL)
530			fatal("sshkey_new failed");
531			key->rsa = rsa;
532			key->type = KEY_RSA;
533			key->flags \|= SSHKEY_FLAG_EXT;
534			if (pkcs11_key_included(keysp, nkeys, key)) {
535			sshkey_free(key);
536			} else {
537			/* expand key array and add key */
538			keysp = xrecallocarray(keysp, *nkeys,
539			nkeys + 1, sizeof(struct sshkey ));
540			(keysp)[nkeys] = key;
541			nkeys = nkeys + 1;
542			debug("have %d keys", *nkeys);
543			}
544			} else if (rsa) {
545			RSA_free(rsa);
546			}
547			for (i = 0; i < 3; i++)
548			free(attribs[i].pValue);
549			}
550			if ((rv = f->C_FindObjectsFinal(session)) != CKR_OK)
551			error("C_FindObjectsFinal failed: %lu", rv);
552			return (0);
553			}
554
555			#ifdef HAVE_DLOPEN
556			/* register a new provider, fails if provider already exists */
557			int
558			pkcs11_add_provider(char provider_id, char pin, struct sshkey ***keyp)
559			{
560			int nkeys, need_finalize = 0;
561			struct pkcs11_provider *p = NULL;
562			void *handle = NULL;
563			CK_RV (getfunctionlist)(CK_FUNCTION_LIST *);
564			CK_RV rv;
565			CK_FUNCTION_LIST *f = NULL;
566			CK_TOKEN_INFO *token;
567			CK_ULONG i;
568
569			*keyp = NULL;
570			if (pkcs11_provider_lookup(provider_id) != NULL) {
571			debug("%s: provider already registered: %s",
572			__func__, provider_id);
573			goto fail;
574			}
575			/* open shared pkcs11-libarary */
576			if ((handle = dlopen(provider_id, RTLD_NOW)) == NULL) {
577			error("dlopen %s failed: %s", provider_id, dlerror());
578			goto fail;
579			}
580			if ((getfunctionlist = dlsym(handle, "C_GetFunctionList")) == NULL) {
581			error("dlsym(C_GetFunctionList) failed: %s", dlerror());
582			goto fail;
583			}
584			p = xcalloc(1, sizeof(*p));
585			p->name = xstrdup(provider_id);
586			p->handle = handle;
587			/* setup the pkcs11 callbacks */
588			if ((rv = (*getfunctionlist)(&f)) != CKR_OK) {
589			error("C_GetFunctionList for provider %s failed: %lu",
590			provider_id, rv);
591			goto fail;
592			}
593			p->function_list = f;
594			if ((rv = f->C_Initialize(NULL)) != CKR_OK) {
595			error("C_Initialize for provider %s failed: %lu",
596			provider_id, rv);
597			goto fail;
598			}
599			need_finalize = 1;
600			if ((rv = f->C_GetInfo(&p->info)) != CKR_OK) {
601			error("C_GetInfo for provider %s failed: %lu",
602			provider_id, rv);
603			goto fail;
604			}
605			rmspace(p->info.manufacturerID, sizeof(p->info.manufacturerID));
606			rmspace(p->info.libraryDescription, sizeof(p->info.libraryDescription));
607			debug("provider %s: manufacturerID <%s> cryptokiVersion %d.%d"
608			" libraryDescription <%s> libraryVersion %d.%d",
609			provider_id,
610			p->info.manufacturerID,
611			p->info.cryptokiVersion.major,
612			p->info.cryptokiVersion.minor,
613			p->info.libraryDescription,
614			p->info.libraryVersion.major,
615			p->info.libraryVersion.minor);
616			if ((rv = f->C_GetSlotList(CK_TRUE, NULL, &p->nslots)) != CKR_OK) {
617			error("C_GetSlotList failed: %lu", rv);
618			goto fail;
619			}
620			if (p->nslots == 0) {
621			debug("%s: provider %s returned no slots", __func__,
622			provider_id);
623			goto fail;
624			}
625			p->slotlist = xcalloc(p->nslots, sizeof(CK_SLOT_ID));
626			if ((rv = f->C_GetSlotList(CK_TRUE, p->slotlist, &p->nslots))
627			!= CKR_OK) {
628			error("C_GetSlotList for provider %s failed: %lu",
629			provider_id, rv);
630			goto fail;
631			}
632			p->slotinfo = xcalloc(p->nslots, sizeof(struct pkcs11_slotinfo));
633			p->valid = 1;
634			nkeys = 0;
635			for (i = 0; i < p->nslots; i++) {
636			token = &p->slotinfo[i].token;
637			if ((rv = f->C_GetTokenInfo(p->slotlist[i], token))
638			!= CKR_OK) {
639			error("C_GetTokenInfo for provider %s slot %lu "
640			"failed: %lu", provider_id, (unsigned long)i, rv);
641			continue;
642			}
643			if ((token->flags & CKF_TOKEN_INITIALIZED) == 0) {
644			debug2("%s: ignoring uninitialised token in "
645			"provider %s slot %lu", __func__,
646			provider_id, (unsigned long)i);
647			continue;
648			}
649			rmspace(token->label, sizeof(token->label));
650			rmspace(token->manufacturerID, sizeof(token->manufacturerID));
651			rmspace(token->model, sizeof(token->model));
652			rmspace(token->serialNumber, sizeof(token->serialNumber));
653			debug("provider %s slot %lu: label <%s> manufacturerID <%s> "
654			"model <%s> serial <%s> flags 0x%lx",
655			provider_id, (unsigned long)i,
656			token->label, token->manufacturerID, token->model,
657			token->serialNumber, token->flags);
658			/* open session, login with pin and retrieve public keys */
659			if (pkcs11_open_session(p, i, pin) == 0)
660			pkcs11_fetch_keys(p, i, keyp, &nkeys);
661			}
662			if (nkeys > 0) {
663			TAILQ_INSERT_TAIL(&pkcs11_providers, p, next);
664			p->refcount++; /* add to provider list */
665			return (nkeys);
666			}
667			debug("%s: provider %s returned no keys", __func__, provider_id);
668			/* don't add the provider, since it does not have any keys */
669			fail:
670			if (need_finalize && (rv = f->C_Finalize(NULL)) != CKR_OK)
671			error("C_Finalize for provider %s failed: %lu",
672			provider_id, rv);
673			if (p) {
674			free(p->slotlist);
675			free(p->slotinfo);
676			free(p);
677			}
678			if (handle)
679			dlclose(handle);
680			return (-1);
681			}
682			#else
683			int
684			pkcs11_add_provider(char provider_id, char pin, struct sshkey ***keyp)
685			{
686			error("dlopen() not supported");
687			return (-1);
688			}
689			#endif