zcrypt_api.c 37.1 KB
Newer Older
1
/*
2
 *  zcrypt 2.1.0
3
 *
4
 *  Copyright IBM Corp. 2001, 2012
5 6 7 8 9 10 11
 *  Author(s): Robert Burroughs
 *	       Eric Rossman (edrossma@us.ibm.com)
 *	       Cornelia Huck <cornelia.huck@de.ibm.com>
 *
 *  Hotplug & misc device support: Jochen Roehrig (roehrig@de.ibm.com)
 *  Major cleanup & driver split: Martin Schwidefsky <schwidefsky@de.ibm.com>
 *				  Ralph Wuerthner <rwuerthn@de.ibm.com>
12
 *  MSGTYPE restruct:		  Holger Dengler <hd@linux.vnet.ibm.com>
13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2, or (at your option)
 * any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/interrupt.h>
#include <linux/miscdevice.h>
#include <linux/fs.h>
#include <linux/proc_fs.h>
35
#include <linux/seq_file.h>
36
#include <linux/compat.h>
37
#include <linux/slab.h>
A
Arun Sharma 已提交
38
#include <linux/atomic.h>
39
#include <asm/uaccess.h>
40
#include <linux/hw_random.h>
41 42
#include <linux/debugfs.h>
#include <asm/debug.h>
43

44
#include "zcrypt_debug.h"
45 46
#include "zcrypt_api.h"

47
#include "zcrypt_msgtype6.h"
48
#include "zcrypt_msgtype50.h"
49

50
/*
51 52 53
 * Module description.
 */
MODULE_AUTHOR("IBM Corporation");
54 55
MODULE_DESCRIPTION("Cryptographic Coprocessor interface, " \
		   "Copyright IBM Corp. 2001, 2012");
56 57
MODULE_LICENSE("GPL");

58 59 60 61
static int zcrypt_hwrng_seed = 1;
module_param_named(hwrng_seed, zcrypt_hwrng_seed, int, S_IRUSR|S_IRGRP);
MODULE_PARM_DESC(hwrng_seed, "Turn on/off hwrng auto seed, default is 1 (on).");

62 63 64 65
DEFINE_SPINLOCK(zcrypt_list_lock);
LIST_HEAD(zcrypt_card_list);
int zcrypt_device_count;

66
static atomic_t zcrypt_open_count = ATOMIC_INIT(0);
67 68 69 70
static atomic_t zcrypt_rescan_count = ATOMIC_INIT(0);

atomic_t zcrypt_rescan_req = ATOMIC_INIT(0);
EXPORT_SYMBOL(zcrypt_rescan_req);
71

72 73
static LIST_HEAD(zcrypt_ops_list);

74
static struct dentry *debugfs_root;
75 76 77
debug_info_t *zcrypt_dbf_common;
debug_info_t *zcrypt_dbf_devices;
debug_info_t *zcrypt_dbf_cards;
78

79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96
/**
 * Process a rescan of the transport layer.
 *
 * Returns 1, if the rescan has been processed, otherwise 0.
 */
static inline int zcrypt_process_rescan(void)
{
	if (atomic_read(&zcrypt_rescan_req)) {
		atomic_set(&zcrypt_rescan_req, 0);
		atomic_inc(&zcrypt_rescan_count);
		ap_bus_force_rescan();
		ZCRYPT_DBF_COMMON(DBF_INFO, "rescan%07d",
				  atomic_inc_return(&zcrypt_rescan_count));
		return 1;
	}
	return 0;
}

97 98
void zcrypt_msgtype_register(struct zcrypt_ops *zops)
{
99
	list_add_tail(&zops->list, &zcrypt_ops_list);
100 101 102 103 104 105 106
}

void zcrypt_msgtype_unregister(struct zcrypt_ops *zops)
{
	list_del_init(&zops->list);
}

107
struct zcrypt_ops *zcrypt_msgtype(unsigned char *name, int variant)
108 109 110
{
	struct zcrypt_ops *zops;

111
	list_for_each_entry(zops, &zcrypt_ops_list, list)
112
		if ((zops->variant == variant) &&
113 114 115
		    (!strncmp(zops->name, name, sizeof(zops->name))))
			return zops;
	return NULL;
116
}
117
EXPORT_SYMBOL(zcrypt_msgtype);
118

119
/**
120 121 122
 * zcrypt_read (): Not supported beyond zcrypt 1.3.1.
 *
 * This function is not supported beyond zcrypt 1.3.1.
123 124 125 126 127 128 129 130
 */
static ssize_t zcrypt_read(struct file *filp, char __user *buf,
			   size_t count, loff_t *f_pos)
{
	return -EPERM;
}

/**
131 132
 * zcrypt_write(): Not allowed.
 *
133 134 135 136 137 138 139 140 141
 * Write is is not allowed
 */
static ssize_t zcrypt_write(struct file *filp, const char __user *buf,
			    size_t count, loff_t *f_pos)
{
	return -EPERM;
}

/**
142 143 144
 * zcrypt_open(): Count number of users.
 *
 * Device open function to count number of users.
145 146 147 148
 */
static int zcrypt_open(struct inode *inode, struct file *filp)
{
	atomic_inc(&zcrypt_open_count);
149
	return nonseekable_open(inode, filp);
150 151
}

152 153 154 155 156
/**
 * zcrypt_release(): Count number of users.
 *
 * Device close function to count number of users.
 */
157 158 159 160 161 162
static int zcrypt_release(struct inode *inode, struct file *filp)
{
	atomic_dec(&zcrypt_open_count);
	return 0;
}

163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190
static inline struct zcrypt_queue *zcrypt_pick_queue(struct zcrypt_card *zc,
						     struct zcrypt_queue *zq,
						     unsigned int weight)
{
	if (!zq || !try_module_get(zq->queue->ap_dev.drv->driver.owner))
		return NULL;
	zcrypt_queue_get(zq);
	get_device(&zq->queue->ap_dev.device);
	atomic_add(weight, &zc->load);
	atomic_add(weight, &zq->load);
	zq->request_count++;
	return zq;
}

static inline void zcrypt_drop_queue(struct zcrypt_card *zc,
				     struct zcrypt_queue *zq,
				     unsigned int weight)
{
	struct module *mod = zq->queue->ap_dev.drv->driver.owner;

	zq->request_count--;
	atomic_sub(weight, &zc->load);
	atomic_sub(weight, &zq->load);
	put_device(&zq->queue->ap_dev.device);
	zcrypt_queue_put(zq);
	module_put(mod);
}

191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218
static inline bool zcrypt_card_compare(struct zcrypt_card *zc,
				       struct zcrypt_card *pref_zc,
				       unsigned weight, unsigned pref_weight)
{
	if (!pref_zc)
		return 0;
	weight += atomic_read(&zc->load);
	pref_weight += atomic_read(&pref_zc->load);
	if (weight == pref_weight)
		return atomic_read(&zc->card->total_request_count) >
			atomic_read(&pref_zc->card->total_request_count);
	return weight > pref_weight;
}

static inline bool zcrypt_queue_compare(struct zcrypt_queue *zq,
					struct zcrypt_queue *pref_zq,
					unsigned weight, unsigned pref_weight)
{
	if (!pref_zq)
		return 0;
	weight += atomic_read(&zq->load);
	pref_weight += atomic_read(&pref_zq->load);
	if (weight == pref_weight)
		return &zq->queue->total_request_count >
			&pref_zq->queue->total_request_count;
	return weight > pref_weight;
}

219
/*
220 221 222 223
 * zcrypt ioctls.
 */
static long zcrypt_rsa_modexpo(struct ica_rsa_modexpo *mex)
{
224 225 226 227
	struct zcrypt_card *zc, *pref_zc;
	struct zcrypt_queue *zq, *pref_zq;
	unsigned int weight, pref_weight;
	unsigned int func_code;
228 229 230 231
	int rc;

	if (mex->outputdatalength < mex->inputdatalength)
		return -EINVAL;
232
	/*
233 234 235 236 237 238
	 * As long as outputdatalength is big enough, we can set the
	 * outputdatalength equal to the inputdatalength, since that is the
	 * number of bytes we will copy in any case
	 */
	mex->outputdatalength = mex->inputdatalength;

239 240 241 242
	rc = get_rsa_modex_fc(mex, &func_code);
	if (rc)
		return rc;

243 244 245 246 247 248
	pref_zc = NULL;
	pref_zq = NULL;
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		/* Check for online accelarator and CCA cards */
		if (!zc->online || !(zc->card->functions & 0x18000000))
249
			continue;
250 251 252
		/* Check for size limits */
		if (zc->min_mod_size > mex->inputdatalength ||
		    zc->max_mod_size < mex->inputdatalength)
253
			continue;
254 255
		/* get weight index of the card device	*/
		weight = zc->speed_rating[func_code];
256
		if (zcrypt_card_compare(zc, pref_zc, weight, pref_weight))
257
			continue;
258 259
		for_each_zcrypt_queue(zq, zc) {
			/* check if device is online and eligible */
260
			if (!zq->online || !zq->ops->rsa_modexpo)
261
				continue;
262 263
			if (zcrypt_queue_compare(zq, pref_zq,
						 weight, pref_weight))
264 265 266 267
				continue;
			pref_zc = zc;
			pref_zq = zq;
			pref_weight = weight;
268
		}
269
	}
270 271
	pref_zq = zcrypt_pick_queue(pref_zc, pref_zq, weight);
	spin_unlock(&zcrypt_list_lock);
272

273
	if (!pref_zq)
274 275
		return -ENODEV;

276 277 278 279 280 281
	rc = pref_zq->ops->rsa_modexpo(pref_zq, mex);

	spin_lock(&zcrypt_list_lock);
	zcrypt_drop_queue(pref_zc, pref_zq, weight);
	spin_unlock(&zcrypt_list_lock);

282
	return rc;
283 284 285 286
}

static long zcrypt_rsa_crt(struct ica_rsa_modexpo_crt *crt)
{
287 288 289 290 291
	struct zcrypt_card *zc, *pref_zc;
	struct zcrypt_queue *zq, *pref_zq;
	unsigned int weight, pref_weight;
	unsigned int func_code;
	int rc;
292

293
	if (crt->outputdatalength < crt->inputdatalength)
294
		return -EINVAL;
295
	/*
296 297 298 299 300 301
	 * As long as outputdatalength is big enough, we can set the
	 * outputdatalength equal to the inputdatalength, since that is the
	 * number of bytes we will copy in any case
	 */
	crt->outputdatalength = crt->inputdatalength;

302 303 304 305
	rc = get_rsa_crt_fc(crt, &func_code);
	if (rc)
		return rc;

306 307 308 309 310 311
	pref_zc = NULL;
	pref_zq = NULL;
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		/* Check for online accelarator and CCA cards */
		if (!zc->online || !(zc->card->functions & 0x18000000))
312
			continue;
313 314 315
		/* Check for size limits */
		if (zc->min_mod_size > crt->inputdatalength ||
		    zc->max_mod_size < crt->inputdatalength)
316
			continue;
317 318
		/* get weight index of the card device	*/
		weight = zc->speed_rating[func_code];
319
		if (zcrypt_card_compare(zc, pref_zc, weight, pref_weight))
320
			continue;
321 322
		for_each_zcrypt_queue(zq, zc) {
			/* check if device is online and eligible */
323
			if (!zq->online || !zq->ops->rsa_modexpo_crt)
324
				continue;
325 326
			if (zcrypt_queue_compare(zq, pref_zq,
						 weight, pref_weight))
327 328 329 330
				continue;
			pref_zc = zc;
			pref_zq = zq;
			pref_weight = weight;
331
		}
332
	}
333 334 335 336
	pref_zq = zcrypt_pick_queue(pref_zc, pref_zq, weight);
	spin_unlock(&zcrypt_list_lock);

	if (!pref_zq)
337
		return -ENODEV;
338 339 340 341 342 343 344

	rc = pref_zq->ops->rsa_modexpo_crt(pref_zq, crt);

	spin_lock(&zcrypt_list_lock);
	zcrypt_drop_queue(pref_zc, pref_zq, weight);
	spin_unlock(&zcrypt_list_lock);

345
	return rc;
346 347
}

348 349
static long zcrypt_send_cprb(struct ica_xcRB *xcRB)
{
350 351
	struct zcrypt_card *zc, *pref_zc;
	struct zcrypt_queue *zq, *pref_zq;
352
	struct ap_message ap_msg;
353 354 355 356
	unsigned int weight, pref_weight;
	unsigned int func_code;
	unsigned short *domain;
	int rc;
357

358
	rc = get_cprb_fc(xcRB, &ap_msg, &func_code, &domain);
359 360
	if (rc)
		return rc;
361

362 363 364 365 366 367
	pref_zc = NULL;
	pref_zq = NULL;
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		/* Check for online CCA cards */
		if (!zc->online || !(zc->card->functions & 0x10000000))
368
			continue;
369 370 371
		/* Check for user selected CCA card */
		if (xcRB->user_defined != AUTOSELECT &&
		    xcRB->user_defined != zc->card->id)
372
			continue;
373 374
		/* get weight index of the card device	*/
		weight = speed_idx_cca(func_code) * zc->speed_rating[SECKEY];
375
		if (zcrypt_card_compare(zc, pref_zc, weight, pref_weight))
376
			continue;
377 378 379
		for_each_zcrypt_queue(zq, zc) {
			/* check if device is online and eligible */
			if (!zq->online ||
380
			    !zq->ops->send_cprb ||
381 382 383
			    ((*domain != (unsigned short) AUTOSELECT) &&
			     (*domain != AP_QID_QUEUE(zq->queue->qid))))
				continue;
384 385
			if (zcrypt_queue_compare(zq, pref_zq,
						 weight, pref_weight))
386 387 388 389
				continue;
			pref_zc = zc;
			pref_zq = zq;
			pref_weight = weight;
390
		}
391
	}
392 393 394 395
	pref_zq = zcrypt_pick_queue(pref_zc, pref_zq, weight);
	spin_unlock(&zcrypt_list_lock);

	if (!pref_zq)
396
		return -ENODEV;
397 398 399 400 401 402 403 404 405 406

	/* in case of auto select, provide the correct domain */
	if (*domain == (unsigned short) AUTOSELECT)
		*domain = AP_QID_QUEUE(pref_zq->queue->qid);

	rc = pref_zq->ops->send_cprb(pref_zq, xcRB, &ap_msg);

	spin_lock(&zcrypt_list_lock);
	zcrypt_drop_queue(pref_zc, pref_zq, weight);
	spin_unlock(&zcrypt_list_lock);
407
	return rc;
408 409
}

410 411 412
static bool is_desired_ep11_card(unsigned int dev_id,
				 unsigned short target_num,
				 struct ep11_target_dev *targets)
413
{
414 415 416 417 418 419 420
	while (target_num-- > 0) {
		if (dev_id == targets->ap_id)
			return true;
		targets++;
	}
	return false;
}
421

422 423 424 425 426 427
static bool is_desired_ep11_queue(unsigned int dev_qid,
				  unsigned short target_num,
				  struct ep11_target_dev *targets)
{
	while (target_num-- > 0) {
		if (AP_MKQID(targets->ap_id, targets->dom_id) == dev_qid)
428
			return true;
429
		targets++;
430 431 432 433 434 435
	}
	return false;
}

static long zcrypt_send_ep11_cprb(struct ep11_urb *xcrb)
{
436 437 438 439 440 441
	struct zcrypt_card *zc, *pref_zc;
	struct zcrypt_queue *zq, *pref_zq;
	struct ep11_target_dev *targets;
	unsigned short target_num;
	unsigned int weight, pref_weight;
	unsigned int func_code;
442
	struct ap_message ap_msg;
443 444
	int rc;

445
	target_num = (unsigned short) xcrb->targets_num;
446 447

	/* empty list indicates autoselect (all available targets) */
448 449 450 451 452 453
	targets = NULL;
	if (target_num != 0) {
		struct ep11_target_dev __user *uptr;

		targets = kcalloc(target_num, sizeof(*targets), GFP_KERNEL);
		if (!targets)
454 455
			return -ENOMEM;

456 457 458
		uptr = (struct ep11_target_dev __force __user *) xcrb->targets;
		if (copy_from_user(targets, uptr,
				   target_num * sizeof(*targets)))
459 460 461
			return -EFAULT;
	}

462 463
	rc = get_ep11cprb_fc(xcrb, &ap_msg, &func_code);
	if (rc)
464
		goto out_free;
465

466 467 468 469 470 471
	pref_zc = NULL;
	pref_zq = NULL;
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		/* Check for online EP11 cards */
		if (!zc->online || !(zc->card->functions & 0x04000000))
472
			continue;
473 474 475
		/* Check for user selected EP11 card */
		if (targets &&
		    !is_desired_ep11_card(zc->card->id, target_num, targets))
476
			continue;
477 478
		/* get weight index of the card device	*/
		weight = speed_idx_ep11(func_code) * zc->speed_rating[SECKEY];
479
		if (zcrypt_card_compare(zc, pref_zc, weight, pref_weight))
480
			continue;
481 482 483
		for_each_zcrypt_queue(zq, zc) {
			/* check if device is online and eligible */
			if (!zq->online ||
484
			    !zq->ops->send_ep11_cprb ||
485 486 487 488
			    (targets &&
			     !is_desired_ep11_queue(zq->queue->qid,
						    target_num, targets)))
				continue;
489 490
			if (zcrypt_queue_compare(zq, pref_zq,
						 weight, pref_weight))
491 492 493
				continue;
			pref_zc = zc;
			pref_zq = zq;
494 495
			pref_weight = weight;
		}
496
	}
497 498
	pref_zq = zcrypt_pick_queue(pref_zc, pref_zq, weight);
	spin_unlock(&zcrypt_list_lock);
499

500 501 502
	if (!pref_zq) {
		rc = -ENODEV;
		goto out_free;
503
	}
504 505 506 507 508 509 510 511 512

	rc = pref_zq->ops->send_ep11_cprb(pref_zq, xcrb, &ap_msg);

	spin_lock(&zcrypt_list_lock);
	zcrypt_drop_queue(pref_zc, pref_zq, weight);
	spin_unlock(&zcrypt_list_lock);

out_free:
	kfree(targets);
513
	return rc;
514 515
}

516 517
static long zcrypt_rng(char *buffer)
{
518 519 520 521
	struct zcrypt_card *zc, *pref_zc;
	struct zcrypt_queue *zq, *pref_zq;
	unsigned int weight, pref_weight;
	unsigned int func_code;
522
	struct ap_message ap_msg;
523
	unsigned int domain;
524 525
	int rc;

526
	rc = get_rng_fc(&ap_msg, &func_code, &domain);
527 528 529
	if (rc)
		return rc;

530 531 532 533 534 535
	pref_zc = NULL;
	pref_zq = NULL;
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		/* Check for online CCA cards */
		if (!zc->online || !(zc->card->functions & 0x10000000))
536
			continue;
537 538
		/* get weight index of the card device	*/
		weight = zc->speed_rating[func_code];
539
		if (zcrypt_card_compare(zc, pref_zc, weight, pref_weight))
540
			continue;
541 542
		for_each_zcrypt_queue(zq, zc) {
			/* check if device is online and eligible */
543
			if (!zq->online || !zq->ops->rng)
544
				continue;
545 546
			if (zcrypt_queue_compare(zq, pref_zq,
						 weight, pref_weight))
547 548 549
				continue;
			pref_zc = zc;
			pref_zq = zq;
550 551 552
			pref_weight = weight;
		}
	}
553 554 555 556
	pref_zq = zcrypt_pick_queue(pref_zc, pref_zq, weight);
	spin_unlock(&zcrypt_list_lock);

	if (!pref_zq)
557 558
		return -ENODEV;

559 560 561 562 563
	rc = pref_zq->ops->rng(pref_zq, buffer, &ap_msg);

	spin_lock(&zcrypt_list_lock);
	zcrypt_drop_queue(pref_zc, pref_zq, weight);
	spin_unlock(&zcrypt_list_lock);
564
	return rc;
565 566
}

567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589
static void zcrypt_device_status_mask(struct zcrypt_device_matrix *matrix)
{
	struct zcrypt_card *zc;
	struct zcrypt_queue *zq;
	struct zcrypt_device_status *stat;

	memset(matrix, 0, sizeof(*matrix));
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		for_each_zcrypt_queue(zq, zc) {
			stat = matrix->device;
			stat += AP_QID_CARD(zq->queue->qid) * MAX_ZDEV_DOMAINS;
			stat += AP_QID_QUEUE(zq->queue->qid);
			stat->hwtype = zc->card->ap_dev.device_type;
			stat->functions = zc->card->functions >> 26;
			stat->qid = zq->queue->qid;
			stat->online = zq->online ? 0x01 : 0x00;
		}
	}
	spin_unlock(&zcrypt_list_lock);
}
EXPORT_SYMBOL(zcrypt_device_status_mask);

590 591
static void zcrypt_status_mask(char status[AP_DEVICES])
{
592 593
	struct zcrypt_card *zc;
	struct zcrypt_queue *zq;
594 595

	memset(status, 0, sizeof(char) * AP_DEVICES);
596 597 598 599 600 601 602 603 604 605
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		for_each_zcrypt_queue(zq, zc) {
			if (AP_QID_QUEUE(zq->queue->qid) != ap_domain_index)
				continue;
			status[AP_QID_CARD(zq->queue->qid)] =
				zc->online ? zc->user_space_type : 0x0d;
		}
	}
	spin_unlock(&zcrypt_list_lock);
606 607 608 609
}

static void zcrypt_qdepth_mask(char qdepth[AP_DEVICES])
{
610 611
	struct zcrypt_card *zc;
	struct zcrypt_queue *zq;
612 613

	memset(qdepth, 0, sizeof(char)	* AP_DEVICES);
614 615 616 617 618 619 620 621 622 623 624
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		for_each_zcrypt_queue(zq, zc) {
			if (AP_QID_QUEUE(zq->queue->qid) != ap_domain_index)
				continue;
			spin_lock(&zq->queue->lock);
			qdepth[AP_QID_CARD(zq->queue->qid)] =
				zq->queue->pendingq_count +
				zq->queue->requestq_count;
			spin_unlock(&zq->queue->lock);
		}
625
	}
626
	spin_unlock(&zcrypt_list_lock);
627 628 629 630
}

static void zcrypt_perdev_reqcnt(int reqcnt[AP_DEVICES])
{
631 632
	struct zcrypt_card *zc;
	struct zcrypt_queue *zq;
633 634

	memset(reqcnt, 0, sizeof(int) * AP_DEVICES);
635 636 637 638 639 640 641 642 643 644
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		for_each_zcrypt_queue(zq, zc) {
			if (AP_QID_QUEUE(zq->queue->qid) != ap_domain_index)
				continue;
			spin_lock(&zq->queue->lock);
			reqcnt[AP_QID_CARD(zq->queue->qid)] =
				zq->queue->total_request_count;
			spin_unlock(&zq->queue->lock);
		}
645
	}
646
	spin_unlock(&zcrypt_list_lock);
647 648 649 650
}

static int zcrypt_pendingq_count(void)
{
651 652 653 654 655 656 657 658 659 660 661 662 663 664
	struct zcrypt_card *zc;
	struct zcrypt_queue *zq;
	int pendingq_count;

	pendingq_count = 0;
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		for_each_zcrypt_queue(zq, zc) {
			if (AP_QID_QUEUE(zq->queue->qid) != ap_domain_index)
				continue;
			spin_lock(&zq->queue->lock);
			pendingq_count += zq->queue->pendingq_count;
			spin_unlock(&zq->queue->lock);
		}
665
	}
666
	spin_unlock(&zcrypt_list_lock);
667 668 669 670 671
	return pendingq_count;
}

static int zcrypt_requestq_count(void)
{
672 673 674 675 676 677 678 679 680 681 682 683 684 685
	struct zcrypt_card *zc;
	struct zcrypt_queue *zq;
	int requestq_count;

	requestq_count = 0;
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		for_each_zcrypt_queue(zq, zc) {
			if (AP_QID_QUEUE(zq->queue->qid) != ap_domain_index)
				continue;
			spin_lock(&zq->queue->lock);
			requestq_count += zq->queue->requestq_count;
			spin_unlock(&zq->queue->lock);
		}
686
	}
687
	spin_unlock(&zcrypt_list_lock);
688 689 690 691 692
	return requestq_count;
}

static int zcrypt_count_type(int type)
{
693 694 695 696 697 698 699 700 701 702 703 704
	struct zcrypt_card *zc;
	struct zcrypt_queue *zq;
	int device_count;

	device_count = 0;
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		if (zc->card->id != type)
			continue;
		for_each_zcrypt_queue(zq, zc) {
			if (AP_QID_QUEUE(zq->queue->qid) != ap_domain_index)
				continue;
705
			device_count++;
706 707 708
		}
	}
	spin_unlock(&zcrypt_list_lock);
709 710 711 712
	return device_count;
}

/**
713 714
 * zcrypt_ica_status(): Old, depracted combi status call.
 *
715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754
 * Old, deprecated combi status call.
 */
static long zcrypt_ica_status(struct file *filp, unsigned long arg)
{
	struct ica_z90_status *pstat;
	int ret;

	pstat = kzalloc(sizeof(*pstat), GFP_KERNEL);
	if (!pstat)
		return -ENOMEM;
	pstat->totalcount = zcrypt_device_count;
	pstat->leedslitecount = zcrypt_count_type(ZCRYPT_PCICA);
	pstat->leeds2count = zcrypt_count_type(ZCRYPT_PCICC);
	pstat->requestqWaitCount = zcrypt_requestq_count();
	pstat->pendingqWaitCount = zcrypt_pendingq_count();
	pstat->totalOpenCount = atomic_read(&zcrypt_open_count);
	pstat->cryptoDomain = ap_domain_index;
	zcrypt_status_mask(pstat->status);
	zcrypt_qdepth_mask(pstat->qdepth);
	ret = 0;
	if (copy_to_user((void __user *) arg, pstat, sizeof(*pstat)))
		ret = -EFAULT;
	kfree(pstat);
	return ret;
}

static long zcrypt_unlocked_ioctl(struct file *filp, unsigned int cmd,
				  unsigned long arg)
{
	int rc;

	switch (cmd) {
	case ICARSAMODEXPO: {
		struct ica_rsa_modexpo __user *umex = (void __user *) arg;
		struct ica_rsa_modexpo mex;
		if (copy_from_user(&mex, umex, sizeof(mex)))
			return -EFAULT;
		do {
			rc = zcrypt_rsa_modexpo(&mex);
		} while (rc == -EAGAIN);
755 756 757 758 759
		/* on failure: retry once again after a requested rescan */
		if ((rc == -ENODEV) && (zcrypt_process_rescan()))
			do {
				rc = zcrypt_rsa_modexpo(&mex);
			} while (rc == -EAGAIN);
760 761 762 763 764 765 766 767 768 769 770 771
		if (rc)
			return rc;
		return put_user(mex.outputdatalength, &umex->outputdatalength);
	}
	case ICARSACRT: {
		struct ica_rsa_modexpo_crt __user *ucrt = (void __user *) arg;
		struct ica_rsa_modexpo_crt crt;
		if (copy_from_user(&crt, ucrt, sizeof(crt)))
			return -EFAULT;
		do {
			rc = zcrypt_rsa_crt(&crt);
		} while (rc == -EAGAIN);
772 773 774 775 776
		/* on failure: retry once again after a requested rescan */
		if ((rc == -ENODEV) && (zcrypt_process_rescan()))
			do {
				rc = zcrypt_rsa_crt(&crt);
			} while (rc == -EAGAIN);
777 778 779 780
		if (rc)
			return rc;
		return put_user(crt.outputdatalength, &ucrt->outputdatalength);
	}
781 782 783 784 785 786 787 788
	case ZSECSENDCPRB: {
		struct ica_xcRB __user *uxcRB = (void __user *) arg;
		struct ica_xcRB xcRB;
		if (copy_from_user(&xcRB, uxcRB, sizeof(xcRB)))
			return -EFAULT;
		do {
			rc = zcrypt_send_cprb(&xcRB);
		} while (rc == -EAGAIN);
789 790 791 792 793
		/* on failure: retry once again after a requested rescan */
		if ((rc == -ENODEV) && (zcrypt_process_rescan()))
			do {
				rc = zcrypt_send_cprb(&xcRB);
			} while (rc == -EAGAIN);
794 795 796 797
		if (copy_to_user(uxcRB, &xcRB, sizeof(xcRB)))
			return -EFAULT;
		return rc;
	}
798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814
	case ZSENDEP11CPRB: {
		struct ep11_urb __user *uxcrb = (void __user *)arg;
		struct ep11_urb xcrb;
		if (copy_from_user(&xcrb, uxcrb, sizeof(xcrb)))
			return -EFAULT;
		do {
			rc = zcrypt_send_ep11_cprb(&xcrb);
		} while (rc == -EAGAIN);
		/* on failure: retry once again after a requested rescan */
		if ((rc == -ENODEV) && (zcrypt_process_rescan()))
			do {
				rc = zcrypt_send_ep11_cprb(&xcrb);
			} while (rc == -EAGAIN);
		if (copy_to_user(uxcrb, &xcrb, sizeof(xcrb)))
			return -EFAULT;
		return rc;
	}
815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833
	case ZDEVICESTATUS: {
		struct zcrypt_device_matrix *device_status;

		device_status = kzalloc(sizeof(struct zcrypt_device_matrix),
					GFP_KERNEL);
		if (!device_status)
			return -ENOMEM;

		zcrypt_device_status_mask(device_status);

		if (copy_to_user((char __user *) arg, device_status,
				 sizeof(struct zcrypt_device_matrix))) {
			kfree(device_status);
			return -EFAULT;
		}

		kfree(device_status);
		return 0;
	}
834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866
	case Z90STAT_STATUS_MASK: {
		char status[AP_DEVICES];
		zcrypt_status_mask(status);
		if (copy_to_user((char __user *) arg, status,
				 sizeof(char) * AP_DEVICES))
			return -EFAULT;
		return 0;
	}
	case Z90STAT_QDEPTH_MASK: {
		char qdepth[AP_DEVICES];
		zcrypt_qdepth_mask(qdepth);
		if (copy_to_user((char __user *) arg, qdepth,
				 sizeof(char) * AP_DEVICES))
			return -EFAULT;
		return 0;
	}
	case Z90STAT_PERDEV_REQCNT: {
		int reqcnt[AP_DEVICES];
		zcrypt_perdev_reqcnt(reqcnt);
		if (copy_to_user((int __user *) arg, reqcnt,
				 sizeof(int) * AP_DEVICES))
			return -EFAULT;
		return 0;
	}
	case Z90STAT_REQUESTQ_COUNT:
		return put_user(zcrypt_requestq_count(), (int __user *) arg);
	case Z90STAT_PENDINGQ_COUNT:
		return put_user(zcrypt_pendingq_count(), (int __user *) arg);
	case Z90STAT_TOTALOPEN_COUNT:
		return put_user(atomic_read(&zcrypt_open_count),
				(int __user *) arg);
	case Z90STAT_DOMAIN_INDEX:
		return put_user(ap_domain_index, (int __user *) arg);
867
	/*
868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904
	 * Deprecated ioctls. Don't add another device count ioctl,
	 * you can count them yourself in the user space with the
	 * output of the Z90STAT_STATUS_MASK ioctl.
	 */
	case ICAZ90STATUS:
		return zcrypt_ica_status(filp, arg);
	case Z90STAT_TOTALCOUNT:
		return put_user(zcrypt_device_count, (int __user *) arg);
	case Z90STAT_PCICACOUNT:
		return put_user(zcrypt_count_type(ZCRYPT_PCICA),
				(int __user *) arg);
	case Z90STAT_PCICCCOUNT:
		return put_user(zcrypt_count_type(ZCRYPT_PCICC),
				(int __user *) arg);
	case Z90STAT_PCIXCCMCL2COUNT:
		return put_user(zcrypt_count_type(ZCRYPT_PCIXCC_MCL2),
				(int __user *) arg);
	case Z90STAT_PCIXCCMCL3COUNT:
		return put_user(zcrypt_count_type(ZCRYPT_PCIXCC_MCL3),
				(int __user *) arg);
	case Z90STAT_PCIXCCCOUNT:
		return put_user(zcrypt_count_type(ZCRYPT_PCIXCC_MCL2) +
				zcrypt_count_type(ZCRYPT_PCIXCC_MCL3),
				(int __user *) arg);
	case Z90STAT_CEX2CCOUNT:
		return put_user(zcrypt_count_type(ZCRYPT_CEX2C),
				(int __user *) arg);
	case Z90STAT_CEX2ACOUNT:
		return put_user(zcrypt_count_type(ZCRYPT_CEX2A),
				(int __user *) arg);
	default:
		/* unknown ioctl number */
		return -ENOIOCTLCMD;
	}
}

#ifdef CONFIG_COMPAT
905
/*
906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935
 * ioctl32 conversion routines
 */
struct compat_ica_rsa_modexpo {
	compat_uptr_t	inputdata;
	unsigned int	inputdatalength;
	compat_uptr_t	outputdata;
	unsigned int	outputdatalength;
	compat_uptr_t	b_key;
	compat_uptr_t	n_modulus;
};

static long trans_modexpo32(struct file *filp, unsigned int cmd,
			    unsigned long arg)
{
	struct compat_ica_rsa_modexpo __user *umex32 = compat_ptr(arg);
	struct compat_ica_rsa_modexpo mex32;
	struct ica_rsa_modexpo mex64;
	long rc;

	if (copy_from_user(&mex32, umex32, sizeof(mex32)))
		return -EFAULT;
	mex64.inputdata = compat_ptr(mex32.inputdata);
	mex64.inputdatalength = mex32.inputdatalength;
	mex64.outputdata = compat_ptr(mex32.outputdata);
	mex64.outputdatalength = mex32.outputdatalength;
	mex64.b_key = compat_ptr(mex32.b_key);
	mex64.n_modulus = compat_ptr(mex32.n_modulus);
	do {
		rc = zcrypt_rsa_modexpo(&mex64);
	} while (rc == -EAGAIN);
936 937 938 939 940 941 942 943 944
	/* on failure: retry once again after a requested rescan */
	if ((rc == -ENODEV) && (zcrypt_process_rescan()))
		do {
			rc = zcrypt_rsa_modexpo(&mex64);
		} while (rc == -EAGAIN);
	if (rc)
		return rc;
	return put_user(mex64.outputdatalength,
			&umex32->outputdatalength);
945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980
}

struct compat_ica_rsa_modexpo_crt {
	compat_uptr_t	inputdata;
	unsigned int	inputdatalength;
	compat_uptr_t	outputdata;
	unsigned int	outputdatalength;
	compat_uptr_t	bp_key;
	compat_uptr_t	bq_key;
	compat_uptr_t	np_prime;
	compat_uptr_t	nq_prime;
	compat_uptr_t	u_mult_inv;
};

static long trans_modexpo_crt32(struct file *filp, unsigned int cmd,
				unsigned long arg)
{
	struct compat_ica_rsa_modexpo_crt __user *ucrt32 = compat_ptr(arg);
	struct compat_ica_rsa_modexpo_crt crt32;
	struct ica_rsa_modexpo_crt crt64;
	long rc;

	if (copy_from_user(&crt32, ucrt32, sizeof(crt32)))
		return -EFAULT;
	crt64.inputdata = compat_ptr(crt32.inputdata);
	crt64.inputdatalength = crt32.inputdatalength;
	crt64.outputdata=  compat_ptr(crt32.outputdata);
	crt64.outputdatalength = crt32.outputdatalength;
	crt64.bp_key = compat_ptr(crt32.bp_key);
	crt64.bq_key = compat_ptr(crt32.bq_key);
	crt64.np_prime = compat_ptr(crt32.np_prime);
	crt64.nq_prime = compat_ptr(crt32.nq_prime);
	crt64.u_mult_inv = compat_ptr(crt32.u_mult_inv);
	do {
		rc = zcrypt_rsa_crt(&crt64);
	} while (rc == -EAGAIN);
981 982 983 984 985 986 987 988 989
	/* on failure: retry once again after a requested rescan */
	if ((rc == -ENODEV) && (zcrypt_process_rescan()))
		do {
			rc = zcrypt_rsa_crt(&crt64);
		} while (rc == -EAGAIN);
	if (rc)
		return rc;
	return put_user(crt64.outputdatalength,
			&ucrt32->outputdatalength);
990 991
}

992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044
struct compat_ica_xcRB {
	unsigned short	agent_ID;
	unsigned int	user_defined;
	unsigned short	request_ID;
	unsigned int	request_control_blk_length;
	unsigned char	padding1[16 - sizeof (compat_uptr_t)];
	compat_uptr_t	request_control_blk_addr;
	unsigned int	request_data_length;
	char		padding2[16 - sizeof (compat_uptr_t)];
	compat_uptr_t	request_data_address;
	unsigned int	reply_control_blk_length;
	char		padding3[16 - sizeof (compat_uptr_t)];
	compat_uptr_t	reply_control_blk_addr;
	unsigned int	reply_data_length;
	char		padding4[16 - sizeof (compat_uptr_t)];
	compat_uptr_t	reply_data_addr;
	unsigned short	priority_window;
	unsigned int	status;
} __attribute__((packed));

static long trans_xcRB32(struct file *filp, unsigned int cmd,
			 unsigned long arg)
{
	struct compat_ica_xcRB __user *uxcRB32 = compat_ptr(arg);
	struct compat_ica_xcRB xcRB32;
	struct ica_xcRB xcRB64;
	long rc;

	if (copy_from_user(&xcRB32, uxcRB32, sizeof(xcRB32)))
		return -EFAULT;
	xcRB64.agent_ID = xcRB32.agent_ID;
	xcRB64.user_defined = xcRB32.user_defined;
	xcRB64.request_ID = xcRB32.request_ID;
	xcRB64.request_control_blk_length =
		xcRB32.request_control_blk_length;
	xcRB64.request_control_blk_addr =
		compat_ptr(xcRB32.request_control_blk_addr);
	xcRB64.request_data_length =
		xcRB32.request_data_length;
	xcRB64.request_data_address =
		compat_ptr(xcRB32.request_data_address);
	xcRB64.reply_control_blk_length =
		xcRB32.reply_control_blk_length;
	xcRB64.reply_control_blk_addr =
		compat_ptr(xcRB32.reply_control_blk_addr);
	xcRB64.reply_data_length = xcRB32.reply_data_length;
	xcRB64.reply_data_addr =
		compat_ptr(xcRB32.reply_data_addr);
	xcRB64.priority_window = xcRB32.priority_window;
	xcRB64.status = xcRB32.status;
	do {
		rc = zcrypt_send_cprb(&xcRB64);
	} while (rc == -EAGAIN);
1045 1046 1047 1048 1049
	/* on failure: retry once again after a requested rescan */
	if ((rc == -ENODEV) && (zcrypt_process_rescan()))
		do {
			rc = zcrypt_send_cprb(&xcRB64);
		} while (rc == -EAGAIN);
1050 1051 1052 1053 1054 1055 1056 1057
	xcRB32.reply_control_blk_length = xcRB64.reply_control_blk_length;
	xcRB32.reply_data_length = xcRB64.reply_data_length;
	xcRB32.status = xcRB64.status;
	if (copy_to_user(uxcRB32, &xcRB32, sizeof(xcRB32)))
			return -EFAULT;
	return rc;
}

1058
static long zcrypt_compat_ioctl(struct file *filp, unsigned int cmd,
1059 1060 1061 1062 1063 1064
			 unsigned long arg)
{
	if (cmd == ICARSAMODEXPO)
		return trans_modexpo32(filp, cmd, arg);
	if (cmd == ICARSACRT)
		return trans_modexpo_crt32(filp, cmd, arg);
1065 1066
	if (cmd == ZSECSENDCPRB)
		return trans_xcRB32(filp, cmd, arg);
1067 1068 1069 1070
	return zcrypt_unlocked_ioctl(filp, cmd, arg);
}
#endif

1071
/*
1072 1073
 * Misc device file operations.
 */
1074
static const struct file_operations zcrypt_fops = {
1075 1076 1077 1078 1079 1080 1081 1082
	.owner		= THIS_MODULE,
	.read		= zcrypt_read,
	.write		= zcrypt_write,
	.unlocked_ioctl	= zcrypt_unlocked_ioctl,
#ifdef CONFIG_COMPAT
	.compat_ioctl	= zcrypt_compat_ioctl,
#endif
	.open		= zcrypt_open,
1083 1084
	.release	= zcrypt_release,
	.llseek		= no_llseek,
1085 1086
};

1087
/*
1088 1089 1090 1091 1092 1093 1094 1095
 * Misc device.
 */
static struct miscdevice zcrypt_misc_device = {
	.minor	    = MISC_DYNAMIC_MINOR,
	.name	    = "z90crypt",
	.fops	    = &zcrypt_fops,
};

1096
/*
1097 1098 1099 1100
 * Deprecated /proc entry support.
 */
static struct proc_dir_entry *zcrypt_entry;

1101
static void sprintcl(struct seq_file *m, unsigned char *addr, unsigned int len)
1102
{
1103
	int i;
1104 1105

	for (i = 0; i < len; i++)
1106 1107
		seq_printf(m, "%01x", (unsigned int) addr[i]);
	seq_putc(m, ' ');
1108 1109
}

1110
static void sprintrw(struct seq_file *m, unsigned char *addr, unsigned int len)
1111
{
1112
	int inl, c, cx;
1113

1114
	seq_printf(m, "	   ");
1115 1116
	inl = 0;
	for (c = 0; c < (len / 16); c++) {
1117
		sprintcl(m, addr+inl, 16);
1118 1119 1120 1121
		inl += 16;
	}
	cx = len%16;
	if (cx) {
1122
		sprintcl(m, addr+inl, cx);
1123 1124
		inl += cx;
	}
1125
	seq_putc(m, '\n');
1126 1127
}

1128 1129
static void sprinthx(unsigned char *title, struct seq_file *m,
		     unsigned char *addr, unsigned int len)
1130
{
1131
	int inl, r, rx;
1132

1133
	seq_printf(m, "\n%s\n", title);
1134 1135
	inl = 0;
	for (r = 0; r < (len / 64); r++) {
1136
		sprintrw(m, addr+inl, 64);
1137 1138 1139 1140
		inl += 64;
	}
	rx = len % 64;
	if (rx) {
1141
		sprintrw(m, addr+inl, rx);
1142 1143
		inl += rx;
	}
1144
	seq_putc(m, '\n');
1145 1146
}

1147 1148
static void sprinthx4(unsigned char *title, struct seq_file *m,
		      unsigned int *array, unsigned int len)
1149
{
1150
	seq_printf(m, "\n%s\n", title);
1151
	seq_hex_dump(m, "    ", DUMP_PREFIX_NONE, 32, 4, array, len, false);
1152
	seq_putc(m, '\n');
1153 1154
}

1155
static int zcrypt_proc_show(struct seq_file *m, void *v)
1156
{
1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176
	char workarea[sizeof(int) * AP_DEVICES];

	seq_printf(m, "\nzcrypt version: %d.%d.%d\n",
		   ZCRYPT_VERSION, ZCRYPT_RELEASE, ZCRYPT_VARIANT);
	seq_printf(m, "Cryptographic domain: %d\n", ap_domain_index);
	seq_printf(m, "Total device count: %d\n", zcrypt_device_count);
	seq_printf(m, "PCICA count: %d\n", zcrypt_count_type(ZCRYPT_PCICA));
	seq_printf(m, "PCICC count: %d\n", zcrypt_count_type(ZCRYPT_PCICC));
	seq_printf(m, "PCIXCC MCL2 count: %d\n",
		   zcrypt_count_type(ZCRYPT_PCIXCC_MCL2));
	seq_printf(m, "PCIXCC MCL3 count: %d\n",
		   zcrypt_count_type(ZCRYPT_PCIXCC_MCL3));
	seq_printf(m, "CEX2C count: %d\n", zcrypt_count_type(ZCRYPT_CEX2C));
	seq_printf(m, "CEX2A count: %d\n", zcrypt_count_type(ZCRYPT_CEX2A));
	seq_printf(m, "CEX3C count: %d\n", zcrypt_count_type(ZCRYPT_CEX3C));
	seq_printf(m, "CEX3A count: %d\n", zcrypt_count_type(ZCRYPT_CEX3A));
	seq_printf(m, "requestq count: %d\n", zcrypt_requestq_count());
	seq_printf(m, "pendingq count: %d\n", zcrypt_pendingq_count());
	seq_printf(m, "Total open handles: %d\n\n",
		   atomic_read(&zcrypt_open_count));
1177
	zcrypt_status_mask(workarea);
1178 1179 1180
	sprinthx("Online devices: 1=PCICA 2=PCICC 3=PCIXCC(MCL2) "
		 "4=PCIXCC(MCL3) 5=CEX2C 6=CEX2A 7=CEX3C 8=CEX3A",
		 m, workarea, AP_DEVICES);
1181
	zcrypt_qdepth_mask(workarea);
1182
	sprinthx("Waiting work element counts", m, workarea, AP_DEVICES);
1183
	zcrypt_perdev_reqcnt((int *) workarea);
1184 1185 1186 1187 1188 1189 1190 1191
	sprinthx4("Per-device successfully completed request counts",
		  m, (unsigned int *) workarea, AP_DEVICES);
	return 0;
}

static int zcrypt_proc_open(struct inode *inode, struct file *file)
{
	return single_open(file, zcrypt_proc_show, NULL);
1192 1193 1194 1195
}

static void zcrypt_disable_card(int index)
{
1196 1197
	struct zcrypt_card *zc;
	struct zcrypt_queue *zq;
1198

1199 1200 1201 1202 1203 1204 1205
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		for_each_zcrypt_queue(zq, zc) {
			if (AP_QID_QUEUE(zq->queue->qid) != ap_domain_index)
				continue;
			zq->online = 0;
			ap_flush_queue(zq->queue);
1206
		}
1207 1208
	}
	spin_unlock(&zcrypt_list_lock);
1209 1210 1211 1212
}

static void zcrypt_enable_card(int index)
{
1213 1214
	struct zcrypt_card *zc;
	struct zcrypt_queue *zq;
1215

1216 1217 1218 1219 1220 1221 1222
	spin_lock(&zcrypt_list_lock);
	for_each_zcrypt_card(zc) {
		for_each_zcrypt_queue(zq, zc) {
			if (AP_QID_QUEUE(zq->queue->qid) != ap_domain_index)
				continue;
			zq->online = 1;
			ap_flush_queue(zq->queue);
1223
		}
1224 1225
	}
	spin_unlock(&zcrypt_list_lock);
1226 1227
}

1228 1229
static ssize_t zcrypt_proc_write(struct file *file, const char __user *buffer,
				 size_t count, loff_t *pos)
1230 1231
{
	unsigned char *lbuf, *ptr;
1232
	size_t local_count;
1233 1234 1235 1236 1237 1238 1239
	int j;

	if (count <= 0)
		return 0;

#define LBUFSIZE 1200UL
	lbuf = kmalloc(LBUFSIZE, GFP_KERNEL);
1240
	if (!lbuf)
1241 1242 1243 1244 1245 1246 1247 1248 1249 1250
		return 0;

	local_count = min(LBUFSIZE - 1, count);
	if (copy_from_user(lbuf, buffer, local_count) != 0) {
		kfree(lbuf);
		return -EFAULT;
	}
	lbuf[local_count] = '\0';

	ptr = strstr(lbuf, "Online devices");
1251
	if (!ptr)
1252 1253
		goto out;
	ptr = strstr(ptr, "\n");
1254
	if (!ptr)
1255 1256 1257
		goto out;
	ptr++;

1258
	if (strstr(ptr, "Waiting work element counts") == NULL)
1259 1260 1261
		goto out;

	for (j = 0; j < 64 && *ptr; ptr++) {
1262
		/*
1263 1264 1265
		 * '0' for no device, '1' for PCICA, '2' for PCICC,
		 * '3' for PCIXCC_MCL2, '4' for PCIXCC_MCL3,
		 * '5' for CEX2C and '6' for CEX2A'
1266
		 * '7' for CEX3C and '8' for CEX3A
1267
		 */
1268
		if (*ptr >= '0' && *ptr <= '8')
1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281
			j++;
		else if (*ptr == 'd' || *ptr == 'D')
			zcrypt_disable_card(j++);
		else if (*ptr == 'e' || *ptr == 'E')
			zcrypt_enable_card(j++);
		else if (*ptr != ' ' && *ptr != '\t')
			break;
	}
out:
	kfree(lbuf);
	return count;
}

1282 1283 1284 1285 1286 1287 1288 1289 1290
static const struct file_operations zcrypt_proc_fops = {
	.owner		= THIS_MODULE,
	.open		= zcrypt_proc_open,
	.read		= seq_read,
	.llseek		= seq_lseek,
	.release	= single_release,
	.write		= zcrypt_proc_write,
};

1291 1292 1293 1294 1295 1296 1297 1298 1299
static int zcrypt_rng_device_count;
static u32 *zcrypt_rng_buffer;
static int zcrypt_rng_buffer_index;
static DEFINE_MUTEX(zcrypt_rng_mutex);

static int zcrypt_rng_data_read(struct hwrng *rng, u32 *data)
{
	int rc;

1300
	/*
1301 1302 1303 1304 1305
	 * We don't need locking here because the RNG API guarantees serialized
	 * read method calls.
	 */
	if (zcrypt_rng_buffer_index == 0) {
		rc = zcrypt_rng((char *) zcrypt_rng_buffer);
1306 1307 1308
		/* on failure: retry once again after a requested rescan */
		if ((rc == -ENODEV) && (zcrypt_process_rescan()))
			rc = zcrypt_rng((char *) zcrypt_rng_buffer);
1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319
		if (rc < 0)
			return -EIO;
		zcrypt_rng_buffer_index = rc / sizeof *data;
	}
	*data = zcrypt_rng_buffer[--zcrypt_rng_buffer_index];
	return sizeof *data;
}

static struct hwrng zcrypt_rng_dev = {
	.name		= "zcrypt",
	.data_read	= zcrypt_rng_data_read,
1320
	.quality	= 990,
1321 1322
};

1323
int zcrypt_rng_device_add(void)
1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334
{
	int rc = 0;

	mutex_lock(&zcrypt_rng_mutex);
	if (zcrypt_rng_device_count == 0) {
		zcrypt_rng_buffer = (u32 *) get_zeroed_page(GFP_KERNEL);
		if (!zcrypt_rng_buffer) {
			rc = -ENOMEM;
			goto out;
		}
		zcrypt_rng_buffer_index = 0;
1335 1336
		if (!zcrypt_hwrng_seed)
			zcrypt_rng_dev.quality = 0;
1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352
		rc = hwrng_register(&zcrypt_rng_dev);
		if (rc)
			goto out_free;
		zcrypt_rng_device_count = 1;
	} else
		zcrypt_rng_device_count++;
	mutex_unlock(&zcrypt_rng_mutex);
	return 0;

out_free:
	free_page((unsigned long) zcrypt_rng_buffer);
out:
	mutex_unlock(&zcrypt_rng_mutex);
	return rc;
}

1353
void zcrypt_rng_device_remove(void)
1354 1355 1356 1357 1358 1359 1360 1361 1362 1363
{
	mutex_lock(&zcrypt_rng_mutex);
	zcrypt_rng_device_count--;
	if (zcrypt_rng_device_count == 0) {
		hwrng_unregister(&zcrypt_rng_dev);
		free_page((unsigned long) zcrypt_rng_buffer);
	}
	mutex_unlock(&zcrypt_rng_mutex);
}

1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375
int __init zcrypt_debug_init(void)
{
	debugfs_root = debugfs_create_dir("zcrypt", NULL);

	zcrypt_dbf_common = debug_register("zcrypt_common", 1, 1, 16);
	debug_register_view(zcrypt_dbf_common, &debug_hex_ascii_view);
	debug_set_level(zcrypt_dbf_common, DBF_ERR);

	zcrypt_dbf_devices = debug_register("zcrypt_devices", 1, 1, 16);
	debug_register_view(zcrypt_dbf_devices, &debug_hex_ascii_view);
	debug_set_level(zcrypt_dbf_devices, DBF_ERR);

1376 1377 1378 1379
	zcrypt_dbf_cards = debug_register("zcrypt_cards", 1, 1, 16);
	debug_register_view(zcrypt_dbf_cards, &debug_hex_ascii_view);
	debug_set_level(zcrypt_dbf_cards, DBF_ERR);

1380 1381 1382 1383 1384 1385
	return 0;
}

void zcrypt_debug_exit(void)
{
	debugfs_remove(debugfs_root);
1386 1387
	debug_unregister(zcrypt_dbf_common);
	debug_unregister(zcrypt_dbf_devices);
1388 1389
}

1390
/**
1391 1392
 * zcrypt_api_init(): Module initialization.
 *
1393 1394 1395 1396 1397 1398
 * The module initialization code.
 */
int __init zcrypt_api_init(void)
{
	int rc;

1399 1400 1401 1402 1403 1404
	rc = zcrypt_debug_init();
	if (rc)
		goto out;

	atomic_set(&zcrypt_rescan_req, 0);

1405 1406
	/* Register the request sprayer. */
	rc = misc_register(&zcrypt_misc_device);
1407
	if (rc < 0)
1408 1409 1410
		goto out;

	/* Set up the proc file system */
1411 1412
	zcrypt_entry = proc_create("driver/z90crypt", 0644, NULL,
				   &zcrypt_proc_fops);
1413 1414 1415 1416 1417
	if (!zcrypt_entry) {
		rc = -ENOMEM;
		goto out_misc;
	}

1418 1419
	zcrypt_msgtype6_init();
	zcrypt_msgtype50_init();
1420 1421 1422 1423 1424 1425 1426 1427 1428
	return 0;

out_misc:
	misc_deregister(&zcrypt_misc_device);
out:
	return rc;
}

/**
1429 1430
 * zcrypt_api_exit(): Module termination.
 *
1431 1432
 * The module termination code.
 */
1433
void __exit zcrypt_api_exit(void)
1434 1435 1436
{
	remove_proc_entry("driver/z90crypt", NULL);
	misc_deregister(&zcrypt_misc_device);
1437
	zcrypt_debug_exit();
1438 1439
	zcrypt_msgtype6_exit();
	zcrypt_msgtype50_exit();
1440 1441 1442 1443
}

module_init(zcrypt_api_init);
module_exit(zcrypt_api_exit);