main.c 17.7 KB
Newer Older
1 2 3
/*
 *
 * Intel Management Engine Interface (Intel MEI) Linux driver
4
 * Copyright (c) 2003-2012, Intel Corporation.
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 *
 * This program is distributed in the hope it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 */
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/kernel.h>
#include <linux/device.h>
20
#include <linux/slab.h>
21 22 23 24 25 26 27 28 29 30 31 32 33 34 35
#include <linux/fs.h>
#include <linux/errno.h>
#include <linux/types.h>
#include <linux/fcntl.h>
#include <linux/aio.h>
#include <linux/poll.h>
#include <linux/init.h>
#include <linux/ioctl.h>
#include <linux/cdev.h>
#include <linux/sched.h>
#include <linux/uuid.h>
#include <linux/compat.h>
#include <linux/jiffies.h>
#include <linux/interrupt.h>

36
#include <linux/mei.h>
37 38

#include "mei_dev.h"
T
Tomas Winkler 已提交
39
#include "client.h"
40 41 42 43 44 45

/**
 * mei_open - the open function
 *
 * @inode: pointer to inode structure
 * @file: pointer to file structure
46
 *
47
 * Return: 0 on success, <0 on error
48 49 50 51
 */
static int mei_open(struct inode *inode, struct file *file)
{
	struct mei_device *dev;
52
	struct mei_cl *cl;
53

54
	int err;
55

56
	dev = container_of(inode->i_cdev, struct mei_device, cdev);
57
	if (!dev)
58
		return -ENODEV;
59 60

	mutex_lock(&dev->device_lock);
61 62

	cl = NULL;
63 64

	err = -ENODEV;
65
	if (dev->dev_state != MEI_DEV_ENABLED) {
66
		dev_dbg(dev->dev, "dev_state != MEI_ENABLED  dev_state = %s\n",
67
		    mei_dev_state_str(dev->dev_state));
68
		goto err_unlock;
69
	}
70

71 72 73 74 75 76
	err = -ENOMEM;
	cl = mei_cl_allocate(dev);
	if (!cl)
		goto err_unlock;

	/* open_handle_count check is handled in the mei_cl_link */
77 78
	err = mei_cl_link(cl, MEI_HOST_CLIENT_ID_ANY);
	if (err)
79
		goto err_unlock;
80 81

	file->private_data = cl;
82

83 84
	mutex_unlock(&dev->device_lock);

85
	return nonseekable_open(inode, file);
86

87
err_unlock:
88 89 90 91 92 93 94 95 96 97 98
	mutex_unlock(&dev->device_lock);
	kfree(cl);
	return err;
}

/**
 * mei_release - the release function
 *
 * @inode: pointer to inode structure
 * @file: pointer to file structure
 *
99
 * Return: 0 on success, <0 on error
100 101 102 103 104 105 106 107 108 109 110 111 112 113
 */
static int mei_release(struct inode *inode, struct file *file)
{
	struct mei_cl *cl = file->private_data;
	struct mei_cl_cb *cb;
	struct mei_device *dev;
	int rets = 0;

	if (WARN_ON(!cl || !cl->dev))
		return -ENODEV;

	dev = cl->dev;

	mutex_lock(&dev->device_lock);
114 115 116 117 118 119
	if (cl == &dev->iamthif_cl) {
		rets = mei_amthif_release(dev, file);
		goto out;
	}
	if (cl->state == MEI_FILE_CONNECTED) {
		cl->state = MEI_FILE_DISCONNECTING;
120
		cl_dbg(dev, cl, "disconnecting\n");
T
Tomas Winkler 已提交
121
		rets = mei_cl_disconnect(cl);
122 123
	}
	mei_cl_flush_queues(cl);
124
	cl_dbg(dev, cl, "removing\n");
125

T
Tomas Winkler 已提交
126
	mei_cl_unlink(cl);
127

128

129 130 131
	/* free read cb */
	cb = NULL;
	if (cl->read_cb) {
T
Tomas Winkler 已提交
132
		cb = mei_cl_find_read_cb(cl);
133 134 135 136 137 138 139
		/* Remove entry from read list */
		if (cb)
			list_del(&cb->list);

		cb = cl->read_cb;
		cl->read_cb = NULL;
	}
140

141
	file->private_data = NULL;
142

143
	mei_io_cb_free(cb);
144 145 146

	kfree(cl);
out:
147 148 149 150 151 152 153 154 155 156 157 158 159
	mutex_unlock(&dev->device_lock);
	return rets;
}


/**
 * mei_read - the read function.
 *
 * @file: pointer to file structure
 * @ubuf: pointer to user buffer
 * @length: buffer length
 * @offset: data offset in buffer
 *
160
 * Return: >=0 data length on success , <0 on error
161 162
 */
static ssize_t mei_read(struct file *file, char __user *ubuf,
163
			size_t length, loff_t *offset)
164 165 166 167 168 169 170 171 172 173 174 175 176 177
{
	struct mei_cl *cl = file->private_data;
	struct mei_cl_cb *cb_pos = NULL;
	struct mei_cl_cb *cb = NULL;
	struct mei_device *dev;
	int rets;
	int err;


	if (WARN_ON(!cl || !cl->dev))
		return -ENODEV;

	dev = cl->dev;

178

179
	mutex_lock(&dev->device_lock);
180
	if (dev->dev_state != MEI_DEV_ENABLED) {
181 182 183 184
		rets = -ENODEV;
		goto out;
	}

185 186 187 188 189
	if (length == 0) {
		rets = 0;
		goto out;
	}

190
	if (cl == &dev->iamthif_cl) {
191
		rets = mei_amthif_read(dev, file, ubuf, length, offset);
192 193 194
		goto out;
	}

195 196
	cb = cl->read_cb;
	if (cb) {
197 198 199 200 201 202 203 204 205 206 207 208
		/* read what left */
		if (cb->buf_idx > *offset)
			goto copy_buffer;
		/* offset is beyond buf_idx we have no more data return 0 */
		if (cb->buf_idx > 0 && cb->buf_idx <= *offset) {
			rets = 0;
			goto free;
		}
		/* Offset needs to be cleaned for contiguous reads*/
		if (cb->buf_idx == 0 && *offset > 0)
			*offset = 0;
	} else if (*offset > 0) {
209 210 211
		*offset = 0;
	}

T
Tomas Winkler 已提交
212
	err = mei_cl_read_start(cl, length);
213
	if (err && err != -EBUSY) {
214
		dev_dbg(dev->dev,
215 216 217 218 219 220
			"mei start read failure with status = %d\n", err);
		rets = err;
		goto out;
	}

	if (MEI_READ_COMPLETE != cl->reading_state &&
221 222
		!waitqueue_active(&cl->rx_wait)) {

223 224 225 226 227 228 229 230
		if (file->f_flags & O_NONBLOCK) {
			rets = -EAGAIN;
			goto out;
		}

		mutex_unlock(&dev->device_lock);

		if (wait_event_interruptible(cl->rx_wait,
231 232 233
				MEI_READ_COMPLETE == cl->reading_state ||
				mei_cl_is_transitioning(cl))) {

234 235 236 237 238 239
			if (signal_pending(current))
				return -EINTR;
			return -ERESTARTSYS;
		}

		mutex_lock(&dev->device_lock);
240
		if (mei_cl_is_transitioning(cl)) {
241 242 243 244 245 246 247 248 249 250 251
			rets = -EBUSY;
			goto out;
		}
	}

	cb = cl->read_cb;

	if (!cb) {
		rets = -ENODEV;
		goto out;
	}
252

253 254 255 256
	if (cl->reading_state != MEI_READ_COMPLETE) {
		rets = 0;
		goto out;
	}
257

258
copy_buffer:
259 260 261 262 263 264 265
	/* now copy the data to user space */
	if (cb->status) {
		rets = cb->status;
		dev_dbg(dev->dev, "read operation failed %d\n", rets);
		goto free;
	}

266
	dev_dbg(dev->dev, "buf.size = %d buf.idx= %ld\n",
T
Tomas Winkler 已提交
267
	    cb->response_buffer.size, cb->buf_idx);
268
	if (length == 0 || ubuf == NULL || *offset > cb->buf_idx) {
269 270 271 272
		rets = -EMSGSIZE;
		goto free;
	}

273 274 275
	/* length is being truncated to PAGE_SIZE,
	 * however buf_idx may point beyond that */
	length = min_t(size_t, length, cb->buf_idx - *offset);
276

277
	if (copy_to_user(ubuf, cb->response_buffer.data + *offset, length)) {
278
		dev_dbg(dev->dev, "failed to copy data to userland\n");
279 280 281 282 283 284
		rets = -EFAULT;
		goto free;
	}

	rets = length;
	*offset += length;
285
	if ((unsigned long)*offset < cb->buf_idx)
286 287 288
		goto out;

free:
T
Tomas Winkler 已提交
289
	cb_pos = mei_cl_find_read_cb(cl);
290 291
	/* Remove entry from read list */
	if (cb_pos)
292
		list_del(&cb_pos->list);
293
	mei_io_cb_free(cb);
294 295 296
	cl->reading_state = MEI_IDLE;
	cl->read_cb = NULL;
out:
297
	dev_dbg(dev->dev, "end mei read rets= %d\n", rets);
298 299 300 301 302 303 304 305 306 307 308
	mutex_unlock(&dev->device_lock);
	return rets;
}
/**
 * mei_write - the write function.
 *
 * @file: pointer to file structure
 * @ubuf: pointer to user buffer
 * @length: buffer length
 * @offset: data offset in buffer
 *
309
 * Return: >=0 data length on success , <0 on error
310 311
 */
static ssize_t mei_write(struct file *file, const char __user *ubuf,
312
			 size_t length, loff_t *offset)
313 314
{
	struct mei_cl *cl = file->private_data;
315
	struct mei_me_client *me_cl = NULL;
316 317 318 319 320 321 322 323 324 325 326 327
	struct mei_cl_cb *write_cb = NULL;
	struct mei_device *dev;
	unsigned long timeout = 0;
	int rets;

	if (WARN_ON(!cl || !cl->dev))
		return -ENODEV;

	dev = cl->dev;

	mutex_lock(&dev->device_lock);

328
	if (dev->dev_state != MEI_DEV_ENABLED) {
329
		rets = -ENODEV;
T
Tomas Winkler 已提交
330
		goto out;
331 332
	}

333
	me_cl = mei_me_cl_by_uuid_id(dev, &cl->cl_uuid, cl->me_client_id);
334
	if (!me_cl) {
335
		rets = -ENOTTY;
T
Tomas Winkler 已提交
336
		goto out;
337
	}
338 339 340 341 342 343

	if (length == 0) {
		rets = 0;
		goto out;
	}

344
	if (length > me_cl->props.max_msg_length) {
345
		rets = -EFBIG;
T
Tomas Winkler 已提交
346
		goto out;
347 348 349
	}

	if (cl->state != MEI_FILE_CONNECTED) {
350
		dev_err(dev->dev, "host client = %d,  is not connected to ME client = %d",
351
			cl->host_client_id, cl->me_client_id);
T
Tomas Winkler 已提交
352 353
		rets = -ENODEV;
		goto out;
354
	}
355
	if (cl == &dev->iamthif_cl) {
356
		write_cb = mei_amthif_find_read_list_entry(dev, file);
357 358 359

		if (write_cb) {
			timeout = write_cb->read_time +
360
				mei_secs_to_jiffies(MEI_IAMTHIF_READ_TIMER);
361 362

			if (time_after(jiffies, timeout) ||
363 364
			    cl->reading_state == MEI_READ_COMPLETE) {
				*offset = 0;
365
				list_del(&write_cb->list);
366
				mei_io_cb_free(write_cb);
367
				write_cb = NULL;
368 369 370 371 372 373 374
			}
		}
	}

	/* free entry used in read */
	if (cl->reading_state == MEI_READ_COMPLETE) {
		*offset = 0;
T
Tomas Winkler 已提交
375
		write_cb = mei_cl_find_read_cb(cl);
376
		if (write_cb) {
377
			list_del(&write_cb->list);
378
			mei_io_cb_free(write_cb);
379 380 381 382
			write_cb = NULL;
			cl->reading_state = MEI_IDLE;
			cl->read_cb = NULL;
		}
383
	} else if (cl->reading_state == MEI_IDLE)
384 385 386
		*offset = 0;


387
	write_cb = mei_io_cb_init(cl, file);
388
	if (!write_cb) {
389
		rets = -ENOMEM;
T
Tomas Winkler 已提交
390
		goto out;
391
	}
392 393
	rets = mei_io_cb_alloc_req_buf(write_cb, length);
	if (rets)
T
Tomas Winkler 已提交
394
		goto out;
395

396
	rets = copy_from_user(write_cb->request_buffer.data, ubuf, length);
397
	if (rets) {
398
		dev_dbg(dev->dev, "failed to copy data from userland\n");
399
		rets = -EFAULT;
T
Tomas Winkler 已提交
400
		goto out;
401
	}
402 403

	if (cl == &dev->iamthif_cl) {
404
		rets = mei_amthif_write(cl, write_cb);
405

406
		if (rets) {
407
			dev_err(dev->dev,
408
				"amthif write failed with status = %d\n", rets);
T
Tomas Winkler 已提交
409
			goto out;
410
		}
411
		mei_me_cl_put(me_cl);
412
		mutex_unlock(&dev->device_lock);
413
		return length;
414 415
	}

T
Tomas Winkler 已提交
416
	rets = mei_cl_write(cl, write_cb, false);
417
out:
418
	mei_me_cl_put(me_cl);
419
	mutex_unlock(&dev->device_lock);
T
Tomas Winkler 已提交
420 421
	if (rets < 0)
		mei_io_cb_free(write_cb);
422 423 424
	return rets;
}

425 426 427 428
/**
 * mei_ioctl_connect_client - the connect to fw client IOCTL function
 *
 * @file: private data of the file object
429
 * @data: IOCTL connect data, input and output parameters
430 431 432
 *
 * Locking: called under "dev->device_lock" lock
 *
433
 * Return: 0 on success, <0 on failure.
434 435 436 437 438 439
 */
static int mei_ioctl_connect_client(struct file *file,
			struct mei_connect_client_data *data)
{
	struct mei_device *dev;
	struct mei_client *client;
440
	struct mei_me_client *me_cl;
441 442 443 444 445 446
	struct mei_cl *cl;
	int rets;

	cl = file->private_data;
	dev = cl->dev;

447 448
	if (dev->dev_state != MEI_DEV_ENABLED)
		return -ENODEV;
449 450

	if (cl->state != MEI_FILE_INITIALIZING &&
451 452
	    cl->state != MEI_FILE_DISCONNECTED)
		return  -EBUSY;
453 454

	/* find ME client we're trying to connect to */
455 456
	me_cl = mei_me_cl_by_uuid(dev, &data->in_client_uuid);
	if (!me_cl || me_cl->props.fixed_address) {
457
		dev_dbg(dev->dev, "Cannot connect to FW Client UUID = %pUl\n",
458
				&data->in_client_uuid);
459
		return  -ENOTTY;
460 461
	}

462
	cl->me_client_id = me_cl->client_id;
463
	cl->cl_uuid = me_cl->props.protocol_name;
464

465
	dev_dbg(dev->dev, "Connect to FW Client ID = %d\n",
466
			cl->me_client_id);
467
	dev_dbg(dev->dev, "FW Client - Protocol Version = %d\n",
468
			me_cl->props.protocol_version);
469
	dev_dbg(dev->dev, "FW Client - Max Msg Len = %d\n",
470
			me_cl->props.max_msg_length);
471

472
	/* if we're connecting to amthif client then we will use the
473 474
	 * existing connection
	 */
475
	if (uuid_le_cmp(data->in_client_uuid, mei_amthif_guid) == 0) {
476
		dev_dbg(dev->dev, "FW Client is amthi\n");
477 478 479 480 481 482 483 484
		if (dev->iamthif_cl.state != MEI_FILE_CONNECTED) {
			rets = -ENODEV;
			goto end;
		}
		mei_cl_unlink(cl);

		kfree(cl);
		cl = NULL;
T
Tomas Winkler 已提交
485
		dev->iamthif_open_count++;
486 487 488
		file->private_data = &dev->iamthif_cl;

		client = &data->out_client_properties;
489 490
		client->max_msg_length = me_cl->props.max_msg_length;
		client->protocol_version = me_cl->props.protocol_version;
491 492 493 494 495 496 497
		rets = dev->iamthif_cl.status;

		goto end;
	}

	/* prepare the output buffer */
	client = &data->out_client_properties;
498 499
	client->max_msg_length = me_cl->props.max_msg_length;
	client->protocol_version = me_cl->props.protocol_version;
500
	dev_dbg(dev->dev, "Can connect?\n");
501 502 503 504

	rets = mei_cl_connect(cl, file);

end:
505
	mei_me_cl_put(me_cl);
506 507 508
	return rets;
}

509 510 511 512 513 514 515
/**
 * mei_ioctl - the IOCTL function
 *
 * @file: pointer to file structure
 * @cmd: ioctl command
 * @data: pointer to mei message structure
 *
516
 * Return: 0 on success , <0 on error
517 518 519 520 521
 */
static long mei_ioctl(struct file *file, unsigned int cmd, unsigned long data)
{
	struct mei_device *dev;
	struct mei_cl *cl = file->private_data;
522
	struct mei_connect_client_data connect_data;
523 524 525 526 527 528 529 530
	int rets;


	if (WARN_ON(!cl || !cl->dev))
		return -ENODEV;

	dev = cl->dev;

531
	dev_dbg(dev->dev, "IOCTL cmd = 0x%x", cmd);
532 533

	mutex_lock(&dev->device_lock);
534
	if (dev->dev_state != MEI_DEV_ENABLED) {
535 536 537 538
		rets = -ENODEV;
		goto out;
	}

539 540
	switch (cmd) {
	case IOCTL_MEI_CONNECT_CLIENT:
541
		dev_dbg(dev->dev, ": IOCTL_MEI_CONNECT_CLIENT.\n");
542
		if (copy_from_user(&connect_data, (char __user *)data,
543
				sizeof(struct mei_connect_client_data))) {
544
			dev_dbg(dev->dev, "failed to copy data from userland\n");
545 546 547
			rets = -EFAULT;
			goto out;
		}
548

549
		rets = mei_ioctl_connect_client(file, &connect_data);
550 551
		if (rets)
			goto out;
552

553
		/* if all is ok, copying the data back to user. */
554
		if (copy_to_user((char __user *)data, &connect_data,
555
				sizeof(struct mei_connect_client_data))) {
556
			dev_dbg(dev->dev, "failed to copy data to userland\n");
557 558 559 560 561
			rets = -EFAULT;
			goto out;
		}

		break;
562

563
	default:
564
		dev_err(dev->dev, ": unsupported ioctl %d.\n", cmd);
565
		rets = -ENOIOCTLCMD;
566 567 568 569 570 571 572 573 574 575 576 577 578 579
	}

out:
	mutex_unlock(&dev->device_lock);
	return rets;
}

/**
 * mei_compat_ioctl - the compat IOCTL function
 *
 * @file: pointer to file structure
 * @cmd: ioctl command
 * @data: pointer to mei message structure
 *
580
 * Return: 0 on success , <0 on error
581 582 583
 */
#ifdef CONFIG_COMPAT
static long mei_compat_ioctl(struct file *file,
584
			unsigned int cmd, unsigned long data)
585 586 587 588 589 590 591 592 593 594 595 596
{
	return mei_ioctl(file, cmd, (unsigned long)compat_ptr(data));
}
#endif


/**
 * mei_poll - the poll function
 *
 * @file: pointer to file structure
 * @wait: pointer to poll_table structure
 *
597
 * Return: poll mask
598 599 600 601 602 603 604 605
 */
static unsigned int mei_poll(struct file *file, poll_table *wait)
{
	struct mei_cl *cl = file->private_data;
	struct mei_device *dev;
	unsigned int mask = 0;

	if (WARN_ON(!cl || !cl->dev))
606
		return POLLERR;
607 608 609 610 611

	dev = cl->dev;

	mutex_lock(&dev->device_lock);

612 613
	if (!mei_cl_is_connected(cl)) {
		mask = POLLERR;
614 615 616 617
		goto out;
	}

	mutex_unlock(&dev->device_lock);
618 619 620 621 622


	if (cl == &dev->iamthif_cl)
		return mei_amthif_poll(dev, file, wait);

623
	poll_wait(file, &cl->tx_wait, wait);
624

625
	mutex_lock(&dev->device_lock);
626 627 628 629 630 631

	if (!mei_cl_is_connected(cl)) {
		mask = POLLERR;
		goto out;
	}

632
	mask |= (POLLIN | POLLRDNORM);
633 634 635 636 637 638

out:
	mutex_unlock(&dev->device_lock);
	return mask;
}

639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676
/**
 * fw_status_show - mei device attribute show method
 *
 * @device: device pointer
 * @attr: attribute pointer
 * @buf:  char out buffer
 *
 * Return: number of the bytes printed into buf or error
 */
static ssize_t fw_status_show(struct device *device,
		struct device_attribute *attr, char *buf)
{
	struct mei_device *dev = dev_get_drvdata(device);
	struct mei_fw_status fw_status;
	int err, i;
	ssize_t cnt = 0;

	mutex_lock(&dev->device_lock);
	err = mei_fw_status(dev, &fw_status);
	mutex_unlock(&dev->device_lock);
	if (err) {
		dev_err(device, "read fw_status error = %d\n", err);
		return err;
	}

	for (i = 0; i < fw_status.count; i++)
		cnt += scnprintf(buf + cnt, PAGE_SIZE - cnt, "%08X\n",
				fw_status.status[i]);
	return cnt;
}
static DEVICE_ATTR_RO(fw_status);

static struct attribute *mei_attrs[] = {
	&dev_attr_fw_status.attr,
	NULL
};
ATTRIBUTE_GROUPS(mei);

677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693
/*
 * file operations structure will be used for mei char device.
 */
static const struct file_operations mei_fops = {
	.owner = THIS_MODULE,
	.read = mei_read,
	.unlocked_ioctl = mei_ioctl,
#ifdef CONFIG_COMPAT
	.compat_ioctl = mei_compat_ioctl,
#endif
	.open = mei_open,
	.release = mei_release,
	.write = mei_write,
	.poll = mei_poll,
	.llseek = no_llseek
};

694 695 696 697 698 699 700 701 702 703 704
static struct class *mei_class;
static dev_t mei_devt;
#define MEI_MAX_DEVS  MINORMASK
static DEFINE_MUTEX(mei_minor_lock);
static DEFINE_IDR(mei_idr);

/**
 * mei_minor_get - obtain next free device minor number
 *
 * @dev:  device pointer
 *
705
 * Return: allocated minor, or -ENOSPC if no free minor left
706
 */
707 708 709 710 711 712 713 714 715
static int mei_minor_get(struct mei_device *dev)
{
	int ret;

	mutex_lock(&mei_minor_lock);
	ret = idr_alloc(&mei_idr, dev, 0, MEI_MAX_DEVS, GFP_KERNEL);
	if (ret >= 0)
		dev->minor = ret;
	else if (ret == -ENOSPC)
716
		dev_err(dev->dev, "too many mei devices\n");
717

718 719 720
	mutex_unlock(&mei_minor_lock);
	return ret;
}
T
Tomas Winkler 已提交
721

722 723 724 725 726 727
/**
 * mei_minor_free - mark device minor number as free
 *
 * @dev:  device pointer
 */
static void mei_minor_free(struct mei_device *dev)
728
{
729 730 731 732 733 734 735 736 737 738 739 740
	mutex_lock(&mei_minor_lock);
	idr_remove(&mei_idr, dev->minor);
	mutex_unlock(&mei_minor_lock);
}

int mei_register(struct mei_device *dev, struct device *parent)
{
	struct device *clsdev; /* class device */
	int ret, devno;

	ret = mei_minor_get(dev);
	if (ret < 0)
T
Tomas Winkler 已提交
741 742
		return ret;

743 744 745 746 747 748 749 750 751 752 753 754 755
	/* Fill in the data structures */
	devno = MKDEV(MAJOR(mei_devt), dev->minor);
	cdev_init(&dev->cdev, &mei_fops);
	dev->cdev.owner = mei_fops.owner;

	/* Add the device */
	ret = cdev_add(&dev->cdev, devno, 1);
	if (ret) {
		dev_err(parent, "unable to add device %d:%d\n",
			MAJOR(mei_devt), dev->minor);
		goto err_dev_add;
	}

756 757 758
	clsdev = device_create_with_groups(mei_class, parent, devno,
					   dev, mei_groups,
					   "mei%d", dev->minor);
759 760 761 762 763 764 765 766 767 768 769 770 771

	if (IS_ERR(clsdev)) {
		dev_err(parent, "unable to create device %d:%d\n",
			MAJOR(mei_devt), dev->minor);
		ret = PTR_ERR(clsdev);
		goto err_dev_create;
	}

	ret = mei_dbgfs_register(dev, dev_name(clsdev));
	if (ret) {
		dev_err(clsdev, "cannot register debugfs ret = %d\n", ret);
		goto err_dev_dbgfs;
	}
T
Tomas Winkler 已提交
772 773

	return 0;
774 775 776 777 778 779 780 781

err_dev_dbgfs:
	device_destroy(mei_class, devno);
err_dev_create:
	cdev_del(&dev->cdev);
err_dev_add:
	mei_minor_free(dev);
	return ret;
782
}
783
EXPORT_SYMBOL_GPL(mei_register);
784

T
Tomas Winkler 已提交
785
void mei_deregister(struct mei_device *dev)
786
{
787 788 789 790 791
	int devno;

	devno = dev->cdev.dev;
	cdev_del(&dev->cdev);

T
Tomas Winkler 已提交
792
	mei_dbgfs_deregister(dev);
793 794 795 796

	device_destroy(mei_class, devno);

	mei_minor_free(dev);
797
}
798
EXPORT_SYMBOL_GPL(mei_deregister);
799

800 801
static int __init mei_init(void)
{
802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830
	int ret;

	mei_class = class_create(THIS_MODULE, "mei");
	if (IS_ERR(mei_class)) {
		pr_err("couldn't create class\n");
		ret = PTR_ERR(mei_class);
		goto err;
	}

	ret = alloc_chrdev_region(&mei_devt, 0, MEI_MAX_DEVS, "mei");
	if (ret < 0) {
		pr_err("unable to allocate char dev region\n");
		goto err_class;
	}

	ret = mei_cl_bus_init();
	if (ret < 0) {
		pr_err("unable to initialize bus\n");
		goto err_chrdev;
	}

	return 0;

err_chrdev:
	unregister_chrdev_region(mei_devt, MEI_MAX_DEVS);
err_class:
	class_destroy(mei_class);
err:
	return ret;
831 832 833 834
}

static void __exit mei_exit(void)
{
835 836
	unregister_chrdev_region(mei_devt, MEI_MAX_DEVS);
	class_destroy(mei_class);
837 838 839 840 841 842
	mei_cl_bus_exit();
}

module_init(mei_init);
module_exit(mei_exit);

843 844
MODULE_AUTHOR("Intel Corporation");
MODULE_DESCRIPTION("Intel(R) Management Engine Interface");
845
MODULE_LICENSE("GPL v2");
846