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