mei: revamp client connection
[linux-2.6-block.git] / drivers / misc / mei / main.c
CommitLineData
ab841160
OW
1/*
2 *
3 * Intel Management Engine Interface (Intel MEI) Linux driver
733ba91c 4 * Copyright (c) 2003-2012, Intel Corporation.
ab841160
OW
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 */
ab841160
OW
16#include <linux/module.h>
17#include <linux/moduleparam.h>
18#include <linux/kernel.h>
19#include <linux/device.h>
1f180359 20#include <linux/slab.h>
ab841160
OW
21#include <linux/fs.h>
22#include <linux/errno.h>
23#include <linux/types.h>
24#include <linux/fcntl.h>
ab841160
OW
25#include <linux/poll.h>
26#include <linux/init.h>
27#include <linux/ioctl.h>
28#include <linux/cdev.h>
ab841160
OW
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
4f3afe1d 35#include <linux/mei.h>
47a73801
TW
36
37#include "mei_dev.h"
90e0b5f1 38#include "client.h"
ab841160 39
ab841160
OW
40/**
41 * mei_open - the open function
42 *
43 * @inode: pointer to inode structure
44 * @file: pointer to file structure
83ce0741 45 *
a8605ea2 46 * Return: 0 on success, <0 on error
ab841160
OW
47 */
48static int mei_open(struct inode *inode, struct file *file)
49{
ab841160 50 struct mei_device *dev;
f3d8e878 51 struct mei_cl *cl;
2703d4b2 52
6f37aca8 53 int err;
ab841160 54
f3d8e878 55 dev = container_of(inode->i_cdev, struct mei_device, cdev);
5b881e3c 56 if (!dev)
e036cc57 57 return -ENODEV;
ab841160
OW
58
59 mutex_lock(&dev->device_lock);
e036cc57 60
b210d750 61 if (dev->dev_state != MEI_DEV_ENABLED) {
2bf94cab 62 dev_dbg(dev->dev, "dev_state != MEI_ENABLED dev_state = %s\n",
b210d750 63 mei_dev_state_str(dev->dev_state));
03b8d341 64 err = -ENODEV;
e036cc57 65 goto err_unlock;
1b812947 66 }
ab841160 67
03b8d341
TW
68 cl = mei_cl_alloc_linked(dev, MEI_HOST_CLIENT_ID_ANY);
69 if (IS_ERR(cl)) {
70 err = PTR_ERR(cl);
e036cc57 71 goto err_unlock;
03b8d341 72 }
ab841160
OW
73
74 file->private_data = cl;
e036cc57 75
ab841160
OW
76 mutex_unlock(&dev->device_lock);
77
5b881e3c 78 return nonseekable_open(inode, file);
ab841160 79
e036cc57 80err_unlock:
ab841160 81 mutex_unlock(&dev->device_lock);
ab841160
OW
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 *
a8605ea2 91 * Return: 0 on success, <0 on error
ab841160
OW
92 */
93static int mei_release(struct inode *inode, struct file *file)
94{
95 struct mei_cl *cl = file->private_data;
ab841160 96 struct mei_device *dev;
3c666182 97 int rets;
ab841160
OW
98
99 if (WARN_ON(!cl || !cl->dev))
100 return -ENODEV;
101
102 dev = cl->dev;
103
104 mutex_lock(&dev->device_lock);
a562d5c2
TW
105 if (cl == &dev->iamthif_cl) {
106 rets = mei_amthif_release(dev, file);
107 goto out;
108 }
3c666182
TW
109 rets = mei_cl_disconnect(cl);
110
a9bed610 111 mei_cl_flush_queues(cl, file);
46922186 112 cl_dbg(dev, cl, "removing\n");
a562d5c2 113
90e0b5f1 114 mei_cl_unlink(cl);
a562d5c2 115
a562d5c2 116 file->private_data = NULL;
ab841160 117
a562d5c2
TW
118 kfree(cl);
119out:
ab841160
OW
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 *
a8605ea2 133 * Return: >=0 data length on success , <0 on error
ab841160
OW
134 */
135static ssize_t mei_read(struct file *file, char __user *ubuf,
441ab50f 136 size_t length, loff_t *offset)
ab841160
OW
137{
138 struct mei_cl *cl = file->private_data;
ab841160 139 struct mei_device *dev;
a9bed610 140 struct mei_cl_cb *cb = NULL;
ab841160
OW
141 int rets;
142 int err;
143
144
145 if (WARN_ON(!cl || !cl->dev))
146 return -ENODEV;
147
148 dev = cl->dev;
149
dd5de1f1 150
ab841160 151 mutex_lock(&dev->device_lock);
b210d750 152 if (dev->dev_state != MEI_DEV_ENABLED) {
ab841160
OW
153 rets = -ENODEV;
154 goto out;
155 }
156
dd5de1f1
TW
157 if (length == 0) {
158 rets = 0;
159 goto out;
160 }
161
ab841160 162 if (cl == &dev->iamthif_cl) {
19838fb8 163 rets = mei_amthif_read(dev, file, ubuf, length, offset);
ab841160
OW
164 goto out;
165 }
166
a9bed610 167 cb = mei_cl_read_cb(cl, file);
3d33ff24 168 if (cb) {
139aacf7
TW
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) {
ab841160 181 *offset = 0;
ab841160
OW
182 }
183
bca67d68 184 err = mei_cl_read_start(cl, length, file);
ab841160 185 if (err && err != -EBUSY) {
2bf94cab 186 dev_dbg(dev->dev,
ab841160
OW
187 "mei start read failure with status = %d\n", err);
188 rets = err;
189 goto out;
190 }
191
a9bed610 192 if (list_empty(&cl->rd_completed) && !waitqueue_active(&cl->rx_wait)) {
ab841160
OW
193 if (file->f_flags & O_NONBLOCK) {
194 rets = -EAGAIN;
195 goto out;
196 }
197
198 mutex_unlock(&dev->device_lock);
199
200 if (wait_event_interruptible(cl->rx_wait,
a9bed610 201 (!list_empty(&cl->rd_completed)) ||
6a84d63d 202 (!mei_cl_is_connected(cl)))) {
e2b31644 203
ab841160
OW
204 if (signal_pending(current))
205 return -EINTR;
206 return -ERESTARTSYS;
207 }
208
209 mutex_lock(&dev->device_lock);
6a84d63d 210 if (!mei_cl_is_connected(cl)) {
ab841160
OW
211 rets = -EBUSY;
212 goto out;
213 }
214 }
215
a9bed610 216 cb = mei_cl_read_cb(cl, file);
ab841160 217 if (!cb) {
ab841160
OW
218 rets = 0;
219 goto out;
220 }
3d33ff24 221
ab841160 222copy_buffer:
3d33ff24
TW
223 /* now copy the data to user space */
224 if (cb->status) {
225 rets = cb->status;
226 dev_dbg(dev->dev, "read operation failed %d\n", rets);
227 goto free;
228 }
229
2bf94cab 230 dev_dbg(dev->dev, "buf.size = %d buf.idx= %ld\n",
5db7514d 231 cb->buf.size, cb->buf_idx);
ebb108ef 232 if (length == 0 || ubuf == NULL || *offset > cb->buf_idx) {
ab841160
OW
233 rets = -EMSGSIZE;
234 goto free;
235 }
236
ebb108ef
TW
237 /* length is being truncated to PAGE_SIZE,
238 * however buf_idx may point beyond that */
239 length = min_t(size_t, length, cb->buf_idx - *offset);
ab841160 240
5db7514d 241 if (copy_to_user(ubuf, cb->buf.data + *offset, length)) {
2bf94cab 242 dev_dbg(dev->dev, "failed to copy data to userland\n");
ab841160
OW
243 rets = -EFAULT;
244 goto free;
245 }
246
247 rets = length;
248 *offset += length;
ebb108ef 249 if ((unsigned long)*offset < cb->buf_idx)
ab841160
OW
250 goto out;
251
252free:
601a1efa 253 mei_io_cb_free(cb);
928fa666 254
ab841160 255out:
2bf94cab 256 dev_dbg(dev->dev, "end mei read rets= %d\n", rets);
ab841160
OW
257 mutex_unlock(&dev->device_lock);
258 return rets;
259}
ab841160
OW
260/**
261 * mei_write - the write function.
262 *
263 * @file: pointer to file structure
264 * @ubuf: pointer to user buffer
265 * @length: buffer length
266 * @offset: data offset in buffer
267 *
a8605ea2 268 * Return: >=0 data length on success , <0 on error
ab841160
OW
269 */
270static ssize_t mei_write(struct file *file, const char __user *ubuf,
441ab50f 271 size_t length, loff_t *offset)
ab841160
OW
272{
273 struct mei_cl *cl = file->private_data;
79563db9 274 struct mei_me_client *me_cl = NULL;
ab841160 275 struct mei_cl_cb *write_cb = NULL;
ab841160
OW
276 struct mei_device *dev;
277 unsigned long timeout = 0;
278 int rets;
ab841160
OW
279
280 if (WARN_ON(!cl || !cl->dev))
281 return -ENODEV;
282
283 dev = cl->dev;
284
285 mutex_lock(&dev->device_lock);
286
b210d750 287 if (dev->dev_state != MEI_DEV_ENABLED) {
75f0ee15 288 rets = -ENODEV;
4234a6de 289 goto out;
ab841160
OW
290 }
291
d880f329 292 me_cl = mei_me_cl_by_uuid_id(dev, &cl->cl_uuid, cl->me_client_id);
d320832f 293 if (!me_cl) {
7ca96aa2 294 rets = -ENOTTY;
4234a6de 295 goto out;
75f0ee15 296 }
dd5de1f1
TW
297
298 if (length == 0) {
299 rets = 0;
300 goto out;
301 }
302
d320832f 303 if (length > me_cl->props.max_msg_length) {
dd5de1f1 304 rets = -EFBIG;
4234a6de 305 goto out;
75f0ee15
TW
306 }
307
f3de9b63
TW
308 if (!mei_cl_is_connected(cl)) {
309 cl_err(dev, cl, "is not connected");
4234a6de
TW
310 rets = -ENODEV;
311 goto out;
75f0ee15 312 }
ab841160 313 if (cl == &dev->iamthif_cl) {
19838fb8 314 write_cb = mei_amthif_find_read_list_entry(dev, file);
ab841160
OW
315
316 if (write_cb) {
317 timeout = write_cb->read_time +
3870c320 318 mei_secs_to_jiffies(MEI_IAMTHIF_READ_TIMER);
ab841160 319
a9bed610 320 if (time_after(jiffies, timeout)) {
75f0ee15 321 *offset = 0;
601a1efa 322 mei_io_cb_free(write_cb);
75f0ee15 323 write_cb = NULL;
ab841160
OW
324 }
325 }
326 }
327
a9bed610 328 *offset = 0;
bca67d68 329 write_cb = mei_cl_alloc_cb(cl, length, MEI_FOP_WRITE, file);
ab841160 330 if (!write_cb) {
33d28c92 331 rets = -ENOMEM;
4234a6de 332 goto out;
ab841160 333 }
ab841160 334
5db7514d 335 rets = copy_from_user(write_cb->buf.data, ubuf, length);
d8b29efa 336 if (rets) {
2bf94cab 337 dev_dbg(dev->dev, "failed to copy data from userland\n");
d8b29efa 338 rets = -EFAULT;
4234a6de 339 goto out;
d8b29efa 340 }
ab841160 341
ab841160 342 if (cl == &dev->iamthif_cl) {
8660172e 343 rets = mei_amthif_write(cl, write_cb);
ab841160 344
ab5c4a56 345 if (rets) {
2bf94cab 346 dev_err(dev->dev,
1a1aca42 347 "amthif write failed with status = %d\n", rets);
4234a6de 348 goto out;
ab841160 349 }
79563db9 350 mei_me_cl_put(me_cl);
ab841160 351 mutex_unlock(&dev->device_lock);
75f0ee15 352 return length;
ab841160
OW
353 }
354
4234a6de 355 rets = mei_cl_write(cl, write_cb, false);
b0d0cf77 356out:
79563db9 357 mei_me_cl_put(me_cl);
ab841160 358 mutex_unlock(&dev->device_lock);
4234a6de
TW
359 if (rets < 0)
360 mei_io_cb_free(write_cb);
ab841160
OW
361 return rets;
362}
363
9f81abda
TW
364/**
365 * mei_ioctl_connect_client - the connect to fw client IOCTL function
366 *
9f81abda 367 * @file: private data of the file object
a8605ea2 368 * @data: IOCTL connect data, input and output parameters
9f81abda
TW
369 *
370 * Locking: called under "dev->device_lock" lock
371 *
a8605ea2 372 * Return: 0 on success, <0 on failure.
9f81abda
TW
373 */
374static int mei_ioctl_connect_client(struct file *file,
375 struct mei_connect_client_data *data)
376{
377 struct mei_device *dev;
378 struct mei_client *client;
d320832f 379 struct mei_me_client *me_cl;
9f81abda 380 struct mei_cl *cl;
9f81abda
TW
381 int rets;
382
383 cl = file->private_data;
9f81abda
TW
384 dev = cl->dev;
385
79563db9
TW
386 if (dev->dev_state != MEI_DEV_ENABLED)
387 return -ENODEV;
9f81abda
TW
388
389 if (cl->state != MEI_FILE_INITIALIZING &&
79563db9
TW
390 cl->state != MEI_FILE_DISCONNECTED)
391 return -EBUSY;
9f81abda
TW
392
393 /* find ME client we're trying to connect to */
d320832f
TW
394 me_cl = mei_me_cl_by_uuid(dev, &data->in_client_uuid);
395 if (!me_cl || me_cl->props.fixed_address) {
2bf94cab 396 dev_dbg(dev->dev, "Cannot connect to FW Client UUID = %pUl\n",
80fe6361 397 &data->in_client_uuid);
79563db9 398 return -ENOTTY;
9f81abda
TW
399 }
400
d320832f 401 cl->me_client_id = me_cl->client_id;
d880f329 402 cl->cl_uuid = me_cl->props.protocol_name;
80fe6361 403
2bf94cab 404 dev_dbg(dev->dev, "Connect to FW Client ID = %d\n",
9f81abda 405 cl->me_client_id);
2bf94cab 406 dev_dbg(dev->dev, "FW Client - Protocol Version = %d\n",
d320832f 407 me_cl->props.protocol_version);
2bf94cab 408 dev_dbg(dev->dev, "FW Client - Max Msg Len = %d\n",
d320832f 409 me_cl->props.max_msg_length);
9f81abda 410
1a1aca42 411 /* if we're connecting to amthif client then we will use the
9f81abda
TW
412 * existing connection
413 */
1a1aca42 414 if (uuid_le_cmp(data->in_client_uuid, mei_amthif_guid) == 0) {
2bf94cab 415 dev_dbg(dev->dev, "FW Client is amthi\n");
f3de9b63 416 if (!mei_cl_is_connected(&dev->iamthif_cl)) {
9f81abda
TW
417 rets = -ENODEV;
418 goto end;
419 }
9f81abda
TW
420 mei_cl_unlink(cl);
421
422 kfree(cl);
423 cl = NULL;
22f96a0e 424 dev->iamthif_open_count++;
9f81abda
TW
425 file->private_data = &dev->iamthif_cl;
426
427 client = &data->out_client_properties;
d320832f
TW
428 client->max_msg_length = me_cl->props.max_msg_length;
429 client->protocol_version = me_cl->props.protocol_version;
9f81abda
TW
430 rets = dev->iamthif_cl.status;
431
432 goto end;
433 }
434
9f81abda
TW
435 /* prepare the output buffer */
436 client = &data->out_client_properties;
d320832f
TW
437 client->max_msg_length = me_cl->props.max_msg_length;
438 client->protocol_version = me_cl->props.protocol_version;
2bf94cab 439 dev_dbg(dev->dev, "Can connect?\n");
9f81abda 440
9f81abda
TW
441 rets = mei_cl_connect(cl, file);
442
443end:
79563db9 444 mei_me_cl_put(me_cl);
9f81abda
TW
445 return rets;
446}
447
ab841160
OW
448/**
449 * mei_ioctl - the IOCTL function
450 *
451 * @file: pointer to file structure
452 * @cmd: ioctl command
453 * @data: pointer to mei message structure
454 *
a8605ea2 455 * Return: 0 on success , <0 on error
ab841160
OW
456 */
457static long mei_ioctl(struct file *file, unsigned int cmd, unsigned long data)
458{
459 struct mei_device *dev;
460 struct mei_cl *cl = file->private_data;
154eb18f 461 struct mei_connect_client_data connect_data;
ab841160
OW
462 int rets;
463
ab841160
OW
464
465 if (WARN_ON(!cl || !cl->dev))
466 return -ENODEV;
467
468 dev = cl->dev;
469
2bf94cab 470 dev_dbg(dev->dev, "IOCTL cmd = 0x%x", cmd);
ab841160
OW
471
472 mutex_lock(&dev->device_lock);
b210d750 473 if (dev->dev_state != MEI_DEV_ENABLED) {
ab841160
OW
474 rets = -ENODEV;
475 goto out;
476 }
477
4f046e7b
TW
478 switch (cmd) {
479 case IOCTL_MEI_CONNECT_CLIENT:
2bf94cab 480 dev_dbg(dev->dev, ": IOCTL_MEI_CONNECT_CLIENT.\n");
154eb18f 481 if (copy_from_user(&connect_data, (char __user *)data,
4f046e7b 482 sizeof(struct mei_connect_client_data))) {
2bf94cab 483 dev_dbg(dev->dev, "failed to copy data from userland\n");
4f046e7b
TW
484 rets = -EFAULT;
485 goto out;
486 }
ab841160 487
154eb18f 488 rets = mei_ioctl_connect_client(file, &connect_data);
4f046e7b
TW
489 if (rets)
490 goto out;
ab841160 491
4f046e7b 492 /* if all is ok, copying the data back to user. */
154eb18f 493 if (copy_to_user((char __user *)data, &connect_data,
ab841160 494 sizeof(struct mei_connect_client_data))) {
2bf94cab 495 dev_dbg(dev->dev, "failed to copy data to userland\n");
4f046e7b
TW
496 rets = -EFAULT;
497 goto out;
498 }
499
500 break;
154eb18f 501
4f046e7b 502 default:
2bf94cab 503 dev_err(dev->dev, ": unsupported ioctl %d.\n", cmd);
4f046e7b 504 rets = -ENOIOCTLCMD;
ab841160
OW
505 }
506
507out:
ab841160
OW
508 mutex_unlock(&dev->device_lock);
509 return rets;
510}
511
512/**
513 * mei_compat_ioctl - the compat IOCTL function
514 *
515 * @file: pointer to file structure
516 * @cmd: ioctl command
517 * @data: pointer to mei message structure
518 *
a8605ea2 519 * Return: 0 on success , <0 on error
ab841160
OW
520 */
521#ifdef CONFIG_COMPAT
522static long mei_compat_ioctl(struct file *file,
441ab50f 523 unsigned int cmd, unsigned long data)
ab841160
OW
524{
525 return mei_ioctl(file, cmd, (unsigned long)compat_ptr(data));
526}
527#endif
528
529
530/**
531 * mei_poll - the poll function
532 *
533 * @file: pointer to file structure
534 * @wait: pointer to poll_table structure
535 *
a8605ea2 536 * Return: poll mask
ab841160
OW
537 */
538static unsigned int mei_poll(struct file *file, poll_table *wait)
539{
1d9013f0 540 unsigned long req_events = poll_requested_events(wait);
ab841160
OW
541 struct mei_cl *cl = file->private_data;
542 struct mei_device *dev;
543 unsigned int mask = 0;
544
545 if (WARN_ON(!cl || !cl->dev))
b950ac1d 546 return POLLERR;
ab841160
OW
547
548 dev = cl->dev;
549
550 mutex_lock(&dev->device_lock);
551
f3de9b63
TW
552
553 if (dev->dev_state != MEI_DEV_ENABLED ||
554 !mei_cl_is_connected(cl)) {
b950ac1d 555 mask = POLLERR;
ab841160
OW
556 goto out;
557 }
558
1d9013f0
TW
559 if (cl == &dev->iamthif_cl) {
560 mask = mei_amthif_poll(dev, file, wait);
b950ac1d
TW
561 goto out;
562 }
563
1d9013f0
TW
564 if (req_events & (POLLIN | POLLRDNORM)) {
565 poll_wait(file, &cl->rx_wait, wait);
566
567 if (!list_empty(&cl->rd_completed))
568 mask |= POLLIN | POLLRDNORM;
569 else
570 mei_cl_read_start(cl, 0, file);
571 }
ab841160
OW
572
573out:
574 mutex_unlock(&dev->device_lock);
575 return mask;
576}
577
55c4e640
TW
578/**
579 * fw_status_show - mei device attribute show method
580 *
581 * @device: device pointer
582 * @attr: attribute pointer
583 * @buf: char out buffer
584 *
585 * Return: number of the bytes printed into buf or error
586 */
587static ssize_t fw_status_show(struct device *device,
588 struct device_attribute *attr, char *buf)
589{
590 struct mei_device *dev = dev_get_drvdata(device);
591 struct mei_fw_status fw_status;
592 int err, i;
593 ssize_t cnt = 0;
594
595 mutex_lock(&dev->device_lock);
596 err = mei_fw_status(dev, &fw_status);
597 mutex_unlock(&dev->device_lock);
598 if (err) {
599 dev_err(device, "read fw_status error = %d\n", err);
600 return err;
601 }
602
603 for (i = 0; i < fw_status.count; i++)
604 cnt += scnprintf(buf + cnt, PAGE_SIZE - cnt, "%08X\n",
605 fw_status.status[i]);
606 return cnt;
607}
608static DEVICE_ATTR_RO(fw_status);
609
610static struct attribute *mei_attrs[] = {
611 &dev_attr_fw_status.attr,
612 NULL
613};
614ATTRIBUTE_GROUPS(mei);
615
5b881e3c
OW
616/*
617 * file operations structure will be used for mei char device.
618 */
619static const struct file_operations mei_fops = {
620 .owner = THIS_MODULE,
621 .read = mei_read,
622 .unlocked_ioctl = mei_ioctl,
623#ifdef CONFIG_COMPAT
624 .compat_ioctl = mei_compat_ioctl,
625#endif
626 .open = mei_open,
627 .release = mei_release,
628 .write = mei_write,
629 .poll = mei_poll,
630 .llseek = no_llseek
631};
632
f3d8e878
AU
633static struct class *mei_class;
634static dev_t mei_devt;
635#define MEI_MAX_DEVS MINORMASK
636static DEFINE_MUTEX(mei_minor_lock);
637static DEFINE_IDR(mei_idr);
638
639/**
640 * mei_minor_get - obtain next free device minor number
641 *
642 * @dev: device pointer
643 *
a8605ea2 644 * Return: allocated minor, or -ENOSPC if no free minor left
5b881e3c 645 */
f3d8e878
AU
646static int mei_minor_get(struct mei_device *dev)
647{
648 int ret;
649
650 mutex_lock(&mei_minor_lock);
651 ret = idr_alloc(&mei_idr, dev, 0, MEI_MAX_DEVS, GFP_KERNEL);
652 if (ret >= 0)
653 dev->minor = ret;
654 else if (ret == -ENOSPC)
2bf94cab 655 dev_err(dev->dev, "too many mei devices\n");
5b881e3c 656
f3d8e878
AU
657 mutex_unlock(&mei_minor_lock);
658 return ret;
659}
30e53bb8 660
f3d8e878
AU
661/**
662 * mei_minor_free - mark device minor number as free
663 *
664 * @dev: device pointer
665 */
666static void mei_minor_free(struct mei_device *dev)
9a123f19 667{
f3d8e878
AU
668 mutex_lock(&mei_minor_lock);
669 idr_remove(&mei_idr, dev->minor);
670 mutex_unlock(&mei_minor_lock);
671}
672
673int mei_register(struct mei_device *dev, struct device *parent)
674{
675 struct device *clsdev; /* class device */
676 int ret, devno;
677
678 ret = mei_minor_get(dev);
679 if (ret < 0)
30e53bb8
TW
680 return ret;
681
f3d8e878
AU
682 /* Fill in the data structures */
683 devno = MKDEV(MAJOR(mei_devt), dev->minor);
684 cdev_init(&dev->cdev, &mei_fops);
685 dev->cdev.owner = mei_fops.owner;
686
687 /* Add the device */
688 ret = cdev_add(&dev->cdev, devno, 1);
689 if (ret) {
690 dev_err(parent, "unable to add device %d:%d\n",
691 MAJOR(mei_devt), dev->minor);
692 goto err_dev_add;
693 }
694
55c4e640
TW
695 clsdev = device_create_with_groups(mei_class, parent, devno,
696 dev, mei_groups,
697 "mei%d", dev->minor);
f3d8e878
AU
698
699 if (IS_ERR(clsdev)) {
700 dev_err(parent, "unable to create device %d:%d\n",
701 MAJOR(mei_devt), dev->minor);
702 ret = PTR_ERR(clsdev);
703 goto err_dev_create;
704 }
705
706 ret = mei_dbgfs_register(dev, dev_name(clsdev));
707 if (ret) {
708 dev_err(clsdev, "cannot register debugfs ret = %d\n", ret);
709 goto err_dev_dbgfs;
710 }
30e53bb8
TW
711
712 return 0;
f3d8e878
AU
713
714err_dev_dbgfs:
715 device_destroy(mei_class, devno);
716err_dev_create:
717 cdev_del(&dev->cdev);
718err_dev_add:
719 mei_minor_free(dev);
720 return ret;
5b881e3c 721}
40e0b67b 722EXPORT_SYMBOL_GPL(mei_register);
5b881e3c 723
30e53bb8 724void mei_deregister(struct mei_device *dev)
5b881e3c 725{
f3d8e878
AU
726 int devno;
727
728 devno = dev->cdev.dev;
729 cdev_del(&dev->cdev);
730
30e53bb8 731 mei_dbgfs_deregister(dev);
f3d8e878
AU
732
733 device_destroy(mei_class, devno);
734
735 mei_minor_free(dev);
5b881e3c 736}
40e0b67b 737EXPORT_SYMBOL_GPL(mei_deregister);
ab841160 738
cf3baefb
SO
739static int __init mei_init(void)
740{
f3d8e878
AU
741 int ret;
742
743 mei_class = class_create(THIS_MODULE, "mei");
744 if (IS_ERR(mei_class)) {
745 pr_err("couldn't create class\n");
746 ret = PTR_ERR(mei_class);
747 goto err;
748 }
749
750 ret = alloc_chrdev_region(&mei_devt, 0, MEI_MAX_DEVS, "mei");
751 if (ret < 0) {
752 pr_err("unable to allocate char dev region\n");
753 goto err_class;
754 }
755
756 ret = mei_cl_bus_init();
757 if (ret < 0) {
758 pr_err("unable to initialize bus\n");
759 goto err_chrdev;
760 }
761
762 return 0;
763
764err_chrdev:
765 unregister_chrdev_region(mei_devt, MEI_MAX_DEVS);
766err_class:
767 class_destroy(mei_class);
768err:
769 return ret;
cf3baefb
SO
770}
771
772static void __exit mei_exit(void)
773{
f3d8e878
AU
774 unregister_chrdev_region(mei_devt, MEI_MAX_DEVS);
775 class_destroy(mei_class);
cf3baefb
SO
776 mei_cl_bus_exit();
777}
778
779module_init(mei_init);
780module_exit(mei_exit);
781
40e0b67b
TW
782MODULE_AUTHOR("Intel Corporation");
783MODULE_DESCRIPTION("Intel(R) Management Engine Interface");
827eef51 784MODULE_LICENSE("GPL v2");
ab841160 785