70 static int axg_tdm_formatter_enable(struct axg_tdm_formatter *formatter)  in axg_tdm_formatter_enable()  argument
72 	struct axg_tdm_stream *ts = formatter->stream;  in axg_tdm_formatter_enable()
77 	if (formatter->enabled)  in axg_tdm_formatter_enable()
94 	ret = reset_control_reset(formatter->reset);  in axg_tdm_formatter_enable()
104 	ret = clk_set_phase(formatter->sclk, invert ? 0 : 180);  in axg_tdm_formatter_enable()
109 	ret = formatter->drv->ops->prepare(formatter->map,  in axg_tdm_formatter_enable()
110 					   formatter->drv->quirks,  in axg_tdm_formatter_enable()
111 					   formatter->stream);  in axg_tdm_formatter_enable()
116 	ret = clk_prepare_enable(formatter->sclk);  in axg_tdm_formatter_enable()
120 	ret = clk_prepare_enable(formatter->lrclk);  in axg_tdm_formatter_enable()
122 		clk_disable_unprepare(formatter->sclk);  in axg_tdm_formatter_enable()
127 	formatter->drv->ops->enable(formatter->map);  in axg_tdm_formatter_enable()
128 	formatter->enabled = true;  in axg_tdm_formatter_enable()
133 static void axg_tdm_formatter_disable(struct axg_tdm_formatter *formatter)  in axg_tdm_formatter_disable()  argument
136 	if (!formatter->enabled)  in axg_tdm_formatter_disable()
139 	formatter->drv->ops->disable(formatter->map);  in axg_tdm_formatter_disable()
140 	clk_disable_unprepare(formatter->lrclk);  in axg_tdm_formatter_disable()
141 	clk_disable_unprepare(formatter->sclk);  in axg_tdm_formatter_disable()
142 	formatter->enabled = false;  in axg_tdm_formatter_disable()
145 static int axg_tdm_formatter_attach(struct axg_tdm_formatter *formatter)  in axg_tdm_formatter_attach()  argument
147 	struct axg_tdm_stream *ts = formatter->stream;  in axg_tdm_formatter_attach()
154 		ret = axg_tdm_formatter_enable(formatter);  in axg_tdm_formatter_attach()
161 	list_add_tail(&formatter->list, &ts->formatter_list);  in axg_tdm_formatter_attach()
167 static void axg_tdm_formatter_dettach(struct axg_tdm_formatter *formatter)  in axg_tdm_formatter_dettach()  argument
169 	struct axg_tdm_stream *ts = formatter->stream;  in axg_tdm_formatter_dettach()
172 	list_del(&formatter->list);  in axg_tdm_formatter_dettach()
175 	axg_tdm_formatter_disable(formatter);  in axg_tdm_formatter_dettach()
178 static int axg_tdm_formatter_power_up(struct axg_tdm_formatter *formatter,  in axg_tdm_formatter_power_up()  argument
181 	struct axg_tdm_stream *ts = formatter->drv->ops->get_stream(w);  in axg_tdm_formatter_power_up()
193 	ret = clk_prepare_enable(formatter->pclk);  in axg_tdm_formatter_power_up()
198 	ret = clk_set_parent(formatter->sclk_sel, ts->iface->sclk);  in axg_tdm_formatter_power_up()
203 	ret = clk_set_parent(formatter->lrclk_sel, ts->iface->lrclk);  in axg_tdm_formatter_power_up()
207 	formatter->stream = ts;  in axg_tdm_formatter_power_up()
208 	ret = axg_tdm_formatter_attach(formatter);  in axg_tdm_formatter_power_up()
215 	clk_disable_unprepare(formatter->pclk);  in axg_tdm_formatter_power_up()
219 static void axg_tdm_formatter_power_down(struct axg_tdm_formatter *formatter)  in axg_tdm_formatter_power_down()  argument
221 	axg_tdm_formatter_dettach(formatter);  in axg_tdm_formatter_power_down()
222 	clk_disable_unprepare(formatter->pclk);  in axg_tdm_formatter_power_down()
223 	formatter->stream = NULL;  in axg_tdm_formatter_power_down()
231 	struct axg_tdm_formatter *formatter = snd_soc_component_get_drvdata(c);  in axg_tdm_formatter_event()  local
236 		ret = axg_tdm_formatter_power_up(formatter, w);  in axg_tdm_formatter_event()
240 		axg_tdm_formatter_power_down(formatter);  in axg_tdm_formatter_event()
256 	struct axg_tdm_formatter *formatter;  in axg_tdm_formatter_probe()  local
265 	formatter = devm_kzalloc(dev, sizeof(*formatter), GFP_KERNEL);  in axg_tdm_formatter_probe()
266 	if (!formatter)  in axg_tdm_formatter_probe()
268 	platform_set_drvdata(pdev, formatter);  in axg_tdm_formatter_probe()
269 	formatter->drv = drv;  in axg_tdm_formatter_probe()
275 	formatter->map = devm_regmap_init_mmio(dev, regs, drv->regmap_cfg);  in axg_tdm_formatter_probe()
276 	if (IS_ERR(formatter->map)) {  in axg_tdm_formatter_probe()
278 			PTR_ERR(formatter->map));  in axg_tdm_formatter_probe()
279 		return PTR_ERR(formatter->map);  in axg_tdm_formatter_probe()
283 	formatter->pclk = devm_clk_get(dev, "pclk");  in axg_tdm_formatter_probe()
284 	if (IS_ERR(formatter->pclk))  in axg_tdm_formatter_probe()
285 		return dev_err_probe(dev, PTR_ERR(formatter->pclk), "failed to get pclk\n");  in axg_tdm_formatter_probe()
288 	formatter->sclk = devm_clk_get(dev, "sclk");  in axg_tdm_formatter_probe()
289 	if (IS_ERR(formatter->sclk))  in axg_tdm_formatter_probe()
290 		return dev_err_probe(dev, PTR_ERR(formatter->sclk), "failed to get sclk\n");  in axg_tdm_formatter_probe()
293 	formatter->lrclk = devm_clk_get(dev, "lrclk");  in axg_tdm_formatter_probe()
294 	if (IS_ERR(formatter->lrclk))  in axg_tdm_formatter_probe()
295 		return dev_err_probe(dev, PTR_ERR(formatter->lrclk), "failed to get lrclk\n");  in axg_tdm_formatter_probe()
298 	formatter->sclk_sel = devm_clk_get(dev, "sclk_sel");  in axg_tdm_formatter_probe()
299 	if (IS_ERR(formatter->sclk_sel))  in axg_tdm_formatter_probe()
300 		return dev_err_probe(dev, PTR_ERR(formatter->sclk_sel), "failed to get sclk_sel\n");  in axg_tdm_formatter_probe()
303 	formatter->lrclk_sel = devm_clk_get(dev, "lrclk_sel");  in axg_tdm_formatter_probe()
304 	if (IS_ERR(formatter->lrclk_sel))  in axg_tdm_formatter_probe()
305 		return dev_err_probe(dev, PTR_ERR(formatter->lrclk_sel),  in axg_tdm_formatter_probe()
309 	formatter->reset = devm_reset_control_get_optional_exclusive(dev, NULL);  in axg_tdm_formatter_probe()
310 	if (IS_ERR(formatter->reset))  in axg_tdm_formatter_probe()
311 		return dev_err_probe(dev, PTR_ERR(formatter->reset), "failed to get reset\n");  in axg_tdm_formatter_probe()
320 	struct axg_tdm_formatter *formatter;  in axg_tdm_stream_start()  local
327 	list_for_each_entry(formatter, &ts->formatter_list, list) {  in axg_tdm_stream_start()
328 		ret = axg_tdm_formatter_enable(formatter);  in axg_tdm_stream_start()
343 	struct axg_tdm_formatter *formatter;  in axg_tdm_stream_stop()  local
349 	list_for_each_entry(formatter, &ts->formatter_list, list) {  in axg_tdm_stream_stop()
350 		axg_tdm_formatter_disable(formatter);  in axg_tdm_stream_stop()