1 // SPDX-License-Identifier: (GPL-2.0 OR MIT)
12 #include "axg-tdm-formatter.h"
18 	struct clk *pclk;  member
31 	unsigned int val, ch = ts->channels;  in axg_tdm_formatter_set_channel_masks()
41 		mask = ts->mask[i];  in axg_tdm_formatter_set_channel_masks()
47 			ch -= 1;  in axg_tdm_formatter_set_channel_masks()
61 		return -EINVAL;  in axg_tdm_formatter_set_channel_masks()
70 	struct axg_tdm_stream *ts = formatter->stream;  in axg_tdm_formatter_enable()
71 	bool invert = formatter->drv->invert_sclk;  in axg_tdm_formatter_enable()
75 	if (formatter->enabled)  in axg_tdm_formatter_enable()
82 	invert ^= axg_tdm_sclk_invert(ts->iface->fmt);  in axg_tdm_formatter_enable()
83 	ret = clk_set_phase(formatter->sclk, invert ? 180 : 0);  in axg_tdm_formatter_enable()
88 	ret = formatter->drv->ops->prepare(formatter->map, formatter->stream);  in axg_tdm_formatter_enable()
93 	ret = clk_prepare_enable(formatter->sclk);  in axg_tdm_formatter_enable()
97 	ret = clk_prepare_enable(formatter->lrclk);  in axg_tdm_formatter_enable()
99 		clk_disable_unprepare(formatter->sclk);  in axg_tdm_formatter_enable()
104 	formatter->drv->ops->enable(formatter->map);  in axg_tdm_formatter_enable()
105 	formatter->enabled = true;  in axg_tdm_formatter_enable()
113 	if (!formatter->enabled)  in axg_tdm_formatter_disable()
116 	formatter->drv->ops->disable(formatter->map);  in axg_tdm_formatter_disable()
117 	clk_disable_unprepare(formatter->lrclk);  in axg_tdm_formatter_disable()
118 	clk_disable_unprepare(formatter->sclk);  in axg_tdm_formatter_disable()
119 	formatter->enabled = false;  in axg_tdm_formatter_disable()
124 	struct axg_tdm_stream *ts = formatter->stream;  in axg_tdm_formatter_attach()
127 	mutex_lock(&ts->lock);  in axg_tdm_formatter_attach()
130 	if (ts->ready) {  in axg_tdm_formatter_attach()
138 	list_add_tail(&formatter->list, &ts->formatter_list);  in axg_tdm_formatter_attach()
140 	mutex_unlock(&ts->lock);  in axg_tdm_formatter_attach()
146 	struct axg_tdm_stream *ts = formatter->stream;  in axg_tdm_formatter_dettach()
148 	mutex_lock(&ts->lock);  in axg_tdm_formatter_dettach()
149 	list_del(&formatter->list);  in axg_tdm_formatter_dettach()
150 	mutex_unlock(&ts->lock);  in axg_tdm_formatter_dettach()
158 	struct axg_tdm_stream *ts = formatter->drv->ops->get_stream(w);  in axg_tdm_formatter_power_up()
167 		return -ENODEV;  in axg_tdm_formatter_power_up()
170 	ret = clk_prepare_enable(formatter->pclk);  in axg_tdm_formatter_power_up()
175 	ret = clk_set_parent(formatter->sclk_sel, ts->iface->sclk);  in axg_tdm_formatter_power_up()
179 	/* Reparent the sample clock to the TDM interface */  in axg_tdm_formatter_power_up()
180 	ret = clk_set_parent(formatter->lrclk_sel, ts->iface->lrclk);  in axg_tdm_formatter_power_up()
184 	formatter->stream = ts;  in axg_tdm_formatter_power_up()
192 	clk_disable_unprepare(formatter->pclk);  in axg_tdm_formatter_power_up()
199 	clk_disable_unprepare(formatter->pclk);  in axg_tdm_formatter_power_down()
200 	formatter->stream = NULL;  in axg_tdm_formatter_power_down()
207 	struct snd_soc_component *c = snd_soc_dapm_to_component(w->dapm);  in axg_tdm_formatter_event()
221 		dev_err(c->dev, "Unexpected event %d\n", event);  in axg_tdm_formatter_event()
222 		return -EINVAL;  in axg_tdm_formatter_event()
231 	struct device *dev = &pdev->dev;  in axg_tdm_formatter_probe()
241 		return -ENODEV;  in axg_tdm_formatter_probe()
246 		return -ENOMEM;  in axg_tdm_formatter_probe()
248 	formatter->drv = drv;  in axg_tdm_formatter_probe()
255 	formatter->map = devm_regmap_init_mmio(dev, regs, drv->regmap_cfg);  in axg_tdm_formatter_probe()
256 	if (IS_ERR(formatter->map)) {  in axg_tdm_formatter_probe()
258 			PTR_ERR(formatter->map));  in axg_tdm_formatter_probe()
259 		return PTR_ERR(formatter->map);  in axg_tdm_formatter_probe()
263 	formatter->pclk = devm_clk_get(dev, "pclk");  in axg_tdm_formatter_probe()
264 	if (IS_ERR(formatter->pclk)) {  in axg_tdm_formatter_probe()
265 		ret = PTR_ERR(formatter->pclk);  in axg_tdm_formatter_probe()
266 		if (ret != -EPROBE_DEFER)  in axg_tdm_formatter_probe()
267 			dev_err(dev, "failed to get pclk: %d\n", ret);  in axg_tdm_formatter_probe()
272 	formatter->sclk = devm_clk_get(dev, "sclk");  in axg_tdm_formatter_probe()
273 	if (IS_ERR(formatter->sclk)) {  in axg_tdm_formatter_probe()
274 		ret = PTR_ERR(formatter->sclk);  in axg_tdm_formatter_probe()
275 		if (ret != -EPROBE_DEFER)  in axg_tdm_formatter_probe()
280 	/* Formatter sample clock */  in axg_tdm_formatter_probe()
281 	formatter->lrclk = devm_clk_get(dev, "lrclk");  in axg_tdm_formatter_probe()
282 	if (IS_ERR(formatter->lrclk)) {  in axg_tdm_formatter_probe()
283 		ret = PTR_ERR(formatter->lrclk);  in axg_tdm_formatter_probe()
284 		if (ret != -EPROBE_DEFER)  in axg_tdm_formatter_probe()
290 	formatter->sclk_sel = devm_clk_get(dev, "sclk_sel");  in axg_tdm_formatter_probe()
291 	if (IS_ERR(formatter->sclk_sel)) {  in axg_tdm_formatter_probe()
292 		ret = PTR_ERR(formatter->sclk_sel);  in axg_tdm_formatter_probe()
293 		if (ret != -EPROBE_DEFER)  in axg_tdm_formatter_probe()
298 	/* Formatter sample clock input multiplexer */  in axg_tdm_formatter_probe()
299 	formatter->lrclk_sel = devm_clk_get(dev, "lrclk_sel");  in axg_tdm_formatter_probe()
300 	if (IS_ERR(formatter->lrclk_sel)) {  in axg_tdm_formatter_probe()
301 		ret = PTR_ERR(formatter->lrclk_sel);  in axg_tdm_formatter_probe()
302 		if (ret != -EPROBE_DEFER)  in axg_tdm_formatter_probe()
307 	return devm_snd_soc_register_component(dev, drv->component_drv,  in axg_tdm_formatter_probe()
317 	mutex_lock(&ts->lock);  in axg_tdm_stream_start()
318 	ts->ready = true;  in axg_tdm_stream_start()
321 	list_for_each_entry(formatter, &ts->formatter_list, list) {  in axg_tdm_stream_start()
330 	mutex_unlock(&ts->lock);  in axg_tdm_stream_start()
339 	mutex_lock(&ts->lock);  in axg_tdm_stream_stop()
340 	ts->ready = false;  in axg_tdm_stream_stop()
343 	list_for_each_entry(formatter, &ts->formatter_list, list) {  in axg_tdm_stream_stop()
347 	mutex_unlock(&ts->lock);  in axg_tdm_stream_stop()
357 		INIT_LIST_HEAD(&ts->formatter_list);  in axg_tdm_stream_alloc()
358 		mutex_init(&ts->lock);  in axg_tdm_stream_alloc()
359 		ts->iface = iface;  in axg_tdm_stream_alloc()
373 	WARN_ON(!list_empty(&ts->formatter_list));  in axg_tdm_stream_free()
374 	mutex_destroy(&ts->lock);  in axg_tdm_stream_free()