Commit | Line | Data |
---|---|---|
e5354107 SO |
1 | /* |
2 | * Intel Management Engine Interface (Intel MEI) Linux driver | |
3 | * Copyright (c) 2012-2013, Intel Corporation. | |
4 | * | |
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. | |
8 | * | |
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. | |
13 | * | |
14 | */ | |
15 | ||
16 | #include <linux/module.h> | |
17 | #include <linux/device.h> | |
18 | #include <linux/kernel.h> | |
3e833295 | 19 | #include <linux/sched.h> |
e5354107 SO |
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> | |
e5354107 SO |
25 | #include <linux/mei_cl_bus.h> |
26 | ||
27 | #include "mei_dev.h" | |
3e833295 | 28 | #include "client.h" |
e5354107 SO |
29 | |
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) | |
32 | ||
62382997 TW |
33 | /** |
34 | * __mei_cl_send - internal client send (write) | |
35 | * | |
36 | * @cl: host client | |
37 | * @buf: buffer to send | |
38 | * @length: buffer length | |
39 | * @blocking: wait for write completion | |
40 | * | |
41 | * Return: written size bytes or < 0 on error | |
42 | */ | |
43 | ssize_t __mei_cl_send(struct mei_cl *cl, u8 *buf, size_t length, | |
44 | bool blocking) | |
e5354107 | 45 | { |
62382997 TW |
46 | struct mei_device *bus; |
47 | struct mei_cl_cb *cb = NULL; | |
48 | ssize_t rets; | |
e5354107 | 49 | |
62382997 TW |
50 | if (WARN_ON(!cl || !cl->dev)) |
51 | return -ENODEV; | |
c93b76b3 | 52 | |
62382997 | 53 | bus = cl->dev; |
e5354107 | 54 | |
62382997 TW |
55 | mutex_lock(&bus->device_lock); |
56 | if (!mei_cl_is_connected(cl)) { | |
57 | rets = -ENODEV; | |
58 | goto out; | |
59 | } | |
e5354107 | 60 | |
62382997 TW |
61 | /* Check if we have an ME client device */ |
62 | if (!mei_me_cl_is_active(cl->me_cl)) { | |
63 | rets = -ENOTTY; | |
64 | goto out; | |
65 | } | |
c93b76b3 | 66 | |
62382997 TW |
67 | if (length > mei_cl_mtu(cl)) { |
68 | rets = -EFBIG; | |
69 | goto out; | |
70 | } | |
e5354107 | 71 | |
62382997 TW |
72 | cb = mei_cl_alloc_cb(cl, length, MEI_FOP_WRITE, NULL); |
73 | if (!cb) { | |
74 | rets = -ENOMEM; | |
75 | goto out; | |
e5354107 SO |
76 | } |
77 | ||
62382997 TW |
78 | memcpy(cb->buf.data, buf, length); |
79 | ||
80 | rets = mei_cl_write(cl, cb, blocking); | |
81 | ||
82 | out: | |
83 | mutex_unlock(&bus->device_lock); | |
84 | if (rets < 0) | |
85 | mei_io_cb_free(cb); | |
86 | ||
87 | return rets; | |
e5354107 SO |
88 | } |
89 | ||
62382997 TW |
90 | /** |
91 | * __mei_cl_recv - internal client receive (read) | |
92 | * | |
93 | * @cl: host client | |
94 | * @buf: buffer to send | |
95 | * @length: buffer length | |
96 | * | |
97 | * Return: read size in bytes of < 0 on error | |
98 | */ | |
99 | ssize_t __mei_cl_recv(struct mei_cl *cl, u8 *buf, size_t length) | |
e5354107 | 100 | { |
62382997 TW |
101 | struct mei_device *bus; |
102 | struct mei_cl_cb *cb; | |
103 | size_t r_length; | |
104 | ssize_t rets; | |
e5354107 | 105 | |
62382997 | 106 | if (WARN_ON(!cl || !cl->dev)) |
e5354107 SO |
107 | return -ENODEV; |
108 | ||
62382997 | 109 | bus = cl->dev; |
e5354107 | 110 | |
62382997 | 111 | mutex_lock(&bus->device_lock); |
e5354107 | 112 | |
62382997 TW |
113 | cb = mei_cl_read_cb(cl, NULL); |
114 | if (cb) | |
115 | goto copy; | |
e5354107 | 116 | |
62382997 TW |
117 | rets = mei_cl_read_start(cl, length, NULL); |
118 | if (rets && rets != -EBUSY) | |
119 | goto out; | |
e5354107 | 120 | |
62382997 TW |
121 | /* wait on event only if there is no other waiter */ |
122 | if (list_empty(&cl->rd_completed) && !waitqueue_active(&cl->rx_wait)) { | |
e5354107 | 123 | |
62382997 | 124 | mutex_unlock(&bus->device_lock); |
3e833295 | 125 | |
62382997 TW |
126 | if (wait_event_interruptible(cl->rx_wait, |
127 | (!list_empty(&cl->rd_completed)) || | |
128 | (!mei_cl_is_connected(cl)))) { | |
e5354107 | 129 | |
62382997 TW |
130 | if (signal_pending(current)) |
131 | return -EINTR; | |
132 | return -ERESTARTSYS; | |
133 | } | |
134 | ||
135 | mutex_lock(&bus->device_lock); | |
136 | ||
137 | if (!mei_cl_is_connected(cl)) { | |
138 | rets = -EBUSY; | |
139 | goto out; | |
140 | } | |
e5354107 SO |
141 | } |
142 | ||
62382997 TW |
143 | cb = mei_cl_read_cb(cl, NULL); |
144 | if (!cb) { | |
145 | rets = 0; | |
146 | goto out; | |
147 | } | |
e5354107 | 148 | |
62382997 TW |
149 | copy: |
150 | if (cb->status) { | |
151 | rets = cb->status; | |
152 | goto free; | |
153 | } | |
007d64eb | 154 | |
62382997 TW |
155 | r_length = min_t(size_t, length, cb->buf_idx); |
156 | memcpy(buf, cb->buf.data, r_length); | |
157 | rets = r_length; | |
007d64eb | 158 | |
62382997 TW |
159 | free: |
160 | mei_io_cb_free(cb); | |
161 | out: | |
162 | mutex_unlock(&bus->device_lock); | |
163 | ||
164 | return rets; | |
007d64eb | 165 | } |
007d64eb | 166 | |
62382997 TW |
167 | /** |
168 | * mei_cl_send - me device send (write) | |
169 | * | |
170 | * @cldev: me client device | |
171 | * @buf: buffer to send | |
172 | * @length: buffer length | |
173 | * | |
174 | * Return: written size in bytes or < 0 on error | |
175 | */ | |
176 | ssize_t mei_cl_send(struct mei_cl_device *cldev, u8 *buf, size_t length) | |
007d64eb | 177 | { |
62382997 | 178 | struct mei_cl *cl = cldev->cl; |
007d64eb | 179 | |
62382997 TW |
180 | if (cl == NULL) |
181 | return -ENODEV; | |
007d64eb | 182 | |
62382997 | 183 | return __mei_cl_send(cl, buf, length, 1); |
007d64eb | 184 | } |
62382997 | 185 | EXPORT_SYMBOL_GPL(mei_cl_send); |
007d64eb | 186 | |
62382997 TW |
187 | /** |
188 | * mei_cl_recv - client receive (read) | |
189 | * | |
190 | * @cldev: me client device | |
191 | * @buf: buffer to send | |
192 | * @length: buffer length | |
193 | * | |
194 | * Return: read size in bytes of < 0 on error | |
195 | */ | |
196 | ssize_t mei_cl_recv(struct mei_cl_device *cldev, u8 *buf, size_t length) | |
e5354107 | 197 | { |
62382997 | 198 | struct mei_cl *cl = cldev->cl; |
e5354107 | 199 | |
62382997 TW |
200 | if (cl == NULL) |
201 | return -ENODEV; | |
e5354107 | 202 | |
62382997 | 203 | return __mei_cl_recv(cl, buf, length); |
e5354107 | 204 | } |
62382997 | 205 | EXPORT_SYMBOL_GPL(mei_cl_recv); |
e5354107 | 206 | |
62382997 TW |
207 | /** |
208 | * mei_bus_event_work - dispatch rx event for a bus device | |
209 | * and schedule new work | |
210 | * | |
211 | * @work: work | |
212 | */ | |
213 | static void mei_bus_event_work(struct work_struct *work) | |
e5354107 | 214 | { |
62382997 | 215 | struct mei_cl_device *cldev; |
c93b76b3 | 216 | |
62382997 | 217 | cldev = container_of(work, struct mei_cl_device, event_work); |
007d64eb | 218 | |
62382997 TW |
219 | if (cldev->event_cb) |
220 | cldev->event_cb(cldev, cldev->events, cldev->event_context); | |
007d64eb | 221 | |
62382997 | 222 | cldev->events = 0; |
e5354107 | 223 | |
62382997 | 224 | /* Prepare for the next read */ |
bb2ef9c3 AU |
225 | if (cldev->events_mask & BIT(MEI_CL_EVENT_RX)) |
226 | mei_cl_read_start(cldev->cl, 0, NULL); | |
227 | } | |
228 | ||
229 | /** | |
230 | * mei_cl_bus_notify_event - schedule notify cb on bus client | |
231 | * | |
232 | * @cl: host client | |
233 | */ | |
234 | void mei_cl_bus_notify_event(struct mei_cl *cl) | |
235 | { | |
236 | struct mei_cl_device *cldev = cl->cldev; | |
237 | ||
238 | if (!cldev || !cldev->event_cb) | |
239 | return; | |
240 | ||
241 | if (!(cldev->events_mask & BIT(MEI_CL_EVENT_NOTIF))) | |
242 | return; | |
243 | ||
244 | if (!cl->notify_ev) | |
245 | return; | |
246 | ||
247 | set_bit(MEI_CL_EVENT_NOTIF, &cldev->events); | |
248 | ||
249 | schedule_work(&cldev->event_work); | |
250 | ||
251 | cl->notify_ev = false; | |
e5354107 SO |
252 | } |
253 | ||
62382997 TW |
254 | /** |
255 | * mei_cl_bus_rx_event - schedule rx evenet | |
256 | * | |
257 | * @cl: host client | |
258 | */ | |
259 | void mei_cl_bus_rx_event(struct mei_cl *cl) | |
e5354107 | 260 | { |
62382997 | 261 | struct mei_cl_device *cldev = cl->cldev; |
d49ed64a | 262 | |
62382997 | 263 | if (!cldev || !cldev->event_cb) |
d49ed64a AU |
264 | return; |
265 | ||
bb2ef9c3 AU |
266 | if (!(cldev->events_mask & BIT(MEI_CL_EVENT_RX))) |
267 | return; | |
268 | ||
62382997 | 269 | set_bit(MEI_CL_EVENT_RX, &cldev->events); |
a7b71bc0 | 270 | |
62382997 | 271 | schedule_work(&cldev->event_work); |
a7b71bc0 | 272 | } |
d49ed64a | 273 | |
62382997 TW |
274 | /** |
275 | * mei_cl_register_event_cb - register event callback | |
276 | * | |
277 | * @cldev: me client devices | |
278 | * @event_cb: callback function | |
bb2ef9c3 | 279 | * @events_mask: requested events bitmask |
62382997 TW |
280 | * @context: driver context data |
281 | * | |
282 | * Return: 0 on success | |
283 | * -EALREADY if an callback is already registered | |
284 | * <0 on other errors | |
285 | */ | |
286 | int mei_cl_register_event_cb(struct mei_cl_device *cldev, | |
bb2ef9c3 | 287 | unsigned long events_mask, |
62382997 | 288 | mei_cl_event_cb_t event_cb, void *context) |
e5354107 | 289 | { |
48168f45 TW |
290 | int ret; |
291 | ||
62382997 TW |
292 | if (cldev->event_cb) |
293 | return -EALREADY; | |
e5354107 | 294 | |
62382997 | 295 | cldev->events = 0; |
bb2ef9c3 | 296 | cldev->events_mask = events_mask; |
62382997 TW |
297 | cldev->event_cb = event_cb; |
298 | cldev->event_context = context; | |
299 | INIT_WORK(&cldev->event_work, mei_bus_event_work); | |
a7b71bc0 | 300 | |
bb2ef9c3 AU |
301 | if (cldev->events_mask & BIT(MEI_CL_EVENT_RX)) { |
302 | ret = mei_cl_read_start(cldev->cl, 0, NULL); | |
303 | if (ret && ret != -EBUSY) | |
304 | return ret; | |
305 | } | |
306 | ||
307 | if (cldev->events_mask & BIT(MEI_CL_EVENT_NOTIF)) { | |
308 | mutex_lock(&cldev->cl->dev->device_lock); | |
309 | ret = mei_cl_notify_request(cldev->cl, NULL, event_cb ? 1 : 0); | |
310 | mutex_unlock(&cldev->cl->dev->device_lock); | |
311 | if (ret) | |
312 | return ret; | |
313 | } | |
e5354107 | 314 | |
62382997 TW |
315 | return 0; |
316 | } | |
317 | EXPORT_SYMBOL_GPL(mei_cl_register_event_cb); | |
e5354107 | 318 | |
62382997 TW |
319 | /** |
320 | * mei_cl_get_drvdata - driver data getter | |
321 | * | |
322 | * @cldev: mei client device | |
323 | * | |
324 | * Return: driver private data | |
325 | */ | |
326 | void *mei_cl_get_drvdata(const struct mei_cl_device *cldev) | |
327 | { | |
328 | return dev_get_drvdata(&cldev->dev); | |
e5354107 | 329 | } |
62382997 | 330 | EXPORT_SYMBOL_GPL(mei_cl_get_drvdata); |
e5354107 | 331 | |
62382997 TW |
332 | /** |
333 | * mei_cl_set_drvdata - driver data setter | |
334 | * | |
335 | * @cldev: mei client device | |
336 | * @data: data to store | |
337 | */ | |
338 | void mei_cl_set_drvdata(struct mei_cl_device *cldev, void *data) | |
e5354107 | 339 | { |
62382997 | 340 | dev_set_drvdata(&cldev->dev, data); |
e5354107 | 341 | } |
62382997 | 342 | EXPORT_SYMBOL_GPL(mei_cl_set_drvdata); |
333e4ee0 | 343 | |
baeacd03 TW |
344 | /** |
345 | * mei_cldev_uuid - return uuid of the underlying me client | |
346 | * | |
347 | * @cldev: mei client device | |
348 | * | |
349 | * Return: me client uuid | |
350 | */ | |
351 | const uuid_le *mei_cldev_uuid(const struct mei_cl_device *cldev) | |
352 | { | |
353 | return mei_me_cl_uuid(cldev->me_cl); | |
354 | } | |
355 | EXPORT_SYMBOL_GPL(mei_cldev_uuid); | |
356 | ||
357 | /** | |
358 | * mei_cldev_ver - return protocol version of the underlying me client | |
359 | * | |
360 | * @cldev: mei client device | |
361 | * | |
362 | * Return: me client protocol version | |
363 | */ | |
364 | u8 mei_cldev_ver(const struct mei_cl_device *cldev) | |
365 | { | |
366 | return mei_me_cl_ver(cldev->me_cl); | |
367 | } | |
368 | EXPORT_SYMBOL_GPL(mei_cldev_ver); | |
369 | ||
62382997 TW |
370 | /** |
371 | * mei_cl_enable_device - enable me client device | |
372 | * create connection with me client | |
373 | * | |
374 | * @cldev: me client device | |
375 | * | |
376 | * Return: 0 on success and < 0 on error | |
377 | */ | |
378 | int mei_cl_enable_device(struct mei_cl_device *cldev) | |
333e4ee0 | 379 | { |
6009595a TW |
380 | struct mei_device *bus = cldev->bus; |
381 | struct mei_cl *cl; | |
382 | int ret; | |
333e4ee0 | 383 | |
6009595a | 384 | cl = cldev->cl; |
333e4ee0 | 385 | |
6009595a TW |
386 | if (!cl) { |
387 | mutex_lock(&bus->device_lock); | |
388 | cl = mei_cl_alloc_linked(bus, MEI_HOST_CLIENT_ID_ANY); | |
389 | mutex_unlock(&bus->device_lock); | |
390 | if (IS_ERR(cl)) | |
391 | return PTR_ERR(cl); | |
392 | /* update pointers */ | |
393 | cldev->cl = cl; | |
394 | cl->cldev = cldev; | |
395 | } | |
333e4ee0 | 396 | |
62382997 | 397 | mutex_lock(&bus->device_lock); |
62382997 | 398 | if (mei_cl_is_connected(cl)) { |
6009595a TW |
399 | ret = 0; |
400 | goto out; | |
62382997 | 401 | } |
333e4ee0 | 402 | |
6009595a TW |
403 | if (!mei_me_cl_is_active(cldev->me_cl)) { |
404 | dev_err(&cldev->dev, "me client is not active\n"); | |
405 | ret = -ENOTTY; | |
406 | goto out; | |
62382997 TW |
407 | } |
408 | ||
6009595a TW |
409 | ret = mei_cl_connect(cl, cldev->me_cl, NULL); |
410 | if (ret < 0) | |
411 | dev_err(&cldev->dev, "cannot connect\n"); | |
412 | ||
413 | out: | |
62382997 TW |
414 | mutex_unlock(&bus->device_lock); |
415 | ||
6009595a | 416 | return ret; |
333e4ee0 | 417 | } |
62382997 | 418 | EXPORT_SYMBOL_GPL(mei_cl_enable_device); |
3e833295 | 419 | |
62382997 TW |
420 | /** |
421 | * mei_cl_disable_device - disable me client device | |
422 | * disconnect form the me client | |
423 | * | |
424 | * @cldev: me client device | |
425 | * | |
426 | * Return: 0 on success and < 0 on error | |
427 | */ | |
428 | int mei_cl_disable_device(struct mei_cl_device *cldev) | |
3e833295 | 429 | { |
b37719c3 | 430 | struct mei_device *bus; |
6009595a TW |
431 | struct mei_cl *cl; |
432 | int err; | |
3e833295 | 433 | |
6009595a | 434 | if (!cldev || !cldev->cl) |
3e833295 SO |
435 | return -ENODEV; |
436 | ||
6009595a TW |
437 | cl = cldev->cl; |
438 | ||
439 | bus = cldev->bus; | |
4234a6de | 440 | |
62382997 | 441 | cldev->event_cb = NULL; |
3e833295 | 442 | |
62382997 | 443 | mutex_lock(&bus->device_lock); |
4234a6de | 444 | |
62382997 TW |
445 | if (!mei_cl_is_connected(cl)) { |
446 | dev_err(bus->dev, "Already disconnected"); | |
447 | err = 0; | |
79563db9 TW |
448 | goto out; |
449 | } | |
4234a6de | 450 | |
62382997 | 451 | err = mei_cl_disconnect(cl); |
6009595a | 452 | if (err < 0) |
62382997 | 453 | dev_err(bus->dev, "Could not disconnect from the ME client"); |
3e833295 | 454 | |
6009595a | 455 | out: |
62382997 TW |
456 | /* Flush queues and remove any pending read */ |
457 | mei_cl_flush_queues(cl, NULL); | |
6009595a TW |
458 | mei_cl_unlink(cl); |
459 | ||
460 | kfree(cl); | |
461 | cldev->cl = NULL; | |
3e833295 | 462 | |
b37719c3 | 463 | mutex_unlock(&bus->device_lock); |
62382997 | 464 | return err; |
3e833295 | 465 | } |
62382997 | 466 | EXPORT_SYMBOL_GPL(mei_cl_disable_device); |
3e833295 | 467 | |
688a9cce TW |
468 | /** |
469 | * mei_cl_device_find - find matching entry in the driver id table | |
470 | * | |
471 | * @cldev: me client device | |
472 | * @cldrv: me client driver | |
473 | * | |
474 | * Return: id on success; NULL if no id is matching | |
475 | */ | |
476 | static const | |
477 | struct mei_cl_device_id *mei_cl_device_find(struct mei_cl_device *cldev, | |
478 | struct mei_cl_driver *cldrv) | |
3e833295 | 479 | { |
62382997 TW |
480 | const struct mei_cl_device_id *id; |
481 | const uuid_le *uuid; | |
b26864ca TW |
482 | u8 version; |
483 | bool match; | |
3e833295 | 484 | |
62382997 | 485 | uuid = mei_me_cl_uuid(cldev->me_cl); |
b26864ca | 486 | version = mei_me_cl_ver(cldev->me_cl); |
3e833295 | 487 | |
62382997 | 488 | id = cldrv->id_table; |
62382997 | 489 | while (uuid_le_cmp(NULL_UUID_LE, id->uuid)) { |
62382997 | 490 | if (!uuid_le_cmp(*uuid, id->uuid)) { |
b26864ca | 491 | match = true; |
688a9cce | 492 | |
b26864ca TW |
493 | if (cldev->name[0]) |
494 | if (strncmp(cldev->name, id->name, | |
495 | sizeof(id->name))) | |
496 | match = false; | |
688a9cce | 497 | |
b26864ca TW |
498 | if (id->version != MEI_CL_VERSION_ANY) |
499 | if (id->version != version) | |
500 | match = false; | |
501 | if (match) | |
688a9cce | 502 | return id; |
62382997 | 503 | } |
e2b31644 | 504 | |
62382997 TW |
505 | id++; |
506 | } | |
3e833295 | 507 | |
688a9cce TW |
508 | return NULL; |
509 | } | |
510 | ||
511 | /** | |
512 | * mei_cl_device_match - device match function | |
513 | * | |
514 | * @dev: device | |
515 | * @drv: driver | |
516 | * | |
517 | * Return: 1 if matching device was found 0 otherwise | |
518 | */ | |
519 | static int mei_cl_device_match(struct device *dev, struct device_driver *drv) | |
520 | { | |
521 | struct mei_cl_device *cldev = to_mei_cl_device(dev); | |
522 | struct mei_cl_driver *cldrv = to_mei_cl_driver(drv); | |
523 | const struct mei_cl_device_id *found_id; | |
524 | ||
525 | if (!cldev) | |
526 | return 0; | |
527 | ||
71ce7891 TW |
528 | if (!cldev->do_match) |
529 | return 0; | |
530 | ||
688a9cce TW |
531 | if (!cldrv || !cldrv->id_table) |
532 | return 0; | |
533 | ||
534 | found_id = mei_cl_device_find(cldev, cldrv); | |
535 | if (found_id) | |
536 | return 1; | |
537 | ||
62382997 TW |
538 | return 0; |
539 | } | |
e2b31644 | 540 | |
feb8cd0f TW |
541 | /** |
542 | * mei_cl_device_probe - bus probe function | |
543 | * | |
544 | * @dev: device | |
545 | * | |
546 | * Return: 0 on success; < 0 otherwise | |
547 | */ | |
62382997 TW |
548 | static int mei_cl_device_probe(struct device *dev) |
549 | { | |
feb8cd0f | 550 | struct mei_cl_device *cldev; |
62382997 | 551 | struct mei_cl_driver *cldrv; |
feb8cd0f TW |
552 | const struct mei_cl_device_id *id; |
553 | ||
554 | cldev = to_mei_cl_device(dev); | |
555 | cldrv = to_mei_cl_driver(dev->driver); | |
3e833295 | 556 | |
62382997 TW |
557 | if (!cldev) |
558 | return 0; | |
3e833295 | 559 | |
62382997 TW |
560 | if (!cldrv || !cldrv->probe) |
561 | return -ENODEV; | |
562 | ||
feb8cd0f TW |
563 | id = mei_cl_device_find(cldev, cldrv); |
564 | if (!id) | |
565 | return -ENODEV; | |
62382997 | 566 | |
feb8cd0f | 567 | __module_get(THIS_MODULE); |
62382997 | 568 | |
feb8cd0f | 569 | return cldrv->probe(cldev, id); |
62382997 | 570 | } |
3e833295 | 571 | |
feb8cd0f TW |
572 | /** |
573 | * mei_cl_device_remove - remove device from the bus | |
574 | * | |
575 | * @dev: device | |
576 | * | |
577 | * Return: 0 on success; < 0 otherwise | |
578 | */ | |
62382997 TW |
579 | static int mei_cl_device_remove(struct device *dev) |
580 | { | |
581 | struct mei_cl_device *cldev = to_mei_cl_device(dev); | |
582 | struct mei_cl_driver *cldrv; | |
feb8cd0f | 583 | int ret = 0; |
3e833295 | 584 | |
62382997 TW |
585 | if (!cldev || !dev->driver) |
586 | return 0; | |
587 | ||
588 | if (cldev->event_cb) { | |
589 | cldev->event_cb = NULL; | |
590 | cancel_work_sync(&cldev->event_work); | |
3d33ff24 TW |
591 | } |
592 | ||
62382997 | 593 | cldrv = to_mei_cl_driver(dev->driver); |
feb8cd0f TW |
594 | if (cldrv->remove) |
595 | ret = cldrv->remove(cldev); | |
3e833295 | 596 | |
feb8cd0f TW |
597 | module_put(THIS_MODULE); |
598 | dev->driver = NULL; | |
599 | return ret; | |
3e833295 | 600 | |
3e833295 SO |
601 | } |
602 | ||
62382997 TW |
603 | static ssize_t name_show(struct device *dev, struct device_attribute *a, |
604 | char *buf) | |
3e833295 | 605 | { |
62382997 TW |
606 | struct mei_cl_device *cldev = to_mei_cl_device(dev); |
607 | size_t len; | |
3e833295 | 608 | |
62382997 | 609 | len = snprintf(buf, PAGE_SIZE, "%s", cldev->name); |
3e833295 | 610 | |
62382997 | 611 | return (len >= PAGE_SIZE) ? (PAGE_SIZE - 1) : len; |
3e833295 | 612 | } |
62382997 | 613 | static DEVICE_ATTR_RO(name); |
3e833295 | 614 | |
62382997 TW |
615 | static ssize_t uuid_show(struct device *dev, struct device_attribute *a, |
616 | char *buf) | |
3e833295 | 617 | { |
62382997 TW |
618 | struct mei_cl_device *cldev = to_mei_cl_device(dev); |
619 | const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl); | |
620 | size_t len; | |
3e833295 | 621 | |
62382997 | 622 | len = snprintf(buf, PAGE_SIZE, "%pUl", uuid); |
3e833295 | 623 | |
62382997 | 624 | return (len >= PAGE_SIZE) ? (PAGE_SIZE - 1) : len; |
3e833295 | 625 | } |
62382997 | 626 | static DEVICE_ATTR_RO(uuid); |
3e833295 | 627 | |
40b7320e TW |
628 | static ssize_t version_show(struct device *dev, struct device_attribute *a, |
629 | char *buf) | |
630 | { | |
631 | struct mei_cl_device *cldev = to_mei_cl_device(dev); | |
632 | u8 version = mei_me_cl_ver(cldev->me_cl); | |
633 | size_t len; | |
634 | ||
635 | len = snprintf(buf, PAGE_SIZE, "%02X", version); | |
636 | ||
637 | return (len >= PAGE_SIZE) ? (PAGE_SIZE - 1) : len; | |
638 | } | |
639 | static DEVICE_ATTR_RO(version); | |
640 | ||
62382997 TW |
641 | static ssize_t modalias_show(struct device *dev, struct device_attribute *a, |
642 | char *buf) | |
3e833295 | 643 | { |
62382997 TW |
644 | struct mei_cl_device *cldev = to_mei_cl_device(dev); |
645 | const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl); | |
646 | size_t len; | |
3e833295 | 647 | |
59796edc | 648 | len = snprintf(buf, PAGE_SIZE, "mei:%s:%pUl:", cldev->name, uuid); |
62382997 | 649 | return (len >= PAGE_SIZE) ? (PAGE_SIZE - 1) : len; |
3e833295 | 650 | } |
62382997 | 651 | static DEVICE_ATTR_RO(modalias); |
3e833295 | 652 | |
62382997 TW |
653 | static struct attribute *mei_cl_dev_attrs[] = { |
654 | &dev_attr_name.attr, | |
655 | &dev_attr_uuid.attr, | |
40b7320e | 656 | &dev_attr_version.attr, |
62382997 TW |
657 | &dev_attr_modalias.attr, |
658 | NULL, | |
659 | }; | |
660 | ATTRIBUTE_GROUPS(mei_cl_dev); | |
661 | ||
38d3c00d TW |
662 | /** |
663 | * mei_cl_device_uevent - me client bus uevent handler | |
664 | * | |
665 | * @dev: device | |
666 | * @env: uevent kobject | |
667 | * | |
668 | * Return: 0 on success -ENOMEM on when add_uevent_var fails | |
669 | */ | |
670 | static int mei_cl_device_uevent(struct device *dev, struct kobj_uevent_env *env) | |
3e833295 | 671 | { |
62382997 TW |
672 | struct mei_cl_device *cldev = to_mei_cl_device(dev); |
673 | const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl); | |
40b7320e TW |
674 | u8 version = mei_me_cl_ver(cldev->me_cl); |
675 | ||
676 | if (add_uevent_var(env, "MEI_CL_VERSION=%d", version)) | |
677 | return -ENOMEM; | |
3e833295 | 678 | |
62382997 TW |
679 | if (add_uevent_var(env, "MEI_CL_UUID=%pUl", uuid)) |
680 | return -ENOMEM; | |
3e833295 | 681 | |
62382997 TW |
682 | if (add_uevent_var(env, "MEI_CL_NAME=%s", cldev->name)) |
683 | return -ENOMEM; | |
684 | ||
b26864ca TW |
685 | if (add_uevent_var(env, "MODALIAS=mei:%s:%pUl:%02X:", |
686 | cldev->name, uuid, version)) | |
62382997 | 687 | return -ENOMEM; |
3e833295 SO |
688 | |
689 | return 0; | |
690 | } | |
cf3baefb | 691 | |
62382997 TW |
692 | static struct bus_type mei_cl_bus_type = { |
693 | .name = "mei", | |
694 | .dev_groups = mei_cl_dev_groups, | |
695 | .match = mei_cl_device_match, | |
696 | .probe = mei_cl_device_probe, | |
697 | .remove = mei_cl_device_remove, | |
38d3c00d | 698 | .uevent = mei_cl_device_uevent, |
62382997 TW |
699 | }; |
700 | ||
512f64d9 TW |
701 | static struct mei_device *mei_dev_bus_get(struct mei_device *bus) |
702 | { | |
703 | if (bus) | |
704 | get_device(bus->dev); | |
705 | ||
706 | return bus; | |
707 | } | |
708 | ||
709 | static void mei_dev_bus_put(struct mei_device *bus) | |
710 | { | |
711 | if (bus) | |
712 | put_device(bus->dev); | |
713 | } | |
714 | ||
62382997 | 715 | static void mei_cl_dev_release(struct device *dev) |
aa6aef21 | 716 | { |
62382997 TW |
717 | struct mei_cl_device *cldev = to_mei_cl_device(dev); |
718 | ||
719 | if (!cldev) | |
720 | return; | |
721 | ||
722 | mei_me_cl_put(cldev->me_cl); | |
512f64d9 | 723 | mei_dev_bus_put(cldev->bus); |
62382997 | 724 | kfree(cldev); |
aa6aef21 | 725 | } |
aa6aef21 | 726 | |
62382997 TW |
727 | static struct device_type mei_cl_device_type = { |
728 | .release = mei_cl_dev_release, | |
729 | }; | |
730 | ||
71ce7891 TW |
731 | /** |
732 | * mei_cl_dev_alloc - initialize and allocate mei client device | |
733 | * | |
734 | * @bus: mei device | |
735 | * @me_cl: me client | |
736 | * | |
737 | * Return: allocated device structur or NULL on allocation failure | |
738 | */ | |
739 | static struct mei_cl_device *mei_cl_dev_alloc(struct mei_device *bus, | |
740 | struct mei_me_client *me_cl) | |
741 | { | |
742 | struct mei_cl_device *cldev; | |
743 | ||
744 | cldev = kzalloc(sizeof(struct mei_cl_device), GFP_KERNEL); | |
745 | if (!cldev) | |
746 | return NULL; | |
747 | ||
748 | device_initialize(&cldev->dev); | |
749 | cldev->dev.parent = bus->dev; | |
750 | cldev->dev.bus = &mei_cl_bus_type; | |
751 | cldev->dev.type = &mei_cl_device_type; | |
752 | cldev->bus = mei_dev_bus_get(bus); | |
753 | cldev->me_cl = mei_me_cl_get(me_cl); | |
754 | cldev->is_added = 0; | |
755 | INIT_LIST_HEAD(&cldev->bus_list); | |
756 | ||
757 | return cldev; | |
758 | } | |
759 | ||
760 | /** | |
761 | * mei_cl_dev_setup - setup me client device | |
762 | * run fix up routines and set the device name | |
763 | * | |
764 | * @bus: mei device | |
765 | * @cldev: me client device | |
766 | * | |
767 | * Return: true if the device is eligible for enumeration | |
768 | */ | |
769 | static bool mei_cl_dev_setup(struct mei_device *bus, | |
770 | struct mei_cl_device *cldev) | |
771 | { | |
772 | cldev->do_match = 1; | |
773 | mei_cl_dev_fixup(cldev); | |
774 | ||
775 | if (cldev->do_match) | |
b26864ca TW |
776 | dev_set_name(&cldev->dev, "mei:%s:%pUl:%02X", |
777 | cldev->name, | |
778 | mei_me_cl_uuid(cldev->me_cl), | |
779 | mei_me_cl_ver(cldev->me_cl)); | |
71ce7891 TW |
780 | |
781 | return cldev->do_match == 1; | |
782 | } | |
783 | ||
784 | /** | |
785 | * mei_cl_bus_dev_add - add me client devices | |
786 | * | |
787 | * @cldev: me client device | |
788 | * | |
789 | * Return: 0 on success; < 0 on failre | |
790 | */ | |
791 | static int mei_cl_bus_dev_add(struct mei_cl_device *cldev) | |
792 | { | |
793 | int ret; | |
794 | ||
b26864ca TW |
795 | dev_dbg(cldev->bus->dev, "adding %pUL:%02X\n", |
796 | mei_me_cl_uuid(cldev->me_cl), | |
797 | mei_me_cl_ver(cldev->me_cl)); | |
71ce7891 TW |
798 | ret = device_add(&cldev->dev); |
799 | if (!ret) | |
800 | cldev->is_added = 1; | |
801 | ||
802 | return ret; | |
803 | } | |
804 | ||
6009595a TW |
805 | /** |
806 | * mei_cl_bus_dev_stop - stop the driver | |
807 | * | |
808 | * @cldev: me client device | |
809 | */ | |
810 | static void mei_cl_bus_dev_stop(struct mei_cl_device *cldev) | |
811 | { | |
812 | if (cldev->is_added) | |
813 | device_release_driver(&cldev->dev); | |
814 | } | |
815 | ||
816 | /** | |
817 | * mei_cl_bus_dev_destroy - destroy me client devices object | |
818 | * | |
819 | * @cldev: me client device | |
820 | */ | |
821 | static void mei_cl_bus_dev_destroy(struct mei_cl_device *cldev) | |
822 | { | |
823 | if (!cldev->is_added) | |
824 | return; | |
825 | ||
826 | device_del(&cldev->dev); | |
827 | ||
828 | mutex_lock(&cldev->bus->cl_bus_lock); | |
829 | list_del_init(&cldev->bus_list); | |
830 | mutex_unlock(&cldev->bus->cl_bus_lock); | |
831 | ||
832 | cldev->is_added = 0; | |
833 | put_device(&cldev->dev); | |
834 | } | |
835 | ||
836 | /** | |
837 | * mei_cl_bus_remove_device - remove a devices form the bus | |
838 | * | |
839 | * @cldev: me client device | |
840 | */ | |
841 | static void mei_cl_bus_remove_device(struct mei_cl_device *cldev) | |
842 | { | |
843 | mei_cl_bus_dev_stop(cldev); | |
844 | mei_cl_bus_dev_destroy(cldev); | |
845 | } | |
846 | ||
847 | /** | |
848 | * mei_cl_bus_remove_devices - remove all devices form the bus | |
849 | * | |
850 | * @bus: mei device | |
851 | */ | |
852 | void mei_cl_bus_remove_devices(struct mei_device *bus) | |
853 | { | |
854 | struct mei_cl_device *cldev, *next; | |
855 | ||
856 | list_for_each_entry_safe(cldev, next, &bus->device_list, bus_list) | |
857 | mei_cl_bus_remove_device(cldev); | |
858 | } | |
859 | ||
860 | ||
861 | /** | |
862 | * mei_cl_dev_init - allocate and initializes an mei client devices | |
863 | * based on me client | |
864 | * | |
865 | * @bus: mei device | |
866 | * @me_cl: me client | |
867 | */ | |
868 | static void mei_cl_dev_init(struct mei_device *bus, struct mei_me_client *me_cl) | |
e46980a1 | 869 | { |
62382997 | 870 | struct mei_cl_device *cldev; |
6009595a TW |
871 | |
872 | dev_dbg(bus->dev, "initializing %pUl", mei_me_cl_uuid(me_cl)); | |
873 | ||
874 | if (me_cl->bus_added) | |
875 | return; | |
e46980a1 | 876 | |
71ce7891 | 877 | cldev = mei_cl_dev_alloc(bus, me_cl); |
62382997 | 878 | if (!cldev) |
6009595a | 879 | return; |
e46980a1 | 880 | |
6009595a TW |
881 | mutex_lock(&cldev->bus->cl_bus_lock); |
882 | me_cl->bus_added = true; | |
883 | list_add_tail(&cldev->bus_list, &bus->device_list); | |
884 | mutex_unlock(&cldev->bus->cl_bus_lock); | |
0c53357c | 885 | |
6009595a | 886 | } |
e46980a1 | 887 | |
6009595a TW |
888 | /** |
889 | * mei_cl_bus_rescan - scan me clients list and add create | |
890 | * devices for eligible clients | |
891 | * | |
892 | * @bus: mei device | |
893 | */ | |
894 | void mei_cl_bus_rescan(struct mei_device *bus) | |
895 | { | |
896 | struct mei_cl_device *cldev, *n; | |
897 | struct mei_me_client *me_cl; | |
e46980a1 | 898 | |
6009595a TW |
899 | down_read(&bus->me_clients_rwsem); |
900 | list_for_each_entry(me_cl, &bus->me_clients, list) | |
901 | mei_cl_dev_init(bus, me_cl); | |
902 | up_read(&bus->me_clients_rwsem); | |
e46980a1 | 903 | |
6009595a TW |
904 | mutex_lock(&bus->cl_bus_lock); |
905 | list_for_each_entry_safe(cldev, n, &bus->device_list, bus_list) { | |
e46980a1 | 906 | |
6009595a TW |
907 | if (!mei_me_cl_is_active(cldev->me_cl)) { |
908 | mei_cl_bus_remove_device(cldev); | |
909 | continue; | |
910 | } | |
e46980a1 | 911 | |
6009595a TW |
912 | if (cldev->is_added) |
913 | continue; | |
914 | ||
915 | if (mei_cl_dev_setup(bus, cldev)) | |
916 | mei_cl_bus_dev_add(cldev); | |
917 | else { | |
918 | list_del_init(&cldev->bus_list); | |
919 | put_device(&cldev->dev); | |
920 | } | |
921 | } | |
922 | mutex_unlock(&bus->cl_bus_lock); | |
923 | ||
924 | dev_dbg(bus->dev, "rescan end"); | |
62382997 | 925 | } |
e46980a1 | 926 | |
62382997 TW |
927 | int __mei_cl_driver_register(struct mei_cl_driver *cldrv, struct module *owner) |
928 | { | |
929 | int err; | |
e46980a1 | 930 | |
62382997 TW |
931 | cldrv->driver.name = cldrv->name; |
932 | cldrv->driver.owner = owner; | |
933 | cldrv->driver.bus = &mei_cl_bus_type; | |
e46980a1 | 934 | |
62382997 TW |
935 | err = driver_register(&cldrv->driver); |
936 | if (err) | |
937 | return err; | |
e46980a1 | 938 | |
62382997 | 939 | pr_debug("mei: driver [%s] registered\n", cldrv->driver.name); |
e46980a1 | 940 | |
62382997 | 941 | return 0; |
e46980a1 | 942 | } |
62382997 | 943 | EXPORT_SYMBOL_GPL(__mei_cl_driver_register); |
e46980a1 | 944 | |
62382997 | 945 | void mei_cl_driver_unregister(struct mei_cl_driver *cldrv) |
cf3baefb | 946 | { |
62382997 | 947 | driver_unregister(&cldrv->driver); |
cf3baefb | 948 | |
62382997 | 949 | pr_debug("mei: driver [%s] unregistered\n", cldrv->driver.name); |
cf3baefb | 950 | } |
62382997 | 951 | EXPORT_SYMBOL_GPL(mei_cl_driver_unregister); |
cf3baefb | 952 | |
6009595a | 953 | |
cf3baefb SO |
954 | int __init mei_cl_bus_init(void) |
955 | { | |
956 | return bus_register(&mei_cl_bus_type); | |
957 | } | |
958 | ||
959 | void __exit mei_cl_bus_exit(void) | |
960 | { | |
961 | bus_unregister(&mei_cl_bus_type); | |
962 | } |