2 * Copyright IBM Corp. 2006, 2012
3 * Author(s): Cornelia Huck <cornelia.huck@de.ibm.com>
4 * Martin Schwidefsky <schwidefsky@de.ibm.com>
5 * Ralph Wuerthner <rwuerthn@de.ibm.com>
6 * Felix Beck <felix.beck@de.ibm.com>
7 * Holger Dengler <hd@linux.vnet.ibm.com>
9 * Adjunct processor bus.
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; either version 2, or (at your option)
16 * This program is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
19 * GNU General Public License for more details.
21 * You should have received a copy of the GNU General Public License
22 * along with this program; if not, write to the Free Software
23 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
26 #define KMSG_COMPONENT "ap"
27 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
29 #include <linux/kernel_stat.h>
30 #include <linux/module.h>
31 #include <linux/init.h>
32 #include <linux/delay.h>
33 #include <linux/err.h>
34 #include <linux/interrupt.h>
35 #include <linux/workqueue.h>
36 #include <linux/slab.h>
37 #include <linux/notifier.h>
38 #include <linux/kthread.h>
39 #include <linux/mutex.h>
40 #include <linux/suspend.h>
41 #include <asm/reset.h>
43 #include <linux/atomic.h>
45 #include <linux/hrtimer.h>
46 #include <linux/ktime.h>
47 #include <asm/facility.h>
48 #include <linux/crypto.h>
55 MODULE_AUTHOR("IBM Corporation");
56 MODULE_DESCRIPTION("Adjunct Processor Bus driver, " \
57 "Copyright IBM Corp. 2006, 2012");
58 MODULE_LICENSE("GPL");
59 MODULE_ALIAS_CRYPTO("z90crypt");
64 int ap_domain_index = -1; /* Adjunct Processor Domain Index */
65 module_param_named(domain, ap_domain_index, int, S_IRUSR|S_IRGRP);
66 MODULE_PARM_DESC(domain, "domain index for ap devices");
67 EXPORT_SYMBOL(ap_domain_index);
69 static int ap_thread_flag = 0;
70 module_param_named(poll_thread, ap_thread_flag, int, S_IRUSR|S_IRGRP);
71 MODULE_PARM_DESC(poll_thread, "Turn on/off poll thread, default is 0 (off).");
73 static struct device *ap_root_device = NULL;
74 static struct ap_config_info *ap_configuration;
75 static DEFINE_SPINLOCK(ap_device_list_lock);
76 static LIST_HEAD(ap_device_list);
77 static bool initialised;
80 * Workqueue timer for bus rescan.
82 static struct timer_list ap_config_timer;
83 static int ap_config_time = AP_CONFIG_TIME;
84 static void ap_scan_bus(struct work_struct *);
85 static DECLARE_WORK(ap_scan_work, ap_scan_bus);
88 * Tasklet & timer for AP request polling and interrupts
90 static void ap_tasklet_fn(unsigned long);
91 static DECLARE_TASKLET(ap_tasklet, ap_tasklet_fn, 0);
92 static atomic_t ap_poll_requests = ATOMIC_INIT(0);
93 static DECLARE_WAIT_QUEUE_HEAD(ap_poll_wait);
94 static struct task_struct *ap_poll_kthread = NULL;
95 static DEFINE_MUTEX(ap_poll_thread_mutex);
96 static DEFINE_SPINLOCK(ap_poll_timer_lock);
97 static struct hrtimer ap_poll_timer;
98 /* In LPAR poll with 4kHz frequency. Poll every 250000 nanoseconds.
99 * If z/VM change to 1500000 nanoseconds to adjust to z/VM polling.*/
100 static unsigned long long poll_timeout = 250000;
103 static int ap_suspend_flag;
104 /* Maximum domain id */
105 static int ap_max_domain_id;
106 /* Flag to check if domain was set through module parameter domain=. This is
107 * important when supsend and resume is done in a z/VM environment where the
108 * domain might change. */
109 static int user_set_domain = 0;
110 static struct bus_type ap_bus_type;
112 /* Adapter interrupt definitions */
113 static void ap_interrupt_handler(struct airq_struct *airq);
115 static int ap_airq_flag;
117 static struct airq_struct ap_airq = {
118 .handler = ap_interrupt_handler,
123 * ap_using_interrupts() - Returns non-zero if interrupt support is
126 static inline int ap_using_interrupts(void)
132 * ap_intructions_available() - Test if AP instructions are available.
134 * Returns 0 if the AP instructions are installed.
136 static inline int ap_instructions_available(void)
138 register unsigned long reg0 asm ("0") = AP_MKQID(0,0);
139 register unsigned long reg1 asm ("1") = -ENODEV;
140 register unsigned long reg2 asm ("2") = 0UL;
143 " .long 0xb2af0000\n" /* PQAP(TAPQ) */
147 : "+d" (reg0), "+d" (reg1), "+d" (reg2) : : "cc" );
152 * ap_interrupts_available(): Test if AP interrupts are available.
154 * Returns 1 if AP interrupts are available.
156 static int ap_interrupts_available(void)
158 return test_facility(65);
162 * ap_configuration_available(): Test if AP configuration
163 * information is available.
165 * Returns 1 if AP configuration information is available.
167 static int ap_configuration_available(void)
169 return test_facility(12);
172 static inline struct ap_queue_status
173 __pqap_tapq(ap_qid_t qid, unsigned long *info)
175 register unsigned long reg0 asm ("0") = qid;
176 register struct ap_queue_status reg1 asm ("1");
177 register unsigned long reg2 asm ("2") = 0UL;
179 asm volatile(".long 0xb2af0000" /* PQAP(TAPQ) */
180 : "+d" (reg0), "=d" (reg1), "+d" (reg2) : : "cc");
186 * ap_test_queue(): Test adjunct processor queue.
187 * @qid: The AP queue number
188 * @info: Pointer to queue descriptor
190 * Returns AP queue status structure.
192 static inline struct ap_queue_status
193 ap_test_queue(ap_qid_t qid, unsigned long *info)
195 struct ap_queue_status aqs;
198 if (test_facility(15))
199 qid |= 1UL << 23; /* set APFT T bit*/
200 aqs = __pqap_tapq(qid, &_info);
207 * ap_reset_queue(): Reset adjunct processor queue.
208 * @qid: The AP queue number
210 * Returns AP queue status structure.
212 static inline struct ap_queue_status ap_reset_queue(ap_qid_t qid)
214 register unsigned long reg0 asm ("0") = qid | 0x01000000UL;
215 register struct ap_queue_status reg1 asm ("1");
216 register unsigned long reg2 asm ("2") = 0UL;
219 ".long 0xb2af0000" /* PQAP(RAPQ) */
220 : "+d" (reg0), "=d" (reg1), "+d" (reg2) : : "cc");
225 * ap_queue_interruption_control(): Enable interruption for a specific AP.
226 * @qid: The AP queue number
227 * @ind: The notification indicator byte
229 * Returns AP queue status.
231 static inline struct ap_queue_status
232 ap_queue_interruption_control(ap_qid_t qid, void *ind)
234 register unsigned long reg0 asm ("0") = qid | 0x03000000UL;
235 register unsigned long reg1_in asm ("1") = 0x0000800000000000UL | AP_ISC;
236 register struct ap_queue_status reg1_out asm ("1");
237 register void *reg2 asm ("2") = ind;
239 ".long 0xb2af0000" /* PQAP(AQIC) */
240 : "+d" (reg0), "+d" (reg1_in), "=d" (reg1_out), "+d" (reg2)
247 * ap_query_configuration(): Get AP configuration data
249 * Returns 0 on success, or -EOPNOTSUPP.
251 static inline int __ap_query_configuration(void)
253 register unsigned long reg0 asm ("0") = 0x04000000UL;
254 register unsigned long reg1 asm ("1") = -EINVAL;
255 register void *reg2 asm ("2") = (void *) ap_configuration;
258 ".long 0xb2af0000\n" /* PQAP(QCI) */
262 : "+d" (reg0), "+d" (reg1), "+d" (reg2)
269 static inline int ap_query_configuration(void)
271 if (!ap_configuration)
273 return __ap_query_configuration();
277 * ap_init_configuration(): Allocate and query configuration array.
279 static void ap_init_configuration(void)
281 if (!ap_configuration_available())
284 ap_configuration = kzalloc(sizeof(*ap_configuration), GFP_KERNEL);
285 if (!ap_configuration)
287 if (ap_query_configuration() != 0) {
288 kfree(ap_configuration);
289 ap_configuration = NULL;
295 * ap_test_config(): helper function to extract the nrth bit
296 * within the unsigned int array field.
298 static inline int ap_test_config(unsigned int *field, unsigned int nr)
300 return ap_test_bit((field + (nr >> 5)), (nr & 0x1f));
304 * ap_test_config_card_id(): Test, whether an AP card ID is configured.
307 * Returns 0 if the card is not configured
308 * 1 if the card is configured or
309 * if the configuration information is not available
311 static inline int ap_test_config_card_id(unsigned int id)
313 if (!ap_configuration) /* QCI not supported */
315 return ap_test_config(ap_configuration->apm, id);
319 * ap_test_config_domain(): Test, whether an AP usage domain is configured.
320 * @domain AP usage domain ID
322 * Returns 0 if the usage domain is not configured
323 * 1 if the usage domain is configured or
324 * if the configuration information is not available
326 static inline int ap_test_config_domain(unsigned int domain)
328 if (!ap_configuration) /* QCI not supported */
330 return ap_test_config(ap_configuration->aqm, domain);
334 * ap_queue_enable_interruption(): Enable interruption on an AP.
335 * @qid: The AP queue number
336 * @ind: the notification indicator byte
338 * Enables interruption on AP queue via ap_queue_interruption_control(). Based
339 * on the return value it waits a while and tests the AP queue if interrupts
340 * have been switched on using ap_test_queue().
342 static int ap_queue_enable_interruption(struct ap_device *ap_dev, void *ind)
344 struct ap_queue_status status;
346 status = ap_queue_interruption_control(ap_dev->qid, ind);
347 switch (status.response_code) {
348 case AP_RESPONSE_NORMAL:
349 case AP_RESPONSE_OTHERWISE_CHANGED:
351 case AP_RESPONSE_Q_NOT_AVAIL:
352 case AP_RESPONSE_DECONFIGURED:
353 case AP_RESPONSE_CHECKSTOPPED:
354 case AP_RESPONSE_INVALID_ADDRESS:
355 pr_err("Registering adapter interrupts for AP %d failed\n",
356 AP_QID_DEVICE(ap_dev->qid));
358 case AP_RESPONSE_RESET_IN_PROGRESS:
359 case AP_RESPONSE_BUSY:
365 static inline struct ap_queue_status
366 __nqap(ap_qid_t qid, unsigned long long psmid, void *msg, size_t length)
368 typedef struct { char _[length]; } msgblock;
369 register unsigned long reg0 asm ("0") = qid | 0x40000000UL;
370 register struct ap_queue_status reg1 asm ("1");
371 register unsigned long reg2 asm ("2") = (unsigned long) msg;
372 register unsigned long reg3 asm ("3") = (unsigned long) length;
373 register unsigned long reg4 asm ("4") = (unsigned int) (psmid >> 32);
374 register unsigned long reg5 asm ("5") = psmid & 0xffffffff;
377 "0: .long 0xb2ad0042\n" /* NQAP */
379 : "+d" (reg0), "=d" (reg1), "+d" (reg2), "+d" (reg3)
380 : "d" (reg4), "d" (reg5), "m" (*(msgblock *) msg)
386 * __ap_send(): Send message to adjunct processor queue.
387 * @qid: The AP queue number
388 * @psmid: The program supplied message identifier
389 * @msg: The message text
390 * @length: The message length
391 * @special: Special Bit
393 * Returns AP queue status structure.
394 * Condition code 1 on NQAP can't happen because the L bit is 1.
395 * Condition code 2 on NQAP also means the send is incomplete,
396 * because a segment boundary was reached. The NQAP is repeated.
398 static inline struct ap_queue_status
399 __ap_send(ap_qid_t qid, unsigned long long psmid, void *msg, size_t length,
400 unsigned int special)
404 return __nqap(qid, psmid, msg, length);
407 int ap_send(ap_qid_t qid, unsigned long long psmid, void *msg, size_t length)
409 struct ap_queue_status status;
411 status = __ap_send(qid, psmid, msg, length, 0);
412 switch (status.response_code) {
413 case AP_RESPONSE_NORMAL:
415 case AP_RESPONSE_Q_FULL:
416 case AP_RESPONSE_RESET_IN_PROGRESS:
418 case AP_RESPONSE_REQ_FAC_NOT_INST:
420 default: /* Device is gone. */
424 EXPORT_SYMBOL(ap_send);
427 * __ap_recv(): Receive message from adjunct processor queue.
428 * @qid: The AP queue number
429 * @psmid: Pointer to program supplied message identifier
430 * @msg: The message text
431 * @length: The message length
433 * Returns AP queue status structure.
434 * Condition code 1 on DQAP means the receive has taken place
435 * but only partially. The response is incomplete, hence the
437 * Condition code 2 on DQAP also means the receive is incomplete,
438 * this time because a segment boundary was reached. Again, the
440 * Note that gpr2 is used by the DQAP instruction to keep track of
441 * any 'residual' length, in case the instruction gets interrupted.
442 * Hence it gets zeroed before the instruction.
444 static inline struct ap_queue_status
445 __ap_recv(ap_qid_t qid, unsigned long long *psmid, void *msg, size_t length)
447 typedef struct { char _[length]; } msgblock;
448 register unsigned long reg0 asm("0") = qid | 0x80000000UL;
449 register struct ap_queue_status reg1 asm ("1");
450 register unsigned long reg2 asm("2") = 0UL;
451 register unsigned long reg4 asm("4") = (unsigned long) msg;
452 register unsigned long reg5 asm("5") = (unsigned long) length;
453 register unsigned long reg6 asm("6") = 0UL;
454 register unsigned long reg7 asm("7") = 0UL;
458 "0: .long 0xb2ae0064\n" /* DQAP */
460 : "+d" (reg0), "=d" (reg1), "+d" (reg2),
461 "+d" (reg4), "+d" (reg5), "+d" (reg6), "+d" (reg7),
462 "=m" (*(msgblock *) msg) : : "cc" );
463 *psmid = (((unsigned long long) reg6) << 32) + reg7;
467 int ap_recv(ap_qid_t qid, unsigned long long *psmid, void *msg, size_t length)
469 struct ap_queue_status status;
471 status = __ap_recv(qid, psmid, msg, length);
472 switch (status.response_code) {
473 case AP_RESPONSE_NORMAL:
475 case AP_RESPONSE_NO_PENDING_REPLY:
476 if (status.queue_empty)
479 case AP_RESPONSE_RESET_IN_PROGRESS:
485 EXPORT_SYMBOL(ap_recv);
488 * ap_query_queue(): Check if an AP queue is available.
489 * @qid: The AP queue number
490 * @queue_depth: Pointer to queue depth value
491 * @device_type: Pointer to device type value
492 * @facilities: Pointer to facility indicator
494 static int ap_query_queue(ap_qid_t qid, int *queue_depth, int *device_type,
495 unsigned int *facilities)
497 struct ap_queue_status status;
501 if (!ap_test_config_card_id(AP_QID_DEVICE(qid)))
504 status = ap_test_queue(qid, &info);
505 switch (status.response_code) {
506 case AP_RESPONSE_NORMAL:
507 *queue_depth = (int)(info & 0xff);
508 *device_type = (int)((info >> 24) & 0xff);
509 *facilities = (unsigned int)(info >> 32);
510 /* Update maximum domain id */
511 nd = (info >> 16) & 0xff;
512 if ((info & (1UL << 57)) && nd > 0)
513 ap_max_domain_id = nd;
515 case AP_RESPONSE_Q_NOT_AVAIL:
516 case AP_RESPONSE_DECONFIGURED:
517 case AP_RESPONSE_CHECKSTOPPED:
518 case AP_RESPONSE_INVALID_ADDRESS:
520 case AP_RESPONSE_RESET_IN_PROGRESS:
521 case AP_RESPONSE_OTHERWISE_CHANGED:
522 case AP_RESPONSE_BUSY:
529 /* State machine definitions and helpers */
531 static void ap_sm_wait(enum ap_wait wait)
537 case AP_WAIT_INTERRUPT:
538 if (ap_using_interrupts())
540 if (ap_poll_kthread) {
541 wake_up(&ap_poll_wait);
545 case AP_WAIT_TIMEOUT:
546 spin_lock_bh(&ap_poll_timer_lock);
547 if (!hrtimer_is_queued(&ap_poll_timer)) {
548 hr_time = ktime_set(0, poll_timeout);
549 hrtimer_forward_now(&ap_poll_timer, hr_time);
550 hrtimer_restart(&ap_poll_timer);
552 spin_unlock_bh(&ap_poll_timer_lock);
560 static enum ap_wait ap_sm_nop(struct ap_device *ap_dev)
566 * ap_sm_recv(): Receive pending reply messages from an AP device but do
567 * not change the state of the device.
568 * @ap_dev: pointer to the AP device
570 * Returns AP_WAIT_NONE, AP_WAIT_AGAIN, or AP_WAIT_INTERRUPT
572 static struct ap_queue_status ap_sm_recv(struct ap_device *ap_dev)
574 struct ap_queue_status status;
575 struct ap_message *ap_msg;
577 status = __ap_recv(ap_dev->qid, &ap_dev->reply->psmid,
578 ap_dev->reply->message, ap_dev->reply->length);
579 switch (status.response_code) {
580 case AP_RESPONSE_NORMAL:
581 atomic_dec(&ap_poll_requests);
582 ap_dev->queue_count--;
583 if (ap_dev->queue_count > 0)
584 mod_timer(&ap_dev->timeout,
585 jiffies + ap_dev->drv->request_timeout);
586 list_for_each_entry(ap_msg, &ap_dev->pendingq, list) {
587 if (ap_msg->psmid != ap_dev->reply->psmid)
589 list_del_init(&ap_msg->list);
590 ap_dev->pendingq_count--;
591 ap_msg->receive(ap_dev, ap_msg, ap_dev->reply);
594 case AP_RESPONSE_NO_PENDING_REPLY:
595 if (!status.queue_empty || ap_dev->queue_count <= 0)
597 /* The card shouldn't forget requests but who knows. */
598 atomic_sub(ap_dev->queue_count, &ap_poll_requests);
599 ap_dev->queue_count = 0;
600 list_splice_init(&ap_dev->pendingq, &ap_dev->requestq);
601 ap_dev->requestq_count += ap_dev->pendingq_count;
602 ap_dev->pendingq_count = 0;
611 * ap_sm_read(): Receive pending reply messages from an AP device.
612 * @ap_dev: pointer to the AP device
614 * Returns AP_WAIT_NONE, AP_WAIT_AGAIN, or AP_WAIT_INTERRUPT
616 static enum ap_wait ap_sm_read(struct ap_device *ap_dev)
618 struct ap_queue_status status;
620 status = ap_sm_recv(ap_dev);
621 switch (status.response_code) {
622 case AP_RESPONSE_NORMAL:
623 if (ap_dev->queue_count > 0) {
624 ap_dev->state = AP_STATE_WORKING;
625 return AP_WAIT_AGAIN;
627 ap_dev->state = AP_STATE_IDLE;
629 case AP_RESPONSE_NO_PENDING_REPLY:
630 if (ap_dev->queue_count > 0)
631 return AP_WAIT_INTERRUPT;
632 ap_dev->state = AP_STATE_IDLE;
635 ap_dev->state = AP_STATE_BORKED;
641 * ap_sm_write(): Send messages from the request queue to an AP device.
642 * @ap_dev: pointer to the AP device
644 * Returns AP_WAIT_NONE, AP_WAIT_AGAIN, or AP_WAIT_INTERRUPT
646 static enum ap_wait ap_sm_write(struct ap_device *ap_dev)
648 struct ap_queue_status status;
649 struct ap_message *ap_msg;
651 if (ap_dev->requestq_count <= 0)
653 /* Start the next request on the queue. */
654 ap_msg = list_entry(ap_dev->requestq.next, struct ap_message, list);
655 status = __ap_send(ap_dev->qid, ap_msg->psmid,
656 ap_msg->message, ap_msg->length, ap_msg->special);
657 switch (status.response_code) {
658 case AP_RESPONSE_NORMAL:
659 atomic_inc(&ap_poll_requests);
660 ap_dev->queue_count++;
661 if (ap_dev->queue_count == 1)
662 mod_timer(&ap_dev->timeout,
663 jiffies + ap_dev->drv->request_timeout);
664 list_move_tail(&ap_msg->list, &ap_dev->pendingq);
665 ap_dev->requestq_count--;
666 ap_dev->pendingq_count++;
667 if (ap_dev->queue_count < ap_dev->queue_depth) {
668 ap_dev->state = AP_STATE_WORKING;
669 return AP_WAIT_AGAIN;
672 case AP_RESPONSE_Q_FULL:
673 ap_dev->state = AP_STATE_QUEUE_FULL;
674 return AP_WAIT_INTERRUPT;
675 case AP_RESPONSE_RESET_IN_PROGRESS:
676 ap_dev->state = AP_STATE_RESET_WAIT;
677 return AP_WAIT_TIMEOUT;
678 case AP_RESPONSE_MESSAGE_TOO_BIG:
679 case AP_RESPONSE_REQ_FAC_NOT_INST:
680 list_del_init(&ap_msg->list);
681 ap_dev->requestq_count--;
682 ap_msg->rc = -EINVAL;
683 ap_msg->receive(ap_dev, ap_msg, NULL);
684 return AP_WAIT_AGAIN;
686 ap_dev->state = AP_STATE_BORKED;
692 * ap_sm_read_write(): Send and receive messages to/from an AP device.
693 * @ap_dev: pointer to the AP device
695 * Returns AP_WAIT_NONE, AP_WAIT_AGAIN, or AP_WAIT_INTERRUPT
697 static enum ap_wait ap_sm_read_write(struct ap_device *ap_dev)
699 return min(ap_sm_read(ap_dev), ap_sm_write(ap_dev));
703 * ap_sm_reset(): Reset an AP queue.
704 * @qid: The AP queue number
706 * Submit the Reset command to an AP queue.
708 static enum ap_wait ap_sm_reset(struct ap_device *ap_dev)
710 struct ap_queue_status status;
712 status = ap_reset_queue(ap_dev->qid);
713 switch (status.response_code) {
714 case AP_RESPONSE_NORMAL:
715 case AP_RESPONSE_RESET_IN_PROGRESS:
716 ap_dev->state = AP_STATE_RESET_WAIT;
717 ap_dev->interrupt = AP_INTR_DISABLED;
718 return AP_WAIT_TIMEOUT;
719 case AP_RESPONSE_BUSY:
720 return AP_WAIT_TIMEOUT;
721 case AP_RESPONSE_Q_NOT_AVAIL:
722 case AP_RESPONSE_DECONFIGURED:
723 case AP_RESPONSE_CHECKSTOPPED:
725 ap_dev->state = AP_STATE_BORKED;
731 * ap_sm_reset_wait(): Test queue for completion of the reset operation
732 * @ap_dev: pointer to the AP device
734 * Returns AP_POLL_IMMEDIATELY, AP_POLL_AFTER_TIMEROUT or 0.
736 static enum ap_wait ap_sm_reset_wait(struct ap_device *ap_dev)
738 struct ap_queue_status status;
741 if (ap_dev->queue_count > 0)
742 /* Try to read a completed message and get the status */
743 status = ap_sm_recv(ap_dev);
745 /* Get the status with TAPQ */
746 status = ap_test_queue(ap_dev->qid, &info);
748 switch (status.response_code) {
749 case AP_RESPONSE_NORMAL:
750 if (ap_using_interrupts() &&
751 ap_queue_enable_interruption(ap_dev,
752 ap_airq.lsi_ptr) == 0)
753 ap_dev->state = AP_STATE_SETIRQ_WAIT;
755 ap_dev->state = (ap_dev->queue_count > 0) ?
756 AP_STATE_WORKING : AP_STATE_IDLE;
757 return AP_WAIT_AGAIN;
758 case AP_RESPONSE_BUSY:
759 case AP_RESPONSE_RESET_IN_PROGRESS:
760 return AP_WAIT_TIMEOUT;
761 case AP_RESPONSE_Q_NOT_AVAIL:
762 case AP_RESPONSE_DECONFIGURED:
763 case AP_RESPONSE_CHECKSTOPPED:
765 ap_dev->state = AP_STATE_BORKED;
771 * ap_sm_setirq_wait(): Test queue for completion of the irq enablement
772 * @ap_dev: pointer to the AP device
774 * Returns AP_POLL_IMMEDIATELY, AP_POLL_AFTER_TIMEROUT or 0.
776 static enum ap_wait ap_sm_setirq_wait(struct ap_device *ap_dev)
778 struct ap_queue_status status;
781 if (ap_dev->queue_count > 0)
782 /* Try to read a completed message and get the status */
783 status = ap_sm_recv(ap_dev);
785 /* Get the status with TAPQ */
786 status = ap_test_queue(ap_dev->qid, &info);
788 if (status.int_enabled == 1) {
789 /* Irqs are now enabled */
790 ap_dev->interrupt = AP_INTR_ENABLED;
791 ap_dev->state = (ap_dev->queue_count > 0) ?
792 AP_STATE_WORKING : AP_STATE_IDLE;
795 switch (status.response_code) {
796 case AP_RESPONSE_NORMAL:
797 if (ap_dev->queue_count > 0)
798 return AP_WAIT_AGAIN;
800 case AP_RESPONSE_NO_PENDING_REPLY:
801 return AP_WAIT_TIMEOUT;
803 ap_dev->state = AP_STATE_BORKED;
809 * AP state machine jump table
811 static ap_func_t *ap_jumptable[NR_AP_STATES][NR_AP_EVENTS] = {
812 [AP_STATE_RESET_START] = {
813 [AP_EVENT_POLL] = ap_sm_reset,
814 [AP_EVENT_TIMEOUT] = ap_sm_nop,
816 [AP_STATE_RESET_WAIT] = {
817 [AP_EVENT_POLL] = ap_sm_reset_wait,
818 [AP_EVENT_TIMEOUT] = ap_sm_nop,
820 [AP_STATE_SETIRQ_WAIT] = {
821 [AP_EVENT_POLL] = ap_sm_setirq_wait,
822 [AP_EVENT_TIMEOUT] = ap_sm_nop,
825 [AP_EVENT_POLL] = ap_sm_write,
826 [AP_EVENT_TIMEOUT] = ap_sm_nop,
828 [AP_STATE_WORKING] = {
829 [AP_EVENT_POLL] = ap_sm_read_write,
830 [AP_EVENT_TIMEOUT] = ap_sm_reset,
832 [AP_STATE_QUEUE_FULL] = {
833 [AP_EVENT_POLL] = ap_sm_read,
834 [AP_EVENT_TIMEOUT] = ap_sm_reset,
836 [AP_STATE_SUSPEND_WAIT] = {
837 [AP_EVENT_POLL] = ap_sm_read,
838 [AP_EVENT_TIMEOUT] = ap_sm_nop,
840 [AP_STATE_BORKED] = {
841 [AP_EVENT_POLL] = ap_sm_nop,
842 [AP_EVENT_TIMEOUT] = ap_sm_nop,
846 static inline enum ap_wait ap_sm_event(struct ap_device *ap_dev,
849 return ap_jumptable[ap_dev->state][event](ap_dev);
852 static inline enum ap_wait ap_sm_event_loop(struct ap_device *ap_dev,
857 while ((wait = ap_sm_event(ap_dev, event)) == AP_WAIT_AGAIN)
863 * ap_request_timeout(): Handling of request timeouts
864 * @data: Holds the AP device.
866 * Handles request timeouts.
868 static void ap_request_timeout(unsigned long data)
870 struct ap_device *ap_dev = (struct ap_device *) data;
874 spin_lock_bh(&ap_dev->lock);
875 ap_sm_wait(ap_sm_event(ap_dev, AP_EVENT_TIMEOUT));
876 spin_unlock_bh(&ap_dev->lock);
880 * ap_poll_timeout(): AP receive polling for finished AP requests.
881 * @unused: Unused pointer.
883 * Schedules the AP tasklet using a high resolution timer.
885 static enum hrtimer_restart ap_poll_timeout(struct hrtimer *unused)
887 if (!ap_suspend_flag)
888 tasklet_schedule(&ap_tasklet);
889 return HRTIMER_NORESTART;
893 * ap_interrupt_handler() - Schedule ap_tasklet on interrupt
894 * @airq: pointer to adapter interrupt descriptor
896 static void ap_interrupt_handler(struct airq_struct *airq)
898 inc_irq_stat(IRQIO_APB);
899 if (!ap_suspend_flag)
900 tasklet_schedule(&ap_tasklet);
904 * ap_tasklet_fn(): Tasklet to poll all AP devices.
905 * @dummy: Unused variable
907 * Poll all AP devices on the bus.
909 static void ap_tasklet_fn(unsigned long dummy)
911 struct ap_device *ap_dev;
912 enum ap_wait wait = AP_WAIT_NONE;
914 /* Reset the indicator if interrupts are used. Thus new interrupts can
915 * be received. Doing it in the beginning of the tasklet is therefor
916 * important that no requests on any AP get lost.
918 if (ap_using_interrupts())
919 xchg(ap_airq.lsi_ptr, 0);
921 spin_lock(&ap_device_list_lock);
922 list_for_each_entry(ap_dev, &ap_device_list, list) {
923 spin_lock_bh(&ap_dev->lock);
924 wait = min(wait, ap_sm_event_loop(ap_dev, AP_EVENT_POLL));
925 spin_unlock_bh(&ap_dev->lock);
927 spin_unlock(&ap_device_list_lock);
932 * ap_poll_thread(): Thread that polls for finished requests.
933 * @data: Unused pointer
935 * AP bus poll thread. The purpose of this thread is to poll for
936 * finished requests in a loop if there is a "free" cpu - that is
937 * a cpu that doesn't have anything better to do. The polling stops
938 * as soon as there is another task or if all messages have been
941 static int ap_poll_thread(void *data)
943 DECLARE_WAITQUEUE(wait, current);
945 set_user_nice(current, MAX_NICE);
947 while (!kthread_should_stop()) {
948 add_wait_queue(&ap_poll_wait, &wait);
949 set_current_state(TASK_INTERRUPTIBLE);
950 if (ap_suspend_flag ||
951 atomic_read(&ap_poll_requests) <= 0) {
955 set_current_state(TASK_RUNNING);
956 remove_wait_queue(&ap_poll_wait, &wait);
957 if (need_resched()) {
963 } while (!kthread_should_stop());
967 static int ap_poll_thread_start(void)
971 if (ap_using_interrupts() || ap_poll_kthread)
973 mutex_lock(&ap_poll_thread_mutex);
974 ap_poll_kthread = kthread_run(ap_poll_thread, NULL, "appoll");
975 rc = PTR_RET(ap_poll_kthread);
977 ap_poll_kthread = NULL;
978 mutex_unlock(&ap_poll_thread_mutex);
982 static void ap_poll_thread_stop(void)
984 if (!ap_poll_kthread)
986 mutex_lock(&ap_poll_thread_mutex);
987 kthread_stop(ap_poll_kthread);
988 ap_poll_kthread = NULL;
989 mutex_unlock(&ap_poll_thread_mutex);
993 * ap_queue_message(): Queue a request to an AP device.
994 * @ap_dev: The AP device to queue the message to
995 * @ap_msg: The message that is to be added
997 void ap_queue_message(struct ap_device *ap_dev, struct ap_message *ap_msg)
999 /* For asynchronous message handling a valid receive-callback
1001 BUG_ON(!ap_msg->receive);
1003 spin_lock_bh(&ap_dev->lock);
1004 /* Queue the message. */
1005 list_add_tail(&ap_msg->list, &ap_dev->requestq);
1006 ap_dev->requestq_count++;
1007 ap_dev->total_request_count++;
1008 /* Send/receive as many request from the queue as possible. */
1009 ap_sm_wait(ap_sm_event_loop(ap_dev, AP_EVENT_POLL));
1010 spin_unlock_bh(&ap_dev->lock);
1012 EXPORT_SYMBOL(ap_queue_message);
1015 * ap_cancel_message(): Cancel a crypto request.
1016 * @ap_dev: The AP device that has the message queued
1017 * @ap_msg: The message that is to be removed
1019 * Cancel a crypto request. This is done by removing the request
1020 * from the device pending or request queue. Note that the
1021 * request stays on the AP queue. When it finishes the message
1022 * reply will be discarded because the psmid can't be found.
1024 void ap_cancel_message(struct ap_device *ap_dev, struct ap_message *ap_msg)
1026 struct ap_message *tmp;
1028 spin_lock_bh(&ap_dev->lock);
1029 if (!list_empty(&ap_msg->list)) {
1030 list_for_each_entry(tmp, &ap_dev->pendingq, list)
1031 if (tmp->psmid == ap_msg->psmid) {
1032 ap_dev->pendingq_count--;
1035 ap_dev->requestq_count--;
1037 list_del_init(&ap_msg->list);
1039 spin_unlock_bh(&ap_dev->lock);
1041 EXPORT_SYMBOL(ap_cancel_message);
1044 * AP device related attributes.
1046 static ssize_t ap_hwtype_show(struct device *dev,
1047 struct device_attribute *attr, char *buf)
1049 struct ap_device *ap_dev = to_ap_dev(dev);
1050 return snprintf(buf, PAGE_SIZE, "%d\n", ap_dev->device_type);
1053 static DEVICE_ATTR(hwtype, 0444, ap_hwtype_show, NULL);
1055 static ssize_t ap_raw_hwtype_show(struct device *dev,
1056 struct device_attribute *attr, char *buf)
1058 struct ap_device *ap_dev = to_ap_dev(dev);
1060 return snprintf(buf, PAGE_SIZE, "%d\n", ap_dev->raw_hwtype);
1063 static DEVICE_ATTR(raw_hwtype, 0444, ap_raw_hwtype_show, NULL);
1065 static ssize_t ap_depth_show(struct device *dev, struct device_attribute *attr,
1068 struct ap_device *ap_dev = to_ap_dev(dev);
1069 return snprintf(buf, PAGE_SIZE, "%d\n", ap_dev->queue_depth);
1072 static DEVICE_ATTR(depth, 0444, ap_depth_show, NULL);
1073 static ssize_t ap_request_count_show(struct device *dev,
1074 struct device_attribute *attr,
1077 struct ap_device *ap_dev = to_ap_dev(dev);
1080 spin_lock_bh(&ap_dev->lock);
1081 rc = snprintf(buf, PAGE_SIZE, "%d\n", ap_dev->total_request_count);
1082 spin_unlock_bh(&ap_dev->lock);
1086 static DEVICE_ATTR(request_count, 0444, ap_request_count_show, NULL);
1088 static ssize_t ap_requestq_count_show(struct device *dev,
1089 struct device_attribute *attr, char *buf)
1091 struct ap_device *ap_dev = to_ap_dev(dev);
1094 spin_lock_bh(&ap_dev->lock);
1095 rc = snprintf(buf, PAGE_SIZE, "%d\n", ap_dev->requestq_count);
1096 spin_unlock_bh(&ap_dev->lock);
1100 static DEVICE_ATTR(requestq_count, 0444, ap_requestq_count_show, NULL);
1102 static ssize_t ap_pendingq_count_show(struct device *dev,
1103 struct device_attribute *attr, char *buf)
1105 struct ap_device *ap_dev = to_ap_dev(dev);
1108 spin_lock_bh(&ap_dev->lock);
1109 rc = snprintf(buf, PAGE_SIZE, "%d\n", ap_dev->pendingq_count);
1110 spin_unlock_bh(&ap_dev->lock);
1114 static DEVICE_ATTR(pendingq_count, 0444, ap_pendingq_count_show, NULL);
1116 static ssize_t ap_reset_show(struct device *dev,
1117 struct device_attribute *attr, char *buf)
1119 struct ap_device *ap_dev = to_ap_dev(dev);
1122 spin_lock_bh(&ap_dev->lock);
1123 switch (ap_dev->state) {
1124 case AP_STATE_RESET_START:
1125 case AP_STATE_RESET_WAIT:
1126 rc = snprintf(buf, PAGE_SIZE, "Reset in progress.\n");
1128 case AP_STATE_WORKING:
1129 case AP_STATE_QUEUE_FULL:
1130 rc = snprintf(buf, PAGE_SIZE, "Reset Timer armed.\n");
1133 rc = snprintf(buf, PAGE_SIZE, "No Reset Timer set.\n");
1135 spin_unlock_bh(&ap_dev->lock);
1139 static DEVICE_ATTR(reset, 0444, ap_reset_show, NULL);
1141 static ssize_t ap_interrupt_show(struct device *dev,
1142 struct device_attribute *attr, char *buf)
1144 struct ap_device *ap_dev = to_ap_dev(dev);
1147 spin_lock_bh(&ap_dev->lock);
1148 if (ap_dev->state == AP_STATE_SETIRQ_WAIT)
1149 rc = snprintf(buf, PAGE_SIZE, "Enable Interrupt pending.\n");
1150 else if (ap_dev->interrupt == AP_INTR_ENABLED)
1151 rc = snprintf(buf, PAGE_SIZE, "Interrupts enabled.\n");
1153 rc = snprintf(buf, PAGE_SIZE, "Interrupts disabled.\n");
1154 spin_unlock_bh(&ap_dev->lock);
1158 static DEVICE_ATTR(interrupt, 0444, ap_interrupt_show, NULL);
1160 static ssize_t ap_modalias_show(struct device *dev,
1161 struct device_attribute *attr, char *buf)
1163 return sprintf(buf, "ap:t%02X\n", to_ap_dev(dev)->device_type);
1166 static DEVICE_ATTR(modalias, 0444, ap_modalias_show, NULL);
1168 static ssize_t ap_functions_show(struct device *dev,
1169 struct device_attribute *attr, char *buf)
1171 struct ap_device *ap_dev = to_ap_dev(dev);
1172 return snprintf(buf, PAGE_SIZE, "0x%08X\n", ap_dev->functions);
1175 static DEVICE_ATTR(ap_functions, 0444, ap_functions_show, NULL);
1177 static struct attribute *ap_dev_attrs[] = {
1178 &dev_attr_hwtype.attr,
1179 &dev_attr_raw_hwtype.attr,
1180 &dev_attr_depth.attr,
1181 &dev_attr_request_count.attr,
1182 &dev_attr_requestq_count.attr,
1183 &dev_attr_pendingq_count.attr,
1184 &dev_attr_reset.attr,
1185 &dev_attr_interrupt.attr,
1186 &dev_attr_modalias.attr,
1187 &dev_attr_ap_functions.attr,
1190 static struct attribute_group ap_dev_attr_group = {
1191 .attrs = ap_dev_attrs
1196 * @dev: Pointer to device
1197 * @drv: Pointer to device_driver
1199 * AP bus driver registration/unregistration.
1201 static int ap_bus_match(struct device *dev, struct device_driver *drv)
1203 struct ap_device *ap_dev = to_ap_dev(dev);
1204 struct ap_driver *ap_drv = to_ap_drv(drv);
1205 struct ap_device_id *id;
1208 * Compare device type of the device with the list of
1209 * supported types of the device_driver.
1211 for (id = ap_drv->ids; id->match_flags; id++) {
1212 if ((id->match_flags & AP_DEVICE_ID_MATCH_DEVICE_TYPE) &&
1213 (id->dev_type != ap_dev->device_type))
1221 * ap_uevent(): Uevent function for AP devices.
1222 * @dev: Pointer to device
1223 * @env: Pointer to kobj_uevent_env
1225 * It sets up a single environment variable DEV_TYPE which contains the
1226 * hardware device type.
1228 static int ap_uevent (struct device *dev, struct kobj_uevent_env *env)
1230 struct ap_device *ap_dev = to_ap_dev(dev);
1236 /* Set up DEV_TYPE environment variable. */
1237 retval = add_uevent_var(env, "DEV_TYPE=%04X", ap_dev->device_type);
1242 retval = add_uevent_var(env, "MODALIAS=ap:t%02X", ap_dev->device_type);
1247 static int ap_dev_suspend(struct device *dev, pm_message_t state)
1249 struct ap_device *ap_dev = to_ap_dev(dev);
1251 /* Poll on the device until all requests are finished. */
1252 spin_lock_bh(&ap_dev->lock);
1253 ap_dev->state = AP_STATE_SUSPEND_WAIT;
1254 while (ap_sm_event(ap_dev, AP_EVENT_POLL) != AP_WAIT_NONE)
1256 ap_dev->state = AP_STATE_BORKED;
1257 spin_unlock_bh(&ap_dev->lock);
1261 static int ap_dev_resume(struct device *dev)
1266 static void ap_bus_suspend(void)
1268 ap_suspend_flag = 1;
1270 * Disable scanning for devices, thus we do not want to scan
1271 * for them after removing.
1273 flush_work(&ap_scan_work);
1274 tasklet_disable(&ap_tasklet);
1277 static int __ap_devices_unregister(struct device *dev, void *dummy)
1279 device_unregister(dev);
1283 static void ap_bus_resume(void)
1287 /* Unconditionally remove all AP devices */
1288 bus_for_each_dev(&ap_bus_type, NULL, NULL, __ap_devices_unregister);
1289 /* Reset thin interrupt setting */
1290 if (ap_interrupts_available() && !ap_using_interrupts()) {
1291 rc = register_adapter_interrupt(&ap_airq);
1292 ap_airq_flag = (rc == 0);
1294 if (!ap_interrupts_available() && ap_using_interrupts()) {
1295 unregister_adapter_interrupt(&ap_airq);
1299 if (!user_set_domain)
1300 ap_domain_index = -1;
1301 /* Get things going again */
1302 ap_suspend_flag = 0;
1304 xchg(ap_airq.lsi_ptr, 0);
1305 tasklet_enable(&ap_tasklet);
1306 queue_work(system_long_wq, &ap_scan_work);
1309 static int ap_power_event(struct notifier_block *this, unsigned long event,
1313 case PM_HIBERNATION_PREPARE:
1314 case PM_SUSPEND_PREPARE:
1317 case PM_POST_HIBERNATION:
1318 case PM_POST_SUSPEND:
1326 static struct notifier_block ap_power_notifier = {
1327 .notifier_call = ap_power_event,
1330 static struct bus_type ap_bus_type = {
1332 .match = &ap_bus_match,
1333 .uevent = &ap_uevent,
1334 .suspend = ap_dev_suspend,
1335 .resume = ap_dev_resume,
1338 static int ap_device_probe(struct device *dev)
1340 struct ap_device *ap_dev = to_ap_dev(dev);
1341 struct ap_driver *ap_drv = to_ap_drv(dev->driver);
1344 ap_dev->drv = ap_drv;
1345 rc = ap_drv->probe ? ap_drv->probe(ap_dev) : -ENODEV;
1352 * __ap_flush_queue(): Flush requests.
1353 * @ap_dev: Pointer to the AP device
1355 * Flush all requests from the request/pending queue of an AP device.
1357 static void __ap_flush_queue(struct ap_device *ap_dev)
1359 struct ap_message *ap_msg, *next;
1361 list_for_each_entry_safe(ap_msg, next, &ap_dev->pendingq, list) {
1362 list_del_init(&ap_msg->list);
1363 ap_dev->pendingq_count--;
1364 ap_msg->rc = -EAGAIN;
1365 ap_msg->receive(ap_dev, ap_msg, NULL);
1367 list_for_each_entry_safe(ap_msg, next, &ap_dev->requestq, list) {
1368 list_del_init(&ap_msg->list);
1369 ap_dev->requestq_count--;
1370 ap_msg->rc = -EAGAIN;
1371 ap_msg->receive(ap_dev, ap_msg, NULL);
1375 void ap_flush_queue(struct ap_device *ap_dev)
1377 spin_lock_bh(&ap_dev->lock);
1378 __ap_flush_queue(ap_dev);
1379 spin_unlock_bh(&ap_dev->lock);
1381 EXPORT_SYMBOL(ap_flush_queue);
1383 static int ap_device_remove(struct device *dev)
1385 struct ap_device *ap_dev = to_ap_dev(dev);
1386 struct ap_driver *ap_drv = ap_dev->drv;
1388 ap_flush_queue(ap_dev);
1389 del_timer_sync(&ap_dev->timeout);
1390 spin_lock_bh(&ap_device_list_lock);
1391 list_del_init(&ap_dev->list);
1392 spin_unlock_bh(&ap_device_list_lock);
1394 ap_drv->remove(ap_dev);
1395 spin_lock_bh(&ap_dev->lock);
1396 atomic_sub(ap_dev->queue_count, &ap_poll_requests);
1397 spin_unlock_bh(&ap_dev->lock);
1401 static void ap_device_release(struct device *dev)
1403 kfree(to_ap_dev(dev));
1406 int ap_driver_register(struct ap_driver *ap_drv, struct module *owner,
1409 struct device_driver *drv = &ap_drv->driver;
1414 drv->bus = &ap_bus_type;
1415 drv->probe = ap_device_probe;
1416 drv->remove = ap_device_remove;
1419 return driver_register(drv);
1421 EXPORT_SYMBOL(ap_driver_register);
1423 void ap_driver_unregister(struct ap_driver *ap_drv)
1425 driver_unregister(&ap_drv->driver);
1427 EXPORT_SYMBOL(ap_driver_unregister);
1429 void ap_bus_force_rescan(void)
1431 if (ap_suspend_flag)
1433 /* processing a asynchronous bus rescan */
1434 del_timer(&ap_config_timer);
1435 queue_work(system_long_wq, &ap_scan_work);
1436 flush_work(&ap_scan_work);
1438 EXPORT_SYMBOL(ap_bus_force_rescan);
1441 * AP bus attributes.
1443 static ssize_t ap_domain_show(struct bus_type *bus, char *buf)
1445 return snprintf(buf, PAGE_SIZE, "%d\n", ap_domain_index);
1448 static BUS_ATTR(ap_domain, 0444, ap_domain_show, NULL);
1450 static ssize_t ap_control_domain_mask_show(struct bus_type *bus, char *buf)
1452 if (!ap_configuration) /* QCI not supported */
1453 return snprintf(buf, PAGE_SIZE, "not supported\n");
1454 if (!test_facility(76))
1455 /* format 0 - 16 bit domain field */
1456 return snprintf(buf, PAGE_SIZE, "%08x%08x\n",
1457 ap_configuration->adm[0],
1458 ap_configuration->adm[1]);
1459 /* format 1 - 256 bit domain field */
1460 return snprintf(buf, PAGE_SIZE,
1461 "0x%08x%08x%08x%08x%08x%08x%08x%08x\n",
1462 ap_configuration->adm[0], ap_configuration->adm[1],
1463 ap_configuration->adm[2], ap_configuration->adm[3],
1464 ap_configuration->adm[4], ap_configuration->adm[5],
1465 ap_configuration->adm[6], ap_configuration->adm[7]);
1468 static BUS_ATTR(ap_control_domain_mask, 0444,
1469 ap_control_domain_mask_show, NULL);
1471 static ssize_t ap_config_time_show(struct bus_type *bus, char *buf)
1473 return snprintf(buf, PAGE_SIZE, "%d\n", ap_config_time);
1476 static ssize_t ap_interrupts_show(struct bus_type *bus, char *buf)
1478 return snprintf(buf, PAGE_SIZE, "%d\n",
1479 ap_using_interrupts() ? 1 : 0);
1482 static BUS_ATTR(ap_interrupts, 0444, ap_interrupts_show, NULL);
1484 static ssize_t ap_config_time_store(struct bus_type *bus,
1485 const char *buf, size_t count)
1489 if (sscanf(buf, "%d\n", &time) != 1 || time < 5 || time > 120)
1491 ap_config_time = time;
1492 mod_timer(&ap_config_timer, jiffies + ap_config_time * HZ);
1496 static BUS_ATTR(config_time, 0644, ap_config_time_show, ap_config_time_store);
1498 static ssize_t ap_poll_thread_show(struct bus_type *bus, char *buf)
1500 return snprintf(buf, PAGE_SIZE, "%d\n", ap_poll_kthread ? 1 : 0);
1503 static ssize_t ap_poll_thread_store(struct bus_type *bus,
1504 const char *buf, size_t count)
1508 if (sscanf(buf, "%d\n", &flag) != 1)
1511 rc = ap_poll_thread_start();
1515 ap_poll_thread_stop();
1519 static BUS_ATTR(poll_thread, 0644, ap_poll_thread_show, ap_poll_thread_store);
1521 static ssize_t poll_timeout_show(struct bus_type *bus, char *buf)
1523 return snprintf(buf, PAGE_SIZE, "%llu\n", poll_timeout);
1526 static ssize_t poll_timeout_store(struct bus_type *bus, const char *buf,
1529 unsigned long long time;
1532 /* 120 seconds = maximum poll interval */
1533 if (sscanf(buf, "%llu\n", &time) != 1 || time < 1 ||
1534 time > 120000000000ULL)
1536 poll_timeout = time;
1537 hr_time = ktime_set(0, poll_timeout);
1539 spin_lock_bh(&ap_poll_timer_lock);
1540 hrtimer_cancel(&ap_poll_timer);
1541 hrtimer_set_expires(&ap_poll_timer, hr_time);
1542 hrtimer_start_expires(&ap_poll_timer, HRTIMER_MODE_ABS);
1543 spin_unlock_bh(&ap_poll_timer_lock);
1548 static BUS_ATTR(poll_timeout, 0644, poll_timeout_show, poll_timeout_store);
1550 static ssize_t ap_max_domain_id_show(struct bus_type *bus, char *buf)
1554 if (ap_configuration)
1555 max_domain_id = ap_max_domain_id ? : -1;
1558 return snprintf(buf, PAGE_SIZE, "%d\n", max_domain_id);
1561 static BUS_ATTR(ap_max_domain_id, 0444, ap_max_domain_id_show, NULL);
1563 static struct bus_attribute *const ap_bus_attrs[] = {
1564 &bus_attr_ap_domain,
1565 &bus_attr_ap_control_domain_mask,
1566 &bus_attr_config_time,
1567 &bus_attr_poll_thread,
1568 &bus_attr_ap_interrupts,
1569 &bus_attr_poll_timeout,
1570 &bus_attr_ap_max_domain_id,
1575 * ap_select_domain(): Select an AP domain.
1577 * Pick one of the 16 AP domains.
1579 static int ap_select_domain(void)
1581 int count, max_count, best_domain;
1582 struct ap_queue_status status;
1586 * We want to use a single domain. Either the one specified with
1587 * the "domain=" parameter or the domain with the maximum number
1590 if (ap_domain_index >= 0)
1591 /* Domain has already been selected. */
1595 for (i = 0; i < AP_DOMAINS; i++) {
1596 if (!ap_test_config_domain(i))
1599 for (j = 0; j < AP_DEVICES; j++) {
1600 if (!ap_test_config_card_id(j))
1602 status = ap_test_queue(AP_MKQID(j, i), NULL);
1603 if (status.response_code != AP_RESPONSE_NORMAL)
1607 if (count > max_count) {
1612 if (best_domain >= 0){
1613 ap_domain_index = best_domain;
1620 * __ap_scan_bus(): Scan the AP bus.
1621 * @dev: Pointer to device
1622 * @data: Pointer to data
1624 * Scan the AP bus for new devices.
1626 static int __ap_scan_bus(struct device *dev, void *data)
1628 return to_ap_dev(dev)->qid == (ap_qid_t)(unsigned long) data;
1631 static void ap_scan_bus(struct work_struct *unused)
1633 struct ap_device *ap_dev;
1636 int queue_depth = 0, device_type = 0;
1637 unsigned int device_functions = 0;
1640 ap_query_configuration();
1641 if (ap_select_domain() != 0)
1644 for (i = 0; i < AP_DEVICES; i++) {
1645 qid = AP_MKQID(i, ap_domain_index);
1646 dev = bus_find_device(&ap_bus_type, NULL,
1647 (void *)(unsigned long)qid,
1649 rc = ap_query_queue(qid, &queue_depth, &device_type,
1652 ap_dev = to_ap_dev(dev);
1653 spin_lock_bh(&ap_dev->lock);
1655 ap_dev->state = AP_STATE_BORKED;
1656 borked = ap_dev->state == AP_STATE_BORKED;
1657 spin_unlock_bh(&ap_dev->lock);
1658 if (borked) /* Remove broken device */
1659 device_unregister(dev);
1666 ap_dev = kzalloc(sizeof(*ap_dev), GFP_KERNEL);
1670 ap_dev->state = AP_STATE_RESET_START;
1671 ap_dev->interrupt = AP_INTR_DISABLED;
1672 ap_dev->queue_depth = queue_depth;
1673 ap_dev->raw_hwtype = device_type;
1674 ap_dev->device_type = device_type;
1675 ap_dev->functions = device_functions;
1676 spin_lock_init(&ap_dev->lock);
1677 INIT_LIST_HEAD(&ap_dev->pendingq);
1678 INIT_LIST_HEAD(&ap_dev->requestq);
1679 INIT_LIST_HEAD(&ap_dev->list);
1680 setup_timer(&ap_dev->timeout, ap_request_timeout,
1681 (unsigned long) ap_dev);
1683 ap_dev->device.bus = &ap_bus_type;
1684 ap_dev->device.parent = ap_root_device;
1685 rc = dev_set_name(&ap_dev->device, "card%02x",
1686 AP_QID_DEVICE(ap_dev->qid));
1691 /* Add to list of devices */
1692 spin_lock_bh(&ap_device_list_lock);
1693 list_add(&ap_dev->list, &ap_device_list);
1694 spin_unlock_bh(&ap_device_list_lock);
1695 /* Start with a device reset */
1696 spin_lock_bh(&ap_dev->lock);
1697 ap_sm_wait(ap_sm_event(ap_dev, AP_EVENT_POLL));
1698 spin_unlock_bh(&ap_dev->lock);
1699 /* Register device */
1700 ap_dev->device.release = ap_device_release;
1701 rc = device_register(&ap_dev->device);
1703 spin_lock_bh(&ap_dev->lock);
1704 list_del_init(&ap_dev->list);
1705 spin_unlock_bh(&ap_dev->lock);
1706 put_device(&ap_dev->device);
1709 /* Add device attributes. */
1710 rc = sysfs_create_group(&ap_dev->device.kobj,
1711 &ap_dev_attr_group);
1713 device_unregister(&ap_dev->device);
1718 mod_timer(&ap_config_timer, jiffies + ap_config_time * HZ);
1721 static void ap_config_timeout(unsigned long ptr)
1723 if (ap_suspend_flag)
1725 queue_work(system_long_wq, &ap_scan_work);
1728 static void ap_reset_domain(void)
1732 if (ap_domain_index == -1 || !ap_test_config_domain(ap_domain_index))
1734 for (i = 0; i < AP_DEVICES; i++)
1735 ap_reset_queue(AP_MKQID(i, ap_domain_index));
1738 static void ap_reset_all(void)
1742 for (i = 0; i < AP_DOMAINS; i++) {
1743 if (!ap_test_config_domain(i))
1745 for (j = 0; j < AP_DEVICES; j++) {
1746 if (!ap_test_config_card_id(j))
1748 ap_reset_queue(AP_MKQID(j, i));
1753 static struct reset_call ap_reset_call = {
1758 * ap_module_init(): The module initialization code.
1760 * Initializes the module.
1762 int __init ap_module_init(void)
1767 if (ap_instructions_available() != 0) {
1768 pr_warn("The hardware system does not support AP instructions\n");
1772 /* Get AP configuration data if available */
1773 ap_init_configuration();
1775 if (ap_configuration)
1776 max_domain_id = ap_max_domain_id ? : (AP_DOMAINS - 1);
1779 if (ap_domain_index < -1 || ap_domain_index > max_domain_id) {
1780 pr_warn("%d is not a valid cryptographic domain\n",
1784 /* In resume callback we need to know if the user had set the domain.
1785 * If so, we can not just reset it.
1787 if (ap_domain_index >= 0)
1788 user_set_domain = 1;
1790 if (ap_interrupts_available()) {
1791 rc = register_adapter_interrupt(&ap_airq);
1792 ap_airq_flag = (rc == 0);
1795 register_reset_call(&ap_reset_call);
1797 /* Create /sys/bus/ap. */
1798 rc = bus_register(&ap_bus_type);
1801 for (i = 0; ap_bus_attrs[i]; i++) {
1802 rc = bus_create_file(&ap_bus_type, ap_bus_attrs[i]);
1807 /* Create /sys/devices/ap. */
1808 ap_root_device = root_device_register("ap");
1809 rc = PTR_RET(ap_root_device);
1813 /* Setup the AP bus rescan timer. */
1814 setup_timer(&ap_config_timer, ap_config_timeout, 0);
1817 * Setup the high resultion poll timer.
1818 * If we are running under z/VM adjust polling to z/VM polling rate.
1821 poll_timeout = 1500000;
1822 spin_lock_init(&ap_poll_timer_lock);
1823 hrtimer_init(&ap_poll_timer, CLOCK_MONOTONIC, HRTIMER_MODE_ABS);
1824 ap_poll_timer.function = ap_poll_timeout;
1826 /* Start the low priority AP bus poll thread. */
1827 if (ap_thread_flag) {
1828 rc = ap_poll_thread_start();
1833 rc = register_pm_notifier(&ap_power_notifier);
1837 queue_work(system_long_wq, &ap_scan_work);
1843 ap_poll_thread_stop();
1845 hrtimer_cancel(&ap_poll_timer);
1846 root_device_unregister(ap_root_device);
1849 bus_remove_file(&ap_bus_type, ap_bus_attrs[i]);
1850 bus_unregister(&ap_bus_type);
1852 unregister_reset_call(&ap_reset_call);
1853 if (ap_using_interrupts())
1854 unregister_adapter_interrupt(&ap_airq);
1855 kfree(ap_configuration);
1860 * ap_modules_exit(): The module termination code
1862 * Terminates the module.
1864 void ap_module_exit(void)
1868 initialised = false;
1870 ap_poll_thread_stop();
1871 del_timer_sync(&ap_config_timer);
1872 hrtimer_cancel(&ap_poll_timer);
1873 tasklet_kill(&ap_tasklet);
1874 bus_for_each_dev(&ap_bus_type, NULL, NULL, __ap_devices_unregister);
1875 for (i = 0; ap_bus_attrs[i]; i++)
1876 bus_remove_file(&ap_bus_type, ap_bus_attrs[i]);
1877 unregister_pm_notifier(&ap_power_notifier);
1878 root_device_unregister(ap_root_device);
1879 bus_unregister(&ap_bus_type);
1880 kfree(ap_configuration);
1881 unregister_reset_call(&ap_reset_call);
1882 if (ap_using_interrupts())
1883 unregister_adapter_interrupt(&ap_airq);
1886 module_init(ap_module_init);
1887 module_exit(ap_module_exit);