Loading...
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * Copyright (c) 2011-2017, The Linux Foundation
4 */
5
6#include <linux/kernel.h>
7#include <linux/errno.h>
8#include <linux/slab.h>
9#include <linux/init.h>
10#include <linux/idr.h>
11#include <linux/of.h>
12#include <linux/of_device.h>
13#include <linux/pm_runtime.h>
14#include <linux/slimbus.h>
15#include "slimbus.h"
16
17static DEFINE_IDA(ctrl_ida);
18
19static const struct slim_device_id *slim_match(const struct slim_device_id *id,
20 const struct slim_device *sbdev)
21{
22 while (id->manf_id != 0 || id->prod_code != 0) {
23 if (id->manf_id == sbdev->e_addr.manf_id &&
24 id->prod_code == sbdev->e_addr.prod_code &&
25 id->dev_index == sbdev->e_addr.dev_index &&
26 id->instance == sbdev->e_addr.instance)
27 return id;
28 id++;
29 }
30 return NULL;
31}
32
33static int slim_device_match(struct device *dev, struct device_driver *drv)
34{
35 struct slim_device *sbdev = to_slim_device(dev);
36 struct slim_driver *sbdrv = to_slim_driver(drv);
37
38 /* Attempt an OF style match first */
39 if (of_driver_match_device(dev, drv))
40 return 1;
41
42 return !!slim_match(sbdrv->id_table, sbdev);
43}
44
45static void slim_device_update_status(struct slim_device *sbdev,
46 enum slim_device_status status)
47{
48 struct slim_driver *sbdrv;
49
50 if (sbdev->status == status)
51 return;
52
53 sbdev->status = status;
54 if (!sbdev->dev.driver)
55 return;
56
57 sbdrv = to_slim_driver(sbdev->dev.driver);
58 if (sbdrv->device_status)
59 sbdrv->device_status(sbdev, sbdev->status);
60}
61
62static int slim_device_probe(struct device *dev)
63{
64 struct slim_device *sbdev = to_slim_device(dev);
65 struct slim_driver *sbdrv = to_slim_driver(dev->driver);
66 int ret;
67
68 ret = sbdrv->probe(sbdev);
69 if (ret)
70 return ret;
71
72 /* try getting the logical address after probe */
73 ret = slim_get_logical_addr(sbdev);
74 if (!ret) {
75 slim_device_update_status(sbdev, SLIM_DEVICE_STATUS_UP);
76 } else {
77 dev_err(&sbdev->dev, "Failed to get logical address\n");
78 ret = -EPROBE_DEFER;
79 }
80
81 return ret;
82}
83
84static void slim_device_remove(struct device *dev)
85{
86 struct slim_device *sbdev = to_slim_device(dev);
87 struct slim_driver *sbdrv;
88
89 if (dev->driver) {
90 sbdrv = to_slim_driver(dev->driver);
91 if (sbdrv->remove)
92 sbdrv->remove(sbdev);
93 }
94}
95
96static int slim_device_uevent(const struct device *dev, struct kobj_uevent_env *env)
97{
98 const struct slim_device *sbdev = to_slim_device(dev);
99
100 return add_uevent_var(env, "MODALIAS=slim:%s", dev_name(&sbdev->dev));
101}
102
103struct bus_type slimbus_bus = {
104 .name = "slimbus",
105 .match = slim_device_match,
106 .probe = slim_device_probe,
107 .remove = slim_device_remove,
108 .uevent = slim_device_uevent,
109};
110EXPORT_SYMBOL_GPL(slimbus_bus);
111
112/*
113 * __slim_driver_register() - Client driver registration with SLIMbus
114 *
115 * @drv:Client driver to be associated with client-device.
116 * @owner: owning module/driver
117 *
118 * This API will register the client driver with the SLIMbus
119 * It is called from the driver's module-init function.
120 */
121int __slim_driver_register(struct slim_driver *drv, struct module *owner)
122{
123 /* ID table and probe are mandatory */
124 if (!(drv->driver.of_match_table || drv->id_table) || !drv->probe)
125 return -EINVAL;
126
127 drv->driver.bus = &slimbus_bus;
128 drv->driver.owner = owner;
129
130 return driver_register(&drv->driver);
131}
132EXPORT_SYMBOL_GPL(__slim_driver_register);
133
134/*
135 * slim_driver_unregister() - Undo effect of slim_driver_register
136 *
137 * @drv: Client driver to be unregistered
138 */
139void slim_driver_unregister(struct slim_driver *drv)
140{
141 driver_unregister(&drv->driver);
142}
143EXPORT_SYMBOL_GPL(slim_driver_unregister);
144
145static void slim_dev_release(struct device *dev)
146{
147 struct slim_device *sbdev = to_slim_device(dev);
148
149 kfree(sbdev);
150}
151
152static int slim_add_device(struct slim_controller *ctrl,
153 struct slim_device *sbdev,
154 struct device_node *node)
155{
156 sbdev->dev.bus = &slimbus_bus;
157 sbdev->dev.parent = ctrl->dev;
158 sbdev->dev.release = slim_dev_release;
159 sbdev->dev.driver = NULL;
160 sbdev->ctrl = ctrl;
161 INIT_LIST_HEAD(&sbdev->stream_list);
162 spin_lock_init(&sbdev->stream_list_lock);
163 sbdev->dev.of_node = of_node_get(node);
164 sbdev->dev.fwnode = of_fwnode_handle(node);
165
166 dev_set_name(&sbdev->dev, "%x:%x:%x:%x",
167 sbdev->e_addr.manf_id,
168 sbdev->e_addr.prod_code,
169 sbdev->e_addr.dev_index,
170 sbdev->e_addr.instance);
171
172 return device_register(&sbdev->dev);
173}
174
175static struct slim_device *slim_alloc_device(struct slim_controller *ctrl,
176 struct slim_eaddr *eaddr,
177 struct device_node *node)
178{
179 struct slim_device *sbdev;
180 int ret;
181
182 sbdev = kzalloc(sizeof(*sbdev), GFP_KERNEL);
183 if (!sbdev)
184 return NULL;
185
186 sbdev->e_addr = *eaddr;
187 ret = slim_add_device(ctrl, sbdev, node);
188 if (ret) {
189 put_device(&sbdev->dev);
190 return NULL;
191 }
192
193 return sbdev;
194}
195
196static void of_register_slim_devices(struct slim_controller *ctrl)
197{
198 struct device *dev = ctrl->dev;
199 struct device_node *node;
200
201 if (!ctrl->dev->of_node)
202 return;
203
204 for_each_child_of_node(ctrl->dev->of_node, node) {
205 struct slim_device *sbdev;
206 struct slim_eaddr e_addr;
207 const char *compat = NULL;
208 int reg[2], ret;
209 int manf_id, prod_code;
210
211 compat = of_get_property(node, "compatible", NULL);
212 if (!compat)
213 continue;
214
215 ret = sscanf(compat, "slim%x,%x", &manf_id, &prod_code);
216 if (ret != 2) {
217 dev_err(dev, "Manf ID & Product code not found %s\n",
218 compat);
219 continue;
220 }
221
222 ret = of_property_read_u32_array(node, "reg", reg, 2);
223 if (ret) {
224 dev_err(dev, "Device and Instance id not found:%d\n",
225 ret);
226 continue;
227 }
228
229 e_addr.dev_index = reg[0];
230 e_addr.instance = reg[1];
231 e_addr.manf_id = manf_id;
232 e_addr.prod_code = prod_code;
233
234 sbdev = slim_alloc_device(ctrl, &e_addr, node);
235 if (!sbdev)
236 continue;
237 }
238}
239
240/*
241 * slim_register_controller() - Controller bring-up and registration.
242 *
243 * @ctrl: Controller to be registered.
244 *
245 * A controller is registered with the framework using this API.
246 * If devices on a controller were registered before controller,
247 * this will make sure that they get probed when controller is up
248 */
249int slim_register_controller(struct slim_controller *ctrl)
250{
251 int id;
252
253 id = ida_alloc(&ctrl_ida, GFP_KERNEL);
254 if (id < 0)
255 return id;
256
257 ctrl->id = id;
258
259 if (!ctrl->min_cg)
260 ctrl->min_cg = SLIM_MIN_CLK_GEAR;
261 if (!ctrl->max_cg)
262 ctrl->max_cg = SLIM_MAX_CLK_GEAR;
263
264 ida_init(&ctrl->laddr_ida);
265 idr_init(&ctrl->tid_idr);
266 mutex_init(&ctrl->lock);
267 mutex_init(&ctrl->sched.m_reconf);
268 init_completion(&ctrl->sched.pause_comp);
269 spin_lock_init(&ctrl->txn_lock);
270
271 dev_dbg(ctrl->dev, "Bus [%s] registered:dev:%p\n",
272 ctrl->name, ctrl->dev);
273
274 of_register_slim_devices(ctrl);
275
276 return 0;
277}
278EXPORT_SYMBOL_GPL(slim_register_controller);
279
280/* slim_remove_device: Remove the effect of slim_add_device() */
281static void slim_remove_device(struct slim_device *sbdev)
282{
283 of_node_put(sbdev->dev.of_node);
284 device_unregister(&sbdev->dev);
285}
286
287static int slim_ctrl_remove_device(struct device *dev, void *null)
288{
289 slim_remove_device(to_slim_device(dev));
290 return 0;
291}
292
293/**
294 * slim_unregister_controller() - Controller tear-down.
295 *
296 * @ctrl: Controller to tear-down.
297 */
298int slim_unregister_controller(struct slim_controller *ctrl)
299{
300 /* Remove all clients */
301 device_for_each_child(ctrl->dev, NULL, slim_ctrl_remove_device);
302 ida_free(&ctrl_ida, ctrl->id);
303
304 return 0;
305}
306EXPORT_SYMBOL_GPL(slim_unregister_controller);
307
308/**
309 * slim_report_absent() - Controller calls this function when a device
310 * reports absent, OR when the device cannot be communicated with
311 *
312 * @sbdev: Device that cannot be reached, or sent report absent
313 */
314void slim_report_absent(struct slim_device *sbdev)
315{
316 struct slim_controller *ctrl = sbdev->ctrl;
317
318 if (!ctrl)
319 return;
320
321 /* invalidate logical addresses */
322 mutex_lock(&ctrl->lock);
323 sbdev->is_laddr_valid = false;
324 mutex_unlock(&ctrl->lock);
325 if (!ctrl->get_laddr)
326 ida_free(&ctrl->laddr_ida, sbdev->laddr);
327 slim_device_update_status(sbdev, SLIM_DEVICE_STATUS_DOWN);
328}
329EXPORT_SYMBOL_GPL(slim_report_absent);
330
331static bool slim_eaddr_equal(struct slim_eaddr *a, struct slim_eaddr *b)
332{
333 return (a->manf_id == b->manf_id &&
334 a->prod_code == b->prod_code &&
335 a->dev_index == b->dev_index &&
336 a->instance == b->instance);
337}
338
339static int slim_match_dev(struct device *dev, void *data)
340{
341 struct slim_eaddr *e_addr = data;
342 struct slim_device *sbdev = to_slim_device(dev);
343
344 return slim_eaddr_equal(&sbdev->e_addr, e_addr);
345}
346
347static struct slim_device *find_slim_device(struct slim_controller *ctrl,
348 struct slim_eaddr *eaddr)
349{
350 struct slim_device *sbdev;
351 struct device *dev;
352
353 dev = device_find_child(ctrl->dev, eaddr, slim_match_dev);
354 if (dev) {
355 sbdev = to_slim_device(dev);
356 return sbdev;
357 }
358
359 return NULL;
360}
361
362/**
363 * slim_get_device() - get handle to a device.
364 *
365 * @ctrl: Controller on which this device will be added/queried
366 * @e_addr: Enumeration address of the device to be queried
367 *
368 * Return: pointer to a device if it has already reported. Creates a new
369 * device and returns pointer to it if the device has not yet enumerated.
370 */
371struct slim_device *slim_get_device(struct slim_controller *ctrl,
372 struct slim_eaddr *e_addr)
373{
374 struct slim_device *sbdev;
375
376 sbdev = find_slim_device(ctrl, e_addr);
377 if (!sbdev) {
378 sbdev = slim_alloc_device(ctrl, e_addr, NULL);
379 if (!sbdev)
380 return ERR_PTR(-ENOMEM);
381 }
382
383 return sbdev;
384}
385EXPORT_SYMBOL_GPL(slim_get_device);
386
387static int of_slim_match_dev(struct device *dev, void *data)
388{
389 struct device_node *np = data;
390 struct slim_device *sbdev = to_slim_device(dev);
391
392 return (sbdev->dev.of_node == np);
393}
394
395static struct slim_device *of_find_slim_device(struct slim_controller *ctrl,
396 struct device_node *np)
397{
398 struct slim_device *sbdev;
399 struct device *dev;
400
401 dev = device_find_child(ctrl->dev, np, of_slim_match_dev);
402 if (dev) {
403 sbdev = to_slim_device(dev);
404 return sbdev;
405 }
406
407 return NULL;
408}
409
410/**
411 * of_slim_get_device() - get handle to a device using dt node.
412 *
413 * @ctrl: Controller on which this device will be added/queried
414 * @np: node pointer to device
415 *
416 * Return: pointer to a device if it has already reported. Creates a new
417 * device and returns pointer to it if the device has not yet enumerated.
418 */
419struct slim_device *of_slim_get_device(struct slim_controller *ctrl,
420 struct device_node *np)
421{
422 return of_find_slim_device(ctrl, np);
423}
424EXPORT_SYMBOL_GPL(of_slim_get_device);
425
426static int slim_device_alloc_laddr(struct slim_device *sbdev,
427 bool report_present)
428{
429 struct slim_controller *ctrl = sbdev->ctrl;
430 u8 laddr;
431 int ret;
432
433 mutex_lock(&ctrl->lock);
434 if (ctrl->get_laddr) {
435 ret = ctrl->get_laddr(ctrl, &sbdev->e_addr, &laddr);
436 if (ret < 0)
437 goto err;
438 } else if (report_present) {
439 ret = ida_simple_get(&ctrl->laddr_ida,
440 0, SLIM_LA_MANAGER - 1, GFP_KERNEL);
441 if (ret < 0)
442 goto err;
443
444 laddr = ret;
445 } else {
446 ret = -EINVAL;
447 goto err;
448 }
449
450 if (ctrl->set_laddr) {
451 ret = ctrl->set_laddr(ctrl, &sbdev->e_addr, laddr);
452 if (ret) {
453 ret = -EINVAL;
454 goto err;
455 }
456 }
457
458 sbdev->laddr = laddr;
459 sbdev->is_laddr_valid = true;
460 mutex_unlock(&ctrl->lock);
461
462 slim_device_update_status(sbdev, SLIM_DEVICE_STATUS_UP);
463
464 dev_dbg(ctrl->dev, "setting slimbus l-addr:%x, ea:%x,%x,%x,%x\n",
465 laddr, sbdev->e_addr.manf_id, sbdev->e_addr.prod_code,
466 sbdev->e_addr.dev_index, sbdev->e_addr.instance);
467
468 return 0;
469
470err:
471 mutex_unlock(&ctrl->lock);
472 return ret;
473
474}
475
476/**
477 * slim_device_report_present() - Report enumerated device.
478 *
479 * @ctrl: Controller with which device is enumerated.
480 * @e_addr: Enumeration address of the device.
481 * @laddr: Return logical address (if valid flag is false)
482 *
483 * Called by controller in response to REPORT_PRESENT. Framework will assign
484 * a logical address to this enumeration address.
485 * Function returns -EXFULL to indicate that all logical addresses are already
486 * taken.
487 */
488int slim_device_report_present(struct slim_controller *ctrl,
489 struct slim_eaddr *e_addr, u8 *laddr)
490{
491 struct slim_device *sbdev;
492 int ret;
493
494 ret = pm_runtime_get_sync(ctrl->dev);
495
496 if (ctrl->sched.clk_state != SLIM_CLK_ACTIVE) {
497 dev_err(ctrl->dev, "slim ctrl not active,state:%d, ret:%d\n",
498 ctrl->sched.clk_state, ret);
499 goto slimbus_not_active;
500 }
501
502 sbdev = slim_get_device(ctrl, e_addr);
503 if (IS_ERR(sbdev))
504 return -ENODEV;
505
506 if (sbdev->is_laddr_valid) {
507 *laddr = sbdev->laddr;
508 return 0;
509 }
510
511 ret = slim_device_alloc_laddr(sbdev, true);
512
513slimbus_not_active:
514 pm_runtime_mark_last_busy(ctrl->dev);
515 pm_runtime_put_autosuspend(ctrl->dev);
516 return ret;
517}
518EXPORT_SYMBOL_GPL(slim_device_report_present);
519
520/**
521 * slim_get_logical_addr() - get/allocate logical address of a SLIMbus device.
522 *
523 * @sbdev: client handle requesting the address.
524 *
525 * Return: zero if a logical address is valid or a new logical address
526 * has been assigned. error code in case of error.
527 */
528int slim_get_logical_addr(struct slim_device *sbdev)
529{
530 if (!sbdev->is_laddr_valid)
531 return slim_device_alloc_laddr(sbdev, false);
532
533 return 0;
534}
535EXPORT_SYMBOL_GPL(slim_get_logical_addr);
536
537static void __exit slimbus_exit(void)
538{
539 bus_unregister(&slimbus_bus);
540}
541module_exit(slimbus_exit);
542
543static int __init slimbus_init(void)
544{
545 return bus_register(&slimbus_bus);
546}
547postcore_initcall(slimbus_init);
548
549MODULE_LICENSE("GPL v2");
550MODULE_DESCRIPTION("SLIMbus core");
1// SPDX-License-Identifier: GPL-2.0
2/*
3 * Copyright (c) 2011-2017, The Linux Foundation
4 */
5
6#include <linux/kernel.h>
7#include <linux/errno.h>
8#include <linux/slab.h>
9#include <linux/init.h>
10#include <linux/idr.h>
11#include <linux/of.h>
12#include <linux/of_device.h>
13#include <linux/pm_runtime.h>
14#include <linux/slimbus.h>
15#include "slimbus.h"
16
17static DEFINE_IDA(ctrl_ida);
18
19static const struct slim_device_id *slim_match(const struct slim_device_id *id,
20 const struct slim_device *sbdev)
21{
22 while (id->manf_id != 0 || id->prod_code != 0) {
23 if (id->manf_id == sbdev->e_addr.manf_id &&
24 id->prod_code == sbdev->e_addr.prod_code &&
25 id->dev_index == sbdev->e_addr.dev_index &&
26 id->instance == sbdev->e_addr.instance)
27 return id;
28 id++;
29 }
30 return NULL;
31}
32
33static int slim_device_match(struct device *dev, struct device_driver *drv)
34{
35 struct slim_device *sbdev = to_slim_device(dev);
36 struct slim_driver *sbdrv = to_slim_driver(drv);
37
38 /* Attempt an OF style match first */
39 if (of_driver_match_device(dev, drv))
40 return 1;
41
42 return !!slim_match(sbdrv->id_table, sbdev);
43}
44
45static void slim_device_update_status(struct slim_device *sbdev,
46 enum slim_device_status status)
47{
48 struct slim_driver *sbdrv;
49
50 if (sbdev->status == status)
51 return;
52
53 sbdev->status = status;
54 if (!sbdev->dev.driver)
55 return;
56
57 sbdrv = to_slim_driver(sbdev->dev.driver);
58 if (sbdrv->device_status)
59 sbdrv->device_status(sbdev, sbdev->status);
60}
61
62static int slim_device_probe(struct device *dev)
63{
64 struct slim_device *sbdev = to_slim_device(dev);
65 struct slim_driver *sbdrv = to_slim_driver(dev->driver);
66 int ret;
67
68 ret = sbdrv->probe(sbdev);
69 if (ret)
70 return ret;
71
72 /* try getting the logical address after probe */
73 ret = slim_get_logical_addr(sbdev);
74 if (!ret) {
75 slim_device_update_status(sbdev, SLIM_DEVICE_STATUS_UP);
76 } else {
77 dev_err(&sbdev->dev, "Failed to get logical address\n");
78 ret = -EPROBE_DEFER;
79 }
80
81 return ret;
82}
83
84static int slim_device_remove(struct device *dev)
85{
86 struct slim_device *sbdev = to_slim_device(dev);
87 struct slim_driver *sbdrv;
88
89 if (dev->driver) {
90 sbdrv = to_slim_driver(dev->driver);
91 if (sbdrv->remove)
92 sbdrv->remove(sbdev);
93 }
94
95 return 0;
96}
97
98static int slim_device_uevent(struct device *dev, struct kobj_uevent_env *env)
99{
100 struct slim_device *sbdev = to_slim_device(dev);
101
102 return add_uevent_var(env, "MODALIAS=slim:%s", dev_name(&sbdev->dev));
103}
104
105struct bus_type slimbus_bus = {
106 .name = "slimbus",
107 .match = slim_device_match,
108 .probe = slim_device_probe,
109 .remove = slim_device_remove,
110 .uevent = slim_device_uevent,
111};
112EXPORT_SYMBOL_GPL(slimbus_bus);
113
114/*
115 * __slim_driver_register() - Client driver registration with SLIMbus
116 *
117 * @drv:Client driver to be associated with client-device.
118 * @owner: owning module/driver
119 *
120 * This API will register the client driver with the SLIMbus
121 * It is called from the driver's module-init function.
122 */
123int __slim_driver_register(struct slim_driver *drv, struct module *owner)
124{
125 /* ID table and probe are mandatory */
126 if (!(drv->driver.of_match_table || drv->id_table) || !drv->probe)
127 return -EINVAL;
128
129 drv->driver.bus = &slimbus_bus;
130 drv->driver.owner = owner;
131
132 return driver_register(&drv->driver);
133}
134EXPORT_SYMBOL_GPL(__slim_driver_register);
135
136/*
137 * slim_driver_unregister() - Undo effect of slim_driver_register
138 *
139 * @drv: Client driver to be unregistered
140 */
141void slim_driver_unregister(struct slim_driver *drv)
142{
143 driver_unregister(&drv->driver);
144}
145EXPORT_SYMBOL_GPL(slim_driver_unregister);
146
147static void slim_dev_release(struct device *dev)
148{
149 struct slim_device *sbdev = to_slim_device(dev);
150
151 kfree(sbdev);
152}
153
154static int slim_add_device(struct slim_controller *ctrl,
155 struct slim_device *sbdev,
156 struct device_node *node)
157{
158 sbdev->dev.bus = &slimbus_bus;
159 sbdev->dev.parent = ctrl->dev;
160 sbdev->dev.release = slim_dev_release;
161 sbdev->dev.driver = NULL;
162 sbdev->ctrl = ctrl;
163 INIT_LIST_HEAD(&sbdev->stream_list);
164 spin_lock_init(&sbdev->stream_list_lock);
165 sbdev->dev.of_node = of_node_get(node);
166 sbdev->dev.fwnode = of_fwnode_handle(node);
167
168 dev_set_name(&sbdev->dev, "%x:%x:%x:%x",
169 sbdev->e_addr.manf_id,
170 sbdev->e_addr.prod_code,
171 sbdev->e_addr.dev_index,
172 sbdev->e_addr.instance);
173
174 return device_register(&sbdev->dev);
175}
176
177static struct slim_device *slim_alloc_device(struct slim_controller *ctrl,
178 struct slim_eaddr *eaddr,
179 struct device_node *node)
180{
181 struct slim_device *sbdev;
182 int ret;
183
184 sbdev = kzalloc(sizeof(*sbdev), GFP_KERNEL);
185 if (!sbdev)
186 return NULL;
187
188 sbdev->e_addr = *eaddr;
189 ret = slim_add_device(ctrl, sbdev, node);
190 if (ret) {
191 put_device(&sbdev->dev);
192 return NULL;
193 }
194
195 return sbdev;
196}
197
198static void of_register_slim_devices(struct slim_controller *ctrl)
199{
200 struct device *dev = ctrl->dev;
201 struct device_node *node;
202
203 if (!ctrl->dev->of_node)
204 return;
205
206 for_each_child_of_node(ctrl->dev->of_node, node) {
207 struct slim_device *sbdev;
208 struct slim_eaddr e_addr;
209 const char *compat = NULL;
210 int reg[2], ret;
211 int manf_id, prod_code;
212
213 compat = of_get_property(node, "compatible", NULL);
214 if (!compat)
215 continue;
216
217 ret = sscanf(compat, "slim%x,%x", &manf_id, &prod_code);
218 if (ret != 2) {
219 dev_err(dev, "Manf ID & Product code not found %s\n",
220 compat);
221 continue;
222 }
223
224 ret = of_property_read_u32_array(node, "reg", reg, 2);
225 if (ret) {
226 dev_err(dev, "Device and Instance id not found:%d\n",
227 ret);
228 continue;
229 }
230
231 e_addr.dev_index = reg[0];
232 e_addr.instance = reg[1];
233 e_addr.manf_id = manf_id;
234 e_addr.prod_code = prod_code;
235
236 sbdev = slim_alloc_device(ctrl, &e_addr, node);
237 if (!sbdev)
238 continue;
239 }
240}
241
242/*
243 * slim_register_controller() - Controller bring-up and registration.
244 *
245 * @ctrl: Controller to be registered.
246 *
247 * A controller is registered with the framework using this API.
248 * If devices on a controller were registered before controller,
249 * this will make sure that they get probed when controller is up
250 */
251int slim_register_controller(struct slim_controller *ctrl)
252{
253 int id;
254
255 id = ida_simple_get(&ctrl_ida, 0, 0, GFP_KERNEL);
256 if (id < 0)
257 return id;
258
259 ctrl->id = id;
260
261 if (!ctrl->min_cg)
262 ctrl->min_cg = SLIM_MIN_CLK_GEAR;
263 if (!ctrl->max_cg)
264 ctrl->max_cg = SLIM_MAX_CLK_GEAR;
265
266 ida_init(&ctrl->laddr_ida);
267 idr_init(&ctrl->tid_idr);
268 mutex_init(&ctrl->lock);
269 mutex_init(&ctrl->sched.m_reconf);
270 init_completion(&ctrl->sched.pause_comp);
271 spin_lock_init(&ctrl->txn_lock);
272
273 dev_dbg(ctrl->dev, "Bus [%s] registered:dev:%p\n",
274 ctrl->name, ctrl->dev);
275
276 of_register_slim_devices(ctrl);
277
278 return 0;
279}
280EXPORT_SYMBOL_GPL(slim_register_controller);
281
282/* slim_remove_device: Remove the effect of slim_add_device() */
283static void slim_remove_device(struct slim_device *sbdev)
284{
285 of_node_put(sbdev->dev.of_node);
286 device_unregister(&sbdev->dev);
287}
288
289static int slim_ctrl_remove_device(struct device *dev, void *null)
290{
291 slim_remove_device(to_slim_device(dev));
292 return 0;
293}
294
295/**
296 * slim_unregister_controller() - Controller tear-down.
297 *
298 * @ctrl: Controller to tear-down.
299 */
300int slim_unregister_controller(struct slim_controller *ctrl)
301{
302 /* Remove all clients */
303 device_for_each_child(ctrl->dev, NULL, slim_ctrl_remove_device);
304 ida_simple_remove(&ctrl_ida, ctrl->id);
305
306 return 0;
307}
308EXPORT_SYMBOL_GPL(slim_unregister_controller);
309
310/**
311 * slim_report_absent() - Controller calls this function when a device
312 * reports absent, OR when the device cannot be communicated with
313 *
314 * @sbdev: Device that cannot be reached, or sent report absent
315 */
316void slim_report_absent(struct slim_device *sbdev)
317{
318 struct slim_controller *ctrl = sbdev->ctrl;
319
320 if (!ctrl)
321 return;
322
323 /* invalidate logical addresses */
324 mutex_lock(&ctrl->lock);
325 sbdev->is_laddr_valid = false;
326 mutex_unlock(&ctrl->lock);
327 if (!ctrl->get_laddr)
328 ida_simple_remove(&ctrl->laddr_ida, sbdev->laddr);
329 slim_device_update_status(sbdev, SLIM_DEVICE_STATUS_DOWN);
330}
331EXPORT_SYMBOL_GPL(slim_report_absent);
332
333static bool slim_eaddr_equal(struct slim_eaddr *a, struct slim_eaddr *b)
334{
335 return (a->manf_id == b->manf_id &&
336 a->prod_code == b->prod_code &&
337 a->dev_index == b->dev_index &&
338 a->instance == b->instance);
339}
340
341static int slim_match_dev(struct device *dev, void *data)
342{
343 struct slim_eaddr *e_addr = data;
344 struct slim_device *sbdev = to_slim_device(dev);
345
346 return slim_eaddr_equal(&sbdev->e_addr, e_addr);
347}
348
349static struct slim_device *find_slim_device(struct slim_controller *ctrl,
350 struct slim_eaddr *eaddr)
351{
352 struct slim_device *sbdev;
353 struct device *dev;
354
355 dev = device_find_child(ctrl->dev, eaddr, slim_match_dev);
356 if (dev) {
357 sbdev = to_slim_device(dev);
358 return sbdev;
359 }
360
361 return NULL;
362}
363
364/**
365 * slim_get_device() - get handle to a device.
366 *
367 * @ctrl: Controller on which this device will be added/queried
368 * @e_addr: Enumeration address of the device to be queried
369 *
370 * Return: pointer to a device if it has already reported. Creates a new
371 * device and returns pointer to it if the device has not yet enumerated.
372 */
373struct slim_device *slim_get_device(struct slim_controller *ctrl,
374 struct slim_eaddr *e_addr)
375{
376 struct slim_device *sbdev;
377
378 sbdev = find_slim_device(ctrl, e_addr);
379 if (!sbdev) {
380 sbdev = slim_alloc_device(ctrl, e_addr, NULL);
381 if (!sbdev)
382 return ERR_PTR(-ENOMEM);
383 }
384
385 return sbdev;
386}
387EXPORT_SYMBOL_GPL(slim_get_device);
388
389static int of_slim_match_dev(struct device *dev, void *data)
390{
391 struct device_node *np = data;
392 struct slim_device *sbdev = to_slim_device(dev);
393
394 return (sbdev->dev.of_node == np);
395}
396
397static struct slim_device *of_find_slim_device(struct slim_controller *ctrl,
398 struct device_node *np)
399{
400 struct slim_device *sbdev;
401 struct device *dev;
402
403 dev = device_find_child(ctrl->dev, np, of_slim_match_dev);
404 if (dev) {
405 sbdev = to_slim_device(dev);
406 return sbdev;
407 }
408
409 return NULL;
410}
411
412/**
413 * of_slim_get_device() - get handle to a device using dt node.
414 *
415 * @ctrl: Controller on which this device will be added/queried
416 * @np: node pointer to device
417 *
418 * Return: pointer to a device if it has already reported. Creates a new
419 * device and returns pointer to it if the device has not yet enumerated.
420 */
421struct slim_device *of_slim_get_device(struct slim_controller *ctrl,
422 struct device_node *np)
423{
424 return of_find_slim_device(ctrl, np);
425}
426EXPORT_SYMBOL_GPL(of_slim_get_device);
427
428static int slim_device_alloc_laddr(struct slim_device *sbdev,
429 bool report_present)
430{
431 struct slim_controller *ctrl = sbdev->ctrl;
432 u8 laddr;
433 int ret;
434
435 mutex_lock(&ctrl->lock);
436 if (ctrl->get_laddr) {
437 ret = ctrl->get_laddr(ctrl, &sbdev->e_addr, &laddr);
438 if (ret < 0)
439 goto err;
440 } else if (report_present) {
441 ret = ida_simple_get(&ctrl->laddr_ida,
442 0, SLIM_LA_MANAGER - 1, GFP_KERNEL);
443 if (ret < 0)
444 goto err;
445
446 laddr = ret;
447 } else {
448 ret = -EINVAL;
449 goto err;
450 }
451
452 if (ctrl->set_laddr) {
453 ret = ctrl->set_laddr(ctrl, &sbdev->e_addr, laddr);
454 if (ret) {
455 ret = -EINVAL;
456 goto err;
457 }
458 }
459
460 sbdev->laddr = laddr;
461 sbdev->is_laddr_valid = true;
462 mutex_unlock(&ctrl->lock);
463
464 slim_device_update_status(sbdev, SLIM_DEVICE_STATUS_UP);
465
466 dev_dbg(ctrl->dev, "setting slimbus l-addr:%x, ea:%x,%x,%x,%x\n",
467 laddr, sbdev->e_addr.manf_id, sbdev->e_addr.prod_code,
468 sbdev->e_addr.dev_index, sbdev->e_addr.instance);
469
470 return 0;
471
472err:
473 mutex_unlock(&ctrl->lock);
474 return ret;
475
476}
477
478/**
479 * slim_device_report_present() - Report enumerated device.
480 *
481 * @ctrl: Controller with which device is enumerated.
482 * @e_addr: Enumeration address of the device.
483 * @laddr: Return logical address (if valid flag is false)
484 *
485 * Called by controller in response to REPORT_PRESENT. Framework will assign
486 * a logical address to this enumeration address.
487 * Function returns -EXFULL to indicate that all logical addresses are already
488 * taken.
489 */
490int slim_device_report_present(struct slim_controller *ctrl,
491 struct slim_eaddr *e_addr, u8 *laddr)
492{
493 struct slim_device *sbdev;
494 int ret;
495
496 ret = pm_runtime_get_sync(ctrl->dev);
497
498 if (ctrl->sched.clk_state != SLIM_CLK_ACTIVE) {
499 dev_err(ctrl->dev, "slim ctrl not active,state:%d, ret:%d\n",
500 ctrl->sched.clk_state, ret);
501 goto slimbus_not_active;
502 }
503
504 sbdev = slim_get_device(ctrl, e_addr);
505 if (IS_ERR(sbdev))
506 return -ENODEV;
507
508 if (sbdev->is_laddr_valid) {
509 *laddr = sbdev->laddr;
510 return 0;
511 }
512
513 ret = slim_device_alloc_laddr(sbdev, true);
514
515slimbus_not_active:
516 pm_runtime_mark_last_busy(ctrl->dev);
517 pm_runtime_put_autosuspend(ctrl->dev);
518 return ret;
519}
520EXPORT_SYMBOL_GPL(slim_device_report_present);
521
522/**
523 * slim_get_logical_addr() - get/allocate logical address of a SLIMbus device.
524 *
525 * @sbdev: client handle requesting the address.
526 *
527 * Return: zero if a logical address is valid or a new logical address
528 * has been assigned. error code in case of error.
529 */
530int slim_get_logical_addr(struct slim_device *sbdev)
531{
532 if (!sbdev->is_laddr_valid)
533 return slim_device_alloc_laddr(sbdev, false);
534
535 return 0;
536}
537EXPORT_SYMBOL_GPL(slim_get_logical_addr);
538
539static void __exit slimbus_exit(void)
540{
541 bus_unregister(&slimbus_bus);
542}
543module_exit(slimbus_exit);
544
545static int __init slimbus_init(void)
546{
547 return bus_register(&slimbus_bus);
548}
549postcore_initcall(slimbus_init);
550
551MODULE_LICENSE("GPL v2");
552MODULE_DESCRIPTION("SLIMbus core");