3 // Cirrus Logic Madera class codecs common support
18 #include <linux/irqchip/irq-madera.h>
19 #include <linux/mfd/madera/core.h>
20 #include <linux/mfd/madera/registers.h>
21 #include <linux/mfd/madera/pdata.h>
22 #include <sound/madera-pdata.h>
24 #include <dt-bindings/sound/madera.h>
26 #include "madera.h"
143 	dev_err(_fll->madera->dev, "FLL%d: " fmt, _fll->id, ##__VA_ARGS__)
145 	dev_warn(_fll->madera->dev, "FLL%d: " fmt, _fll->id, ##__VA_ARGS__)
147 	dev_dbg(_fll->madera->dev, "FLL%d: " fmt, _fll->id, ##__VA_ARGS__)
171 	struct madera *madera = priv->madera;  in madera_clk_ev()  local
176 	ret = regmap_read(madera->regmap, w->reg, &val);  in madera_clk_ev()
178 		dev_err(madera->dev, "Failed to check clock source: %d\n", ret);  in madera_clk_ev()
198 		return clk_prepare_enable(madera->mclk[clk_idx].clk);  in madera_clk_ev()
200 		clk_disable_unprepare(madera->mclk[clk_idx].clk);  in madera_clk_ev()
210 	struct madera *madera = priv->madera;  in madera_spin_sysclk()  local
215 	if (pm_runtime_suspended(madera->dev))  in madera_spin_sysclk()
223 		ret = regmap_read(madera->regmap, MADERA_SOFTWARE_RESET, &val);  in madera_spin_sysclk()
225 			dev_err(madera->dev,  in madera_spin_sysclk()
251 static int madera_check_speaker_overheat(struct madera *madera,  in madera_check_speaker_overheat()  argument
257 	ret = regmap_read(madera->regmap, MADERA_IRQ1_RAW_STATUS_15, &val);  in madera_check_speaker_overheat()
259 		dev_err(madera->dev, "Failed to read thermal status: %d\n",  in madera_check_speaker_overheat()
275 	struct madera *madera = priv->madera;  in madera_spk_ev()  local
281 		ret = madera_check_speaker_overheat(madera, &warn, &shutdown);  in madera_spk_ev()
286 			dev_crit(madera->dev,  in madera_spk_ev()
291 		regmap_update_bits(madera->regmap, MADERA_OUTPUT_ENABLES_1,  in madera_spk_ev()
295 		regmap_update_bits(madera->regmap, MADERA_OUTPUT_ENABLES_1,  in madera_spk_ev()
308 	struct madera *madera = data;  in madera_thermal_warn()  local
312 	ret = madera_check_speaker_overheat(madera, &warn, &shutdown);  in madera_thermal_warn()
314 		dev_crit(madera->dev, "Thermal shutdown\n");  in madera_thermal_warn()
315 		ret = regmap_update_bits(madera->regmap,  in madera_thermal_warn()
320 			dev_crit(madera->dev,  in madera_thermal_warn()
324 		dev_alert(madera->dev, "Thermal warning\n");  in madera_thermal_warn()
326 		dev_info(madera->dev, "Spurious thermal warning\n");  in madera_thermal_warn()
335 	struct madera *madera = priv->madera;  in madera_init_overheat()  local
336 	struct device *dev = madera->dev;  in madera_init_overheat()
339 	ret = madera_request_irq(madera, MADERA_IRQ_SPK_OVERHEAT_WARN,  in madera_init_overheat()
341 				 madera);  in madera_init_overheat()
345 	ret = madera_request_irq(madera, MADERA_IRQ_SPK_OVERHEAT,  in madera_init_overheat()
347 				 madera);  in madera_init_overheat()
357 	struct madera *madera = priv->madera;  in madera_free_overheat()  local
359 	madera_free_irq(madera, MADERA_IRQ_SPK_OVERHEAT_WARN, madera);  in madera_free_overheat()
360 	madera_free_irq(madera, MADERA_IRQ_SPK_OVERHEAT, madera);  in madera_free_overheat()
400 	struct madera *madera = priv->madera;  in madera_prop_get_inmode()  local
401 	struct madera_codec_pdata *pdata = &madera->pdata.codec;  in madera_prop_get_inmode()
408 	n = madera_get_variable_u32_array(madera->dev, "cirrus,inmode",  in madera_prop_get_inmode()
428 	struct madera *madera = priv->madera;  in madera_prop_get_pdata()  local
429 	struct madera_codec_pdata *pdata = &madera->pdata.codec;  in madera_prop_get_pdata()
435 	n = madera_get_variable_u32_array(madera->dev, "cirrus,out-mono",  in madera_prop_get_pdata()
441 	madera_get_variable_u32_array(madera->dev,  in madera_prop_get_pdata()
447 	madera_get_variable_u32_array(madera->dev, "cirrus,pdm-fmt",  in madera_prop_get_pdata()
451 	madera_get_variable_u32_array(madera->dev, "cirrus,pdm-mute",  in madera_prop_get_pdata()
455 	madera_get_variable_u32_array(madera->dev, "cirrus,dmic-ref",  in madera_prop_get_pdata()
468 	if (!dev_get_platdata(priv->madera->dev))  in madera_core_init()
474 		priv->madera->out_clamp[i] = true;  in madera_core_init()
490 	struct madera *madera = priv->madera;  in madera_debug_dump_domain_groups()  local
494 		dev_dbg(madera->dev, "domain_grp_ref[%d]=%d\n", i,  in madera_debug_dump_domain_groups()
519 		dev_dbg(priv->madera->dev, "Inc ref on domain group %d\n",  in madera_domain_clk_ev()
524 		dev_dbg(priv->madera->dev, "Dec ref on domain group %d\n",  in madera_domain_clk_ev()
548 	struct madera *madera = priv->madera;  in madera_out1_demux_put()  local
570 	ret = regmap_update_bits(madera->regmap, MADERA_OUTPUT_ENABLES_1,  in madera_out1_demux_put()
573 		dev_warn(madera->dev, "Failed to disable outputs: %d\n", ret);  in madera_out1_demux_put()
579 	if (madera->out_clamp[0])  in madera_out1_demux_put()
580 		ret = regmap_update_bits(madera->regmap,  in madera_out1_demux_put()
584 		dev_err(madera->dev, "Failed to set OUT1 demux: %d\n", ret);  in madera_out1_demux_put()
587 		if (!ep_sel && !madera->pdata.codec.out_mono[0])  in madera_out1_demux_put()
594 			dev_warn(madera->dev,  in madera_out1_demux_put()
603 	    (madera->out_clamp[0] && !madera->out_shorted[0])) {  in madera_out1_demux_put()
604 		ret = regmap_update_bits(madera->regmap,  in madera_out1_demux_put()
607 					 madera->hp_ena);  in madera_out1_demux_put()
609 			dev_warn(madera->dev,  in madera_out1_demux_put()
612 		else if (madera->hp_ena)  in madera_out1_demux_put()
649 	struct madera *madera = priv->madera;  in madera_inmux_put()  local
650 	struct regmap *regmap = madera->regmap;  in madera_inmux_put()
666 		inmode = madera->pdata.codec.inmode[0][2 * mux];  in madera_inmux_put()
669 		inmode = madera->pdata.codec.inmode[0][1 + (2 * mux)];  in madera_inmux_put()
672 		inmode = madera->pdata.codec.inmode[1][2 * mux];  in madera_inmux_put()
675 		inmode = madera->pdata.codec.inmode[1][1 + (2 * mux)];  in madera_inmux_put()
684 	dev_dbg(madera->dev, "mux=%u reg=0x%x inmode=0x%x mask=0x%x val=0x%x\n",  in madera_inmux_put()
858 	dev_dbg(priv->madera->dev, "Rate reg 0x%x group ref %d\n", reg, count);  in madera_can_change_grp_rate()
909 		dev_warn(priv->madera->dev,  in madera_adsp_rate_put()
969 	switch (priv->madera->type) {  in madera_write_adsp_clk_setting()
979 		dev_dbg(priv->madera->dev, "Set DSP frequency to 0x%x\n", freq);  in madera_write_adsp_clk_setting()
994 	dev_dbg(priv->madera->dev, "Set DSP clocking to 0x%x\n", val);  in madera_write_adsp_clk_setting()
1008 	struct madera *madera = priv->madera;  in madera_set_adsp_clk()  local
1023 		dev_err(madera->dev,  in madera_set_adsp_clk()
1033 		dev_dbg(madera->dev, "DSP rate not changed\n");  in madera_set_adsp_clk()
1036 		dev_dbg(madera->dev, "DSP rate changed\n");  in madera_set_adsp_clk()
1076 		dev_warn(priv->madera->dev,  in madera_rate_put()
1093 static void madera_configure_input_mode(struct madera *madera)  in madera_configure_input_mode()  argument
1098 	switch (madera->type) {  in madera_configure_input_mode()
1128 		dev_dbg(madera->dev, "IN%d mode %u:%u:%u:%u\n", i + 1,  in madera_configure_input_mode()
1129 			madera->pdata.codec.inmode[i][0],  in madera_configure_input_mode()
1130 			madera->pdata.codec.inmode[i][1],  in madera_configure_input_mode()
1131 			madera->pdata.codec.inmode[i][2],  in madera_configure_input_mode()
1132 			madera->pdata.codec.inmode[i][3]);  in madera_configure_input_mode()
1134 		dig_mode = madera->pdata.codec.dmic_ref[i] <<  in madera_configure_input_mode()
1137 		switch (madera->pdata.codec.inmode[i][0]) {  in madera_configure_input_mode()
1145 			dev_warn(madera->dev,  in madera_configure_input_mode()
1147 				 i + 1, madera->pdata.codec.inmode[i][0]);  in madera_configure_input_mode()
1151 		switch (madera->pdata.codec.inmode[i][1]) {  in madera_configure_input_mode()
1159 			dev_warn(madera->dev,  in madera_configure_input_mode()
1161 				 i + 1, madera->pdata.codec.inmode[i][1]);  in madera_configure_input_mode()
1165 		dev_dbg(madera->dev,  in madera_configure_input_mode()
1169 		regmap_update_bits(madera->regmap,  in madera_configure_input_mode()
1176 		regmap_update_bits(madera->regmap,  in madera_configure_input_mode()
1180 		regmap_update_bits(madera->regmap,  in madera_configure_input_mode()
1189 	struct madera *madera = priv->madera;  in madera_init_inputs()  local
1191 	madera_configure_input_mode(madera);  in madera_init_inputs()
1213 	struct madera *madera = priv->madera;  in madera_init_outputs()  local
1214 	const struct madera_codec_pdata *pdata = &madera->pdata.codec;  in madera_init_outputs()
1219 		dev_warn(madera->dev,  in madera_init_outputs()
1240 		regmap_update_bits(madera->regmap,  in madera_init_outputs()
1244 		dev_dbg(madera->dev, "OUT%d mono=0x%x\n", i + 1, val);  in madera_init_outputs()
1248 		dev_dbg(madera->dev, "PDM%d fmt=0x%x mute=0x%x\n", i + 1,  in madera_init_outputs()
1252 			regmap_update_bits(madera->regmap,  in madera_init_outputs()
1259 			regmap_update_bits(madera->regmap,  in madera_init_outputs()
1272 	struct madera *madera = priv->madera;  in madera_init_bus_error_irq()  local
1275 	ret = madera_request_irq(madera,  in madera_init_bus_error_irq()
1281 		dev_err(madera->dev,  in madera_init_bus_error_irq()
1290 	struct madera *madera = priv->madera;  in madera_free_bus_error_irq()  local
1292 	madera_free_irq(madera,  in madera_free_bus_error_irq()
2250 		ret = regmap_update_bits(priv->madera->regmap,  in madera_in_set_vu()
2254 			dev_warn(priv->madera->dev,  in madera_in_set_vu()
2310 	struct madera *madera = priv->madera;  in madera_out_ev()  local
2313 	switch (madera->type) {  in madera_out_ev()
2410 	struct madera *madera = priv->madera;  in madera_hp_ev()  local
2431 	madera->hp_ena &= ~mask;  in madera_hp_ev()
2432 	madera->hp_ena |= val;  in madera_hp_ev()
2434 	switch (madera->type) {  in madera_hp_ev()
2441 		regmap_read(madera->regmap, MADERA_OUTPUT_ENABLES_1, &ep_sel);  in madera_hp_ev()
2448 	    (!madera->out_clamp[out_num] || madera->out_shorted[out_num]))  in madera_hp_ev()
2451 	regmap_update_bits(madera->regmap, MADERA_OUTPUT_ENABLES_1, mask, val);  in madera_hp_ev()
2573 static int madera_get_legacy_dspclk_setting(struct madera *madera,  in madera_get_legacy_dspclk_setting()  argument
2581 		switch (madera->type) {  in madera_get_legacy_dspclk_setting()
2584 			if (madera->rev < 3)  in madera_get_legacy_dspclk_setting()
2600 static int madera_get_dspclk_setting(struct madera *madera,  in madera_get_dspclk_setting()  argument
2604 	switch (madera->type) {  in madera_get_dspclk_setting()
2609 		return madera_get_legacy_dspclk_setting(madera, freq);  in madera_get_dspclk_setting()
2676 	struct madera *madera = priv->madera;  in madera_set_sysclk()  local
2702 		clk_freq_sel = madera_get_dspclk_setting(madera, freq,  in madera_set_sysclk()
2715 		dev_err(madera->dev,  in madera_set_sysclk()
2723 		dev_dbg(madera->dev, "%s cleared\n", name);  in madera_set_sysclk()
2730 		ret = regmap_write(madera->regmap, MADERA_DSP_CLOCK_2,  in madera_set_sysclk()
2733 			dev_err(madera->dev,  in madera_set_sysclk()
2748 	dev_dbg(madera->dev, "%s set to %uHz\n", name, freq);  in madera_set_sysclk()
2750 	return regmap_update_bits(madera->regmap, reg, mask, val);  in madera_set_sysclk()
2758 	struct madera *madera = priv->madera;  in madera_set_fmt()  local
2833 	regmap_update_bits(madera->regmap, base + MADERA_AIF_BCLK_CTRL,  in madera_set_fmt()
2836 	regmap_update_bits(madera->regmap, base + MADERA_AIF_TX_PIN_CTRL,  in madera_set_fmt()
2839 	regmap_update_bits(madera->regmap, base + MADERA_AIF_RX_PIN_CTRL,  in madera_set_fmt()
2842 	regmap_update_bits(madera->regmap, base + MADERA_AIF_FORMAT,  in madera_set_fmt()
2939 	struct madera *madera = priv->madera;  in madera_startup()  local
2959 	switch (madera->type) {  in madera_startup()
3040 	ret = regmap_read(priv->madera->regmap,  in madera_hw_params_rate()
3097 	struct madera *madera = priv->madera;  in madera_hw_params()  local
3105 			madera->pdata.codec.max_channels_clocked[dai->id - 1];  in madera_hw_params()
3172 		regmap_read(madera->regmap, base + MADERA_AIF_TX_ENABLES,  in madera_hw_params()
3174 		regmap_read(madera->regmap, base + MADERA_AIF_RX_ENABLES,  in madera_hw_params()
3177 		regmap_update_bits(madera->regmap,  in madera_hw_params()
3179 		regmap_update_bits(madera->regmap,  in madera_hw_params()
3188 		regmap_update_bits(madera->regmap,  in madera_hw_params()
3191 		regmap_update_bits(madera->regmap,  in madera_hw_params()
3194 		regmap_update_bits(madera->regmap,  in madera_hw_params()
3198 		regmap_update_bits(madera->regmap,  in madera_hw_params()
3207 		regmap_update_bits(madera->regmap,  in madera_hw_params()
3210 		regmap_update_bits(madera->regmap,  in madera_hw_params()
3309 	struct madera *madera = priv->madera;  in madera_set_channels_to_mask()  local
3317 		regmap_write(madera->regmap, base + i, slot);  in madera_set_channels_to_mask()
3471 	switch (fll->madera->type) {  in madera_find_fratio()
3473 		switch (fll->madera->rev) {  in madera_find_fratio()
3528 	switch (fll->madera->type) {  in madera_calc_fratio()
3530 		switch (fll->madera->rev) {  in madera_calc_fratio()
3659 	switch (fll->madera->type) {  in madera_calc_fll()
3661 		switch (fll->madera->rev) {  in madera_calc_fll()
3708 static bool madera_write_fll(struct madera *madera, unsigned int base,  in madera_write_fll()  argument
3715 	regmap_update_bits_check(madera->regmap,  in madera_write_fll()
3720 	regmap_update_bits_check(madera->regmap,  in madera_write_fll()
3725 	regmap_update_bits_check(madera->regmap,  in madera_write_fll()
3731 	regmap_update_bits_check(madera->regmap,  in madera_write_fll()
3741 		regmap_update_bits_check(madera->regmap,  in madera_write_fll()
3748 		regmap_update_bits_check(madera->regmap,  in madera_write_fll()
3756 	regmap_update_bits_check(madera->regmap,  in madera_write_fll()
3767 	struct madera *madera = fll->madera;  in madera_is_enabled_fll()  local
3771 	ret = regmap_read(madera->regmap,  in madera_is_enabled_fll()
3783 	struct madera *madera = fll->madera;  in madera_wait_for_fll()  local
3791 		regmap_read(madera->regmap, MADERA_IRQ1_RAW_STATUS_2, &val);  in madera_wait_for_fll()
3827 	regmap_update_bits_check(fll->madera->regmap,  in madera_set_fll_phase_integrator()
3840 	struct madera *madera = fll->madera;  in madera_set_fll_clks_reg()  local
3845 	ret = regmap_read(madera->regmap, reg, &src);  in madera_set_fll_clks_reg()
3856 		clk = madera->mclk[MADERA_MCLK1].clk;  in madera_set_fll_clks_reg()
3859 		clk = madera->mclk[MADERA_MCLK2].clk;  in madera_set_fll_clks_reg()
3862 		clk = madera->mclk[MADERA_MCLK3].clk;  in madera_set_fll_clks_reg()
3902 	struct madera *madera = fll->madera;  in madera_disable_fll()  local
3906 	switch (madera->type) {  in madera_disable_fll()
3917 	regmap_update_bits(madera->regmap,  in madera_disable_fll()
3920 	regmap_update_bits_check(madera->regmap,  in madera_disable_fll()
3923 	regmap_update_bits_check(madera->regmap,  in madera_disable_fll()
3926 	regmap_update_bits(madera->regmap,  in madera_disable_fll()
3937 		pm_runtime_put_autosuspend(madera->dev);  in madera_disable_fll()
3943 	struct madera *madera = fll->madera;  in madera_enable_fll()  local
3971 	switch (madera->type) {  in madera_enable_fll()
3986 		regmap_update_bits(fll->madera->regmap,  in madera_enable_fll()
3991 		regmap_update_bits(fll->madera->regmap,  in madera_enable_fll()
4006 		fll_change |= madera_write_fll(madera, sync_base,  in madera_enable_fll()
4024 	switch (fll->madera->type) {  in madera_enable_fll()
4026 		switch (fll->madera->rev) {  in madera_enable_fll()
4055 	fll_change |= madera_write_fll(madera, fll->base,  in madera_enable_fll()
4064 		regmap_update_bits(madera->regmap,  in madera_enable_fll()
4068 		regmap_update_bits(madera->regmap,  in madera_enable_fll()
4074 		pm_runtime_get_sync(madera->dev);  in madera_enable_fll()
4078 		regmap_update_bits(madera->regmap,  in madera_enable_fll()
4085 	regmap_update_bits(madera->regmap,  in madera_enable_fll()
4090 		regmap_update_bits(madera->regmap,  in madera_enable_fll()
4167 int madera_init_fll(struct madera *madera, int id, int base,  in madera_init_fll()  argument
4172 	fll->madera = madera;  in madera_init_fll()
4176 	regmap_update_bits(madera->regmap,  in madera_init_fll()
4237 	struct madera *madera = fll->madera;  in madera_enable_fll_ao()  local
4246 		pm_runtime_get_sync(madera->dev);  in madera_enable_fll_ao()
4252 	regmap_update_bits(fll->madera->regmap,  in madera_enable_fll_ao()
4269 		regmap_write(madera->regmap, patch[i].reg, val);  in madera_enable_fll_ao()
4274 	regmap_update_bits(madera->regmap,  in madera_enable_fll_ao()
4279 	regmap_update_bits(madera->regmap,  in madera_enable_fll_ao()
4291 	struct madera *madera = fll->madera;  in madera_disable_fll_ao()  local
4296 	regmap_update_bits(madera->regmap,  in madera_disable_fll_ao()
4299 	regmap_update_bits_check(madera->regmap,  in madera_disable_fll_ao()
4313 	regmap_update_bits(madera->regmap,  in madera_disable_fll_ao()
4319 		pm_runtime_put_autosuspend(madera->dev);  in madera_disable_fll_ao()
4372 	struct madera *madera = fll->madera;  in madera_fllhj_disable()  local
4383 	regmap_update_bits(madera->regmap,  in madera_fllhj_disable()
4386 	regmap_update_bits(madera->regmap,  in madera_fllhj_disable()
4389 	regmap_update_bits_check(madera->regmap,  in madera_fllhj_disable()
4402 	regmap_update_bits(madera->regmap,  in madera_fllhj_disable()
4408 		pm_runtime_put_autosuspend(madera->dev);  in madera_fllhj_disable()
4416 	struct madera *madera = fll->madera;  in madera_fllhj_apply()  local
4518 	regmap_write(madera->regmap,  in madera_fllhj_apply()
4521 	regmap_update_bits(madera->regmap,  in madera_fllhj_apply()
4525 	regmap_update_bits(madera->regmap,  in madera_fllhj_apply()
4529 	regmap_update_bits(madera->regmap,  in madera_fllhj_apply()
4533 	regmap_update_bits(madera->regmap,  in madera_fllhj_apply()
4537 	regmap_update_bits(madera->regmap,  in madera_fllhj_apply()
4543 	regmap_update_bits(madera->regmap,  in madera_fllhj_apply()
4547 	regmap_update_bits(madera->regmap,  in madera_fllhj_apply()
4551 	regmap_update_bits(madera->regmap,  in madera_fllhj_apply()
4562 	struct madera *madera = fll->madera;  in madera_fllhj_enable()  local
4570 		pm_runtime_get_sync(madera->dev);  in madera_fllhj_enable()
4576 	regmap_update_bits(fll->madera->regmap,  in madera_fllhj_enable()
4590 	regmap_update_bits(madera->regmap,  in madera_fllhj_enable()
4597 	regmap_update_bits(madera->regmap,  in madera_fllhj_enable()
4603 	regmap_update_bits(madera->regmap,  in madera_fllhj_enable()
4608 	regmap_update_bits(madera->regmap,  in madera_fllhj_enable()
4614 	regmap_update_bits(madera->regmap,  in madera_fllhj_enable()
4741 	struct madera *madera = priv->madera;  in madera_eq_coeff_put()  local
4748 	len = params->num_regs * regmap_get_val_bytes(madera->regmap);  in madera_eq_coeff_put()
4761 		dev_err(madera->dev, "Rejecting unstable EQ coefficients\n");  in madera_eq_coeff_put()
4766 	ret = regmap_read(madera->regmap, params->base, &val);  in madera_eq_coeff_put()
4773 	ret = regmap_raw_write(madera->regmap, params->base, data, len);  in madera_eq_coeff_put()
4788 	struct madera *madera = priv->madera;  in madera_lhpf_coeff_put()  local
4793 		dev_err(madera->dev, "Rejecting unstable LHPF coefficients\n");  in madera_lhpf_coeff_put()
4801 MODULE_SOFTDEP("pre: madera");
4802 MODULE_DESCRIPTION("ASoC Cirrus Logic Madera codec support");