drivers/misc/mei/main.c

   1 /*
   2  *
   3  * Intel Management Engine Interface (Intel MEI) Linux driver
   4  * Copyright (c) 2003-2012, Intel Corporation.
   5  *
   6  * This program is free software; you can redistribute it and/or modify it
   7  * under the terms and conditions of the GNU General Public License,
   8  * version 2, as published by the Free Software Foundation.
   9  *
  10  * This program is distributed in the hope it will be useful, but WITHOUT
  11  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  12  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  13  * more details.
  14  *
  15  */
  16 #include <linux/module.h>
  17 #include <linux/moduleparam.h>
  18 #include <linux/kernel.h>
  19 #include <linux/device.h>
  20 #include <linux/slab.h>
  21 #include <linux/fs.h>
  22 #include <linux/errno.h>
  23 #include <linux/types.h>
  24 #include <linux/fcntl.h>
  25 #include <linux/poll.h>
  26 #include <linux/init.h>
  27 #include <linux/ioctl.h>
  28 #include <linux/cdev.h>
  29 #include <linux/sched.h>
  30 #include <linux/uuid.h>
  31 #include <linux/compat.h>
  32 #include <linux/jiffies.h>
  33 #include <linux/interrupt.h>
  34
  35 #include <linux/mei.h>
  36
  37 #include "mei_dev.h"
  38 #include "client.h"
  39
  40 /**
  41  * mei_open - the open function
  42  *
  43  * @inode: pointer to inode structure
  44  * @file: pointer to file structure
  45  *
  46  * Return: 0 on success, <0 on error
  47  */
  48 static int mei_open(struct inode *inode, struct file *file)
  49 {
  50         struct mei_device *dev;
  51         struct mei_cl *cl;
  52
  53         int err;
  54
  55         dev = container_of(inode->i_cdev, struct mei_device, cdev);
  56         if (!dev)
  57                 return -ENODEV;
  58
  59         mutex_lock(&dev->device_lock);
  60
  61         if (dev->dev_state != MEI_DEV_ENABLED) {
  62                 dev_dbg(dev->dev, "dev_state != MEI_ENABLED  dev_state = %s\n",
  63                     mei_dev_state_str(dev->dev_state));
  64                 err = -ENODEV;
  65                 goto err_unlock;
  66         }
  67
  68         cl = mei_cl_alloc_linked(dev, MEI_HOST_CLIENT_ID_ANY);
  69         if (IS_ERR(cl)) {
  70                 err = PTR_ERR(cl);
  71                 goto err_unlock;
  72         }
  73
  74         file->private_data = cl;
  75
  76         mutex_unlock(&dev->device_lock);
  77
  78         return nonseekable_open(inode, file);
  79
  80 err_unlock:
  81         mutex_unlock(&dev->device_lock);
  82         return err;
  83 }
  84
  85 /**
  86  * mei_release - the release function
  87  *
  88  * @inode: pointer to inode structure
  89  * @file: pointer to file structure
  90  *
  91  * Return: 0 on success, <0 on error
  92  */
  93 static int mei_release(struct inode *inode, struct file *file)
  94 {
  95         struct mei_cl *cl = file->private_data;
  96         struct mei_device *dev;
  97         int rets;
  98
  99         if (WARN_ON(!cl || !cl->dev))
 100                 return -ENODEV;
 101
 102         dev = cl->dev;
 103
 104         mutex_lock(&dev->device_lock);
 105         if (cl == &dev->iamthif_cl) {
 106                 rets = mei_amthif_release(dev, file);
 107                 goto out;
 108         }
 109         rets = mei_cl_disconnect(cl);
 110
 111         mei_cl_flush_queues(cl, file);
 112         cl_dbg(dev, cl, "removing\n");
 113
 114         mei_cl_unlink(cl);
 115
 116         file->private_data = NULL;
 117
 118         kfree(cl);
 119 out:
 120         mutex_unlock(&dev->device_lock);
 121         return rets;
 122 }
 123
 124
 125 /**
 126  * mei_read - the read function.
 127  *
 128  * @file: pointer to file structure
 129  * @ubuf: pointer to user buffer
 130  * @length: buffer length
 131  * @offset: data offset in buffer
 132  *
 133  * Return: >=0 data length on success , <0 on error
 134  */
 135 static ssize_t mei_read(struct file *file, char __user *ubuf,
 136                         size_t length, loff_t *offset)
 137 {
 138         struct mei_cl *cl = file->private_data;
 139         struct mei_device *dev;
 140         struct mei_cl_cb *cb = NULL;
 141         int rets;
 142         int err;
 143
 144
 145         if (WARN_ON(!cl || !cl->dev))
 146                 return -ENODEV;
 147
 148         dev = cl->dev;
 149
 150
 151         mutex_lock(&dev->device_lock);
 152         if (dev->dev_state != MEI_DEV_ENABLED) {
 153                 rets = -ENODEV;
 154                 goto out;
 155         }
 156
 157         if (length == 0) {
 158                 rets = 0;
 159                 goto out;
 160         }
 161
 162         if (cl == &dev->iamthif_cl) {
 163                 rets = mei_amthif_read(dev, file, ubuf, length, offset);
 164                 goto out;
 165         }
 166
 167         cb = mei_cl_read_cb(cl, file);
 168         if (cb) {
 169                 /* read what left */
 170                 if (cb->buf_idx > *offset)
 171                         goto copy_buffer;
 172                 /* offset is beyond buf_idx we have no more data return 0 */
 173                 if (cb->buf_idx > 0 && cb->buf_idx <= *offset) {
 174                         rets = 0;
 175                         goto free;
 176                 }
 177                 /* Offset needs to be cleaned for contiguous reads*/
 178                 if (cb->buf_idx == 0 && *offset > 0)
 179                         *offset = 0;
 180         } else if (*offset > 0) {
 181                 *offset = 0;
 182         }
 183
 184         err = mei_cl_read_start(cl, length, file);
 185         if (err && err != -EBUSY) {
 186                 cl_dbg(dev, cl, "mei start read failure status = %d\n", err);
 187                 rets = err;
 188                 goto out;
 189         }
 190
 191         if (list_empty(&cl->rd_completed) && !waitqueue_active(&cl->rx_wait)) {
 192                 if (file->f_flags & O_NONBLOCK) {
 193                         rets = -EAGAIN;
 194                         goto out;
 195                 }
 196
 197                 mutex_unlock(&dev->device_lock);
 198
 199                 if (wait_event_interruptible(cl->rx_wait,
 200                                 (!list_empty(&cl->rd_completed)) ||
 201                                 (!mei_cl_is_connected(cl)))) {
 202
 203                         if (signal_pending(current))
 204                                 return -EINTR;
 205                         return -ERESTARTSYS;
 206                 }
 207
 208                 mutex_lock(&dev->device_lock);
 209                 if (!mei_cl_is_connected(cl)) {
 210                         rets = -EBUSY;
 211                         goto out;
 212                 }
 213         }
 214
 215         cb = mei_cl_read_cb(cl, file);
 216         if (!cb) {
 217                 if (mei_cl_is_fixed_address(cl) && dev->allow_fixed_address) {
 218                         cb = mei_cl_read_cb(cl, NULL);
 219                         if (cb)
 220                                 goto copy_buffer;
 221                 }
 222                 rets = 0;
 223                 goto out;
 224         }
 225
 226 copy_buffer:
 227         /* now copy the data to user space */
 228         if (cb->status) {
 229                 rets = cb->status;
 230                 cl_dbg(dev, cl, "read operation failed %d\n", rets);
 231                 goto free;
 232         }
 233
 234         cl_dbg(dev, cl, "buf.size = %d buf.idx = %ld\n",
 235             cb->buf.size, cb->buf_idx);
 236         if (length == 0 || ubuf == NULL || *offset > cb->buf_idx) {
 237                 rets = -EMSGSIZE;
 238                 goto free;
 239         }
 240
 241         /* length is being truncated to PAGE_SIZE,
 242          * however buf_idx may point beyond that */
 243         length = min_t(size_t, length, cb->buf_idx - *offset);
 244
 245         if (copy_to_user(ubuf, cb->buf.data + *offset, length)) {
 246                 dev_dbg(dev->dev, "failed to copy data to userland\n");
 247                 rets = -EFAULT;
 248                 goto free;
 249         }
 250
 251         rets = length;
 252         *offset += length;
 253         if ((unsigned long)*offset < cb->buf_idx)
 254                 goto out;
 255
 256 free:
 257         mei_io_cb_free(cb);
 258
 259 out:
 260         cl_dbg(dev, cl, "end mei read rets = %d\n", rets);
 261         mutex_unlock(&dev->device_lock);
 262         return rets;
 263 }
 264 /**
 265  * mei_write - the write function.
 266  *
 267  * @file: pointer to file structure
 268  * @ubuf: pointer to user buffer
 269  * @length: buffer length
 270  * @offset: data offset in buffer
 271  *
 272  * Return: >=0 data length on success , <0 on error
 273  */
 274 static ssize_t mei_write(struct file *file, const char __user *ubuf,
 275                          size_t length, loff_t *offset)
 276 {
 277         struct mei_cl *cl = file->private_data;
 278         struct mei_cl_cb *write_cb = NULL;
 279         struct mei_device *dev;
 280         unsigned long timeout = 0;
 281         int rets;
 282
 283         if (WARN_ON(!cl || !cl->dev))
 284                 return -ENODEV;
 285
 286         dev = cl->dev;
 287
 288         mutex_lock(&dev->device_lock);
 289
 290         if (dev->dev_state != MEI_DEV_ENABLED) {
 291                 rets = -ENODEV;
 292                 goto out;
 293         }
 294
 295         if (!mei_cl_is_connected(cl)) {
 296                 cl_err(dev, cl, "is not connected");
 297                 rets = -ENODEV;
 298                 goto out;
 299         }
 300
 301         if (!mei_me_cl_is_active(cl->me_cl)) {
 302                 rets = -ENOTTY;
 303                 goto out;
 304         }
 305
 306         if (length > mei_cl_mtu(cl)) {
 307                 rets = -EFBIG;
 308                 goto out;
 309         }
 310
 311         if (length == 0) {
 312                 rets = 0;
 313                 goto out;
 314         }
 315
 316         if (cl == &dev->iamthif_cl) {
 317                 write_cb = mei_amthif_find_read_list_entry(dev, file);
 318
 319                 if (write_cb) {
 320                         timeout = write_cb->read_time +
 321                                 mei_secs_to_jiffies(MEI_IAMTHIF_READ_TIMER);
 322
 323                         if (time_after(jiffies, timeout)) {
 324                                 *offset = 0;
 325                                 mei_io_cb_free(write_cb);
 326                                 write_cb = NULL;
 327                         }
 328                 }
 329         }
 330
 331         *offset = 0;
 332         write_cb = mei_cl_alloc_cb(cl, length, MEI_FOP_WRITE, file);
 333         if (!write_cb) {
 334                 rets = -ENOMEM;
 335                 goto out;
 336         }
 337
 338         rets = copy_from_user(write_cb->buf.data, ubuf, length);
 339         if (rets) {
 340                 dev_dbg(dev->dev, "failed to copy data from userland\n");
 341                 rets = -EFAULT;
 342                 goto out;
 343         }
 344
 345         if (cl == &dev->iamthif_cl) {
 346                 rets = mei_amthif_write(cl, write_cb);
 347
 348                 if (rets) {
 349                         dev_err(dev->dev,
 350                                 "amthif write failed with status = %d\n", rets);
 351                         goto out;
 352                 }
 353                 mutex_unlock(&dev->device_lock);
 354                 return length;
 355         }
 356
 357         rets = mei_cl_write(cl, write_cb, false);
 358 out:
 359         mutex_unlock(&dev->device_lock);
 360         if (rets < 0)
 361                 mei_io_cb_free(write_cb);
 362         return rets;
 363 }
 364
 365 /**
 366  * mei_ioctl_connect_client - the connect to fw client IOCTL function
 367  *
 368  * @file: private data of the file object
 369  * @data: IOCTL connect data, input and output parameters
 370  *
 371  * Locking: called under "dev->device_lock" lock
 372  *
 373  * Return: 0 on success, <0 on failure.
 374  */
 375 static int mei_ioctl_connect_client(struct file *file,
 376                         struct mei_connect_client_data *data)
 377 {
 378         struct mei_device *dev;
 379         struct mei_client *client;
 380         struct mei_me_client *me_cl;
 381         struct mei_cl *cl;
 382         int rets;
 383
 384         cl = file->private_data;
 385         dev = cl->dev;
 386
 387         if (dev->dev_state != MEI_DEV_ENABLED)
 388                 return -ENODEV;
 389
 390         if (cl->state != MEI_FILE_INITIALIZING &&
 391             cl->state != MEI_FILE_DISCONNECTED)
 392                 return  -EBUSY;
 393
 394         /* find ME client we're trying to connect to */
 395         me_cl = mei_me_cl_by_uuid(dev, &data->in_client_uuid);
 396         if (!me_cl ||
 397             (me_cl->props.fixed_address && !dev->allow_fixed_address)) {
 398                 dev_dbg(dev->dev, "Cannot connect to FW Client UUID = %pUl\n",
 399                         &data->in_client_uuid);
 400                 mei_me_cl_put(me_cl);
 401                 return  -ENOTTY;
 402         }
 403
 404         dev_dbg(dev->dev, "Connect to FW Client ID = %d\n",
 405                         me_cl->client_id);
 406         dev_dbg(dev->dev, "FW Client - Protocol Version = %d\n",
 407                         me_cl->props.protocol_version);
 408         dev_dbg(dev->dev, "FW Client - Max Msg Len = %d\n",
 409                         me_cl->props.max_msg_length);
 410
 411         /* if we're connecting to amthif client then we will use the
 412          * existing connection
 413          */
 414         if (uuid_le_cmp(data->in_client_uuid, mei_amthif_guid) == 0) {
 415                 dev_dbg(dev->dev, "FW Client is amthi\n");
 416                 if (!mei_cl_is_connected(&dev->iamthif_cl)) {
 417                         rets = -ENODEV;
 418                         goto end;
 419                 }
 420                 mei_cl_unlink(cl);
 421
 422                 kfree(cl);
 423                 cl = NULL;
 424                 dev->iamthif_open_count++;
 425                 file->private_data = &dev->iamthif_cl;
 426
 427                 client = &data->out_client_properties;
 428                 client->max_msg_length = me_cl->props.max_msg_length;
 429                 client->protocol_version = me_cl->props.protocol_version;
 430                 rets = dev->iamthif_cl.status;
 431
 432                 goto end;
 433         }
 434
 435         /* prepare the output buffer */
 436         client = &data->out_client_properties;
 437         client->max_msg_length = me_cl->props.max_msg_length;
 438         client->protocol_version = me_cl->props.protocol_version;
 439         dev_dbg(dev->dev, "Can connect?\n");
 440
 441         rets = mei_cl_connect(cl, me_cl, file);
 442
 443 end:
 444         mei_me_cl_put(me_cl);
 445         return rets;
 446 }
 447
 448 /**
 449  * mei_ioctl_client_notify_request -
 450  *     propagate event notification request to client
 451  *
 452  * @file: pointer to file structure
 453  * @request: 0 - disable, 1 - enable
 454  *
 455  * Return: 0 on success , <0 on error
 456  */
 457 static int mei_ioctl_client_notify_request(struct file *file, u32 request)
 458 {
 459         struct mei_cl *cl = file->private_data;
 460
 461         return mei_cl_notify_request(cl, file, request);
 462 }
 463
 464 /**
 465  * mei_ioctl_client_notify_get -  wait for notification request
 466  *
 467  * @file: pointer to file structure
 468  * @notify_get: 0 - disable, 1 - enable
 469  *
 470  * Return: 0 on success , <0 on error
 471  */
 472 static int mei_ioctl_client_notify_get(struct file *file, u32 *notify_get)
 473 {
 474         struct mei_cl *cl = file->private_data;
 475         bool notify_ev;
 476         bool block = (file->f_flags & O_NONBLOCK) == 0;
 477         int rets;
 478
 479         rets = mei_cl_notify_get(cl, block, &notify_ev);
 480         if (rets)
 481                 return rets;
 482
 483         *notify_get = notify_ev ? 1 : 0;
 484         return 0;
 485 }
 486
 487 /**
 488  * mei_ioctl - the IOCTL function
 489  *
 490  * @file: pointer to file structure
 491  * @cmd: ioctl command
 492  * @data: pointer to mei message structure
 493  *
 494  * Return: 0 on success , <0 on error
 495  */
 496 static long mei_ioctl(struct file *file, unsigned int cmd, unsigned long data)
 497 {
 498         struct mei_device *dev;
 499         struct mei_cl *cl = file->private_data;
 500         struct mei_connect_client_data connect_data;
 501         u32 notify_get, notify_req;
 502         int rets;
 503
 504
 505         if (WARN_ON(!cl || !cl->dev))
 506                 return -ENODEV;
 507
 508         dev = cl->dev;
 509
 510         dev_dbg(dev->dev, "IOCTL cmd = 0x%x", cmd);
 511
 512         mutex_lock(&dev->device_lock);
 513         if (dev->dev_state != MEI_DEV_ENABLED) {
 514                 rets = -ENODEV;
 515                 goto out;
 516         }
 517
 518         switch (cmd) {
 519         case IOCTL_MEI_CONNECT_CLIENT:
 520                 dev_dbg(dev->dev, ": IOCTL_MEI_CONNECT_CLIENT.\n");
 521                 if (copy_from_user(&connect_data, (char __user *)data,
 522                                 sizeof(struct mei_connect_client_data))) {
 523                         dev_dbg(dev->dev, "failed to copy data from userland\n");
 524                         rets = -EFAULT;
 525                         goto out;
 526                 }
 527
 528                 rets = mei_ioctl_connect_client(file, &connect_data);
 529                 if (rets)
 530                         goto out;
 531
 532                 /* if all is ok, copying the data back to user. */
 533                 if (copy_to_user((char __user *)data, &connect_data,
 534                                 sizeof(struct mei_connect_client_data))) {
 535                         dev_dbg(dev->dev, "failed to copy data to userland\n");
 536                         rets = -EFAULT;
 537                         goto out;
 538                 }
 539
 540                 break;
 541
 542         case IOCTL_MEI_NOTIFY_SET:
 543                 dev_dbg(dev->dev, ": IOCTL_MEI_NOTIFY_SET.\n");
 544                 if (copy_from_user(&notify_req,
 545                                    (char __user *)data, sizeof(notify_req))) {
 546                         dev_dbg(dev->dev, "failed to copy data from userland\n");
 547                         rets = -EFAULT;
 548                         goto out;
 549                 }
 550                 rets = mei_ioctl_client_notify_request(file, notify_req);
 551                 break;
 552
 553         case IOCTL_MEI_NOTIFY_GET:
 554                 dev_dbg(dev->dev, ": IOCTL_MEI_NOTIFY_GET.\n");
 555                 rets = mei_ioctl_client_notify_get(file, &notify_get);
 556                 if (rets)
 557                         goto out;
 558
 559                 dev_dbg(dev->dev, "copy connect data to user\n");
 560                 if (copy_to_user((char __user *)data,
 561                                 &notify_get, sizeof(notify_get))) {
 562                         dev_dbg(dev->dev, "failed to copy data to userland\n");
 563                         rets = -EFAULT;
 564                         goto out;
 565
 566                 }
 567                 break;
 568
 569         default:
 570                 dev_err(dev->dev, ": unsupported ioctl %d.\n", cmd);
 571                 rets = -ENOIOCTLCMD;
 572         }
 573
 574 out:
 575         mutex_unlock(&dev->device_lock);
 576         return rets;
 577 }
 578
 579 /**
 580  * mei_compat_ioctl - the compat IOCTL function
 581  *
 582  * @file: pointer to file structure
 583  * @cmd: ioctl command
 584  * @data: pointer to mei message structure
 585  *
 586  * Return: 0 on success , <0 on error
 587  */
 588 #ifdef CONFIG_COMPAT
 589 static long mei_compat_ioctl(struct file *file,
 590                         unsigned int cmd, unsigned long data)
 591 {
 592         return mei_ioctl(file, cmd, (unsigned long)compat_ptr(data));
 593 }
 594 #endif
 595
 596
 597 /**
 598  * mei_poll - the poll function
 599  *
 600  * @file: pointer to file structure
 601  * @wait: pointer to poll_table structure
 602  *
 603  * Return: poll mask
 604  */
 605 static unsigned int mei_poll(struct file *file, poll_table *wait)
 606 {
 607         unsigned long req_events = poll_requested_events(wait);
 608         struct mei_cl *cl = file->private_data;
 609         struct mei_device *dev;
 610         unsigned int mask = 0;
 611         bool notify_en;
 612
 613         if (WARN_ON(!cl || !cl->dev))
 614                 return POLLERR;
 615
 616         dev = cl->dev;
 617
 618         mutex_lock(&dev->device_lock);
 619
 620         notify_en = cl->notify_en && (req_events & POLLPRI);
 621
 622         if (dev->dev_state != MEI_DEV_ENABLED ||
 623             !mei_cl_is_connected(cl)) {
 624                 mask = POLLERR;
 625                 goto out;
 626         }
 627
 628         if (cl == &dev->iamthif_cl) {
 629                 mask = mei_amthif_poll(dev, file, wait);
 630                 goto out;
 631         }
 632
 633         if (notify_en) {
 634                 poll_wait(file, &cl->ev_wait, wait);
 635                 if (cl->notify_ev)
 636                         mask |= POLLPRI;
 637         }
 638
 639         if (req_events & (POLLIN | POLLRDNORM)) {
 640                 poll_wait(file, &cl->rx_wait, wait);
 641
 642                 if (!list_empty(&cl->rd_completed))
 643                         mask |= POLLIN | POLLRDNORM;
 644                 else
 645                         mei_cl_read_start(cl, 0, file);
 646         }
 647
 648 out:
 649         mutex_unlock(&dev->device_lock);
 650         return mask;
 651 }
 652
 653 /**
 654  * mei_fasync - asynchronous io support
 655  *
 656  * @fd: file descriptor
 657  * @file: pointer to file structure
 658  * @band: band bitmap
 659  *
 660  * Return: poll mask
 661  */
 662 static int mei_fasync(int fd, struct file *file, int band)
 663 {
 664
 665         struct mei_cl *cl = file->private_data;
 666
 667         if (!mei_cl_is_connected(cl))
 668                 return POLLERR;
 669
 670         return fasync_helper(fd, file, band, &cl->ev_async);
 671 }
 672
 673 /**
 674  * fw_status_show - mei device attribute show method
 675  *
 676  * @device: device pointer
 677  * @attr: attribute pointer
 678  * @buf:  char out buffer
 679  *
 680  * Return: number of the bytes printed into buf or error
 681  */
 682 static ssize_t fw_status_show(struct device *device,
 683                 struct device_attribute *attr, char *buf)
 684 {
 685         struct mei_device *dev = dev_get_drvdata(device);
 686         struct mei_fw_status fw_status;
 687         int err, i;
 688         ssize_t cnt = 0;
 689
 690         mutex_lock(&dev->device_lock);
 691         err = mei_fw_status(dev, &fw_status);
 692         mutex_unlock(&dev->device_lock);
 693         if (err) {
 694                 dev_err(device, "read fw_status error = %d\n", err);
 695                 return err;
 696         }
 697
 698         for (i = 0; i < fw_status.count; i++)
 699                 cnt += scnprintf(buf + cnt, PAGE_SIZE - cnt, "%08X\n",
 700                                 fw_status.status[i]);
 701         return cnt;
 702 }
 703 static DEVICE_ATTR_RO(fw_status);
 704
 705 static struct attribute *mei_attrs[] = {
 706         &dev_attr_fw_status.attr,
 707         NULL
 708 };
 709 ATTRIBUTE_GROUPS(mei);
 710
 711 /*
 712  * file operations structure will be used for mei char device.
 713  */
 714 static const struct file_operations mei_fops = {
 715         .owner = THIS_MODULE,
 716         .read = mei_read,
 717         .unlocked_ioctl = mei_ioctl,
 718 #ifdef CONFIG_COMPAT
 719         .compat_ioctl = mei_compat_ioctl,
 720 #endif
 721         .open = mei_open,
 722         .release = mei_release,
 723         .write = mei_write,
 724         .poll = mei_poll,
 725         .fasync = mei_fasync,
 726         .llseek = no_llseek
 727 };
 728
 729 static struct class *mei_class;
 730 static dev_t mei_devt;
 731 #define MEI_MAX_DEVS  MINORMASK
 732 static DEFINE_MUTEX(mei_minor_lock);
 733 static DEFINE_IDR(mei_idr);
 734
 735 /**
 736  * mei_minor_get - obtain next free device minor number
 737  *
 738  * @dev:  device pointer
 739  *
 740  * Return: allocated minor, or -ENOSPC if no free minor left
 741  */
 742 static int mei_minor_get(struct mei_device *dev)
 743 {
 744         int ret;
 745
 746         mutex_lock(&mei_minor_lock);
 747         ret = idr_alloc(&mei_idr, dev, 0, MEI_MAX_DEVS, GFP_KERNEL);
 748         if (ret >= 0)
 749                 dev->minor = ret;
 750         else if (ret == -ENOSPC)
 751                 dev_err(dev->dev, "too many mei devices\n");
 752
 753         mutex_unlock(&mei_minor_lock);
 754         return ret;
 755 }
 756
 757 /**
 758  * mei_minor_free - mark device minor number as free
 759  *
 760  * @dev:  device pointer
 761  */
 762 static void mei_minor_free(struct mei_device *dev)
 763 {
 764         mutex_lock(&mei_minor_lock);
 765         idr_remove(&mei_idr, dev->minor);
 766         mutex_unlock(&mei_minor_lock);
 767 }
 768
 769 int mei_register(struct mei_device *dev, struct device *parent)
 770 {
 771         struct device *clsdev; /* class device */
 772         int ret, devno;
 773
 774         ret = mei_minor_get(dev);
 775         if (ret < 0)
 776                 return ret;
 777
 778         /* Fill in the data structures */
 779         devno = MKDEV(MAJOR(mei_devt), dev->minor);
 780         cdev_init(&dev->cdev, &mei_fops);
 781         dev->cdev.owner = parent->driver->owner;
 782
 783         /* Add the device */
 784         ret = cdev_add(&dev->cdev, devno, 1);
 785         if (ret) {
 786                 dev_err(parent, "unable to add device %d:%d\n",
 787                         MAJOR(mei_devt), dev->minor);
 788                 goto err_dev_add;
 789         }
 790
 791         clsdev = device_create_with_groups(mei_class, parent, devno,
 792                                            dev, mei_groups,
 793                                            "mei%d", dev->minor);
 794
 795         if (IS_ERR(clsdev)) {
 796                 dev_err(parent, "unable to create device %d:%d\n",
 797                         MAJOR(mei_devt), dev->minor);
 798                 ret = PTR_ERR(clsdev);
 799                 goto err_dev_create;
 800         }
 801
 802         ret = mei_dbgfs_register(dev, dev_name(clsdev));
 803         if (ret) {
 804                 dev_err(clsdev, "cannot register debugfs ret = %d\n", ret);
 805                 goto err_dev_dbgfs;
 806         }
 807
 808         return 0;
 809
 810 err_dev_dbgfs:
 811         device_destroy(mei_class, devno);
 812 err_dev_create:
 813         cdev_del(&dev->cdev);
 814 err_dev_add:
 815         mei_minor_free(dev);
 816         return ret;
 817 }
 818 EXPORT_SYMBOL_GPL(mei_register);
 819
 820 void mei_deregister(struct mei_device *dev)
 821 {
 822         int devno;
 823
 824         devno = dev->cdev.dev;
 825         cdev_del(&dev->cdev);
 826
 827         mei_dbgfs_deregister(dev);
 828
 829         device_destroy(mei_class, devno);
 830
 831         mei_minor_free(dev);
 832 }
 833 EXPORT_SYMBOL_GPL(mei_deregister);
 834
 835 static int __init mei_init(void)
 836 {
 837         int ret;
 838
 839         mei_class = class_create(THIS_MODULE, "mei");
 840         if (IS_ERR(mei_class)) {
 841                 pr_err("couldn't create class\n");
 842                 ret = PTR_ERR(mei_class);
 843                 goto err;
 844         }
 845
 846         ret = alloc_chrdev_region(&mei_devt, 0, MEI_MAX_DEVS, "mei");
 847         if (ret < 0) {
 848                 pr_err("unable to allocate char dev region\n");
 849                 goto err_class;
 850         }
 851
 852         ret = mei_cl_bus_init();
 853         if (ret < 0) {
 854                 pr_err("unable to initialize bus\n");
 855                 goto err_chrdev;
 856         }
 857
 858         return 0;
 859
 860 err_chrdev:
 861         unregister_chrdev_region(mei_devt, MEI_MAX_DEVS);
 862 err_class:
 863         class_destroy(mei_class);
 864 err:
 865         return ret;
 866 }
 867
 868 static void __exit mei_exit(void)
 869 {
 870         unregister_chrdev_region(mei_devt, MEI_MAX_DEVS);
 871         class_destroy(mei_class);
 872         mei_cl_bus_exit();
 873 }
 874
 875 module_init(mei_init);
 876 module_exit(mei_exit);
 877
 878 MODULE_AUTHOR("Intel Corporation");
 879 MODULE_DESCRIPTION("Intel(R) Management Engine Interface");
 880 MODULE_LICENSE("GPL v2");
 881