drivers/char/tpm/tpm_ibmvtpm.c

   1 /*
   2  * Copyright (C) 2012 IBM Corporation
   3  *
   4  * Author: Ashley Lai <adlai@us.ibm.com>
   5  *
   6  * Maintained by: <tpmdd-devel@lists.sourceforge.net>
   7  *
   8  * Device driver for TCG/TCPA TPM (trusted platform module).
   9  * Specifications at www.trustedcomputinggroup.org
  10  *
  11  * This program is free software; you can redistribute it and/or
  12  * modify it under the terms of the GNU General Public License as
  13  * published by the Free Software Foundation, version 2 of the
  14  * License.
  15  *
  16  */
  17
  18 #include <linux/dma-mapping.h>
  19 #include <linux/dmapool.h>
  20 #include <linux/slab.h>
  21 #include <asm/vio.h>
  22 #include <asm/irq.h>
  23 #include <linux/types.h>
  24 #include <linux/list.h>
  25 #include <linux/spinlock.h>
  26 #include <linux/interrupt.h>
  27 #include <linux/wait.h>
  28 #include <asm/prom.h>
  29
  30 #include "tpm.h"
  31 #include "tpm_ibmvtpm.h"
  32
  33 static const char tpm_ibmvtpm_driver_name[] = "tpm_ibmvtpm";
  34
  35 static struct vio_device_id tpm_ibmvtpm_device_table[] = {
  36         { "IBM,vtpm", "IBM,vtpm"},
  37         { "", "" }
  38 };
  39 MODULE_DEVICE_TABLE(vio, tpm_ibmvtpm_device_table);
  40
  41 DECLARE_WAIT_QUEUE_HEAD(wq);
  42
  43 /**
  44  * ibmvtpm_send_crq - Send a CRQ request
  45  * @vdev:       vio device struct
  46  * @w1:         first word
  47  * @w2:         second word
  48  *
  49  * Return value:
  50  *      0 -Sucess
  51  *      Non-zero - Failure
  52  */
  53 static int ibmvtpm_send_crq(struct vio_dev *vdev, u64 w1, u64 w2)
  54 {
  55         return plpar_hcall_norets(H_SEND_CRQ, vdev->unit_address, w1, w2);
  56 }
  57
  58 /**
  59  * ibmvtpm_get_data - Retrieve ibm vtpm data
  60  * @dev:        device struct
  61  *
  62  * Return value:
  63  *      vtpm device struct
  64  */
  65 static struct ibmvtpm_dev *ibmvtpm_get_data(const struct device *dev)
  66 {
  67         struct tpm_chip *chip = dev_get_drvdata(dev);
  68         if (chip)
  69                 return (struct ibmvtpm_dev *)chip->vendor.data;
  70         return NULL;
  71 }
  72
  73 /**
  74  * tpm_ibmvtpm_recv - Receive data after send
  75  * @chip:       tpm chip struct
  76  * @buf:        buffer to read
  77  * count:       size of buffer
  78  *
  79  * Return value:
  80  *      Number of bytes read
  81  */
  82 static int tpm_ibmvtpm_recv(struct tpm_chip *chip, u8 *buf, size_t count)
  83 {
  84         struct ibmvtpm_dev *ibmvtpm;
  85         u16 len;
  86
  87         ibmvtpm = (struct ibmvtpm_dev *)chip->vendor.data;
  88
  89         if (!ibmvtpm->rtce_buf) {
  90                 dev_err(ibmvtpm->dev, "ibmvtpm device is not ready\n");
  91                 return 0;
  92         }
  93
  94         wait_event_interruptible(wq, ibmvtpm->crq_res.len != 0);
  95
  96         if (count < ibmvtpm->crq_res.len) {
  97                 dev_err(ibmvtpm->dev,
  98                         "Invalid size in recv: count=%ld, crq_size=%d\n",
  99                         count, ibmvtpm->crq_res.len);
 100                 return -EIO;
 101         }
 102
 103         spin_lock(&ibmvtpm->rtce_lock);
 104         memcpy((void *)buf, (void *)ibmvtpm->rtce_buf, ibmvtpm->crq_res.len);
 105         memset(ibmvtpm->rtce_buf, 0, ibmvtpm->crq_res.len);
 106         ibmvtpm->crq_res.valid = 0;
 107         ibmvtpm->crq_res.msg = 0;
 108         len = ibmvtpm->crq_res.len;
 109         ibmvtpm->crq_res.len = 0;
 110         spin_unlock(&ibmvtpm->rtce_lock);
 111         return len;
 112 }
 113
 114 /**
 115  * tpm_ibmvtpm_send - Send tpm request
 116  * @chip:       tpm chip struct
 117  * @buf:        buffer contains data to send
 118  * count:       size of buffer
 119  *
 120  * Return value:
 121  *      Number of bytes sent
 122  */
 123 static int tpm_ibmvtpm_send(struct tpm_chip *chip, u8 *buf, size_t count)
 124 {
 125         struct ibmvtpm_dev *ibmvtpm;
 126         struct ibmvtpm_crq crq;
 127         u64 *word = (u64 *) &crq;
 128         int rc;
 129
 130         ibmvtpm = (struct ibmvtpm_dev *)chip->vendor.data;
 131
 132         if (!ibmvtpm->rtce_buf) {
 133                 dev_err(ibmvtpm->dev, "ibmvtpm device is not ready\n");
 134                 return 0;
 135         }
 136
 137         if (count > ibmvtpm->rtce_size) {
 138                 dev_err(ibmvtpm->dev,
 139                         "Invalid size in send: count=%ld, rtce_size=%d\n",
 140                         count, ibmvtpm->rtce_size);
 141                 return -EIO;
 142         }
 143
 144         spin_lock(&ibmvtpm->rtce_lock);
 145         memcpy((void *)ibmvtpm->rtce_buf, (void *)buf, count);
 146         crq.valid = (u8)IBMVTPM_VALID_CMD;
 147         crq.msg = (u8)VTPM_TPM_COMMAND;
 148         crq.len = (u16)count;
 149         crq.data = ibmvtpm->rtce_dma_handle;
 150
 151         rc = ibmvtpm_send_crq(ibmvtpm->vdev, word[0], word[1]);
 152         if (rc != H_SUCCESS) {
 153                 dev_err(ibmvtpm->dev, "tpm_ibmvtpm_send failed rc=%d\n", rc);
 154                 rc = 0;
 155         } else
 156                 rc = count;
 157
 158         spin_unlock(&ibmvtpm->rtce_lock);
 159         return rc;
 160 }
 161
 162 static void tpm_ibmvtpm_cancel(struct tpm_chip *chip)
 163 {
 164         return;
 165 }
 166
 167 static u8 tpm_ibmvtpm_status(struct tpm_chip *chip)
 168 {
 169         return 0;
 170 }
 171
 172 /**
 173  * ibmvtpm_crq_get_rtce_size - Send a CRQ request to get rtce size
 174  * @ibmvtpm:    vtpm device struct
 175  *
 176  * Return value:
 177  *      0 - Success
 178  *      Non-zero - Failure
 179  */
 180 static int ibmvtpm_crq_get_rtce_size(struct ibmvtpm_dev *ibmvtpm)
 181 {
 182         struct ibmvtpm_crq crq;
 183         u64 *buf = (u64 *) &crq;
 184         int rc;
 185
 186         crq.valid = (u8)IBMVTPM_VALID_CMD;
 187         crq.msg = (u8)VTPM_GET_RTCE_BUFFER_SIZE;
 188
 189         rc = ibmvtpm_send_crq(ibmvtpm->vdev, buf[0], buf[1]);
 190         if (rc != H_SUCCESS)
 191                 dev_err(ibmvtpm->dev,
 192                         "ibmvtpm_crq_get_rtce_size failed rc=%d\n", rc);
 193
 194         return rc;
 195 }
 196
 197 /**
 198  * ibmvtpm_crq_get_version - Send a CRQ request to get vtpm version
 199  *                         - Note that this is vtpm version and not tpm version
 200  * @ibmvtpm:    vtpm device struct
 201  *
 202  * Return value:
 203  *      0 - Success
 204  *      Non-zero - Failure
 205  */
 206 static int ibmvtpm_crq_get_version(struct ibmvtpm_dev *ibmvtpm)
 207 {
 208         struct ibmvtpm_crq crq;
 209         u64 *buf = (u64 *) &crq;
 210         int rc;
 211
 212         crq.valid = (u8)IBMVTPM_VALID_CMD;
 213         crq.msg = (u8)VTPM_GET_VERSION;
 214
 215         rc = ibmvtpm_send_crq(ibmvtpm->vdev, buf[0], buf[1]);
 216         if (rc != H_SUCCESS)
 217                 dev_err(ibmvtpm->dev,
 218                         "ibmvtpm_crq_get_version failed rc=%d\n", rc);
 219
 220         return rc;
 221 }
 222
 223 /**
 224  * ibmvtpm_crq_send_init_complete - Send a CRQ initialize complete message
 225  * @ibmvtpm:    vtpm device struct
 226  *
 227  * Return value:
 228  *      0 - Success
 229  *      Non-zero - Failure
 230  */
 231 static int ibmvtpm_crq_send_init_complete(struct ibmvtpm_dev *ibmvtpm)
 232 {
 233         int rc;
 234
 235         rc = ibmvtpm_send_crq(ibmvtpm->vdev, INIT_CRQ_COMP_CMD, 0);
 236         if (rc != H_SUCCESS)
 237                 dev_err(ibmvtpm->dev,
 238                         "ibmvtpm_crq_send_init_complete failed rc=%d\n", rc);
 239
 240         return rc;
 241 }
 242
 243 /**
 244  * ibmvtpm_crq_send_init - Send a CRQ initialize message
 245  * @ibmvtpm:    vtpm device struct
 246  *
 247  * Return value:
 248  *      0 - Success
 249  *      Non-zero - Failure
 250  */
 251 static int ibmvtpm_crq_send_init(struct ibmvtpm_dev *ibmvtpm)
 252 {
 253         int rc;
 254
 255         rc = ibmvtpm_send_crq(ibmvtpm->vdev, INIT_CRQ_CMD, 0);
 256         if (rc != H_SUCCESS)
 257                 dev_err(ibmvtpm->dev,
 258                         "ibmvtpm_crq_send_init failed rc=%d\n", rc);
 259
 260         return rc;
 261 }
 262
 263 /**
 264  * tpm_ibmvtpm_remove - ibm vtpm remove entry point
 265  * @vdev:       vio device struct
 266  *
 267  * Return value:
 268  *      0
 269  */
 270 static int tpm_ibmvtpm_remove(struct vio_dev *vdev)
 271 {
 272         struct ibmvtpm_dev *ibmvtpm = ibmvtpm_get_data(&vdev->dev);
 273         int rc = 0;
 274
 275         free_irq(vdev->irq, ibmvtpm);
 276         tasklet_kill(&ibmvtpm->tasklet);
 277
 278         do {
 279                 if (rc)
 280                         msleep(100);
 281                 rc = plpar_hcall_norets(H_FREE_CRQ, vdev->unit_address);
 282         } while (rc == H_BUSY || H_IS_LONG_BUSY(rc));
 283
 284         dma_unmap_single(ibmvtpm->dev, ibmvtpm->crq_dma_handle,
 285                          CRQ_RES_BUF_SIZE, DMA_BIDIRECTIONAL);
 286         free_page((unsigned long)ibmvtpm->crq_queue.crq_addr);
 287
 288         if (ibmvtpm->rtce_buf) {
 289                 dma_unmap_single(ibmvtpm->dev, ibmvtpm->rtce_dma_handle,
 290                                  ibmvtpm->rtce_size, DMA_BIDIRECTIONAL);
 291                 kfree(ibmvtpm->rtce_buf);
 292         }
 293
 294         tpm_remove_hardware(ibmvtpm->dev);
 295
 296         kfree(ibmvtpm);
 297
 298         return 0;
 299 }
 300
 301 /**
 302  * tpm_ibmvtpm_get_desired_dma - Get DMA size needed by this driver
 303  * @vdev:       vio device struct
 304  *
 305  * Return value:
 306  *      Number of bytes the driver needs to DMA map
 307  */
 308 static unsigned long tpm_ibmvtpm_get_desired_dma(struct vio_dev *vdev)
 309 {
 310         struct ibmvtpm_dev *ibmvtpm = ibmvtpm_get_data(&vdev->dev);
 311         return CRQ_RES_BUF_SIZE + ibmvtpm->rtce_size;
 312 }
 313
 314 /**
 315  * tpm_ibmvtpm_suspend - Suspend
 316  * @dev:        device struct
 317  *
 318  * Return value:
 319  *      0
 320  */
 321 static int tpm_ibmvtpm_suspend(struct device *dev)
 322 {
 323         struct ibmvtpm_dev *ibmvtpm = ibmvtpm_get_data(dev);
 324         struct ibmvtpm_crq crq;
 325         u64 *buf = (u64 *) &crq;
 326         int rc = 0;
 327
 328         crq.valid = (u8)IBMVTPM_VALID_CMD;
 329         crq.msg = (u8)VTPM_PREPARE_TO_SUSPEND;
 330
 331         rc = ibmvtpm_send_crq(ibmvtpm->vdev, buf[0], buf[1]);
 332         if (rc != H_SUCCESS)
 333                 dev_err(ibmvtpm->dev,
 334                         "tpm_ibmvtpm_suspend failed rc=%d\n", rc);
 335
 336         return rc;
 337 }
 338
 339 /**
 340  * ibmvtpm_reset_crq - Reset CRQ
 341  * @ibmvtpm:    ibm vtpm struct
 342  *
 343  * Return value:
 344  *      0 - Success
 345  *      Non-zero - Failure
 346  */
 347 static int ibmvtpm_reset_crq(struct ibmvtpm_dev *ibmvtpm)
 348 {
 349         int rc = 0;
 350
 351         do {
 352                 if (rc)
 353                         msleep(100);
 354                 rc = plpar_hcall_norets(H_FREE_CRQ,
 355                                         ibmvtpm->vdev->unit_address);
 356         } while (rc == H_BUSY || H_IS_LONG_BUSY(rc));
 357
 358         memset(ibmvtpm->crq_queue.crq_addr, 0, CRQ_RES_BUF_SIZE);
 359         ibmvtpm->crq_queue.index = 0;
 360
 361         return plpar_hcall_norets(H_REG_CRQ, ibmvtpm->vdev->unit_address,
 362                                   ibmvtpm->crq_dma_handle, CRQ_RES_BUF_SIZE);
 363 }
 364
 365 /**
 366  * tpm_ibmvtpm_resume - Resume from suspend
 367  * @dev:        device struct
 368  *
 369  * Return value:
 370  *      0
 371  */
 372 static int tpm_ibmvtpm_resume(struct device *dev)
 373 {
 374         struct ibmvtpm_dev *ibmvtpm = ibmvtpm_get_data(dev);
 375         unsigned long flags;
 376         int rc = 0;
 377
 378         do {
 379                 if (rc)
 380                         msleep(100);
 381                 rc = plpar_hcall_norets(H_ENABLE_CRQ,
 382                                         ibmvtpm->vdev->unit_address);
 383         } while (rc == H_IN_PROGRESS || rc == H_BUSY || H_IS_LONG_BUSY(rc));
 384
 385         if (rc) {
 386                 dev_err(dev, "Error enabling ibmvtpm rc=%d\n", rc);
 387                 return rc;
 388         }
 389
 390         spin_lock_irqsave(&ibmvtpm->lock, flags);
 391         vio_disable_interrupts(ibmvtpm->vdev);
 392         tasklet_schedule(&ibmvtpm->tasklet);
 393         spin_unlock_irqrestore(&ibmvtpm->lock, flags);
 394
 395         rc = ibmvtpm_crq_send_init(ibmvtpm);
 396         if (rc)
 397                 dev_err(dev, "Error send_init rc=%d\n", rc);
 398
 399         return rc;
 400 }
 401
 402 static const struct file_operations ibmvtpm_ops = {
 403         .owner = THIS_MODULE,
 404         .llseek = no_llseek,
 405         .open = tpm_open,
 406         .read = tpm_read,
 407         .write = tpm_write,
 408         .release = tpm_release,
 409 };
 410
 411 static DEVICE_ATTR(pubek, S_IRUGO, tpm_show_pubek, NULL);
 412 static DEVICE_ATTR(pcrs, S_IRUGO, tpm_show_pcrs, NULL);
 413 static DEVICE_ATTR(enabled, S_IRUGO, tpm_show_enabled, NULL);
 414 static DEVICE_ATTR(active, S_IRUGO, tpm_show_active, NULL);
 415 static DEVICE_ATTR(owned, S_IRUGO, tpm_show_owned, NULL);
 416 static DEVICE_ATTR(temp_deactivated, S_IRUGO, tpm_show_temp_deactivated,
 417                    NULL);
 418 static DEVICE_ATTR(caps, S_IRUGO, tpm_show_caps_1_2, NULL);
 419 static DEVICE_ATTR(cancel, S_IWUSR | S_IWGRP, NULL, tpm_store_cancel);
 420 static DEVICE_ATTR(durations, S_IRUGO, tpm_show_durations, NULL);
 421 static DEVICE_ATTR(timeouts, S_IRUGO, tpm_show_timeouts, NULL);
 422
 423 static struct attribute *ibmvtpm_attrs[] = {
 424         &dev_attr_pubek.attr,
 425         &dev_attr_pcrs.attr,
 426         &dev_attr_enabled.attr,
 427         &dev_attr_active.attr,
 428         &dev_attr_owned.attr,
 429         &dev_attr_temp_deactivated.attr,
 430         &dev_attr_caps.attr,
 431         &dev_attr_cancel.attr,
 432         &dev_attr_durations.attr,
 433         &dev_attr_timeouts.attr, NULL,
 434 };
 435
 436 static struct attribute_group ibmvtpm_attr_grp = { .attrs = ibmvtpm_attrs };
 437
 438 static const struct tpm_vendor_specific tpm_ibmvtpm = {
 439         .recv = tpm_ibmvtpm_recv,
 440         .send = tpm_ibmvtpm_send,
 441         .cancel = tpm_ibmvtpm_cancel,
 442         .status = tpm_ibmvtpm_status,
 443         .req_complete_mask = 0,
 444         .req_complete_val = 0,
 445         .req_canceled = 0,
 446         .attr_group = &ibmvtpm_attr_grp,
 447         .miscdev = { .fops = &ibmvtpm_ops, },
 448 };
 449
 450 static const struct dev_pm_ops tpm_ibmvtpm_pm_ops = {
 451         .suspend = tpm_ibmvtpm_suspend,
 452         .resume = tpm_ibmvtpm_resume,
 453 };
 454
 455 /**
 456  * ibmvtpm_crq_get_next - Get next responded crq
 457  * @ibmvtpm     vtpm device struct
 458  *
 459  * Return value:
 460  *      vtpm crq pointer
 461  */
 462 static struct ibmvtpm_crq *ibmvtpm_crq_get_next(struct ibmvtpm_dev *ibmvtpm)
 463 {
 464         struct ibmvtpm_crq_queue *crq_q = &ibmvtpm->crq_queue;
 465         struct ibmvtpm_crq *crq = &crq_q->crq_addr[crq_q->index];
 466
 467         if (crq->valid & VTPM_MSG_RES) {
 468                 if (++crq_q->index == crq_q->num_entry)
 469                         crq_q->index = 0;
 470                 rmb();
 471         } else
 472                 crq = NULL;
 473         return crq;
 474 }
 475
 476 /**
 477  * ibmvtpm_crq_process - Process responded crq
 478  * @crq         crq to be processed
 479  * @ibmvtpm     vtpm device struct
 480  *
 481  * Return value:
 482  *      Nothing
 483  */
 484 static void ibmvtpm_crq_process(struct ibmvtpm_crq *crq,
 485                                 struct ibmvtpm_dev *ibmvtpm)
 486 {
 487         int rc = 0;
 488
 489         switch (crq->valid) {
 490         case VALID_INIT_CRQ:
 491                 switch (crq->msg) {
 492                 case INIT_CRQ_RES:
 493                         dev_info(ibmvtpm->dev, "CRQ initialized\n");
 494                         rc = ibmvtpm_crq_send_init_complete(ibmvtpm);
 495                         if (rc)
 496                                 dev_err(ibmvtpm->dev, "Unable to send CRQ init complete rc=%d\n", rc);
 497                         return;
 498                 case INIT_CRQ_COMP_RES:
 499                         dev_info(ibmvtpm->dev,
 500                                  "CRQ initialization completed\n");
 501                         return;
 502                 default:
 503                         dev_err(ibmvtpm->dev, "Unknown crq message type: %d\n", crq->msg);
 504                         return;
 505                 }
 506                 return;
 507         case IBMVTPM_VALID_CMD:
 508                 switch (crq->msg) {
 509                 case VTPM_GET_RTCE_BUFFER_SIZE_RES:
 510                         if (crq->len <= 0) {
 511                                 dev_err(ibmvtpm->dev, "Invalid rtce size\n");
 512                                 return;
 513                         }
 514                         ibmvtpm->rtce_size = crq->len;
 515                         ibmvtpm->rtce_buf = kmalloc(ibmvtpm->rtce_size,
 516                                                     GFP_KERNEL);
 517                         if (!ibmvtpm->rtce_buf) {
 518                                 dev_err(ibmvtpm->dev, "Failed to allocate memory for rtce buffer\n");
 519                                 return;
 520                         }
 521
 522                         ibmvtpm->rtce_dma_handle = dma_map_single(ibmvtpm->dev,
 523                                 ibmvtpm->rtce_buf, ibmvtpm->rtce_size,
 524                                 DMA_BIDIRECTIONAL);
 525
 526                         if (dma_mapping_error(ibmvtpm->dev,
 527                                               ibmvtpm->rtce_dma_handle)) {
 528                                 kfree(ibmvtpm->rtce_buf);
 529                                 ibmvtpm->rtce_buf = NULL;
 530                                 dev_err(ibmvtpm->dev, "Failed to dma map rtce buffer\n");
 531                         }
 532
 533                         return;
 534                 case VTPM_GET_VERSION_RES:
 535                         ibmvtpm->vtpm_version = crq->data;
 536                         return;
 537                 case VTPM_TPM_COMMAND_RES:
 538                         ibmvtpm->crq_res.valid = crq->valid;
 539                         ibmvtpm->crq_res.msg = crq->msg;
 540                         ibmvtpm->crq_res.len = crq->len;
 541                         ibmvtpm->crq_res.data = crq->data;
 542                         wake_up_interruptible(&wq);
 543                         return;
 544                 default:
 545                         return;
 546                 }
 547         }
 548         return;
 549 }
 550
 551 /**
 552  * ibmvtpm_interrupt -  Interrupt handler
 553  * @irq:                irq number to handle
 554  * @vtpm_instance:      vtpm that received interrupt
 555  *
 556  * Returns:
 557  *      IRQ_HANDLED
 558  **/
 559 static irqreturn_t ibmvtpm_interrupt(int irq, void *vtpm_instance)
 560 {
 561         struct ibmvtpm_dev *ibmvtpm = (struct ibmvtpm_dev *) vtpm_instance;
 562         unsigned long flags;
 563
 564         spin_lock_irqsave(&ibmvtpm->lock, flags);
 565         vio_disable_interrupts(ibmvtpm->vdev);
 566         tasklet_schedule(&ibmvtpm->tasklet);
 567         spin_unlock_irqrestore(&ibmvtpm->lock, flags);
 568
 569         return IRQ_HANDLED;
 570 }
 571
 572 /**
 573  * ibmvtpm_tasklet - Interrupt handler tasklet
 574  * @data:       ibm vtpm device struct
 575  *
 576  * Returns:
 577  *      Nothing
 578  **/
 579 static void ibmvtpm_tasklet(void *data)
 580 {
 581         struct ibmvtpm_dev *ibmvtpm = data;
 582         struct ibmvtpm_crq *crq;
 583         unsigned long flags;
 584
 585         spin_lock_irqsave(&ibmvtpm->lock, flags);
 586         while ((crq = ibmvtpm_crq_get_next(ibmvtpm)) != NULL) {
 587                 ibmvtpm_crq_process(crq, ibmvtpm);
 588                 crq->valid = 0;
 589                 wmb();
 590         }
 591
 592         vio_enable_interrupts(ibmvtpm->vdev);
 593         spin_unlock_irqrestore(&ibmvtpm->lock, flags);
 594 }
 595
 596 /**
 597  * tpm_ibmvtpm_probe - ibm vtpm initialize entry point
 598  * @vio_dev:    vio device struct
 599  * @id:         vio device id struct
 600  *
 601  * Return value:
 602  *      0 - Success
 603  *      Non-zero - Failure
 604  */
 605 static int tpm_ibmvtpm_probe(struct vio_dev *vio_dev,
 606                                    const struct vio_device_id *id)
 607 {
 608         struct ibmvtpm_dev *ibmvtpm;
 609         struct device *dev = &vio_dev->dev;
 610         struct ibmvtpm_crq_queue *crq_q;
 611         struct tpm_chip *chip;
 612         int rc = -ENOMEM, rc1;
 613
 614         chip = tpm_register_hardware(dev, &tpm_ibmvtpm);
 615         if (!chip) {
 616                 dev_err(dev, "tpm_register_hardware failed\n");
 617                 return -ENODEV;
 618         }
 619
 620         ibmvtpm = kzalloc(sizeof(struct ibmvtpm_dev), GFP_KERNEL);
 621         if (!ibmvtpm) {
 622                 dev_err(dev, "kzalloc for ibmvtpm failed\n");
 623                 goto cleanup;
 624         }
 625
 626         crq_q = &ibmvtpm->crq_queue;
 627         crq_q->crq_addr = (struct ibmvtpm_crq *)get_zeroed_page(GFP_KERNEL);
 628         if (!crq_q->crq_addr) {
 629                 dev_err(dev, "Unable to allocate memory for crq_addr\n");
 630                 goto cleanup;
 631         }
 632
 633         crq_q->num_entry = CRQ_RES_BUF_SIZE / sizeof(*crq_q->crq_addr);
 634         ibmvtpm->crq_dma_handle = dma_map_single(dev, crq_q->crq_addr,
 635                                                  CRQ_RES_BUF_SIZE,
 636                                                  DMA_BIDIRECTIONAL);
 637
 638         if (dma_mapping_error(dev, ibmvtpm->crq_dma_handle)) {
 639                 dev_err(dev, "dma mapping failed\n");
 640                 goto cleanup;
 641         }
 642
 643         rc = plpar_hcall_norets(H_REG_CRQ, vio_dev->unit_address,
 644                                 ibmvtpm->crq_dma_handle, CRQ_RES_BUF_SIZE);
 645         if (rc == H_RESOURCE)
 646                 rc = ibmvtpm_reset_crq(ibmvtpm);
 647
 648         if (rc) {
 649                 dev_err(dev, "Unable to register CRQ rc=%d\n", rc);
 650                 goto reg_crq_cleanup;
 651         }
 652
 653         tasklet_init(&ibmvtpm->tasklet, (void *)ibmvtpm_tasklet,
 654                      (unsigned long)ibmvtpm);
 655
 656         rc = request_irq(vio_dev->irq, ibmvtpm_interrupt, 0,
 657                          tpm_ibmvtpm_driver_name, ibmvtpm);
 658         if (rc) {
 659                 dev_err(dev, "Error %d register irq 0x%x\n", rc, vio_dev->irq);
 660                 goto init_irq_cleanup;
 661         }
 662
 663         rc = vio_enable_interrupts(vio_dev);
 664         if (rc) {
 665                 dev_err(dev, "Error %d enabling interrupts\n", rc);
 666                 goto init_irq_cleanup;
 667         }
 668
 669         crq_q->index = 0;
 670
 671         ibmvtpm->dev = dev;
 672         ibmvtpm->vdev = vio_dev;
 673         chip->vendor.data = (void *)ibmvtpm;
 674
 675         spin_lock_init(&ibmvtpm->lock);
 676         spin_lock_init(&ibmvtpm->rtce_lock);
 677
 678         rc = ibmvtpm_crq_send_init(ibmvtpm);
 679         if (rc)
 680                 goto init_irq_cleanup;
 681
 682         rc = ibmvtpm_crq_get_version(ibmvtpm);
 683         if (rc)
 684                 goto init_irq_cleanup;
 685
 686         rc = ibmvtpm_crq_get_rtce_size(ibmvtpm);
 687         if (rc)
 688                 goto init_irq_cleanup;
 689
 690         return rc;
 691 init_irq_cleanup:
 692         tasklet_kill(&ibmvtpm->tasklet);
 693         do {
 694                 rc1 = plpar_hcall_norets(H_FREE_CRQ, vio_dev->unit_address);
 695         } while (rc1 == H_BUSY || H_IS_LONG_BUSY(rc1));
 696 reg_crq_cleanup:
 697         dma_unmap_single(dev, ibmvtpm->crq_dma_handle, CRQ_RES_BUF_SIZE,
 698                          DMA_BIDIRECTIONAL);
 699 cleanup:
 700         if (ibmvtpm) {
 701                 if (crq_q->crq_addr)
 702                         free_page((unsigned long)crq_q->crq_addr);
 703                 kfree(ibmvtpm);
 704         }
 705
 706         tpm_remove_hardware(dev);
 707
 708         return rc;
 709 }
 710
 711 static struct vio_driver ibmvtpm_driver = {
 712         .id_table        = tpm_ibmvtpm_device_table,
 713         .probe           = tpm_ibmvtpm_probe,
 714         .remove          = tpm_ibmvtpm_remove,
 715         .get_desired_dma = tpm_ibmvtpm_get_desired_dma,
 716         .name            = tpm_ibmvtpm_driver_name,
 717         .pm              = &tpm_ibmvtpm_pm_ops,
 718 };
 719
 720 /**
 721  * ibmvtpm_module_init - Initialize ibm vtpm module
 722  *
 723  * Return value:
 724  *      0 -Success
 725  *      Non-zero - Failure
 726  */
 727 static int __init ibmvtpm_module_init(void)
 728 {
 729         return vio_register_driver(&ibmvtpm_driver);
 730 }
 731
 732 /**
 733  * ibmvtpm_module_exit - Teardown ibm vtpm module
 734  *
 735  * Return value:
 736  *      Nothing
 737  */
 738 static void __exit ibmvtpm_module_exit(void)
 739 {
 740         vio_unregister_driver(&ibmvtpm_driver);
 741 }
 742
 743 module_init(ibmvtpm_module_init);
 744 module_exit(ibmvtpm_module_exit);
 745
 746 MODULE_AUTHOR("adlai@us.ibm.com");
 747 MODULE_DESCRIPTION("IBM vTPM Driver");
 748 MODULE_VERSION("1.0");
 749 MODULE_LICENSE("GPL");