drivers/s390/crypto/ap_queue.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright IBM Corp. 2016
   4  * Author(s): Martin Schwidefsky <schwidefsky@de.ibm.com>
   5  *
   6  * Adjunct processor bus, queue related code.
   7  */
   8
   9 #define KMSG_COMPONENT "ap"
  10 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
  11
  12 #include <linux/init.h>
  13 #include <linux/slab.h>
  14 #include <asm/facility.h>
  15
  16 #include "ap_bus.h"
  17 #include "ap_debug.h"
  18
  19 static void __ap_flush_queue(struct ap_queue *aq);
  20
  21 /**
  22  * ap_queue_enable_interruption(): Enable interruption on an AP queue.
  23  * @qid: The AP queue number
  24  * @ind: the notification indicator byte
  25  *
  26  * Enables interruption on AP queue via ap_aqic(). Based on the return
  27  * value it waits a while and tests the AP queue if interrupts
  28  * have been switched on using ap_test_queue().
  29  */
  30 static int ap_queue_enable_interruption(struct ap_queue *aq, void *ind)
  31 {
  32         struct ap_queue_status status;
  33         struct ap_qirq_ctrl qirqctrl = { 0 };
  34
  35         qirqctrl.ir = 1;
  36         qirqctrl.isc = AP_ISC;
  37         status = ap_aqic(aq->qid, qirqctrl, ind);
  38         switch (status.response_code) {
  39         case AP_RESPONSE_NORMAL:
  40         case AP_RESPONSE_OTHERWISE_CHANGED:
  41                 return 0;
  42         case AP_RESPONSE_Q_NOT_AVAIL:
  43         case AP_RESPONSE_DECONFIGURED:
  44         case AP_RESPONSE_CHECKSTOPPED:
  45         case AP_RESPONSE_INVALID_ADDRESS:
  46                 pr_err("Registering adapter interrupts for AP device %02x.%04x failed\n",
  47                        AP_QID_CARD(aq->qid),
  48                        AP_QID_QUEUE(aq->qid));
  49                 return -EOPNOTSUPP;
  50         case AP_RESPONSE_RESET_IN_PROGRESS:
  51         case AP_RESPONSE_BUSY:
  52         default:
  53                 return -EBUSY;
  54         }
  55 }
  56
  57 /**
  58  * __ap_send(): Send message to adjunct processor queue.
  59  * @qid: The AP queue number
  60  * @psmid: The program supplied message identifier
  61  * @msg: The message text
  62  * @length: The message length
  63  * @special: Special Bit
  64  *
  65  * Returns AP queue status structure.
  66  * Condition code 1 on NQAP can't happen because the L bit is 1.
  67  * Condition code 2 on NQAP also means the send is incomplete,
  68  * because a segment boundary was reached. The NQAP is repeated.
  69  */
  70 static inline struct ap_queue_status
  71 __ap_send(ap_qid_t qid, unsigned long long psmid, void *msg, size_t length,
  72           int special)
  73 {
  74         if (special)
  75                 qid |= 0x400000UL;
  76         return ap_nqap(qid, psmid, msg, length);
  77 }
  78
  79 int ap_send(ap_qid_t qid, unsigned long long psmid, void *msg, size_t length)
  80 {
  81         struct ap_queue_status status;
  82
  83         status = __ap_send(qid, psmid, msg, length, 0);
  84         switch (status.response_code) {
  85         case AP_RESPONSE_NORMAL:
  86                 return 0;
  87         case AP_RESPONSE_Q_FULL:
  88         case AP_RESPONSE_RESET_IN_PROGRESS:
  89                 return -EBUSY;
  90         case AP_RESPONSE_REQ_FAC_NOT_INST:
  91                 return -EINVAL;
  92         default:        /* Device is gone. */
  93                 return -ENODEV;
  94         }
  95 }
  96 EXPORT_SYMBOL(ap_send);
  97
  98 int ap_recv(ap_qid_t qid, unsigned long long *psmid, void *msg, size_t length)
  99 {
 100         struct ap_queue_status status;
 101
 102         if (msg == NULL)
 103                 return -EINVAL;
 104         status = ap_dqap(qid, psmid, msg, length);
 105         switch (status.response_code) {
 106         case AP_RESPONSE_NORMAL:
 107                 return 0;
 108         case AP_RESPONSE_NO_PENDING_REPLY:
 109                 if (status.queue_empty)
 110                         return -ENOENT;
 111                 return -EBUSY;
 112         case AP_RESPONSE_RESET_IN_PROGRESS:
 113                 return -EBUSY;
 114         default:
 115                 return -ENODEV;
 116         }
 117 }
 118 EXPORT_SYMBOL(ap_recv);
 119
 120 /* State machine definitions and helpers */
 121
 122 static enum ap_sm_wait ap_sm_nop(struct ap_queue *aq)
 123 {
 124         return AP_SM_WAIT_NONE;
 125 }
 126
 127 /**
 128  * ap_sm_recv(): Receive pending reply messages from an AP queue but do
 129  *      not change the state of the device.
 130  * @aq: pointer to the AP queue
 131  *
 132  * Returns AP_SM_WAIT_NONE, AP_SM_WAIT_AGAIN, or AP_SM_WAIT_INTERRUPT
 133  */
 134 static struct ap_queue_status ap_sm_recv(struct ap_queue *aq)
 135 {
 136         struct ap_queue_status status;
 137         struct ap_message *ap_msg;
 138
 139         status = ap_dqap(aq->qid, &aq->reply->psmid,
 140                          aq->reply->msg, aq->reply->len);
 141         switch (status.response_code) {
 142         case AP_RESPONSE_NORMAL:
 143                 aq->queue_count--;
 144                 if (aq->queue_count > 0)
 145                         mod_timer(&aq->timeout,
 146                                   jiffies + aq->request_timeout);
 147                 list_for_each_entry(ap_msg, &aq->pendingq, list) {
 148                         if (ap_msg->psmid != aq->reply->psmid)
 149                                 continue;
 150                         list_del_init(&ap_msg->list);
 151                         aq->pendingq_count--;
 152                         ap_msg->receive(aq, ap_msg, aq->reply);
 153                         break;
 154                 }
 155                 fallthrough;
 156         case AP_RESPONSE_NO_PENDING_REPLY:
 157                 if (!status.queue_empty || aq->queue_count <= 0)
 158                         break;
 159                 /* The card shouldn't forget requests but who knows. */
 160                 aq->queue_count = 0;
 161                 list_splice_init(&aq->pendingq, &aq->requestq);
 162                 aq->requestq_count += aq->pendingq_count;
 163                 aq->pendingq_count = 0;
 164                 break;
 165         default:
 166                 break;
 167         }
 168         return status;
 169 }
 170
 171 /**
 172  * ap_sm_read(): Receive pending reply messages from an AP queue.
 173  * @aq: pointer to the AP queue
 174  *
 175  * Returns AP_SM_WAIT_NONE, AP_SM_WAIT_AGAIN, or AP_SM_WAIT_INTERRUPT
 176  */
 177 static enum ap_sm_wait ap_sm_read(struct ap_queue *aq)
 178 {
 179         struct ap_queue_status status;
 180
 181         if (!aq->reply)
 182                 return AP_SM_WAIT_NONE;
 183         status = ap_sm_recv(aq);
 184         switch (status.response_code) {
 185         case AP_RESPONSE_NORMAL:
 186                 if (aq->queue_count > 0) {
 187                         aq->sm_state = AP_SM_STATE_WORKING;
 188                         return AP_SM_WAIT_AGAIN;
 189                 }
 190                 aq->sm_state = AP_SM_STATE_IDLE;
 191                 return AP_SM_WAIT_NONE;
 192         case AP_RESPONSE_NO_PENDING_REPLY:
 193                 if (aq->queue_count > 0)
 194                         return AP_SM_WAIT_INTERRUPT;
 195                 aq->sm_state = AP_SM_STATE_IDLE;
 196                 return AP_SM_WAIT_NONE;
 197         default:
 198                 aq->dev_state = AP_DEV_STATE_ERROR;
 199                 aq->last_err_rc = status.response_code;
 200                 AP_DBF_WARN("%s RC 0x%02x on 0x%02x.%04x -> AP_DEV_STATE_ERROR\n",
 201                             __func__, status.response_code,
 202                             AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
 203                 return AP_SM_WAIT_NONE;
 204         }
 205 }
 206
 207 /**
 208  * ap_sm_write(): Send messages from the request queue to an AP queue.
 209  * @aq: pointer to the AP queue
 210  *
 211  * Returns AP_SM_WAIT_NONE, AP_SM_WAIT_AGAIN, or AP_SM_WAIT_INTERRUPT
 212  */
 213 static enum ap_sm_wait ap_sm_write(struct ap_queue *aq)
 214 {
 215         struct ap_queue_status status;
 216         struct ap_message *ap_msg;
 217         ap_qid_t qid = aq->qid;
 218
 219         if (aq->requestq_count <= 0)
 220                 return AP_SM_WAIT_NONE;
 221         /* Start the next request on the queue. */
 222         ap_msg = list_entry(aq->requestq.next, struct ap_message, list);
 223 #ifdef CONFIG_ZCRYPT_DEBUG
 224         if (ap_msg->fi.action == AP_FI_ACTION_NQAP_QID_INVAL) {
 225                 AP_DBF_WARN("%s fi cmd 0x%04x: forcing invalid qid 0xFF00\n",
 226                             __func__, ap_msg->fi.cmd);
 227                 qid = 0xFF00;
 228         }
 229 #endif
 230         status = __ap_send(qid, ap_msg->psmid,
 231                            ap_msg->msg, ap_msg->len,
 232                            ap_msg->flags & AP_MSG_FLAG_SPECIAL);
 233         switch (status.response_code) {
 234         case AP_RESPONSE_NORMAL:
 235                 aq->queue_count++;
 236                 if (aq->queue_count == 1)
 237                         mod_timer(&aq->timeout, jiffies + aq->request_timeout);
 238                 list_move_tail(&ap_msg->list, &aq->pendingq);
 239                 aq->requestq_count--;
 240                 aq->pendingq_count++;
 241                 if (aq->queue_count < aq->card->queue_depth) {
 242                         aq->sm_state = AP_SM_STATE_WORKING;
 243                         return AP_SM_WAIT_AGAIN;
 244                 }
 245                 fallthrough;
 246         case AP_RESPONSE_Q_FULL:
 247                 aq->sm_state = AP_SM_STATE_QUEUE_FULL;
 248                 return AP_SM_WAIT_INTERRUPT;
 249         case AP_RESPONSE_RESET_IN_PROGRESS:
 250                 aq->sm_state = AP_SM_STATE_RESET_WAIT;
 251                 return AP_SM_WAIT_TIMEOUT;
 252         case AP_RESPONSE_INVALID_DOMAIN:
 253                 AP_DBF(DBF_WARN, "AP_RESPONSE_INVALID_DOMAIN on NQAP\n");
 254                 fallthrough;
 255         case AP_RESPONSE_MESSAGE_TOO_BIG:
 256         case AP_RESPONSE_REQ_FAC_NOT_INST:
 257                 list_del_init(&ap_msg->list);
 258                 aq->requestq_count--;
 259                 ap_msg->rc = -EINVAL;
 260                 ap_msg->receive(aq, ap_msg, NULL);
 261                 return AP_SM_WAIT_AGAIN;
 262         default:
 263                 aq->dev_state = AP_DEV_STATE_ERROR;
 264                 aq->last_err_rc = status.response_code;
 265                 AP_DBF_WARN("%s RC 0x%02x on 0x%02x.%04x -> AP_DEV_STATE_ERROR\n",
 266                             __func__, status.response_code,
 267                             AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
 268                 return AP_SM_WAIT_NONE;
 269         }
 270 }
 271
 272 /**
 273  * ap_sm_read_write(): Send and receive messages to/from an AP queue.
 274  * @aq: pointer to the AP queue
 275  *
 276  * Returns AP_SM_WAIT_NONE, AP_SM_WAIT_AGAIN, or AP_SM_WAIT_INTERRUPT
 277  */
 278 static enum ap_sm_wait ap_sm_read_write(struct ap_queue *aq)
 279 {
 280         return min(ap_sm_read(aq), ap_sm_write(aq));
 281 }
 282
 283 /**
 284  * ap_sm_reset(): Reset an AP queue.
 285  * @qid: The AP queue number
 286  *
 287  * Submit the Reset command to an AP queue.
 288  */
 289 static enum ap_sm_wait ap_sm_reset(struct ap_queue *aq)
 290 {
 291         struct ap_queue_status status;
 292
 293         status = ap_rapq(aq->qid);
 294         switch (status.response_code) {
 295         case AP_RESPONSE_NORMAL:
 296         case AP_RESPONSE_RESET_IN_PROGRESS:
 297                 aq->sm_state = AP_SM_STATE_RESET_WAIT;
 298                 aq->interrupt = AP_INTR_DISABLED;
 299                 return AP_SM_WAIT_TIMEOUT;
 300         default:
 301                 aq->dev_state = AP_DEV_STATE_ERROR;
 302                 aq->last_err_rc = status.response_code;
 303                 AP_DBF_WARN("%s RC 0x%02x on 0x%02x.%04x -> AP_DEV_STATE_ERROR\n",
 304                             __func__, status.response_code,
 305                             AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
 306                 return AP_SM_WAIT_NONE;
 307         }
 308 }
 309
 310 /**
 311  * ap_sm_reset_wait(): Test queue for completion of the reset operation
 312  * @aq: pointer to the AP queue
 313  *
 314  * Returns AP_POLL_IMMEDIATELY, AP_POLL_AFTER_TIMEROUT or 0.
 315  */
 316 static enum ap_sm_wait ap_sm_reset_wait(struct ap_queue *aq)
 317 {
 318         struct ap_queue_status status;
 319         void *lsi_ptr;
 320
 321         if (aq->queue_count > 0 && aq->reply)
 322                 /* Try to read a completed message and get the status */
 323                 status = ap_sm_recv(aq);
 324         else
 325                 /* Get the status with TAPQ */
 326                 status = ap_tapq(aq->qid, NULL);
 327
 328         switch (status.response_code) {
 329         case AP_RESPONSE_NORMAL:
 330                 lsi_ptr = ap_airq_ptr();
 331                 if (lsi_ptr && ap_queue_enable_interruption(aq, lsi_ptr) == 0)
 332                         aq->sm_state = AP_SM_STATE_SETIRQ_WAIT;
 333                 else
 334                         aq->sm_state = (aq->queue_count > 0) ?
 335                                 AP_SM_STATE_WORKING : AP_SM_STATE_IDLE;
 336                 return AP_SM_WAIT_AGAIN;
 337         case AP_RESPONSE_BUSY:
 338         case AP_RESPONSE_RESET_IN_PROGRESS:
 339                 return AP_SM_WAIT_TIMEOUT;
 340         case AP_RESPONSE_Q_NOT_AVAIL:
 341         case AP_RESPONSE_DECONFIGURED:
 342         case AP_RESPONSE_CHECKSTOPPED:
 343         default:
 344                 aq->dev_state = AP_DEV_STATE_ERROR;
 345                 aq->last_err_rc = status.response_code;
 346                 AP_DBF_WARN("%s RC 0x%02x on 0x%02x.%04x -> AP_DEV_STATE_ERROR\n",
 347                             __func__, status.response_code,
 348                             AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
 349                 return AP_SM_WAIT_NONE;
 350         }
 351 }
 352
 353 /**
 354  * ap_sm_setirq_wait(): Test queue for completion of the irq enablement
 355  * @aq: pointer to the AP queue
 356  *
 357  * Returns AP_POLL_IMMEDIATELY, AP_POLL_AFTER_TIMEROUT or 0.
 358  */
 359 static enum ap_sm_wait ap_sm_setirq_wait(struct ap_queue *aq)
 360 {
 361         struct ap_queue_status status;
 362
 363         if (aq->queue_count > 0 && aq->reply)
 364                 /* Try to read a completed message and get the status */
 365                 status = ap_sm_recv(aq);
 366         else
 367                 /* Get the status with TAPQ */
 368                 status = ap_tapq(aq->qid, NULL);
 369
 370         if (status.irq_enabled == 1) {
 371                 /* Irqs are now enabled */
 372                 aq->interrupt = AP_INTR_ENABLED;
 373                 aq->sm_state = (aq->queue_count > 0) ?
 374                         AP_SM_STATE_WORKING : AP_SM_STATE_IDLE;
 375         }
 376
 377         switch (status.response_code) {
 378         case AP_RESPONSE_NORMAL:
 379                 if (aq->queue_count > 0)
 380                         return AP_SM_WAIT_AGAIN;
 381                 fallthrough;
 382         case AP_RESPONSE_NO_PENDING_REPLY:
 383                 return AP_SM_WAIT_TIMEOUT;
 384         default:
 385                 aq->dev_state = AP_DEV_STATE_ERROR;
 386                 aq->last_err_rc = status.response_code;
 387                 AP_DBF_WARN("%s RC 0x%02x on 0x%02x.%04x -> AP_DEV_STATE_ERROR\n",
 388                             __func__, status.response_code,
 389                             AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
 390                 return AP_SM_WAIT_NONE;
 391         }
 392 }
 393
 394 /*
 395  * AP state machine jump table
 396  */
 397 static ap_func_t *ap_jumptable[NR_AP_SM_STATES][NR_AP_SM_EVENTS] = {
 398         [AP_SM_STATE_RESET_START] = {
 399                 [AP_SM_EVENT_POLL] = ap_sm_reset,
 400                 [AP_SM_EVENT_TIMEOUT] = ap_sm_nop,
 401         },
 402         [AP_SM_STATE_RESET_WAIT] = {
 403                 [AP_SM_EVENT_POLL] = ap_sm_reset_wait,
 404                 [AP_SM_EVENT_TIMEOUT] = ap_sm_nop,
 405         },
 406         [AP_SM_STATE_SETIRQ_WAIT] = {
 407                 [AP_SM_EVENT_POLL] = ap_sm_setirq_wait,
 408                 [AP_SM_EVENT_TIMEOUT] = ap_sm_nop,
 409         },
 410         [AP_SM_STATE_IDLE] = {
 411                 [AP_SM_EVENT_POLL] = ap_sm_write,
 412                 [AP_SM_EVENT_TIMEOUT] = ap_sm_nop,
 413         },
 414         [AP_SM_STATE_WORKING] = {
 415                 [AP_SM_EVENT_POLL] = ap_sm_read_write,
 416                 [AP_SM_EVENT_TIMEOUT] = ap_sm_reset,
 417         },
 418         [AP_SM_STATE_QUEUE_FULL] = {
 419                 [AP_SM_EVENT_POLL] = ap_sm_read,
 420                 [AP_SM_EVENT_TIMEOUT] = ap_sm_reset,
 421         },
 422 };
 423
 424 enum ap_sm_wait ap_sm_event(struct ap_queue *aq, enum ap_sm_event event)
 425 {
 426         if (aq->dev_state > AP_DEV_STATE_UNINITIATED)
 427                 return ap_jumptable[aq->sm_state][event](aq);
 428         else
 429                 return AP_SM_WAIT_NONE;
 430 }
 431
 432 enum ap_sm_wait ap_sm_event_loop(struct ap_queue *aq, enum ap_sm_event event)
 433 {
 434         enum ap_sm_wait wait;
 435
 436         while ((wait = ap_sm_event(aq, event)) == AP_SM_WAIT_AGAIN)
 437                 ;
 438         return wait;
 439 }
 440
 441 /*
 442  * AP queue related attributes.
 443  */
 444 static ssize_t request_count_show(struct device *dev,
 445                                   struct device_attribute *attr,
 446                                   char *buf)
 447 {
 448         struct ap_queue *aq = to_ap_queue(dev);
 449         bool valid = false;
 450         u64 req_cnt;
 451
 452         spin_lock_bh(&aq->lock);
 453         if (aq->dev_state > AP_DEV_STATE_UNINITIATED) {
 454                 req_cnt = aq->total_request_count;
 455                 valid = true;
 456         }
 457         spin_unlock_bh(&aq->lock);
 458
 459         if (valid)
 460                 return scnprintf(buf, PAGE_SIZE, "%llu\n", req_cnt);
 461         else
 462                 return scnprintf(buf, PAGE_SIZE, "-\n");
 463 }
 464
 465 static ssize_t request_count_store(struct device *dev,
 466                                    struct device_attribute *attr,
 467                                    const char *buf, size_t count)
 468 {
 469         struct ap_queue *aq = to_ap_queue(dev);
 470
 471         spin_lock_bh(&aq->lock);
 472         aq->total_request_count = 0;
 473         spin_unlock_bh(&aq->lock);
 474
 475         return count;
 476 }
 477
 478 static DEVICE_ATTR_RW(request_count);
 479
 480 static ssize_t requestq_count_show(struct device *dev,
 481                                    struct device_attribute *attr, char *buf)
 482 {
 483         struct ap_queue *aq = to_ap_queue(dev);
 484         unsigned int reqq_cnt = 0;
 485
 486         spin_lock_bh(&aq->lock);
 487         if (aq->dev_state > AP_DEV_STATE_UNINITIATED)
 488                 reqq_cnt = aq->requestq_count;
 489         spin_unlock_bh(&aq->lock);
 490         return scnprintf(buf, PAGE_SIZE, "%d\n", reqq_cnt);
 491 }
 492
 493 static DEVICE_ATTR_RO(requestq_count);
 494
 495 static ssize_t pendingq_count_show(struct device *dev,
 496                                    struct device_attribute *attr, char *buf)
 497 {
 498         struct ap_queue *aq = to_ap_queue(dev);
 499         unsigned int penq_cnt = 0;
 500
 501         spin_lock_bh(&aq->lock);
 502         if (aq->dev_state > AP_DEV_STATE_UNINITIATED)
 503                 penq_cnt = aq->pendingq_count;
 504         spin_unlock_bh(&aq->lock);
 505         return scnprintf(buf, PAGE_SIZE, "%d\n", penq_cnt);
 506 }
 507
 508 static DEVICE_ATTR_RO(pendingq_count);
 509
 510 static ssize_t reset_show(struct device *dev,
 511                           struct device_attribute *attr, char *buf)
 512 {
 513         struct ap_queue *aq = to_ap_queue(dev);
 514         int rc = 0;
 515
 516         spin_lock_bh(&aq->lock);
 517         switch (aq->sm_state) {
 518         case AP_SM_STATE_RESET_START:
 519         case AP_SM_STATE_RESET_WAIT:
 520                 rc = scnprintf(buf, PAGE_SIZE, "Reset in progress.\n");
 521                 break;
 522         case AP_SM_STATE_WORKING:
 523         case AP_SM_STATE_QUEUE_FULL:
 524                 rc = scnprintf(buf, PAGE_SIZE, "Reset Timer armed.\n");
 525                 break;
 526         default:
 527                 rc = scnprintf(buf, PAGE_SIZE, "No Reset Timer set.\n");
 528         }
 529         spin_unlock_bh(&aq->lock);
 530         return rc;
 531 }
 532
 533 static ssize_t reset_store(struct device *dev,
 534                            struct device_attribute *attr,
 535                            const char *buf, size_t count)
 536 {
 537         struct ap_queue *aq = to_ap_queue(dev);
 538
 539         spin_lock_bh(&aq->lock);
 540         __ap_flush_queue(aq);
 541         aq->sm_state = AP_SM_STATE_RESET_START;
 542         ap_wait(ap_sm_event(aq, AP_SM_EVENT_POLL));
 543         spin_unlock_bh(&aq->lock);
 544
 545         AP_DBF(DBF_INFO, "reset queue=%02x.%04x triggered by user\n",
 546                AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
 547
 548         return count;
 549 }
 550
 551 static DEVICE_ATTR_RW(reset);
 552
 553 static ssize_t interrupt_show(struct device *dev,
 554                               struct device_attribute *attr, char *buf)
 555 {
 556         struct ap_queue *aq = to_ap_queue(dev);
 557         int rc = 0;
 558
 559         spin_lock_bh(&aq->lock);
 560         if (aq->sm_state == AP_SM_STATE_SETIRQ_WAIT)
 561                 rc = scnprintf(buf, PAGE_SIZE, "Enable Interrupt pending.\n");
 562         else if (aq->interrupt == AP_INTR_ENABLED)
 563                 rc = scnprintf(buf, PAGE_SIZE, "Interrupts enabled.\n");
 564         else
 565                 rc = scnprintf(buf, PAGE_SIZE, "Interrupts disabled.\n");
 566         spin_unlock_bh(&aq->lock);
 567         return rc;
 568 }
 569
 570 static DEVICE_ATTR_RO(interrupt);
 571
 572 static ssize_t config_show(struct device *dev,
 573                              struct device_attribute *attr, char *buf)
 574 {
 575         struct ap_queue *aq = to_ap_queue(dev);
 576         int rc;
 577
 578         spin_lock_bh(&aq->lock);
 579         rc = scnprintf(buf, PAGE_SIZE, "%d\n", aq->config ? 1 : 0);
 580         spin_unlock_bh(&aq->lock);
 581         return rc;
 582 }
 583
 584 static DEVICE_ATTR_RO(config);
 585
 586 #ifdef CONFIG_ZCRYPT_DEBUG
 587 static ssize_t states_show(struct device *dev,
 588                            struct device_attribute *attr, char *buf)
 589 {
 590         struct ap_queue *aq = to_ap_queue(dev);
 591         int rc = 0;
 592
 593         spin_lock_bh(&aq->lock);
 594         /* queue device state */
 595         switch (aq->dev_state) {
 596         case AP_DEV_STATE_UNINITIATED:
 597                 rc = scnprintf(buf, PAGE_SIZE, "UNINITIATED\n");
 598                 break;
 599         case AP_DEV_STATE_OPERATING:
 600                 rc = scnprintf(buf, PAGE_SIZE, "OPERATING");
 601                 break;
 602         case AP_DEV_STATE_SHUTDOWN:
 603                 rc = scnprintf(buf, PAGE_SIZE, "SHUTDOWN");
 604                 break;
 605         case AP_DEV_STATE_ERROR:
 606                 rc = scnprintf(buf, PAGE_SIZE, "ERROR");
 607                 break;
 608         default:
 609                 rc = scnprintf(buf, PAGE_SIZE, "UNKNOWN");
 610         }
 611         /* state machine state */
 612         if (aq->dev_state) {
 613                 switch (aq->sm_state) {
 614                 case AP_SM_STATE_RESET_START:
 615                         rc += scnprintf(buf + rc, PAGE_SIZE - rc,
 616                                         " [RESET_START]\n");
 617                         break;
 618                 case AP_SM_STATE_RESET_WAIT:
 619                         rc += scnprintf(buf + rc, PAGE_SIZE - rc,
 620                                         " [RESET_WAIT]\n");
 621                         break;
 622                 case AP_SM_STATE_SETIRQ_WAIT:
 623                         rc += scnprintf(buf + rc, PAGE_SIZE - rc,
 624                                         " [SETIRQ_WAIT]\n");
 625                         break;
 626                 case AP_SM_STATE_IDLE:
 627                         rc += scnprintf(buf + rc, PAGE_SIZE - rc,
 628                                         " [IDLE]\n");
 629                         break;
 630                 case AP_SM_STATE_WORKING:
 631                         rc += scnprintf(buf + rc, PAGE_SIZE - rc,
 632                                         " [WORKING]\n");
 633                         break;
 634                 case AP_SM_STATE_QUEUE_FULL:
 635                         rc += scnprintf(buf + rc, PAGE_SIZE - rc,
 636                                         " [FULL]\n");
 637                         break;
 638                 default:
 639                         rc += scnprintf(buf + rc, PAGE_SIZE - rc,
 640                                         " [UNKNOWN]\n");
 641                 }
 642         }
 643         spin_unlock_bh(&aq->lock);
 644
 645         return rc;
 646 }
 647 static DEVICE_ATTR_RO(states);
 648
 649 static ssize_t last_err_rc_show(struct device *dev,
 650                                 struct device_attribute *attr, char *buf)
 651 {
 652         struct ap_queue *aq = to_ap_queue(dev);
 653         int rc;
 654
 655         spin_lock_bh(&aq->lock);
 656         rc = aq->last_err_rc;
 657         spin_unlock_bh(&aq->lock);
 658
 659         switch (rc) {
 660         case AP_RESPONSE_NORMAL:
 661                 return scnprintf(buf, PAGE_SIZE, "NORMAL\n");
 662         case AP_RESPONSE_Q_NOT_AVAIL:
 663                 return scnprintf(buf, PAGE_SIZE, "Q_NOT_AVAIL\n");
 664         case AP_RESPONSE_RESET_IN_PROGRESS:
 665                 return scnprintf(buf, PAGE_SIZE, "RESET_IN_PROGRESS\n");
 666         case AP_RESPONSE_DECONFIGURED:
 667                 return scnprintf(buf, PAGE_SIZE, "DECONFIGURED\n");
 668         case AP_RESPONSE_CHECKSTOPPED:
 669                 return scnprintf(buf, PAGE_SIZE, "CHECKSTOPPED\n");
 670         case AP_RESPONSE_BUSY:
 671                 return scnprintf(buf, PAGE_SIZE, "BUSY\n");
 672         case AP_RESPONSE_INVALID_ADDRESS:
 673                 return scnprintf(buf, PAGE_SIZE, "INVALID_ADDRESS\n");
 674         case AP_RESPONSE_OTHERWISE_CHANGED:
 675                 return scnprintf(buf, PAGE_SIZE, "OTHERWISE_CHANGED\n");
 676         case AP_RESPONSE_Q_FULL:
 677                 return scnprintf(buf, PAGE_SIZE, "Q_FULL/NO_PENDING_REPLY\n");
 678         case AP_RESPONSE_INDEX_TOO_BIG:
 679                 return scnprintf(buf, PAGE_SIZE, "INDEX_TOO_BIG\n");
 680         case AP_RESPONSE_NO_FIRST_PART:
 681                 return scnprintf(buf, PAGE_SIZE, "NO_FIRST_PART\n");
 682         case AP_RESPONSE_MESSAGE_TOO_BIG:
 683                 return scnprintf(buf, PAGE_SIZE, "MESSAGE_TOO_BIG\n");
 684         case AP_RESPONSE_REQ_FAC_NOT_INST:
 685                 return scnprintf(buf, PAGE_SIZE, "REQ_FAC_NOT_INST\n");
 686         default:
 687                 return scnprintf(buf, PAGE_SIZE, "response code %d\n", rc);
 688         }
 689 }
 690 static DEVICE_ATTR_RO(last_err_rc);
 691 #endif
 692
 693 static struct attribute *ap_queue_dev_attrs[] = {
 694         &dev_attr_request_count.attr,
 695         &dev_attr_requestq_count.attr,
 696         &dev_attr_pendingq_count.attr,
 697         &dev_attr_reset.attr,
 698         &dev_attr_interrupt.attr,
 699         &dev_attr_config.attr,
 700 #ifdef CONFIG_ZCRYPT_DEBUG
 701         &dev_attr_states.attr,
 702         &dev_attr_last_err_rc.attr,
 703 #endif
 704         NULL
 705 };
 706
 707 static struct attribute_group ap_queue_dev_attr_group = {
 708         .attrs = ap_queue_dev_attrs
 709 };
 710
 711 static const struct attribute_group *ap_queue_dev_attr_groups[] = {
 712         &ap_queue_dev_attr_group,
 713         NULL
 714 };
 715
 716 static struct device_type ap_queue_type = {
 717         .name = "ap_queue",
 718         .groups = ap_queue_dev_attr_groups,
 719 };
 720
 721 static void ap_queue_device_release(struct device *dev)
 722 {
 723         struct ap_queue *aq = to_ap_queue(dev);
 724
 725         spin_lock_bh(&ap_queues_lock);
 726         hash_del(&aq->hnode);
 727         spin_unlock_bh(&ap_queues_lock);
 728
 729         kfree(aq);
 730 }
 731
 732 struct ap_queue *ap_queue_create(ap_qid_t qid, int device_type)
 733 {
 734         struct ap_queue *aq;
 735
 736         aq = kzalloc(sizeof(*aq), GFP_KERNEL);
 737         if (!aq)
 738                 return NULL;
 739         aq->ap_dev.device.release = ap_queue_device_release;
 740         aq->ap_dev.device.type = &ap_queue_type;
 741         aq->ap_dev.device_type = device_type;
 742         aq->qid = qid;
 743         aq->interrupt = AP_INTR_DISABLED;
 744         spin_lock_init(&aq->lock);
 745         INIT_LIST_HEAD(&aq->pendingq);
 746         INIT_LIST_HEAD(&aq->requestq);
 747         timer_setup(&aq->timeout, ap_request_timeout, 0);
 748
 749         return aq;
 750 }
 751
 752 void ap_queue_init_reply(struct ap_queue *aq, struct ap_message *reply)
 753 {
 754         aq->reply = reply;
 755
 756         spin_lock_bh(&aq->lock);
 757         ap_wait(ap_sm_event(aq, AP_SM_EVENT_POLL));
 758         spin_unlock_bh(&aq->lock);
 759 }
 760 EXPORT_SYMBOL(ap_queue_init_reply);
 761
 762 /**
 763  * ap_queue_message(): Queue a request to an AP device.
 764  * @aq: The AP device to queue the message to
 765  * @ap_msg: The message that is to be added
 766  */
 767 int ap_queue_message(struct ap_queue *aq, struct ap_message *ap_msg)
 768 {
 769         int rc = 0;
 770
 771         /* msg needs to have a valid receive-callback */
 772         BUG_ON(!ap_msg->receive);
 773
 774         spin_lock_bh(&aq->lock);
 775
 776         /* only allow to queue new messages if device state is ok */
 777         if (aq->dev_state == AP_DEV_STATE_OPERATING) {
 778                 list_add_tail(&ap_msg->list, &aq->requestq);
 779                 aq->requestq_count++;
 780                 aq->total_request_count++;
 781                 atomic64_inc(&aq->card->total_request_count);
 782         } else
 783                 rc = -ENODEV;
 784
 785         /* Send/receive as many request from the queue as possible. */
 786         ap_wait(ap_sm_event_loop(aq, AP_SM_EVENT_POLL));
 787
 788         spin_unlock_bh(&aq->lock);
 789
 790         return rc;
 791 }
 792 EXPORT_SYMBOL(ap_queue_message);
 793
 794 /**
 795  * ap_cancel_message(): Cancel a crypto request.
 796  * @aq: The AP device that has the message queued
 797  * @ap_msg: The message that is to be removed
 798  *
 799  * Cancel a crypto request. This is done by removing the request
 800  * from the device pending or request queue. Note that the
 801  * request stays on the AP queue. When it finishes the message
 802  * reply will be discarded because the psmid can't be found.
 803  */
 804 void ap_cancel_message(struct ap_queue *aq, struct ap_message *ap_msg)
 805 {
 806         struct ap_message *tmp;
 807
 808         spin_lock_bh(&aq->lock);
 809         if (!list_empty(&ap_msg->list)) {
 810                 list_for_each_entry(tmp, &aq->pendingq, list)
 811                         if (tmp->psmid == ap_msg->psmid) {
 812                                 aq->pendingq_count--;
 813                                 goto found;
 814                         }
 815                 aq->requestq_count--;
 816 found:
 817                 list_del_init(&ap_msg->list);
 818         }
 819         spin_unlock_bh(&aq->lock);
 820 }
 821 EXPORT_SYMBOL(ap_cancel_message);
 822
 823 /**
 824  * __ap_flush_queue(): Flush requests.
 825  * @aq: Pointer to the AP queue
 826  *
 827  * Flush all requests from the request/pending queue of an AP device.
 828  */
 829 static void __ap_flush_queue(struct ap_queue *aq)
 830 {
 831         struct ap_message *ap_msg, *next;
 832
 833         list_for_each_entry_safe(ap_msg, next, &aq->pendingq, list) {
 834                 list_del_init(&ap_msg->list);
 835                 aq->pendingq_count--;
 836                 ap_msg->rc = -EAGAIN;
 837                 ap_msg->receive(aq, ap_msg, NULL);
 838         }
 839         list_for_each_entry_safe(ap_msg, next, &aq->requestq, list) {
 840                 list_del_init(&ap_msg->list);
 841                 aq->requestq_count--;
 842                 ap_msg->rc = -EAGAIN;
 843                 ap_msg->receive(aq, ap_msg, NULL);
 844         }
 845         aq->queue_count = 0;
 846 }
 847
 848 void ap_flush_queue(struct ap_queue *aq)
 849 {
 850         spin_lock_bh(&aq->lock);
 851         __ap_flush_queue(aq);
 852         spin_unlock_bh(&aq->lock);
 853 }
 854 EXPORT_SYMBOL(ap_flush_queue);
 855
 856 void ap_queue_prepare_remove(struct ap_queue *aq)
 857 {
 858         spin_lock_bh(&aq->lock);
 859         /* flush queue */
 860         __ap_flush_queue(aq);
 861         /* move queue device state to SHUTDOWN in progress */
 862         aq->dev_state = AP_DEV_STATE_SHUTDOWN;
 863         spin_unlock_bh(&aq->lock);
 864         del_timer_sync(&aq->timeout);
 865 }
 866
 867 void ap_queue_remove(struct ap_queue *aq)
 868 {
 869         /*
 870          * all messages have been flushed and the device state
 871          * is SHUTDOWN. Now reset with zero which also clears
 872          * the irq registration and move the device state
 873          * to the initial value AP_DEV_STATE_UNINITIATED.
 874          */
 875         spin_lock_bh(&aq->lock);
 876         ap_zapq(aq->qid);
 877         aq->dev_state = AP_DEV_STATE_UNINITIATED;
 878         spin_unlock_bh(&aq->lock);
 879 }
 880
 881 void ap_queue_init_state(struct ap_queue *aq)
 882 {
 883         spin_lock_bh(&aq->lock);
 884         aq->dev_state = AP_DEV_STATE_OPERATING;
 885         aq->sm_state = AP_SM_STATE_RESET_START;
 886         ap_wait(ap_sm_event(aq, AP_SM_EVENT_POLL));
 887         spin_unlock_bh(&aq->lock);
 888 }
 889 EXPORT_SYMBOL(ap_queue_init_state);