65 static void omap_mcbsp_st_write(struct omap_mcbsp *mcbsp, u16 reg, u32 val)  in omap_mcbsp_st_write()  argument
67 	writel_relaxed(val, mcbsp->st_data->io_base_st + reg);  in omap_mcbsp_st_write()
70 static int omap_mcbsp_st_read(struct omap_mcbsp *mcbsp, u16 reg)  in omap_mcbsp_st_read()  argument
72 	return readl_relaxed(mcbsp->st_data->io_base_st + reg);  in omap_mcbsp_st_read()
75 #define MCBSP_ST_READ(mcbsp, reg) omap_mcbsp_st_read(mcbsp, OMAP_ST_REG_##reg)  argument
76 #define MCBSP_ST_WRITE(mcbsp, reg, val) \  argument
77 			omap_mcbsp_st_write(mcbsp, OMAP_ST_REG_##reg, val)
79 static void omap_mcbsp_st_on(struct omap_mcbsp *mcbsp)  in omap_mcbsp_st_on()  argument
83 	if (mcbsp->pdata->force_ick_on)  in omap_mcbsp_st_on()
84 		mcbsp->pdata->force_ick_on(mcbsp->st_data->mcbsp_iclk, true);  in omap_mcbsp_st_on()
87 	w = MCBSP_ST_READ(mcbsp, SYSCONFIG);  in omap_mcbsp_st_on()
88 	MCBSP_ST_WRITE(mcbsp, SYSCONFIG, w & ~(ST_AUTOIDLE));  in omap_mcbsp_st_on()
91 	w = MCBSP_READ(mcbsp, SSELCR);  in omap_mcbsp_st_on()
92 	MCBSP_WRITE(mcbsp, SSELCR, w | SIDETONEEN);  in omap_mcbsp_st_on()
95 	w = MCBSP_ST_READ(mcbsp, SSELCR);  in omap_mcbsp_st_on()
96 	MCBSP_ST_WRITE(mcbsp, SSELCR, w | ST_SIDETONEEN);  in omap_mcbsp_st_on()
99 static void omap_mcbsp_st_off(struct omap_mcbsp *mcbsp)  in omap_mcbsp_st_off()  argument
103 	w = MCBSP_ST_READ(mcbsp, SSELCR);  in omap_mcbsp_st_off()
104 	MCBSP_ST_WRITE(mcbsp, SSELCR, w & ~(ST_SIDETONEEN));  in omap_mcbsp_st_off()
106 	w = MCBSP_READ(mcbsp, SSELCR);  in omap_mcbsp_st_off()
107 	MCBSP_WRITE(mcbsp, SSELCR, w & ~(SIDETONEEN));  in omap_mcbsp_st_off()
110 	w = MCBSP_ST_READ(mcbsp, SYSCONFIG);  in omap_mcbsp_st_off()
111 	MCBSP_ST_WRITE(mcbsp, SYSCONFIG, w | ST_AUTOIDLE);  in omap_mcbsp_st_off()
113 	if (mcbsp->pdata->force_ick_on)  in omap_mcbsp_st_off()
114 		mcbsp->pdata->force_ick_on(mcbsp->st_data->mcbsp_iclk, false);  in omap_mcbsp_st_off()
117 static void omap_mcbsp_st_fir_write(struct omap_mcbsp *mcbsp, s16 *fir)  in omap_mcbsp_st_fir_write()  argument
121 	val = MCBSP_ST_READ(mcbsp, SSELCR);  in omap_mcbsp_st_fir_write()
124 		MCBSP_ST_WRITE(mcbsp, SSELCR, val & ~(ST_COEFFWREN));  in omap_mcbsp_st_fir_write()
126 	MCBSP_ST_WRITE(mcbsp, SSELCR, val | ST_COEFFWREN);  in omap_mcbsp_st_fir_write()
129 		MCBSP_ST_WRITE(mcbsp, SFIRCR, fir[i]);  in omap_mcbsp_st_fir_write()
133 	val = MCBSP_ST_READ(mcbsp, SSELCR);  in omap_mcbsp_st_fir_write()
135 		val = MCBSP_ST_READ(mcbsp, SSELCR);  in omap_mcbsp_st_fir_write()
137 	MCBSP_ST_WRITE(mcbsp, SSELCR, val & ~(ST_COEFFWREN));  in omap_mcbsp_st_fir_write()
140 		dev_err(mcbsp->dev, "McBSP FIR load error!\n");  in omap_mcbsp_st_fir_write()
143 static void omap_mcbsp_st_chgain(struct omap_mcbsp *mcbsp)  in omap_mcbsp_st_chgain()  argument
146 	struct omap_mcbsp_st_data *st_data = mcbsp->st_data;  in omap_mcbsp_st_chgain()
148 	w = MCBSP_ST_READ(mcbsp, SSELCR);  in omap_mcbsp_st_chgain()
150 	MCBSP_ST_WRITE(mcbsp, SGAINCR, ST_CH0GAIN(st_data->ch0gain) |  in omap_mcbsp_st_chgain()
154 static int omap_mcbsp_st_set_chgain(struct omap_mcbsp *mcbsp, int channel,  in omap_mcbsp_st_set_chgain()  argument
157 	struct omap_mcbsp_st_data *st_data = mcbsp->st_data;  in omap_mcbsp_st_set_chgain()
163 	spin_lock_irq(&mcbsp->lock);  in omap_mcbsp_st_set_chgain()
172 		omap_mcbsp_st_chgain(mcbsp);  in omap_mcbsp_st_set_chgain()
173 	spin_unlock_irq(&mcbsp->lock);  in omap_mcbsp_st_set_chgain()
178 static int omap_mcbsp_st_get_chgain(struct omap_mcbsp *mcbsp, int channel,  in omap_mcbsp_st_get_chgain()  argument
181 	struct omap_mcbsp_st_data *st_data = mcbsp->st_data;  in omap_mcbsp_st_get_chgain()
187 	spin_lock_irq(&mcbsp->lock);  in omap_mcbsp_st_get_chgain()
194 	spin_unlock_irq(&mcbsp->lock);  in omap_mcbsp_st_get_chgain()
199 static int omap_mcbsp_st_enable(struct omap_mcbsp *mcbsp)  in omap_mcbsp_st_enable()  argument
201 	struct omap_mcbsp_st_data *st_data = mcbsp->st_data;  in omap_mcbsp_st_enable()
206 	spin_lock_irq(&mcbsp->lock);  in omap_mcbsp_st_enable()
208 	omap_mcbsp_st_start(mcbsp);  in omap_mcbsp_st_enable()
209 	spin_unlock_irq(&mcbsp->lock);  in omap_mcbsp_st_enable()
214 static int omap_mcbsp_st_disable(struct omap_mcbsp *mcbsp)  in omap_mcbsp_st_disable()  argument
216 	struct omap_mcbsp_st_data *st_data = mcbsp->st_data;  in omap_mcbsp_st_disable()
222 	spin_lock_irq(&mcbsp->lock);  in omap_mcbsp_st_disable()
223 	omap_mcbsp_st_stop(mcbsp);  in omap_mcbsp_st_disable()
225 	spin_unlock_irq(&mcbsp->lock);  in omap_mcbsp_st_disable()
230 static int omap_mcbsp_st_is_enabled(struct omap_mcbsp *mcbsp)  in omap_mcbsp_st_is_enabled()  argument
232 	struct omap_mcbsp_st_data *st_data = mcbsp->st_data;  in omap_mcbsp_st_is_enabled()
243 	struct omap_mcbsp *mcbsp = dev_get_drvdata(dev);  in st_taps_show()  local
244 	struct omap_mcbsp_st_data *st_data = mcbsp->st_data;  in st_taps_show()
248 	spin_lock_irq(&mcbsp->lock);  in st_taps_show()
254 	spin_unlock_irq(&mcbsp->lock);  in st_taps_show()
263 	struct omap_mcbsp *mcbsp = dev_get_drvdata(dev);  in st_taps_store()  local
264 	struct omap_mcbsp_st_data *st_data = mcbsp->st_data;  in st_taps_store()
267 	spin_lock_irq(&mcbsp->lock);  in st_taps_store()
291 	spin_unlock_irq(&mcbsp->lock);  in st_taps_store()
307 int omap_mcbsp_st_start(struct omap_mcbsp *mcbsp)  in omap_mcbsp_st_start()  argument
309 	struct omap_mcbsp_st_data *st_data = mcbsp->st_data;  in omap_mcbsp_st_start()
312 		omap_mcbsp_st_fir_write(mcbsp, st_data->taps);  in omap_mcbsp_st_start()
313 		omap_mcbsp_st_chgain(mcbsp);  in omap_mcbsp_st_start()
315 		if (!mcbsp->free) {  in omap_mcbsp_st_start()
316 			omap_mcbsp_st_on(mcbsp);  in omap_mcbsp_st_start()
324 int omap_mcbsp_st_stop(struct omap_mcbsp *mcbsp)  in omap_mcbsp_st_stop()  argument
326 	struct omap_mcbsp_st_data *st_data = mcbsp->st_data;  in omap_mcbsp_st_stop()
329 		if (!mcbsp->free) {  in omap_mcbsp_st_stop()
330 			omap_mcbsp_st_off(mcbsp);  in omap_mcbsp_st_stop()
340 	struct omap_mcbsp *mcbsp = platform_get_drvdata(pdev);  in omap_mcbsp_st_init()  local
349 	st_data = devm_kzalloc(mcbsp->dev, sizeof(*mcbsp->st_data), GFP_KERNEL);  in omap_mcbsp_st_init()
353 	st_data->mcbsp_iclk = clk_get(mcbsp->dev, "ick");  in omap_mcbsp_st_init()
355 		dev_warn(mcbsp->dev,  in omap_mcbsp_st_init()
360 	st_data->io_base_st = devm_ioremap(mcbsp->dev, res->start,  in omap_mcbsp_st_init()
365 	ret = sysfs_create_group(&mcbsp->dev->kobj, &sidetone_attr_group);  in omap_mcbsp_st_init()
369 	mcbsp->st_data = st_data;  in omap_mcbsp_st_init()
376 	struct omap_mcbsp *mcbsp = platform_get_drvdata(pdev);  in omap_mcbsp_st_cleanup()  local
378 	if (mcbsp->st_data) {  in omap_mcbsp_st_cleanup()
379 		sysfs_remove_group(&mcbsp->dev->kobj, &sidetone_attr_group);  in omap_mcbsp_st_cleanup()
380 		clk_put(mcbsp->st_data->mcbsp_iclk);  in omap_mcbsp_st_cleanup()
405 	struct omap_mcbsp *mcbsp = snd_soc_dai_get_drvdata(cpu_dai);	\
416 	return omap_mcbsp_st_set_chgain(mcbsp, channel, val);		\
424 	struct omap_mcbsp *mcbsp = snd_soc_dai_get_drvdata(cpu_dai);	\
427 	if (omap_mcbsp_st_get_chgain(mcbsp, channel, &chgain))		\
441 	struct omap_mcbsp *mcbsp = snd_soc_dai_get_drvdata(cpu_dai);  in omap_mcbsp_st_put_mode()  local
444 	if (value == omap_mcbsp_st_is_enabled(mcbsp))  in omap_mcbsp_st_put_mode()
448 		omap_mcbsp_st_enable(mcbsp);  in omap_mcbsp_st_put_mode()
450 		omap_mcbsp_st_disable(mcbsp);  in omap_mcbsp_st_put_mode()
459 	struct omap_mcbsp *mcbsp = snd_soc_dai_get_drvdata(cpu_dai);  in omap_mcbsp_st_get_mode()  local
461 	ucontrol->value.integer.value[0] = omap_mcbsp_st_is_enabled(mcbsp);  in omap_mcbsp_st_get_mode()
493 	struct omap_mcbsp *mcbsp = snd_soc_dai_get_drvdata(cpu_dai);  in omap_mcbsp_st_add_controls()  local
495 	if (!mcbsp->st_data) {  in omap_mcbsp_st_add_controls()
496 		dev_warn(mcbsp->dev, "No sidetone data for port\n");  in omap_mcbsp_st_add_controls()
510 		dev_err(mcbsp->dev, "Port %d not supported\n", port_id);  in omap_mcbsp_st_add_controls()