1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright (c) 2012-2019, Intel Corporation. All rights reserved.
4*4882a593Smuzhiyun * Intel Management Engine Interface (Intel MEI) Linux driver
5*4882a593Smuzhiyun */
6*4882a593Smuzhiyun
7*4882a593Smuzhiyun #include <linux/module.h>
8*4882a593Smuzhiyun #include <linux/device.h>
9*4882a593Smuzhiyun #include <linux/kernel.h>
10*4882a593Smuzhiyun #include <linux/sched/signal.h>
11*4882a593Smuzhiyun #include <linux/init.h>
12*4882a593Smuzhiyun #include <linux/errno.h>
13*4882a593Smuzhiyun #include <linux/slab.h>
14*4882a593Smuzhiyun #include <linux/mutex.h>
15*4882a593Smuzhiyun #include <linux/interrupt.h>
16*4882a593Smuzhiyun #include <linux/mei_cl_bus.h>
17*4882a593Smuzhiyun
18*4882a593Smuzhiyun #include "mei_dev.h"
19*4882a593Smuzhiyun #include "client.h"
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun #define to_mei_cl_driver(d) container_of(d, struct mei_cl_driver, driver)
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun /**
24*4882a593Smuzhiyun * __mei_cl_send - internal client send (write)
25*4882a593Smuzhiyun *
26*4882a593Smuzhiyun * @cl: host client
27*4882a593Smuzhiyun * @buf: buffer to send
28*4882a593Smuzhiyun * @length: buffer length
29*4882a593Smuzhiyun * @mode: sending mode
30*4882a593Smuzhiyun *
31*4882a593Smuzhiyun * Return: written size bytes or < 0 on error
32*4882a593Smuzhiyun */
__mei_cl_send(struct mei_cl * cl,u8 * buf,size_t length,unsigned int mode)33*4882a593Smuzhiyun ssize_t __mei_cl_send(struct mei_cl *cl, u8 *buf, size_t length,
34*4882a593Smuzhiyun unsigned int mode)
35*4882a593Smuzhiyun {
36*4882a593Smuzhiyun struct mei_device *bus;
37*4882a593Smuzhiyun struct mei_cl_cb *cb;
38*4882a593Smuzhiyun ssize_t rets;
39*4882a593Smuzhiyun
40*4882a593Smuzhiyun if (WARN_ON(!cl || !cl->dev))
41*4882a593Smuzhiyun return -ENODEV;
42*4882a593Smuzhiyun
43*4882a593Smuzhiyun bus = cl->dev;
44*4882a593Smuzhiyun
45*4882a593Smuzhiyun mutex_lock(&bus->device_lock);
46*4882a593Smuzhiyun if (bus->dev_state != MEI_DEV_ENABLED) {
47*4882a593Smuzhiyun rets = -ENODEV;
48*4882a593Smuzhiyun goto out;
49*4882a593Smuzhiyun }
50*4882a593Smuzhiyun
51*4882a593Smuzhiyun if (!mei_cl_is_connected(cl)) {
52*4882a593Smuzhiyun rets = -ENODEV;
53*4882a593Smuzhiyun goto out;
54*4882a593Smuzhiyun }
55*4882a593Smuzhiyun
56*4882a593Smuzhiyun /* Check if we have an ME client device */
57*4882a593Smuzhiyun if (!mei_me_cl_is_active(cl->me_cl)) {
58*4882a593Smuzhiyun rets = -ENOTTY;
59*4882a593Smuzhiyun goto out;
60*4882a593Smuzhiyun }
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun if (length > mei_cl_mtu(cl)) {
63*4882a593Smuzhiyun rets = -EFBIG;
64*4882a593Smuzhiyun goto out;
65*4882a593Smuzhiyun }
66*4882a593Smuzhiyun
67*4882a593Smuzhiyun while (cl->tx_cb_queued >= bus->tx_queue_limit) {
68*4882a593Smuzhiyun mutex_unlock(&bus->device_lock);
69*4882a593Smuzhiyun rets = wait_event_interruptible(cl->tx_wait,
70*4882a593Smuzhiyun cl->writing_state == MEI_WRITE_COMPLETE ||
71*4882a593Smuzhiyun (!mei_cl_is_connected(cl)));
72*4882a593Smuzhiyun mutex_lock(&bus->device_lock);
73*4882a593Smuzhiyun if (rets) {
74*4882a593Smuzhiyun if (signal_pending(current))
75*4882a593Smuzhiyun rets = -EINTR;
76*4882a593Smuzhiyun goto out;
77*4882a593Smuzhiyun }
78*4882a593Smuzhiyun if (!mei_cl_is_connected(cl)) {
79*4882a593Smuzhiyun rets = -ENODEV;
80*4882a593Smuzhiyun goto out;
81*4882a593Smuzhiyun }
82*4882a593Smuzhiyun }
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun cb = mei_cl_alloc_cb(cl, length, MEI_FOP_WRITE, NULL);
85*4882a593Smuzhiyun if (!cb) {
86*4882a593Smuzhiyun rets = -ENOMEM;
87*4882a593Smuzhiyun goto out;
88*4882a593Smuzhiyun }
89*4882a593Smuzhiyun
90*4882a593Smuzhiyun cb->internal = !!(mode & MEI_CL_IO_TX_INTERNAL);
91*4882a593Smuzhiyun cb->blocking = !!(mode & MEI_CL_IO_TX_BLOCKING);
92*4882a593Smuzhiyun memcpy(cb->buf.data, buf, length);
93*4882a593Smuzhiyun
94*4882a593Smuzhiyun rets = mei_cl_write(cl, cb);
95*4882a593Smuzhiyun
96*4882a593Smuzhiyun out:
97*4882a593Smuzhiyun mutex_unlock(&bus->device_lock);
98*4882a593Smuzhiyun
99*4882a593Smuzhiyun return rets;
100*4882a593Smuzhiyun }
101*4882a593Smuzhiyun
102*4882a593Smuzhiyun /**
103*4882a593Smuzhiyun * __mei_cl_recv - internal client receive (read)
104*4882a593Smuzhiyun *
105*4882a593Smuzhiyun * @cl: host client
106*4882a593Smuzhiyun * @buf: buffer to receive
107*4882a593Smuzhiyun * @length: buffer length
108*4882a593Smuzhiyun * @mode: io mode
109*4882a593Smuzhiyun * @timeout: recv timeout, 0 for infinite timeout
110*4882a593Smuzhiyun *
111*4882a593Smuzhiyun * Return: read size in bytes of < 0 on error
112*4882a593Smuzhiyun */
__mei_cl_recv(struct mei_cl * cl,u8 * buf,size_t length,unsigned int mode,unsigned long timeout)113*4882a593Smuzhiyun ssize_t __mei_cl_recv(struct mei_cl *cl, u8 *buf, size_t length,
114*4882a593Smuzhiyun unsigned int mode, unsigned long timeout)
115*4882a593Smuzhiyun {
116*4882a593Smuzhiyun struct mei_device *bus;
117*4882a593Smuzhiyun struct mei_cl_cb *cb;
118*4882a593Smuzhiyun size_t r_length;
119*4882a593Smuzhiyun ssize_t rets;
120*4882a593Smuzhiyun bool nonblock = !!(mode & MEI_CL_IO_RX_NONBLOCK);
121*4882a593Smuzhiyun
122*4882a593Smuzhiyun if (WARN_ON(!cl || !cl->dev))
123*4882a593Smuzhiyun return -ENODEV;
124*4882a593Smuzhiyun
125*4882a593Smuzhiyun bus = cl->dev;
126*4882a593Smuzhiyun
127*4882a593Smuzhiyun mutex_lock(&bus->device_lock);
128*4882a593Smuzhiyun if (bus->dev_state != MEI_DEV_ENABLED) {
129*4882a593Smuzhiyun rets = -ENODEV;
130*4882a593Smuzhiyun goto out;
131*4882a593Smuzhiyun }
132*4882a593Smuzhiyun
133*4882a593Smuzhiyun cb = mei_cl_read_cb(cl, NULL);
134*4882a593Smuzhiyun if (cb)
135*4882a593Smuzhiyun goto copy;
136*4882a593Smuzhiyun
137*4882a593Smuzhiyun rets = mei_cl_read_start(cl, length, NULL);
138*4882a593Smuzhiyun if (rets && rets != -EBUSY)
139*4882a593Smuzhiyun goto out;
140*4882a593Smuzhiyun
141*4882a593Smuzhiyun if (nonblock) {
142*4882a593Smuzhiyun rets = -EAGAIN;
143*4882a593Smuzhiyun goto out;
144*4882a593Smuzhiyun }
145*4882a593Smuzhiyun
146*4882a593Smuzhiyun /* wait on event only if there is no other waiter */
147*4882a593Smuzhiyun /* synchronized under device mutex */
148*4882a593Smuzhiyun if (!waitqueue_active(&cl->rx_wait)) {
149*4882a593Smuzhiyun
150*4882a593Smuzhiyun mutex_unlock(&bus->device_lock);
151*4882a593Smuzhiyun
152*4882a593Smuzhiyun if (timeout) {
153*4882a593Smuzhiyun rets = wait_event_interruptible_timeout
154*4882a593Smuzhiyun (cl->rx_wait,
155*4882a593Smuzhiyun mei_cl_read_cb(cl, NULL) ||
156*4882a593Smuzhiyun (!mei_cl_is_connected(cl)),
157*4882a593Smuzhiyun msecs_to_jiffies(timeout));
158*4882a593Smuzhiyun if (rets == 0)
159*4882a593Smuzhiyun return -ETIME;
160*4882a593Smuzhiyun if (rets < 0) {
161*4882a593Smuzhiyun if (signal_pending(current))
162*4882a593Smuzhiyun return -EINTR;
163*4882a593Smuzhiyun return -ERESTARTSYS;
164*4882a593Smuzhiyun }
165*4882a593Smuzhiyun } else {
166*4882a593Smuzhiyun if (wait_event_interruptible
167*4882a593Smuzhiyun (cl->rx_wait,
168*4882a593Smuzhiyun mei_cl_read_cb(cl, NULL) ||
169*4882a593Smuzhiyun (!mei_cl_is_connected(cl)))) {
170*4882a593Smuzhiyun if (signal_pending(current))
171*4882a593Smuzhiyun return -EINTR;
172*4882a593Smuzhiyun return -ERESTARTSYS;
173*4882a593Smuzhiyun }
174*4882a593Smuzhiyun }
175*4882a593Smuzhiyun
176*4882a593Smuzhiyun mutex_lock(&bus->device_lock);
177*4882a593Smuzhiyun
178*4882a593Smuzhiyun if (!mei_cl_is_connected(cl)) {
179*4882a593Smuzhiyun rets = -ENODEV;
180*4882a593Smuzhiyun goto out;
181*4882a593Smuzhiyun }
182*4882a593Smuzhiyun }
183*4882a593Smuzhiyun
184*4882a593Smuzhiyun cb = mei_cl_read_cb(cl, NULL);
185*4882a593Smuzhiyun if (!cb) {
186*4882a593Smuzhiyun rets = 0;
187*4882a593Smuzhiyun goto out;
188*4882a593Smuzhiyun }
189*4882a593Smuzhiyun
190*4882a593Smuzhiyun copy:
191*4882a593Smuzhiyun if (cb->status) {
192*4882a593Smuzhiyun rets = cb->status;
193*4882a593Smuzhiyun goto free;
194*4882a593Smuzhiyun }
195*4882a593Smuzhiyun
196*4882a593Smuzhiyun r_length = min_t(size_t, length, cb->buf_idx);
197*4882a593Smuzhiyun memcpy(buf, cb->buf.data, r_length);
198*4882a593Smuzhiyun rets = r_length;
199*4882a593Smuzhiyun
200*4882a593Smuzhiyun free:
201*4882a593Smuzhiyun mei_cl_del_rd_completed(cl, cb);
202*4882a593Smuzhiyun out:
203*4882a593Smuzhiyun mutex_unlock(&bus->device_lock);
204*4882a593Smuzhiyun
205*4882a593Smuzhiyun return rets;
206*4882a593Smuzhiyun }
207*4882a593Smuzhiyun
208*4882a593Smuzhiyun /**
209*4882a593Smuzhiyun * mei_cldev_send - me device send (write)
210*4882a593Smuzhiyun *
211*4882a593Smuzhiyun * @cldev: me client device
212*4882a593Smuzhiyun * @buf: buffer to send
213*4882a593Smuzhiyun * @length: buffer length
214*4882a593Smuzhiyun *
215*4882a593Smuzhiyun * Return: written size in bytes or < 0 on error
216*4882a593Smuzhiyun */
mei_cldev_send(struct mei_cl_device * cldev,u8 * buf,size_t length)217*4882a593Smuzhiyun ssize_t mei_cldev_send(struct mei_cl_device *cldev, u8 *buf, size_t length)
218*4882a593Smuzhiyun {
219*4882a593Smuzhiyun struct mei_cl *cl = cldev->cl;
220*4882a593Smuzhiyun
221*4882a593Smuzhiyun return __mei_cl_send(cl, buf, length, MEI_CL_IO_TX_BLOCKING);
222*4882a593Smuzhiyun }
223*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mei_cldev_send);
224*4882a593Smuzhiyun
225*4882a593Smuzhiyun /**
226*4882a593Smuzhiyun * mei_cldev_recv_nonblock - non block client receive (read)
227*4882a593Smuzhiyun *
228*4882a593Smuzhiyun * @cldev: me client device
229*4882a593Smuzhiyun * @buf: buffer to receive
230*4882a593Smuzhiyun * @length: buffer length
231*4882a593Smuzhiyun *
232*4882a593Smuzhiyun * Return: read size in bytes of < 0 on error
233*4882a593Smuzhiyun * -EAGAIN if function will block.
234*4882a593Smuzhiyun */
mei_cldev_recv_nonblock(struct mei_cl_device * cldev,u8 * buf,size_t length)235*4882a593Smuzhiyun ssize_t mei_cldev_recv_nonblock(struct mei_cl_device *cldev, u8 *buf,
236*4882a593Smuzhiyun size_t length)
237*4882a593Smuzhiyun {
238*4882a593Smuzhiyun struct mei_cl *cl = cldev->cl;
239*4882a593Smuzhiyun
240*4882a593Smuzhiyun return __mei_cl_recv(cl, buf, length, MEI_CL_IO_RX_NONBLOCK, 0);
241*4882a593Smuzhiyun }
242*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mei_cldev_recv_nonblock);
243*4882a593Smuzhiyun
244*4882a593Smuzhiyun /**
245*4882a593Smuzhiyun * mei_cldev_recv - client receive (read)
246*4882a593Smuzhiyun *
247*4882a593Smuzhiyun * @cldev: me client device
248*4882a593Smuzhiyun * @buf: buffer to receive
249*4882a593Smuzhiyun * @length: buffer length
250*4882a593Smuzhiyun *
251*4882a593Smuzhiyun * Return: read size in bytes of < 0 on error
252*4882a593Smuzhiyun */
mei_cldev_recv(struct mei_cl_device * cldev,u8 * buf,size_t length)253*4882a593Smuzhiyun ssize_t mei_cldev_recv(struct mei_cl_device *cldev, u8 *buf, size_t length)
254*4882a593Smuzhiyun {
255*4882a593Smuzhiyun struct mei_cl *cl = cldev->cl;
256*4882a593Smuzhiyun
257*4882a593Smuzhiyun return __mei_cl_recv(cl, buf, length, 0, 0);
258*4882a593Smuzhiyun }
259*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mei_cldev_recv);
260*4882a593Smuzhiyun
261*4882a593Smuzhiyun /**
262*4882a593Smuzhiyun * mei_cl_bus_rx_work - dispatch rx event for a bus device
263*4882a593Smuzhiyun *
264*4882a593Smuzhiyun * @work: work
265*4882a593Smuzhiyun */
mei_cl_bus_rx_work(struct work_struct * work)266*4882a593Smuzhiyun static void mei_cl_bus_rx_work(struct work_struct *work)
267*4882a593Smuzhiyun {
268*4882a593Smuzhiyun struct mei_cl_device *cldev;
269*4882a593Smuzhiyun struct mei_device *bus;
270*4882a593Smuzhiyun
271*4882a593Smuzhiyun cldev = container_of(work, struct mei_cl_device, rx_work);
272*4882a593Smuzhiyun
273*4882a593Smuzhiyun bus = cldev->bus;
274*4882a593Smuzhiyun
275*4882a593Smuzhiyun if (cldev->rx_cb)
276*4882a593Smuzhiyun cldev->rx_cb(cldev);
277*4882a593Smuzhiyun
278*4882a593Smuzhiyun mutex_lock(&bus->device_lock);
279*4882a593Smuzhiyun mei_cl_read_start(cldev->cl, mei_cl_mtu(cldev->cl), NULL);
280*4882a593Smuzhiyun mutex_unlock(&bus->device_lock);
281*4882a593Smuzhiyun }
282*4882a593Smuzhiyun
283*4882a593Smuzhiyun /**
284*4882a593Smuzhiyun * mei_cl_bus_notif_work - dispatch FW notif event for a bus device
285*4882a593Smuzhiyun *
286*4882a593Smuzhiyun * @work: work
287*4882a593Smuzhiyun */
mei_cl_bus_notif_work(struct work_struct * work)288*4882a593Smuzhiyun static void mei_cl_bus_notif_work(struct work_struct *work)
289*4882a593Smuzhiyun {
290*4882a593Smuzhiyun struct mei_cl_device *cldev;
291*4882a593Smuzhiyun
292*4882a593Smuzhiyun cldev = container_of(work, struct mei_cl_device, notif_work);
293*4882a593Smuzhiyun
294*4882a593Smuzhiyun if (cldev->notif_cb)
295*4882a593Smuzhiyun cldev->notif_cb(cldev);
296*4882a593Smuzhiyun }
297*4882a593Smuzhiyun
298*4882a593Smuzhiyun /**
299*4882a593Smuzhiyun * mei_cl_bus_notify_event - schedule notify cb on bus client
300*4882a593Smuzhiyun *
301*4882a593Smuzhiyun * @cl: host client
302*4882a593Smuzhiyun *
303*4882a593Smuzhiyun * Return: true if event was scheduled
304*4882a593Smuzhiyun * false if the client is not waiting for event
305*4882a593Smuzhiyun */
mei_cl_bus_notify_event(struct mei_cl * cl)306*4882a593Smuzhiyun bool mei_cl_bus_notify_event(struct mei_cl *cl)
307*4882a593Smuzhiyun {
308*4882a593Smuzhiyun struct mei_cl_device *cldev = cl->cldev;
309*4882a593Smuzhiyun
310*4882a593Smuzhiyun if (!cldev || !cldev->notif_cb)
311*4882a593Smuzhiyun return false;
312*4882a593Smuzhiyun
313*4882a593Smuzhiyun if (!cl->notify_ev)
314*4882a593Smuzhiyun return false;
315*4882a593Smuzhiyun
316*4882a593Smuzhiyun schedule_work(&cldev->notif_work);
317*4882a593Smuzhiyun
318*4882a593Smuzhiyun cl->notify_ev = false;
319*4882a593Smuzhiyun
320*4882a593Smuzhiyun return true;
321*4882a593Smuzhiyun }
322*4882a593Smuzhiyun
323*4882a593Smuzhiyun /**
324*4882a593Smuzhiyun * mei_cl_bus_rx_event - schedule rx event
325*4882a593Smuzhiyun *
326*4882a593Smuzhiyun * @cl: host client
327*4882a593Smuzhiyun *
328*4882a593Smuzhiyun * Return: true if event was scheduled
329*4882a593Smuzhiyun * false if the client is not waiting for event
330*4882a593Smuzhiyun */
mei_cl_bus_rx_event(struct mei_cl * cl)331*4882a593Smuzhiyun bool mei_cl_bus_rx_event(struct mei_cl *cl)
332*4882a593Smuzhiyun {
333*4882a593Smuzhiyun struct mei_cl_device *cldev = cl->cldev;
334*4882a593Smuzhiyun
335*4882a593Smuzhiyun if (!cldev || !cldev->rx_cb)
336*4882a593Smuzhiyun return false;
337*4882a593Smuzhiyun
338*4882a593Smuzhiyun schedule_work(&cldev->rx_work);
339*4882a593Smuzhiyun
340*4882a593Smuzhiyun return true;
341*4882a593Smuzhiyun }
342*4882a593Smuzhiyun
343*4882a593Smuzhiyun /**
344*4882a593Smuzhiyun * mei_cldev_register_rx_cb - register Rx event callback
345*4882a593Smuzhiyun *
346*4882a593Smuzhiyun * @cldev: me client devices
347*4882a593Smuzhiyun * @rx_cb: callback function
348*4882a593Smuzhiyun *
349*4882a593Smuzhiyun * Return: 0 on success
350*4882a593Smuzhiyun * -EALREADY if an callback is already registered
351*4882a593Smuzhiyun * <0 on other errors
352*4882a593Smuzhiyun */
mei_cldev_register_rx_cb(struct mei_cl_device * cldev,mei_cldev_cb_t rx_cb)353*4882a593Smuzhiyun int mei_cldev_register_rx_cb(struct mei_cl_device *cldev, mei_cldev_cb_t rx_cb)
354*4882a593Smuzhiyun {
355*4882a593Smuzhiyun struct mei_device *bus = cldev->bus;
356*4882a593Smuzhiyun int ret;
357*4882a593Smuzhiyun
358*4882a593Smuzhiyun if (!rx_cb)
359*4882a593Smuzhiyun return -EINVAL;
360*4882a593Smuzhiyun if (cldev->rx_cb)
361*4882a593Smuzhiyun return -EALREADY;
362*4882a593Smuzhiyun
363*4882a593Smuzhiyun cldev->rx_cb = rx_cb;
364*4882a593Smuzhiyun INIT_WORK(&cldev->rx_work, mei_cl_bus_rx_work);
365*4882a593Smuzhiyun
366*4882a593Smuzhiyun mutex_lock(&bus->device_lock);
367*4882a593Smuzhiyun ret = mei_cl_read_start(cldev->cl, mei_cl_mtu(cldev->cl), NULL);
368*4882a593Smuzhiyun mutex_unlock(&bus->device_lock);
369*4882a593Smuzhiyun if (ret && ret != -EBUSY)
370*4882a593Smuzhiyun return ret;
371*4882a593Smuzhiyun
372*4882a593Smuzhiyun return 0;
373*4882a593Smuzhiyun }
374*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mei_cldev_register_rx_cb);
375*4882a593Smuzhiyun
376*4882a593Smuzhiyun /**
377*4882a593Smuzhiyun * mei_cldev_register_notif_cb - register FW notification event callback
378*4882a593Smuzhiyun *
379*4882a593Smuzhiyun * @cldev: me client devices
380*4882a593Smuzhiyun * @notif_cb: callback function
381*4882a593Smuzhiyun *
382*4882a593Smuzhiyun * Return: 0 on success
383*4882a593Smuzhiyun * -EALREADY if an callback is already registered
384*4882a593Smuzhiyun * <0 on other errors
385*4882a593Smuzhiyun */
mei_cldev_register_notif_cb(struct mei_cl_device * cldev,mei_cldev_cb_t notif_cb)386*4882a593Smuzhiyun int mei_cldev_register_notif_cb(struct mei_cl_device *cldev,
387*4882a593Smuzhiyun mei_cldev_cb_t notif_cb)
388*4882a593Smuzhiyun {
389*4882a593Smuzhiyun struct mei_device *bus = cldev->bus;
390*4882a593Smuzhiyun int ret;
391*4882a593Smuzhiyun
392*4882a593Smuzhiyun if (!notif_cb)
393*4882a593Smuzhiyun return -EINVAL;
394*4882a593Smuzhiyun
395*4882a593Smuzhiyun if (cldev->notif_cb)
396*4882a593Smuzhiyun return -EALREADY;
397*4882a593Smuzhiyun
398*4882a593Smuzhiyun cldev->notif_cb = notif_cb;
399*4882a593Smuzhiyun INIT_WORK(&cldev->notif_work, mei_cl_bus_notif_work);
400*4882a593Smuzhiyun
401*4882a593Smuzhiyun mutex_lock(&bus->device_lock);
402*4882a593Smuzhiyun ret = mei_cl_notify_request(cldev->cl, NULL, 1);
403*4882a593Smuzhiyun mutex_unlock(&bus->device_lock);
404*4882a593Smuzhiyun if (ret)
405*4882a593Smuzhiyun return ret;
406*4882a593Smuzhiyun
407*4882a593Smuzhiyun return 0;
408*4882a593Smuzhiyun }
409*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mei_cldev_register_notif_cb);
410*4882a593Smuzhiyun
411*4882a593Smuzhiyun /**
412*4882a593Smuzhiyun * mei_cldev_get_drvdata - driver data getter
413*4882a593Smuzhiyun *
414*4882a593Smuzhiyun * @cldev: mei client device
415*4882a593Smuzhiyun *
416*4882a593Smuzhiyun * Return: driver private data
417*4882a593Smuzhiyun */
mei_cldev_get_drvdata(const struct mei_cl_device * cldev)418*4882a593Smuzhiyun void *mei_cldev_get_drvdata(const struct mei_cl_device *cldev)
419*4882a593Smuzhiyun {
420*4882a593Smuzhiyun return dev_get_drvdata(&cldev->dev);
421*4882a593Smuzhiyun }
422*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mei_cldev_get_drvdata);
423*4882a593Smuzhiyun
424*4882a593Smuzhiyun /**
425*4882a593Smuzhiyun * mei_cldev_set_drvdata - driver data setter
426*4882a593Smuzhiyun *
427*4882a593Smuzhiyun * @cldev: mei client device
428*4882a593Smuzhiyun * @data: data to store
429*4882a593Smuzhiyun */
mei_cldev_set_drvdata(struct mei_cl_device * cldev,void * data)430*4882a593Smuzhiyun void mei_cldev_set_drvdata(struct mei_cl_device *cldev, void *data)
431*4882a593Smuzhiyun {
432*4882a593Smuzhiyun dev_set_drvdata(&cldev->dev, data);
433*4882a593Smuzhiyun }
434*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mei_cldev_set_drvdata);
435*4882a593Smuzhiyun
436*4882a593Smuzhiyun /**
437*4882a593Smuzhiyun * mei_cldev_uuid - return uuid of the underlying me client
438*4882a593Smuzhiyun *
439*4882a593Smuzhiyun * @cldev: mei client device
440*4882a593Smuzhiyun *
441*4882a593Smuzhiyun * Return: me client uuid
442*4882a593Smuzhiyun */
mei_cldev_uuid(const struct mei_cl_device * cldev)443*4882a593Smuzhiyun const uuid_le *mei_cldev_uuid(const struct mei_cl_device *cldev)
444*4882a593Smuzhiyun {
445*4882a593Smuzhiyun return mei_me_cl_uuid(cldev->me_cl);
446*4882a593Smuzhiyun }
447*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mei_cldev_uuid);
448*4882a593Smuzhiyun
449*4882a593Smuzhiyun /**
450*4882a593Smuzhiyun * mei_cldev_ver - return protocol version of the underlying me client
451*4882a593Smuzhiyun *
452*4882a593Smuzhiyun * @cldev: mei client device
453*4882a593Smuzhiyun *
454*4882a593Smuzhiyun * Return: me client protocol version
455*4882a593Smuzhiyun */
mei_cldev_ver(const struct mei_cl_device * cldev)456*4882a593Smuzhiyun u8 mei_cldev_ver(const struct mei_cl_device *cldev)
457*4882a593Smuzhiyun {
458*4882a593Smuzhiyun return mei_me_cl_ver(cldev->me_cl);
459*4882a593Smuzhiyun }
460*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mei_cldev_ver);
461*4882a593Smuzhiyun
462*4882a593Smuzhiyun /**
463*4882a593Smuzhiyun * mei_cldev_enabled - check whether the device is enabled
464*4882a593Smuzhiyun *
465*4882a593Smuzhiyun * @cldev: mei client device
466*4882a593Smuzhiyun *
467*4882a593Smuzhiyun * Return: true if me client is initialized and connected
468*4882a593Smuzhiyun */
mei_cldev_enabled(struct mei_cl_device * cldev)469*4882a593Smuzhiyun bool mei_cldev_enabled(struct mei_cl_device *cldev)
470*4882a593Smuzhiyun {
471*4882a593Smuzhiyun return mei_cl_is_connected(cldev->cl);
472*4882a593Smuzhiyun }
473*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mei_cldev_enabled);
474*4882a593Smuzhiyun
475*4882a593Smuzhiyun /**
476*4882a593Smuzhiyun * mei_cl_bus_module_get - acquire module of the underlying
477*4882a593Smuzhiyun * hw driver.
478*4882a593Smuzhiyun *
479*4882a593Smuzhiyun * @cldev: mei client device
480*4882a593Smuzhiyun *
481*4882a593Smuzhiyun * Return: true on success; false if the module was removed.
482*4882a593Smuzhiyun */
mei_cl_bus_module_get(struct mei_cl_device * cldev)483*4882a593Smuzhiyun static bool mei_cl_bus_module_get(struct mei_cl_device *cldev)
484*4882a593Smuzhiyun {
485*4882a593Smuzhiyun return try_module_get(cldev->bus->dev->driver->owner);
486*4882a593Smuzhiyun }
487*4882a593Smuzhiyun
488*4882a593Smuzhiyun /**
489*4882a593Smuzhiyun * mei_cl_bus_module_put - release the underlying hw module.
490*4882a593Smuzhiyun *
491*4882a593Smuzhiyun * @cldev: mei client device
492*4882a593Smuzhiyun */
mei_cl_bus_module_put(struct mei_cl_device * cldev)493*4882a593Smuzhiyun static void mei_cl_bus_module_put(struct mei_cl_device *cldev)
494*4882a593Smuzhiyun {
495*4882a593Smuzhiyun module_put(cldev->bus->dev->driver->owner);
496*4882a593Smuzhiyun }
497*4882a593Smuzhiyun
498*4882a593Smuzhiyun /**
499*4882a593Smuzhiyun * mei_cl_bus_vtag - get bus vtag entry wrapper
500*4882a593Smuzhiyun * The tag for bus client is always first.
501*4882a593Smuzhiyun *
502*4882a593Smuzhiyun * @cl: host client
503*4882a593Smuzhiyun *
504*4882a593Smuzhiyun * Return: bus vtag or NULL
505*4882a593Smuzhiyun */
mei_cl_bus_vtag(struct mei_cl * cl)506*4882a593Smuzhiyun static inline struct mei_cl_vtag *mei_cl_bus_vtag(struct mei_cl *cl)
507*4882a593Smuzhiyun {
508*4882a593Smuzhiyun return list_first_entry_or_null(&cl->vtag_map,
509*4882a593Smuzhiyun struct mei_cl_vtag, list);
510*4882a593Smuzhiyun }
511*4882a593Smuzhiyun
512*4882a593Smuzhiyun /**
513*4882a593Smuzhiyun * mei_cl_bus_vtag_alloc - add bus client entry to vtag map
514*4882a593Smuzhiyun *
515*4882a593Smuzhiyun * @cldev: me client device
516*4882a593Smuzhiyun *
517*4882a593Smuzhiyun * Return:
518*4882a593Smuzhiyun * * 0 on success
519*4882a593Smuzhiyun * * -ENOMEM if memory allocation failed
520*4882a593Smuzhiyun */
mei_cl_bus_vtag_alloc(struct mei_cl_device * cldev)521*4882a593Smuzhiyun static int mei_cl_bus_vtag_alloc(struct mei_cl_device *cldev)
522*4882a593Smuzhiyun {
523*4882a593Smuzhiyun struct mei_cl *cl = cldev->cl;
524*4882a593Smuzhiyun struct mei_cl_vtag *cl_vtag;
525*4882a593Smuzhiyun
526*4882a593Smuzhiyun /*
527*4882a593Smuzhiyun * Bail out if the client does not supports vtags
528*4882a593Smuzhiyun * or has already allocated one
529*4882a593Smuzhiyun */
530*4882a593Smuzhiyun if (mei_cl_vt_support_check(cl) || mei_cl_bus_vtag(cl))
531*4882a593Smuzhiyun return 0;
532*4882a593Smuzhiyun
533*4882a593Smuzhiyun cl_vtag = mei_cl_vtag_alloc(NULL, 0);
534*4882a593Smuzhiyun if (IS_ERR(cl_vtag))
535*4882a593Smuzhiyun return -ENOMEM;
536*4882a593Smuzhiyun
537*4882a593Smuzhiyun list_add_tail(&cl_vtag->list, &cl->vtag_map);
538*4882a593Smuzhiyun
539*4882a593Smuzhiyun return 0;
540*4882a593Smuzhiyun }
541*4882a593Smuzhiyun
542*4882a593Smuzhiyun /**
543*4882a593Smuzhiyun * mei_cl_bus_vtag_free - remove the bus entry from vtag map
544*4882a593Smuzhiyun *
545*4882a593Smuzhiyun * @cldev: me client device
546*4882a593Smuzhiyun */
mei_cl_bus_vtag_free(struct mei_cl_device * cldev)547*4882a593Smuzhiyun static void mei_cl_bus_vtag_free(struct mei_cl_device *cldev)
548*4882a593Smuzhiyun {
549*4882a593Smuzhiyun struct mei_cl *cl = cldev->cl;
550*4882a593Smuzhiyun struct mei_cl_vtag *cl_vtag;
551*4882a593Smuzhiyun
552*4882a593Smuzhiyun cl_vtag = mei_cl_bus_vtag(cl);
553*4882a593Smuzhiyun if (!cl_vtag)
554*4882a593Smuzhiyun return;
555*4882a593Smuzhiyun
556*4882a593Smuzhiyun list_del(&cl_vtag->list);
557*4882a593Smuzhiyun kfree(cl_vtag);
558*4882a593Smuzhiyun }
559*4882a593Smuzhiyun
560*4882a593Smuzhiyun /**
561*4882a593Smuzhiyun * mei_cldev_enable - enable me client device
562*4882a593Smuzhiyun * create connection with me client
563*4882a593Smuzhiyun *
564*4882a593Smuzhiyun * @cldev: me client device
565*4882a593Smuzhiyun *
566*4882a593Smuzhiyun * Return: 0 on success and < 0 on error
567*4882a593Smuzhiyun */
mei_cldev_enable(struct mei_cl_device * cldev)568*4882a593Smuzhiyun int mei_cldev_enable(struct mei_cl_device *cldev)
569*4882a593Smuzhiyun {
570*4882a593Smuzhiyun struct mei_device *bus = cldev->bus;
571*4882a593Smuzhiyun struct mei_cl *cl;
572*4882a593Smuzhiyun int ret;
573*4882a593Smuzhiyun
574*4882a593Smuzhiyun cl = cldev->cl;
575*4882a593Smuzhiyun
576*4882a593Smuzhiyun mutex_lock(&bus->device_lock);
577*4882a593Smuzhiyun if (cl->state == MEI_FILE_UNINITIALIZED) {
578*4882a593Smuzhiyun ret = mei_cl_link(cl);
579*4882a593Smuzhiyun if (ret)
580*4882a593Smuzhiyun goto out;
581*4882a593Smuzhiyun /* update pointers */
582*4882a593Smuzhiyun cl->cldev = cldev;
583*4882a593Smuzhiyun }
584*4882a593Smuzhiyun
585*4882a593Smuzhiyun if (mei_cl_is_connected(cl)) {
586*4882a593Smuzhiyun ret = 0;
587*4882a593Smuzhiyun goto out;
588*4882a593Smuzhiyun }
589*4882a593Smuzhiyun
590*4882a593Smuzhiyun if (!mei_me_cl_is_active(cldev->me_cl)) {
591*4882a593Smuzhiyun dev_err(&cldev->dev, "me client is not active\n");
592*4882a593Smuzhiyun ret = -ENOTTY;
593*4882a593Smuzhiyun goto out;
594*4882a593Smuzhiyun }
595*4882a593Smuzhiyun
596*4882a593Smuzhiyun ret = mei_cl_bus_vtag_alloc(cldev);
597*4882a593Smuzhiyun if (ret)
598*4882a593Smuzhiyun goto out;
599*4882a593Smuzhiyun
600*4882a593Smuzhiyun ret = mei_cl_connect(cl, cldev->me_cl, NULL);
601*4882a593Smuzhiyun if (ret < 0) {
602*4882a593Smuzhiyun dev_err(&cldev->dev, "cannot connect\n");
603*4882a593Smuzhiyun mei_cl_bus_vtag_free(cldev);
604*4882a593Smuzhiyun }
605*4882a593Smuzhiyun
606*4882a593Smuzhiyun out:
607*4882a593Smuzhiyun mutex_unlock(&bus->device_lock);
608*4882a593Smuzhiyun
609*4882a593Smuzhiyun return ret;
610*4882a593Smuzhiyun }
611*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mei_cldev_enable);
612*4882a593Smuzhiyun
613*4882a593Smuzhiyun /**
614*4882a593Smuzhiyun * mei_cldev_unregister_callbacks - internal wrapper for unregistering
615*4882a593Smuzhiyun * callbacks.
616*4882a593Smuzhiyun *
617*4882a593Smuzhiyun * @cldev: client device
618*4882a593Smuzhiyun */
mei_cldev_unregister_callbacks(struct mei_cl_device * cldev)619*4882a593Smuzhiyun static void mei_cldev_unregister_callbacks(struct mei_cl_device *cldev)
620*4882a593Smuzhiyun {
621*4882a593Smuzhiyun if (cldev->rx_cb) {
622*4882a593Smuzhiyun cancel_work_sync(&cldev->rx_work);
623*4882a593Smuzhiyun cldev->rx_cb = NULL;
624*4882a593Smuzhiyun }
625*4882a593Smuzhiyun
626*4882a593Smuzhiyun if (cldev->notif_cb) {
627*4882a593Smuzhiyun cancel_work_sync(&cldev->notif_work);
628*4882a593Smuzhiyun cldev->notif_cb = NULL;
629*4882a593Smuzhiyun }
630*4882a593Smuzhiyun }
631*4882a593Smuzhiyun
632*4882a593Smuzhiyun /**
633*4882a593Smuzhiyun * mei_cldev_disable - disable me client device
634*4882a593Smuzhiyun * disconnect form the me client
635*4882a593Smuzhiyun *
636*4882a593Smuzhiyun * @cldev: me client device
637*4882a593Smuzhiyun *
638*4882a593Smuzhiyun * Return: 0 on success and < 0 on error
639*4882a593Smuzhiyun */
mei_cldev_disable(struct mei_cl_device * cldev)640*4882a593Smuzhiyun int mei_cldev_disable(struct mei_cl_device *cldev)
641*4882a593Smuzhiyun {
642*4882a593Smuzhiyun struct mei_device *bus;
643*4882a593Smuzhiyun struct mei_cl *cl;
644*4882a593Smuzhiyun int err;
645*4882a593Smuzhiyun
646*4882a593Smuzhiyun if (!cldev)
647*4882a593Smuzhiyun return -ENODEV;
648*4882a593Smuzhiyun
649*4882a593Smuzhiyun cl = cldev->cl;
650*4882a593Smuzhiyun
651*4882a593Smuzhiyun bus = cldev->bus;
652*4882a593Smuzhiyun
653*4882a593Smuzhiyun mei_cldev_unregister_callbacks(cldev);
654*4882a593Smuzhiyun
655*4882a593Smuzhiyun mutex_lock(&bus->device_lock);
656*4882a593Smuzhiyun
657*4882a593Smuzhiyun mei_cl_bus_vtag_free(cldev);
658*4882a593Smuzhiyun
659*4882a593Smuzhiyun if (!mei_cl_is_connected(cl)) {
660*4882a593Smuzhiyun dev_dbg(bus->dev, "Already disconnected\n");
661*4882a593Smuzhiyun err = 0;
662*4882a593Smuzhiyun goto out;
663*4882a593Smuzhiyun }
664*4882a593Smuzhiyun
665*4882a593Smuzhiyun err = mei_cl_disconnect(cl);
666*4882a593Smuzhiyun if (err < 0)
667*4882a593Smuzhiyun dev_err(bus->dev, "Could not disconnect from the ME client\n");
668*4882a593Smuzhiyun
669*4882a593Smuzhiyun out:
670*4882a593Smuzhiyun /* Flush queues and remove any pending read */
671*4882a593Smuzhiyun mei_cl_flush_queues(cl, NULL);
672*4882a593Smuzhiyun mei_cl_unlink(cl);
673*4882a593Smuzhiyun
674*4882a593Smuzhiyun mutex_unlock(&bus->device_lock);
675*4882a593Smuzhiyun return err;
676*4882a593Smuzhiyun }
677*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mei_cldev_disable);
678*4882a593Smuzhiyun
679*4882a593Smuzhiyun /**
680*4882a593Smuzhiyun * mei_cl_device_find - find matching entry in the driver id table
681*4882a593Smuzhiyun *
682*4882a593Smuzhiyun * @cldev: me client device
683*4882a593Smuzhiyun * @cldrv: me client driver
684*4882a593Smuzhiyun *
685*4882a593Smuzhiyun * Return: id on success; NULL if no id is matching
686*4882a593Smuzhiyun */
687*4882a593Smuzhiyun static const
mei_cl_device_find(struct mei_cl_device * cldev,struct mei_cl_driver * cldrv)688*4882a593Smuzhiyun struct mei_cl_device_id *mei_cl_device_find(struct mei_cl_device *cldev,
689*4882a593Smuzhiyun struct mei_cl_driver *cldrv)
690*4882a593Smuzhiyun {
691*4882a593Smuzhiyun const struct mei_cl_device_id *id;
692*4882a593Smuzhiyun const uuid_le *uuid;
693*4882a593Smuzhiyun u8 version;
694*4882a593Smuzhiyun bool match;
695*4882a593Smuzhiyun
696*4882a593Smuzhiyun uuid = mei_me_cl_uuid(cldev->me_cl);
697*4882a593Smuzhiyun version = mei_me_cl_ver(cldev->me_cl);
698*4882a593Smuzhiyun
699*4882a593Smuzhiyun id = cldrv->id_table;
700*4882a593Smuzhiyun while (uuid_le_cmp(NULL_UUID_LE, id->uuid)) {
701*4882a593Smuzhiyun if (!uuid_le_cmp(*uuid, id->uuid)) {
702*4882a593Smuzhiyun match = true;
703*4882a593Smuzhiyun
704*4882a593Smuzhiyun if (cldev->name[0])
705*4882a593Smuzhiyun if (strncmp(cldev->name, id->name,
706*4882a593Smuzhiyun sizeof(id->name)))
707*4882a593Smuzhiyun match = false;
708*4882a593Smuzhiyun
709*4882a593Smuzhiyun if (id->version != MEI_CL_VERSION_ANY)
710*4882a593Smuzhiyun if (id->version != version)
711*4882a593Smuzhiyun match = false;
712*4882a593Smuzhiyun if (match)
713*4882a593Smuzhiyun return id;
714*4882a593Smuzhiyun }
715*4882a593Smuzhiyun
716*4882a593Smuzhiyun id++;
717*4882a593Smuzhiyun }
718*4882a593Smuzhiyun
719*4882a593Smuzhiyun return NULL;
720*4882a593Smuzhiyun }
721*4882a593Smuzhiyun
722*4882a593Smuzhiyun /**
723*4882a593Smuzhiyun * mei_cl_device_match - device match function
724*4882a593Smuzhiyun *
725*4882a593Smuzhiyun * @dev: device
726*4882a593Smuzhiyun * @drv: driver
727*4882a593Smuzhiyun *
728*4882a593Smuzhiyun * Return: 1 if matching device was found 0 otherwise
729*4882a593Smuzhiyun */
mei_cl_device_match(struct device * dev,struct device_driver * drv)730*4882a593Smuzhiyun static int mei_cl_device_match(struct device *dev, struct device_driver *drv)
731*4882a593Smuzhiyun {
732*4882a593Smuzhiyun struct mei_cl_device *cldev = to_mei_cl_device(dev);
733*4882a593Smuzhiyun struct mei_cl_driver *cldrv = to_mei_cl_driver(drv);
734*4882a593Smuzhiyun const struct mei_cl_device_id *found_id;
735*4882a593Smuzhiyun
736*4882a593Smuzhiyun if (!cldev)
737*4882a593Smuzhiyun return 0;
738*4882a593Smuzhiyun
739*4882a593Smuzhiyun if (!cldev->do_match)
740*4882a593Smuzhiyun return 0;
741*4882a593Smuzhiyun
742*4882a593Smuzhiyun if (!cldrv || !cldrv->id_table)
743*4882a593Smuzhiyun return 0;
744*4882a593Smuzhiyun
745*4882a593Smuzhiyun found_id = mei_cl_device_find(cldev, cldrv);
746*4882a593Smuzhiyun if (found_id)
747*4882a593Smuzhiyun return 1;
748*4882a593Smuzhiyun
749*4882a593Smuzhiyun return 0;
750*4882a593Smuzhiyun }
751*4882a593Smuzhiyun
752*4882a593Smuzhiyun /**
753*4882a593Smuzhiyun * mei_cl_device_probe - bus probe function
754*4882a593Smuzhiyun *
755*4882a593Smuzhiyun * @dev: device
756*4882a593Smuzhiyun *
757*4882a593Smuzhiyun * Return: 0 on success; < 0 otherwise
758*4882a593Smuzhiyun */
mei_cl_device_probe(struct device * dev)759*4882a593Smuzhiyun static int mei_cl_device_probe(struct device *dev)
760*4882a593Smuzhiyun {
761*4882a593Smuzhiyun struct mei_cl_device *cldev;
762*4882a593Smuzhiyun struct mei_cl_driver *cldrv;
763*4882a593Smuzhiyun const struct mei_cl_device_id *id;
764*4882a593Smuzhiyun int ret;
765*4882a593Smuzhiyun
766*4882a593Smuzhiyun cldev = to_mei_cl_device(dev);
767*4882a593Smuzhiyun cldrv = to_mei_cl_driver(dev->driver);
768*4882a593Smuzhiyun
769*4882a593Smuzhiyun if (!cldev)
770*4882a593Smuzhiyun return 0;
771*4882a593Smuzhiyun
772*4882a593Smuzhiyun if (!cldrv || !cldrv->probe)
773*4882a593Smuzhiyun return -ENODEV;
774*4882a593Smuzhiyun
775*4882a593Smuzhiyun id = mei_cl_device_find(cldev, cldrv);
776*4882a593Smuzhiyun if (!id)
777*4882a593Smuzhiyun return -ENODEV;
778*4882a593Smuzhiyun
779*4882a593Smuzhiyun if (!mei_cl_bus_module_get(cldev)) {
780*4882a593Smuzhiyun dev_err(&cldev->dev, "get hw module failed");
781*4882a593Smuzhiyun return -ENODEV;
782*4882a593Smuzhiyun }
783*4882a593Smuzhiyun
784*4882a593Smuzhiyun ret = cldrv->probe(cldev, id);
785*4882a593Smuzhiyun if (ret) {
786*4882a593Smuzhiyun mei_cl_bus_module_put(cldev);
787*4882a593Smuzhiyun return ret;
788*4882a593Smuzhiyun }
789*4882a593Smuzhiyun
790*4882a593Smuzhiyun __module_get(THIS_MODULE);
791*4882a593Smuzhiyun return 0;
792*4882a593Smuzhiyun }
793*4882a593Smuzhiyun
794*4882a593Smuzhiyun /**
795*4882a593Smuzhiyun * mei_cl_device_remove - remove device from the bus
796*4882a593Smuzhiyun *
797*4882a593Smuzhiyun * @dev: device
798*4882a593Smuzhiyun *
799*4882a593Smuzhiyun * Return: 0 on success; < 0 otherwise
800*4882a593Smuzhiyun */
mei_cl_device_remove(struct device * dev)801*4882a593Smuzhiyun static int mei_cl_device_remove(struct device *dev)
802*4882a593Smuzhiyun {
803*4882a593Smuzhiyun struct mei_cl_device *cldev = to_mei_cl_device(dev);
804*4882a593Smuzhiyun struct mei_cl_driver *cldrv;
805*4882a593Smuzhiyun int ret = 0;
806*4882a593Smuzhiyun
807*4882a593Smuzhiyun if (!cldev || !dev->driver)
808*4882a593Smuzhiyun return 0;
809*4882a593Smuzhiyun
810*4882a593Smuzhiyun cldrv = to_mei_cl_driver(dev->driver);
811*4882a593Smuzhiyun if (cldrv->remove)
812*4882a593Smuzhiyun ret = cldrv->remove(cldev);
813*4882a593Smuzhiyun
814*4882a593Smuzhiyun mei_cldev_unregister_callbacks(cldev);
815*4882a593Smuzhiyun
816*4882a593Smuzhiyun mei_cl_bus_module_put(cldev);
817*4882a593Smuzhiyun module_put(THIS_MODULE);
818*4882a593Smuzhiyun
819*4882a593Smuzhiyun return ret;
820*4882a593Smuzhiyun }
821*4882a593Smuzhiyun
name_show(struct device * dev,struct device_attribute * a,char * buf)822*4882a593Smuzhiyun static ssize_t name_show(struct device *dev, struct device_attribute *a,
823*4882a593Smuzhiyun char *buf)
824*4882a593Smuzhiyun {
825*4882a593Smuzhiyun struct mei_cl_device *cldev = to_mei_cl_device(dev);
826*4882a593Smuzhiyun
827*4882a593Smuzhiyun return scnprintf(buf, PAGE_SIZE, "%s", cldev->name);
828*4882a593Smuzhiyun }
829*4882a593Smuzhiyun static DEVICE_ATTR_RO(name);
830*4882a593Smuzhiyun
uuid_show(struct device * dev,struct device_attribute * a,char * buf)831*4882a593Smuzhiyun static ssize_t uuid_show(struct device *dev, struct device_attribute *a,
832*4882a593Smuzhiyun char *buf)
833*4882a593Smuzhiyun {
834*4882a593Smuzhiyun struct mei_cl_device *cldev = to_mei_cl_device(dev);
835*4882a593Smuzhiyun const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl);
836*4882a593Smuzhiyun
837*4882a593Smuzhiyun return sprintf(buf, "%pUl", uuid);
838*4882a593Smuzhiyun }
839*4882a593Smuzhiyun static DEVICE_ATTR_RO(uuid);
840*4882a593Smuzhiyun
version_show(struct device * dev,struct device_attribute * a,char * buf)841*4882a593Smuzhiyun static ssize_t version_show(struct device *dev, struct device_attribute *a,
842*4882a593Smuzhiyun char *buf)
843*4882a593Smuzhiyun {
844*4882a593Smuzhiyun struct mei_cl_device *cldev = to_mei_cl_device(dev);
845*4882a593Smuzhiyun u8 version = mei_me_cl_ver(cldev->me_cl);
846*4882a593Smuzhiyun
847*4882a593Smuzhiyun return sprintf(buf, "%02X", version);
848*4882a593Smuzhiyun }
849*4882a593Smuzhiyun static DEVICE_ATTR_RO(version);
850*4882a593Smuzhiyun
modalias_show(struct device * dev,struct device_attribute * a,char * buf)851*4882a593Smuzhiyun static ssize_t modalias_show(struct device *dev, struct device_attribute *a,
852*4882a593Smuzhiyun char *buf)
853*4882a593Smuzhiyun {
854*4882a593Smuzhiyun struct mei_cl_device *cldev = to_mei_cl_device(dev);
855*4882a593Smuzhiyun const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl);
856*4882a593Smuzhiyun u8 version = mei_me_cl_ver(cldev->me_cl);
857*4882a593Smuzhiyun
858*4882a593Smuzhiyun return scnprintf(buf, PAGE_SIZE, "mei:%s:%pUl:%02X:",
859*4882a593Smuzhiyun cldev->name, uuid, version);
860*4882a593Smuzhiyun }
861*4882a593Smuzhiyun static DEVICE_ATTR_RO(modalias);
862*4882a593Smuzhiyun
max_conn_show(struct device * dev,struct device_attribute * a,char * buf)863*4882a593Smuzhiyun static ssize_t max_conn_show(struct device *dev, struct device_attribute *a,
864*4882a593Smuzhiyun char *buf)
865*4882a593Smuzhiyun {
866*4882a593Smuzhiyun struct mei_cl_device *cldev = to_mei_cl_device(dev);
867*4882a593Smuzhiyun u8 maxconn = mei_me_cl_max_conn(cldev->me_cl);
868*4882a593Smuzhiyun
869*4882a593Smuzhiyun return sprintf(buf, "%d", maxconn);
870*4882a593Smuzhiyun }
871*4882a593Smuzhiyun static DEVICE_ATTR_RO(max_conn);
872*4882a593Smuzhiyun
fixed_show(struct device * dev,struct device_attribute * a,char * buf)873*4882a593Smuzhiyun static ssize_t fixed_show(struct device *dev, struct device_attribute *a,
874*4882a593Smuzhiyun char *buf)
875*4882a593Smuzhiyun {
876*4882a593Smuzhiyun struct mei_cl_device *cldev = to_mei_cl_device(dev);
877*4882a593Smuzhiyun u8 fixed = mei_me_cl_fixed(cldev->me_cl);
878*4882a593Smuzhiyun
879*4882a593Smuzhiyun return sprintf(buf, "%d", fixed);
880*4882a593Smuzhiyun }
881*4882a593Smuzhiyun static DEVICE_ATTR_RO(fixed);
882*4882a593Smuzhiyun
vtag_show(struct device * dev,struct device_attribute * a,char * buf)883*4882a593Smuzhiyun static ssize_t vtag_show(struct device *dev, struct device_attribute *a,
884*4882a593Smuzhiyun char *buf)
885*4882a593Smuzhiyun {
886*4882a593Smuzhiyun struct mei_cl_device *cldev = to_mei_cl_device(dev);
887*4882a593Smuzhiyun bool vt = mei_me_cl_vt(cldev->me_cl);
888*4882a593Smuzhiyun
889*4882a593Smuzhiyun return sprintf(buf, "%d", vt);
890*4882a593Smuzhiyun }
891*4882a593Smuzhiyun static DEVICE_ATTR_RO(vtag);
892*4882a593Smuzhiyun
max_len_show(struct device * dev,struct device_attribute * a,char * buf)893*4882a593Smuzhiyun static ssize_t max_len_show(struct device *dev, struct device_attribute *a,
894*4882a593Smuzhiyun char *buf)
895*4882a593Smuzhiyun {
896*4882a593Smuzhiyun struct mei_cl_device *cldev = to_mei_cl_device(dev);
897*4882a593Smuzhiyun u32 maxlen = mei_me_cl_max_len(cldev->me_cl);
898*4882a593Smuzhiyun
899*4882a593Smuzhiyun return sprintf(buf, "%u", maxlen);
900*4882a593Smuzhiyun }
901*4882a593Smuzhiyun static DEVICE_ATTR_RO(max_len);
902*4882a593Smuzhiyun
903*4882a593Smuzhiyun static struct attribute *mei_cldev_attrs[] = {
904*4882a593Smuzhiyun &dev_attr_name.attr,
905*4882a593Smuzhiyun &dev_attr_uuid.attr,
906*4882a593Smuzhiyun &dev_attr_version.attr,
907*4882a593Smuzhiyun &dev_attr_modalias.attr,
908*4882a593Smuzhiyun &dev_attr_max_conn.attr,
909*4882a593Smuzhiyun &dev_attr_fixed.attr,
910*4882a593Smuzhiyun &dev_attr_vtag.attr,
911*4882a593Smuzhiyun &dev_attr_max_len.attr,
912*4882a593Smuzhiyun NULL,
913*4882a593Smuzhiyun };
914*4882a593Smuzhiyun ATTRIBUTE_GROUPS(mei_cldev);
915*4882a593Smuzhiyun
916*4882a593Smuzhiyun /**
917*4882a593Smuzhiyun * mei_cl_device_uevent - me client bus uevent handler
918*4882a593Smuzhiyun *
919*4882a593Smuzhiyun * @dev: device
920*4882a593Smuzhiyun * @env: uevent kobject
921*4882a593Smuzhiyun *
922*4882a593Smuzhiyun * Return: 0 on success -ENOMEM on when add_uevent_var fails
923*4882a593Smuzhiyun */
mei_cl_device_uevent(struct device * dev,struct kobj_uevent_env * env)924*4882a593Smuzhiyun static int mei_cl_device_uevent(struct device *dev, struct kobj_uevent_env *env)
925*4882a593Smuzhiyun {
926*4882a593Smuzhiyun struct mei_cl_device *cldev = to_mei_cl_device(dev);
927*4882a593Smuzhiyun const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl);
928*4882a593Smuzhiyun u8 version = mei_me_cl_ver(cldev->me_cl);
929*4882a593Smuzhiyun
930*4882a593Smuzhiyun if (add_uevent_var(env, "MEI_CL_VERSION=%d", version))
931*4882a593Smuzhiyun return -ENOMEM;
932*4882a593Smuzhiyun
933*4882a593Smuzhiyun if (add_uevent_var(env, "MEI_CL_UUID=%pUl", uuid))
934*4882a593Smuzhiyun return -ENOMEM;
935*4882a593Smuzhiyun
936*4882a593Smuzhiyun if (add_uevent_var(env, "MEI_CL_NAME=%s", cldev->name))
937*4882a593Smuzhiyun return -ENOMEM;
938*4882a593Smuzhiyun
939*4882a593Smuzhiyun if (add_uevent_var(env, "MODALIAS=mei:%s:%pUl:%02X:",
940*4882a593Smuzhiyun cldev->name, uuid, version))
941*4882a593Smuzhiyun return -ENOMEM;
942*4882a593Smuzhiyun
943*4882a593Smuzhiyun return 0;
944*4882a593Smuzhiyun }
945*4882a593Smuzhiyun
946*4882a593Smuzhiyun static struct bus_type mei_cl_bus_type = {
947*4882a593Smuzhiyun .name = "mei",
948*4882a593Smuzhiyun .dev_groups = mei_cldev_groups,
949*4882a593Smuzhiyun .match = mei_cl_device_match,
950*4882a593Smuzhiyun .probe = mei_cl_device_probe,
951*4882a593Smuzhiyun .remove = mei_cl_device_remove,
952*4882a593Smuzhiyun .uevent = mei_cl_device_uevent,
953*4882a593Smuzhiyun };
954*4882a593Smuzhiyun
mei_dev_bus_get(struct mei_device * bus)955*4882a593Smuzhiyun static struct mei_device *mei_dev_bus_get(struct mei_device *bus)
956*4882a593Smuzhiyun {
957*4882a593Smuzhiyun if (bus)
958*4882a593Smuzhiyun get_device(bus->dev);
959*4882a593Smuzhiyun
960*4882a593Smuzhiyun return bus;
961*4882a593Smuzhiyun }
962*4882a593Smuzhiyun
mei_dev_bus_put(struct mei_device * bus)963*4882a593Smuzhiyun static void mei_dev_bus_put(struct mei_device *bus)
964*4882a593Smuzhiyun {
965*4882a593Smuzhiyun if (bus)
966*4882a593Smuzhiyun put_device(bus->dev);
967*4882a593Smuzhiyun }
968*4882a593Smuzhiyun
mei_cl_bus_dev_release(struct device * dev)969*4882a593Smuzhiyun static void mei_cl_bus_dev_release(struct device *dev)
970*4882a593Smuzhiyun {
971*4882a593Smuzhiyun struct mei_cl_device *cldev = to_mei_cl_device(dev);
972*4882a593Smuzhiyun
973*4882a593Smuzhiyun if (!cldev)
974*4882a593Smuzhiyun return;
975*4882a593Smuzhiyun
976*4882a593Smuzhiyun mei_me_cl_put(cldev->me_cl);
977*4882a593Smuzhiyun mei_dev_bus_put(cldev->bus);
978*4882a593Smuzhiyun mei_cl_unlink(cldev->cl);
979*4882a593Smuzhiyun kfree(cldev->cl);
980*4882a593Smuzhiyun kfree(cldev);
981*4882a593Smuzhiyun }
982*4882a593Smuzhiyun
983*4882a593Smuzhiyun static const struct device_type mei_cl_device_type = {
984*4882a593Smuzhiyun .release = mei_cl_bus_dev_release,
985*4882a593Smuzhiyun };
986*4882a593Smuzhiyun
987*4882a593Smuzhiyun /**
988*4882a593Smuzhiyun * mei_cl_bus_set_name - set device name for me client device
989*4882a593Smuzhiyun * <controller>-<client device>
990*4882a593Smuzhiyun * Example: 0000:00:16.0-55213584-9a29-4916-badf-0fb7ed682aeb
991*4882a593Smuzhiyun *
992*4882a593Smuzhiyun * @cldev: me client device
993*4882a593Smuzhiyun */
mei_cl_bus_set_name(struct mei_cl_device * cldev)994*4882a593Smuzhiyun static inline void mei_cl_bus_set_name(struct mei_cl_device *cldev)
995*4882a593Smuzhiyun {
996*4882a593Smuzhiyun dev_set_name(&cldev->dev, "%s-%pUl",
997*4882a593Smuzhiyun dev_name(cldev->bus->dev),
998*4882a593Smuzhiyun mei_me_cl_uuid(cldev->me_cl));
999*4882a593Smuzhiyun }
1000*4882a593Smuzhiyun
1001*4882a593Smuzhiyun /**
1002*4882a593Smuzhiyun * mei_cl_bus_dev_alloc - initialize and allocate mei client device
1003*4882a593Smuzhiyun *
1004*4882a593Smuzhiyun * @bus: mei device
1005*4882a593Smuzhiyun * @me_cl: me client
1006*4882a593Smuzhiyun *
1007*4882a593Smuzhiyun * Return: allocated device structur or NULL on allocation failure
1008*4882a593Smuzhiyun */
mei_cl_bus_dev_alloc(struct mei_device * bus,struct mei_me_client * me_cl)1009*4882a593Smuzhiyun static struct mei_cl_device *mei_cl_bus_dev_alloc(struct mei_device *bus,
1010*4882a593Smuzhiyun struct mei_me_client *me_cl)
1011*4882a593Smuzhiyun {
1012*4882a593Smuzhiyun struct mei_cl_device *cldev;
1013*4882a593Smuzhiyun struct mei_cl *cl;
1014*4882a593Smuzhiyun
1015*4882a593Smuzhiyun cldev = kzalloc(sizeof(*cldev), GFP_KERNEL);
1016*4882a593Smuzhiyun if (!cldev)
1017*4882a593Smuzhiyun return NULL;
1018*4882a593Smuzhiyun
1019*4882a593Smuzhiyun cl = mei_cl_allocate(bus);
1020*4882a593Smuzhiyun if (!cl) {
1021*4882a593Smuzhiyun kfree(cldev);
1022*4882a593Smuzhiyun return NULL;
1023*4882a593Smuzhiyun }
1024*4882a593Smuzhiyun
1025*4882a593Smuzhiyun device_initialize(&cldev->dev);
1026*4882a593Smuzhiyun cldev->dev.parent = bus->dev;
1027*4882a593Smuzhiyun cldev->dev.bus = &mei_cl_bus_type;
1028*4882a593Smuzhiyun cldev->dev.type = &mei_cl_device_type;
1029*4882a593Smuzhiyun cldev->bus = mei_dev_bus_get(bus);
1030*4882a593Smuzhiyun cldev->me_cl = mei_me_cl_get(me_cl);
1031*4882a593Smuzhiyun cldev->cl = cl;
1032*4882a593Smuzhiyun mei_cl_bus_set_name(cldev);
1033*4882a593Smuzhiyun cldev->is_added = 0;
1034*4882a593Smuzhiyun INIT_LIST_HEAD(&cldev->bus_list);
1035*4882a593Smuzhiyun
1036*4882a593Smuzhiyun return cldev;
1037*4882a593Smuzhiyun }
1038*4882a593Smuzhiyun
1039*4882a593Smuzhiyun /**
1040*4882a593Smuzhiyun * mei_cl_dev_setup - setup me client device
1041*4882a593Smuzhiyun * run fix up routines and set the device name
1042*4882a593Smuzhiyun *
1043*4882a593Smuzhiyun * @bus: mei device
1044*4882a593Smuzhiyun * @cldev: me client device
1045*4882a593Smuzhiyun *
1046*4882a593Smuzhiyun * Return: true if the device is eligible for enumeration
1047*4882a593Smuzhiyun */
mei_cl_bus_dev_setup(struct mei_device * bus,struct mei_cl_device * cldev)1048*4882a593Smuzhiyun static bool mei_cl_bus_dev_setup(struct mei_device *bus,
1049*4882a593Smuzhiyun struct mei_cl_device *cldev)
1050*4882a593Smuzhiyun {
1051*4882a593Smuzhiyun cldev->do_match = 1;
1052*4882a593Smuzhiyun mei_cl_bus_dev_fixup(cldev);
1053*4882a593Smuzhiyun
1054*4882a593Smuzhiyun /* the device name can change during fix up */
1055*4882a593Smuzhiyun if (cldev->do_match)
1056*4882a593Smuzhiyun mei_cl_bus_set_name(cldev);
1057*4882a593Smuzhiyun
1058*4882a593Smuzhiyun return cldev->do_match == 1;
1059*4882a593Smuzhiyun }
1060*4882a593Smuzhiyun
1061*4882a593Smuzhiyun /**
1062*4882a593Smuzhiyun * mei_cl_bus_dev_add - add me client devices
1063*4882a593Smuzhiyun *
1064*4882a593Smuzhiyun * @cldev: me client device
1065*4882a593Smuzhiyun *
1066*4882a593Smuzhiyun * Return: 0 on success; < 0 on failre
1067*4882a593Smuzhiyun */
mei_cl_bus_dev_add(struct mei_cl_device * cldev)1068*4882a593Smuzhiyun static int mei_cl_bus_dev_add(struct mei_cl_device *cldev)
1069*4882a593Smuzhiyun {
1070*4882a593Smuzhiyun int ret;
1071*4882a593Smuzhiyun
1072*4882a593Smuzhiyun dev_dbg(cldev->bus->dev, "adding %pUL:%02X\n",
1073*4882a593Smuzhiyun mei_me_cl_uuid(cldev->me_cl),
1074*4882a593Smuzhiyun mei_me_cl_ver(cldev->me_cl));
1075*4882a593Smuzhiyun ret = device_add(&cldev->dev);
1076*4882a593Smuzhiyun if (!ret)
1077*4882a593Smuzhiyun cldev->is_added = 1;
1078*4882a593Smuzhiyun
1079*4882a593Smuzhiyun return ret;
1080*4882a593Smuzhiyun }
1081*4882a593Smuzhiyun
1082*4882a593Smuzhiyun /**
1083*4882a593Smuzhiyun * mei_cl_bus_dev_stop - stop the driver
1084*4882a593Smuzhiyun *
1085*4882a593Smuzhiyun * @cldev: me client device
1086*4882a593Smuzhiyun */
mei_cl_bus_dev_stop(struct mei_cl_device * cldev)1087*4882a593Smuzhiyun static void mei_cl_bus_dev_stop(struct mei_cl_device *cldev)
1088*4882a593Smuzhiyun {
1089*4882a593Smuzhiyun if (cldev->is_added)
1090*4882a593Smuzhiyun device_release_driver(&cldev->dev);
1091*4882a593Smuzhiyun }
1092*4882a593Smuzhiyun
1093*4882a593Smuzhiyun /**
1094*4882a593Smuzhiyun * mei_cl_bus_dev_destroy - destroy me client devices object
1095*4882a593Smuzhiyun *
1096*4882a593Smuzhiyun * @cldev: me client device
1097*4882a593Smuzhiyun *
1098*4882a593Smuzhiyun * Locking: called under "dev->cl_bus_lock" lock
1099*4882a593Smuzhiyun */
mei_cl_bus_dev_destroy(struct mei_cl_device * cldev)1100*4882a593Smuzhiyun static void mei_cl_bus_dev_destroy(struct mei_cl_device *cldev)
1101*4882a593Smuzhiyun {
1102*4882a593Smuzhiyun
1103*4882a593Smuzhiyun WARN_ON(!mutex_is_locked(&cldev->bus->cl_bus_lock));
1104*4882a593Smuzhiyun
1105*4882a593Smuzhiyun if (!cldev->is_added)
1106*4882a593Smuzhiyun return;
1107*4882a593Smuzhiyun
1108*4882a593Smuzhiyun device_del(&cldev->dev);
1109*4882a593Smuzhiyun
1110*4882a593Smuzhiyun list_del_init(&cldev->bus_list);
1111*4882a593Smuzhiyun
1112*4882a593Smuzhiyun cldev->is_added = 0;
1113*4882a593Smuzhiyun put_device(&cldev->dev);
1114*4882a593Smuzhiyun }
1115*4882a593Smuzhiyun
1116*4882a593Smuzhiyun /**
1117*4882a593Smuzhiyun * mei_cl_bus_remove_device - remove a devices form the bus
1118*4882a593Smuzhiyun *
1119*4882a593Smuzhiyun * @cldev: me client device
1120*4882a593Smuzhiyun */
mei_cl_bus_remove_device(struct mei_cl_device * cldev)1121*4882a593Smuzhiyun static void mei_cl_bus_remove_device(struct mei_cl_device *cldev)
1122*4882a593Smuzhiyun {
1123*4882a593Smuzhiyun mei_cl_bus_dev_stop(cldev);
1124*4882a593Smuzhiyun mei_cl_bus_dev_destroy(cldev);
1125*4882a593Smuzhiyun }
1126*4882a593Smuzhiyun
1127*4882a593Smuzhiyun /**
1128*4882a593Smuzhiyun * mei_cl_bus_remove_devices - remove all devices form the bus
1129*4882a593Smuzhiyun *
1130*4882a593Smuzhiyun * @bus: mei device
1131*4882a593Smuzhiyun */
mei_cl_bus_remove_devices(struct mei_device * bus)1132*4882a593Smuzhiyun void mei_cl_bus_remove_devices(struct mei_device *bus)
1133*4882a593Smuzhiyun {
1134*4882a593Smuzhiyun struct mei_cl_device *cldev, *next;
1135*4882a593Smuzhiyun
1136*4882a593Smuzhiyun mutex_lock(&bus->cl_bus_lock);
1137*4882a593Smuzhiyun list_for_each_entry_safe(cldev, next, &bus->device_list, bus_list)
1138*4882a593Smuzhiyun mei_cl_bus_remove_device(cldev);
1139*4882a593Smuzhiyun mutex_unlock(&bus->cl_bus_lock);
1140*4882a593Smuzhiyun }
1141*4882a593Smuzhiyun
1142*4882a593Smuzhiyun
1143*4882a593Smuzhiyun /**
1144*4882a593Smuzhiyun * mei_cl_bus_dev_init - allocate and initializes an mei client devices
1145*4882a593Smuzhiyun * based on me client
1146*4882a593Smuzhiyun *
1147*4882a593Smuzhiyun * @bus: mei device
1148*4882a593Smuzhiyun * @me_cl: me client
1149*4882a593Smuzhiyun *
1150*4882a593Smuzhiyun * Locking: called under "dev->cl_bus_lock" lock
1151*4882a593Smuzhiyun */
mei_cl_bus_dev_init(struct mei_device * bus,struct mei_me_client * me_cl)1152*4882a593Smuzhiyun static void mei_cl_bus_dev_init(struct mei_device *bus,
1153*4882a593Smuzhiyun struct mei_me_client *me_cl)
1154*4882a593Smuzhiyun {
1155*4882a593Smuzhiyun struct mei_cl_device *cldev;
1156*4882a593Smuzhiyun
1157*4882a593Smuzhiyun WARN_ON(!mutex_is_locked(&bus->cl_bus_lock));
1158*4882a593Smuzhiyun
1159*4882a593Smuzhiyun dev_dbg(bus->dev, "initializing %pUl", mei_me_cl_uuid(me_cl));
1160*4882a593Smuzhiyun
1161*4882a593Smuzhiyun if (me_cl->bus_added)
1162*4882a593Smuzhiyun return;
1163*4882a593Smuzhiyun
1164*4882a593Smuzhiyun cldev = mei_cl_bus_dev_alloc(bus, me_cl);
1165*4882a593Smuzhiyun if (!cldev)
1166*4882a593Smuzhiyun return;
1167*4882a593Smuzhiyun
1168*4882a593Smuzhiyun me_cl->bus_added = true;
1169*4882a593Smuzhiyun list_add_tail(&cldev->bus_list, &bus->device_list);
1170*4882a593Smuzhiyun
1171*4882a593Smuzhiyun }
1172*4882a593Smuzhiyun
1173*4882a593Smuzhiyun /**
1174*4882a593Smuzhiyun * mei_cl_bus_rescan - scan me clients list and add create
1175*4882a593Smuzhiyun * devices for eligible clients
1176*4882a593Smuzhiyun *
1177*4882a593Smuzhiyun * @bus: mei device
1178*4882a593Smuzhiyun */
mei_cl_bus_rescan(struct mei_device * bus)1179*4882a593Smuzhiyun static void mei_cl_bus_rescan(struct mei_device *bus)
1180*4882a593Smuzhiyun {
1181*4882a593Smuzhiyun struct mei_cl_device *cldev, *n;
1182*4882a593Smuzhiyun struct mei_me_client *me_cl;
1183*4882a593Smuzhiyun
1184*4882a593Smuzhiyun mutex_lock(&bus->cl_bus_lock);
1185*4882a593Smuzhiyun
1186*4882a593Smuzhiyun down_read(&bus->me_clients_rwsem);
1187*4882a593Smuzhiyun list_for_each_entry(me_cl, &bus->me_clients, list)
1188*4882a593Smuzhiyun mei_cl_bus_dev_init(bus, me_cl);
1189*4882a593Smuzhiyun up_read(&bus->me_clients_rwsem);
1190*4882a593Smuzhiyun
1191*4882a593Smuzhiyun list_for_each_entry_safe(cldev, n, &bus->device_list, bus_list) {
1192*4882a593Smuzhiyun
1193*4882a593Smuzhiyun if (!mei_me_cl_is_active(cldev->me_cl)) {
1194*4882a593Smuzhiyun mei_cl_bus_remove_device(cldev);
1195*4882a593Smuzhiyun continue;
1196*4882a593Smuzhiyun }
1197*4882a593Smuzhiyun
1198*4882a593Smuzhiyun if (cldev->is_added)
1199*4882a593Smuzhiyun continue;
1200*4882a593Smuzhiyun
1201*4882a593Smuzhiyun if (mei_cl_bus_dev_setup(bus, cldev))
1202*4882a593Smuzhiyun mei_cl_bus_dev_add(cldev);
1203*4882a593Smuzhiyun else {
1204*4882a593Smuzhiyun list_del_init(&cldev->bus_list);
1205*4882a593Smuzhiyun put_device(&cldev->dev);
1206*4882a593Smuzhiyun }
1207*4882a593Smuzhiyun }
1208*4882a593Smuzhiyun mutex_unlock(&bus->cl_bus_lock);
1209*4882a593Smuzhiyun
1210*4882a593Smuzhiyun dev_dbg(bus->dev, "rescan end");
1211*4882a593Smuzhiyun }
1212*4882a593Smuzhiyun
mei_cl_bus_rescan_work(struct work_struct * work)1213*4882a593Smuzhiyun void mei_cl_bus_rescan_work(struct work_struct *work)
1214*4882a593Smuzhiyun {
1215*4882a593Smuzhiyun struct mei_device *bus =
1216*4882a593Smuzhiyun container_of(work, struct mei_device, bus_rescan_work);
1217*4882a593Smuzhiyun
1218*4882a593Smuzhiyun mei_cl_bus_rescan(bus);
1219*4882a593Smuzhiyun }
1220*4882a593Smuzhiyun
__mei_cldev_driver_register(struct mei_cl_driver * cldrv,struct module * owner)1221*4882a593Smuzhiyun int __mei_cldev_driver_register(struct mei_cl_driver *cldrv,
1222*4882a593Smuzhiyun struct module *owner)
1223*4882a593Smuzhiyun {
1224*4882a593Smuzhiyun int err;
1225*4882a593Smuzhiyun
1226*4882a593Smuzhiyun cldrv->driver.name = cldrv->name;
1227*4882a593Smuzhiyun cldrv->driver.owner = owner;
1228*4882a593Smuzhiyun cldrv->driver.bus = &mei_cl_bus_type;
1229*4882a593Smuzhiyun
1230*4882a593Smuzhiyun err = driver_register(&cldrv->driver);
1231*4882a593Smuzhiyun if (err)
1232*4882a593Smuzhiyun return err;
1233*4882a593Smuzhiyun
1234*4882a593Smuzhiyun pr_debug("mei: driver [%s] registered\n", cldrv->driver.name);
1235*4882a593Smuzhiyun
1236*4882a593Smuzhiyun return 0;
1237*4882a593Smuzhiyun }
1238*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(__mei_cldev_driver_register);
1239*4882a593Smuzhiyun
mei_cldev_driver_unregister(struct mei_cl_driver * cldrv)1240*4882a593Smuzhiyun void mei_cldev_driver_unregister(struct mei_cl_driver *cldrv)
1241*4882a593Smuzhiyun {
1242*4882a593Smuzhiyun driver_unregister(&cldrv->driver);
1243*4882a593Smuzhiyun
1244*4882a593Smuzhiyun pr_debug("mei: driver [%s] unregistered\n", cldrv->driver.name);
1245*4882a593Smuzhiyun }
1246*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(mei_cldev_driver_unregister);
1247*4882a593Smuzhiyun
1248*4882a593Smuzhiyun
mei_cl_bus_init(void)1249*4882a593Smuzhiyun int __init mei_cl_bus_init(void)
1250*4882a593Smuzhiyun {
1251*4882a593Smuzhiyun return bus_register(&mei_cl_bus_type);
1252*4882a593Smuzhiyun }
1253*4882a593Smuzhiyun
mei_cl_bus_exit(void)1254*4882a593Smuzhiyun void __exit mei_cl_bus_exit(void)
1255*4882a593Smuzhiyun {
1256*4882a593Smuzhiyun bus_unregister(&mei_cl_bus_type);
1257*4882a593Smuzhiyun }
1258