xref: /openbmc/linux/drivers/misc/mei/bus.c (revision 35267cea)
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  */
34 ssize_t __mei_cl_send(struct mei_cl *cl, 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  */
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 
235 ssize_t mei_cldev_send_vtag(struct mei_cl_device *cldev, u8 *buf, size_t length,
236 			    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 
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  */
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  */
299 ssize_t mei_cldev_send(struct mei_cl_device *cldev, 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  */
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  */
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  */
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  */
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  */
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  */
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  */
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  */
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  */
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  */
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  */
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  */
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  */
555 bool mei_cldev_enabled(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  */
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  */
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  */
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  */
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  */
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  */
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  */
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  */
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
774 struct mei_cl_device_id *mei_cl_device_find(struct mei_cl_device *cldev,
775 					    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  */
816 static int mei_cl_device_match(struct device *dev, struct device_driver *drv)
817 {
818 	struct mei_cl_device *cldev = to_mei_cl_device(dev);
819 	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  */
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  */
887 static int 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 	return 0;
901 }
902 
903 static ssize_t name_show(struct device *dev, struct device_attribute *a,
904 			     char *buf)
905 {
906 	struct mei_cl_device *cldev = to_mei_cl_device(dev);
907 
908 	return scnprintf(buf, PAGE_SIZE, "%s", cldev->name);
909 }
910 static DEVICE_ATTR_RO(name);
911 
912 static ssize_t uuid_show(struct device *dev, struct device_attribute *a,
913 			     char *buf)
914 {
915 	struct mei_cl_device *cldev = to_mei_cl_device(dev);
916 	const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl);
917 
918 	return sprintf(buf, "%pUl", uuid);
919 }
920 static DEVICE_ATTR_RO(uuid);
921 
922 static ssize_t version_show(struct device *dev, struct device_attribute *a,
923 			     char *buf)
924 {
925 	struct mei_cl_device *cldev = to_mei_cl_device(dev);
926 	u8 version = mei_me_cl_ver(cldev->me_cl);
927 
928 	return sprintf(buf, "%02X", version);
929 }
930 static DEVICE_ATTR_RO(version);
931 
932 static ssize_t modalias_show(struct device *dev, struct device_attribute *a,
933 			     char *buf)
934 {
935 	struct mei_cl_device *cldev = to_mei_cl_device(dev);
936 	const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl);
937 	u8 version = mei_me_cl_ver(cldev->me_cl);
938 
939 	return scnprintf(buf, PAGE_SIZE, "mei:%s:%pUl:%02X:",
940 			 cldev->name, uuid, version);
941 }
942 static DEVICE_ATTR_RO(modalias);
943 
944 static ssize_t max_conn_show(struct device *dev, struct device_attribute *a,
945 			     char *buf)
946 {
947 	struct mei_cl_device *cldev = to_mei_cl_device(dev);
948 	u8 maxconn = mei_me_cl_max_conn(cldev->me_cl);
949 
950 	return sprintf(buf, "%d", maxconn);
951 }
952 static DEVICE_ATTR_RO(max_conn);
953 
954 static ssize_t fixed_show(struct device *dev, struct device_attribute *a,
955 			  char *buf)
956 {
957 	struct mei_cl_device *cldev = to_mei_cl_device(dev);
958 	u8 fixed = mei_me_cl_fixed(cldev->me_cl);
959 
960 	return sprintf(buf, "%d", fixed);
961 }
962 static DEVICE_ATTR_RO(fixed);
963 
964 static ssize_t vtag_show(struct device *dev, struct device_attribute *a,
965 			 char *buf)
966 {
967 	struct mei_cl_device *cldev = to_mei_cl_device(dev);
968 	bool vt = mei_me_cl_vt(cldev->me_cl);
969 
970 	return sprintf(buf, "%d", vt);
971 }
972 static DEVICE_ATTR_RO(vtag);
973 
974 static ssize_t max_len_show(struct device *dev, struct device_attribute *a,
975 			    char *buf)
976 {
977 	struct mei_cl_device *cldev = to_mei_cl_device(dev);
978 	u32 maxlen = mei_me_cl_max_len(cldev->me_cl);
979 
980 	return sprintf(buf, "%u", maxlen);
981 }
982 static DEVICE_ATTR_RO(max_len);
983 
984 static struct attribute *mei_cldev_attrs[] = {
985 	&dev_attr_name.attr,
986 	&dev_attr_uuid.attr,
987 	&dev_attr_version.attr,
988 	&dev_attr_modalias.attr,
989 	&dev_attr_max_conn.attr,
990 	&dev_attr_fixed.attr,
991 	&dev_attr_vtag.attr,
992 	&dev_attr_max_len.attr,
993 	NULL,
994 };
995 ATTRIBUTE_GROUPS(mei_cldev);
996 
997 /**
998  * mei_cl_device_uevent - me client bus uevent handler
999  *
1000  * @dev: device
1001  * @env: uevent kobject
1002  *
1003  * Return: 0 on success -ENOMEM on when add_uevent_var fails
1004  */
1005 static int mei_cl_device_uevent(struct device *dev, struct kobj_uevent_env *env)
1006 {
1007 	struct mei_cl_device *cldev = to_mei_cl_device(dev);
1008 	const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl);
1009 	u8 version = mei_me_cl_ver(cldev->me_cl);
1010 
1011 	if (add_uevent_var(env, "MEI_CL_VERSION=%d", version))
1012 		return -ENOMEM;
1013 
1014 	if (add_uevent_var(env, "MEI_CL_UUID=%pUl", uuid))
1015 		return -ENOMEM;
1016 
1017 	if (add_uevent_var(env, "MEI_CL_NAME=%s", cldev->name))
1018 		return -ENOMEM;
1019 
1020 	if (add_uevent_var(env, "MODALIAS=mei:%s:%pUl:%02X:",
1021 			   cldev->name, uuid, version))
1022 		return -ENOMEM;
1023 
1024 	return 0;
1025 }
1026 
1027 static struct bus_type mei_cl_bus_type = {
1028 	.name		= "mei",
1029 	.dev_groups	= mei_cldev_groups,
1030 	.match		= mei_cl_device_match,
1031 	.probe		= mei_cl_device_probe,
1032 	.remove		= mei_cl_device_remove,
1033 	.uevent		= mei_cl_device_uevent,
1034 };
1035 
1036 static struct mei_device *mei_dev_bus_get(struct mei_device *bus)
1037 {
1038 	if (bus)
1039 		get_device(bus->dev);
1040 
1041 	return bus;
1042 }
1043 
1044 static void mei_dev_bus_put(struct mei_device *bus)
1045 {
1046 	if (bus)
1047 		put_device(bus->dev);
1048 }
1049 
1050 static void mei_cl_bus_dev_release(struct device *dev)
1051 {
1052 	struct mei_cl_device *cldev = to_mei_cl_device(dev);
1053 
1054 	if (!cldev)
1055 		return;
1056 
1057 	mei_me_cl_put(cldev->me_cl);
1058 	mei_dev_bus_put(cldev->bus);
1059 	mei_cl_unlink(cldev->cl);
1060 	kfree(cldev->cl);
1061 	kfree(cldev);
1062 }
1063 
1064 static const struct device_type mei_cl_device_type = {
1065 	.release = mei_cl_bus_dev_release,
1066 };
1067 
1068 /**
1069  * mei_cl_bus_set_name - set device name for me client device
1070  *  <controller>-<client device>
1071  *  Example: 0000:00:16.0-55213584-9a29-4916-badf-0fb7ed682aeb
1072  *
1073  * @cldev: me client device
1074  */
1075 static inline void mei_cl_bus_set_name(struct mei_cl_device *cldev)
1076 {
1077 	dev_set_name(&cldev->dev, "%s-%pUl",
1078 		     dev_name(cldev->bus->dev),
1079 		     mei_me_cl_uuid(cldev->me_cl));
1080 }
1081 
1082 /**
1083  * mei_cl_bus_dev_alloc - initialize and allocate mei client device
1084  *
1085  * @bus: mei device
1086  * @me_cl: me client
1087  *
1088  * Return: allocated device structur or NULL on allocation failure
1089  */
1090 static struct mei_cl_device *mei_cl_bus_dev_alloc(struct mei_device *bus,
1091 						  struct mei_me_client *me_cl)
1092 {
1093 	struct mei_cl_device *cldev;
1094 	struct mei_cl *cl;
1095 
1096 	cldev = kzalloc(sizeof(*cldev), GFP_KERNEL);
1097 	if (!cldev)
1098 		return NULL;
1099 
1100 	cl = mei_cl_allocate(bus);
1101 	if (!cl) {
1102 		kfree(cldev);
1103 		return NULL;
1104 	}
1105 
1106 	device_initialize(&cldev->dev);
1107 	cldev->dev.parent = bus->dev;
1108 	cldev->dev.bus    = &mei_cl_bus_type;
1109 	cldev->dev.type   = &mei_cl_device_type;
1110 	cldev->bus        = mei_dev_bus_get(bus);
1111 	cldev->me_cl      = mei_me_cl_get(me_cl);
1112 	cldev->cl         = cl;
1113 	mei_cl_bus_set_name(cldev);
1114 	cldev->is_added   = 0;
1115 	INIT_LIST_HEAD(&cldev->bus_list);
1116 
1117 	return cldev;
1118 }
1119 
1120 /**
1121  * mei_cl_bus_dev_setup - setup me client device
1122  *    run fix up routines and set the device name
1123  *
1124  * @bus: mei device
1125  * @cldev: me client device
1126  *
1127  * Return: true if the device is eligible for enumeration
1128  */
1129 static bool mei_cl_bus_dev_setup(struct mei_device *bus,
1130 				 struct mei_cl_device *cldev)
1131 {
1132 	cldev->do_match = 1;
1133 	mei_cl_bus_dev_fixup(cldev);
1134 
1135 	/* the device name can change during fix up */
1136 	if (cldev->do_match)
1137 		mei_cl_bus_set_name(cldev);
1138 
1139 	return cldev->do_match == 1;
1140 }
1141 
1142 /**
1143  * mei_cl_bus_dev_add - add me client devices
1144  *
1145  * @cldev: me client device
1146  *
1147  * Return: 0 on success; < 0 on failre
1148  */
1149 static int mei_cl_bus_dev_add(struct mei_cl_device *cldev)
1150 {
1151 	int ret;
1152 
1153 	dev_dbg(cldev->bus->dev, "adding %pUL:%02X\n",
1154 		mei_me_cl_uuid(cldev->me_cl),
1155 		mei_me_cl_ver(cldev->me_cl));
1156 	ret = device_add(&cldev->dev);
1157 	if (!ret)
1158 		cldev->is_added = 1;
1159 
1160 	return ret;
1161 }
1162 
1163 /**
1164  * mei_cl_bus_dev_stop - stop the driver
1165  *
1166  * @cldev: me client device
1167  */
1168 static void mei_cl_bus_dev_stop(struct mei_cl_device *cldev)
1169 {
1170 	if (cldev->is_added)
1171 		device_release_driver(&cldev->dev);
1172 }
1173 
1174 /**
1175  * mei_cl_bus_dev_destroy - destroy me client devices object
1176  *
1177  * @cldev: me client device
1178  *
1179  * Locking: called under "dev->cl_bus_lock" lock
1180  */
1181 static void mei_cl_bus_dev_destroy(struct mei_cl_device *cldev)
1182 {
1183 
1184 	WARN_ON(!mutex_is_locked(&cldev->bus->cl_bus_lock));
1185 
1186 	if (!cldev->is_added)
1187 		return;
1188 
1189 	device_del(&cldev->dev);
1190 
1191 	list_del_init(&cldev->bus_list);
1192 
1193 	cldev->is_added = 0;
1194 	put_device(&cldev->dev);
1195 }
1196 
1197 /**
1198  * mei_cl_bus_remove_device - remove a devices form the bus
1199  *
1200  * @cldev: me client device
1201  */
1202 static void mei_cl_bus_remove_device(struct mei_cl_device *cldev)
1203 {
1204 	mei_cl_bus_dev_stop(cldev);
1205 	mei_cl_bus_dev_destroy(cldev);
1206 }
1207 
1208 /**
1209  * mei_cl_bus_remove_devices - remove all devices form the bus
1210  *
1211  * @bus: mei device
1212  */
1213 void mei_cl_bus_remove_devices(struct mei_device *bus)
1214 {
1215 	struct mei_cl_device *cldev, *next;
1216 
1217 	mutex_lock(&bus->cl_bus_lock);
1218 	list_for_each_entry_safe(cldev, next, &bus->device_list, bus_list)
1219 		mei_cl_bus_remove_device(cldev);
1220 	mutex_unlock(&bus->cl_bus_lock);
1221 }
1222 
1223 
1224 /**
1225  * mei_cl_bus_dev_init - allocate and initializes an mei client devices
1226  *     based on me client
1227  *
1228  * @bus: mei device
1229  * @me_cl: me client
1230  *
1231  * Locking: called under "dev->cl_bus_lock" lock
1232  */
1233 static void mei_cl_bus_dev_init(struct mei_device *bus,
1234 				struct mei_me_client *me_cl)
1235 {
1236 	struct mei_cl_device *cldev;
1237 
1238 	WARN_ON(!mutex_is_locked(&bus->cl_bus_lock));
1239 
1240 	dev_dbg(bus->dev, "initializing %pUl", mei_me_cl_uuid(me_cl));
1241 
1242 	if (me_cl->bus_added)
1243 		return;
1244 
1245 	cldev = mei_cl_bus_dev_alloc(bus, me_cl);
1246 	if (!cldev)
1247 		return;
1248 
1249 	me_cl->bus_added = true;
1250 	list_add_tail(&cldev->bus_list, &bus->device_list);
1251 
1252 }
1253 
1254 /**
1255  * mei_cl_bus_rescan - scan me clients list and add create
1256  *    devices for eligible clients
1257  *
1258  * @bus: mei device
1259  */
1260 static void mei_cl_bus_rescan(struct mei_device *bus)
1261 {
1262 	struct mei_cl_device *cldev, *n;
1263 	struct mei_me_client *me_cl;
1264 
1265 	mutex_lock(&bus->cl_bus_lock);
1266 
1267 	down_read(&bus->me_clients_rwsem);
1268 	list_for_each_entry(me_cl, &bus->me_clients, list)
1269 		mei_cl_bus_dev_init(bus, me_cl);
1270 	up_read(&bus->me_clients_rwsem);
1271 
1272 	list_for_each_entry_safe(cldev, n, &bus->device_list, bus_list) {
1273 
1274 		if (!mei_me_cl_is_active(cldev->me_cl)) {
1275 			mei_cl_bus_remove_device(cldev);
1276 			continue;
1277 		}
1278 
1279 		if (cldev->is_added)
1280 			continue;
1281 
1282 		if (mei_cl_bus_dev_setup(bus, cldev))
1283 			mei_cl_bus_dev_add(cldev);
1284 		else {
1285 			list_del_init(&cldev->bus_list);
1286 			put_device(&cldev->dev);
1287 		}
1288 	}
1289 	mutex_unlock(&bus->cl_bus_lock);
1290 
1291 	dev_dbg(bus->dev, "rescan end");
1292 }
1293 
1294 void mei_cl_bus_rescan_work(struct work_struct *work)
1295 {
1296 	struct mei_device *bus =
1297 		container_of(work, struct mei_device, bus_rescan_work);
1298 
1299 	mei_cl_bus_rescan(bus);
1300 }
1301 
1302 int __mei_cldev_driver_register(struct mei_cl_driver *cldrv,
1303 				struct module *owner)
1304 {
1305 	int err;
1306 
1307 	cldrv->driver.name = cldrv->name;
1308 	cldrv->driver.owner = owner;
1309 	cldrv->driver.bus = &mei_cl_bus_type;
1310 
1311 	err = driver_register(&cldrv->driver);
1312 	if (err)
1313 		return err;
1314 
1315 	pr_debug("mei: driver [%s] registered\n", cldrv->driver.name);
1316 
1317 	return 0;
1318 }
1319 EXPORT_SYMBOL_GPL(__mei_cldev_driver_register);
1320 
1321 void mei_cldev_driver_unregister(struct mei_cl_driver *cldrv)
1322 {
1323 	driver_unregister(&cldrv->driver);
1324 
1325 	pr_debug("mei: driver [%s] unregistered\n", cldrv->driver.name);
1326 }
1327 EXPORT_SYMBOL_GPL(mei_cldev_driver_unregister);
1328 
1329 
1330 int __init mei_cl_bus_init(void)
1331 {
1332 	return bus_register(&mei_cl_bus_type);
1333 }
1334 
1335 void __exit mei_cl_bus_exit(void)
1336 {
1337 	bus_unregister(&mei_cl_bus_type);
1338 }
1339