main.c 18.2 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
#include <linux/fs.h>
#include <linux/errno.h>
#include <linux/types.h>
#include <linux/fcntl.h>
#include <linux/poll.h>
#include <linux/init.h>
#include <linux/ioctl.h>
#include <linux/cdev.h>
29
#include <linux/sched/signal.h>
30 31 32 33 34
#include <linux/uuid.h>
#include <linux/compat.h>
#include <linux/jiffies.h>
#include <linux/interrupt.h>

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

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

/**
 * mei_open - the open function
 *
 * @inode: pointer to inode structure
 * @file: pointer to file structure
45
 *
46
 * Return: 0 on success, <0 on error
47 48 49 50
 */
static int mei_open(struct inode *inode, struct file *file)
{
	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);
69 70
	if (IS_ERR(cl)) {
		err = PTR_ERR(cl);
71
		goto err_unlock;
72
	}
73

74
	cl->fp = file;
75
	file->private_data = cl;
76

77 78
	mutex_unlock(&dev->device_lock);

79
	return nonseekable_open(inode, file);
80

81
err_unlock:
82 83 84 85 86 87 88 89 90 91
	mutex_unlock(&dev->device_lock);
	return err;
}

/**
 * mei_release - the release function
 *
 * @inode: pointer to inode structure
 * @file: pointer to file structure
 *
92
 * Return: 0 on success, <0 on error
93 94 95 96 97
 */
static int mei_release(struct inode *inode, struct file *file)
{
	struct mei_cl *cl = file->private_data;
	struct mei_device *dev;
98
	int rets;
99 100 101 102 103 104 105

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

	dev = cl->dev;

	mutex_lock(&dev->device_lock);
106

107 108
	rets = mei_cl_disconnect(cl);

T
Tomas Winkler 已提交
109
	mei_cl_flush_queues(cl, file);
110
	cl_dbg(dev, cl, "removing\n");
111

T
Tomas Winkler 已提交
112
	mei_cl_unlink(cl);
113 114

	file->private_data = NULL;
115

116
	kfree(cl);
117

118 119 120 121 122 123 124 125 126 127 128 129 130
	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
 *
131
 * Return: >=0 data length on success , <0 on error
132 133
 */
static ssize_t mei_read(struct file *file, char __user *ubuf,
134
			size_t length, loff_t *offset)
135 136 137
{
	struct mei_cl *cl = file->private_data;
	struct mei_device *dev;
T
Tomas Winkler 已提交
138
	struct mei_cl_cb *cb = NULL;
139
	bool nonblock = !!(file->f_flags & O_NONBLOCK);
140 141 142 143 144 145 146
	int rets;

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

	dev = cl->dev;

147

148
	mutex_lock(&dev->device_lock);
149
	if (dev->dev_state != MEI_DEV_ENABLED) {
150 151 152 153
		rets = -ENODEV;
		goto out;
	}

154 155 156 157 158
	if (length == 0) {
		rets = 0;
		goto out;
	}

159 160 161 162 163
	if (ubuf == NULL) {
		rets = -EMSGSIZE;
		goto out;
	}

T
Tomas Winkler 已提交
164
	cb = mei_cl_read_cb(cl, file);
165 166 167 168
	if (cb)
		goto copy_buffer;

	if (*offset > 0)
169 170
		*offset = 0;

171 172 173
	rets = mei_cl_read_start(cl, length, file);
	if (rets && rets != -EBUSY) {
		cl_dbg(dev, cl, "mei start read failure status = %d\n", rets);
174 175 176
		goto out;
	}

177 178 179 180 181
	if (nonblock) {
		rets = -EAGAIN;
		goto out;
	}

182 183 184 185 186 187 188 189 190
	mutex_unlock(&dev->device_lock);
	if (wait_event_interruptible(cl->rx_wait,
				     !list_empty(&cl->rd_completed) ||
				     !mei_cl_is_connected(cl))) {
		if (signal_pending(current))
			return -EINTR;
		return -ERESTARTSYS;
	}
	mutex_lock(&dev->device_lock);
191

192 193 194 195
	if (!mei_cl_is_connected(cl)) {
		rets = -ENODEV;
		goto out;
	}
196

197 198 199 200 201
	cb = mei_cl_read_cb(cl, file);
	if (!cb) {
		rets = 0;
		goto out;
	}
202

203
copy_buffer:
204 205 206
	/* now copy the data to user space */
	if (cb->status) {
		rets = cb->status;
207
		cl_dbg(dev, cl, "read operation failed %d\n", rets);
208 209 210
		goto free;
	}

211
	cl_dbg(dev, cl, "buf.size = %zu buf.idx = %zu offset = %lld\n",
212 213 214
	       cb->buf.size, cb->buf_idx, *offset);
	if (*offset >= cb->buf_idx) {
		rets = 0;
215 216 217
		goto free;
	}

218 219 220
	/* length is being truncated to PAGE_SIZE,
	 * however buf_idx may point beyond that */
	length = min_t(size_t, length, cb->buf_idx - *offset);
221

222
	if (copy_to_user(ubuf, cb->buf.data + *offset, length)) {
223
		dev_dbg(dev->dev, "failed to copy data to userland\n");
224 225 226 227 228 229
		rets = -EFAULT;
		goto free;
	}

	rets = length;
	*offset += length;
230 231
	/* not all data was read, keep the cb */
	if (*offset < cb->buf_idx)
232 233 234
		goto out;

free:
235
	mei_io_cb_free(cb);
236
	*offset = 0;
237

238
out:
239
	cl_dbg(dev, cl, "end mei read rets = %d\n", rets);
240 241 242 243 244 245 246 247 248 249 250
	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
 *
251
 * Return: >=0 data length on success , <0 on error
252 253
 */
static ssize_t mei_write(struct file *file, const char __user *ubuf,
254
			 size_t length, loff_t *offset)
255 256
{
	struct mei_cl *cl = file->private_data;
257
	struct mei_cl_cb *cb;
258 259 260 261 262 263 264 265 266 267
	struct mei_device *dev;
	int rets;

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

	dev = cl->dev;

	mutex_lock(&dev->device_lock);

268
	if (dev->dev_state != MEI_DEV_ENABLED) {
269
		rets = -ENODEV;
T
Tomas Winkler 已提交
270
		goto out;
271 272
	}

273 274 275
	if (!mei_cl_is_connected(cl)) {
		cl_err(dev, cl, "is not connected");
		rets = -ENODEV;
T
Tomas Winkler 已提交
276
		goto out;
277
	}
278

279 280
	if (!mei_me_cl_is_active(cl->me_cl)) {
		rets = -ENOTTY;
281 282 283
		goto out;
	}

284
	if (length > mei_cl_mtu(cl)) {
285
		rets = -EFBIG;
T
Tomas Winkler 已提交
286
		goto out;
287 288
	}

289 290
	if (length == 0) {
		rets = 0;
T
Tomas Winkler 已提交
291
		goto out;
292
	}
293

T
Tomas Winkler 已提交
294
	*offset = 0;
295 296
	cb = mei_cl_alloc_cb(cl, length, MEI_FOP_WRITE, file);
	if (!cb) {
297
		rets = -ENOMEM;
T
Tomas Winkler 已提交
298
		goto out;
299 300
	}

301
	rets = copy_from_user(cb->buf.data, ubuf, length);
302
	if (rets) {
303
		dev_dbg(dev->dev, "failed to copy data from userland\n");
304
		rets = -EFAULT;
305
		mei_io_cb_free(cb);
T
Tomas Winkler 已提交
306
		goto out;
307
	}
308

309
	rets = mei_cl_write(cl, cb);
310
out:
311 312 313 314
	mutex_unlock(&dev->device_lock);
	return rets;
}

315 316 317 318
/**
 * mei_ioctl_connect_client - the connect to fw client IOCTL function
 *
 * @file: private data of the file object
319
 * @data: IOCTL connect data, input and output parameters
320 321 322
 *
 * Locking: called under "dev->device_lock" lock
 *
323
 * Return: 0 on success, <0 on failure.
324 325 326 327 328 329
 */
static int mei_ioctl_connect_client(struct file *file,
			struct mei_connect_client_data *data)
{
	struct mei_device *dev;
	struct mei_client *client;
330
	struct mei_me_client *me_cl;
331 332 333 334 335 336
	struct mei_cl *cl;
	int rets;

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

337 338
	if (dev->dev_state != MEI_DEV_ENABLED)
		return -ENODEV;
339 340

	if (cl->state != MEI_FILE_INITIALIZING &&
341 342
	    cl->state != MEI_FILE_DISCONNECTED)
		return  -EBUSY;
343 344

	/* find ME client we're trying to connect to */
345
	me_cl = mei_me_cl_by_uuid(dev, &data->in_client_uuid);
346
	if (!me_cl) {
347
		dev_dbg(dev->dev, "Cannot connect to FW Client UUID = %pUl\n",
348
			&data->in_client_uuid);
349 350 351 352 353 354 355 356 357 358 359 360 361
		rets = -ENOTTY;
		goto end;
	}

	if (me_cl->props.fixed_address) {
		bool forbidden = dev->override_fixed_address ?
			 !dev->allow_fixed_address : !dev->hbm_f_fa_supported;
		if (forbidden) {
			dev_dbg(dev->dev, "Connection forbidden to FW Client UUID = %pUl\n",
				&data->in_client_uuid);
			rets = -ENOTTY;
			goto end;
		}
362 363
	}

364
	dev_dbg(dev->dev, "Connect to FW Client ID = %d\n",
365
			me_cl->client_id);
366
	dev_dbg(dev->dev, "FW Client - Protocol Version = %d\n",
367
			me_cl->props.protocol_version);
368
	dev_dbg(dev->dev, "FW Client - Max Msg Len = %d\n",
369
			me_cl->props.max_msg_length);
370 371 372

	/* prepare the output buffer */
	client = &data->out_client_properties;
373 374
	client->max_msg_length = me_cl->props.max_msg_length;
	client->protocol_version = me_cl->props.protocol_version;
375
	dev_dbg(dev->dev, "Can connect?\n");
376

377
	rets = mei_cl_connect(cl, me_cl, file);
378 379

end:
380
	mei_me_cl_put(me_cl);
381 382 383
	return rets;
}

384 385 386 387 388 389 390 391 392
/**
 * mei_ioctl_client_notify_request -
 *     propagate event notification request to client
 *
 * @file: pointer to file structure
 * @request: 0 - disable, 1 - enable
 *
 * Return: 0 on success , <0 on error
 */
393
static int mei_ioctl_client_notify_request(const struct file *file, u32 request)
394 395 396
{
	struct mei_cl *cl = file->private_data;

397 398 399 400 401
	if (request != MEI_HBM_NOTIFICATION_START &&
	    request != MEI_HBM_NOTIFICATION_STOP)
		return -EINVAL;

	return mei_cl_notify_request(cl, file, (u8)request);
402 403 404 405 406 407 408 409 410 411
}

/**
 * mei_ioctl_client_notify_get -  wait for notification request
 *
 * @file: pointer to file structure
 * @notify_get: 0 - disable, 1 - enable
 *
 * Return: 0 on success , <0 on error
 */
412
static int mei_ioctl_client_notify_get(const struct file *file, u32 *notify_get)
413 414 415 416 417 418 419 420 421 422 423 424 425 426
{
	struct mei_cl *cl = file->private_data;
	bool notify_ev;
	bool block = (file->f_flags & O_NONBLOCK) == 0;
	int rets;

	rets = mei_cl_notify_get(cl, block, &notify_ev);
	if (rets)
		return rets;

	*notify_get = notify_ev ? 1 : 0;
	return 0;
}

427 428 429 430 431 432 433
/**
 * mei_ioctl - the IOCTL function
 *
 * @file: pointer to file structure
 * @cmd: ioctl command
 * @data: pointer to mei message structure
 *
434
 * Return: 0 on success , <0 on error
435 436 437 438 439
 */
static long mei_ioctl(struct file *file, unsigned int cmd, unsigned long data)
{
	struct mei_device *dev;
	struct mei_cl *cl = file->private_data;
440
	struct mei_connect_client_data connect_data;
441
	u32 notify_get, notify_req;
442 443 444 445 446 447 448 449
	int rets;


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

	dev = cl->dev;

450
	dev_dbg(dev->dev, "IOCTL cmd = 0x%x", cmd);
451 452

	mutex_lock(&dev->device_lock);
453
	if (dev->dev_state != MEI_DEV_ENABLED) {
454 455 456 457
		rets = -ENODEV;
		goto out;
	}

458 459
	switch (cmd) {
	case IOCTL_MEI_CONNECT_CLIENT:
460
		dev_dbg(dev->dev, ": IOCTL_MEI_CONNECT_CLIENT.\n");
461
		if (copy_from_user(&connect_data, (char __user *)data,
462
				sizeof(struct mei_connect_client_data))) {
463
			dev_dbg(dev->dev, "failed to copy data from userland\n");
464 465 466
			rets = -EFAULT;
			goto out;
		}
467

468
		rets = mei_ioctl_connect_client(file, &connect_data);
469 470
		if (rets)
			goto out;
471

472
		/* if all is ok, copying the data back to user. */
473
		if (copy_to_user((char __user *)data, &connect_data,
474
				sizeof(struct mei_connect_client_data))) {
475
			dev_dbg(dev->dev, "failed to copy data to userland\n");
476 477 478 479 480
			rets = -EFAULT;
			goto out;
		}

		break;
481

482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508
	case IOCTL_MEI_NOTIFY_SET:
		dev_dbg(dev->dev, ": IOCTL_MEI_NOTIFY_SET.\n");
		if (copy_from_user(&notify_req,
				   (char __user *)data, sizeof(notify_req))) {
			dev_dbg(dev->dev, "failed to copy data from userland\n");
			rets = -EFAULT;
			goto out;
		}
		rets = mei_ioctl_client_notify_request(file, notify_req);
		break;

	case IOCTL_MEI_NOTIFY_GET:
		dev_dbg(dev->dev, ": IOCTL_MEI_NOTIFY_GET.\n");
		rets = mei_ioctl_client_notify_get(file, &notify_get);
		if (rets)
			goto out;

		dev_dbg(dev->dev, "copy connect data to user\n");
		if (copy_to_user((char __user *)data,
				&notify_get, sizeof(notify_get))) {
			dev_dbg(dev->dev, "failed to copy data to userland\n");
			rets = -EFAULT;
			goto out;

		}
		break;

509
	default:
510
		dev_err(dev->dev, ": unsupported ioctl %d.\n", cmd);
511
		rets = -ENOIOCTLCMD;
512 513 514 515 516 517 518 519 520 521 522 523 524 525
	}

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
 *
526
 * Return: 0 on success , <0 on error
527 528 529
 */
#ifdef CONFIG_COMPAT
static long mei_compat_ioctl(struct file *file,
530
			unsigned int cmd, unsigned long data)
531 532 533 534 535 536 537 538 539 540 541 542
{
	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
 *
543
 * Return: poll mask
544 545 546
 */
static unsigned int mei_poll(struct file *file, poll_table *wait)
{
T
Tomas Winkler 已提交
547
	unsigned long req_events = poll_requested_events(wait);
548 549 550
	struct mei_cl *cl = file->private_data;
	struct mei_device *dev;
	unsigned int mask = 0;
551
	bool notify_en;
552 553

	if (WARN_ON(!cl || !cl->dev))
554
		return POLLERR;
555 556 557 558 559

	dev = cl->dev;

	mutex_lock(&dev->device_lock);

560
	notify_en = cl->notify_en && (req_events & POLLPRI);
561 562 563

	if (dev->dev_state != MEI_DEV_ENABLED ||
	    !mei_cl_is_connected(cl)) {
564
		mask = POLLERR;
565 566 567
		goto out;
	}

568 569 570 571 572
	if (notify_en) {
		poll_wait(file, &cl->ev_wait, wait);
		if (cl->notify_ev)
			mask |= POLLPRI;
	}
573

T
Tomas Winkler 已提交
574 575 576 577 578 579
	if (req_events & (POLLIN | POLLRDNORM)) {
		poll_wait(file, &cl->rx_wait, wait);

		if (!list_empty(&cl->rd_completed))
			mask |= POLLIN | POLLRDNORM;
		else
580
			mei_cl_read_start(cl, mei_cl_mtu(cl), file);
T
Tomas Winkler 已提交
581
	}
582 583 584 585 586 587

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

588 589 590 591 592 593 594
/**
 * mei_fasync - asynchronous io support
 *
 * @fd: file descriptor
 * @file: pointer to file structure
 * @band: band bitmap
 *
595 596 597
 * Return: negative on error,
 *         0 if it did no changes,
 *         and positive a process was added or deleted
598 599 600 601 602 603 604
 */
static int mei_fasync(int fd, struct file *file, int band)
{

	struct mei_cl *cl = file->private_data;

	if (!mei_cl_is_connected(cl))
605
		return -ENODEV;
606 607 608 609

	return fasync_helper(fd, file, band, &cl->ev_async);
}

610
/**
611
 * fw_status_show - mei device fw_status attribute show method
612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641
 *
 * @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);

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 677 678 679 680
/**
 * hbm_ver_show - display HBM protocol version negotiated with FW
 *
 * @device: device pointer
 * @attr: attribute pointer
 * @buf:  char out buffer
 *
 * Return: number of the bytes printed into buf or error
 */
static ssize_t hbm_ver_show(struct device *device,
			    struct device_attribute *attr, char *buf)
{
	struct mei_device *dev = dev_get_drvdata(device);
	struct hbm_version ver;

	mutex_lock(&dev->device_lock);
	ver = dev->version;
	mutex_unlock(&dev->device_lock);

	return sprintf(buf, "%u.%u\n", ver.major_version, ver.minor_version);
}
static DEVICE_ATTR_RO(hbm_ver);

/**
 * hbm_ver_drv_show - display HBM protocol version advertised by driver
 *
 * @device: device pointer
 * @attr: attribute pointer
 * @buf:  char out buffer
 *
 * Return: number of the bytes printed into buf or error
 */
static ssize_t hbm_ver_drv_show(struct device *device,
				struct device_attribute *attr, char *buf)
{
	return sprintf(buf, "%u.%u\n", HBM_MAJOR_VERSION, HBM_MINOR_VERSION);
}
static DEVICE_ATTR_RO(hbm_ver_drv);

681 682
static struct attribute *mei_attrs[] = {
	&dev_attr_fw_status.attr,
683 684
	&dev_attr_hbm_ver.attr,
	&dev_attr_hbm_ver_drv.attr,
685 686 687 688
	NULL
};
ATTRIBUTE_GROUPS(mei);

689 690 691 692 693 694 695 696 697 698 699 700 701 702
/*
 * 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,
703
	.fasync = mei_fasync,
704 705 706
	.llseek = no_llseek
};

707 708 709 710 711 712 713 714 715 716 717
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
 *
718
 * Return: allocated minor, or -ENOSPC if no free minor left
719
 */
720 721 722 723 724 725 726 727 728
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)
729
		dev_err(dev->dev, "too many mei devices\n");
730

731 732 733
	mutex_unlock(&mei_minor_lock);
	return ret;
}
T
Tomas Winkler 已提交
734

735 736 737 738 739 740
/**
 * mei_minor_free - mark device minor number as free
 *
 * @dev:  device pointer
 */
static void mei_minor_free(struct mei_device *dev)
741
{
742 743 744 745 746 747 748 749 750 751 752 753
	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 已提交
754 755
		return ret;

756 757 758
	/* Fill in the data structures */
	devno = MKDEV(MAJOR(mei_devt), dev->minor);
	cdev_init(&dev->cdev, &mei_fops);
759
	dev->cdev.owner = parent->driver->owner;
760 761 762 763 764 765 766 767 768

	/* 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;
	}

769 770 771
	clsdev = device_create_with_groups(mei_class, parent, devno,
					   dev, mei_groups,
					   "mei%d", dev->minor);
772 773 774 775 776 777 778 779 780 781 782 783 784

	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 已提交
785 786

	return 0;
787 788 789 790 791 792 793 794

err_dev_dbgfs:
	device_destroy(mei_class, devno);
err_dev_create:
	cdev_del(&dev->cdev);
err_dev_add:
	mei_minor_free(dev);
	return ret;
795
}
796
EXPORT_SYMBOL_GPL(mei_register);
797

T
Tomas Winkler 已提交
798
void mei_deregister(struct mei_device *dev)
799
{
800 801 802 803 804
	int devno;

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

T
Tomas Winkler 已提交
805
	mei_dbgfs_deregister(dev);
806 807 808 809

	device_destroy(mei_class, devno);

	mei_minor_free(dev);
810
}
811
EXPORT_SYMBOL_GPL(mei_deregister);
812

813 814
static int __init mei_init(void)
{
815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843
	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;
844 845 846 847
}

static void __exit mei_exit(void)
{
848 849
	unregister_chrdev_region(mei_devt, MEI_MAX_DEVS);
	class_destroy(mei_class);
850 851 852 853 854 855
	mei_cl_bus_exit();
}

module_init(mei_init);
module_exit(mei_exit);

856 857
MODULE_AUTHOR("Intel Corporation");
MODULE_DESCRIPTION("Intel(R) Management Engine Interface");
858
MODULE_LICENSE("GPL v2");
859