1 // SPDX-License-Identifier: GPL-2.0
3  * Copyright (c) 2011-2017, The Linux Foundation
22 	while (id->manf_id != 0 || id->prod_code != 0) {  in slim_match()
23 		if (id->manf_id == sbdev->e_addr.manf_id &&  in slim_match()
24 		    id->prod_code == sbdev->e_addr.prod_code &&  in slim_match()
25 		    id->dev_index == sbdev->e_addr.dev_index &&  in slim_match()
26 		    id->instance == sbdev->e_addr.instance)  in slim_match()
33 static int slim_device_match(struct device *dev, const struct device_driver *drv)  in slim_device_match()  argument
35 	struct slim_device *sbdev = to_slim_device(dev);  in slim_device_match()
39 	if (of_driver_match_device(dev, drv))  in slim_device_match()
42 	return !!slim_match(sbdrv->id_table, sbdev);  in slim_device_match()
50 	if (sbdev->status == status)  in slim_device_update_status()
53 	sbdev->status = status;  in slim_device_update_status()
54 	if (!sbdev->dev.driver)  in slim_device_update_status()
57 	sbdrv = to_slim_driver(sbdev->dev.driver);  in slim_device_update_status()
58 	if (sbdrv->device_status)  in slim_device_update_status()
59 		sbdrv->device_status(sbdev, sbdev->status);  in slim_device_update_status()
62 static int slim_device_probe(struct device *dev)  in slim_device_probe()  argument
64 	struct slim_device	*sbdev = to_slim_device(dev);  in slim_device_probe()
65 	struct slim_driver	*sbdrv = to_slim_driver(dev->driver);  in slim_device_probe()
68 	ret = sbdrv->probe(sbdev);  in slim_device_probe()
77 		dev_err(&sbdev->dev, "Failed to get logical address\n");  in slim_device_probe()
78 		ret = -EPROBE_DEFER;  in slim_device_probe()
84 static void slim_device_remove(struct device *dev)  in slim_device_remove()  argument
86 	struct slim_device *sbdev = to_slim_device(dev);  in slim_device_remove()
89 	if (dev->driver) {  in slim_device_remove()
90 		sbdrv = to_slim_driver(dev->driver);  in slim_device_remove()
91 		if (sbdrv->remove)  in slim_device_remove()
92 			sbdrv->remove(sbdev);  in slim_device_remove()
96 static int slim_device_uevent(const struct device *dev, struct kobj_uevent_env *env)  in slim_device_uevent()  argument
98 	const struct slim_device *sbdev = to_slim_device(dev);  in slim_device_uevent()
100 	return add_uevent_var(env, "MODALIAS=slim:%s", dev_name(&sbdev->dev));  in slim_device_uevent()
113  * __slim_driver_register() - Client driver registration with SLIMbus
115  * @drv:Client driver to be associated with client-device.
119  * It is called from the driver's module-init function.
124 	if (!(drv->driver.of_match_table || drv->id_table) || !drv->probe)  in __slim_driver_register()
125 		return -EINVAL;  in __slim_driver_register()
127 	drv->driver.bus = &slimbus_bus;  in __slim_driver_register()
128 	drv->driver.owner = owner;  in __slim_driver_register()
130 	return driver_register(&drv->driver);  in __slim_driver_register()
135  * slim_driver_unregister() - Undo effect of slim_driver_register
141 	driver_unregister(&drv->driver);  in slim_driver_unregister()
145 static void slim_dev_release(struct device *dev)  in slim_dev_release()  argument
147 	struct slim_device *sbdev = to_slim_device(dev);  in slim_dev_release()
152 static int slim_add_device(struct slim_controller *ctrl,  in slim_add_device()  argument
156 	sbdev->dev.bus = &slimbus_bus;  in slim_add_device()
157 	sbdev->dev.parent = ctrl->dev;  in slim_add_device()
158 	sbdev->dev.release = slim_dev_release;  in slim_add_device()
159 	sbdev->dev.driver = NULL;  in slim_add_device()
160 	sbdev->ctrl = ctrl;  in slim_add_device()
161 	INIT_LIST_HEAD(&sbdev->stream_list);  in slim_add_device()
162 	spin_lock_init(&sbdev->stream_list_lock);  in slim_add_device()
163 	sbdev->dev.of_node = of_node_get(node);  in slim_add_device()
164 	sbdev->dev.fwnode = of_fwnode_handle(node);  in slim_add_device()
166 	dev_set_name(&sbdev->dev, "%x:%x:%x:%x",  in slim_add_device()
167 				  sbdev->e_addr.manf_id,  in slim_add_device()
168 				  sbdev->e_addr.prod_code,  in slim_add_device()
169 				  sbdev->e_addr.dev_index,  in slim_add_device()
170 				  sbdev->e_addr.instance);  in slim_add_device()
172 	return device_register(&sbdev->dev);  in slim_add_device()
175 static struct slim_device *slim_alloc_device(struct slim_controller *ctrl,  in slim_alloc_device()  argument
186 	sbdev->e_addr = *eaddr;  in slim_alloc_device()
187 	ret = slim_add_device(ctrl, sbdev, node);  in slim_alloc_device()
189 		put_device(&sbdev->dev);  in slim_alloc_device()
196 static void of_register_slim_devices(struct slim_controller *ctrl)  in of_register_slim_devices()  argument
198 	struct device *dev = ctrl->dev;  in of_register_slim_devices()  local
201 	if (!ctrl->dev->of_node)  in of_register_slim_devices()
204 	for_each_child_of_node(ctrl->dev->of_node, node) {  in of_register_slim_devices()
217 			dev_err(dev, "Manf ID & Product code not found %s\n",  in of_register_slim_devices()
224 			dev_err(dev, "Device and Instance id not found:%d\n",  in of_register_slim_devices()
234 		sbdev = slim_alloc_device(ctrl, &e_addr, node);  in of_register_slim_devices()
241  * slim_register_controller() - Controller bring-up and registration.
243  * @ctrl: Controller to be registered.
249 int slim_register_controller(struct slim_controller *ctrl)  in slim_register_controller()  argument
257 	ctrl->id = id;  in slim_register_controller()
259 	if (!ctrl->min_cg)  in slim_register_controller()
260 		ctrl->min_cg = SLIM_MIN_CLK_GEAR;  in slim_register_controller()
261 	if (!ctrl->max_cg)  in slim_register_controller()
262 		ctrl->max_cg = SLIM_MAX_CLK_GEAR;  in slim_register_controller()
264 	ida_init(&ctrl->laddr_ida);  in slim_register_controller()
265 	idr_init(&ctrl->tid_idr);  in slim_register_controller()
266 	mutex_init(&ctrl->lock);  in slim_register_controller()
267 	mutex_init(&ctrl->sched.m_reconf);  in slim_register_controller()
268 	init_completion(&ctrl->sched.pause_comp);  in slim_register_controller()
269 	spin_lock_init(&ctrl->txn_lock);  in slim_register_controller()
271 	dev_dbg(ctrl->dev, "Bus [%s] registered:dev:%p\n",  in slim_register_controller()
272 		ctrl->name, ctrl->dev);  in slim_register_controller()
274 	of_register_slim_devices(ctrl);  in slim_register_controller()
283 	of_node_put(sbdev->dev.of_node);  in slim_remove_device()
284 	device_unregister(&sbdev->dev);  in slim_remove_device()
287 static int slim_ctrl_remove_device(struct device *dev, void *null)  in slim_ctrl_remove_device()  argument
289 	slim_remove_device(to_slim_device(dev));  in slim_ctrl_remove_device()
294  * slim_unregister_controller() - Controller tear-down.
296  * @ctrl: Controller to tear-down.
298 int slim_unregister_controller(struct slim_controller *ctrl)  in slim_unregister_controller()  argument
301 	device_for_each_child(ctrl->dev, NULL, slim_ctrl_remove_device);  in slim_unregister_controller()
302 	ida_free(&ctrl_ida, ctrl->id);  in slim_unregister_controller()
309  * slim_report_absent() - Controller calls this function when a device
316 	struct slim_controller *ctrl = sbdev->ctrl;  in slim_report_absent()  local
318 	if (!ctrl)  in slim_report_absent()
322 	mutex_lock(&ctrl->lock);  in slim_report_absent()
323 	sbdev->is_laddr_valid = false;  in slim_report_absent()
324 	mutex_unlock(&ctrl->lock);  in slim_report_absent()
325 	if (!ctrl->get_laddr)  in slim_report_absent()
326 		ida_free(&ctrl->laddr_ida, sbdev->laddr);  in slim_report_absent()
334 	return (a->manf_id == b->manf_id &&  in slim_eaddr_equal()
335 		a->prod_code == b->prod_code &&  in slim_eaddr_equal()
336 		a->dev_index == b->dev_index &&  in slim_eaddr_equal()
337 		a->instance == b->instance);  in slim_eaddr_equal()
340 static int slim_match_dev(struct device *dev, const void *data)  in slim_match_dev()  argument
343 	struct slim_device *sbdev = to_slim_device(dev);  in slim_match_dev()
345 	return slim_eaddr_equal(&sbdev->e_addr, e_addr);  in slim_match_dev()
348 static struct slim_device *find_slim_device(struct slim_controller *ctrl,  in find_slim_device()  argument
352 	struct device *dev;  in find_slim_device()  local
354 	dev = device_find_child(ctrl->dev, eaddr, slim_match_dev);  in find_slim_device()
355 	if (dev) {  in find_slim_device()
356 		sbdev = to_slim_device(dev);  in find_slim_device()
364  * slim_get_device() - get handle to a device.
366  * @ctrl: Controller on which this device will be added/queried
372 struct slim_device *slim_get_device(struct slim_controller *ctrl,  in slim_get_device()  argument
377 	sbdev = find_slim_device(ctrl, e_addr);  in slim_get_device()
379 		sbdev = slim_alloc_device(ctrl, e_addr, NULL);  in slim_get_device()
381 			return ERR_PTR(-ENOMEM);  in slim_get_device()
388 static struct slim_device *of_find_slim_device(struct slim_controller *ctrl,  in of_find_slim_device()  argument
392 	struct device *dev;  in of_find_slim_device()  local
394 	dev = device_find_child(ctrl->dev, np, device_match_of_node);  in of_find_slim_device()
395 	if (dev) {  in of_find_slim_device()
396 		sbdev = to_slim_device(dev);  in of_find_slim_device()
404  * of_slim_get_device() - get handle to a device using dt node.
406  * @ctrl: Controller on which this device will be added/queried
412 struct slim_device *of_slim_get_device(struct slim_controller *ctrl,  in of_slim_get_device()  argument
415 	return of_find_slim_device(ctrl, np);  in of_slim_get_device()
422 	struct slim_controller *ctrl = sbdev->ctrl;  in slim_device_alloc_laddr()  local
426 	mutex_lock(&ctrl->lock);  in slim_device_alloc_laddr()
427 	if (ctrl->get_laddr) {  in slim_device_alloc_laddr()
428 		ret = ctrl->get_laddr(ctrl, &sbdev->e_addr, &laddr);  in slim_device_alloc_laddr()
432 		ret = ida_alloc_max(&ctrl->laddr_ida,  in slim_device_alloc_laddr()
433 				    SLIM_LA_MANAGER - 1, GFP_KERNEL);  in slim_device_alloc_laddr()
439 		ret = -EINVAL;  in slim_device_alloc_laddr()
443 	if (ctrl->set_laddr) {  in slim_device_alloc_laddr()
444 		ret = ctrl->set_laddr(ctrl, &sbdev->e_addr, laddr);  in slim_device_alloc_laddr()
446 			ret = -EINVAL;  in slim_device_alloc_laddr()
451 	sbdev->laddr = laddr;  in slim_device_alloc_laddr()
452 	sbdev->is_laddr_valid = true;  in slim_device_alloc_laddr()
453 	mutex_unlock(&ctrl->lock);  in slim_device_alloc_laddr()
457 	dev_dbg(ctrl->dev, "setting slimbus l-addr:%x, ea:%x,%x,%x,%x\n",  in slim_device_alloc_laddr()
458 		laddr, sbdev->e_addr.manf_id, sbdev->e_addr.prod_code,  in slim_device_alloc_laddr()
459 		sbdev->e_addr.dev_index, sbdev->e_addr.instance);  in slim_device_alloc_laddr()
464 	mutex_unlock(&ctrl->lock);  in slim_device_alloc_laddr()
470  * slim_device_report_present() - Report enumerated device.
472  * @ctrl: Controller with which device is enumerated.
478  * Function returns -EXFULL to indicate that all logical addresses are already
481 int slim_device_report_present(struct slim_controller *ctrl,  in slim_device_report_present()  argument
487 	ret = pm_runtime_get_sync(ctrl->dev);  in slim_device_report_present()
489 	if (ctrl->sched.clk_state != SLIM_CLK_ACTIVE) {  in slim_device_report_present()
490 		dev_err(ctrl->dev, "slim ctrl not active,state:%d, ret:%d\n",  in slim_device_report_present()
491 				    ctrl->sched.clk_state, ret);  in slim_device_report_present()
495 	sbdev = slim_get_device(ctrl, e_addr);  in slim_device_report_present()
497 		return -ENODEV;  in slim_device_report_present()
499 	if (sbdev->is_laddr_valid) {  in slim_device_report_present()
500 		*laddr = sbdev->laddr;  in slim_device_report_present()
507 	pm_runtime_mark_last_busy(ctrl->dev);  in slim_device_report_present()
508 	pm_runtime_put_autosuspend(ctrl->dev);  in slim_device_report_present()
514  * slim_get_logical_addr() - get/allocate logical address of a SLIMbus device.
523 	if (!sbdev->is_laddr_valid)  in slim_get_logical_addr()