ap_bus.c 53.1 KB
Newer Older
1
/*
2
 * Copyright IBM Corp. 2006, 2012
3 4 5
 * Author(s): Cornelia Huck <cornelia.huck@de.ibm.com>
 *	      Martin Schwidefsky <schwidefsky@de.ibm.com>
 *	      Ralph Wuerthner <rwuerthn@de.ibm.com>
F
Felix Beck 已提交
6
 *	      Felix Beck <felix.beck@de.ibm.com>
7
 *	      Holger Dengler <hd@linux.vnet.ibm.com>
8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25
 *
 * Adjunct processor bus.
 *
 * 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.
 */

26 27 28
#define KMSG_COMPONENT "ap"
#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt

29
#include <linux/kernel_stat.h>
30 31 32 33 34 35
#include <linux/module.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/err.h>
#include <linux/interrupt.h>
#include <linux/workqueue.h>
36
#include <linux/slab.h>
37 38 39
#include <linux/notifier.h>
#include <linux/kthread.h>
#include <linux/mutex.h>
40
#include <asm/reset.h>
F
Felix Beck 已提交
41
#include <asm/airq.h>
A
Arun Sharma 已提交
42
#include <linux/atomic.h>
F
Felix Beck 已提交
43
#include <asm/isc.h>
44 45
#include <linux/hrtimer.h>
#include <linux/ktime.h>
46
#include <asm/facility.h>
47 48 49 50

#include "ap_bus.h"

/* Some prototypes. */
51
static void ap_scan_bus(struct work_struct *);
52
static void ap_poll_all(unsigned long);
53
static enum hrtimer_restart ap_poll_timeout(struct hrtimer *);
54 55
static int ap_poll_thread_start(void);
static void ap_poll_thread_stop(void);
56
static void ap_request_timeout(unsigned long);
F
Felix Beck 已提交
57
static inline void ap_schedule_poll_timer(void);
58 59 60
static int __ap_poll_device(struct ap_device *ap_dev, unsigned long *flags);
static int ap_device_remove(struct device *dev);
static int ap_device_probe(struct device *dev);
61
static void ap_interrupt_handler(struct airq_struct *airq);
62 63
static void ap_reset(struct ap_device *ap_dev);
static void ap_config_timeout(unsigned long ptr);
64
static int ap_select_domain(void);
65
static void ap_query_configuration(void);
66

67
/*
68 69 70
 * Module description.
 */
MODULE_AUTHOR("IBM Corporation");
71 72
MODULE_DESCRIPTION("Adjunct Processor Bus driver, " \
		   "Copyright IBM Corp. 2006, 2012");
73
MODULE_LICENSE("GPL");
74
MODULE_ALIAS("z90crypt");
75

76
/*
77 78 79
 * Module parameter
 */
int ap_domain_index = -1;	/* Adjunct Processor Domain Index */
80
module_param_named(domain, ap_domain_index, int, S_IRUSR|S_IRGRP);
81 82 83
MODULE_PARM_DESC(domain, "domain index for ap devices");
EXPORT_SYMBOL(ap_domain_index);

84
static int ap_thread_flag = 0;
85
module_param_named(poll_thread, ap_thread_flag, int, S_IRUSR|S_IRGRP);
86
MODULE_PARM_DESC(poll_thread, "Turn on/off poll thread, default is 0 (off).");
87 88

static struct device *ap_root_device = NULL;
89
static struct ap_config_info *ap_configuration;
90
static DEFINE_SPINLOCK(ap_device_list_lock);
91
static LIST_HEAD(ap_device_list);
92

93
/*
94 95 96 97 98
 * Workqueue & timer for bus rescan.
 */
static struct workqueue_struct *ap_work_queue;
static struct timer_list ap_config_timer;
static int ap_config_time = AP_CONFIG_TIME;
99
static DECLARE_WORK(ap_config_work, ap_scan_bus);
100

101
/*
F
Felix Beck 已提交
102
 * Tasklet & timer for AP request polling and interrupts
103 104 105 106 107 108
 */
static DECLARE_TASKLET(ap_tasklet, ap_poll_all, 0);
static atomic_t ap_poll_requests = ATOMIC_INIT(0);
static DECLARE_WAIT_QUEUE_HEAD(ap_poll_wait);
static struct task_struct *ap_poll_kthread = NULL;
static DEFINE_MUTEX(ap_poll_thread_mutex);
109
static DEFINE_SPINLOCK(ap_poll_timer_lock);
110 111 112 113
static struct hrtimer ap_poll_timer;
/* In LPAR poll with 4kHz frequency. Poll every 250000 nanoseconds.
 * If z/VM change to 1500000 nanoseconds to adjust to z/VM polling.*/
static unsigned long long poll_timeout = 250000;
114

115 116
/* Suspend flag */
static int ap_suspend_flag;
117 118 119 120
/* Flag to check if domain was set through module parameter domain=. This is
 * important when supsend and resume is done in a z/VM environment where the
 * domain might change. */
static int user_set_domain = 0;
121 122
static struct bus_type ap_bus_type;

123 124 125 126 127 128 129 130
/* Adapter interrupt definitions */
static int ap_airq_flag;

static struct airq_struct ap_airq = {
	.handler = ap_interrupt_handler,
	.isc = AP_ISC,
};

F
Felix Beck 已提交
131 132 133 134 135 136
/**
 * ap_using_interrupts() - Returns non-zero if interrupt support is
 * available.
 */
static inline int ap_using_interrupts(void)
{
137
	return ap_airq_flag;
F
Felix Beck 已提交
138 139
}

140
/**
141
 * ap_intructions_available() - Test if AP instructions are available.
142
 *
143
 * Returns 0 if the AP instructions are installed.
144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159
 */
static inline int ap_instructions_available(void)
{
	register unsigned long reg0 asm ("0") = AP_MKQID(0,0);
	register unsigned long reg1 asm ("1") = -ENODEV;
	register unsigned long reg2 asm ("2") = 0UL;

	asm volatile(
		"   .long 0xb2af0000\n"		/* PQAP(TAPQ) */
		"0: la    %1,0\n"
		"1:\n"
		EX_TABLE(0b, 1b)
		: "+d" (reg0), "+d" (reg1), "+d" (reg2) : : "cc" );
	return reg1;
}

F
Felix Beck 已提交
160 161 162 163 164 165 166
/**
 * ap_interrupts_available(): Test if AP interrupts are available.
 *
 * Returns 1 if AP interrupts are available.
 */
static int ap_interrupts_available(void)
{
167
	return test_facility(2) && test_facility(65);
F
Felix Beck 已提交
168 169
}

170 171 172 173 174 175
/**
 * ap_configuration_available(): Test if AP configuration
 * information is available.
 *
 * Returns 1 if AP configuration information is available.
 */
H
Heiko Carstens 已提交
176
#ifdef CONFIG_64BIT
177 178 179 180
static int ap_configuration_available(void)
{
	return test_facility(2) && test_facility(12);
}
H
Heiko Carstens 已提交
181
#endif
182

183
/**
184 185 186 187
 * ap_test_queue(): Test adjunct processor queue.
 * @qid: The AP queue number
 * @queue_depth: Pointer to queue depth value
 * @device_type: Pointer to device type value
188
 *
189
 * Returns AP queue status structure.
190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205
 */
static inline struct ap_queue_status
ap_test_queue(ap_qid_t qid, int *queue_depth, int *device_type)
{
	register unsigned long reg0 asm ("0") = qid;
	register struct ap_queue_status reg1 asm ("1");
	register unsigned long reg2 asm ("2") = 0UL;

	asm volatile(".long 0xb2af0000"		/* PQAP(TAPQ) */
		     : "+d" (reg0), "=d" (reg1), "+d" (reg2) : : "cc");
	*device_type = (int) (reg2 >> 24);
	*queue_depth = (int) (reg2 & 0xff);
	return reg1;
}

/**
206 207
 * ap_reset_queue(): Reset adjunct processor queue.
 * @qid: The AP queue number
208
 *
209
 * Returns AP queue status structure.
210 211 212 213 214 215 216 217 218 219 220 221 222
 */
static inline struct ap_queue_status ap_reset_queue(ap_qid_t qid)
{
	register unsigned long reg0 asm ("0") = qid | 0x01000000UL;
	register struct ap_queue_status reg1 asm ("1");
	register unsigned long reg2 asm ("2") = 0UL;

	asm volatile(
		".long 0xb2af0000"		/* PQAP(RAPQ) */
		: "+d" (reg0), "=d" (reg1), "+d" (reg2) : : "cc");
	return reg1;
}

F
Felix Beck 已提交
223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238
#ifdef CONFIG_64BIT
/**
 * ap_queue_interruption_control(): Enable interruption for a specific AP.
 * @qid: The AP queue number
 * @ind: The notification indicator byte
 *
 * Returns AP queue status.
 */
static inline struct ap_queue_status
ap_queue_interruption_control(ap_qid_t qid, void *ind)
{
	register unsigned long reg0 asm ("0") = qid | 0x03000000UL;
	register unsigned long reg1_in asm ("1") = 0x0000800000000000UL | AP_ISC;
	register struct ap_queue_status reg1_out asm ("1");
	register void *reg2 asm ("2") = ind;
	asm volatile(
239
		".long 0xb2af0000"		/* PQAP(AQIC) */
F
Felix Beck 已提交
240 241 242 243 244 245 246
		: "+d" (reg0), "+d" (reg1_in), "=d" (reg1_out), "+d" (reg2)
		:
		: "cc" );
	return reg1_out;
}
#endif

247 248 249
#ifdef CONFIG_64BIT
static inline struct ap_queue_status
__ap_query_functions(ap_qid_t qid, unsigned int *functions)
250 251
{
	register unsigned long reg0 asm ("0") = 0UL | qid | (1UL << 23);
252 253
	register struct ap_queue_status reg1 asm ("1") = AP_QUEUE_STATUS_INVALID;
	register unsigned long reg2 asm ("2");
254 255

	asm volatile(
256
		".long 0xb2af0000\n"		/* PQAP(TAPQ) */
257 258 259
		"0:\n"
		EX_TABLE(0b, 0b)
		: "+d" (reg0), "+d" (reg1), "=d" (reg2)
260 261 262
		:
		: "cc");

263
	*functions = (unsigned int)(reg2 >> 32);
264 265
	return reg1;
}
266
#endif
267

268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287
#ifdef CONFIG_64BIT
static inline int __ap_query_configuration(struct ap_config_info *config)
{
	register unsigned long reg0 asm ("0") = 0x04000000UL;
	register unsigned long reg1 asm ("1") = -EINVAL;
	register unsigned char *reg2 asm ("2") = (unsigned char *)config;

	asm volatile(
		".long 0xb2af0000\n"		/* PQAP(QCI) */
		"0: la    %1,0\n"
		"1:\n"
		EX_TABLE(0b, 1b)
		: "+d" (reg0), "+d" (reg1), "+d" (reg2)
		:
		: "cc");

	return reg1;
}
#endif

288
/**
289
 * ap_query_functions(): Query supported functions.
290
 * @qid: The AP queue number
291
 * @functions: Pointer to functions field.
292
 *
293 294 295 296 297
 * Returns
 *   0	     on success.
 *   -ENODEV  if queue not valid.
 *   -EBUSY   if device busy.
 *   -EINVAL  if query function is not supported
298
 */
299
static int ap_query_functions(ap_qid_t qid, unsigned int *functions)
300
{
301
#ifdef CONFIG_64BIT
302
	struct ap_queue_status status;
303 304
	int i;
	status = __ap_query_functions(qid, functions);
305 306

	for (i = 0; i < AP_MAX_RESET; i++) {
307 308 309
		if (ap_queue_status_invalid_test(&status))
			return -ENODEV;

310 311
		switch (status.response_code) {
		case AP_RESPONSE_NORMAL:
312
			return 0;
313 314 315 316 317 318 319
		case AP_RESPONSE_RESET_IN_PROGRESS:
		case AP_RESPONSE_BUSY:
			break;
		case AP_RESPONSE_Q_NOT_AVAIL:
		case AP_RESPONSE_DECONFIGURED:
		case AP_RESPONSE_CHECKSTOPPED:
		case AP_RESPONSE_INVALID_ADDRESS:
320
			return -ENODEV;
321 322 323 324 325 326 327
		case AP_RESPONSE_OTHERWISE_CHANGED:
			break;
		default:
			break;
		}
		if (i < AP_MAX_RESET - 1) {
			udelay(5);
328
			status = __ap_query_functions(qid, functions);
329 330
		}
	}
331 332 333 334 335 336
	return -EBUSY;
#else
	return -EINVAL;
#endif
}

F
Felix Beck 已提交
337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362
/**
 * ap_queue_enable_interruption(): Enable interruption on an AP.
 * @qid: The AP queue number
 * @ind: the notification indicator byte
 *
 * Enables interruption on AP queue via ap_queue_interruption_control(). Based
 * on the return value it waits a while and tests the AP queue if interrupts
 * have been switched on using ap_test_queue().
 */
static int ap_queue_enable_interruption(ap_qid_t qid, void *ind)
{
#ifdef CONFIG_64BIT
	struct ap_queue_status status;
	int t_depth, t_device_type, rc, i;

	rc = -EBUSY;
	status = ap_queue_interruption_control(qid, ind);

	for (i = 0; i < AP_MAX_RESET; i++) {
		switch (status.response_code) {
		case AP_RESPONSE_NORMAL:
			if (status.int_enabled)
				return 0;
			break;
		case AP_RESPONSE_RESET_IN_PROGRESS:
		case AP_RESPONSE_BUSY:
363 364 365 366 367 368
			if (i < AP_MAX_RESET - 1) {
				udelay(5);
				status = ap_queue_interruption_control(qid,
								       ind);
				continue;
			}
F
Felix Beck 已提交
369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392
			break;
		case AP_RESPONSE_Q_NOT_AVAIL:
		case AP_RESPONSE_DECONFIGURED:
		case AP_RESPONSE_CHECKSTOPPED:
		case AP_RESPONSE_INVALID_ADDRESS:
			return -ENODEV;
		case AP_RESPONSE_OTHERWISE_CHANGED:
			if (status.int_enabled)
				return 0;
			break;
		default:
			break;
		}
		if (i < AP_MAX_RESET - 1) {
			udelay(5);
			status = ap_test_queue(qid, &t_depth, &t_device_type);
		}
	}
	return rc;
#else
	return -EINVAL;
#endif
}

393
/**
394 395 396 397 398
 * __ap_send(): Send message to adjunct processor queue.
 * @qid: The AP queue number
 * @psmid: The program supplied message identifier
 * @msg: The message text
 * @length: The message length
399
 * @special: Special Bit
400
 *
401
 * Returns AP queue status structure.
402 403 404 405 406
 * Condition code 1 on NQAP can't happen because the L bit is 1.
 * Condition code 2 on NQAP also means the send is incomplete,
 * because a segment boundary was reached. The NQAP is repeated.
 */
static inline struct ap_queue_status
407 408
__ap_send(ap_qid_t qid, unsigned long long psmid, void *msg, size_t length,
	  unsigned int special)
409 410 411 412 413 414 415
{
	typedef struct { char _[length]; } msgblock;
	register unsigned long reg0 asm ("0") = qid | 0x40000000UL;
	register struct ap_queue_status reg1 asm ("1");
	register unsigned long reg2 asm ("2") = (unsigned long) msg;
	register unsigned long reg3 asm ("3") = (unsigned long) length;
	register unsigned long reg4 asm ("4") = (unsigned int) (psmid >> 32);
416
	register unsigned long reg5 asm ("5") = psmid & 0xffffffff;
417

418 419 420
	if (special == 1)
		reg0 |= 0x400000UL;

421
	asm volatile (
422
		"0: .long 0xb2ad0042\n"		/* NQAP */
423 424 425 426 427 428 429 430 431 432 433
		"   brc   2,0b"
		: "+d" (reg0), "=d" (reg1), "+d" (reg2), "+d" (reg3)
		: "d" (reg4), "d" (reg5), "m" (*(msgblock *) msg)
		: "cc" );
	return reg1;
}

int ap_send(ap_qid_t qid, unsigned long long psmid, void *msg, size_t length)
{
	struct ap_queue_status status;

434
	status = __ap_send(qid, psmid, msg, length, 0);
435 436 437 438
	switch (status.response_code) {
	case AP_RESPONSE_NORMAL:
		return 0;
	case AP_RESPONSE_Q_FULL:
439
	case AP_RESPONSE_RESET_IN_PROGRESS:
440
		return -EBUSY;
441 442
	case AP_RESPONSE_REQ_FAC_NOT_INST:
		return -EINVAL;
443 444 445 446 447 448
	default:	/* Device is gone. */
		return -ENODEV;
	}
}
EXPORT_SYMBOL(ap_send);

449 450 451 452 453 454
/**
 * __ap_recv(): Receive message from adjunct processor queue.
 * @qid: The AP queue number
 * @psmid: Pointer to program supplied message identifier
 * @msg: The message text
 * @length: The message length
455
 *
456
 * Returns AP queue status structure.
457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480
 * Condition code 1 on DQAP means the receive has taken place
 * but only partially.	The response is incomplete, hence the
 * DQAP is repeated.
 * Condition code 2 on DQAP also means the receive is incomplete,
 * this time because a segment boundary was reached. Again, the
 * DQAP is repeated.
 * Note that gpr2 is used by the DQAP instruction to keep track of
 * any 'residual' length, in case the instruction gets interrupted.
 * Hence it gets zeroed before the instruction.
 */
static inline struct ap_queue_status
__ap_recv(ap_qid_t qid, unsigned long long *psmid, void *msg, size_t length)
{
	typedef struct { char _[length]; } msgblock;
	register unsigned long reg0 asm("0") = qid | 0x80000000UL;
	register struct ap_queue_status reg1 asm ("1");
	register unsigned long reg2 asm("2") = 0UL;
	register unsigned long reg4 asm("4") = (unsigned long) msg;
	register unsigned long reg5 asm("5") = (unsigned long) length;
	register unsigned long reg6 asm("6") = 0UL;
	register unsigned long reg7 asm("7") = 0UL;


	asm volatile(
481
		"0: .long 0xb2ae0064\n"		/* DQAP */
482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501
		"   brc   6,0b\n"
		: "+d" (reg0), "=d" (reg1), "+d" (reg2),
		"+d" (reg4), "+d" (reg5), "+d" (reg6), "+d" (reg7),
		"=m" (*(msgblock *) msg) : : "cc" );
	*psmid = (((unsigned long long) reg6) << 32) + reg7;
	return reg1;
}

int ap_recv(ap_qid_t qid, unsigned long long *psmid, void *msg, size_t length)
{
	struct ap_queue_status status;

	status = __ap_recv(qid, psmid, msg, length);
	switch (status.response_code) {
	case AP_RESPONSE_NORMAL:
		return 0;
	case AP_RESPONSE_NO_PENDING_REPLY:
		if (status.queue_empty)
			return -ENOENT;
		return -EBUSY;
502 503
	case AP_RESPONSE_RESET_IN_PROGRESS:
		return -EBUSY;
504 505 506 507 508 509 510
	default:
		return -ENODEV;
	}
}
EXPORT_SYMBOL(ap_recv);

/**
511 512 513 514 515 516
 * ap_query_queue(): Check if an AP queue is available.
 * @qid: The AP queue number
 * @queue_depth: Pointer to queue depth value
 * @device_type: Pointer to device type value
 *
 * The test is repeated for AP_MAX_RESET times.
517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542
 */
static int ap_query_queue(ap_qid_t qid, int *queue_depth, int *device_type)
{
	struct ap_queue_status status;
	int t_depth, t_device_type, rc, i;

	rc = -EBUSY;
	for (i = 0; i < AP_MAX_RESET; i++) {
		status = ap_test_queue(qid, &t_depth, &t_device_type);
		switch (status.response_code) {
		case AP_RESPONSE_NORMAL:
			*queue_depth = t_depth + 1;
			*device_type = t_device_type;
			rc = 0;
			break;
		case AP_RESPONSE_Q_NOT_AVAIL:
			rc = -ENODEV;
			break;
		case AP_RESPONSE_RESET_IN_PROGRESS:
			break;
		case AP_RESPONSE_DECONFIGURED:
			rc = -ENODEV;
			break;
		case AP_RESPONSE_CHECKSTOPPED:
			rc = -ENODEV;
			break;
F
Felix Beck 已提交
543 544 545 546 547
		case AP_RESPONSE_INVALID_ADDRESS:
			rc = -ENODEV;
			break;
		case AP_RESPONSE_OTHERWISE_CHANGED:
			break;
548 549 550 551 552 553 554 555 556 557 558 559 560 561
		case AP_RESPONSE_BUSY:
			break;
		default:
			BUG();
		}
		if (rc != -EBUSY)
			break;
		if (i < AP_MAX_RESET - 1)
			udelay(5);
	}
	return rc;
}

/**
562 563 564
 * ap_init_queue(): Reset an AP queue.
 * @qid: The AP queue number
 *
565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585
 * Reset an AP queue and wait for it to become available again.
 */
static int ap_init_queue(ap_qid_t qid)
{
	struct ap_queue_status status;
	int rc, dummy, i;

	rc = -ENODEV;
	status = ap_reset_queue(qid);
	for (i = 0; i < AP_MAX_RESET; i++) {
		switch (status.response_code) {
		case AP_RESPONSE_NORMAL:
			if (status.queue_empty)
				rc = 0;
			break;
		case AP_RESPONSE_Q_NOT_AVAIL:
		case AP_RESPONSE_DECONFIGURED:
		case AP_RESPONSE_CHECKSTOPPED:
			i = AP_MAX_RESET;	/* return with -ENODEV */
			break;
		case AP_RESPONSE_RESET_IN_PROGRESS:
586
			rc = -EBUSY;
587 588 589 590
		case AP_RESPONSE_BUSY:
		default:
			break;
		}
591
		if (rc != -ENODEV && rc != -EBUSY)
592 593
			break;
		if (i < AP_MAX_RESET - 1) {
594 595 596 597 598 599 600
			/* Time we are waiting until we give up (0.7sec * 90).
			 * Since the actual request (in progress) will not
			 * interrupted immediately for the reset command,
			 * we have to be patient. In worst case we have to
			 * wait 60sec + reset time (some msec).
			 */
			schedule_timeout(AP_RESET_TIMEOUT);
601 602 603
			status = ap_test_queue(qid, &dummy, &dummy);
		}
	}
F
Felix Beck 已提交
604
	if (rc == 0 && ap_using_interrupts()) {
605
		rc = ap_queue_enable_interruption(qid, ap_airq.lsi_ptr);
F
Felix Beck 已提交
606 607 608 609 610 611 612
		/* If interruption mode is supported by the machine,
		* but an AP can not be enabled for interruption then
		* the AP will be discarded.    */
		if (rc)
			pr_err("Registering adapter interrupts for "
			       "AP %d failed\n", AP_QID_DEVICE(qid));
	}
613 614 615
	return rc;
}

616
/**
617 618 619 620
 * ap_increase_queue_count(): Arm request timeout.
 * @ap_dev: Pointer to an AP device.
 *
 * Arm request timeout if an AP device was idle and a new request is submitted.
621 622 623 624 625 626 627 628 629 630 631 632 633
 */
static void ap_increase_queue_count(struct ap_device *ap_dev)
{
	int timeout = ap_dev->drv->request_timeout;

	ap_dev->queue_count++;
	if (ap_dev->queue_count == 1) {
		mod_timer(&ap_dev->timeout, jiffies + timeout);
		ap_dev->reset = AP_RESET_ARMED;
	}
}

/**
634 635 636 637
 * ap_decrease_queue_count(): Decrease queue count.
 * @ap_dev: Pointer to an AP device.
 *
 * If AP device is still alive, re-schedule request timeout if there are still
638 639 640 641 642 643 644 645 646 647
 * pending requests.
 */
static void ap_decrease_queue_count(struct ap_device *ap_dev)
{
	int timeout = ap_dev->drv->request_timeout;

	ap_dev->queue_count--;
	if (ap_dev->queue_count > 0)
		mod_timer(&ap_dev->timeout, jiffies + timeout);
	else
648
		/*
649 650 651 652 653 654 655
		 * The timeout timer should to be disabled now - since
		 * del_timer_sync() is very expensive, we just tell via the
		 * reset flag to ignore the pending timeout timer.
		 */
		ap_dev->reset = AP_RESET_IGNORE;
}

656
/*
657 658 659 660 661 662 663 664 665
 * AP device related attributes.
 */
static ssize_t ap_hwtype_show(struct device *dev,
			      struct device_attribute *attr, char *buf)
{
	struct ap_device *ap_dev = to_ap_dev(dev);
	return snprintf(buf, PAGE_SIZE, "%d\n", ap_dev->device_type);
}

666
static DEVICE_ATTR(hwtype, 0444, ap_hwtype_show, NULL);
667 668 669 670 671 672 673
static ssize_t ap_depth_show(struct device *dev, struct device_attribute *attr,
			     char *buf)
{
	struct ap_device *ap_dev = to_ap_dev(dev);
	return snprintf(buf, PAGE_SIZE, "%d\n", ap_dev->queue_depth);
}

674
static DEVICE_ATTR(depth, 0444, ap_depth_show, NULL);
675 676 677 678 679 680 681 682 683 684 685 686 687 688 689
static ssize_t ap_request_count_show(struct device *dev,
				     struct device_attribute *attr,
				     char *buf)
{
	struct ap_device *ap_dev = to_ap_dev(dev);
	int rc;

	spin_lock_bh(&ap_dev->lock);
	rc = snprintf(buf, PAGE_SIZE, "%d\n", ap_dev->total_request_count);
	spin_unlock_bh(&ap_dev->lock);
	return rc;
}

static DEVICE_ATTR(request_count, 0444, ap_request_count_show, NULL);

690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717
static ssize_t ap_requestq_count_show(struct device *dev,
				      struct device_attribute *attr, char *buf)
{
	struct ap_device *ap_dev = to_ap_dev(dev);
	int rc;

	spin_lock_bh(&ap_dev->lock);
	rc = snprintf(buf, PAGE_SIZE, "%d\n", ap_dev->requestq_count);
	spin_unlock_bh(&ap_dev->lock);
	return rc;
}

static DEVICE_ATTR(requestq_count, 0444, ap_requestq_count_show, NULL);

static ssize_t ap_pendingq_count_show(struct device *dev,
				      struct device_attribute *attr, char *buf)
{
	struct ap_device *ap_dev = to_ap_dev(dev);
	int rc;

	spin_lock_bh(&ap_dev->lock);
	rc = snprintf(buf, PAGE_SIZE, "%d\n", ap_dev->pendingq_count);
	spin_unlock_bh(&ap_dev->lock);
	return rc;
}

static DEVICE_ATTR(pendingq_count, 0444, ap_pendingq_count_show, NULL);

718 719 720 721 722 723 724 725
static ssize_t ap_modalias_show(struct device *dev,
				struct device_attribute *attr, char *buf)
{
	return sprintf(buf, "ap:t%02X", to_ap_dev(dev)->device_type);
}

static DEVICE_ATTR(modalias, 0444, ap_modalias_show, NULL);

726 727 728 729 730 731 732 733 734
static ssize_t ap_functions_show(struct device *dev,
				 struct device_attribute *attr, char *buf)
{
	struct ap_device *ap_dev = to_ap_dev(dev);
	return snprintf(buf, PAGE_SIZE, "0x%08X\n", ap_dev->functions);
}

static DEVICE_ATTR(ap_functions, 0444, ap_functions_show, NULL);

735 736 737 738
static struct attribute *ap_dev_attrs[] = {
	&dev_attr_hwtype.attr,
	&dev_attr_depth.attr,
	&dev_attr_request_count.attr,
739 740
	&dev_attr_requestq_count.attr,
	&dev_attr_pendingq_count.attr,
741
	&dev_attr_modalias.attr,
742
	&dev_attr_ap_functions.attr,
743 744 745 746 747 748 749
	NULL
};
static struct attribute_group ap_dev_attr_group = {
	.attrs = ap_dev_attrs
};

/**
750 751 752 753
 * ap_bus_match()
 * @dev: Pointer to device
 * @drv: Pointer to device_driver
 *
754 755 756 757 758 759 760 761
 * AP bus driver registration/unregistration.
 */
static int ap_bus_match(struct device *dev, struct device_driver *drv)
{
	struct ap_device *ap_dev = to_ap_dev(dev);
	struct ap_driver *ap_drv = to_ap_drv(drv);
	struct ap_device_id *id;

762
	/*
763 764 765 766 767 768 769 770 771 772 773 774 775
	 * Compare device type of the device with the list of
	 * supported types of the device_driver.
	 */
	for (id = ap_drv->ids; id->match_flags; id++) {
		if ((id->match_flags & AP_DEVICE_ID_MATCH_DEVICE_TYPE) &&
		    (id->dev_type != ap_dev->device_type))
			continue;
		return 1;
	}
	return 0;
}

/**
776 777 778 779 780 781
 * ap_uevent(): Uevent function for AP devices.
 * @dev: Pointer to device
 * @env: Pointer to kobj_uevent_env
 *
 * It sets up a single environment variable DEV_TYPE which contains the
 * hardware device type.
782
 */
783
static int ap_uevent (struct device *dev, struct kobj_uevent_env *env)
784 785
{
	struct ap_device *ap_dev = to_ap_dev(dev);
786
	int retval = 0;
787 788 789 790 791

	if (!ap_dev)
		return -ENODEV;

	/* Set up DEV_TYPE environment variable. */
792
	retval = add_uevent_var(env, "DEV_TYPE=%04X", ap_dev->device_type);
793 794 795
	if (retval)
		return retval;

796
	/* Add MODALIAS= */
797
	retval = add_uevent_var(env, "MODALIAS=ap:t%02X", ap_dev->device_type);
798 799

	return retval;
800 801
}

802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817
static int ap_bus_suspend(struct device *dev, pm_message_t state)
{
	struct ap_device *ap_dev = to_ap_dev(dev);
	unsigned long flags;

	if (!ap_suspend_flag) {
		ap_suspend_flag = 1;

		/* Disable scanning for devices, thus we do not want to scan
		 * for them after removing.
		 */
		del_timer_sync(&ap_config_timer);
		if (ap_work_queue != NULL) {
			destroy_workqueue(ap_work_queue);
			ap_work_queue = NULL;
		}
818

819 820 821 822 823
		tasklet_disable(&ap_tasklet);
	}
	/* Poll on the device until all requests are finished. */
	do {
		flags = 0;
824
		spin_lock_bh(&ap_dev->lock);
825
		__ap_poll_device(ap_dev, &flags);
826
		spin_unlock_bh(&ap_dev->lock);
827 828
	} while ((flags & 1) || (flags & 2));

829 830 831 832
	spin_lock_bh(&ap_dev->lock);
	ap_dev->unregistered = 1;
	spin_unlock_bh(&ap_dev->lock);

833 834 835 836 837 838
	return 0;
}

static int ap_bus_resume(struct device *dev)
{
	struct ap_device *ap_dev = to_ap_dev(dev);
839
	int rc;
840 841 842

	if (ap_suspend_flag) {
		ap_suspend_flag = 0;
843 844 845 846 847 848 849 850 851 852 853
		if (ap_interrupts_available()) {
			if (!ap_using_interrupts()) {
				rc = register_adapter_interrupt(&ap_airq);
				ap_airq_flag = (rc == 0);
			}
		} else {
			if (ap_using_interrupts()) {
				unregister_adapter_interrupt(&ap_airq);
				ap_airq_flag = 0;
			}
		}
854
		ap_query_configuration();
855 856 857 858
		if (!user_set_domain) {
			ap_domain_index = -1;
			ap_select_domain();
		}
859 860 861 862 863 864 865 866 867 868 869 870 871 872 873
		init_timer(&ap_config_timer);
		ap_config_timer.function = ap_config_timeout;
		ap_config_timer.data = 0;
		ap_config_timer.expires = jiffies + ap_config_time * HZ;
		add_timer(&ap_config_timer);
		ap_work_queue = create_singlethread_workqueue("kapwork");
		if (!ap_work_queue)
			return -ENOMEM;
		tasklet_enable(&ap_tasklet);
		if (!ap_using_interrupts())
			ap_schedule_poll_timer();
		else
			tasklet_schedule(&ap_tasklet);
		if (ap_thread_flag)
			rc = ap_poll_thread_start();
874 875 876 877
		else
			rc = 0;
	} else
		rc = 0;
878 879 880 881 882 883 884
	if (AP_QID_QUEUE(ap_dev->qid) != ap_domain_index) {
		spin_lock_bh(&ap_dev->lock);
		ap_dev->qid = AP_MKQID(AP_QID_DEVICE(ap_dev->qid),
				       ap_domain_index);
		spin_unlock_bh(&ap_dev->lock);
	}
	queue_work(ap_work_queue, &ap_config_work);
885 886 887 888

	return rc;
}

889 890 891 892
static struct bus_type ap_bus_type = {
	.name = "ap",
	.match = &ap_bus_match,
	.uevent = &ap_uevent,
893 894
	.suspend = ap_bus_suspend,
	.resume = ap_bus_resume
895 896 897 898 899 900 901 902 903
};

static int ap_device_probe(struct device *dev)
{
	struct ap_device *ap_dev = to_ap_dev(dev);
	struct ap_driver *ap_drv = to_ap_drv(dev->driver);
	int rc;

	ap_dev->drv = ap_drv;
904 905 906 907 908

	spin_lock_bh(&ap_device_list_lock);
	list_add(&ap_dev->list, &ap_device_list);
	spin_unlock_bh(&ap_device_list_lock);

909
	rc = ap_drv->probe ? ap_drv->probe(ap_dev) : -ENODEV;
910
	if (rc) {
911
		spin_lock_bh(&ap_device_list_lock);
912
		list_del_init(&ap_dev->list);
913
		spin_unlock_bh(&ap_device_list_lock);
914
	}
915 916 917 918
	return rc;
}

/**
919 920 921
 * __ap_flush_queue(): Flush requests.
 * @ap_dev: Pointer to the AP device
 *
922 923
 * Flush all requests from the request/pending queue of an AP device.
 */
924
static void __ap_flush_queue(struct ap_device *ap_dev)
925 926 927 928 929 930
{
	struct ap_message *ap_msg, *next;

	list_for_each_entry_safe(ap_msg, next, &ap_dev->pendingq, list) {
		list_del_init(&ap_msg->list);
		ap_dev->pendingq_count--;
931
		ap_msg->receive(ap_dev, ap_msg, ERR_PTR(-ENODEV));
932 933 934 935
	}
	list_for_each_entry_safe(ap_msg, next, &ap_dev->requestq, list) {
		list_del_init(&ap_msg->list);
		ap_dev->requestq_count--;
936
		ap_msg->receive(ap_dev, ap_msg, ERR_PTR(-ENODEV));
937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952
	}
}

void ap_flush_queue(struct ap_device *ap_dev)
{
	spin_lock_bh(&ap_dev->lock);
	__ap_flush_queue(ap_dev);
	spin_unlock_bh(&ap_dev->lock);
}
EXPORT_SYMBOL(ap_flush_queue);

static int ap_device_remove(struct device *dev)
{
	struct ap_device *ap_dev = to_ap_dev(dev);
	struct ap_driver *ap_drv = ap_dev->drv;

953
	ap_flush_queue(ap_dev);
954
	del_timer_sync(&ap_dev->timeout);
955
	spin_lock_bh(&ap_device_list_lock);
956
	list_del_init(&ap_dev->list);
957
	spin_unlock_bh(&ap_device_list_lock);
958 959
	if (ap_drv->remove)
		ap_drv->remove(ap_dev);
960 961 962
	spin_lock_bh(&ap_dev->lock);
	atomic_sub(ap_dev->queue_count, &ap_poll_requests);
	spin_unlock_bh(&ap_dev->lock);
963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985
	return 0;
}

int ap_driver_register(struct ap_driver *ap_drv, struct module *owner,
		       char *name)
{
	struct device_driver *drv = &ap_drv->driver;

	drv->bus = &ap_bus_type;
	drv->probe = ap_device_probe;
	drv->remove = ap_device_remove;
	drv->owner = owner;
	drv->name = name;
	return driver_register(drv);
}
EXPORT_SYMBOL(ap_driver_register);

void ap_driver_unregister(struct ap_driver *ap_drv)
{
	driver_unregister(&ap_drv->driver);
}
EXPORT_SYMBOL(ap_driver_unregister);

986 987
void ap_bus_force_rescan(void)
{
988 989 990 991 992
	/* reconfigure the AP bus rescan timer. */
	mod_timer(&ap_config_timer, jiffies + ap_config_time * HZ);
	/* processing a asynchronous bus rescan */
	queue_work(ap_work_queue, &ap_config_work);
	flush_work(&ap_config_work);
993 994 995
}
EXPORT_SYMBOL(ap_bus_force_rescan);

996
/*
997 998 999 1000 1001 1002 1003 1004 1005
 * AP bus attributes.
 */
static ssize_t ap_domain_show(struct bus_type *bus, char *buf)
{
	return snprintf(buf, PAGE_SIZE, "%d\n", ap_domain_index);
}

static BUS_ATTR(ap_domain, 0444, ap_domain_show, NULL);

1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027
static ssize_t ap_control_domain_mask_show(struct bus_type *bus, char *buf)
{
	if (ap_configuration != NULL) { /* QCI not supported */
		if (test_facility(76)) { /* format 1 - 256 bit domain field */
			return snprintf(buf, PAGE_SIZE,
				"0x%08x%08x%08x%08x%08x%08x%08x%08x\n",
			ap_configuration->adm[0], ap_configuration->adm[1],
			ap_configuration->adm[2], ap_configuration->adm[3],
			ap_configuration->adm[4], ap_configuration->adm[5],
			ap_configuration->adm[6], ap_configuration->adm[7]);
		} else { /* format 0 - 16 bit domain field */
			return snprintf(buf, PAGE_SIZE, "%08x%08x\n",
			ap_configuration->adm[0], ap_configuration->adm[1]);
		  }
	} else {
		return snprintf(buf, PAGE_SIZE, "not supported\n");
	  }
}

static BUS_ATTR(ap_control_domain_mask, 0444,
		ap_control_domain_mask_show, NULL);

1028 1029 1030 1031 1032
static ssize_t ap_config_time_show(struct bus_type *bus, char *buf)
{
	return snprintf(buf, PAGE_SIZE, "%d\n", ap_config_time);
}

F
Felix Beck 已提交
1033 1034 1035 1036 1037 1038 1039 1040
static ssize_t ap_interrupts_show(struct bus_type *bus, char *buf)
{
	return snprintf(buf, PAGE_SIZE, "%d\n",
			ap_using_interrupts() ? 1 : 0);
}

static BUS_ATTR(ap_interrupts, 0444, ap_interrupts_show, NULL);

1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082
static ssize_t ap_config_time_store(struct bus_type *bus,
				    const char *buf, size_t count)
{
	int time;

	if (sscanf(buf, "%d\n", &time) != 1 || time < 5 || time > 120)
		return -EINVAL;
	ap_config_time = time;
	if (!timer_pending(&ap_config_timer) ||
	    !mod_timer(&ap_config_timer, jiffies + ap_config_time * HZ)) {
		ap_config_timer.expires = jiffies + ap_config_time * HZ;
		add_timer(&ap_config_timer);
	}
	return count;
}

static BUS_ATTR(config_time, 0644, ap_config_time_show, ap_config_time_store);

static ssize_t ap_poll_thread_show(struct bus_type *bus, char *buf)
{
	return snprintf(buf, PAGE_SIZE, "%d\n", ap_poll_kthread ? 1 : 0);
}

static ssize_t ap_poll_thread_store(struct bus_type *bus,
				    const char *buf, size_t count)
{
	int flag, rc;

	if (sscanf(buf, "%d\n", &flag) != 1)
		return -EINVAL;
	if (flag) {
		rc = ap_poll_thread_start();
		if (rc)
			return rc;
	}
	else
		ap_poll_thread_stop();
	return count;
}

static BUS_ATTR(poll_thread, 0644, ap_poll_thread_show, ap_poll_thread_store);

1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094
static ssize_t poll_timeout_show(struct bus_type *bus, char *buf)
{
	return snprintf(buf, PAGE_SIZE, "%llu\n", poll_timeout);
}

static ssize_t poll_timeout_store(struct bus_type *bus, const char *buf,
				  size_t count)
{
	unsigned long long time;
	ktime_t hr_time;

	/* 120 seconds = maximum poll interval */
F
Felix Beck 已提交
1095 1096
	if (sscanf(buf, "%llu\n", &time) != 1 || time < 1 ||
	    time > 120000000000ULL)
1097 1098 1099 1100 1101
		return -EINVAL;
	poll_timeout = time;
	hr_time = ktime_set(0, poll_timeout);

	if (!hrtimer_is_queued(&ap_poll_timer) ||
1102 1103 1104
	    !hrtimer_forward(&ap_poll_timer, hrtimer_get_expires(&ap_poll_timer), hr_time)) {
		hrtimer_set_expires(&ap_poll_timer, hr_time);
		hrtimer_start_expires(&ap_poll_timer, HRTIMER_MODE_ABS);
1105 1106 1107 1108 1109 1110
	}
	return count;
}

static BUS_ATTR(poll_timeout, 0644, poll_timeout_show, poll_timeout_store);

1111 1112
static struct bus_attribute *const ap_bus_attrs[] = {
	&bus_attr_ap_domain,
1113
	&bus_attr_ap_control_domain_mask,
1114 1115
	&bus_attr_config_time,
	&bus_attr_poll_thread,
F
Felix Beck 已提交
1116
	&bus_attr_ap_interrupts,
1117 1118
	&bus_attr_poll_timeout,
	NULL,
1119 1120
};

1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179
static inline int ap_test_config(unsigned int *field, unsigned int nr)
{
	if (nr > 0xFFu)
		return 0;
	return ap_test_bit((field + (nr >> 5)), (nr & 0x1f));
}

/*
 * ap_test_config_card_id(): Test, whether an AP card ID is configured.
 * @id AP card ID
 *
 * Returns 0 if the card is not configured
 *	   1 if the card is configured or
 *	     if the configuration information is not available
 */
static inline int ap_test_config_card_id(unsigned int id)
{
	if (!ap_configuration)
		return 1;
	return ap_test_config(ap_configuration->apm, id);
}

/*
 * ap_test_config_domain(): Test, whether an AP usage domain is configured.
 * @domain AP usage domain ID
 *
 * Returns 0 if the usage domain is not configured
 *	   1 if the usage domain is configured or
 *	     if the configuration information is not available
 */
static inline int ap_test_config_domain(unsigned int domain)
{
	if (!ap_configuration)
		return 1;
	return ap_test_config(ap_configuration->aqm, domain);
}

/**
 * ap_query_configuration(): Query AP configuration information.
 *
 * Query information of installed cards and configured domains from AP.
 */
static void ap_query_configuration(void)
{
#ifdef CONFIG_64BIT
	if (ap_configuration_available()) {
		if (!ap_configuration)
			ap_configuration =
				kzalloc(sizeof(struct ap_config_info),
					GFP_KERNEL);
		if (ap_configuration)
			__ap_query_configuration(ap_configuration);
	} else
		ap_configuration = NULL;
#else
	ap_configuration = NULL;
#endif
}

1180
/**
1181 1182 1183
 * ap_select_domain(): Select an AP domain.
 *
 * Pick one of the 16 AP domains.
1184
 */
1185
static int ap_select_domain(void)
1186 1187
{
	int queue_depth, device_type, count, max_count, best_domain;
1188
	ap_qid_t qid;
1189 1190
	int rc, i, j;

1191 1192 1193 1194
	/* IF APXA isn't installed, only 16 domains could be defined */
	if (!ap_configuration->ap_extended && (ap_domain_index > 15))
		return -EINVAL;

1195
	/*
1196 1197 1198 1199 1200 1201 1202 1203 1204 1205
	 * We want to use a single domain. Either the one specified with
	 * the "domain=" parameter or the domain with the maximum number
	 * of devices.
	 */
	if (ap_domain_index >= 0 && ap_domain_index < AP_DOMAINS)
		/* Domain has already been selected. */
		return 0;
	best_domain = -1;
	max_count = 0;
	for (i = 0; i < AP_DOMAINS; i++) {
1206 1207
		if (!ap_test_config_domain(i))
			continue;
1208 1209
		count = 0;
		for (j = 0; j < AP_DEVICES; j++) {
1210 1211 1212
			if (!ap_test_config_card_id(j))
				continue;
			qid = AP_MKQID(j, i);
1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230
			rc = ap_query_queue(qid, &queue_depth, &device_type);
			if (rc)
				continue;
			count++;
		}
		if (count > max_count) {
			max_count = count;
			best_domain = i;
		}
	}
	if (best_domain >= 0){
		ap_domain_index = best_domain;
		return 0;
	}
	return -ENODEV;
}

/**
1231
 * ap_probe_device_type(): Find the device type of an AP.
1232
 * @ap_dev: pointer to the AP device.
1233 1234
 *
 * Find the device type if query queue returned a device type of 0.
1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296
 */
static int ap_probe_device_type(struct ap_device *ap_dev)
{
	static unsigned char msg[] = {
		0x00,0x06,0x00,0x00,0x00,0x00,0x00,0x00,
		0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
		0x00,0x00,0x00,0x58,0x00,0x00,0x00,0x00,
		0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
		0x01,0x00,0x43,0x43,0x41,0x2d,0x41,0x50,
		0x50,0x4c,0x20,0x20,0x20,0x01,0x01,0x01,
		0x00,0x00,0x00,0x00,0x50,0x4b,0x00,0x00,
		0x00,0x00,0x01,0x1c,0x00,0x00,0x00,0x00,
		0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
		0x00,0x00,0x05,0xb8,0x00,0x00,0x00,0x00,
		0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
		0x70,0x00,0x41,0x00,0x00,0x00,0x00,0x00,
		0x00,0x00,0x54,0x32,0x01,0x00,0xa0,0x00,
		0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
		0x00,0x00,0x00,0x00,0xb8,0x05,0x00,0x00,
		0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
		0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
		0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
		0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
		0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
		0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
		0x00,0x00,0x0a,0x00,0x00,0x00,0x00,0x00,
		0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
		0x00,0x00,0x00,0x00,0x00,0x00,0x08,0x00,
		0x49,0x43,0x53,0x46,0x20,0x20,0x20,0x20,
		0x50,0x4b,0x0a,0x00,0x50,0x4b,0x43,0x53,
		0x2d,0x31,0x2e,0x32,0x37,0x00,0x11,0x22,
		0x33,0x44,0x55,0x66,0x77,0x88,0x99,0x00,
		0x11,0x22,0x33,0x44,0x55,0x66,0x77,0x88,
		0x99,0x00,0x11,0x22,0x33,0x44,0x55,0x66,
		0x77,0x88,0x99,0x00,0x11,0x22,0x33,0x44,
		0x55,0x66,0x77,0x88,0x99,0x00,0x11,0x22,
		0x33,0x44,0x55,0x66,0x77,0x88,0x99,0x00,
		0x11,0x22,0x33,0x5d,0x00,0x5b,0x00,0x77,
		0x88,0x1e,0x00,0x00,0x57,0x00,0x00,0x00,
		0x00,0x04,0x00,0x00,0x4f,0x00,0x00,0x00,
		0x03,0x02,0x00,0x00,0x40,0x01,0x00,0x01,
		0xce,0x02,0x68,0x2d,0x5f,0xa9,0xde,0x0c,
		0xf6,0xd2,0x7b,0x58,0x4b,0xf9,0x28,0x68,
		0x3d,0xb4,0xf4,0xef,0x78,0xd5,0xbe,0x66,
		0x63,0x42,0xef,0xf8,0xfd,0xa4,0xf8,0xb0,
		0x8e,0x29,0xc2,0xc9,0x2e,0xd8,0x45,0xb8,
		0x53,0x8c,0x6f,0x4e,0x72,0x8f,0x6c,0x04,
		0x9c,0x88,0xfc,0x1e,0xc5,0x83,0x55,0x57,
		0xf7,0xdd,0xfd,0x4f,0x11,0x36,0x95,0x5d,
	};
	struct ap_queue_status status;
	unsigned long long psmid;
	char *reply;
	int rc, i;

	reply = (void *) get_zeroed_page(GFP_KERNEL);
	if (!reply) {
		rc = -ENOMEM;
		goto out;
	}

	status = __ap_send(ap_dev->qid, 0x0102030405060708ULL,
1297
			   msg, sizeof(msg), 0);
1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326
	if (status.response_code != AP_RESPONSE_NORMAL) {
		rc = -ENODEV;
		goto out_free;
	}

	/* Wait for the test message to complete. */
	for (i = 0; i < 6; i++) {
		mdelay(300);
		status = __ap_recv(ap_dev->qid, &psmid, reply, 4096);
		if (status.response_code == AP_RESPONSE_NORMAL &&
		    psmid == 0x0102030405060708ULL)
			break;
	}
	if (i < 6) {
		/* Got an answer. */
		if (reply[0] == 0x00 && reply[1] == 0x86)
			ap_dev->device_type = AP_DEVICE_TYPE_PCICC;
		else
			ap_dev->device_type = AP_DEVICE_TYPE_PCICA;
		rc = 0;
	} else
		rc = -ENODEV;

out_free:
	free_page((unsigned long) reply);
out:
	return rc;
}

1327
static void ap_interrupt_handler(struct airq_struct *airq)
F
Felix Beck 已提交
1328
{
1329
	inc_irq_stat(IRQIO_APB);
F
Felix Beck 已提交
1330 1331 1332
	tasklet_schedule(&ap_tasklet);
}

1333
/**
1334 1335 1336 1337 1338
 * __ap_scan_bus(): Scan the AP bus.
 * @dev: Pointer to device
 * @data: Pointer to data
 *
 * Scan the AP bus for new devices.
1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351
 */
static int __ap_scan_bus(struct device *dev, void *data)
{
	return to_ap_dev(dev)->qid == (ap_qid_t)(unsigned long) data;
}

static void ap_device_release(struct device *dev)
{
	struct ap_device *ap_dev = to_ap_dev(dev);

	kfree(ap_dev);
}

1352
static void ap_scan_bus(struct work_struct *unused)
1353 1354 1355 1356 1357
{
	struct ap_device *ap_dev;
	struct device *dev;
	ap_qid_t qid;
	int queue_depth, device_type;
1358
	unsigned int device_functions;
1359 1360
	int rc, i;

1361
	ap_query_configuration();
1362
	if (ap_select_domain() != 0) {
1363
		return;
1364
	}
1365 1366 1367 1368 1369
	for (i = 0; i < AP_DEVICES; i++) {
		qid = AP_MKQID(i, ap_domain_index);
		dev = bus_find_device(&ap_bus_type, NULL,
				      (void *)(unsigned long)qid,
				      __ap_scan_bus);
1370 1371 1372 1373
		if (ap_test_config_card_id(i))
			rc = ap_query_queue(qid, &queue_depth, &device_type);
		else
			rc = -ENODEV;
1374
		if (dev) {
1375 1376 1377 1378 1379 1380
			if (rc == -EBUSY) {
				set_current_state(TASK_UNINTERRUPTIBLE);
				schedule_timeout(AP_RESET_TIMEOUT);
				rc = ap_query_queue(qid, &queue_depth,
						    &device_type);
			}
1381 1382 1383 1384
			ap_dev = to_ap_dev(dev);
			spin_lock_bh(&ap_dev->lock);
			if (rc || ap_dev->unregistered) {
				spin_unlock_bh(&ap_dev->lock);
1385 1386
				if (ap_dev->unregistered)
					i--;
1387
				device_unregister(dev);
1388
				put_device(dev);
1389
				continue;
1390 1391
			}
			spin_unlock_bh(&ap_dev->lock);
1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404
			put_device(dev);
			continue;
		}
		if (rc)
			continue;
		rc = ap_init_queue(qid);
		if (rc)
			continue;
		ap_dev = kzalloc(sizeof(*ap_dev), GFP_KERNEL);
		if (!ap_dev)
			break;
		ap_dev->qid = qid;
		ap_dev->queue_depth = queue_depth;
1405
		ap_dev->unregistered = 1;
1406 1407 1408
		spin_lock_init(&ap_dev->lock);
		INIT_LIST_HEAD(&ap_dev->pendingq);
		INIT_LIST_HEAD(&ap_dev->requestq);
1409
		INIT_LIST_HEAD(&ap_dev->list);
1410 1411
		setup_timer(&ap_dev->timeout, ap_request_timeout,
			    (unsigned long) ap_dev);
1412 1413
		switch (device_type) {
		case 0:
1414
			/* device type probing for old cards */
1415 1416 1417 1418
			if (ap_probe_device_type(ap_dev)) {
				kfree(ap_dev);
				continue;
			}
1419 1420
			break;
		default:
1421
			ap_dev->device_type = device_type;
1422
		}
1423

1424 1425 1426 1427 1428 1429
		rc = ap_query_functions(qid, &device_functions);
		if (!rc)
			ap_dev->functions = device_functions;
		else
			ap_dev->functions = 0u;

1430 1431
		ap_dev->device.bus = &ap_bus_type;
		ap_dev->device.parent = ap_root_device;
1432 1433 1434 1435 1436
		if (dev_set_name(&ap_dev->device, "card%02x",
				 AP_QID_DEVICE(ap_dev->qid))) {
			kfree(ap_dev);
			continue;
		}
1437 1438 1439
		ap_dev->device.release = ap_device_release;
		rc = device_register(&ap_dev->device);
		if (rc) {
1440
			put_device(&ap_dev->device);
1441 1442 1443 1444 1445
			continue;
		}
		/* Add device attributes. */
		rc = sysfs_create_group(&ap_dev->device.kobj,
					&ap_dev_attr_group);
1446 1447 1448 1449 1450 1451
		if (!rc) {
			spin_lock_bh(&ap_dev->lock);
			ap_dev->unregistered = 0;
			spin_unlock_bh(&ap_dev->lock);
		}
		else
1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464
			device_unregister(&ap_dev->device);
	}
}

static void
ap_config_timeout(unsigned long ptr)
{
	queue_work(ap_work_queue, &ap_config_work);
	ap_config_timer.expires = jiffies + ap_config_time * HZ;
	add_timer(&ap_config_timer);
}

/**
1465
 * __ap_schedule_poll_timer(): Schedule poll timer.
1466
 *
1467 1468
 * Set up the timer to run the poll tasklet
 */
1469
static inline void __ap_schedule_poll_timer(void)
1470
{
1471
	ktime_t hr_time;
1472 1473

	spin_lock_bh(&ap_poll_timer_lock);
1474
	if (hrtimer_is_queued(&ap_poll_timer) || ap_suspend_flag)
1475
		goto out;
1476 1477 1478 1479 1480
	if (ktime_to_ns(hrtimer_expires_remaining(&ap_poll_timer)) <= 0) {
		hr_time = ktime_set(0, poll_timeout);
		hrtimer_forward_now(&ap_poll_timer, hr_time);
		hrtimer_restart(&ap_poll_timer);
	}
1481 1482
out:
	spin_unlock_bh(&ap_poll_timer_lock);
1483 1484
}

1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496
/**
 * ap_schedule_poll_timer(): Schedule poll timer.
 *
 * Set up the timer to run the poll tasklet
 */
static inline void ap_schedule_poll_timer(void)
{
	if (ap_using_interrupts())
		return;
	__ap_schedule_poll_timer();
}

1497
/**
1498
 * ap_poll_read(): Receive pending reply messages from an AP device.
1499 1500 1501
 * @ap_dev: pointer to the AP device
 * @flags: pointer to control flags, bit 2^0 is set if another poll is
 *	   required, bit 2^1 is set if the poll timer needs to get armed
1502
 *
1503 1504
 * Returns 0 if the device is still present, -ENODEV if not.
 */
1505
static int ap_poll_read(struct ap_device *ap_dev, unsigned long *flags)
1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516
{
	struct ap_queue_status status;
	struct ap_message *ap_msg;

	if (ap_dev->queue_count <= 0)
		return 0;
	status = __ap_recv(ap_dev->qid, &ap_dev->reply->psmid,
			   ap_dev->reply->message, ap_dev->reply->length);
	switch (status.response_code) {
	case AP_RESPONSE_NORMAL:
		atomic_dec(&ap_poll_requests);
1517
		ap_decrease_queue_count(ap_dev);
1518 1519 1520 1521 1522
		list_for_each_entry(ap_msg, &ap_dev->pendingq, list) {
			if (ap_msg->psmid != ap_dev->reply->psmid)
				continue;
			list_del_init(&ap_msg->list);
			ap_dev->pendingq_count--;
1523
			ap_msg->receive(ap_dev, ap_msg, ap_dev->reply);
1524 1525 1526 1527 1528 1529 1530 1531
			break;
		}
		if (ap_dev->queue_count > 0)
			*flags |= 1;
		break;
	case AP_RESPONSE_NO_PENDING_REPLY:
		if (status.queue_empty) {
			/* The card shouldn't forget requests but who knows. */
1532
			atomic_sub(ap_dev->queue_count, &ap_poll_requests);
1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546
			ap_dev->queue_count = 0;
			list_splice_init(&ap_dev->pendingq, &ap_dev->requestq);
			ap_dev->requestq_count += ap_dev->pendingq_count;
			ap_dev->pendingq_count = 0;
		} else
			*flags |= 2;
		break;
	default:
		return -ENODEV;
	}
	return 0;
}

/**
1547
 * ap_poll_write(): Send messages from the request queue to an AP device.
1548 1549 1550
 * @ap_dev: pointer to the AP device
 * @flags: pointer to control flags, bit 2^0 is set if another poll is
 *	   required, bit 2^1 is set if the poll timer needs to get armed
1551
 *
1552 1553
 * Returns 0 if the device is still present, -ENODEV if not.
 */
1554
static int ap_poll_write(struct ap_device *ap_dev, unsigned long *flags)
1555 1556 1557 1558 1559 1560 1561 1562 1563 1564
{
	struct ap_queue_status status;
	struct ap_message *ap_msg;

	if (ap_dev->requestq_count <= 0 ||
	    ap_dev->queue_count >= ap_dev->queue_depth)
		return 0;
	/* Start the next request on the queue. */
	ap_msg = list_entry(ap_dev->requestq.next, struct ap_message, list);
	status = __ap_send(ap_dev->qid, ap_msg->psmid,
1565
			   ap_msg->message, ap_msg->length, ap_msg->special);
1566 1567 1568
	switch (status.response_code) {
	case AP_RESPONSE_NORMAL:
		atomic_inc(&ap_poll_requests);
1569
		ap_increase_queue_count(ap_dev);
1570 1571 1572 1573 1574 1575 1576 1577
		list_move_tail(&ap_msg->list, &ap_dev->pendingq);
		ap_dev->requestq_count--;
		ap_dev->pendingq_count++;
		if (ap_dev->queue_count < ap_dev->queue_depth &&
		    ap_dev->requestq_count > 0)
			*flags |= 1;
		*flags |= 2;
		break;
1578
	case AP_RESPONSE_RESET_IN_PROGRESS:
1579 1580
		__ap_schedule_poll_timer();
	case AP_RESPONSE_Q_FULL:
1581 1582 1583
		*flags |= 2;
		break;
	case AP_RESPONSE_MESSAGE_TOO_BIG:
1584
	case AP_RESPONSE_REQ_FAC_NOT_INST:
1585 1586 1587 1588 1589 1590 1591 1592
		return -EINVAL;
	default:
		return -ENODEV;
	}
	return 0;
}

/**
1593
 * ap_poll_queue(): Poll AP device for pending replies and send new messages.
1594 1595 1596
 * @ap_dev: pointer to the bus device
 * @flags: pointer to control flags, bit 2^0 is set if another poll is
 *	   required, bit 2^1 is set if the poll timer needs to get armed
1597 1598 1599
 *
 * Poll AP device for pending replies and send new messages. If either
 * ap_poll_read or ap_poll_write returns -ENODEV unregister the device.
1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612
 * Returns 0.
 */
static inline int ap_poll_queue(struct ap_device *ap_dev, unsigned long *flags)
{
	int rc;

	rc = ap_poll_read(ap_dev, flags);
	if (rc)
		return rc;
	return ap_poll_write(ap_dev, flags);
}

/**
1613
 * __ap_queue_message(): Queue a message to a device.
1614 1615
 * @ap_dev: pointer to the AP device
 * @ap_msg: the message to be queued
1616 1617
 *
 * Queue a message to a device. Returns 0 if successful.
1618 1619 1620 1621 1622 1623 1624 1625
 */
static int __ap_queue_message(struct ap_device *ap_dev, struct ap_message *ap_msg)
{
	struct ap_queue_status status;

	if (list_empty(&ap_dev->requestq) &&
	    ap_dev->queue_count < ap_dev->queue_depth) {
		status = __ap_send(ap_dev->qid, ap_msg->psmid,
1626 1627
				   ap_msg->message, ap_msg->length,
				   ap_msg->special);
1628 1629 1630 1631 1632
		switch (status.response_code) {
		case AP_RESPONSE_NORMAL:
			list_add_tail(&ap_msg->list, &ap_dev->pendingq);
			atomic_inc(&ap_poll_requests);
			ap_dev->pendingq_count++;
1633
			ap_increase_queue_count(ap_dev);
1634 1635 1636
			ap_dev->total_request_count++;
			break;
		case AP_RESPONSE_Q_FULL:
1637
		case AP_RESPONSE_RESET_IN_PROGRESS:
1638 1639 1640 1641
			list_add_tail(&ap_msg->list, &ap_dev->requestq);
			ap_dev->requestq_count++;
			ap_dev->total_request_count++;
			return -EBUSY;
1642
		case AP_RESPONSE_REQ_FAC_NOT_INST:
1643
		case AP_RESPONSE_MESSAGE_TOO_BIG:
1644
			ap_msg->receive(ap_dev, ap_msg, ERR_PTR(-EINVAL));
1645 1646
			return -EINVAL;
		default:	/* Device is gone. */
1647
			ap_msg->receive(ap_dev, ap_msg, ERR_PTR(-ENODEV));
1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664
			return -ENODEV;
		}
	} else {
		list_add_tail(&ap_msg->list, &ap_dev->requestq);
		ap_dev->requestq_count++;
		ap_dev->total_request_count++;
		return -EBUSY;
	}
	ap_schedule_poll_timer();
	return 0;
}

void ap_queue_message(struct ap_device *ap_dev, struct ap_message *ap_msg)
{
	unsigned long flags;
	int rc;

1665 1666 1667 1668
	/* For asynchronous message handling a valid receive-callback
	 * is required. */
	BUG_ON(!ap_msg->receive);

1669 1670 1671 1672 1673 1674 1675 1676
	spin_lock_bh(&ap_dev->lock);
	if (!ap_dev->unregistered) {
		/* Make room on the queue by polling for finished requests. */
		rc = ap_poll_queue(ap_dev, &flags);
		if (!rc)
			rc = __ap_queue_message(ap_dev, ap_msg);
		if (!rc)
			wake_up(&ap_poll_wait);
1677 1678
		if (rc == -ENODEV)
			ap_dev->unregistered = 1;
1679
	} else {
1680
		ap_msg->receive(ap_dev, ap_msg, ERR_PTR(-ENODEV));
1681
		rc = -ENODEV;
1682 1683 1684 1685 1686 1687 1688 1689
	}
	spin_unlock_bh(&ap_dev->lock);
	if (rc == -ENODEV)
		device_unregister(&ap_dev->device);
}
EXPORT_SYMBOL(ap_queue_message);

/**
1690 1691 1692 1693
 * ap_cancel_message(): Cancel a crypto request.
 * @ap_dev: The AP device that has the message queued
 * @ap_msg: The message that is to be removed
 *
1694
 * Cancel a crypto request. This is done by removing the request
1695
 * from the device pending or request queue. Note that the
1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718
 * request stays on the AP queue. When it finishes the message
 * reply will be discarded because the psmid can't be found.
 */
void ap_cancel_message(struct ap_device *ap_dev, struct ap_message *ap_msg)
{
	struct ap_message *tmp;

	spin_lock_bh(&ap_dev->lock);
	if (!list_empty(&ap_msg->list)) {
		list_for_each_entry(tmp, &ap_dev->pendingq, list)
			if (tmp->psmid == ap_msg->psmid) {
				ap_dev->pendingq_count--;
				goto found;
			}
		ap_dev->requestq_count--;
	found:
		list_del_init(&ap_msg->list);
	}
	spin_unlock_bh(&ap_dev->lock);
}
EXPORT_SYMBOL(ap_cancel_message);

/**
1719
 * ap_poll_timeout(): AP receive polling for finished AP requests.
1720
 * @unused: Unused pointer.
1721
 *
1722
 * Schedules the AP tasklet using a high resolution timer.
1723
 */
1724
static enum hrtimer_restart ap_poll_timeout(struct hrtimer *unused)
1725 1726
{
	tasklet_schedule(&ap_tasklet);
1727
	return HRTIMER_NORESTART;
1728 1729
}

1730
/**
1731 1732 1733
 * ap_reset(): Reset a not responding AP device.
 * @ap_dev: Pointer to the AP device
 *
1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749
 * Reset a not responding AP device and move all requests from the
 * pending queue to the request queue.
 */
static void ap_reset(struct ap_device *ap_dev)
{
	int rc;

	ap_dev->reset = AP_RESET_IGNORE;
	atomic_sub(ap_dev->queue_count, &ap_poll_requests);
	ap_dev->queue_count = 0;
	list_splice_init(&ap_dev->pendingq, &ap_dev->requestq);
	ap_dev->requestq_count += ap_dev->pendingq_count;
	ap_dev->pendingq_count = 0;
	rc = ap_init_queue(ap_dev->qid);
	if (rc == -ENODEV)
		ap_dev->unregistered = 1;
1750 1751
	else
		__ap_schedule_poll_timer();
1752 1753
}

1754
static int __ap_poll_device(struct ap_device *ap_dev, unsigned long *flags)
1755 1756
{
	if (!ap_dev->unregistered) {
1757
		if (ap_poll_queue(ap_dev, flags))
1758
			ap_dev->unregistered = 1;
1759 1760
		if (ap_dev->reset == AP_RESET_DO)
			ap_reset(ap_dev);
1761
	}
1762 1763 1764
	return 0;
}

1765 1766 1767 1768 1769 1770 1771 1772
/**
 * ap_poll_all(): Poll all AP devices.
 * @dummy: Unused variable
 *
 * Poll all AP devices on the bus in a round robin fashion. Continue
 * polling until bit 2^0 of the control flags is not set. If bit 2^1
 * of the control flags has been set arm the poll timer.
 */
1773 1774 1775
static void ap_poll_all(unsigned long dummy)
{
	unsigned long flags;
1776
	struct ap_device *ap_dev;
1777

F
Felix Beck 已提交
1778 1779 1780 1781 1782
	/* Reset the indicator if interrupts are used. Thus new interrupts can
	 * be received. Doing it in the beginning of the tasklet is therefor
	 * important that no requests on any AP get lost.
	 */
	if (ap_using_interrupts())
1783
		xchg(ap_airq.lsi_ptr, 0);
1784 1785
	do {
		flags = 0;
1786
		spin_lock(&ap_device_list_lock);
1787
		list_for_each_entry(ap_dev, &ap_device_list, list) {
1788
			spin_lock(&ap_dev->lock);
1789
			__ap_poll_device(ap_dev, &flags);
1790
			spin_unlock(&ap_dev->lock);
1791
		}
1792
		spin_unlock(&ap_device_list_lock);
1793 1794 1795 1796 1797 1798
	} while (flags & 1);
	if (flags & 2)
		ap_schedule_poll_timer();
}

/**
1799 1800 1801
 * ap_poll_thread(): Thread that polls for finished requests.
 * @data: Unused pointer
 *
1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812
 * AP bus poll thread. The purpose of this thread is to poll for
 * finished requests in a loop if there is a "free" cpu - that is
 * a cpu that doesn't have anything better to do. The polling stops
 * as soon as there is another task or if all messages have been
 * delivered.
 */
static int ap_poll_thread(void *data)
{
	DECLARE_WAITQUEUE(wait, current);
	unsigned long flags;
	int requests;
1813
	struct ap_device *ap_dev;
1814

1815
	set_user_nice(current, MAX_NICE);
1816
	while (1) {
1817 1818
		if (ap_suspend_flag)
			return 0;
1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833
		if (need_resched()) {
			schedule();
			continue;
		}
		add_wait_queue(&ap_poll_wait, &wait);
		set_current_state(TASK_INTERRUPTIBLE);
		if (kthread_should_stop())
			break;
		requests = atomic_read(&ap_poll_requests);
		if (requests <= 0)
			schedule();
		set_current_state(TASK_RUNNING);
		remove_wait_queue(&ap_poll_wait, &wait);

		flags = 0;
1834
		spin_lock_bh(&ap_device_list_lock);
1835
		list_for_each_entry(ap_dev, &ap_device_list, list) {
1836
			spin_lock(&ap_dev->lock);
1837
			__ap_poll_device(ap_dev, &flags);
1838
			spin_unlock(&ap_dev->lock);
1839
		}
1840
		spin_unlock_bh(&ap_device_list_lock);
1841 1842 1843 1844 1845 1846 1847 1848 1849 1850
	}
	set_current_state(TASK_RUNNING);
	remove_wait_queue(&ap_poll_wait, &wait);
	return 0;
}

static int ap_poll_thread_start(void)
{
	int rc;

1851
	if (ap_using_interrupts() || ap_suspend_flag)
F
Felix Beck 已提交
1852
		return 0;
1853 1854 1855
	mutex_lock(&ap_poll_thread_mutex);
	if (!ap_poll_kthread) {
		ap_poll_kthread = kthread_run(ap_poll_thread, NULL, "appoll");
1856
		rc = PTR_RET(ap_poll_kthread);
1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875
		if (rc)
			ap_poll_kthread = NULL;
	}
	else
		rc = 0;
	mutex_unlock(&ap_poll_thread_mutex);
	return rc;
}

static void ap_poll_thread_stop(void)
{
	mutex_lock(&ap_poll_thread_mutex);
	if (ap_poll_kthread) {
		kthread_stop(ap_poll_kthread);
		ap_poll_kthread = NULL;
	}
	mutex_unlock(&ap_poll_thread_mutex);
}

1876
/**
1877 1878 1879 1880
 * ap_request_timeout(): Handling of request timeouts
 * @data: Holds the AP device.
 *
 * Handles request timeouts.
1881 1882 1883 1884 1885
 */
static void ap_request_timeout(unsigned long data)
{
	struct ap_device *ap_dev = (struct ap_device *) data;

F
Felix Beck 已提交
1886
	if (ap_dev->reset == AP_RESET_ARMED) {
1887
		ap_dev->reset = AP_RESET_DO;
F
Felix Beck 已提交
1888 1889 1890 1891

		if (ap_using_interrupts())
			tasklet_schedule(&ap_tasklet);
	}
1892 1893
}

1894 1895 1896 1897
static void ap_reset_domain(void)
{
	int i;

1898 1899 1900
	if (ap_domain_index != -1)
		for (i = 0; i < AP_DEVICES; i++)
			ap_reset_queue(AP_MKQID(i, ap_domain_index));
1901 1902 1903
}

static void ap_reset_all(void)
1904 1905 1906
{
	int i, j;

1907 1908 1909 1910 1911 1912
	for (i = 0; i < AP_DOMAINS; i++) {
		if (!ap_test_config_domain(i))
			continue;
		for (j = 0; j < AP_DEVICES; j++) {
			if (!ap_test_config_card_id(j))
				continue;
1913
			ap_reset_queue(AP_MKQID(j, i));
1914 1915
		}
	}
1916 1917 1918
}

static struct reset_call ap_reset_call = {
1919
	.fn = ap_reset_all,
1920 1921
};

1922
/**
1923 1924 1925
 * ap_module_init(): The module initialization code.
 *
 * Initializes the module.
1926 1927 1928 1929 1930 1931
 */
int __init ap_module_init(void)
{
	int rc, i;

	if (ap_domain_index < -1 || ap_domain_index >= AP_DOMAINS) {
1932 1933
		pr_warning("%d is not a valid cryptographic domain\n",
			   ap_domain_index);
1934 1935
		return -EINVAL;
	}
1936 1937 1938 1939 1940 1941
	/* In resume callback we need to know if the user had set the domain.
	 * If so, we can not just reset it.
	 */
	if (ap_domain_index >= 0)
		user_set_domain = 1;

1942
	if (ap_instructions_available() != 0) {
1943 1944
		pr_warning("The hardware system does not support "
			   "AP instructions\n");
1945 1946
		return -ENODEV;
	}
F
Felix Beck 已提交
1947
	if (ap_interrupts_available()) {
1948 1949
		rc = register_adapter_interrupt(&ap_airq);
		ap_airq_flag = (rc == 0);
F
Felix Beck 已提交
1950 1951
	}

1952
	register_reset_call(&ap_reset_call);
1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964

	/* Create /sys/bus/ap. */
	rc = bus_register(&ap_bus_type);
	if (rc)
		goto out;
	for (i = 0; ap_bus_attrs[i]; i++) {
		rc = bus_create_file(&ap_bus_type, ap_bus_attrs[i]);
		if (rc)
			goto out_bus;
	}

	/* Create /sys/devices/ap. */
M
Mark McLoughlin 已提交
1965
	ap_root_device = root_device_register("ap");
1966
	rc = PTR_RET(ap_root_device);
1967 1968 1969 1970 1971 1972 1973 1974 1975
	if (rc)
		goto out_bus;

	ap_work_queue = create_singlethread_workqueue("kapwork");
	if (!ap_work_queue) {
		rc = -ENOMEM;
		goto out_root;
	}

1976
	ap_query_configuration();
1977 1978 1979
	if (ap_select_domain() == 0)
		ap_scan_bus(NULL);

1980
	/* Setup the AP bus rescan timer. */
1981 1982 1983 1984 1985 1986
	init_timer(&ap_config_timer);
	ap_config_timer.function = ap_config_timeout;
	ap_config_timer.data = 0;
	ap_config_timer.expires = jiffies + ap_config_time * HZ;
	add_timer(&ap_config_timer);

1987 1988 1989 1990 1991
	/* Setup the high resultion poll timer.
	 * If we are running under z/VM adjust polling to z/VM polling rate.
	 */
	if (MACHINE_IS_VM)
		poll_timeout = 1500000;
1992
	spin_lock_init(&ap_poll_timer_lock);
1993 1994 1995
	hrtimer_init(&ap_poll_timer, CLOCK_MONOTONIC, HRTIMER_MODE_ABS);
	ap_poll_timer.function = ap_poll_timeout;

1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006
	/* Start the low priority AP bus poll thread. */
	if (ap_thread_flag) {
		rc = ap_poll_thread_start();
		if (rc)
			goto out_work;
	}

	return 0;

out_work:
	del_timer_sync(&ap_config_timer);
2007
	hrtimer_cancel(&ap_poll_timer);
2008 2009
	destroy_workqueue(ap_work_queue);
out_root:
M
Mark McLoughlin 已提交
2010
	root_device_unregister(ap_root_device);
2011 2012 2013 2014 2015
out_bus:
	while (i--)
		bus_remove_file(&ap_bus_type, ap_bus_attrs[i]);
	bus_unregister(&ap_bus_type);
out:
2016
	unregister_reset_call(&ap_reset_call);
2017 2018
	if (ap_using_interrupts())
		unregister_adapter_interrupt(&ap_airq);
2019 2020 2021 2022 2023 2024 2025 2026 2027
	return rc;
}

static int __ap_match_all(struct device *dev, void *data)
{
	return 1;
}

/**
2028 2029 2030
 * ap_modules_exit(): The module termination code
 *
 * Terminates the module.
2031 2032 2033 2034 2035 2036
 */
void ap_module_exit(void)
{
	int i;
	struct device *dev;

2037
	ap_reset_domain();
2038 2039
	ap_poll_thread_stop();
	del_timer_sync(&ap_config_timer);
2040
	hrtimer_cancel(&ap_poll_timer);
2041
	destroy_workqueue(ap_work_queue);
2042
	tasklet_kill(&ap_tasklet);
M
Mark McLoughlin 已提交
2043
	root_device_unregister(ap_root_device);
2044 2045 2046 2047 2048 2049 2050 2051 2052
	while ((dev = bus_find_device(&ap_bus_type, NULL, NULL,
		    __ap_match_all)))
	{
		device_unregister(dev);
		put_device(dev);
	}
	for (i = 0; ap_bus_attrs[i]; i++)
		bus_remove_file(&ap_bus_type, ap_bus_attrs[i]);
	bus_unregister(&ap_bus_type);
2053
	unregister_reset_call(&ap_reset_call);
2054 2055
	if (ap_using_interrupts())
		unregister_adapter_interrupt(&ap_airq);
2056 2057 2058 2059
}

module_init(ap_module_init);
module_exit(ap_module_exit);