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
);