blob: 9fa93bb923d70f03ff371b5e05cb4a03f0047d81 [file] [log] [blame]
Vinod Koul92513452017-12-14 11:19:33 +05301// SPDX-License-Identifier: GPL-2.0
2// Copyright(c) 2015-17 Intel Corporation.
3
4#include <linux/module.h>
5#include <linux/mod_devicetable.h>
6#include <linux/pm_domain.h>
7#include <linux/soundwire/sdw.h>
8#include <linux/soundwire/sdw_type.h>
Pierre-Louis Bossartbf034732019-08-21 13:58:18 -05009#include "bus.h"
Charles Keepax3b6c4a12023-09-20 17:04:01 +010010#include "irq.h"
Pierre-Louis Bossartbcac5902020-05-19 04:35:51 +080011#include "sysfs_local.h"
Vinod Koul92513452017-12-14 11:19:33 +053012
13/**
14 * sdw_get_device_id - find the matching SoundWire device id
15 * @slave: SoundWire Slave Device
16 * @drv: SoundWire Slave Driver
17 *
18 * The match is done by comparing the mfg_id and part_id from the
19 * struct sdw_device_id.
20 */
21static const struct sdw_device_id *
22sdw_get_device_id(struct sdw_slave *slave, struct sdw_driver *drv)
23{
Pierre-Louis Bossartee9173d2020-06-09 04:54:34 +080024 const struct sdw_device_id *id;
Vinod Koul92513452017-12-14 11:19:33 +053025
Pierre-Louis Bossartee9173d2020-06-09 04:54:34 +080026 for (id = drv->id_table; id && id->mfg_id; id++)
Vinod Koul92513452017-12-14 11:19:33 +053027 if (slave->id.mfg_id == id->mfg_id &&
Pierre-Louis Bossartb5924262020-06-09 04:54:35 +080028 slave->id.part_id == id->part_id &&
29 (!id->sdw_version ||
30 slave->id.sdw_version == id->sdw_version) &&
31 (!id->class_id ||
32 slave->id.class_id == id->class_id))
Vinod Koul92513452017-12-14 11:19:33 +053033 return id;
Vinod Koul92513452017-12-14 11:19:33 +053034
35 return NULL;
36}
37
38static int sdw_bus_match(struct device *dev, struct device_driver *ddrv)
39{
Pierre-Louis Bossart90acca12020-05-19 01:43:19 +080040 struct sdw_slave *slave;
41 struct sdw_driver *drv;
42 int ret = 0;
Vinod Koul92513452017-12-14 11:19:33 +053043
Pierre-Louis Bossart90acca12020-05-19 01:43:19 +080044 if (is_sdw_slave(dev)) {
45 slave = dev_to_sdw_dev(dev);
46 drv = drv_to_sdw_driver(ddrv);
47
48 ret = !!sdw_get_device_id(slave, drv);
49 }
50 return ret;
Vinod Koul92513452017-12-14 11:19:33 +053051}
52
Pierre-Louis Bossartbcac5902020-05-19 04:35:51 +080053int sdw_slave_modalias(const struct sdw_slave *slave, char *buf, size_t size)
Vinod Koul92513452017-12-14 11:19:33 +053054{
Pierre-Louis Bossartb5924262020-06-09 04:54:35 +080055 /* modalias is sdw:m<mfg_id>p<part_id>v<version>c<class_id> */
Vinod Koul92513452017-12-14 11:19:33 +053056
Pierre-Louis Bossartb5924262020-06-09 04:54:35 +080057 return snprintf(buf, size, "sdw:m%04Xp%04Xv%02Xc%02X\n",
58 slave->id.mfg_id, slave->id.part_id,
59 slave->id.sdw_version, slave->id.class_id);
Vinod Koul92513452017-12-14 11:19:33 +053060}
61
Greg Kroah-Hartman162736b2023-01-11 12:30:07 +010062int sdw_slave_uevent(const struct device *dev, struct kobj_uevent_env *env)
Vinod Koul92513452017-12-14 11:19:33 +053063{
Greg Kroah-Hartman162736b2023-01-11 12:30:07 +010064 const struct sdw_slave *slave = dev_to_sdw_dev(dev);
Vinod Koul92513452017-12-14 11:19:33 +053065 char modalias[32];
66
67 sdw_slave_modalias(slave, modalias, sizeof(modalias));
68
69 if (add_uevent_var(env, "MODALIAS=%s", modalias))
70 return -ENOMEM;
71
72 return 0;
73}
74
75struct bus_type sdw_bus_type = {
76 .name = "soundwire",
77 .match = sdw_bus_match,
Vinod Koul92513452017-12-14 11:19:33 +053078};
79EXPORT_SYMBOL_GPL(sdw_bus_type);
80
81static int sdw_drv_probe(struct device *dev)
82{
83 struct sdw_slave *slave = dev_to_sdw_dev(dev);
84 struct sdw_driver *drv = drv_to_sdw_driver(dev->driver);
85 const struct sdw_device_id *id;
Pierre-Louis Bossart0196b522021-03-02 17:11:12 +080086 const char *name;
Vinod Koul92513452017-12-14 11:19:33 +053087 int ret;
88
Srinivas Kandagatlafcb9d732020-09-24 14:44:29 -050089 /*
90 * fw description is mandatory to bind
91 */
92 if (!dev->fwnode)
93 return -ENODEV;
94
95 if (!IS_ENABLED(CONFIG_ACPI) && !dev->of_node)
96 return -ENODEV;
97
Vinod Koul92513452017-12-14 11:19:33 +053098 id = sdw_get_device_id(slave, drv);
99 if (!id)
100 return -ENODEV;
101
102 /*
103 * attach to power domain but don't turn on (last arg)
104 */
105 ret = dev_pm_domain_attach(dev, false);
Vinod Koul56d4fe32017-12-14 11:19:35 +0530106 if (ret)
107 return ret;
108
Ulf Hansson29ffcc82018-04-26 10:53:09 +0200109 ret = drv->probe(slave, id);
110 if (ret) {
Pierre-Louis Bossart0196b522021-03-02 17:11:12 +0800111 name = drv->name;
112 if (!name)
113 name = drv->driver.name;
Pierre-Louis Bossartbd29c002022-06-21 17:56:38 -0500114
Pierre-Louis Bossart0196b522021-03-02 17:11:12 +0800115 dev_err(dev, "Probe of %s failed: %d\n", name, ret);
Ulf Hansson29ffcc82018-04-26 10:53:09 +0200116 dev_pm_domain_detach(dev, false);
117 return ret;
118 }
119
Richard Fitzgerald3dca1f82023-01-23 17:25:20 +0000120 mutex_lock(&slave->sdw_dev_lock);
121
Vinod Koul56d4fe32017-12-14 11:19:35 +0530122 /* device is probed so let's read the properties now */
Pierre-Louis Bossartbd29c002022-06-21 17:56:38 -0500123 if (drv->ops && drv->ops->read_prop)
124 drv->ops->read_prop(slave);
Vinod Koul56d4fe32017-12-14 11:19:35 +0530125
Charles Keepax3b6c4a12023-09-20 17:04:01 +0100126 if (slave->prop.use_domain_irq)
127 sdw_irq_create_mapping(slave);
Lucas Tanure12a95122023-08-04 11:45:57 +0100128
Pierre-Louis Bossartbcac5902020-05-19 04:35:51 +0800129 /* init the sysfs as we have properties now */
130 ret = sdw_slave_sysfs_init(slave);
131 if (ret < 0)
132 dev_warn(dev, "Slave sysfs init failed:%d\n", ret);
133
Vinod Koul56d4fe32017-12-14 11:19:35 +0530134 /*
135 * Check for valid clk_stop_timeout, use DisCo worst case value of
136 * 300ms
137 *
138 * TODO: check the timeouts and driver removal case
139 */
140 if (slave->prop.clk_stop_timeout == 0)
141 slave->prop.clk_stop_timeout = 300;
142
143 slave->bus->clk_stop_timeout = max_t(u32, slave->bus->clk_stop_timeout,
Pierre-Louis Bossart74a8d802019-05-01 10:57:32 -0500144 slave->prop.clk_stop_timeout);
Vinod Koul56d4fe32017-12-14 11:19:35 +0530145
Pierre-Louis Bossart2140b662020-01-14 18:08:35 -0600146 slave->probed = true;
Pierre-Louis Bossartbd29c002022-06-21 17:56:38 -0500147
148 /*
149 * if the probe happened after the bus was started, notify the codec driver
150 * of the current hardware status to e.g. start the initialization.
151 * Errors are only logged as warnings to avoid failing the probe.
152 */
153 if (drv->ops && drv->ops->update_status) {
154 ret = drv->ops->update_status(slave, slave->status);
155 if (ret < 0)
156 dev_warn(dev, "%s: update_status failed with status %d\n", __func__, ret);
157 }
158
159 mutex_unlock(&slave->sdw_dev_lock);
Pierre-Louis Bossart2140b662020-01-14 18:08:35 -0600160
161 dev_dbg(dev, "probe complete\n");
162
Vinod Koul56d4fe32017-12-14 11:19:35 +0530163 return 0;
Vinod Koul92513452017-12-14 11:19:33 +0530164}
165
166static int sdw_drv_remove(struct device *dev)
167{
168 struct sdw_slave *slave = dev_to_sdw_dev(dev);
169 struct sdw_driver *drv = drv_to_sdw_driver(dev->driver);
170 int ret = 0;
171
Pierre-Louis Bossartbd29c002022-06-21 17:56:38 -0500172 mutex_lock(&slave->sdw_dev_lock);
Lucas Tanure12a95122023-08-04 11:45:57 +0100173
Pierre-Louis Bossartbd29c002022-06-21 17:56:38 -0500174 slave->probed = false;
Lucas Tanure12a95122023-08-04 11:45:57 +0100175
176 if (slave->prop.use_domain_irq)
Charles Keepax3b6c4a12023-09-20 17:04:01 +0100177 sdw_irq_dispose_mapping(slave);
Lucas Tanure12a95122023-08-04 11:45:57 +0100178
Richard Fitzgerald3dca1f82023-01-23 17:25:20 +0000179 mutex_unlock(&slave->sdw_dev_lock);
Pierre-Louis Bossartbd29c002022-06-21 17:56:38 -0500180
Vinod Koul92513452017-12-14 11:19:33 +0530181 if (drv->remove)
182 ret = drv->remove(slave);
183
184 dev_pm_domain_detach(dev, false);
185
186 return ret;
187}
188
189static void sdw_drv_shutdown(struct device *dev)
190{
191 struct sdw_slave *slave = dev_to_sdw_dev(dev);
192 struct sdw_driver *drv = drv_to_sdw_driver(dev->driver);
193
194 if (drv->shutdown)
195 drv->shutdown(slave);
196}
197
198/**
199 * __sdw_register_driver() - register a SoundWire Slave driver
200 * @drv: driver to register
201 * @owner: owning module/driver
202 *
203 * Return: zero on success, else a negative error code.
204 */
205int __sdw_register_driver(struct sdw_driver *drv, struct module *owner)
206{
Pierre-Louis Bossart0196b522021-03-02 17:11:12 +0800207 const char *name;
208
Vinod Koul92513452017-12-14 11:19:33 +0530209 drv->driver.bus = &sdw_bus_type;
210
211 if (!drv->probe) {
Pierre-Louis Bossart0196b522021-03-02 17:11:12 +0800212 name = drv->name;
213 if (!name)
214 name = drv->driver.name;
215
216 pr_err("driver %s didn't provide SDW probe routine\n", name);
Vinod Koul92513452017-12-14 11:19:33 +0530217 return -EINVAL;
218 }
219
220 drv->driver.owner = owner;
221 drv->driver.probe = sdw_drv_probe;
Pierre-Louis Bossartdf640772022-06-10 09:51:05 +0800222 drv->driver.remove = sdw_drv_remove;
223 drv->driver.shutdown = sdw_drv_shutdown;
Vinod Koul92513452017-12-14 11:19:33 +0530224
225 return driver_register(&drv->driver);
226}
227EXPORT_SYMBOL_GPL(__sdw_register_driver);
228
229/**
230 * sdw_unregister_driver() - unregisters the SoundWire Slave driver
231 * @drv: driver to unregister
232 */
233void sdw_unregister_driver(struct sdw_driver *drv)
234{
235 driver_unregister(&drv->driver);
236}
237EXPORT_SYMBOL_GPL(sdw_unregister_driver);
238
239static int __init sdw_bus_init(void)
240{
Pierre-Louis Bossartbf034732019-08-21 13:58:18 -0500241 sdw_debugfs_init();
Vinod Koul92513452017-12-14 11:19:33 +0530242 return bus_register(&sdw_bus_type);
243}
244
245static void __exit sdw_bus_exit(void)
246{
Pierre-Louis Bossartbf034732019-08-21 13:58:18 -0500247 sdw_debugfs_exit();
Vinod Koul92513452017-12-14 11:19:33 +0530248 bus_unregister(&sdw_bus_type);
249}
250
251postcore_initcall(sdw_bus_init);
252module_exit(sdw_bus_exit);
253
254MODULE_DESCRIPTION("SoundWire bus");
255MODULE_LICENSE("GPL v2");