perf tools: Don't clone maps from parent when synthesizing forks
[linux/fpc-iii.git] / drivers / misc / mei / bus.c
blobfc3872fe7b2510e1fa862ea508be53ad377a4bfd
1 /*
2 * Intel Management Engine Interface (Intel MEI) Linux driver
3 * Copyright (c) 2012-2013, Intel Corporation.
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms and conditions of the GNU General Public License,
7 * version 2, as published by the Free Software Foundation.
9 * This program is distributed in the hope it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
16 #include <linux/module.h>
17 #include <linux/device.h>
18 #include <linux/kernel.h>
19 #include <linux/sched/signal.h>
20 #include <linux/init.h>
21 #include <linux/errno.h>
22 #include <linux/slab.h>
23 #include <linux/mutex.h>
24 #include <linux/interrupt.h>
25 #include <linux/mei_cl_bus.h>
27 #include "mei_dev.h"
28 #include "client.h"
30 #define to_mei_cl_driver(d) container_of(d, struct mei_cl_driver, driver)
31 #define to_mei_cl_device(d) container_of(d, struct mei_cl_device, dev)
33 /**
34 * __mei_cl_send - internal client send (write)
36 * @cl: host client
37 * @buf: buffer to send
38 * @length: buffer length
39 * @mode: sending mode
41 * Return: written size bytes or < 0 on error
43 ssize_t __mei_cl_send(struct mei_cl *cl, u8 *buf, size_t length,
44 unsigned int mode)
46 struct mei_device *bus;
47 struct mei_cl_cb *cb;
48 ssize_t rets;
50 if (WARN_ON(!cl || !cl->dev))
51 return -ENODEV;
53 bus = cl->dev;
55 mutex_lock(&bus->device_lock);
56 if (bus->dev_state != MEI_DEV_ENABLED) {
57 rets = -ENODEV;
58 goto out;
61 if (!mei_cl_is_connected(cl)) {
62 rets = -ENODEV;
63 goto out;
66 /* Check if we have an ME client device */
67 if (!mei_me_cl_is_active(cl->me_cl)) {
68 rets = -ENOTTY;
69 goto out;
72 if (length > mei_cl_mtu(cl)) {
73 rets = -EFBIG;
74 goto out;
77 while (cl->tx_cb_queued >= bus->tx_queue_limit) {
78 mutex_unlock(&bus->device_lock);
79 rets = wait_event_interruptible(cl->tx_wait,
80 cl->writing_state == MEI_WRITE_COMPLETE ||
81 (!mei_cl_is_connected(cl)));
82 mutex_lock(&bus->device_lock);
83 if (rets) {
84 if (signal_pending(current))
85 rets = -EINTR;
86 goto out;
88 if (!mei_cl_is_connected(cl)) {
89 rets = -ENODEV;
90 goto out;
94 cb = mei_cl_alloc_cb(cl, length, MEI_FOP_WRITE, NULL);
95 if (!cb) {
96 rets = -ENOMEM;
97 goto out;
100 cb->internal = !!(mode & MEI_CL_IO_TX_INTERNAL);
101 cb->blocking = !!(mode & MEI_CL_IO_TX_BLOCKING);
102 memcpy(cb->buf.data, buf, length);
104 rets = mei_cl_write(cl, cb);
106 out:
107 mutex_unlock(&bus->device_lock);
109 return rets;
113 * __mei_cl_recv - internal client receive (read)
115 * @cl: host client
116 * @buf: buffer to receive
117 * @length: buffer length
118 * @mode: io mode
119 * @timeout: recv timeout, 0 for infinite timeout
121 * Return: read size in bytes of < 0 on error
123 ssize_t __mei_cl_recv(struct mei_cl *cl, u8 *buf, size_t length,
124 unsigned int mode, unsigned long timeout)
126 struct mei_device *bus;
127 struct mei_cl_cb *cb;
128 size_t r_length;
129 ssize_t rets;
130 bool nonblock = !!(mode & MEI_CL_IO_RX_NONBLOCK);
132 if (WARN_ON(!cl || !cl->dev))
133 return -ENODEV;
135 bus = cl->dev;
137 mutex_lock(&bus->device_lock);
138 if (bus->dev_state != MEI_DEV_ENABLED) {
139 rets = -ENODEV;
140 goto out;
143 cb = mei_cl_read_cb(cl, NULL);
144 if (cb)
145 goto copy;
147 rets = mei_cl_read_start(cl, length, NULL);
148 if (rets && rets != -EBUSY)
149 goto out;
151 if (nonblock) {
152 rets = -EAGAIN;
153 goto out;
156 /* wait on event only if there is no other waiter */
157 /* synchronized under device mutex */
158 if (!waitqueue_active(&cl->rx_wait)) {
160 mutex_unlock(&bus->device_lock);
162 if (timeout) {
163 rets = wait_event_interruptible_timeout
164 (cl->rx_wait,
165 (!list_empty(&cl->rd_completed)) ||
166 (!mei_cl_is_connected(cl)),
167 msecs_to_jiffies(timeout));
168 if (rets == 0)
169 return -ETIME;
170 if (rets < 0) {
171 if (signal_pending(current))
172 return -EINTR;
173 return -ERESTARTSYS;
175 } else {
176 if (wait_event_interruptible
177 (cl->rx_wait,
178 (!list_empty(&cl->rd_completed)) ||
179 (!mei_cl_is_connected(cl)))) {
180 if (signal_pending(current))
181 return -EINTR;
182 return -ERESTARTSYS;
186 mutex_lock(&bus->device_lock);
188 if (!mei_cl_is_connected(cl)) {
189 rets = -ENODEV;
190 goto out;
194 cb = mei_cl_read_cb(cl, NULL);
195 if (!cb) {
196 rets = 0;
197 goto out;
200 copy:
201 if (cb->status) {
202 rets = cb->status;
203 goto free;
206 r_length = min_t(size_t, length, cb->buf_idx);
207 memcpy(buf, cb->buf.data, r_length);
208 rets = r_length;
210 free:
211 mei_io_cb_free(cb);
212 out:
213 mutex_unlock(&bus->device_lock);
215 return rets;
219 * mei_cldev_send - me device send (write)
221 * @cldev: me client device
222 * @buf: buffer to send
223 * @length: buffer length
225 * Return: written size in bytes or < 0 on error
227 ssize_t mei_cldev_send(struct mei_cl_device *cldev, u8 *buf, size_t length)
229 struct mei_cl *cl = cldev->cl;
231 return __mei_cl_send(cl, buf, length, MEI_CL_IO_TX_BLOCKING);
233 EXPORT_SYMBOL_GPL(mei_cldev_send);
236 * mei_cldev_recv_nonblock - non block client receive (read)
238 * @cldev: me client device
239 * @buf: buffer to receive
240 * @length: buffer length
242 * Return: read size in bytes of < 0 on error
243 * -EAGAIN if function will block.
245 ssize_t mei_cldev_recv_nonblock(struct mei_cl_device *cldev, u8 *buf,
246 size_t length)
248 struct mei_cl *cl = cldev->cl;
250 return __mei_cl_recv(cl, buf, length, MEI_CL_IO_RX_NONBLOCK, 0);
252 EXPORT_SYMBOL_GPL(mei_cldev_recv_nonblock);
255 * mei_cldev_recv - client receive (read)
257 * @cldev: me client device
258 * @buf: buffer to receive
259 * @length: buffer length
261 * Return: read size in bytes of < 0 on error
263 ssize_t mei_cldev_recv(struct mei_cl_device *cldev, u8 *buf, size_t length)
265 struct mei_cl *cl = cldev->cl;
267 return __mei_cl_recv(cl, buf, length, 0, 0);
269 EXPORT_SYMBOL_GPL(mei_cldev_recv);
272 * mei_cl_bus_rx_work - dispatch rx event for a bus device
274 * @work: work
276 static void mei_cl_bus_rx_work(struct work_struct *work)
278 struct mei_cl_device *cldev;
279 struct mei_device *bus;
281 cldev = container_of(work, struct mei_cl_device, rx_work);
283 bus = cldev->bus;
285 if (cldev->rx_cb)
286 cldev->rx_cb(cldev);
288 mutex_lock(&bus->device_lock);
289 mei_cl_read_start(cldev->cl, mei_cl_mtu(cldev->cl), NULL);
290 mutex_unlock(&bus->device_lock);
294 * mei_cl_bus_notif_work - dispatch FW notif event for a bus device
296 * @work: work
298 static void mei_cl_bus_notif_work(struct work_struct *work)
300 struct mei_cl_device *cldev;
302 cldev = container_of(work, struct mei_cl_device, notif_work);
304 if (cldev->notif_cb)
305 cldev->notif_cb(cldev);
309 * mei_cl_bus_notify_event - schedule notify cb on bus client
311 * @cl: host client
313 * Return: true if event was scheduled
314 * false if the client is not waiting for event
316 bool mei_cl_bus_notify_event(struct mei_cl *cl)
318 struct mei_cl_device *cldev = cl->cldev;
320 if (!cldev || !cldev->notif_cb)
321 return false;
323 if (!cl->notify_ev)
324 return false;
326 schedule_work(&cldev->notif_work);
328 cl->notify_ev = false;
330 return true;
334 * mei_cl_bus_rx_event - schedule rx event
336 * @cl: host client
338 * Return: true if event was scheduled
339 * false if the client is not waiting for event
341 bool mei_cl_bus_rx_event(struct mei_cl *cl)
343 struct mei_cl_device *cldev = cl->cldev;
345 if (!cldev || !cldev->rx_cb)
346 return false;
348 schedule_work(&cldev->rx_work);
350 return true;
354 * mei_cldev_register_rx_cb - register Rx event callback
356 * @cldev: me client devices
357 * @rx_cb: callback function
359 * Return: 0 on success
360 * -EALREADY if an callback is already registered
361 * <0 on other errors
363 int mei_cldev_register_rx_cb(struct mei_cl_device *cldev, mei_cldev_cb_t rx_cb)
365 struct mei_device *bus = cldev->bus;
366 int ret;
368 if (!rx_cb)
369 return -EINVAL;
370 if (cldev->rx_cb)
371 return -EALREADY;
373 cldev->rx_cb = rx_cb;
374 INIT_WORK(&cldev->rx_work, mei_cl_bus_rx_work);
376 mutex_lock(&bus->device_lock);
377 ret = mei_cl_read_start(cldev->cl, mei_cl_mtu(cldev->cl), NULL);
378 mutex_unlock(&bus->device_lock);
379 if (ret && ret != -EBUSY)
380 return ret;
382 return 0;
384 EXPORT_SYMBOL_GPL(mei_cldev_register_rx_cb);
387 * mei_cldev_register_notif_cb - register FW notification event callback
389 * @cldev: me client devices
390 * @notif_cb: callback function
392 * Return: 0 on success
393 * -EALREADY if an callback is already registered
394 * <0 on other errors
396 int mei_cldev_register_notif_cb(struct mei_cl_device *cldev,
397 mei_cldev_cb_t notif_cb)
399 struct mei_device *bus = cldev->bus;
400 int ret;
402 if (!notif_cb)
403 return -EINVAL;
405 if (cldev->notif_cb)
406 return -EALREADY;
408 cldev->notif_cb = notif_cb;
409 INIT_WORK(&cldev->notif_work, mei_cl_bus_notif_work);
411 mutex_lock(&bus->device_lock);
412 ret = mei_cl_notify_request(cldev->cl, NULL, 1);
413 mutex_unlock(&bus->device_lock);
414 if (ret)
415 return ret;
417 return 0;
419 EXPORT_SYMBOL_GPL(mei_cldev_register_notif_cb);
422 * mei_cldev_get_drvdata - driver data getter
424 * @cldev: mei client device
426 * Return: driver private data
428 void *mei_cldev_get_drvdata(const struct mei_cl_device *cldev)
430 return dev_get_drvdata(&cldev->dev);
432 EXPORT_SYMBOL_GPL(mei_cldev_get_drvdata);
435 * mei_cldev_set_drvdata - driver data setter
437 * @cldev: mei client device
438 * @data: data to store
440 void mei_cldev_set_drvdata(struct mei_cl_device *cldev, void *data)
442 dev_set_drvdata(&cldev->dev, data);
444 EXPORT_SYMBOL_GPL(mei_cldev_set_drvdata);
447 * mei_cldev_uuid - return uuid of the underlying me client
449 * @cldev: mei client device
451 * Return: me client uuid
453 const uuid_le *mei_cldev_uuid(const struct mei_cl_device *cldev)
455 return mei_me_cl_uuid(cldev->me_cl);
457 EXPORT_SYMBOL_GPL(mei_cldev_uuid);
460 * mei_cldev_ver - return protocol version of the underlying me client
462 * @cldev: mei client device
464 * Return: me client protocol version
466 u8 mei_cldev_ver(const struct mei_cl_device *cldev)
468 return mei_me_cl_ver(cldev->me_cl);
470 EXPORT_SYMBOL_GPL(mei_cldev_ver);
473 * mei_cldev_enabled - check whether the device is enabled
475 * @cldev: mei client device
477 * Return: true if me client is initialized and connected
479 bool mei_cldev_enabled(struct mei_cl_device *cldev)
481 return mei_cl_is_connected(cldev->cl);
483 EXPORT_SYMBOL_GPL(mei_cldev_enabled);
486 * mei_cl_bus_module_get - acquire module of the underlying
487 * hw driver.
489 * @cldev: mei client device
491 * Return: true on success; false if the module was removed.
493 static bool mei_cl_bus_module_get(struct mei_cl_device *cldev)
495 return try_module_get(cldev->bus->dev->driver->owner);
499 * mei_cl_bus_module_put - release the underlying hw module.
501 * @cldev: mei client device
503 static void mei_cl_bus_module_put(struct mei_cl_device *cldev)
505 module_put(cldev->bus->dev->driver->owner);
509 * mei_cldev_enable - enable me client device
510 * create connection with me client
512 * @cldev: me client device
514 * Return: 0 on success and < 0 on error
516 int mei_cldev_enable(struct mei_cl_device *cldev)
518 struct mei_device *bus = cldev->bus;
519 struct mei_cl *cl;
520 int ret;
522 cl = cldev->cl;
524 mutex_lock(&bus->device_lock);
525 if (cl->state == MEI_FILE_UNINITIALIZED) {
526 ret = mei_cl_link(cl);
527 if (ret)
528 goto out;
529 /* update pointers */
530 cl->cldev = cldev;
533 if (mei_cl_is_connected(cl)) {
534 ret = 0;
535 goto out;
538 if (!mei_me_cl_is_active(cldev->me_cl)) {
539 dev_err(&cldev->dev, "me client is not active\n");
540 ret = -ENOTTY;
541 goto out;
544 if (!mei_cl_bus_module_get(cldev)) {
545 dev_err(&cldev->dev, "get hw module failed");
546 ret = -ENODEV;
547 goto out;
550 ret = mei_cl_connect(cl, cldev->me_cl, NULL);
551 if (ret < 0) {
552 dev_err(&cldev->dev, "cannot connect\n");
553 mei_cl_bus_module_put(cldev);
556 out:
557 mutex_unlock(&bus->device_lock);
559 return ret;
561 EXPORT_SYMBOL_GPL(mei_cldev_enable);
564 * mei_cldev_unregister_callbacks - internal wrapper for unregistering
565 * callbacks.
567 * @cldev: client device
569 static void mei_cldev_unregister_callbacks(struct mei_cl_device *cldev)
571 if (cldev->rx_cb) {
572 cancel_work_sync(&cldev->rx_work);
573 cldev->rx_cb = NULL;
576 if (cldev->notif_cb) {
577 cancel_work_sync(&cldev->notif_work);
578 cldev->notif_cb = NULL;
583 * mei_cldev_disable - disable me client device
584 * disconnect form the me client
586 * @cldev: me client device
588 * Return: 0 on success and < 0 on error
590 int mei_cldev_disable(struct mei_cl_device *cldev)
592 struct mei_device *bus;
593 struct mei_cl *cl;
594 int err;
596 if (!cldev)
597 return -ENODEV;
599 cl = cldev->cl;
601 bus = cldev->bus;
603 mei_cldev_unregister_callbacks(cldev);
605 mutex_lock(&bus->device_lock);
607 if (!mei_cl_is_connected(cl)) {
608 dev_dbg(bus->dev, "Already disconnected\n");
609 err = 0;
610 goto out;
613 err = mei_cl_disconnect(cl);
614 if (err < 0)
615 dev_err(bus->dev, "Could not disconnect from the ME client\n");
617 mei_cl_bus_module_put(cldev);
618 out:
619 /* Flush queues and remove any pending read */
620 mei_cl_flush_queues(cl, NULL);
621 mei_cl_unlink(cl);
623 mutex_unlock(&bus->device_lock);
624 return err;
626 EXPORT_SYMBOL_GPL(mei_cldev_disable);
629 * mei_cl_device_find - find matching entry in the driver id table
631 * @cldev: me client device
632 * @cldrv: me client driver
634 * Return: id on success; NULL if no id is matching
636 static const
637 struct mei_cl_device_id *mei_cl_device_find(struct mei_cl_device *cldev,
638 struct mei_cl_driver *cldrv)
640 const struct mei_cl_device_id *id;
641 const uuid_le *uuid;
642 u8 version;
643 bool match;
645 uuid = mei_me_cl_uuid(cldev->me_cl);
646 version = mei_me_cl_ver(cldev->me_cl);
648 id = cldrv->id_table;
649 while (uuid_le_cmp(NULL_UUID_LE, id->uuid)) {
650 if (!uuid_le_cmp(*uuid, id->uuid)) {
651 match = true;
653 if (cldev->name[0])
654 if (strncmp(cldev->name, id->name,
655 sizeof(id->name)))
656 match = false;
658 if (id->version != MEI_CL_VERSION_ANY)
659 if (id->version != version)
660 match = false;
661 if (match)
662 return id;
665 id++;
668 return NULL;
672 * mei_cl_device_match - device match function
674 * @dev: device
675 * @drv: driver
677 * Return: 1 if matching device was found 0 otherwise
679 static int mei_cl_device_match(struct device *dev, struct device_driver *drv)
681 struct mei_cl_device *cldev = to_mei_cl_device(dev);
682 struct mei_cl_driver *cldrv = to_mei_cl_driver(drv);
683 const struct mei_cl_device_id *found_id;
685 if (!cldev)
686 return 0;
688 if (!cldev->do_match)
689 return 0;
691 if (!cldrv || !cldrv->id_table)
692 return 0;
694 found_id = mei_cl_device_find(cldev, cldrv);
695 if (found_id)
696 return 1;
698 return 0;
702 * mei_cl_device_probe - bus probe function
704 * @dev: device
706 * Return: 0 on success; < 0 otherwise
708 static int mei_cl_device_probe(struct device *dev)
710 struct mei_cl_device *cldev;
711 struct mei_cl_driver *cldrv;
712 const struct mei_cl_device_id *id;
713 int ret;
715 cldev = to_mei_cl_device(dev);
716 cldrv = to_mei_cl_driver(dev->driver);
718 if (!cldev)
719 return 0;
721 if (!cldrv || !cldrv->probe)
722 return -ENODEV;
724 id = mei_cl_device_find(cldev, cldrv);
725 if (!id)
726 return -ENODEV;
728 ret = cldrv->probe(cldev, id);
729 if (ret)
730 return ret;
732 __module_get(THIS_MODULE);
733 return 0;
737 * mei_cl_device_remove - remove device from the bus
739 * @dev: device
741 * Return: 0 on success; < 0 otherwise
743 static int mei_cl_device_remove(struct device *dev)
745 struct mei_cl_device *cldev = to_mei_cl_device(dev);
746 struct mei_cl_driver *cldrv;
747 int ret = 0;
749 if (!cldev || !dev->driver)
750 return 0;
752 cldrv = to_mei_cl_driver(dev->driver);
753 if (cldrv->remove)
754 ret = cldrv->remove(cldev);
756 mei_cldev_unregister_callbacks(cldev);
758 module_put(THIS_MODULE);
759 dev->driver = NULL;
760 return ret;
764 static ssize_t name_show(struct device *dev, struct device_attribute *a,
765 char *buf)
767 struct mei_cl_device *cldev = to_mei_cl_device(dev);
769 return scnprintf(buf, PAGE_SIZE, "%s", cldev->name);
771 static DEVICE_ATTR_RO(name);
773 static ssize_t uuid_show(struct device *dev, struct device_attribute *a,
774 char *buf)
776 struct mei_cl_device *cldev = to_mei_cl_device(dev);
777 const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl);
779 return scnprintf(buf, PAGE_SIZE, "%pUl", uuid);
781 static DEVICE_ATTR_RO(uuid);
783 static ssize_t version_show(struct device *dev, struct device_attribute *a,
784 char *buf)
786 struct mei_cl_device *cldev = to_mei_cl_device(dev);
787 u8 version = mei_me_cl_ver(cldev->me_cl);
789 return scnprintf(buf, PAGE_SIZE, "%02X", version);
791 static DEVICE_ATTR_RO(version);
793 static ssize_t modalias_show(struct device *dev, struct device_attribute *a,
794 char *buf)
796 struct mei_cl_device *cldev = to_mei_cl_device(dev);
797 const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl);
798 u8 version = mei_me_cl_ver(cldev->me_cl);
800 return scnprintf(buf, PAGE_SIZE, "mei:%s:%pUl:%02X:",
801 cldev->name, uuid, version);
803 static DEVICE_ATTR_RO(modalias);
805 static struct attribute *mei_cldev_attrs[] = {
806 &dev_attr_name.attr,
807 &dev_attr_uuid.attr,
808 &dev_attr_version.attr,
809 &dev_attr_modalias.attr,
810 NULL,
812 ATTRIBUTE_GROUPS(mei_cldev);
815 * mei_cl_device_uevent - me client bus uevent handler
817 * @dev: device
818 * @env: uevent kobject
820 * Return: 0 on success -ENOMEM on when add_uevent_var fails
822 static int mei_cl_device_uevent(struct device *dev, struct kobj_uevent_env *env)
824 struct mei_cl_device *cldev = to_mei_cl_device(dev);
825 const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl);
826 u8 version = mei_me_cl_ver(cldev->me_cl);
828 if (add_uevent_var(env, "MEI_CL_VERSION=%d", version))
829 return -ENOMEM;
831 if (add_uevent_var(env, "MEI_CL_UUID=%pUl", uuid))
832 return -ENOMEM;
834 if (add_uevent_var(env, "MEI_CL_NAME=%s", cldev->name))
835 return -ENOMEM;
837 if (add_uevent_var(env, "MODALIAS=mei:%s:%pUl:%02X:",
838 cldev->name, uuid, version))
839 return -ENOMEM;
841 return 0;
844 static struct bus_type mei_cl_bus_type = {
845 .name = "mei",
846 .dev_groups = mei_cldev_groups,
847 .match = mei_cl_device_match,
848 .probe = mei_cl_device_probe,
849 .remove = mei_cl_device_remove,
850 .uevent = mei_cl_device_uevent,
853 static struct mei_device *mei_dev_bus_get(struct mei_device *bus)
855 if (bus)
856 get_device(bus->dev);
858 return bus;
861 static void mei_dev_bus_put(struct mei_device *bus)
863 if (bus)
864 put_device(bus->dev);
867 static void mei_cl_bus_dev_release(struct device *dev)
869 struct mei_cl_device *cldev = to_mei_cl_device(dev);
871 if (!cldev)
872 return;
874 mei_me_cl_put(cldev->me_cl);
875 mei_dev_bus_put(cldev->bus);
876 mei_cl_unlink(cldev->cl);
877 kfree(cldev->cl);
878 kfree(cldev);
881 static const struct device_type mei_cl_device_type = {
882 .release = mei_cl_bus_dev_release,
886 * mei_cl_bus_set_name - set device name for me client device
888 * @cldev: me client device
890 static inline void mei_cl_bus_set_name(struct mei_cl_device *cldev)
892 dev_set_name(&cldev->dev, "mei:%s:%pUl:%02X",
893 cldev->name,
894 mei_me_cl_uuid(cldev->me_cl),
895 mei_me_cl_ver(cldev->me_cl));
899 * mei_cl_bus_dev_alloc - initialize and allocate mei client device
901 * @bus: mei device
902 * @me_cl: me client
904 * Return: allocated device structur or NULL on allocation failure
906 static struct mei_cl_device *mei_cl_bus_dev_alloc(struct mei_device *bus,
907 struct mei_me_client *me_cl)
909 struct mei_cl_device *cldev;
910 struct mei_cl *cl;
912 cldev = kzalloc(sizeof(struct mei_cl_device), GFP_KERNEL);
913 if (!cldev)
914 return NULL;
916 cl = mei_cl_allocate(bus);
917 if (!cl) {
918 kfree(cldev);
919 return NULL;
922 device_initialize(&cldev->dev);
923 cldev->dev.parent = bus->dev;
924 cldev->dev.bus = &mei_cl_bus_type;
925 cldev->dev.type = &mei_cl_device_type;
926 cldev->bus = mei_dev_bus_get(bus);
927 cldev->me_cl = mei_me_cl_get(me_cl);
928 cldev->cl = cl;
929 mei_cl_bus_set_name(cldev);
930 cldev->is_added = 0;
931 INIT_LIST_HEAD(&cldev->bus_list);
933 return cldev;
937 * mei_cl_dev_setup - setup me client device
938 * run fix up routines and set the device name
940 * @bus: mei device
941 * @cldev: me client device
943 * Return: true if the device is eligible for enumeration
945 static bool mei_cl_bus_dev_setup(struct mei_device *bus,
946 struct mei_cl_device *cldev)
948 cldev->do_match = 1;
949 mei_cl_bus_dev_fixup(cldev);
951 /* the device name can change during fix up */
952 if (cldev->do_match)
953 mei_cl_bus_set_name(cldev);
955 return cldev->do_match == 1;
959 * mei_cl_bus_dev_add - add me client devices
961 * @cldev: me client device
963 * Return: 0 on success; < 0 on failre
965 static int mei_cl_bus_dev_add(struct mei_cl_device *cldev)
967 int ret;
969 dev_dbg(cldev->bus->dev, "adding %pUL:%02X\n",
970 mei_me_cl_uuid(cldev->me_cl),
971 mei_me_cl_ver(cldev->me_cl));
972 ret = device_add(&cldev->dev);
973 if (!ret)
974 cldev->is_added = 1;
976 return ret;
980 * mei_cl_bus_dev_stop - stop the driver
982 * @cldev: me client device
984 static void mei_cl_bus_dev_stop(struct mei_cl_device *cldev)
986 if (cldev->is_added)
987 device_release_driver(&cldev->dev);
991 * mei_cl_bus_dev_destroy - destroy me client devices object
993 * @cldev: me client device
995 * Locking: called under "dev->cl_bus_lock" lock
997 static void mei_cl_bus_dev_destroy(struct mei_cl_device *cldev)
1000 WARN_ON(!mutex_is_locked(&cldev->bus->cl_bus_lock));
1002 if (!cldev->is_added)
1003 return;
1005 device_del(&cldev->dev);
1007 list_del_init(&cldev->bus_list);
1009 cldev->is_added = 0;
1010 put_device(&cldev->dev);
1014 * mei_cl_bus_remove_device - remove a devices form the bus
1016 * @cldev: me client device
1018 static void mei_cl_bus_remove_device(struct mei_cl_device *cldev)
1020 mei_cl_bus_dev_stop(cldev);
1021 mei_cl_bus_dev_destroy(cldev);
1025 * mei_cl_bus_remove_devices - remove all devices form the bus
1027 * @bus: mei device
1029 void mei_cl_bus_remove_devices(struct mei_device *bus)
1031 struct mei_cl_device *cldev, *next;
1033 mutex_lock(&bus->cl_bus_lock);
1034 list_for_each_entry_safe(cldev, next, &bus->device_list, bus_list)
1035 mei_cl_bus_remove_device(cldev);
1036 mutex_unlock(&bus->cl_bus_lock);
1041 * mei_cl_bus_dev_init - allocate and initializes an mei client devices
1042 * based on me client
1044 * @bus: mei device
1045 * @me_cl: me client
1047 * Locking: called under "dev->cl_bus_lock" lock
1049 static void mei_cl_bus_dev_init(struct mei_device *bus,
1050 struct mei_me_client *me_cl)
1052 struct mei_cl_device *cldev;
1054 WARN_ON(!mutex_is_locked(&bus->cl_bus_lock));
1056 dev_dbg(bus->dev, "initializing %pUl", mei_me_cl_uuid(me_cl));
1058 if (me_cl->bus_added)
1059 return;
1061 cldev = mei_cl_bus_dev_alloc(bus, me_cl);
1062 if (!cldev)
1063 return;
1065 me_cl->bus_added = true;
1066 list_add_tail(&cldev->bus_list, &bus->device_list);
1071 * mei_cl_bus_rescan - scan me clients list and add create
1072 * devices for eligible clients
1074 * @bus: mei device
1076 static void mei_cl_bus_rescan(struct mei_device *bus)
1078 struct mei_cl_device *cldev, *n;
1079 struct mei_me_client *me_cl;
1081 mutex_lock(&bus->cl_bus_lock);
1083 down_read(&bus->me_clients_rwsem);
1084 list_for_each_entry(me_cl, &bus->me_clients, list)
1085 mei_cl_bus_dev_init(bus, me_cl);
1086 up_read(&bus->me_clients_rwsem);
1088 list_for_each_entry_safe(cldev, n, &bus->device_list, bus_list) {
1090 if (!mei_me_cl_is_active(cldev->me_cl)) {
1091 mei_cl_bus_remove_device(cldev);
1092 continue;
1095 if (cldev->is_added)
1096 continue;
1098 if (mei_cl_bus_dev_setup(bus, cldev))
1099 mei_cl_bus_dev_add(cldev);
1100 else {
1101 list_del_init(&cldev->bus_list);
1102 put_device(&cldev->dev);
1105 mutex_unlock(&bus->cl_bus_lock);
1107 dev_dbg(bus->dev, "rescan end");
1110 void mei_cl_bus_rescan_work(struct work_struct *work)
1112 struct mei_device *bus =
1113 container_of(work, struct mei_device, bus_rescan_work);
1115 mei_cl_bus_rescan(bus);
1118 int __mei_cldev_driver_register(struct mei_cl_driver *cldrv,
1119 struct module *owner)
1121 int err;
1123 cldrv->driver.name = cldrv->name;
1124 cldrv->driver.owner = owner;
1125 cldrv->driver.bus = &mei_cl_bus_type;
1127 err = driver_register(&cldrv->driver);
1128 if (err)
1129 return err;
1131 pr_debug("mei: driver [%s] registered\n", cldrv->driver.name);
1133 return 0;
1135 EXPORT_SYMBOL_GPL(__mei_cldev_driver_register);
1137 void mei_cldev_driver_unregister(struct mei_cl_driver *cldrv)
1139 driver_unregister(&cldrv->driver);
1141 pr_debug("mei: driver [%s] unregistered\n", cldrv->driver.name);
1143 EXPORT_SYMBOL_GPL(mei_cldev_driver_unregister);
1146 int __init mei_cl_bus_init(void)
1148 return bus_register(&mei_cl_bus_type);
1151 void __exit mei_cl_bus_exit(void)
1153 bus_unregister(&mei_cl_bus_type);