When stopping the MEI, we should remove and potentially unregister
all bus devices queued on the mei_dev linked list.

Signed-off-by: Tomas Winkler <[email protected]>
---
 drivers/misc/mei/bus.c     | 16 ++++++++++++++++
 drivers/misc/mei/init.c    |  2 ++
 drivers/misc/mei/mei_dev.h |  1 +
 drivers/misc/mei/nfc.c     |  8 +-------
 4 files changed, 20 insertions(+), 7 deletions(-)

diff --git a/drivers/misc/mei/bus.c b/drivers/misc/mei/bus.c
index 4bc7d62..cf4cc0b 100644
--- a/drivers/misc/mei/bus.c
+++ b/drivers/misc/mei/bus.c
@@ -524,6 +524,22 @@ void mei_cl_bus_rx_event(struct mei_cl *cl)
        schedule_work(&device->event_work);
 }
 
+void mei_cl_bus_remove_devices(struct mei_device *dev)
+{
+       struct mei_cl *cl, *next;
+
+       mutex_lock(&dev->device_lock);
+       list_for_each_entry_safe(cl, next, &dev->device_list, device_link) {
+               if (cl->device)
+                       mei_cl_remove_device(cl->device);
+
+               list_del(&cl->device_link);
+               mei_cl_unlink(cl);
+               kfree(cl);
+       }
+       mutex_unlock(&dev->device_lock);
+}
+
 int __init mei_cl_bus_init(void)
 {
        return bus_register(&mei_cl_bus_type);
diff --git a/drivers/misc/mei/init.c b/drivers/misc/mei/init.c
index 214dcef..4460975 100644
--- a/drivers/misc/mei/init.c
+++ b/drivers/misc/mei/init.c
@@ -288,6 +288,8 @@ void mei_stop(struct mei_device *dev)
 
        mei_nfc_host_exit(dev);
 
+       mei_cl_bus_remove_devices(dev);
+
        mutex_lock(&dev->device_lock);
 
        mei_wd_stop(dev);
diff --git a/drivers/misc/mei/mei_dev.h b/drivers/misc/mei/mei_dev.h
index 49bf2cf..c59c56b 100644
--- a/drivers/misc/mei/mei_dev.h
+++ b/drivers/misc/mei/mei_dev.h
@@ -296,6 +296,7 @@ int __mei_cl_async_send(struct mei_cl *cl, u8 *buf, size_t 
length);
 int __mei_cl_send(struct mei_cl *cl, u8 *buf, size_t length);
 int __mei_cl_recv(struct mei_cl *cl, u8 *buf, size_t length);
 void mei_cl_bus_rx_event(struct mei_cl *cl);
+void mei_cl_bus_remove_devices(struct mei_device *dev);
 int mei_cl_bus_init(void);
 void mei_cl_bus_exit(void);
 
diff --git a/drivers/misc/mei/nfc.c b/drivers/misc/mei/nfc.c
index a58320c..7626dde 100644
--- a/drivers/misc/mei/nfc.c
+++ b/drivers/misc/mei/nfc.c
@@ -552,13 +552,7 @@ err:
 void mei_nfc_host_exit(struct mei_device *dev)
 {
        struct mei_nfc_dev *ndev = &nfc_dev;
-
        cancel_work_sync(&ndev->init_work);
+}
 
-       mutex_lock(&dev->device_lock);
-       if (ndev->cl && ndev->cl->device)
-               mei_cl_remove_device(ndev->cl->device);
 
-       mei_nfc_free(ndev);
-       mutex_unlock(&dev->device_lock);
-}
-- 
1.8.5.3

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to [email protected]
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Reply via email to