blob: 582b24d2c479f0e49a32bafb85ed96be713b8c52 [file] [log] [blame]
Samuel Ortize5354102013-03-27 17:29:53 +02001/*
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>
Samuel Ortiz3e833292013-03-27 17:29:55 +020019#include <linux/sched.h>
Samuel Ortize5354102013-03-27 17:29:53 +020020#include <linux/init.h>
21#include <linux/errno.h>
22#include <linux/slab.h>
23#include <linux/mutex.h>
24#include <linux/interrupt.h>
Samuel Ortize5354102013-03-27 17:29:53 +020025#include <linux/mei_cl_bus.h>
26
27#include "mei_dev.h"
Samuel Ortiz3e833292013-03-27 17:29:55 +020028#include "client.h"
Samuel Ortize5354102013-03-27 17:29:53 +020029
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
Tomas Winkler62382992015-07-23 15:08:35 +030033/**
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 */
43ssize_t __mei_cl_send(struct mei_cl *cl, u8 *buf, size_t length,
44 bool blocking)
45{
46 struct mei_device *bus;
Alexander Usyskin6cbb0972016-02-10 23:57:26 +020047 struct mei_cl_cb *cb;
Tomas Winkler62382992015-07-23 15:08:35 +030048 ssize_t rets;
49
50 if (WARN_ON(!cl || !cl->dev))
51 return -ENODEV;
52
53 bus = cl->dev;
54
55 mutex_lock(&bus->device_lock);
Alexander Usyskin15c13df2016-02-07 23:35:32 +020056 if (bus->dev_state != MEI_DEV_ENABLED) {
57 rets = -ENODEV;
58 goto out;
59 }
60
Tomas Winkler62382992015-07-23 15:08:35 +030061 if (!mei_cl_is_connected(cl)) {
62 rets = -ENODEV;
63 goto out;
64 }
65
66 /* Check if we have an ME client device */
67 if (!mei_me_cl_is_active(cl->me_cl)) {
68 rets = -ENOTTY;
69 goto out;
70 }
71
72 if (length > mei_cl_mtu(cl)) {
73 rets = -EFBIG;
74 goto out;
75 }
76
77 cb = mei_cl_alloc_cb(cl, length, MEI_FOP_WRITE, NULL);
78 if (!cb) {
79 rets = -ENOMEM;
80 goto out;
81 }
82
83 memcpy(cb->buf.data, buf, length);
84
85 rets = mei_cl_write(cl, cb, blocking);
86
87out:
88 mutex_unlock(&bus->device_lock);
Tomas Winkler62382992015-07-23 15:08:35 +030089
90 return rets;
91}
92
93/**
94 * __mei_cl_recv - internal client receive (read)
95 *
96 * @cl: host client
Tomas Winklerdf7f5442015-10-13 15:02:40 +030097 * @buf: buffer to receive
Tomas Winkler62382992015-07-23 15:08:35 +030098 * @length: buffer length
99 *
100 * Return: read size in bytes of < 0 on error
101 */
102ssize_t __mei_cl_recv(struct mei_cl *cl, u8 *buf, size_t length)
103{
104 struct mei_device *bus;
105 struct mei_cl_cb *cb;
106 size_t r_length;
107 ssize_t rets;
108
109 if (WARN_ON(!cl || !cl->dev))
110 return -ENODEV;
111
112 bus = cl->dev;
113
114 mutex_lock(&bus->device_lock);
Alexander Usyskin15c13df2016-02-07 23:35:32 +0200115 if (bus->dev_state != MEI_DEV_ENABLED) {
116 rets = -ENODEV;
117 goto out;
118 }
Tomas Winkler62382992015-07-23 15:08:35 +0300119
120 cb = mei_cl_read_cb(cl, NULL);
121 if (cb)
122 goto copy;
123
124 rets = mei_cl_read_start(cl, length, NULL);
125 if (rets && rets != -EBUSY)
126 goto out;
127
128 /* wait on event only if there is no other waiter */
Alexander Usyskin1eb5bd42016-06-16 17:58:54 +0300129 /* synchronized under device mutex */
130 if (!waitqueue_active(&cl->rx_wait)) {
Tomas Winkler62382992015-07-23 15:08:35 +0300131
132 mutex_unlock(&bus->device_lock);
133
134 if (wait_event_interruptible(cl->rx_wait,
135 (!list_empty(&cl->rd_completed)) ||
136 (!mei_cl_is_connected(cl)))) {
137
138 if (signal_pending(current))
139 return -EINTR;
140 return -ERESTARTSYS;
141 }
142
143 mutex_lock(&bus->device_lock);
144
145 if (!mei_cl_is_connected(cl)) {
Tomas Winkler2d4d5482016-06-23 00:25:31 +0300146 rets = -ENODEV;
Tomas Winkler62382992015-07-23 15:08:35 +0300147 goto out;
148 }
149 }
150
151 cb = mei_cl_read_cb(cl, NULL);
152 if (!cb) {
153 rets = 0;
154 goto out;
155 }
156
157copy:
158 if (cb->status) {
159 rets = cb->status;
160 goto free;
161 }
162
163 r_length = min_t(size_t, length, cb->buf_idx);
164 memcpy(buf, cb->buf.data, r_length);
165 rets = r_length;
166
167free:
168 mei_io_cb_free(cb);
169out:
170 mutex_unlock(&bus->device_lock);
171
172 return rets;
173}
174
175/**
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300176 * mei_cldev_send - me device send (write)
Tomas Winkler62382992015-07-23 15:08:35 +0300177 *
178 * @cldev: me client device
179 * @buf: buffer to send
180 * @length: buffer length
181 *
182 * Return: written size in bytes or < 0 on error
183 */
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300184ssize_t mei_cldev_send(struct mei_cl_device *cldev, u8 *buf, size_t length)
Tomas Winkler62382992015-07-23 15:08:35 +0300185{
186 struct mei_cl *cl = cldev->cl;
187
188 if (cl == NULL)
189 return -ENODEV;
190
191 return __mei_cl_send(cl, buf, length, 1);
192}
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300193EXPORT_SYMBOL_GPL(mei_cldev_send);
Tomas Winkler62382992015-07-23 15:08:35 +0300194
195/**
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300196 * mei_cldev_recv - client receive (read)
Tomas Winkler62382992015-07-23 15:08:35 +0300197 *
198 * @cldev: me client device
Tomas Winklerdf7f5442015-10-13 15:02:40 +0300199 * @buf: buffer to receive
Tomas Winkler62382992015-07-23 15:08:35 +0300200 * @length: buffer length
201 *
202 * Return: read size in bytes of < 0 on error
203 */
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300204ssize_t mei_cldev_recv(struct mei_cl_device *cldev, u8 *buf, size_t length)
Tomas Winkler62382992015-07-23 15:08:35 +0300205{
206 struct mei_cl *cl = cldev->cl;
207
208 if (cl == NULL)
209 return -ENODEV;
210
211 return __mei_cl_recv(cl, buf, length);
212}
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300213EXPORT_SYMBOL_GPL(mei_cldev_recv);
Tomas Winkler62382992015-07-23 15:08:35 +0300214
215/**
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300216 * mei_cl_bus_event_work - dispatch rx event for a bus device
Tomas Winkler62382992015-07-23 15:08:35 +0300217 * and schedule new work
218 *
219 * @work: work
220 */
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300221static void mei_cl_bus_event_work(struct work_struct *work)
Tomas Winkler62382992015-07-23 15:08:35 +0300222{
223 struct mei_cl_device *cldev;
Alexander Usyskinbc46b452016-05-03 18:54:21 -0400224 struct mei_device *bus;
Tomas Winkler62382992015-07-23 15:08:35 +0300225
226 cldev = container_of(work, struct mei_cl_device, event_work);
227
Alexander Usyskinbc46b452016-05-03 18:54:21 -0400228 bus = cldev->bus;
229
Tomas Winkler62382992015-07-23 15:08:35 +0300230 if (cldev->event_cb)
231 cldev->event_cb(cldev, cldev->events, cldev->event_context);
232
233 cldev->events = 0;
234
235 /* Prepare for the next read */
Alexander Usyskinbc46b452016-05-03 18:54:21 -0400236 if (cldev->events_mask & BIT(MEI_CL_EVENT_RX)) {
237 mutex_lock(&bus->device_lock);
Tomas Winkler3030dc02016-07-26 01:06:05 +0300238 mei_cl_read_start(cldev->cl, mei_cl_mtu(cldev->cl), NULL);
Alexander Usyskinbc46b452016-05-03 18:54:21 -0400239 mutex_unlock(&bus->device_lock);
240 }
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300241}
242
243/**
244 * mei_cl_bus_notify_event - schedule notify cb on bus client
245 *
246 * @cl: host client
Tomas Winkler850f8942016-02-07 23:35:31 +0200247 *
248 * Return: true if event was scheduled
249 * false if the client is not waiting for event
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300250 */
Tomas Winkler850f8942016-02-07 23:35:31 +0200251bool mei_cl_bus_notify_event(struct mei_cl *cl)
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300252{
253 struct mei_cl_device *cldev = cl->cldev;
254
255 if (!cldev || !cldev->event_cb)
Tomas Winkler850f8942016-02-07 23:35:31 +0200256 return false;
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300257
258 if (!(cldev->events_mask & BIT(MEI_CL_EVENT_NOTIF)))
Tomas Winkler850f8942016-02-07 23:35:31 +0200259 return false;
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300260
261 if (!cl->notify_ev)
Tomas Winkler850f8942016-02-07 23:35:31 +0200262 return false;
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300263
264 set_bit(MEI_CL_EVENT_NOTIF, &cldev->events);
265
266 schedule_work(&cldev->event_work);
267
268 cl->notify_ev = false;
Tomas Winkler850f8942016-02-07 23:35:31 +0200269
270 return true;
Tomas Winkler62382992015-07-23 15:08:35 +0300271}
272
273/**
Tomas Winklera1f9ae22016-02-07 23:35:30 +0200274 * mei_cl_bus_rx_event - schedule rx event
Tomas Winkler62382992015-07-23 15:08:35 +0300275 *
276 * @cl: host client
Tomas Winklera1f9ae22016-02-07 23:35:30 +0200277 *
278 * Return: true if event was scheduled
279 * false if the client is not waiting for event
Tomas Winkler62382992015-07-23 15:08:35 +0300280 */
Tomas Winklera1f9ae22016-02-07 23:35:30 +0200281bool mei_cl_bus_rx_event(struct mei_cl *cl)
Tomas Winkler62382992015-07-23 15:08:35 +0300282{
283 struct mei_cl_device *cldev = cl->cldev;
284
285 if (!cldev || !cldev->event_cb)
Tomas Winklera1f9ae22016-02-07 23:35:30 +0200286 return false;
Tomas Winkler62382992015-07-23 15:08:35 +0300287
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300288 if (!(cldev->events_mask & BIT(MEI_CL_EVENT_RX)))
Tomas Winklera1f9ae22016-02-07 23:35:30 +0200289 return false;
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300290
Tomas Winkler62382992015-07-23 15:08:35 +0300291 set_bit(MEI_CL_EVENT_RX, &cldev->events);
292
293 schedule_work(&cldev->event_work);
Tomas Winklera1f9ae22016-02-07 23:35:30 +0200294
295 return true;
Tomas Winkler62382992015-07-23 15:08:35 +0300296}
297
298/**
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300299 * mei_cldev_register_event_cb - register event callback
Tomas Winkler62382992015-07-23 15:08:35 +0300300 *
301 * @cldev: me client devices
302 * @event_cb: callback function
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300303 * @events_mask: requested events bitmask
Tomas Winkler62382992015-07-23 15:08:35 +0300304 * @context: driver context data
305 *
306 * Return: 0 on success
307 * -EALREADY if an callback is already registered
308 * <0 on other errors
309 */
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300310int mei_cldev_register_event_cb(struct mei_cl_device *cldev,
311 unsigned long events_mask,
312 mei_cldev_event_cb_t event_cb, void *context)
Tomas Winkler62382992015-07-23 15:08:35 +0300313{
Alexander Usyskinbc46b452016-05-03 18:54:21 -0400314 struct mei_device *bus = cldev->bus;
Tomas Winkler48168f42015-07-23 15:08:38 +0300315 int ret;
316
Tomas Winkler62382992015-07-23 15:08:35 +0300317 if (cldev->event_cb)
318 return -EALREADY;
319
320 cldev->events = 0;
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300321 cldev->events_mask = events_mask;
Tomas Winkler62382992015-07-23 15:08:35 +0300322 cldev->event_cb = event_cb;
323 cldev->event_context = context;
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300324 INIT_WORK(&cldev->event_work, mei_cl_bus_event_work);
Tomas Winkler62382992015-07-23 15:08:35 +0300325
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300326 if (cldev->events_mask & BIT(MEI_CL_EVENT_RX)) {
Alexander Usyskinbc46b452016-05-03 18:54:21 -0400327 mutex_lock(&bus->device_lock);
Tomas Winkler3030dc02016-07-26 01:06:05 +0300328 ret = mei_cl_read_start(cldev->cl, mei_cl_mtu(cldev->cl), NULL);
Alexander Usyskinbc46b452016-05-03 18:54:21 -0400329 mutex_unlock(&bus->device_lock);
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300330 if (ret && ret != -EBUSY)
331 return ret;
332 }
333
334 if (cldev->events_mask & BIT(MEI_CL_EVENT_NOTIF)) {
Alexander Usyskinbc46b452016-05-03 18:54:21 -0400335 mutex_lock(&bus->device_lock);
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300336 ret = mei_cl_notify_request(cldev->cl, NULL, event_cb ? 1 : 0);
Alexander Usyskinbc46b452016-05-03 18:54:21 -0400337 mutex_unlock(&bus->device_lock);
Alexander Usyskinbb2ef9c2015-07-26 09:54:23 +0300338 if (ret)
339 return ret;
340 }
Tomas Winkler62382992015-07-23 15:08:35 +0300341
342 return 0;
343}
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300344EXPORT_SYMBOL_GPL(mei_cldev_register_event_cb);
Tomas Winkler62382992015-07-23 15:08:35 +0300345
346/**
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300347 * mei_cldev_get_drvdata - driver data getter
Tomas Winkler62382992015-07-23 15:08:35 +0300348 *
349 * @cldev: mei client device
350 *
351 * Return: driver private data
352 */
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300353void *mei_cldev_get_drvdata(const struct mei_cl_device *cldev)
Tomas Winkler62382992015-07-23 15:08:35 +0300354{
355 return dev_get_drvdata(&cldev->dev);
356}
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300357EXPORT_SYMBOL_GPL(mei_cldev_get_drvdata);
Tomas Winkler62382992015-07-23 15:08:35 +0300358
359/**
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300360 * mei_cldev_set_drvdata - driver data setter
Tomas Winkler62382992015-07-23 15:08:35 +0300361 *
362 * @cldev: mei client device
363 * @data: data to store
364 */
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300365void mei_cldev_set_drvdata(struct mei_cl_device *cldev, void *data)
Tomas Winkler62382992015-07-23 15:08:35 +0300366{
367 dev_set_drvdata(&cldev->dev, data);
368}
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300369EXPORT_SYMBOL_GPL(mei_cldev_set_drvdata);
Tomas Winkler62382992015-07-23 15:08:35 +0300370
371/**
Tomas Winklerbaeacd02015-09-10 10:18:02 +0300372 * mei_cldev_uuid - return uuid of the underlying me client
373 *
374 * @cldev: mei client device
375 *
376 * Return: me client uuid
377 */
378const uuid_le *mei_cldev_uuid(const struct mei_cl_device *cldev)
379{
380 return mei_me_cl_uuid(cldev->me_cl);
381}
382EXPORT_SYMBOL_GPL(mei_cldev_uuid);
383
384/**
385 * mei_cldev_ver - return protocol version of the underlying me client
386 *
387 * @cldev: mei client device
388 *
389 * Return: me client protocol version
390 */
391u8 mei_cldev_ver(const struct mei_cl_device *cldev)
392{
393 return mei_me_cl_ver(cldev->me_cl);
394}
395EXPORT_SYMBOL_GPL(mei_cldev_ver);
396
397/**
Tomas Winkler01a14ed2015-09-10 10:18:03 +0300398 * mei_cldev_enabled - check whether the device is enabled
399 *
400 * @cldev: mei client device
401 *
402 * Return: true if me client is initialized and connected
403 */
404bool mei_cldev_enabled(struct mei_cl_device *cldev)
405{
406 return cldev->cl && mei_cl_is_connected(cldev->cl);
407}
408EXPORT_SYMBOL_GPL(mei_cldev_enabled);
409
410/**
Alexander Usyskin5d46c4e2016-12-14 17:56:51 +0200411 * mei_cldev_enable - enable me client device
Tomas Winkler62382992015-07-23 15:08:35 +0300412 * create connection with me client
413 *
414 * @cldev: me client device
415 *
416 * Return: 0 on success and < 0 on error
417 */
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300418int mei_cldev_enable(struct mei_cl_device *cldev)
Tomas Winkler62382992015-07-23 15:08:35 +0300419{
Tomas Winkler60095952015-07-23 15:08:47 +0300420 struct mei_device *bus = cldev->bus;
421 struct mei_cl *cl;
422 int ret;
Tomas Winkler62382992015-07-23 15:08:35 +0300423
Tomas Winkler60095952015-07-23 15:08:47 +0300424 cl = cldev->cl;
Tomas Winkler62382992015-07-23 15:08:35 +0300425
Tomas Winkler60095952015-07-23 15:08:47 +0300426 if (!cl) {
427 mutex_lock(&bus->device_lock);
Alexander Usyskin7851e002016-02-07 23:35:40 +0200428 cl = mei_cl_alloc_linked(bus);
Tomas Winkler60095952015-07-23 15:08:47 +0300429 mutex_unlock(&bus->device_lock);
430 if (IS_ERR(cl))
431 return PTR_ERR(cl);
432 /* update pointers */
433 cldev->cl = cl;
434 cl->cldev = cldev;
435 }
Tomas Winkler62382992015-07-23 15:08:35 +0300436
437 mutex_lock(&bus->device_lock);
Tomas Winkler62382992015-07-23 15:08:35 +0300438 if (mei_cl_is_connected(cl)) {
Tomas Winkler60095952015-07-23 15:08:47 +0300439 ret = 0;
440 goto out;
Tomas Winkler62382992015-07-23 15:08:35 +0300441 }
442
Tomas Winkler60095952015-07-23 15:08:47 +0300443 if (!mei_me_cl_is_active(cldev->me_cl)) {
444 dev_err(&cldev->dev, "me client is not active\n");
445 ret = -ENOTTY;
446 goto out;
Tomas Winkler62382992015-07-23 15:08:35 +0300447 }
448
Tomas Winkler60095952015-07-23 15:08:47 +0300449 ret = mei_cl_connect(cl, cldev->me_cl, NULL);
450 if (ret < 0)
451 dev_err(&cldev->dev, "cannot connect\n");
452
453out:
Tomas Winkler62382992015-07-23 15:08:35 +0300454 mutex_unlock(&bus->device_lock);
455
Tomas Winkler60095952015-07-23 15:08:47 +0300456 return ret;
Tomas Winkler62382992015-07-23 15:08:35 +0300457}
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300458EXPORT_SYMBOL_GPL(mei_cldev_enable);
Tomas Winkler62382992015-07-23 15:08:35 +0300459
460/**
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300461 * mei_cldev_disable - disable me client device
Tomas Winkler62382992015-07-23 15:08:35 +0300462 * disconnect form the me client
463 *
464 * @cldev: me client device
465 *
466 * Return: 0 on success and < 0 on error
467 */
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300468int mei_cldev_disable(struct mei_cl_device *cldev)
Tomas Winkler62382992015-07-23 15:08:35 +0300469{
Tomas Winkler62382992015-07-23 15:08:35 +0300470 struct mei_device *bus;
Tomas Winkler60095952015-07-23 15:08:47 +0300471 struct mei_cl *cl;
472 int err;
Tomas Winkler62382992015-07-23 15:08:35 +0300473
Tomas Winkler60095952015-07-23 15:08:47 +0300474 if (!cldev || !cldev->cl)
Tomas Winkler62382992015-07-23 15:08:35 +0300475 return -ENODEV;
476
Tomas Winkler60095952015-07-23 15:08:47 +0300477 cl = cldev->cl;
478
479 bus = cldev->bus;
Tomas Winkler62382992015-07-23 15:08:35 +0300480
481 cldev->event_cb = NULL;
482
483 mutex_lock(&bus->device_lock);
484
485 if (!mei_cl_is_connected(cl)) {
486 dev_err(bus->dev, "Already disconnected");
487 err = 0;
488 goto out;
489 }
490
491 err = mei_cl_disconnect(cl);
Tomas Winkler60095952015-07-23 15:08:47 +0300492 if (err < 0)
Tomas Winkler62382992015-07-23 15:08:35 +0300493 dev_err(bus->dev, "Could not disconnect from the ME client");
Tomas Winkler62382992015-07-23 15:08:35 +0300494
495out:
Tomas Winkler60095952015-07-23 15:08:47 +0300496 /* Flush queues and remove any pending read */
497 mei_cl_flush_queues(cl, NULL);
498 mei_cl_unlink(cl);
499
500 kfree(cl);
501 cldev->cl = NULL;
502
Tomas Winkler62382992015-07-23 15:08:35 +0300503 mutex_unlock(&bus->device_lock);
504 return err;
Tomas Winkler62382992015-07-23 15:08:35 +0300505}
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300506EXPORT_SYMBOL_GPL(mei_cldev_disable);
Tomas Winkler62382992015-07-23 15:08:35 +0300507
Tomas Winkler688a9cc2015-07-23 15:08:39 +0300508/**
509 * mei_cl_device_find - find matching entry in the driver id table
510 *
511 * @cldev: me client device
512 * @cldrv: me client driver
513 *
514 * Return: id on success; NULL if no id is matching
515 */
516static const
517struct mei_cl_device_id *mei_cl_device_find(struct mei_cl_device *cldev,
518 struct mei_cl_driver *cldrv)
Samuel Ortize5354102013-03-27 17:29:53 +0200519{
Samuel Ortize5354102013-03-27 17:29:53 +0200520 const struct mei_cl_device_id *id;
Tomas Winklerc93b76b2015-05-07 15:54:02 +0300521 const uuid_le *uuid;
Tomas Winklerb26864c2015-09-10 10:18:01 +0300522 u8 version;
523 bool match;
Samuel Ortize5354102013-03-27 17:29:53 +0200524
Tomas Winklerb37719c32015-07-23 15:08:33 +0300525 uuid = mei_me_cl_uuid(cldev->me_cl);
Tomas Winklerb26864c2015-09-10 10:18:01 +0300526 version = mei_me_cl_ver(cldev->me_cl);
Samuel Ortize5354102013-03-27 17:29:53 +0200527
Tomas Winklerb37719c32015-07-23 15:08:33 +0300528 id = cldrv->id_table;
Greg Kroah-Hartmanb144ce22015-05-27 17:17:27 -0700529 while (uuid_le_cmp(NULL_UUID_LE, id->uuid)) {
Greg Kroah-Hartmanb144ce22015-05-27 17:17:27 -0700530 if (!uuid_le_cmp(*uuid, id->uuid)) {
Tomas Winklerb26864c2015-09-10 10:18:01 +0300531 match = true;
Tomas Winkler688a9cc2015-07-23 15:08:39 +0300532
Tomas Winklerb26864c2015-09-10 10:18:01 +0300533 if (cldev->name[0])
534 if (strncmp(cldev->name, id->name,
535 sizeof(id->name)))
536 match = false;
Tomas Winkler688a9cc2015-07-23 15:08:39 +0300537
Tomas Winklerb26864c2015-09-10 10:18:01 +0300538 if (id->version != MEI_CL_VERSION_ANY)
539 if (id->version != version)
540 match = false;
541 if (match)
Tomas Winkler688a9cc2015-07-23 15:08:39 +0300542 return id;
Tomas Winklerc93b76b2015-05-07 15:54:02 +0300543 }
Samuel Ortize5354102013-03-27 17:29:53 +0200544
545 id++;
546 }
547
Tomas Winkler688a9cc2015-07-23 15:08:39 +0300548 return NULL;
549}
550
551/**
552 * mei_cl_device_match - device match function
553 *
554 * @dev: device
555 * @drv: driver
556 *
557 * Return: 1 if matching device was found 0 otherwise
558 */
559static int mei_cl_device_match(struct device *dev, struct device_driver *drv)
560{
561 struct mei_cl_device *cldev = to_mei_cl_device(dev);
562 struct mei_cl_driver *cldrv = to_mei_cl_driver(drv);
563 const struct mei_cl_device_id *found_id;
564
565 if (!cldev)
566 return 0;
567
Tomas Winkler71ce7892015-07-23 15:08:43 +0300568 if (!cldev->do_match)
569 return 0;
570
Tomas Winkler688a9cc2015-07-23 15:08:39 +0300571 if (!cldrv || !cldrv->id_table)
572 return 0;
573
574 found_id = mei_cl_device_find(cldev, cldrv);
575 if (found_id)
576 return 1;
577
Samuel Ortize5354102013-03-27 17:29:53 +0200578 return 0;
579}
580
Tomas Winklerfeb8cd02015-07-23 15:08:40 +0300581/**
582 * mei_cl_device_probe - bus probe function
583 *
584 * @dev: device
585 *
586 * Return: 0 on success; < 0 otherwise
587 */
Samuel Ortize5354102013-03-27 17:29:53 +0200588static int mei_cl_device_probe(struct device *dev)
589{
Tomas Winklerfeb8cd02015-07-23 15:08:40 +0300590 struct mei_cl_device *cldev;
Tomas Winklerb37719c32015-07-23 15:08:33 +0300591 struct mei_cl_driver *cldrv;
Tomas Winklerfeb8cd02015-07-23 15:08:40 +0300592 const struct mei_cl_device_id *id;
Alexey Khoroshilovb9c79542016-04-01 23:53:01 +0300593 int ret;
Tomas Winklerfeb8cd02015-07-23 15:08:40 +0300594
595 cldev = to_mei_cl_device(dev);
596 cldrv = to_mei_cl_driver(dev->driver);
Samuel Ortize5354102013-03-27 17:29:53 +0200597
Tomas Winklerb37719c32015-07-23 15:08:33 +0300598 if (!cldev)
Samuel Ortize5354102013-03-27 17:29:53 +0200599 return 0;
600
Tomas Winklerb37719c32015-07-23 15:08:33 +0300601 if (!cldrv || !cldrv->probe)
Samuel Ortize5354102013-03-27 17:29:53 +0200602 return -ENODEV;
603
Tomas Winklerfeb8cd02015-07-23 15:08:40 +0300604 id = mei_cl_device_find(cldev, cldrv);
605 if (!id)
606 return -ENODEV;
Samuel Ortize5354102013-03-27 17:29:53 +0200607
Alexey Khoroshilovb9c79542016-04-01 23:53:01 +0300608 ret = cldrv->probe(cldev, id);
609 if (ret)
610 return ret;
Samuel Ortize5354102013-03-27 17:29:53 +0200611
Alexey Khoroshilovb9c79542016-04-01 23:53:01 +0300612 __module_get(THIS_MODULE);
613 return 0;
Samuel Ortize5354102013-03-27 17:29:53 +0200614}
615
Tomas Winklerfeb8cd02015-07-23 15:08:40 +0300616/**
617 * mei_cl_device_remove - remove device from the bus
618 *
619 * @dev: device
620 *
621 * Return: 0 on success; < 0 otherwise
622 */
Samuel Ortize5354102013-03-27 17:29:53 +0200623static int mei_cl_device_remove(struct device *dev)
624{
Tomas Winklerb37719c32015-07-23 15:08:33 +0300625 struct mei_cl_device *cldev = to_mei_cl_device(dev);
626 struct mei_cl_driver *cldrv;
Tomas Winklerfeb8cd02015-07-23 15:08:40 +0300627 int ret = 0;
Samuel Ortize5354102013-03-27 17:29:53 +0200628
Tomas Winklerb37719c32015-07-23 15:08:33 +0300629 if (!cldev || !dev->driver)
Samuel Ortize5354102013-03-27 17:29:53 +0200630 return 0;
631
Tomas Winklerb37719c32015-07-23 15:08:33 +0300632 if (cldev->event_cb) {
633 cldev->event_cb = NULL;
634 cancel_work_sync(&cldev->event_work);
Samuel Ortiz3e833292013-03-27 17:29:55 +0200635 }
636
Tomas Winklerb37719c32015-07-23 15:08:33 +0300637 cldrv = to_mei_cl_driver(dev->driver);
Tomas Winklerfeb8cd02015-07-23 15:08:40 +0300638 if (cldrv->remove)
639 ret = cldrv->remove(cldev);
Samuel Ortize5354102013-03-27 17:29:53 +0200640
Tomas Winklerfeb8cd02015-07-23 15:08:40 +0300641 module_put(THIS_MODULE);
642 dev->driver = NULL;
643 return ret;
Samuel Ortize5354102013-03-27 17:29:53 +0200644
Samuel Ortize5354102013-03-27 17:29:53 +0200645}
646
Tomas Winkler007d64e2015-05-07 15:54:03 +0300647static ssize_t name_show(struct device *dev, struct device_attribute *a,
648 char *buf)
649{
Tomas Winklerb37719c32015-07-23 15:08:33 +0300650 struct mei_cl_device *cldev = to_mei_cl_device(dev);
Tomas Winkler007d64e2015-05-07 15:54:03 +0300651
Rasmus Villemoes423de922016-03-24 10:38:04 +0200652 return scnprintf(buf, PAGE_SIZE, "%s", cldev->name);
Tomas Winkler007d64e2015-05-07 15:54:03 +0300653}
654static DEVICE_ATTR_RO(name);
655
656static ssize_t uuid_show(struct device *dev, struct device_attribute *a,
657 char *buf)
658{
Tomas Winklerb37719c32015-07-23 15:08:33 +0300659 struct mei_cl_device *cldev = to_mei_cl_device(dev);
660 const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl);
Tomas Winkler007d64e2015-05-07 15:54:03 +0300661
Rasmus Villemoes423de922016-03-24 10:38:04 +0200662 return scnprintf(buf, PAGE_SIZE, "%pUl", uuid);
Tomas Winkler007d64e2015-05-07 15:54:03 +0300663}
664static DEVICE_ATTR_RO(uuid);
665
Tomas Winkler40b73202015-09-10 10:18:00 +0300666static ssize_t version_show(struct device *dev, struct device_attribute *a,
667 char *buf)
668{
669 struct mei_cl_device *cldev = to_mei_cl_device(dev);
670 u8 version = mei_me_cl_ver(cldev->me_cl);
Tomas Winkler40b73202015-09-10 10:18:00 +0300671
Rasmus Villemoes423de922016-03-24 10:38:04 +0200672 return scnprintf(buf, PAGE_SIZE, "%02X", version);
Tomas Winkler40b73202015-09-10 10:18:00 +0300673}
674static DEVICE_ATTR_RO(version);
675
Samuel Ortize5354102013-03-27 17:29:53 +0200676static ssize_t modalias_show(struct device *dev, struct device_attribute *a,
677 char *buf)
678{
Tomas Winklerb37719c32015-07-23 15:08:33 +0300679 struct mei_cl_device *cldev = to_mei_cl_device(dev);
680 const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl);
Pratyush Anandacd8f912017-05-29 22:08:24 +0300681 u8 version = mei_me_cl_ver(cldev->me_cl);
Samuel Ortize5354102013-03-27 17:29:53 +0200682
Pratyush Anandacd8f912017-05-29 22:08:24 +0300683 return scnprintf(buf, PAGE_SIZE, "mei:%s:%pUl:%02X:",
684 cldev->name, uuid, version);
Samuel Ortize5354102013-03-27 17:29:53 +0200685}
Greg Kroah-Hartman32f389ec2013-08-23 14:24:39 -0700686static DEVICE_ATTR_RO(modalias);
Samuel Ortize5354102013-03-27 17:29:53 +0200687
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300688static struct attribute *mei_cldev_attrs[] = {
Tomas Winkler007d64e2015-05-07 15:54:03 +0300689 &dev_attr_name.attr,
690 &dev_attr_uuid.attr,
Tomas Winkler40b73202015-09-10 10:18:00 +0300691 &dev_attr_version.attr,
Greg Kroah-Hartman32f389ec2013-08-23 14:24:39 -0700692 &dev_attr_modalias.attr,
693 NULL,
Samuel Ortize5354102013-03-27 17:29:53 +0200694};
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300695ATTRIBUTE_GROUPS(mei_cldev);
Samuel Ortize5354102013-03-27 17:29:53 +0200696
Tomas Winkler38d3c002015-07-23 15:08:36 +0300697/**
698 * mei_cl_device_uevent - me client bus uevent handler
699 *
700 * @dev: device
701 * @env: uevent kobject
702 *
703 * Return: 0 on success -ENOMEM on when add_uevent_var fails
704 */
705static int mei_cl_device_uevent(struct device *dev, struct kobj_uevent_env *env)
Samuel Ortize5354102013-03-27 17:29:53 +0200706{
Tomas Winklerb37719c32015-07-23 15:08:33 +0300707 struct mei_cl_device *cldev = to_mei_cl_device(dev);
708 const uuid_le *uuid = mei_me_cl_uuid(cldev->me_cl);
Tomas Winkler40b73202015-09-10 10:18:00 +0300709 u8 version = mei_me_cl_ver(cldev->me_cl);
710
711 if (add_uevent_var(env, "MEI_CL_VERSION=%d", version))
712 return -ENOMEM;
Tomas Winklerc93b76b2015-05-07 15:54:02 +0300713
Tomas Winkler007d64e2015-05-07 15:54:03 +0300714 if (add_uevent_var(env, "MEI_CL_UUID=%pUl", uuid))
715 return -ENOMEM;
716
Tomas Winklerb37719c32015-07-23 15:08:33 +0300717 if (add_uevent_var(env, "MEI_CL_NAME=%s", cldev->name))
Tomas Winkler007d64e2015-05-07 15:54:03 +0300718 return -ENOMEM;
719
Tomas Winklerb26864c2015-09-10 10:18:01 +0300720 if (add_uevent_var(env, "MODALIAS=mei:%s:%pUl:%02X:",
721 cldev->name, uuid, version))
Samuel Ortize5354102013-03-27 17:29:53 +0200722 return -ENOMEM;
723
724 return 0;
725}
726
727static struct bus_type mei_cl_bus_type = {
728 .name = "mei",
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300729 .dev_groups = mei_cldev_groups,
Samuel Ortize5354102013-03-27 17:29:53 +0200730 .match = mei_cl_device_match,
731 .probe = mei_cl_device_probe,
732 .remove = mei_cl_device_remove,
Tomas Winkler38d3c002015-07-23 15:08:36 +0300733 .uevent = mei_cl_device_uevent,
Samuel Ortize5354102013-03-27 17:29:53 +0200734};
735
Tomas Winkler512f64d2015-07-23 15:08:41 +0300736static struct mei_device *mei_dev_bus_get(struct mei_device *bus)
737{
738 if (bus)
739 get_device(bus->dev);
740
741 return bus;
742}
743
744static void mei_dev_bus_put(struct mei_device *bus)
745{
746 if (bus)
747 put_device(bus->dev);
748}
749
Tomas Winklerae48d742015-09-10 10:18:06 +0300750static void mei_cl_bus_dev_release(struct device *dev)
Samuel Ortize5354102013-03-27 17:29:53 +0200751{
Tomas Winklerb37719c32015-07-23 15:08:33 +0300752 struct mei_cl_device *cldev = to_mei_cl_device(dev);
Alexander Usyskind49ed642015-05-04 09:43:54 +0300753
Tomas Winklerb37719c32015-07-23 15:08:33 +0300754 if (!cldev)
Alexander Usyskind49ed642015-05-04 09:43:54 +0300755 return;
756
Tomas Winklerb37719c32015-07-23 15:08:33 +0300757 mei_me_cl_put(cldev->me_cl);
Tomas Winkler512f64d2015-07-23 15:08:41 +0300758 mei_dev_bus_put(cldev->bus);
Tomas Winklerb37719c32015-07-23 15:08:33 +0300759 kfree(cldev);
Samuel Ortize5354102013-03-27 17:29:53 +0200760}
761
762static struct device_type mei_cl_device_type = {
Tomas Winklerae48d742015-09-10 10:18:06 +0300763 .release = mei_cl_bus_dev_release,
Samuel Ortize5354102013-03-27 17:29:53 +0200764};
765
Tomas Winkler71ce7892015-07-23 15:08:43 +0300766/**
Tomas Winkler213dd192015-10-28 14:34:35 +0200767 * mei_cl_bus_set_name - set device name for me client device
Alexander Usyskin5cce6032019-11-05 17:05:13 +0200768 * <controller>-<client device>
769 * Example: 0000:00:16.0-55213584-9a29-4916-badf-0fb7ed682aeb
Tomas Winkler213dd192015-10-28 14:34:35 +0200770 *
771 * @cldev: me client device
772 */
773static inline void mei_cl_bus_set_name(struct mei_cl_device *cldev)
774{
Alexander Usyskin5cce6032019-11-05 17:05:13 +0200775 dev_set_name(&cldev->dev, "%s-%pUl",
776 dev_name(cldev->bus->dev),
777 mei_me_cl_uuid(cldev->me_cl));
Tomas Winkler213dd192015-10-28 14:34:35 +0200778}
779
780/**
Tomas Winklerae48d742015-09-10 10:18:06 +0300781 * mei_cl_bus_dev_alloc - initialize and allocate mei client device
Tomas Winkler71ce7892015-07-23 15:08:43 +0300782 *
783 * @bus: mei device
784 * @me_cl: me client
785 *
786 * Return: allocated device structur or NULL on allocation failure
787 */
Tomas Winklerae48d742015-09-10 10:18:06 +0300788static struct mei_cl_device *mei_cl_bus_dev_alloc(struct mei_device *bus,
789 struct mei_me_client *me_cl)
Tomas Winkler71ce7892015-07-23 15:08:43 +0300790{
791 struct mei_cl_device *cldev;
792
793 cldev = kzalloc(sizeof(struct mei_cl_device), GFP_KERNEL);
794 if (!cldev)
795 return NULL;
796
797 device_initialize(&cldev->dev);
798 cldev->dev.parent = bus->dev;
799 cldev->dev.bus = &mei_cl_bus_type;
800 cldev->dev.type = &mei_cl_device_type;
801 cldev->bus = mei_dev_bus_get(bus);
802 cldev->me_cl = mei_me_cl_get(me_cl);
Tomas Winkler213dd192015-10-28 14:34:35 +0200803 mei_cl_bus_set_name(cldev);
Tomas Winkler71ce7892015-07-23 15:08:43 +0300804 cldev->is_added = 0;
805 INIT_LIST_HEAD(&cldev->bus_list);
806
807 return cldev;
808}
809
810/**
811 * mei_cl_dev_setup - setup me client device
812 * run fix up routines and set the device name
813 *
814 * @bus: mei device
815 * @cldev: me client device
816 *
817 * Return: true if the device is eligible for enumeration
818 */
Tomas Winklerae48d742015-09-10 10:18:06 +0300819static bool mei_cl_bus_dev_setup(struct mei_device *bus,
820 struct mei_cl_device *cldev)
Tomas Winkler71ce7892015-07-23 15:08:43 +0300821{
822 cldev->do_match = 1;
Tomas Winklerae48d742015-09-10 10:18:06 +0300823 mei_cl_bus_dev_fixup(cldev);
Tomas Winkler71ce7892015-07-23 15:08:43 +0300824
Tomas Winkler213dd192015-10-28 14:34:35 +0200825 /* the device name can change during fix up */
Tomas Winkler71ce7892015-07-23 15:08:43 +0300826 if (cldev->do_match)
Tomas Winkler213dd192015-10-28 14:34:35 +0200827 mei_cl_bus_set_name(cldev);
Tomas Winkler71ce7892015-07-23 15:08:43 +0300828
829 return cldev->do_match == 1;
830}
831
832/**
833 * mei_cl_bus_dev_add - add me client devices
834 *
835 * @cldev: me client device
836 *
837 * Return: 0 on success; < 0 on failre
838 */
839static int mei_cl_bus_dev_add(struct mei_cl_device *cldev)
840{
841 int ret;
842
Tomas Winklerb26864c2015-09-10 10:18:01 +0300843 dev_dbg(cldev->bus->dev, "adding %pUL:%02X\n",
844 mei_me_cl_uuid(cldev->me_cl),
845 mei_me_cl_ver(cldev->me_cl));
Tomas Winkler71ce7892015-07-23 15:08:43 +0300846 ret = device_add(&cldev->dev);
847 if (!ret)
848 cldev->is_added = 1;
849
850 return ret;
851}
852
Tomas Winkler60095952015-07-23 15:08:47 +0300853/**
854 * mei_cl_bus_dev_stop - stop the driver
855 *
856 * @cldev: me client device
857 */
858static void mei_cl_bus_dev_stop(struct mei_cl_device *cldev)
859{
860 if (cldev->is_added)
861 device_release_driver(&cldev->dev);
862}
863
864/**
865 * mei_cl_bus_dev_destroy - destroy me client devices object
866 *
867 * @cldev: me client device
Tomas Winkler2da55cf2015-10-28 14:34:34 +0200868 *
869 * Locking: called under "dev->cl_bus_lock" lock
Tomas Winkler60095952015-07-23 15:08:47 +0300870 */
871static void mei_cl_bus_dev_destroy(struct mei_cl_device *cldev)
872{
Tomas Winkler2da55cf2015-10-28 14:34:34 +0200873
874 WARN_ON(!mutex_is_locked(&cldev->bus->cl_bus_lock));
875
Tomas Winkler60095952015-07-23 15:08:47 +0300876 if (!cldev->is_added)
877 return;
878
879 device_del(&cldev->dev);
880
Tomas Winkler60095952015-07-23 15:08:47 +0300881 list_del_init(&cldev->bus_list);
Tomas Winkler60095952015-07-23 15:08:47 +0300882
883 cldev->is_added = 0;
884 put_device(&cldev->dev);
885}
886
887/**
888 * mei_cl_bus_remove_device - remove a devices form the bus
889 *
890 * @cldev: me client device
891 */
892static void mei_cl_bus_remove_device(struct mei_cl_device *cldev)
893{
894 mei_cl_bus_dev_stop(cldev);
895 mei_cl_bus_dev_destroy(cldev);
896}
897
898/**
899 * mei_cl_bus_remove_devices - remove all devices form the bus
900 *
901 * @bus: mei device
902 */
903void mei_cl_bus_remove_devices(struct mei_device *bus)
904{
905 struct mei_cl_device *cldev, *next;
906
Tomas Winkler2da55cf2015-10-28 14:34:34 +0200907 mutex_lock(&bus->cl_bus_lock);
Tomas Winkler60095952015-07-23 15:08:47 +0300908 list_for_each_entry_safe(cldev, next, &bus->device_list, bus_list)
909 mei_cl_bus_remove_device(cldev);
Tomas Winkler2da55cf2015-10-28 14:34:34 +0200910 mutex_unlock(&bus->cl_bus_lock);
Tomas Winkler60095952015-07-23 15:08:47 +0300911}
912
913
914/**
Tomas Winklerae48d742015-09-10 10:18:06 +0300915 * mei_cl_bus_dev_init - allocate and initializes an mei client devices
Tomas Winkler60095952015-07-23 15:08:47 +0300916 * based on me client
917 *
918 * @bus: mei device
919 * @me_cl: me client
Tomas Winkler2da55cf2015-10-28 14:34:34 +0200920 *
921 * Locking: called under "dev->cl_bus_lock" lock
Tomas Winkler60095952015-07-23 15:08:47 +0300922 */
Tomas Winklerae48d742015-09-10 10:18:06 +0300923static void mei_cl_bus_dev_init(struct mei_device *bus,
924 struct mei_me_client *me_cl)
Samuel Ortize5354102013-03-27 17:29:53 +0200925{
Tomas Winklerb37719c32015-07-23 15:08:33 +0300926 struct mei_cl_device *cldev;
Tomas Winkler60095952015-07-23 15:08:47 +0300927
Tomas Winkler2da55cf2015-10-28 14:34:34 +0200928 WARN_ON(!mutex_is_locked(&bus->cl_bus_lock));
929
Tomas Winkler60095952015-07-23 15:08:47 +0300930 dev_dbg(bus->dev, "initializing %pUl", mei_me_cl_uuid(me_cl));
931
932 if (me_cl->bus_added)
933 return;
Samuel Ortize5354102013-03-27 17:29:53 +0200934
Tomas Winklerae48d742015-09-10 10:18:06 +0300935 cldev = mei_cl_bus_dev_alloc(bus, me_cl);
Tomas Winklerb37719c32015-07-23 15:08:33 +0300936 if (!cldev)
Tomas Winkler60095952015-07-23 15:08:47 +0300937 return;
Samuel Ortize5354102013-03-27 17:29:53 +0200938
Tomas Winkler60095952015-07-23 15:08:47 +0300939 me_cl->bus_added = true;
940 list_add_tail(&cldev->bus_list, &bus->device_list);
Tomas Winklerc93b76b2015-05-07 15:54:02 +0300941
Samuel Ortize5354102013-03-27 17:29:53 +0200942}
Samuel Ortize5354102013-03-27 17:29:53 +0200943
Tomas Winkler60095952015-07-23 15:08:47 +0300944/**
945 * mei_cl_bus_rescan - scan me clients list and add create
946 * devices for eligible clients
947 *
948 * @bus: mei device
949 */
950void mei_cl_bus_rescan(struct mei_device *bus)
Samuel Ortize5354102013-03-27 17:29:53 +0200951{
Tomas Winkler60095952015-07-23 15:08:47 +0300952 struct mei_cl_device *cldev, *n;
953 struct mei_me_client *me_cl;
954
Tomas Winkler2da55cf2015-10-28 14:34:34 +0200955 mutex_lock(&bus->cl_bus_lock);
956
Tomas Winkler60095952015-07-23 15:08:47 +0300957 down_read(&bus->me_clients_rwsem);
958 list_for_each_entry(me_cl, &bus->me_clients, list)
Tomas Winklerae48d742015-09-10 10:18:06 +0300959 mei_cl_bus_dev_init(bus, me_cl);
Tomas Winkler60095952015-07-23 15:08:47 +0300960 up_read(&bus->me_clients_rwsem);
961
Tomas Winkler60095952015-07-23 15:08:47 +0300962 list_for_each_entry_safe(cldev, n, &bus->device_list, bus_list) {
963
964 if (!mei_me_cl_is_active(cldev->me_cl)) {
965 mei_cl_bus_remove_device(cldev);
966 continue;
967 }
968
969 if (cldev->is_added)
970 continue;
971
Tomas Winklerae48d742015-09-10 10:18:06 +0300972 if (mei_cl_bus_dev_setup(bus, cldev))
Tomas Winkler60095952015-07-23 15:08:47 +0300973 mei_cl_bus_dev_add(cldev);
974 else {
975 list_del_init(&cldev->bus_list);
976 put_device(&cldev->dev);
977 }
978 }
979 mutex_unlock(&bus->cl_bus_lock);
980
981 dev_dbg(bus->dev, "rescan end");
Samuel Ortize5354102013-03-27 17:29:53 +0200982}
Samuel Ortiz333e4ee2013-03-27 17:29:54 +0200983
Alexander Usyskina816a002016-02-07 23:35:41 +0200984void mei_cl_bus_rescan_work(struct work_struct *work)
985{
986 struct mei_device *bus =
987 container_of(work, struct mei_device, bus_rescan_work);
Alexander Usyskin025fb792016-02-07 23:35:43 +0200988 struct mei_me_client *me_cl;
989
Alexander Usyskin025fb792016-02-07 23:35:43 +0200990 me_cl = mei_me_cl_by_uuid(bus, &mei_amthif_guid);
991 if (me_cl)
992 mei_amthif_host_init(bus, me_cl);
993 mei_me_cl_put(me_cl);
Alexander Usyskina816a002016-02-07 23:35:41 +0200994
995 mei_cl_bus_rescan(bus);
996}
997
Tomas Winklerd49dc5e2015-09-10 10:18:05 +0300998int __mei_cldev_driver_register(struct mei_cl_driver *cldrv,
999 struct module *owner)
Samuel Ortiz333e4ee2013-03-27 17:29:54 +02001000{
1001 int err;
1002
Tomas Winklerb37719c32015-07-23 15:08:33 +03001003 cldrv->driver.name = cldrv->name;
1004 cldrv->driver.owner = owner;
1005 cldrv->driver.bus = &mei_cl_bus_type;
Samuel Ortiz333e4ee2013-03-27 17:29:54 +02001006
Tomas Winklerb37719c32015-07-23 15:08:33 +03001007 err = driver_register(&cldrv->driver);
Samuel Ortiz333e4ee2013-03-27 17:29:54 +02001008 if (err)
1009 return err;
1010
Tomas Winklerb37719c32015-07-23 15:08:33 +03001011 pr_debug("mei: driver [%s] registered\n", cldrv->driver.name);
Samuel Ortiz333e4ee2013-03-27 17:29:54 +02001012
1013 return 0;
1014}
Tomas Winklerd49dc5e2015-09-10 10:18:05 +03001015EXPORT_SYMBOL_GPL(__mei_cldev_driver_register);
Samuel Ortiz333e4ee2013-03-27 17:29:54 +02001016
Tomas Winklerd49dc5e2015-09-10 10:18:05 +03001017void mei_cldev_driver_unregister(struct mei_cl_driver *cldrv)
Samuel Ortiz333e4ee2013-03-27 17:29:54 +02001018{
Tomas Winklerb37719c32015-07-23 15:08:33 +03001019 driver_unregister(&cldrv->driver);
Samuel Ortiz333e4ee2013-03-27 17:29:54 +02001020
Tomas Winklerb37719c32015-07-23 15:08:33 +03001021 pr_debug("mei: driver [%s] unregistered\n", cldrv->driver.name);
Samuel Ortiz333e4ee2013-03-27 17:29:54 +02001022}
Tomas Winklerd49dc5e2015-09-10 10:18:05 +03001023EXPORT_SYMBOL_GPL(mei_cldev_driver_unregister);
Samuel Ortiz3e833292013-03-27 17:29:55 +02001024
Tomas Winkler60095952015-07-23 15:08:47 +03001025
Samuel Ortizcf3baef2013-03-27 17:29:57 +02001026int __init mei_cl_bus_init(void)
1027{
1028 return bus_register(&mei_cl_bus_type);
1029}
1030
1031void __exit mei_cl_bus_exit(void)
1032{
1033 bus_unregister(&mei_cl_bus_type);
1034}