1 // SPDX-License-Identifier: GPL-2.0
3 * Copyright (c) 2011-2017, The Linux Foundation
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>
12 #include <linux/of_device.h>
13 #include <linux/pm_runtime.h>
14 #include <linux/slimbus.h>
17 static DEFINE_IDA(ctrl_ida);
19 static const struct slim_device_id *slim_match(const struct slim_device_id *id,
20 const struct slim_device *sbdev)
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)
33 static int slim_device_match(struct device *dev, struct device_driver *drv)
35 struct slim_device *sbdev = to_slim_device(dev);
36 struct slim_driver *sbdrv = to_slim_driver(drv);
38 /* Attempt an OF style match first */
39 if (of_driver_match_device(dev, drv))
42 return !!slim_match(sbdrv->id_table, sbdev);
45 static void slim_device_update_status(struct slim_device *sbdev,
46 enum slim_device_status status)
48 struct slim_driver *sbdrv;
50 if (sbdev->status == status)
53 sbdev->status = status;
54 if (!sbdev->dev.driver)
57 sbdrv = to_slim_driver(sbdev->dev.driver);
58 if (sbdrv->device_status)
59 sbdrv->device_status(sbdev, sbdev->status);
62 static int slim_device_probe(struct device *dev)
64 struct slim_device *sbdev = to_slim_device(dev);
65 struct slim_driver *sbdrv = to_slim_driver(dev->driver);
68 ret = sbdrv->probe(sbdev);
72 /* try getting the logical address after probe */
73 ret = slim_get_logical_addr(sbdev);
75 slim_device_update_status(sbdev, SLIM_DEVICE_STATUS_UP);
77 dev_err(&sbdev->dev, "Failed to get logical address\n");
84 static int slim_device_remove(struct device *dev)
86 struct slim_device *sbdev = to_slim_device(dev);
87 struct slim_driver *sbdrv;
90 sbdrv = to_slim_driver(dev->driver);
98 static int slim_device_uevent(struct device *dev, struct kobj_uevent_env *env)
100 struct slim_device *sbdev = to_slim_device(dev);
102 return add_uevent_var(env, "MODALIAS=slim:%s", dev_name(&sbdev->dev));
105 struct bus_type slimbus_bus = {
107 .match = slim_device_match,
108 .probe = slim_device_probe,
109 .remove = slim_device_remove,
110 .uevent = slim_device_uevent,
112 EXPORT_SYMBOL_GPL(slimbus_bus);
115 * __slim_driver_register() - Client driver registration with SLIMbus
117 * @drv:Client driver to be associated with client-device.
118 * @owner: owning module/driver
120 * This API will register the client driver with the SLIMbus
121 * It is called from the driver's module-init function.
123 int __slim_driver_register(struct slim_driver *drv, struct module *owner)
125 /* ID table and probe are mandatory */
126 if (!(drv->driver.of_match_table || drv->id_table) || !drv->probe)
129 drv->driver.bus = &slimbus_bus;
130 drv->driver.owner = owner;
132 return driver_register(&drv->driver);
134 EXPORT_SYMBOL_GPL(__slim_driver_register);
137 * slim_driver_unregister() - Undo effect of slim_driver_register
139 * @drv: Client driver to be unregistered
141 void slim_driver_unregister(struct slim_driver *drv)
143 driver_unregister(&drv->driver);
145 EXPORT_SYMBOL_GPL(slim_driver_unregister);
147 static void slim_dev_release(struct device *dev)
149 struct slim_device *sbdev = to_slim_device(dev);
154 static int slim_add_device(struct slim_controller *ctrl,
155 struct slim_device *sbdev,
156 struct device_node *node)
158 sbdev->dev.bus = &slimbus_bus;
159 sbdev->dev.parent = ctrl->dev;
160 sbdev->dev.release = slim_dev_release;
161 sbdev->dev.driver = NULL;
163 INIT_LIST_HEAD(&sbdev->stream_list);
164 spin_lock_init(&sbdev->stream_list_lock);
167 sbdev->dev.of_node = of_node_get(node);
169 dev_set_name(&sbdev->dev, "%x:%x:%x:%x",
170 sbdev->e_addr.manf_id,
171 sbdev->e_addr.prod_code,
172 sbdev->e_addr.dev_index,
173 sbdev->e_addr.instance);
175 return device_register(&sbdev->dev);
178 static struct slim_device *slim_alloc_device(struct slim_controller *ctrl,
179 struct slim_eaddr *eaddr,
180 struct device_node *node)
182 struct slim_device *sbdev;
185 sbdev = kzalloc(sizeof(*sbdev), GFP_KERNEL);
189 sbdev->e_addr = *eaddr;
190 ret = slim_add_device(ctrl, sbdev, node);
192 put_device(&sbdev->dev);
199 static void of_register_slim_devices(struct slim_controller *ctrl)
201 struct device *dev = ctrl->dev;
202 struct device_node *node;
204 if (!ctrl->dev->of_node)
207 for_each_child_of_node(ctrl->dev->of_node, node) {
208 struct slim_device *sbdev;
209 struct slim_eaddr e_addr;
210 const char *compat = NULL;
212 int manf_id, prod_code;
214 compat = of_get_property(node, "compatible", NULL);
218 ret = sscanf(compat, "slim%x,%x", &manf_id, &prod_code);
220 dev_err(dev, "Manf ID & Product code not found %s\n",
225 ret = of_property_read_u32_array(node, "reg", reg, 2);
227 dev_err(dev, "Device and Instance id not found:%d\n",
232 e_addr.dev_index = reg[0];
233 e_addr.instance = reg[1];
234 e_addr.manf_id = manf_id;
235 e_addr.prod_code = prod_code;
237 sbdev = slim_alloc_device(ctrl, &e_addr, node);
244 * slim_register_controller() - Controller bring-up and registration.
246 * @ctrl: Controller to be registered.
248 * A controller is registered with the framework using this API.
249 * If devices on a controller were registered before controller,
250 * this will make sure that they get probed when controller is up
252 int slim_register_controller(struct slim_controller *ctrl)
256 id = ida_simple_get(&ctrl_ida, 0, 0, GFP_KERNEL);
263 ctrl->min_cg = SLIM_MIN_CLK_GEAR;
265 ctrl->max_cg = SLIM_MAX_CLK_GEAR;
267 ida_init(&ctrl->laddr_ida);
268 idr_init(&ctrl->tid_idr);
269 mutex_init(&ctrl->lock);
270 mutex_init(&ctrl->sched.m_reconf);
271 init_completion(&ctrl->sched.pause_comp);
272 spin_lock_init(&ctrl->txn_lock);
274 dev_dbg(ctrl->dev, "Bus [%s] registered:dev:%p\n",
275 ctrl->name, ctrl->dev);
277 of_register_slim_devices(ctrl);
281 EXPORT_SYMBOL_GPL(slim_register_controller);
283 /* slim_remove_device: Remove the effect of slim_add_device() */
284 static void slim_remove_device(struct slim_device *sbdev)
286 of_node_put(sbdev->dev.of_node);
287 device_unregister(&sbdev->dev);
290 static int slim_ctrl_remove_device(struct device *dev, void *null)
292 slim_remove_device(to_slim_device(dev));
297 * slim_unregister_controller() - Controller tear-down.
299 * @ctrl: Controller to tear-down.
301 int slim_unregister_controller(struct slim_controller *ctrl)
303 /* Remove all clients */
304 device_for_each_child(ctrl->dev, NULL, slim_ctrl_remove_device);
305 ida_simple_remove(&ctrl_ida, ctrl->id);
309 EXPORT_SYMBOL_GPL(slim_unregister_controller);
312 * slim_report_absent() - Controller calls this function when a device
313 * reports absent, OR when the device cannot be communicated with
315 * @sbdev: Device that cannot be reached, or sent report absent
317 void slim_report_absent(struct slim_device *sbdev)
319 struct slim_controller *ctrl = sbdev->ctrl;
324 /* invalidate logical addresses */
325 mutex_lock(&ctrl->lock);
326 sbdev->is_laddr_valid = false;
327 mutex_unlock(&ctrl->lock);
328 if (!ctrl->get_laddr)
329 ida_simple_remove(&ctrl->laddr_ida, sbdev->laddr);
330 slim_device_update_status(sbdev, SLIM_DEVICE_STATUS_DOWN);
332 EXPORT_SYMBOL_GPL(slim_report_absent);
334 static bool slim_eaddr_equal(struct slim_eaddr *a, struct slim_eaddr *b)
336 return (a->manf_id == b->manf_id &&
337 a->prod_code == b->prod_code &&
338 a->dev_index == b->dev_index &&
339 a->instance == b->instance);
342 static int slim_match_dev(struct device *dev, void *data)
344 struct slim_eaddr *e_addr = data;
345 struct slim_device *sbdev = to_slim_device(dev);
347 return slim_eaddr_equal(&sbdev->e_addr, e_addr);
350 static struct slim_device *find_slim_device(struct slim_controller *ctrl,
351 struct slim_eaddr *eaddr)
353 struct slim_device *sbdev;
356 dev = device_find_child(ctrl->dev, eaddr, slim_match_dev);
358 sbdev = to_slim_device(dev);
366 * slim_get_device() - get handle to a device.
368 * @ctrl: Controller on which this device will be added/queried
369 * @e_addr: Enumeration address of the device to be queried
371 * Return: pointer to a device if it has already reported. Creates a new
372 * device and returns pointer to it if the device has not yet enumerated.
374 struct slim_device *slim_get_device(struct slim_controller *ctrl,
375 struct slim_eaddr *e_addr)
377 struct slim_device *sbdev;
379 sbdev = find_slim_device(ctrl, e_addr);
381 sbdev = slim_alloc_device(ctrl, e_addr, NULL);
383 return ERR_PTR(-ENOMEM);
388 EXPORT_SYMBOL_GPL(slim_get_device);
390 static int of_slim_match_dev(struct device *dev, void *data)
392 struct device_node *np = data;
393 struct slim_device *sbdev = to_slim_device(dev);
395 return (sbdev->dev.of_node == np);
398 static struct slim_device *of_find_slim_device(struct slim_controller *ctrl,
399 struct device_node *np)
401 struct slim_device *sbdev;
404 dev = device_find_child(ctrl->dev, np, of_slim_match_dev);
406 sbdev = to_slim_device(dev);
414 * of_slim_get_device() - get handle to a device using dt node.
416 * @ctrl: Controller on which this device will be added/queried
417 * @np: node pointer to device
419 * Return: pointer to a device if it has already reported. Creates a new
420 * device and returns pointer to it if the device has not yet enumerated.
422 struct slim_device *of_slim_get_device(struct slim_controller *ctrl,
423 struct device_node *np)
425 return of_find_slim_device(ctrl, np);
427 EXPORT_SYMBOL_GPL(of_slim_get_device);
429 static int slim_device_alloc_laddr(struct slim_device *sbdev,
432 struct slim_controller *ctrl = sbdev->ctrl;
436 mutex_lock(&ctrl->lock);
437 if (ctrl->get_laddr) {
438 ret = ctrl->get_laddr(ctrl, &sbdev->e_addr, &laddr);
441 } else if (report_present) {
442 ret = ida_simple_get(&ctrl->laddr_ida,
443 0, SLIM_LA_MANAGER - 1, GFP_KERNEL);
453 if (ctrl->set_laddr) {
454 ret = ctrl->set_laddr(ctrl, &sbdev->e_addr, laddr);
461 sbdev->laddr = laddr;
462 sbdev->is_laddr_valid = true;
463 mutex_unlock(&ctrl->lock);
465 slim_device_update_status(sbdev, SLIM_DEVICE_STATUS_UP);
467 dev_dbg(ctrl->dev, "setting slimbus l-addr:%x, ea:%x,%x,%x,%x\n",
468 laddr, sbdev->e_addr.manf_id, sbdev->e_addr.prod_code,
469 sbdev->e_addr.dev_index, sbdev->e_addr.instance);
474 mutex_unlock(&ctrl->lock);
480 * slim_device_report_present() - Report enumerated device.
482 * @ctrl: Controller with which device is enumerated.
483 * @e_addr: Enumeration address of the device.
484 * @laddr: Return logical address (if valid flag is false)
486 * Called by controller in response to REPORT_PRESENT. Framework will assign
487 * a logical address to this enumeration address.
488 * Function returns -EXFULL to indicate that all logical addresses are already
491 int slim_device_report_present(struct slim_controller *ctrl,
492 struct slim_eaddr *e_addr, u8 *laddr)
494 struct slim_device *sbdev;
497 ret = pm_runtime_get_sync(ctrl->dev);
499 if (ctrl->sched.clk_state != SLIM_CLK_ACTIVE) {
500 dev_err(ctrl->dev, "slim ctrl not active,state:%d, ret:%d\n",
501 ctrl->sched.clk_state, ret);
502 goto slimbus_not_active;
505 sbdev = slim_get_device(ctrl, e_addr);
509 if (sbdev->is_laddr_valid) {
510 *laddr = sbdev->laddr;
514 ret = slim_device_alloc_laddr(sbdev, true);
517 pm_runtime_mark_last_busy(ctrl->dev);
518 pm_runtime_put_autosuspend(ctrl->dev);
521 EXPORT_SYMBOL_GPL(slim_device_report_present);
524 * slim_get_logical_addr() - get/allocate logical address of a SLIMbus device.
526 * @sbdev: client handle requesting the address.
528 * Return: zero if a logical address is valid or a new logical address
529 * has been assigned. error code in case of error.
531 int slim_get_logical_addr(struct slim_device *sbdev)
533 if (!sbdev->is_laddr_valid)
534 return slim_device_alloc_laddr(sbdev, false);
538 EXPORT_SYMBOL_GPL(slim_get_logical_addr);
540 static void __exit slimbus_exit(void)
542 bus_unregister(&slimbus_bus);
544 module_exit(slimbus_exit);
546 static int __init slimbus_init(void)
548 return bus_register(&slimbus_bus);
550 postcore_initcall(slimbus_init);
552 MODULE_LICENSE("GPL v2");
553 MODULE_DESCRIPTION("SLIMbus core");