xref: /openbmc/linux/sound/soc/codecs/cs35l33.c (revision 13bb7bfc)
1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
23333cb71SPaul Handrigan /*
33333cb71SPaul Handrigan  * cs35l33.c -- CS35L33 ALSA SoC audio driver
43333cb71SPaul Handrigan  *
53333cb71SPaul Handrigan  * Copyright 2016 Cirrus Logic, Inc.
63333cb71SPaul Handrigan  *
73333cb71SPaul Handrigan  * Author: Paul Handrigan <paul.handrigan@cirrus.com>
83333cb71SPaul Handrigan  */
93333cb71SPaul Handrigan #include <linux/module.h>
103333cb71SPaul Handrigan #include <linux/moduleparam.h>
113333cb71SPaul Handrigan #include <linux/kernel.h>
123333cb71SPaul Handrigan #include <linux/init.h>
133333cb71SPaul Handrigan #include <linux/delay.h>
143333cb71SPaul Handrigan #include <linux/i2c.h>
153333cb71SPaul Handrigan #include <linux/slab.h>
163333cb71SPaul Handrigan #include <linux/workqueue.h>
173333cb71SPaul Handrigan #include <linux/platform_device.h>
183333cb71SPaul Handrigan #include <sound/core.h>
193333cb71SPaul Handrigan #include <sound/pcm.h>
203333cb71SPaul Handrigan #include <sound/pcm_params.h>
213333cb71SPaul Handrigan #include <sound/soc.h>
223333cb71SPaul Handrigan #include <sound/soc-dapm.h>
233333cb71SPaul Handrigan #include <sound/initval.h>
243333cb71SPaul Handrigan #include <sound/tlv.h>
253333cb71SPaul Handrigan #include <linux/gpio/consumer.h>
263333cb71SPaul Handrigan #include <sound/cs35l33.h>
273333cb71SPaul Handrigan #include <linux/pm_runtime.h>
283333cb71SPaul Handrigan #include <linux/regulator/consumer.h>
293333cb71SPaul Handrigan #include <linux/regulator/machine.h>
303333cb71SPaul Handrigan #include <linux/of.h>
313333cb71SPaul Handrigan #include <linux/of_device.h>
323333cb71SPaul Handrigan #include <linux/of_irq.h>
333333cb71SPaul Handrigan 
343333cb71SPaul Handrigan #include "cs35l33.h"
3577908dbeSCharles Keepax #include "cirrus_legacy.h"
363333cb71SPaul Handrigan 
373333cb71SPaul Handrigan #define CS35L33_BOOT_DELAY	50
383333cb71SPaul Handrigan 
393333cb71SPaul Handrigan struct cs35l33_private {
40cefcf594SKuninori Morimoto 	struct snd_soc_component *component;
413333cb71SPaul Handrigan 	struct cs35l33_pdata pdata;
423333cb71SPaul Handrigan 	struct regmap *regmap;
433333cb71SPaul Handrigan 	struct gpio_desc *reset_gpio;
443333cb71SPaul Handrigan 	bool amp_cal;
453333cb71SPaul Handrigan 	int mclk_int;
463333cb71SPaul Handrigan 	struct regulator_bulk_data core_supplies[2];
473333cb71SPaul Handrigan 	int num_core_supplies;
483333cb71SPaul Handrigan 	bool is_tdm_mode;
493333cb71SPaul Handrigan 	bool enable_soft_ramp;
503333cb71SPaul Handrigan };
513333cb71SPaul Handrigan 
523333cb71SPaul Handrigan static const struct reg_default cs35l33_reg[] = {
533333cb71SPaul Handrigan 	{CS35L33_PWRCTL1, 0x85},
543333cb71SPaul Handrigan 	{CS35L33_PWRCTL2, 0xFE},
553333cb71SPaul Handrigan 	{CS35L33_CLK_CTL, 0x0C},
563333cb71SPaul Handrigan 	{CS35L33_BST_PEAK_CTL, 0x90},
573333cb71SPaul Handrigan 	{CS35L33_PROTECT_CTL, 0x55},
583333cb71SPaul Handrigan 	{CS35L33_BST_CTL1, 0x00},
593333cb71SPaul Handrigan 	{CS35L33_BST_CTL2, 0x01},
603333cb71SPaul Handrigan 	{CS35L33_ADSP_CTL, 0x00},
613333cb71SPaul Handrigan 	{CS35L33_ADC_CTL, 0xC8},
623333cb71SPaul Handrigan 	{CS35L33_DAC_CTL, 0x14},
633333cb71SPaul Handrigan 	{CS35L33_DIG_VOL_CTL, 0x00},
643333cb71SPaul Handrigan 	{CS35L33_CLASSD_CTL, 0x04},
653333cb71SPaul Handrigan 	{CS35L33_AMP_CTL, 0x90},
663333cb71SPaul Handrigan 	{CS35L33_INT_MASK_1, 0xFF},
673333cb71SPaul Handrigan 	{CS35L33_INT_MASK_2, 0xFF},
683333cb71SPaul Handrigan 	{CS35L33_DIAG_LOCK, 0x00},
693333cb71SPaul Handrigan 	{CS35L33_DIAG_CTRL_1, 0x40},
703333cb71SPaul Handrigan 	{CS35L33_DIAG_CTRL_2, 0x00},
713333cb71SPaul Handrigan 	{CS35L33_HG_MEMLDO_CTL, 0x62},
723333cb71SPaul Handrigan 	{CS35L33_HG_REL_RATE, 0x03},
733333cb71SPaul Handrigan 	{CS35L33_LDO_DEL, 0x12},
743333cb71SPaul Handrigan 	{CS35L33_HG_HEAD, 0x0A},
753333cb71SPaul Handrigan 	{CS35L33_HG_EN, 0x05},
763333cb71SPaul Handrigan 	{CS35L33_TX_VMON, 0x00},
773333cb71SPaul Handrigan 	{CS35L33_TX_IMON, 0x03},
783333cb71SPaul Handrigan 	{CS35L33_TX_VPMON, 0x02},
793333cb71SPaul Handrigan 	{CS35L33_TX_VBSTMON, 0x05},
803333cb71SPaul Handrigan 	{CS35L33_TX_FLAG, 0x06},
813333cb71SPaul Handrigan 	{CS35L33_TX_EN1, 0x00},
823333cb71SPaul Handrigan 	{CS35L33_TX_EN2, 0x00},
833333cb71SPaul Handrigan 	{CS35L33_TX_EN3, 0x00},
843333cb71SPaul Handrigan 	{CS35L33_TX_EN4, 0x00},
853333cb71SPaul Handrigan 	{CS35L33_RX_AUD, 0x40},
863333cb71SPaul Handrigan 	{CS35L33_RX_SPLY, 0x03},
873333cb71SPaul Handrigan 	{CS35L33_RX_ALIVE, 0x04},
883333cb71SPaul Handrigan 	{CS35L33_BST_CTL4, 0x63},
893333cb71SPaul Handrigan };
903333cb71SPaul Handrigan 
913333cb71SPaul Handrigan static const struct reg_sequence cs35l33_patch[] = {
923333cb71SPaul Handrigan 	{ 0x00,  0x99, 0 },
933333cb71SPaul Handrigan 	{ 0x59,  0x02, 0 },
943333cb71SPaul Handrigan 	{ 0x52,  0x30, 0 },
953333cb71SPaul Handrigan 	{ 0x39,  0x45, 0 },
963333cb71SPaul Handrigan 	{ 0x57,  0x30, 0 },
973333cb71SPaul Handrigan 	{ 0x2C,  0x68, 0 },
983333cb71SPaul Handrigan 	{ 0x00,  0x00, 0 },
993333cb71SPaul Handrigan };
1003333cb71SPaul Handrigan 
cs35l33_volatile_register(struct device * dev,unsigned int reg)1013333cb71SPaul Handrigan static bool cs35l33_volatile_register(struct device *dev, unsigned int reg)
1023333cb71SPaul Handrigan {
1033333cb71SPaul Handrigan 	switch (reg) {
1043333cb71SPaul Handrigan 	case CS35L33_DEVID_AB:
1053333cb71SPaul Handrigan 	case CS35L33_DEVID_CD:
1063333cb71SPaul Handrigan 	case CS35L33_DEVID_E:
1073333cb71SPaul Handrigan 	case CS35L33_REV_ID:
1083333cb71SPaul Handrigan 	case CS35L33_INT_STATUS_1:
1093333cb71SPaul Handrigan 	case CS35L33_INT_STATUS_2:
1103333cb71SPaul Handrigan 	case CS35L33_HG_STATUS:
1113333cb71SPaul Handrigan 		return true;
1123333cb71SPaul Handrigan 	default:
1133333cb71SPaul Handrigan 		return false;
1143333cb71SPaul Handrigan 	}
1153333cb71SPaul Handrigan }
1163333cb71SPaul Handrigan 
cs35l33_writeable_register(struct device * dev,unsigned int reg)1173333cb71SPaul Handrigan static bool cs35l33_writeable_register(struct device *dev, unsigned int reg)
1183333cb71SPaul Handrigan {
1193333cb71SPaul Handrigan 	switch (reg) {
1203333cb71SPaul Handrigan 	/* these are read only registers */
1213333cb71SPaul Handrigan 	case CS35L33_DEVID_AB:
1223333cb71SPaul Handrigan 	case CS35L33_DEVID_CD:
1233333cb71SPaul Handrigan 	case CS35L33_DEVID_E:
1243333cb71SPaul Handrigan 	case CS35L33_REV_ID:
1253333cb71SPaul Handrigan 	case CS35L33_INT_STATUS_1:
1263333cb71SPaul Handrigan 	case CS35L33_INT_STATUS_2:
1273333cb71SPaul Handrigan 	case CS35L33_HG_STATUS:
1283333cb71SPaul Handrigan 		return false;
1293333cb71SPaul Handrigan 	default:
1303333cb71SPaul Handrigan 		return true;
1313333cb71SPaul Handrigan 	}
1323333cb71SPaul Handrigan }
1333333cb71SPaul Handrigan 
cs35l33_readable_register(struct device * dev,unsigned int reg)1343333cb71SPaul Handrigan static bool cs35l33_readable_register(struct device *dev, unsigned int reg)
1353333cb71SPaul Handrigan {
1363333cb71SPaul Handrigan 	switch (reg) {
1373333cb71SPaul Handrigan 	case CS35L33_DEVID_AB:
1383333cb71SPaul Handrigan 	case CS35L33_DEVID_CD:
1393333cb71SPaul Handrigan 	case CS35L33_DEVID_E:
1403333cb71SPaul Handrigan 	case CS35L33_REV_ID:
1413333cb71SPaul Handrigan 	case CS35L33_PWRCTL1:
1423333cb71SPaul Handrigan 	case CS35L33_PWRCTL2:
1433333cb71SPaul Handrigan 	case CS35L33_CLK_CTL:
1443333cb71SPaul Handrigan 	case CS35L33_BST_PEAK_CTL:
1453333cb71SPaul Handrigan 	case CS35L33_PROTECT_CTL:
1463333cb71SPaul Handrigan 	case CS35L33_BST_CTL1:
1473333cb71SPaul Handrigan 	case CS35L33_BST_CTL2:
1483333cb71SPaul Handrigan 	case CS35L33_ADSP_CTL:
1493333cb71SPaul Handrigan 	case CS35L33_ADC_CTL:
1503333cb71SPaul Handrigan 	case CS35L33_DAC_CTL:
1513333cb71SPaul Handrigan 	case CS35L33_DIG_VOL_CTL:
1523333cb71SPaul Handrigan 	case CS35L33_CLASSD_CTL:
1533333cb71SPaul Handrigan 	case CS35L33_AMP_CTL:
1543333cb71SPaul Handrigan 	case CS35L33_INT_MASK_1:
1553333cb71SPaul Handrigan 	case CS35L33_INT_MASK_2:
1563333cb71SPaul Handrigan 	case CS35L33_INT_STATUS_1:
1573333cb71SPaul Handrigan 	case CS35L33_INT_STATUS_2:
1583333cb71SPaul Handrigan 	case CS35L33_DIAG_LOCK:
1593333cb71SPaul Handrigan 	case CS35L33_DIAG_CTRL_1:
1603333cb71SPaul Handrigan 	case CS35L33_DIAG_CTRL_2:
1613333cb71SPaul Handrigan 	case CS35L33_HG_MEMLDO_CTL:
1623333cb71SPaul Handrigan 	case CS35L33_HG_REL_RATE:
1633333cb71SPaul Handrigan 	case CS35L33_LDO_DEL:
1643333cb71SPaul Handrigan 	case CS35L33_HG_HEAD:
1653333cb71SPaul Handrigan 	case CS35L33_HG_EN:
1663333cb71SPaul Handrigan 	case CS35L33_TX_VMON:
1673333cb71SPaul Handrigan 	case CS35L33_TX_IMON:
1683333cb71SPaul Handrigan 	case CS35L33_TX_VPMON:
1693333cb71SPaul Handrigan 	case CS35L33_TX_VBSTMON:
1703333cb71SPaul Handrigan 	case CS35L33_TX_FLAG:
1713333cb71SPaul Handrigan 	case CS35L33_TX_EN1:
1723333cb71SPaul Handrigan 	case CS35L33_TX_EN2:
1733333cb71SPaul Handrigan 	case CS35L33_TX_EN3:
1743333cb71SPaul Handrigan 	case CS35L33_TX_EN4:
1753333cb71SPaul Handrigan 	case CS35L33_RX_AUD:
1763333cb71SPaul Handrigan 	case CS35L33_RX_SPLY:
1773333cb71SPaul Handrigan 	case CS35L33_RX_ALIVE:
1783333cb71SPaul Handrigan 	case CS35L33_BST_CTL4:
1793333cb71SPaul Handrigan 		return true;
1803333cb71SPaul Handrigan 	default:
1813333cb71SPaul Handrigan 		return false;
1823333cb71SPaul Handrigan 	}
1833333cb71SPaul Handrigan }
1843333cb71SPaul Handrigan 
1853333cb71SPaul Handrigan static DECLARE_TLV_DB_SCALE(classd_ctl_tlv, 900, 100, 0);
1863333cb71SPaul Handrigan static DECLARE_TLV_DB_SCALE(dac_tlv, -10200, 50, 0);
1873333cb71SPaul Handrigan 
1883333cb71SPaul Handrigan static const struct snd_kcontrol_new cs35l33_snd_controls[] = {
1893333cb71SPaul Handrigan 
1903333cb71SPaul Handrigan 	SOC_SINGLE_TLV("SPK Amp Volume", CS35L33_AMP_CTL,
1913333cb71SPaul Handrigan 		       4, 0x09, 0, classd_ctl_tlv),
1923333cb71SPaul Handrigan 	SOC_SINGLE_SX_TLV("DAC Volume", CS35L33_DIG_VOL_CTL,
1933333cb71SPaul Handrigan 			0, 0x34, 0xE4, dac_tlv),
1943333cb71SPaul Handrigan };
1953333cb71SPaul Handrigan 
cs35l33_spkrdrv_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1963333cb71SPaul Handrigan static int cs35l33_spkrdrv_event(struct snd_soc_dapm_widget *w,
1973333cb71SPaul Handrigan 	struct snd_kcontrol *kcontrol, int event)
1983333cb71SPaul Handrigan {
199cefcf594SKuninori Morimoto 	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
200cefcf594SKuninori Morimoto 	struct cs35l33_private *priv = snd_soc_component_get_drvdata(component);
2013333cb71SPaul Handrigan 
2023333cb71SPaul Handrigan 	switch (event) {
2033333cb71SPaul Handrigan 	case SND_SOC_DAPM_POST_PMU:
2043333cb71SPaul Handrigan 		if (!priv->amp_cal) {
2053333cb71SPaul Handrigan 			usleep_range(8000, 9000);
2063333cb71SPaul Handrigan 			priv->amp_cal = true;
2073333cb71SPaul Handrigan 			regmap_update_bits(priv->regmap, CS35L33_CLASSD_CTL,
2083333cb71SPaul Handrigan 				    CS35L33_AMP_CAL, 0);
209cefcf594SKuninori Morimoto 			dev_dbg(component->dev, "Amp calibration done\n");
2103333cb71SPaul Handrigan 		}
211cefcf594SKuninori Morimoto 		dev_dbg(component->dev, "Amp turned on\n");
2123333cb71SPaul Handrigan 		break;
2133333cb71SPaul Handrigan 	case SND_SOC_DAPM_POST_PMD:
214cefcf594SKuninori Morimoto 		dev_dbg(component->dev, "Amp turned off\n");
2153333cb71SPaul Handrigan 		break;
2163333cb71SPaul Handrigan 	default:
217cefcf594SKuninori Morimoto 		dev_err(component->dev, "Invalid event = 0x%x\n", event);
2183333cb71SPaul Handrigan 		break;
2193333cb71SPaul Handrigan 	}
2203333cb71SPaul Handrigan 
2213333cb71SPaul Handrigan 	return 0;
2223333cb71SPaul Handrigan }
2233333cb71SPaul Handrigan 
cs35l33_sdin_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)2243333cb71SPaul Handrigan static int cs35l33_sdin_event(struct snd_soc_dapm_widget *w,
2253333cb71SPaul Handrigan 	struct snd_kcontrol *kcontrol, int event)
2263333cb71SPaul Handrigan {
227cefcf594SKuninori Morimoto 	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
228cefcf594SKuninori Morimoto 	struct cs35l33_private *priv = snd_soc_component_get_drvdata(component);
2293333cb71SPaul Handrigan 	unsigned int val;
2303333cb71SPaul Handrigan 
2313333cb71SPaul Handrigan 	switch (event) {
2323333cb71SPaul Handrigan 	case SND_SOC_DAPM_PRE_PMU:
2333333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_PWRCTL1,
2343333cb71SPaul Handrigan 				    CS35L33_PDN_BST, 0);
2353333cb71SPaul Handrigan 		val = priv->is_tdm_mode ? 0 : CS35L33_PDN_TDM;
2363333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_PWRCTL2,
2373333cb71SPaul Handrigan 				    CS35L33_PDN_TDM, val);
238cefcf594SKuninori Morimoto 		dev_dbg(component->dev, "BST turned on\n");
2393333cb71SPaul Handrigan 		break;
2403333cb71SPaul Handrigan 	case SND_SOC_DAPM_POST_PMU:
241cefcf594SKuninori Morimoto 		dev_dbg(component->dev, "SDIN turned on\n");
2423333cb71SPaul Handrigan 		if (!priv->amp_cal) {
2433333cb71SPaul Handrigan 			regmap_update_bits(priv->regmap, CS35L33_CLASSD_CTL,
2443333cb71SPaul Handrigan 				    CS35L33_AMP_CAL, CS35L33_AMP_CAL);
245cefcf594SKuninori Morimoto 			dev_dbg(component->dev, "Amp calibration started\n");
2463333cb71SPaul Handrigan 			usleep_range(10000, 11000);
2473333cb71SPaul Handrigan 		}
2483333cb71SPaul Handrigan 		break;
2493333cb71SPaul Handrigan 	case SND_SOC_DAPM_POST_PMD:
2503333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_PWRCTL2,
2513333cb71SPaul Handrigan 				    CS35L33_PDN_TDM, CS35L33_PDN_TDM);
2523333cb71SPaul Handrigan 		usleep_range(4000, 4100);
2533333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_PWRCTL1,
2543333cb71SPaul Handrigan 				    CS35L33_PDN_BST, CS35L33_PDN_BST);
255cefcf594SKuninori Morimoto 		dev_dbg(component->dev, "BST and SDIN turned off\n");
2563333cb71SPaul Handrigan 		break;
2573333cb71SPaul Handrigan 	default:
258cefcf594SKuninori Morimoto 		dev_err(component->dev, "Invalid event = 0x%x\n", event);
2593333cb71SPaul Handrigan 
2603333cb71SPaul Handrigan 	}
2613333cb71SPaul Handrigan 
2623333cb71SPaul Handrigan 	return 0;
2633333cb71SPaul Handrigan }
2643333cb71SPaul Handrigan 
cs35l33_sdout_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)2653333cb71SPaul Handrigan static int cs35l33_sdout_event(struct snd_soc_dapm_widget *w,
2663333cb71SPaul Handrigan 	struct snd_kcontrol *kcontrol, int event)
2673333cb71SPaul Handrigan {
268cefcf594SKuninori Morimoto 	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
269cefcf594SKuninori Morimoto 	struct cs35l33_private *priv = snd_soc_component_get_drvdata(component);
2703333cb71SPaul Handrigan 	unsigned int mask = CS35L33_SDOUT_3ST_I2S | CS35L33_PDN_TDM;
2713333cb71SPaul Handrigan 	unsigned int mask2 = CS35L33_SDOUT_3ST_TDM;
2723333cb71SPaul Handrigan 	unsigned int val, val2;
2733333cb71SPaul Handrigan 
2743333cb71SPaul Handrigan 	switch (event) {
2753333cb71SPaul Handrigan 	case SND_SOC_DAPM_PRE_PMU:
2763333cb71SPaul Handrigan 		if (priv->is_tdm_mode) {
2773333cb71SPaul Handrigan 			/* set sdout_3st_i2s and reset pdn_tdm */
2783333cb71SPaul Handrigan 			val = CS35L33_SDOUT_3ST_I2S;
2793333cb71SPaul Handrigan 			/* reset sdout_3st_tdm */
2803333cb71SPaul Handrigan 			val2 = 0;
2813333cb71SPaul Handrigan 		} else {
2823333cb71SPaul Handrigan 			/* reset sdout_3st_i2s and set pdn_tdm */
2833333cb71SPaul Handrigan 			val = CS35L33_PDN_TDM;
2843333cb71SPaul Handrigan 			/* set sdout_3st_tdm */
2853333cb71SPaul Handrigan 			val2 = CS35L33_SDOUT_3ST_TDM;
2863333cb71SPaul Handrigan 		}
287cefcf594SKuninori Morimoto 		dev_dbg(component->dev, "SDOUT turned on\n");
2883333cb71SPaul Handrigan 		break;
2893333cb71SPaul Handrigan 	case SND_SOC_DAPM_PRE_PMD:
2903333cb71SPaul Handrigan 		val = CS35L33_SDOUT_3ST_I2S | CS35L33_PDN_TDM;
2913333cb71SPaul Handrigan 		val2 = CS35L33_SDOUT_3ST_TDM;
292cefcf594SKuninori Morimoto 		dev_dbg(component->dev, "SDOUT turned off\n");
2933333cb71SPaul Handrigan 		break;
2943333cb71SPaul Handrigan 	default:
295cefcf594SKuninori Morimoto 		dev_err(component->dev, "Invalid event = 0x%x\n", event);
2963333cb71SPaul Handrigan 		return 0;
2973333cb71SPaul Handrigan 	}
2983333cb71SPaul Handrigan 
2993333cb71SPaul Handrigan 	regmap_update_bits(priv->regmap, CS35L33_PWRCTL2,
3003333cb71SPaul Handrigan 		mask, val);
3013333cb71SPaul Handrigan 	regmap_update_bits(priv->regmap, CS35L33_CLK_CTL,
3023333cb71SPaul Handrigan 		mask2, val2);
3033333cb71SPaul Handrigan 
3043333cb71SPaul Handrigan 	return 0;
3053333cb71SPaul Handrigan }
3063333cb71SPaul Handrigan 
3073333cb71SPaul Handrigan static const struct snd_soc_dapm_widget cs35l33_dapm_widgets[] = {
3083333cb71SPaul Handrigan 
3093333cb71SPaul Handrigan 	SND_SOC_DAPM_OUTPUT("SPK"),
3103333cb71SPaul Handrigan 	SND_SOC_DAPM_OUT_DRV_E("SPKDRV", CS35L33_PWRCTL1, 7, 1, NULL, 0,
3113333cb71SPaul Handrigan 		cs35l33_spkrdrv_event,
3123333cb71SPaul Handrigan 		SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
3133333cb71SPaul Handrigan 	SND_SOC_DAPM_AIF_IN_E("SDIN", NULL, 0, CS35L33_PWRCTL2,
3143333cb71SPaul Handrigan 		2, 1, cs35l33_sdin_event, SND_SOC_DAPM_PRE_PMU |
3153333cb71SPaul Handrigan 		SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
3163333cb71SPaul Handrigan 
3173333cb71SPaul Handrigan 	SND_SOC_DAPM_INPUT("MON"),
3183333cb71SPaul Handrigan 
3193333cb71SPaul Handrigan 	SND_SOC_DAPM_ADC("VMON", NULL,
3203333cb71SPaul Handrigan 		CS35L33_PWRCTL2, CS35L33_PDN_VMON_SHIFT, 1),
3213333cb71SPaul Handrigan 	SND_SOC_DAPM_ADC("IMON", NULL,
3223333cb71SPaul Handrigan 		CS35L33_PWRCTL2, CS35L33_PDN_IMON_SHIFT, 1),
3233333cb71SPaul Handrigan 	SND_SOC_DAPM_ADC("VPMON", NULL,
3243333cb71SPaul Handrigan 		CS35L33_PWRCTL2, CS35L33_PDN_VPMON_SHIFT, 1),
3253333cb71SPaul Handrigan 	SND_SOC_DAPM_ADC("VBSTMON", NULL,
3263333cb71SPaul Handrigan 		CS35L33_PWRCTL2, CS35L33_PDN_VBSTMON_SHIFT, 1),
3273333cb71SPaul Handrigan 
3283333cb71SPaul Handrigan 	SND_SOC_DAPM_AIF_OUT_E("SDOUT", NULL, 0, SND_SOC_NOPM, 0, 0,
3293333cb71SPaul Handrigan 		cs35l33_sdout_event, SND_SOC_DAPM_PRE_PMU |
3303333cb71SPaul Handrigan 		SND_SOC_DAPM_PRE_PMD),
3313333cb71SPaul Handrigan };
3323333cb71SPaul Handrigan 
3333333cb71SPaul Handrigan static const struct snd_soc_dapm_route cs35l33_audio_map[] = {
3343333cb71SPaul Handrigan 	{"SDIN", NULL, "CS35L33 Playback"},
3353333cb71SPaul Handrigan 	{"SPKDRV", NULL, "SDIN"},
3363333cb71SPaul Handrigan 	{"SPK", NULL, "SPKDRV"},
3373333cb71SPaul Handrigan 
3383333cb71SPaul Handrigan 	{"VMON", NULL, "MON"},
3393333cb71SPaul Handrigan 	{"IMON", NULL, "MON"},
3403333cb71SPaul Handrigan 
3413333cb71SPaul Handrigan 	{"SDOUT", NULL, "VMON"},
3423333cb71SPaul Handrigan 	{"SDOUT", NULL, "IMON"},
3433333cb71SPaul Handrigan 	{"CS35L33 Capture", NULL, "SDOUT"},
3443333cb71SPaul Handrigan };
3453333cb71SPaul Handrigan 
3463333cb71SPaul Handrigan static const struct snd_soc_dapm_route cs35l33_vphg_auto_route[] = {
3473333cb71SPaul Handrigan 	{"SPKDRV", NULL, "VPMON"},
3483333cb71SPaul Handrigan 	{"VPMON", NULL, "CS35L33 Playback"},
3493333cb71SPaul Handrigan };
3503333cb71SPaul Handrigan 
3513333cb71SPaul Handrigan static const struct snd_soc_dapm_route cs35l33_vp_vbst_mon_route[] = {
3523333cb71SPaul Handrigan 	{"SDOUT", NULL, "VPMON"},
3533333cb71SPaul Handrigan 	{"VPMON", NULL, "MON"},
3543333cb71SPaul Handrigan 	{"SDOUT", NULL, "VBSTMON"},
3553333cb71SPaul Handrigan 	{"VBSTMON", NULL, "MON"},
3563333cb71SPaul Handrigan };
3573333cb71SPaul Handrigan 
cs35l33_set_bias_level(struct snd_soc_component * component,enum snd_soc_bias_level level)358cefcf594SKuninori Morimoto static int cs35l33_set_bias_level(struct snd_soc_component *component,
3593333cb71SPaul Handrigan 				  enum snd_soc_bias_level level)
3603333cb71SPaul Handrigan {
3613333cb71SPaul Handrigan 	unsigned int val;
362cefcf594SKuninori Morimoto 	struct cs35l33_private *priv = snd_soc_component_get_drvdata(component);
3633333cb71SPaul Handrigan 
3643333cb71SPaul Handrigan 	switch (level) {
3653333cb71SPaul Handrigan 	case SND_SOC_BIAS_ON:
3663333cb71SPaul Handrigan 		break;
3673333cb71SPaul Handrigan 	case SND_SOC_BIAS_PREPARE:
3683333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_PWRCTL1,
3693333cb71SPaul Handrigan 				    CS35L33_PDN_ALL, 0);
3703333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_CLK_CTL,
3713333cb71SPaul Handrigan 				    CS35L33_MCLKDIS, 0);
3723333cb71SPaul Handrigan 		break;
3733333cb71SPaul Handrigan 	case SND_SOC_BIAS_STANDBY:
3743333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_PWRCTL1,
3753333cb71SPaul Handrigan 				    CS35L33_PDN_ALL, CS35L33_PDN_ALL);
3763333cb71SPaul Handrigan 		regmap_read(priv->regmap, CS35L33_INT_STATUS_2, &val);
3773333cb71SPaul Handrigan 		usleep_range(1000, 1100);
3783333cb71SPaul Handrigan 		if (val & CS35L33_PDN_DONE)
3793333cb71SPaul Handrigan 			regmap_update_bits(priv->regmap, CS35L33_CLK_CTL,
3803333cb71SPaul Handrigan 					    CS35L33_MCLKDIS, CS35L33_MCLKDIS);
3813333cb71SPaul Handrigan 		break;
3823333cb71SPaul Handrigan 	case SND_SOC_BIAS_OFF:
3833333cb71SPaul Handrigan 		break;
3843333cb71SPaul Handrigan 	default:
3853333cb71SPaul Handrigan 		return -EINVAL;
3863333cb71SPaul Handrigan 	}
3873333cb71SPaul Handrigan 
3883333cb71SPaul Handrigan 	return 0;
3893333cb71SPaul Handrigan }
3903333cb71SPaul Handrigan 
3913333cb71SPaul Handrigan struct cs35l33_mclk_div {
3923333cb71SPaul Handrigan 	int mclk;
3933333cb71SPaul Handrigan 	int srate;
3943333cb71SPaul Handrigan 	u8 adsp_rate;
3953333cb71SPaul Handrigan 	u8 int_fs_ratio;
3963333cb71SPaul Handrigan };
3973333cb71SPaul Handrigan 
3983333cb71SPaul Handrigan static const struct cs35l33_mclk_div cs35l33_mclk_coeffs[] = {
3993333cb71SPaul Handrigan 	/* MCLK, Sample Rate, adsp_rate, int_fs_ratio */
4003333cb71SPaul Handrigan 	{5644800, 11025, 0x4, CS35L33_INT_FS_RATE},
4013333cb71SPaul Handrigan 	{5644800, 22050, 0x8, CS35L33_INT_FS_RATE},
4023333cb71SPaul Handrigan 	{5644800, 44100, 0xC, CS35L33_INT_FS_RATE},
4033333cb71SPaul Handrigan 
4043333cb71SPaul Handrigan 	{6000000,  8000, 0x1, 0},
4053333cb71SPaul Handrigan 	{6000000, 11025, 0x2, 0},
4063333cb71SPaul Handrigan 	{6000000, 11029, 0x3, 0},
4073333cb71SPaul Handrigan 	{6000000, 12000, 0x4, 0},
4083333cb71SPaul Handrigan 	{6000000, 16000, 0x5, 0},
4093333cb71SPaul Handrigan 	{6000000, 22050, 0x6, 0},
4103333cb71SPaul Handrigan 	{6000000, 22059, 0x7, 0},
4113333cb71SPaul Handrigan 	{6000000, 24000, 0x8, 0},
4123333cb71SPaul Handrigan 	{6000000, 32000, 0x9, 0},
4133333cb71SPaul Handrigan 	{6000000, 44100, 0xA, 0},
4143333cb71SPaul Handrigan 	{6000000, 44118, 0xB, 0},
4153333cb71SPaul Handrigan 	{6000000, 48000, 0xC, 0},
4163333cb71SPaul Handrigan 
4173333cb71SPaul Handrigan 	{6144000,  8000, 0x1, CS35L33_INT_FS_RATE},
4183333cb71SPaul Handrigan 	{6144000, 12000, 0x4, CS35L33_INT_FS_RATE},
4193333cb71SPaul Handrigan 	{6144000, 16000, 0x5, CS35L33_INT_FS_RATE},
4203333cb71SPaul Handrigan 	{6144000, 24000, 0x8, CS35L33_INT_FS_RATE},
4213333cb71SPaul Handrigan 	{6144000, 32000, 0x9, CS35L33_INT_FS_RATE},
4223333cb71SPaul Handrigan 	{6144000, 48000, 0xC, CS35L33_INT_FS_RATE},
4233333cb71SPaul Handrigan };
4243333cb71SPaul Handrigan 
cs35l33_get_mclk_coeff(int mclk,int srate)4253333cb71SPaul Handrigan static int cs35l33_get_mclk_coeff(int mclk, int srate)
4263333cb71SPaul Handrigan {
4273333cb71SPaul Handrigan 	int i;
4283333cb71SPaul Handrigan 
4293333cb71SPaul Handrigan 	for (i = 0; i < ARRAY_SIZE(cs35l33_mclk_coeffs); i++) {
4303333cb71SPaul Handrigan 		if (cs35l33_mclk_coeffs[i].mclk == mclk &&
4313333cb71SPaul Handrigan 			cs35l33_mclk_coeffs[i].srate == srate)
4323333cb71SPaul Handrigan 			return i;
4333333cb71SPaul Handrigan 	}
4343333cb71SPaul Handrigan 	return -EINVAL;
4353333cb71SPaul Handrigan }
4363333cb71SPaul Handrigan 
cs35l33_set_dai_fmt(struct snd_soc_dai * codec_dai,unsigned int fmt)4373333cb71SPaul Handrigan static int cs35l33_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
4383333cb71SPaul Handrigan {
439cefcf594SKuninori Morimoto 	struct snd_soc_component *component = codec_dai->component;
440cefcf594SKuninori Morimoto 	struct cs35l33_private *priv = snd_soc_component_get_drvdata(component);
4413333cb71SPaul Handrigan 
4423333cb71SPaul Handrigan 	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
4433333cb71SPaul Handrigan 	case SND_SOC_DAIFMT_CBM_CFM:
4443333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_ADSP_CTL,
4453333cb71SPaul Handrigan 			CS35L33_MS_MASK, CS35L33_MS_MASK);
446cefcf594SKuninori Morimoto 		dev_dbg(component->dev, "Audio port in master mode\n");
4473333cb71SPaul Handrigan 		break;
4483333cb71SPaul Handrigan 	case SND_SOC_DAIFMT_CBS_CFS:
4493333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_ADSP_CTL,
4503333cb71SPaul Handrigan 			CS35L33_MS_MASK, 0);
451cefcf594SKuninori Morimoto 		dev_dbg(component->dev, "Audio port in slave mode\n");
4523333cb71SPaul Handrigan 		break;
4533333cb71SPaul Handrigan 	default:
4543333cb71SPaul Handrigan 		return -EINVAL;
4553333cb71SPaul Handrigan 	}
4563333cb71SPaul Handrigan 
4573333cb71SPaul Handrigan 	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
4583333cb71SPaul Handrigan 	case SND_SOC_DAIFMT_DSP_A:
4593333cb71SPaul Handrigan 		/*
4603333cb71SPaul Handrigan 		 * tdm mode in cs35l33 resembles dsp-a mode very
4613333cb71SPaul Handrigan 		 * closely, it is dsp-a with fsync shifted left by half bclk
4623333cb71SPaul Handrigan 		 */
4633333cb71SPaul Handrigan 		priv->is_tdm_mode = true;
464cefcf594SKuninori Morimoto 		dev_dbg(component->dev, "Audio port in TDM mode\n");
4653333cb71SPaul Handrigan 		break;
4663333cb71SPaul Handrigan 	case SND_SOC_DAIFMT_I2S:
4673333cb71SPaul Handrigan 		priv->is_tdm_mode = false;
468cefcf594SKuninori Morimoto 		dev_dbg(component->dev, "Audio port in I2S mode\n");
4693333cb71SPaul Handrigan 		break;
4703333cb71SPaul Handrigan 	default:
4713333cb71SPaul Handrigan 		return -EINVAL;
4723333cb71SPaul Handrigan 	}
4733333cb71SPaul Handrigan 
4743333cb71SPaul Handrigan 	return 0;
4753333cb71SPaul Handrigan }
4763333cb71SPaul Handrigan 
cs35l33_pcm_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params,struct snd_soc_dai * dai)4773333cb71SPaul Handrigan static int cs35l33_pcm_hw_params(struct snd_pcm_substream *substream,
4783333cb71SPaul Handrigan 				 struct snd_pcm_hw_params *params,
4793333cb71SPaul Handrigan 				 struct snd_soc_dai *dai)
4803333cb71SPaul Handrigan {
481cefcf594SKuninori Morimoto 	struct snd_soc_component *component = dai->component;
482cefcf594SKuninori Morimoto 	struct cs35l33_private *priv = snd_soc_component_get_drvdata(component);
4833333cb71SPaul Handrigan 	int sample_size = params_width(params);
4843333cb71SPaul Handrigan 	int coeff = cs35l33_get_mclk_coeff(priv->mclk_int, params_rate(params));
4853333cb71SPaul Handrigan 
4863333cb71SPaul Handrigan 	if (coeff < 0)
4873333cb71SPaul Handrigan 		return coeff;
4883333cb71SPaul Handrigan 
4893333cb71SPaul Handrigan 	regmap_update_bits(priv->regmap, CS35L33_CLK_CTL,
4903333cb71SPaul Handrigan 		CS35L33_ADSP_FS | CS35L33_INT_FS_RATE,
4913333cb71SPaul Handrigan 		cs35l33_mclk_coeffs[coeff].int_fs_ratio
4923333cb71SPaul Handrigan 		| cs35l33_mclk_coeffs[coeff].adsp_rate);
4933333cb71SPaul Handrigan 
4943333cb71SPaul Handrigan 	if (priv->is_tdm_mode) {
4953333cb71SPaul Handrigan 		sample_size = (sample_size / 8) - 1;
4963333cb71SPaul Handrigan 		if (sample_size > 2)
4973333cb71SPaul Handrigan 			sample_size = 2;
4983333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_RX_AUD,
4993333cb71SPaul Handrigan 			CS35L33_AUDIN_RX_DEPTH,
5003333cb71SPaul Handrigan 			sample_size << CS35L33_AUDIN_RX_DEPTH_SHIFT);
5013333cb71SPaul Handrigan 	}
5023333cb71SPaul Handrigan 
503cefcf594SKuninori Morimoto 	dev_dbg(component->dev, "sample rate=%d, bits per sample=%d\n",
5043333cb71SPaul Handrigan 		params_rate(params), params_width(params));
5053333cb71SPaul Handrigan 
5063333cb71SPaul Handrigan 	return 0;
5073333cb71SPaul Handrigan }
5083333cb71SPaul Handrigan 
5093333cb71SPaul Handrigan static const unsigned int cs35l33_src_rates[] = {
5103333cb71SPaul Handrigan 	8000, 11025, 11029, 12000, 16000, 22050,
5113333cb71SPaul Handrigan 	22059, 24000, 32000, 44100, 44118, 48000
5123333cb71SPaul Handrigan };
5133333cb71SPaul Handrigan 
5143333cb71SPaul Handrigan static const struct snd_pcm_hw_constraint_list cs35l33_constraints = {
5153333cb71SPaul Handrigan 	.count  = ARRAY_SIZE(cs35l33_src_rates),
5163333cb71SPaul Handrigan 	.list   = cs35l33_src_rates,
5173333cb71SPaul Handrigan };
5183333cb71SPaul Handrigan 
cs35l33_pcm_startup(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)5193333cb71SPaul Handrigan static int cs35l33_pcm_startup(struct snd_pcm_substream *substream,
5203333cb71SPaul Handrigan 			       struct snd_soc_dai *dai)
5213333cb71SPaul Handrigan {
5223333cb71SPaul Handrigan 	snd_pcm_hw_constraint_list(substream->runtime, 0,
5233333cb71SPaul Handrigan 					SNDRV_PCM_HW_PARAM_RATE,
5243333cb71SPaul Handrigan 					&cs35l33_constraints);
5253333cb71SPaul Handrigan 	return 0;
5263333cb71SPaul Handrigan }
5273333cb71SPaul Handrigan 
cs35l33_set_tristate(struct snd_soc_dai * dai,int tristate)5283333cb71SPaul Handrigan static int cs35l33_set_tristate(struct snd_soc_dai *dai, int tristate)
5293333cb71SPaul Handrigan {
530cefcf594SKuninori Morimoto 	struct snd_soc_component *component = dai->component;
531cefcf594SKuninori Morimoto 	struct cs35l33_private *priv = snd_soc_component_get_drvdata(component);
5323333cb71SPaul Handrigan 
5333333cb71SPaul Handrigan 	if (tristate) {
5343333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_PWRCTL2,
5353333cb71SPaul Handrigan 			CS35L33_SDOUT_3ST_I2S, CS35L33_SDOUT_3ST_I2S);
5363333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_CLK_CTL,
5373333cb71SPaul Handrigan 			CS35L33_SDOUT_3ST_TDM, CS35L33_SDOUT_3ST_TDM);
5383333cb71SPaul Handrigan 	} else {
5393333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_PWRCTL2,
5403333cb71SPaul Handrigan 			CS35L33_SDOUT_3ST_I2S, 0);
5413333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_CLK_CTL,
5423333cb71SPaul Handrigan 			CS35L33_SDOUT_3ST_TDM, 0);
5433333cb71SPaul Handrigan 	}
5443333cb71SPaul Handrigan 
5453333cb71SPaul Handrigan 	return 0;
5463333cb71SPaul Handrigan }
5473333cb71SPaul Handrigan 
cs35l33_set_tdm_slot(struct snd_soc_dai * dai,unsigned int tx_mask,unsigned int rx_mask,int slots,int slot_width)5483333cb71SPaul Handrigan static int cs35l33_set_tdm_slot(struct snd_soc_dai *dai, unsigned int tx_mask,
5493333cb71SPaul Handrigan 				unsigned int rx_mask, int slots, int slot_width)
5503333cb71SPaul Handrigan {
551cefcf594SKuninori Morimoto 	struct snd_soc_component *component = dai->component;
552cefcf594SKuninori Morimoto 	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
553cefcf594SKuninori Morimoto 	struct cs35l33_private *priv = snd_soc_component_get_drvdata(component);
5543333cb71SPaul Handrigan 	unsigned int reg, bit_pos, i;
5553333cb71SPaul Handrigan 	int slot, slot_num;
5563333cb71SPaul Handrigan 
5573333cb71SPaul Handrigan 	if (slot_width != 8)
5583333cb71SPaul Handrigan 		return -EINVAL;
5593333cb71SPaul Handrigan 
5603333cb71SPaul Handrigan 	/* scan rx_mask for aud slot */
5613333cb71SPaul Handrigan 	slot = ffs(rx_mask) - 1;
5623333cb71SPaul Handrigan 	if (slot >= 0) {
5633333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_RX_AUD,
5643333cb71SPaul Handrigan 			CS35L33_X_LOC, slot);
565cefcf594SKuninori Morimoto 		dev_dbg(component->dev, "Audio starts from slots %d", slot);
5663333cb71SPaul Handrigan 	}
5673333cb71SPaul Handrigan 
5683333cb71SPaul Handrigan 	/*
5693333cb71SPaul Handrigan 	 * scan tx_mask: vmon(2 slots); imon (2 slots);
5703333cb71SPaul Handrigan 	 * vpmon (1 slot) vbstmon (1 slot)
5713333cb71SPaul Handrigan 	 */
5723333cb71SPaul Handrigan 	slot = ffs(tx_mask) - 1;
5733333cb71SPaul Handrigan 	slot_num = 0;
5743333cb71SPaul Handrigan 
5753333cb71SPaul Handrigan 	for (i = 0; i < 2 ; i++) {
5763333cb71SPaul Handrigan 		/* disable vpmon/vbstmon: enable later if set in tx_mask */
5773333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_TX_VPMON + i,
5783333cb71SPaul Handrigan 			CS35L33_X_STATE | CS35L33_X_LOC, CS35L33_X_STATE
5793333cb71SPaul Handrigan 			| CS35L33_X_LOC);
5803333cb71SPaul Handrigan 	}
5813333cb71SPaul Handrigan 
5823333cb71SPaul Handrigan 	/* disconnect {vp,vbst}_mon routes: eanble later if set in tx_mask*/
5833333cb71SPaul Handrigan 	snd_soc_dapm_del_routes(dapm, cs35l33_vp_vbst_mon_route,
5843333cb71SPaul Handrigan 		ARRAY_SIZE(cs35l33_vp_vbst_mon_route));
5853333cb71SPaul Handrigan 
5863333cb71SPaul Handrigan 	while (slot >= 0) {
5873333cb71SPaul Handrigan 		/* configure VMON_TX_LOC */
5883333cb71SPaul Handrigan 		if (slot_num == 0) {
5893333cb71SPaul Handrigan 			regmap_update_bits(priv->regmap, CS35L33_TX_VMON,
5903333cb71SPaul Handrigan 				CS35L33_X_STATE | CS35L33_X_LOC, slot);
591cefcf594SKuninori Morimoto 			dev_dbg(component->dev, "VMON enabled in slots %d-%d",
5923333cb71SPaul Handrigan 				slot, slot + 1);
5933333cb71SPaul Handrigan 		}
5943333cb71SPaul Handrigan 
5953333cb71SPaul Handrigan 		/* configure IMON_TX_LOC */
5963333cb71SPaul Handrigan 		if (slot_num == 3) {
5973333cb71SPaul Handrigan 			regmap_update_bits(priv->regmap, CS35L33_TX_IMON,
5983333cb71SPaul Handrigan 				CS35L33_X_STATE | CS35L33_X_LOC, slot);
599cefcf594SKuninori Morimoto 			dev_dbg(component->dev, "IMON enabled in slots %d-%d",
6003333cb71SPaul Handrigan 				slot, slot + 1);
6013333cb71SPaul Handrigan 		}
6023333cb71SPaul Handrigan 
6033333cb71SPaul Handrigan 		/* configure VPMON_TX_LOC */
6043333cb71SPaul Handrigan 		if (slot_num == 4) {
6053333cb71SPaul Handrigan 			regmap_update_bits(priv->regmap, CS35L33_TX_VPMON,
6063333cb71SPaul Handrigan 				CS35L33_X_STATE | CS35L33_X_LOC, slot);
6073333cb71SPaul Handrigan 			snd_soc_dapm_add_routes(dapm,
6083333cb71SPaul Handrigan 				&cs35l33_vp_vbst_mon_route[0], 2);
609cefcf594SKuninori Morimoto 			dev_dbg(component->dev, "VPMON enabled in slots %d", slot);
6103333cb71SPaul Handrigan 		}
6113333cb71SPaul Handrigan 
6123333cb71SPaul Handrigan 		/* configure VBSTMON_TX_LOC */
6133333cb71SPaul Handrigan 		if (slot_num == 5) {
6143333cb71SPaul Handrigan 			regmap_update_bits(priv->regmap, CS35L33_TX_VBSTMON,
6153333cb71SPaul Handrigan 				CS35L33_X_STATE | CS35L33_X_LOC, slot);
6163333cb71SPaul Handrigan 			snd_soc_dapm_add_routes(dapm,
6173333cb71SPaul Handrigan 				&cs35l33_vp_vbst_mon_route[2], 2);
618cefcf594SKuninori Morimoto 			dev_dbg(component->dev,
6193333cb71SPaul Handrigan 				"VBSTMON enabled in slots %d", slot);
6203333cb71SPaul Handrigan 		}
6213333cb71SPaul Handrigan 
6223333cb71SPaul Handrigan 		/* Enable the relevant tx slot */
6233333cb71SPaul Handrigan 		reg = CS35L33_TX_EN4 - (slot/8);
6243333cb71SPaul Handrigan 		bit_pos = slot - ((slot / 8) * (8));
6253333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, reg,
6263333cb71SPaul Handrigan 			1 << bit_pos, 1 << bit_pos);
6273333cb71SPaul Handrigan 
6283333cb71SPaul Handrigan 		tx_mask &= ~(1 << slot);
6293333cb71SPaul Handrigan 		slot = ffs(tx_mask) - 1;
6303333cb71SPaul Handrigan 		slot_num++;
6313333cb71SPaul Handrigan 	}
6323333cb71SPaul Handrigan 
6333333cb71SPaul Handrigan 	return 0;
6343333cb71SPaul Handrigan }
6353333cb71SPaul Handrigan 
cs35l33_component_set_sysclk(struct snd_soc_component * component,int clk_id,int source,unsigned int freq,int dir)636cefcf594SKuninori Morimoto static int cs35l33_component_set_sysclk(struct snd_soc_component *component,
6373333cb71SPaul Handrigan 		int clk_id, int source, unsigned int freq, int dir)
6383333cb71SPaul Handrigan {
639cefcf594SKuninori Morimoto 	struct cs35l33_private *cs35l33 = snd_soc_component_get_drvdata(component);
6403333cb71SPaul Handrigan 
6413333cb71SPaul Handrigan 	switch (freq) {
6423333cb71SPaul Handrigan 	case CS35L33_MCLK_5644:
6433333cb71SPaul Handrigan 	case CS35L33_MCLK_6:
6443333cb71SPaul Handrigan 	case CS35L33_MCLK_6144:
6453333cb71SPaul Handrigan 		regmap_update_bits(cs35l33->regmap, CS35L33_CLK_CTL,
6463333cb71SPaul Handrigan 			CS35L33_MCLKDIV2, 0);
6473333cb71SPaul Handrigan 		cs35l33->mclk_int = freq;
6483333cb71SPaul Handrigan 		break;
6493333cb71SPaul Handrigan 	case CS35L33_MCLK_11289:
6503333cb71SPaul Handrigan 	case CS35L33_MCLK_12:
6513333cb71SPaul Handrigan 	case CS35L33_MCLK_12288:
6523333cb71SPaul Handrigan 		regmap_update_bits(cs35l33->regmap, CS35L33_CLK_CTL,
6533333cb71SPaul Handrigan 			CS35L33_MCLKDIV2, CS35L33_MCLKDIV2);
6543333cb71SPaul Handrigan 		cs35l33->mclk_int = freq/2;
6553333cb71SPaul Handrigan 		break;
6563333cb71SPaul Handrigan 	default:
6573333cb71SPaul Handrigan 		cs35l33->mclk_int = 0;
6583333cb71SPaul Handrigan 		return -EINVAL;
6593333cb71SPaul Handrigan 	}
6603333cb71SPaul Handrigan 
661cefcf594SKuninori Morimoto 	dev_dbg(component->dev, "external mclk freq=%d, internal mclk freq=%d\n",
6623333cb71SPaul Handrigan 		freq, cs35l33->mclk_int);
6633333cb71SPaul Handrigan 
6643333cb71SPaul Handrigan 	return 0;
6653333cb71SPaul Handrigan }
6663333cb71SPaul Handrigan 
6673333cb71SPaul Handrigan static const struct snd_soc_dai_ops cs35l33_ops = {
6683333cb71SPaul Handrigan 	.startup = cs35l33_pcm_startup,
6693333cb71SPaul Handrigan 	.set_tristate = cs35l33_set_tristate,
6703333cb71SPaul Handrigan 	.set_fmt = cs35l33_set_dai_fmt,
6713333cb71SPaul Handrigan 	.hw_params = cs35l33_pcm_hw_params,
6723333cb71SPaul Handrigan 	.set_tdm_slot = cs35l33_set_tdm_slot,
6733333cb71SPaul Handrigan };
6743333cb71SPaul Handrigan 
6753333cb71SPaul Handrigan static struct snd_soc_dai_driver cs35l33_dai = {
6763333cb71SPaul Handrigan 		.name = "cs35l33-dai",
6773333cb71SPaul Handrigan 		.id = 0,
6783333cb71SPaul Handrigan 		.playback = {
6793333cb71SPaul Handrigan 			.stream_name = "CS35L33 Playback",
6803333cb71SPaul Handrigan 			.channels_min = 1,
6813333cb71SPaul Handrigan 			.channels_max = 1,
6823333cb71SPaul Handrigan 			.rates = CS35L33_RATES,
6833333cb71SPaul Handrigan 			.formats = CS35L33_FORMATS,
6843333cb71SPaul Handrigan 		},
6853333cb71SPaul Handrigan 		.capture = {
6863333cb71SPaul Handrigan 			.stream_name = "CS35L33 Capture",
6873333cb71SPaul Handrigan 			.channels_min = 2,
6883333cb71SPaul Handrigan 			.channels_max = 2,
6893333cb71SPaul Handrigan 			.rates = CS35L33_RATES,
6903333cb71SPaul Handrigan 			.formats = CS35L33_FORMATS,
6913333cb71SPaul Handrigan 		},
6923333cb71SPaul Handrigan 		.ops = &cs35l33_ops,
693260b668cSKuninori Morimoto 		.symmetric_rate = 1,
6943333cb71SPaul Handrigan };
6953333cb71SPaul Handrigan 
cs35l33_set_hg_data(struct snd_soc_component * component,struct cs35l33_pdata * pdata)696cefcf594SKuninori Morimoto static int cs35l33_set_hg_data(struct snd_soc_component *component,
6973333cb71SPaul Handrigan 			       struct cs35l33_pdata *pdata)
6983333cb71SPaul Handrigan {
6993333cb71SPaul Handrigan 	struct cs35l33_hg *hg_config = &pdata->hg_config;
700cefcf594SKuninori Morimoto 	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
701cefcf594SKuninori Morimoto 	struct cs35l33_private *priv = snd_soc_component_get_drvdata(component);
7023333cb71SPaul Handrigan 
7033333cb71SPaul Handrigan 	if (hg_config->enable_hg_algo) {
7043333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_HG_MEMLDO_CTL,
7053333cb71SPaul Handrigan 			CS35L33_MEM_DEPTH_MASK,
7063333cb71SPaul Handrigan 			hg_config->mem_depth << CS35L33_MEM_DEPTH_SHIFT);
7073333cb71SPaul Handrigan 		regmap_write(priv->regmap, CS35L33_HG_REL_RATE,
7083333cb71SPaul Handrigan 			hg_config->release_rate);
7093333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_HG_HEAD,
7103333cb71SPaul Handrigan 			CS35L33_HD_RM_MASK,
7113333cb71SPaul Handrigan 			hg_config->hd_rm << CS35L33_HD_RM_SHIFT);
7123333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_HG_MEMLDO_CTL,
7133333cb71SPaul Handrigan 			CS35L33_LDO_THLD_MASK,
7143333cb71SPaul Handrigan 			hg_config->ldo_thld << CS35L33_LDO_THLD_SHIFT);
7153333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_HG_MEMLDO_CTL,
7163333cb71SPaul Handrigan 			CS35L33_LDO_DISABLE_MASK,
7173333cb71SPaul Handrigan 			hg_config->ldo_path_disable <<
7183333cb71SPaul Handrigan 				CS35L33_LDO_DISABLE_SHIFT);
7193333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_LDO_DEL,
7203333cb71SPaul Handrigan 			CS35L33_LDO_ENTRY_DELAY_MASK,
7213333cb71SPaul Handrigan 			hg_config->ldo_entry_delay <<
7223333cb71SPaul Handrigan 				CS35L33_LDO_ENTRY_DELAY_SHIFT);
7233333cb71SPaul Handrigan 		if (hg_config->vp_hg_auto) {
7243333cb71SPaul Handrigan 			regmap_update_bits(priv->regmap, CS35L33_HG_EN,
7253333cb71SPaul Handrigan 				CS35L33_VP_HG_AUTO_MASK,
7263333cb71SPaul Handrigan 				CS35L33_VP_HG_AUTO_MASK);
7273333cb71SPaul Handrigan 			snd_soc_dapm_add_routes(dapm, cs35l33_vphg_auto_route,
7283333cb71SPaul Handrigan 				ARRAY_SIZE(cs35l33_vphg_auto_route));
7293333cb71SPaul Handrigan 		}
7303333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_HG_EN,
7313333cb71SPaul Handrigan 			CS35L33_VP_HG_MASK,
7323333cb71SPaul Handrigan 			hg_config->vp_hg << CS35L33_VP_HG_SHIFT);
7333333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_LDO_DEL,
7343333cb71SPaul Handrigan 			CS35L33_VP_HG_RATE_MASK,
7353333cb71SPaul Handrigan 			hg_config->vp_hg_rate << CS35L33_VP_HG_RATE_SHIFT);
7363333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_LDO_DEL,
7373333cb71SPaul Handrigan 			CS35L33_VP_HG_VA_MASK,
7383333cb71SPaul Handrigan 			hg_config->vp_hg_va << CS35L33_VP_HG_VA_SHIFT);
7393333cb71SPaul Handrigan 		regmap_update_bits(priv->regmap, CS35L33_HG_EN,
7403333cb71SPaul Handrigan 			CS35L33_CLASS_HG_EN_MASK, CS35L33_CLASS_HG_EN_MASK);
7413333cb71SPaul Handrigan 	}
7423333cb71SPaul Handrigan 	return 0;
7433333cb71SPaul Handrigan }
7443333cb71SPaul Handrigan 
cs35l33_set_bst_ipk(struct snd_soc_component * component,unsigned int bst)745cefcf594SKuninori Morimoto static int cs35l33_set_bst_ipk(struct snd_soc_component *component, unsigned int bst)
7463333cb71SPaul Handrigan {
747cefcf594SKuninori Morimoto 	struct cs35l33_private *cs35l33 = snd_soc_component_get_drvdata(component);
7483333cb71SPaul Handrigan 	int ret = 0, steps = 0;
7493333cb71SPaul Handrigan 
7503333cb71SPaul Handrigan 	/* Boost current in uA */
7513333cb71SPaul Handrigan 	if (bst > 3600000 || bst < 1850000) {
752cefcf594SKuninori Morimoto 		dev_err(component->dev, "Invalid boost current %d\n", bst);
7533333cb71SPaul Handrigan 		ret = -EINVAL;
7543333cb71SPaul Handrigan 		goto err;
7553333cb71SPaul Handrigan 	}
7563333cb71SPaul Handrigan 
7573333cb71SPaul Handrigan 	if (bst % 15625) {
758cefcf594SKuninori Morimoto 		dev_err(component->dev, "Current not a multiple of 15625uA (%d)\n",
7593333cb71SPaul Handrigan 			bst);
7603333cb71SPaul Handrigan 		ret = -EINVAL;
7613333cb71SPaul Handrigan 		goto err;
7623333cb71SPaul Handrigan 	}
7633333cb71SPaul Handrigan 
7643333cb71SPaul Handrigan 	while (bst > 1850000) {
7653333cb71SPaul Handrigan 		bst -= 15625;
7663333cb71SPaul Handrigan 		steps++;
7673333cb71SPaul Handrigan 	}
7683333cb71SPaul Handrigan 
7693333cb71SPaul Handrigan 	regmap_write(cs35l33->regmap, CS35L33_BST_PEAK_CTL,
7703333cb71SPaul Handrigan 		steps+0x70);
7713333cb71SPaul Handrigan 
7723333cb71SPaul Handrigan err:
7733333cb71SPaul Handrigan 	return ret;
7743333cb71SPaul Handrigan }
7753333cb71SPaul Handrigan 
cs35l33_probe(struct snd_soc_component * component)776cefcf594SKuninori Morimoto static int cs35l33_probe(struct snd_soc_component *component)
7773333cb71SPaul Handrigan {
778cefcf594SKuninori Morimoto 	struct cs35l33_private *cs35l33 = snd_soc_component_get_drvdata(component);
7793333cb71SPaul Handrigan 
780cefcf594SKuninori Morimoto 	cs35l33->component = component;
781cefcf594SKuninori Morimoto 	pm_runtime_get_sync(component->dev);
7823333cb71SPaul Handrigan 
7833333cb71SPaul Handrigan 	regmap_update_bits(cs35l33->regmap, CS35L33_PROTECT_CTL,
7843333cb71SPaul Handrigan 		CS35L33_ALIVE_WD_DIS, 0x8);
7853333cb71SPaul Handrigan 	regmap_update_bits(cs35l33->regmap, CS35L33_BST_CTL2,
7863333cb71SPaul Handrigan 				CS35L33_ALIVE_WD_DIS2,
7873333cb71SPaul Handrigan 				CS35L33_ALIVE_WD_DIS2);
7883333cb71SPaul Handrigan 
7893333cb71SPaul Handrigan 	/* Set Platform Data */
7903333cb71SPaul Handrigan 	regmap_update_bits(cs35l33->regmap, CS35L33_BST_CTL1,
7913333cb71SPaul Handrigan 		CS35L33_BST_CTL_MASK, cs35l33->pdata.boost_ctl);
7923333cb71SPaul Handrigan 	regmap_update_bits(cs35l33->regmap, CS35L33_CLASSD_CTL,
7933333cb71SPaul Handrigan 		CS35L33_AMP_DRV_SEL_MASK,
7943333cb71SPaul Handrigan 		cs35l33->pdata.amp_drv_sel << CS35L33_AMP_DRV_SEL_SHIFT);
7953333cb71SPaul Handrigan 
7963333cb71SPaul Handrigan 	if (cs35l33->pdata.boost_ipk)
797cefcf594SKuninori Morimoto 		cs35l33_set_bst_ipk(component, cs35l33->pdata.boost_ipk);
7983333cb71SPaul Handrigan 
7993333cb71SPaul Handrigan 	if (cs35l33->enable_soft_ramp) {
800cefcf594SKuninori Morimoto 		snd_soc_component_update_bits(component, CS35L33_DAC_CTL,
8013333cb71SPaul Handrigan 			CS35L33_DIGSFT, CS35L33_DIGSFT);
802cefcf594SKuninori Morimoto 		snd_soc_component_update_bits(component, CS35L33_DAC_CTL,
8033333cb71SPaul Handrigan 			CS35L33_DSR_RATE, cs35l33->pdata.ramp_rate);
8043333cb71SPaul Handrigan 	} else {
805cefcf594SKuninori Morimoto 		snd_soc_component_update_bits(component, CS35L33_DAC_CTL,
8063333cb71SPaul Handrigan 			CS35L33_DIGSFT, 0);
8073333cb71SPaul Handrigan 	}
8083333cb71SPaul Handrigan 
8093333cb71SPaul Handrigan 	/* update IMON scaling rate if different from default of 0x8 */
8103333cb71SPaul Handrigan 	if (cs35l33->pdata.imon_adc_scale != 0x8)
811cefcf594SKuninori Morimoto 		snd_soc_component_update_bits(component, CS35L33_ADC_CTL,
8123333cb71SPaul Handrigan 			CS35L33_IMON_SCALE, cs35l33->pdata.imon_adc_scale);
8133333cb71SPaul Handrigan 
814cefcf594SKuninori Morimoto 	cs35l33_set_hg_data(component, &(cs35l33->pdata));
8153333cb71SPaul Handrigan 
8163333cb71SPaul Handrigan 	/*
8173333cb71SPaul Handrigan 	 * unmask important interrupts that causes the chip to enter
8183333cb71SPaul Handrigan 	 * speaker safe mode and hence deserves user attention
8193333cb71SPaul Handrigan 	 */
8203333cb71SPaul Handrigan 	regmap_update_bits(cs35l33->regmap, CS35L33_INT_MASK_1,
8213333cb71SPaul Handrigan 		CS35L33_M_OTE | CS35L33_M_OTW | CS35L33_M_AMP_SHORT |
8223333cb71SPaul Handrigan 		CS35L33_M_CAL_ERR, 0);
8233333cb71SPaul Handrigan 
824cefcf594SKuninori Morimoto 	pm_runtime_put_sync(component->dev);
8253333cb71SPaul Handrigan 
8263333cb71SPaul Handrigan 	return 0;
8273333cb71SPaul Handrigan }
8283333cb71SPaul Handrigan 
829cefcf594SKuninori Morimoto static const struct snd_soc_component_driver soc_component_dev_cs35l33 = {
8303333cb71SPaul Handrigan 	.probe			= cs35l33_probe,
8313333cb71SPaul Handrigan 	.set_bias_level		= cs35l33_set_bias_level,
832cefcf594SKuninori Morimoto 	.set_sysclk		= cs35l33_component_set_sysclk,
833133987d6SKuninori Morimoto 	.controls		= cs35l33_snd_controls,
834133987d6SKuninori Morimoto 	.num_controls		= ARRAY_SIZE(cs35l33_snd_controls),
8353333cb71SPaul Handrigan 	.dapm_widgets		= cs35l33_dapm_widgets,
8363333cb71SPaul Handrigan 	.num_dapm_widgets	= ARRAY_SIZE(cs35l33_dapm_widgets),
8373333cb71SPaul Handrigan 	.dapm_routes		= cs35l33_audio_map,
8383333cb71SPaul Handrigan 	.num_dapm_routes	= ARRAY_SIZE(cs35l33_audio_map),
839cefcf594SKuninori Morimoto 	.use_pmdown_time	= 1,
840cefcf594SKuninori Morimoto 	.endianness		= 1,
8413333cb71SPaul Handrigan };
8423333cb71SPaul Handrigan 
8433333cb71SPaul Handrigan static const struct regmap_config cs35l33_regmap = {
8443333cb71SPaul Handrigan 	.reg_bits = 8,
8453333cb71SPaul Handrigan 	.val_bits = 8,
8463333cb71SPaul Handrigan 
8473333cb71SPaul Handrigan 	.max_register = CS35L33_MAX_REGISTER,
8483333cb71SPaul Handrigan 	.reg_defaults = cs35l33_reg,
8493333cb71SPaul Handrigan 	.num_reg_defaults = ARRAY_SIZE(cs35l33_reg),
8503333cb71SPaul Handrigan 	.volatile_reg = cs35l33_volatile_register,
8513333cb71SPaul Handrigan 	.readable_reg = cs35l33_readable_register,
8523333cb71SPaul Handrigan 	.writeable_reg = cs35l33_writeable_register,
8537a230512SMark Brown 	.cache_type = REGCACHE_MAPLE,
8541c96a2f6SDavid Frey 	.use_single_read = true,
8551c96a2f6SDavid Frey 	.use_single_write = true,
8563333cb71SPaul Handrigan };
8573333cb71SPaul Handrigan 
cs35l33_runtime_resume(struct device * dev)85820f12f2cSArnd Bergmann static int __maybe_unused cs35l33_runtime_resume(struct device *dev)
8593333cb71SPaul Handrigan {
8603333cb71SPaul Handrigan 	struct cs35l33_private *cs35l33 = dev_get_drvdata(dev);
8613333cb71SPaul Handrigan 	int ret;
8623333cb71SPaul Handrigan 
8633333cb71SPaul Handrigan 	dev_dbg(dev, "%s\n", __func__);
8643333cb71SPaul Handrigan 
8653333cb71SPaul Handrigan 	gpiod_set_value_cansleep(cs35l33->reset_gpio, 0);
8663333cb71SPaul Handrigan 
8673333cb71SPaul Handrigan 	ret = regulator_bulk_enable(cs35l33->num_core_supplies,
8683333cb71SPaul Handrigan 		cs35l33->core_supplies);
8693333cb71SPaul Handrigan 	if (ret != 0) {
8703333cb71SPaul Handrigan 		dev_err(dev, "Failed to enable core supplies: %d\n", ret);
8713333cb71SPaul Handrigan 		return ret;
8723333cb71SPaul Handrigan 	}
8733333cb71SPaul Handrigan 
8743333cb71SPaul Handrigan 	regcache_cache_only(cs35l33->regmap, false);
8753333cb71SPaul Handrigan 
8763333cb71SPaul Handrigan 	gpiod_set_value_cansleep(cs35l33->reset_gpio, 1);
8773333cb71SPaul Handrigan 
8783333cb71SPaul Handrigan 	msleep(CS35L33_BOOT_DELAY);
8793333cb71SPaul Handrigan 
8803333cb71SPaul Handrigan 	ret = regcache_sync(cs35l33->regmap);
8813333cb71SPaul Handrigan 	if (ret != 0) {
8823333cb71SPaul Handrigan 		dev_err(dev, "Failed to restore register cache\n");
8833333cb71SPaul Handrigan 		goto err;
8843333cb71SPaul Handrigan 	}
8853333cb71SPaul Handrigan 
8863333cb71SPaul Handrigan 	return 0;
8873333cb71SPaul Handrigan 
8883333cb71SPaul Handrigan err:
8893333cb71SPaul Handrigan 	regcache_cache_only(cs35l33->regmap, true);
8903333cb71SPaul Handrigan 	regulator_bulk_disable(cs35l33->num_core_supplies,
8913333cb71SPaul Handrigan 		cs35l33->core_supplies);
8923333cb71SPaul Handrigan 
8933333cb71SPaul Handrigan 	return ret;
8943333cb71SPaul Handrigan }
8953333cb71SPaul Handrigan 
cs35l33_runtime_suspend(struct device * dev)89620f12f2cSArnd Bergmann static int __maybe_unused cs35l33_runtime_suspend(struct device *dev)
8973333cb71SPaul Handrigan {
8983333cb71SPaul Handrigan 	struct cs35l33_private *cs35l33 = dev_get_drvdata(dev);
8993333cb71SPaul Handrigan 
9003333cb71SPaul Handrigan 	dev_dbg(dev, "%s\n", __func__);
9013333cb71SPaul Handrigan 
9023333cb71SPaul Handrigan 	/* redo the calibration in next power up */
9033333cb71SPaul Handrigan 	cs35l33->amp_cal = false;
9043333cb71SPaul Handrigan 
9053333cb71SPaul Handrigan 	regcache_cache_only(cs35l33->regmap, true);
9063333cb71SPaul Handrigan 	regcache_mark_dirty(cs35l33->regmap);
9073333cb71SPaul Handrigan 	regulator_bulk_disable(cs35l33->num_core_supplies,
9083333cb71SPaul Handrigan 		cs35l33->core_supplies);
9093333cb71SPaul Handrigan 
9103333cb71SPaul Handrigan 	return 0;
9113333cb71SPaul Handrigan }
9123333cb71SPaul Handrigan 
9133333cb71SPaul Handrigan static const struct dev_pm_ops cs35l33_pm_ops = {
9143333cb71SPaul Handrigan 	SET_RUNTIME_PM_OPS(cs35l33_runtime_suspend,
9153333cb71SPaul Handrigan 			   cs35l33_runtime_resume,
9163333cb71SPaul Handrigan 			   NULL)
9173333cb71SPaul Handrigan };
9183333cb71SPaul Handrigan 
cs35l33_get_hg_data(const struct device_node * np,struct cs35l33_pdata * pdata)9193333cb71SPaul Handrigan static int cs35l33_get_hg_data(const struct device_node *np,
9203333cb71SPaul Handrigan 			       struct cs35l33_pdata *pdata)
9213333cb71SPaul Handrigan {
9223333cb71SPaul Handrigan 	struct device_node *hg;
9233333cb71SPaul Handrigan 	struct cs35l33_hg *hg_config = &pdata->hg_config;
9243333cb71SPaul Handrigan 	u32 val32;
9253333cb71SPaul Handrigan 
9263333cb71SPaul Handrigan 	hg = of_get_child_by_name(np, "cirrus,hg-algo");
9273333cb71SPaul Handrigan 	hg_config->enable_hg_algo = hg ? true : false;
9283333cb71SPaul Handrigan 
9293333cb71SPaul Handrigan 	if (hg_config->enable_hg_algo) {
9303333cb71SPaul Handrigan 		if (of_property_read_u32(hg, "cirrus,mem-depth", &val32) >= 0)
9313333cb71SPaul Handrigan 			hg_config->mem_depth = val32;
9323333cb71SPaul Handrigan 		if (of_property_read_u32(hg, "cirrus,release-rate",
9333333cb71SPaul Handrigan 				&val32) >= 0)
9343333cb71SPaul Handrigan 			hg_config->release_rate = val32;
9353333cb71SPaul Handrigan 		if (of_property_read_u32(hg, "cirrus,ldo-thld", &val32) >= 0)
9363333cb71SPaul Handrigan 			hg_config->ldo_thld = val32;
9373333cb71SPaul Handrigan 		if (of_property_read_u32(hg, "cirrus,ldo-path-disable",
9383333cb71SPaul Handrigan 				&val32) >= 0)
9393333cb71SPaul Handrigan 			hg_config->ldo_path_disable = val32;
9403333cb71SPaul Handrigan 		if (of_property_read_u32(hg, "cirrus,ldo-entry-delay",
9413333cb71SPaul Handrigan 				&val32) >= 0)
9423333cb71SPaul Handrigan 			hg_config->ldo_entry_delay = val32;
9433333cb71SPaul Handrigan 
9443333cb71SPaul Handrigan 		hg_config->vp_hg_auto = of_property_read_bool(hg,
9453333cb71SPaul Handrigan 			"cirrus,vp-hg-auto");
9463333cb71SPaul Handrigan 
9473333cb71SPaul Handrigan 		if (of_property_read_u32(hg, "cirrus,vp-hg", &val32) >= 0)
9483333cb71SPaul Handrigan 			hg_config->vp_hg = val32;
9493333cb71SPaul Handrigan 		if (of_property_read_u32(hg, "cirrus,vp-hg-rate", &val32) >= 0)
9503333cb71SPaul Handrigan 			hg_config->vp_hg_rate = val32;
9513333cb71SPaul Handrigan 		if (of_property_read_u32(hg, "cirrus,vp-hg-va", &val32) >= 0)
9523333cb71SPaul Handrigan 			hg_config->vp_hg_va = val32;
9533333cb71SPaul Handrigan 	}
9543333cb71SPaul Handrigan 
9553333cb71SPaul Handrigan 	of_node_put(hg);
9563333cb71SPaul Handrigan 
9573333cb71SPaul Handrigan 	return 0;
9583333cb71SPaul Handrigan }
9593333cb71SPaul Handrigan 
cs35l33_irq_thread(int irq,void * data)9603333cb71SPaul Handrigan static irqreturn_t cs35l33_irq_thread(int irq, void *data)
9613333cb71SPaul Handrigan {
9623333cb71SPaul Handrigan 	struct cs35l33_private *cs35l33 = data;
963cefcf594SKuninori Morimoto 	struct snd_soc_component *component = cs35l33->component;
9643333cb71SPaul Handrigan 	unsigned int sticky_val1, sticky_val2, current_val, mask1, mask2;
9653333cb71SPaul Handrigan 
9663333cb71SPaul Handrigan 	regmap_read(cs35l33->regmap, CS35L33_INT_STATUS_2,
9673333cb71SPaul Handrigan 		&sticky_val2);
9683333cb71SPaul Handrigan 	regmap_read(cs35l33->regmap, CS35L33_INT_STATUS_1,
9693333cb71SPaul Handrigan 		&sticky_val1);
9703333cb71SPaul Handrigan 	regmap_read(cs35l33->regmap, CS35L33_INT_MASK_2, &mask2);
9713333cb71SPaul Handrigan 	regmap_read(cs35l33->regmap, CS35L33_INT_MASK_1, &mask1);
9723333cb71SPaul Handrigan 
9733333cb71SPaul Handrigan 	/* Check to see if the unmasked bits are active,
9743333cb71SPaul Handrigan 	 *  if not then exit.
9753333cb71SPaul Handrigan 	 */
9763333cb71SPaul Handrigan 	if (!(sticky_val1 & ~mask1) && !(sticky_val2 & ~mask2))
9773333cb71SPaul Handrigan 		return IRQ_NONE;
9783333cb71SPaul Handrigan 
9793333cb71SPaul Handrigan 	regmap_read(cs35l33->regmap, CS35L33_INT_STATUS_1,
9803333cb71SPaul Handrigan 		&current_val);
9813333cb71SPaul Handrigan 
9823333cb71SPaul Handrigan 	/* handle the interrupts */
9833333cb71SPaul Handrigan 
9843333cb71SPaul Handrigan 	if (sticky_val1 & CS35L33_AMP_SHORT) {
985cefcf594SKuninori Morimoto 		dev_crit(component->dev, "Amp short error\n");
9863333cb71SPaul Handrigan 		if (!(current_val & CS35L33_AMP_SHORT)) {
987cefcf594SKuninori Morimoto 			dev_dbg(component->dev,
9883333cb71SPaul Handrigan 				"Amp short error release\n");
9893333cb71SPaul Handrigan 			regmap_update_bits(cs35l33->regmap,
9903333cb71SPaul Handrigan 				CS35L33_AMP_CTL,
9913333cb71SPaul Handrigan 				CS35L33_AMP_SHORT_RLS, 0);
9923333cb71SPaul Handrigan 			regmap_update_bits(cs35l33->regmap,
9933333cb71SPaul Handrigan 				CS35L33_AMP_CTL,
9943333cb71SPaul Handrigan 				CS35L33_AMP_SHORT_RLS,
9953333cb71SPaul Handrigan 				CS35L33_AMP_SHORT_RLS);
9963333cb71SPaul Handrigan 			regmap_update_bits(cs35l33->regmap,
9973333cb71SPaul Handrigan 				CS35L33_AMP_CTL, CS35L33_AMP_SHORT_RLS,
9983333cb71SPaul Handrigan 				0);
9993333cb71SPaul Handrigan 		}
10003333cb71SPaul Handrigan 	}
10013333cb71SPaul Handrigan 
10023333cb71SPaul Handrigan 	if (sticky_val1 & CS35L33_CAL_ERR) {
1003cefcf594SKuninori Morimoto 		dev_err(component->dev, "Cal error\n");
10043333cb71SPaul Handrigan 
10053333cb71SPaul Handrigan 		/* redo the calibration in next power up */
10063333cb71SPaul Handrigan 		cs35l33->amp_cal = false;
10073333cb71SPaul Handrigan 
10083333cb71SPaul Handrigan 		if (!(current_val & CS35L33_CAL_ERR)) {
1009cefcf594SKuninori Morimoto 			dev_dbg(component->dev, "Cal error release\n");
10103333cb71SPaul Handrigan 			regmap_update_bits(cs35l33->regmap,
10113333cb71SPaul Handrigan 				CS35L33_AMP_CTL, CS35L33_CAL_ERR_RLS,
10123333cb71SPaul Handrigan 				0);
10133333cb71SPaul Handrigan 			regmap_update_bits(cs35l33->regmap,
10143333cb71SPaul Handrigan 				CS35L33_AMP_CTL, CS35L33_CAL_ERR_RLS,
10153333cb71SPaul Handrigan 				CS35L33_CAL_ERR_RLS);
10163333cb71SPaul Handrigan 			regmap_update_bits(cs35l33->regmap,
10173333cb71SPaul Handrigan 				CS35L33_AMP_CTL, CS35L33_CAL_ERR_RLS,
10183333cb71SPaul Handrigan 				0);
10193333cb71SPaul Handrigan 		}
10203333cb71SPaul Handrigan 	}
10213333cb71SPaul Handrigan 
10223333cb71SPaul Handrigan 	if (sticky_val1 & CS35L33_OTE) {
1023cefcf594SKuninori Morimoto 		dev_crit(component->dev, "Over temperature error\n");
10243333cb71SPaul Handrigan 		if (!(current_val & CS35L33_OTE)) {
1025cefcf594SKuninori Morimoto 			dev_dbg(component->dev,
10263333cb71SPaul Handrigan 				"Over temperature error release\n");
10273333cb71SPaul Handrigan 			regmap_update_bits(cs35l33->regmap,
10283333cb71SPaul Handrigan 				CS35L33_AMP_CTL, CS35L33_OTE_RLS, 0);
10293333cb71SPaul Handrigan 			regmap_update_bits(cs35l33->regmap,
10303333cb71SPaul Handrigan 				CS35L33_AMP_CTL, CS35L33_OTE_RLS,
10313333cb71SPaul Handrigan 				CS35L33_OTE_RLS);
10323333cb71SPaul Handrigan 			regmap_update_bits(cs35l33->regmap,
10333333cb71SPaul Handrigan 				CS35L33_AMP_CTL, CS35L33_OTE_RLS, 0);
10343333cb71SPaul Handrigan 		}
10353333cb71SPaul Handrigan 	}
10363333cb71SPaul Handrigan 
10373333cb71SPaul Handrigan 	if (sticky_val1 & CS35L33_OTW) {
1038cefcf594SKuninori Morimoto 		dev_err(component->dev, "Over temperature warning\n");
10393333cb71SPaul Handrigan 		if (!(current_val & CS35L33_OTW)) {
1040cefcf594SKuninori Morimoto 			dev_dbg(component->dev,
10413333cb71SPaul Handrigan 				"Over temperature warning release\n");
10423333cb71SPaul Handrigan 			regmap_update_bits(cs35l33->regmap,
10433333cb71SPaul Handrigan 				CS35L33_AMP_CTL, CS35L33_OTW_RLS, 0);
10443333cb71SPaul Handrigan 			regmap_update_bits(cs35l33->regmap,
10453333cb71SPaul Handrigan 				CS35L33_AMP_CTL, CS35L33_OTW_RLS,
10463333cb71SPaul Handrigan 				CS35L33_OTW_RLS);
10473333cb71SPaul Handrigan 			regmap_update_bits(cs35l33->regmap,
10483333cb71SPaul Handrigan 				CS35L33_AMP_CTL, CS35L33_OTW_RLS, 0);
10493333cb71SPaul Handrigan 		}
10503333cb71SPaul Handrigan 	}
10513333cb71SPaul Handrigan 	if (CS35L33_ALIVE_ERR & sticky_val1)
1052cefcf594SKuninori Morimoto 		dev_err(component->dev, "ERROR: ADSPCLK Interrupt\n");
10533333cb71SPaul Handrigan 
10543333cb71SPaul Handrigan 	if (CS35L33_MCLK_ERR & sticky_val1)
1055cefcf594SKuninori Morimoto 		dev_err(component->dev, "ERROR: MCLK Interrupt\n");
10563333cb71SPaul Handrigan 
10573333cb71SPaul Handrigan 	if (CS35L33_VMON_OVFL & sticky_val2)
1058cefcf594SKuninori Morimoto 		dev_err(component->dev,
10593333cb71SPaul Handrigan 			"ERROR: VMON Overflow Interrupt\n");
10603333cb71SPaul Handrigan 
10613333cb71SPaul Handrigan 	if (CS35L33_IMON_OVFL & sticky_val2)
1062cefcf594SKuninori Morimoto 		dev_err(component->dev,
10633333cb71SPaul Handrigan 			"ERROR: IMON Overflow Interrupt\n");
10643333cb71SPaul Handrigan 
10653333cb71SPaul Handrigan 	if (CS35L33_VPMON_OVFL & sticky_val2)
1066cefcf594SKuninori Morimoto 		dev_err(component->dev,
10673333cb71SPaul Handrigan 			"ERROR: VPMON Overflow Interrupt\n");
10683333cb71SPaul Handrigan 
10693333cb71SPaul Handrigan 	return IRQ_HANDLED;
10703333cb71SPaul Handrigan }
10713333cb71SPaul Handrigan 
10723333cb71SPaul Handrigan static const char * const cs35l33_core_supplies[] = {
10733333cb71SPaul Handrigan 	"VA",
10743333cb71SPaul Handrigan 	"VP",
10753333cb71SPaul Handrigan };
10763333cb71SPaul Handrigan 
cs35l33_of_get_pdata(struct device * dev,struct cs35l33_private * cs35l33)10773333cb71SPaul Handrigan static int cs35l33_of_get_pdata(struct device *dev,
10783333cb71SPaul Handrigan 				struct cs35l33_private *cs35l33)
10793333cb71SPaul Handrigan {
10803333cb71SPaul Handrigan 	struct device_node *np = dev->of_node;
10813333cb71SPaul Handrigan 	struct cs35l33_pdata *pdata = &cs35l33->pdata;
10823333cb71SPaul Handrigan 	u32 val32;
10833333cb71SPaul Handrigan 
10843333cb71SPaul Handrigan 	if (!np)
10853333cb71SPaul Handrigan 		return 0;
10863333cb71SPaul Handrigan 
10873333cb71SPaul Handrigan 	if (of_property_read_u32(np, "cirrus,boost-ctl", &val32) >= 0) {
10883333cb71SPaul Handrigan 		pdata->boost_ctl = val32;
10893333cb71SPaul Handrigan 		pdata->amp_drv_sel = 1;
10903333cb71SPaul Handrigan 	}
10913333cb71SPaul Handrigan 
10923333cb71SPaul Handrigan 	if (of_property_read_u32(np, "cirrus,ramp-rate", &val32) >= 0) {
10933333cb71SPaul Handrigan 		pdata->ramp_rate = val32;
10943333cb71SPaul Handrigan 		cs35l33->enable_soft_ramp = true;
10953333cb71SPaul Handrigan 	}
10963333cb71SPaul Handrigan 
10973333cb71SPaul Handrigan 	if (of_property_read_u32(np, "cirrus,boost-ipk", &val32) >= 0)
10983333cb71SPaul Handrigan 		pdata->boost_ipk = val32;
10993333cb71SPaul Handrigan 
11003333cb71SPaul Handrigan 	if (of_property_read_u32(np, "cirrus,imon-adc-scale", &val32) >= 0) {
11013333cb71SPaul Handrigan 		if ((val32 == 0x0) || (val32 == 0x7) || (val32 == 0x6))
11023333cb71SPaul Handrigan 			pdata->imon_adc_scale = val32;
11033333cb71SPaul Handrigan 		else
11043333cb71SPaul Handrigan 			/* use default value */
11053333cb71SPaul Handrigan 			pdata->imon_adc_scale = 0x8;
11063333cb71SPaul Handrigan 	} else {
11073333cb71SPaul Handrigan 		/* use default value */
11083333cb71SPaul Handrigan 		pdata->imon_adc_scale = 0x8;
11093333cb71SPaul Handrigan 	}
11103333cb71SPaul Handrigan 
11113333cb71SPaul Handrigan 	cs35l33_get_hg_data(np, pdata);
11123333cb71SPaul Handrigan 
11133333cb71SPaul Handrigan 	return 0;
11143333cb71SPaul Handrigan }
11153333cb71SPaul Handrigan 
cs35l33_i2c_probe(struct i2c_client * i2c_client)11164a404345SStephen Kitt static int cs35l33_i2c_probe(struct i2c_client *i2c_client)
11173333cb71SPaul Handrigan {
11183333cb71SPaul Handrigan 	struct cs35l33_private *cs35l33;
11193333cb71SPaul Handrigan 	struct cs35l33_pdata *pdata = dev_get_platdata(&i2c_client->dev);
11203333cb71SPaul Handrigan 	int ret, devid, i;
11213333cb71SPaul Handrigan 	unsigned int reg;
11223333cb71SPaul Handrigan 
11233333cb71SPaul Handrigan 	cs35l33 = devm_kzalloc(&i2c_client->dev, sizeof(struct cs35l33_private),
11243333cb71SPaul Handrigan 			       GFP_KERNEL);
11253333cb71SPaul Handrigan 	if (!cs35l33)
11263333cb71SPaul Handrigan 		return -ENOMEM;
11273333cb71SPaul Handrigan 
11283333cb71SPaul Handrigan 	i2c_set_clientdata(i2c_client, cs35l33);
11293333cb71SPaul Handrigan 	cs35l33->regmap = devm_regmap_init_i2c(i2c_client, &cs35l33_regmap);
11303333cb71SPaul Handrigan 	if (IS_ERR(cs35l33->regmap)) {
11313333cb71SPaul Handrigan 		ret = PTR_ERR(cs35l33->regmap);
11323333cb71SPaul Handrigan 		dev_err(&i2c_client->dev, "regmap_init() failed: %d\n", ret);
11333333cb71SPaul Handrigan 		return ret;
11343333cb71SPaul Handrigan 	}
11353333cb71SPaul Handrigan 
11363333cb71SPaul Handrigan 	regcache_cache_only(cs35l33->regmap, true);
11373333cb71SPaul Handrigan 
11383333cb71SPaul Handrigan 	for (i = 0; i < ARRAY_SIZE(cs35l33_core_supplies); i++)
11393333cb71SPaul Handrigan 		cs35l33->core_supplies[i].supply
11403333cb71SPaul Handrigan 			= cs35l33_core_supplies[i];
11413333cb71SPaul Handrigan 	cs35l33->num_core_supplies = ARRAY_SIZE(cs35l33_core_supplies);
11423333cb71SPaul Handrigan 
11433333cb71SPaul Handrigan 	ret = devm_regulator_bulk_get(&i2c_client->dev,
11443333cb71SPaul Handrigan 			cs35l33->num_core_supplies,
11453333cb71SPaul Handrigan 			cs35l33->core_supplies);
11463333cb71SPaul Handrigan 	if (ret != 0) {
11473333cb71SPaul Handrigan 		dev_err(&i2c_client->dev,
11483333cb71SPaul Handrigan 			"Failed to request core supplies: %d\n",
11493333cb71SPaul Handrigan 			ret);
11503333cb71SPaul Handrigan 		return ret;
11513333cb71SPaul Handrigan 	}
11523333cb71SPaul Handrigan 
11533333cb71SPaul Handrigan 	if (pdata) {
11543333cb71SPaul Handrigan 		cs35l33->pdata = *pdata;
11553333cb71SPaul Handrigan 	} else {
11563333cb71SPaul Handrigan 		cs35l33_of_get_pdata(&i2c_client->dev, cs35l33);
11573333cb71SPaul Handrigan 		pdata = &cs35l33->pdata;
11583333cb71SPaul Handrigan 	}
11593333cb71SPaul Handrigan 
11603333cb71SPaul Handrigan 	ret = devm_request_threaded_irq(&i2c_client->dev, i2c_client->irq, NULL,
11613333cb71SPaul Handrigan 			cs35l33_irq_thread, IRQF_ONESHOT | IRQF_TRIGGER_LOW,
11623333cb71SPaul Handrigan 			"cs35l33", cs35l33);
11633333cb71SPaul Handrigan 	if (ret != 0)
11643333cb71SPaul Handrigan 		dev_warn(&i2c_client->dev, "Failed to request IRQ: %d\n", ret);
11653333cb71SPaul Handrigan 
11663333cb71SPaul Handrigan 	/* We could issue !RST or skip it based on AMP topology */
11673333cb71SPaul Handrigan 	cs35l33->reset_gpio = devm_gpiod_get_optional(&i2c_client->dev,
1168*13bb7bfcSLinus Walleij 			"reset", GPIOD_OUT_HIGH);
1169410fe39cSAxel Lin 	if (IS_ERR(cs35l33->reset_gpio)) {
11703333cb71SPaul Handrigan 		dev_err(&i2c_client->dev, "%s ERROR: Can't get reset GPIO\n",
11713333cb71SPaul Handrigan 			__func__);
11723333cb71SPaul Handrigan 		return PTR_ERR(cs35l33->reset_gpio);
11733333cb71SPaul Handrigan 	}
11743333cb71SPaul Handrigan 
11753333cb71SPaul Handrigan 	ret = regulator_bulk_enable(cs35l33->num_core_supplies,
11763333cb71SPaul Handrigan 					cs35l33->core_supplies);
11773333cb71SPaul Handrigan 	if (ret != 0) {
11783333cb71SPaul Handrigan 		dev_err(&i2c_client->dev,
11793333cb71SPaul Handrigan 			"Failed to enable core supplies: %d\n",
11803333cb71SPaul Handrigan 			ret);
1181beefe4a9SAxel Lin 		return ret;
11823333cb71SPaul Handrigan 	}
11833333cb71SPaul Handrigan 
11843333cb71SPaul Handrigan 	gpiod_set_value_cansleep(cs35l33->reset_gpio, 1);
11853333cb71SPaul Handrigan 
11863333cb71SPaul Handrigan 	msleep(CS35L33_BOOT_DELAY);
11873333cb71SPaul Handrigan 	regcache_cache_only(cs35l33->regmap, false);
11883333cb71SPaul Handrigan 
11893333cb71SPaul Handrigan 	/* initialize codec */
119077908dbeSCharles Keepax 	devid = cirrus_read_device_id(cs35l33->regmap, CS35L33_DEVID_AB);
119177908dbeSCharles Keepax 	if (devid < 0) {
119277908dbeSCharles Keepax 		ret = devid;
119377908dbeSCharles Keepax 		dev_err(&i2c_client->dev, "Failed to read device ID: %d\n", ret);
119477908dbeSCharles Keepax 		goto err_enable;
119577908dbeSCharles Keepax 	}
11963333cb71SPaul Handrigan 
11973333cb71SPaul Handrigan 	if (devid != CS35L33_CHIP_ID) {
11983333cb71SPaul Handrigan 		dev_err(&i2c_client->dev,
11993333cb71SPaul Handrigan 			"CS35L33 Device ID (%X). Expected ID %X\n",
12003333cb71SPaul Handrigan 			devid, CS35L33_CHIP_ID);
1201833bc4cfSDan Carpenter 		ret = -EINVAL;
12023333cb71SPaul Handrigan 		goto err_enable;
12033333cb71SPaul Handrigan 	}
12043333cb71SPaul Handrigan 
12053333cb71SPaul Handrigan 	ret = regmap_read(cs35l33->regmap, CS35L33_REV_ID, &reg);
12063333cb71SPaul Handrigan 	if (ret < 0) {
12073333cb71SPaul Handrigan 		dev_err(&i2c_client->dev, "Get Revision ID failed\n");
12083333cb71SPaul Handrigan 		goto err_enable;
12093333cb71SPaul Handrigan 	}
12103333cb71SPaul Handrigan 
12113333cb71SPaul Handrigan 	dev_info(&i2c_client->dev,
12125d78b027SAxel Lin 		 "Cirrus Logic CS35L33, Revision: %02X\n", reg & 0xFF);
12133333cb71SPaul Handrigan 
12143333cb71SPaul Handrigan 	ret = regmap_register_patch(cs35l33->regmap,
12153333cb71SPaul Handrigan 			cs35l33_patch, ARRAY_SIZE(cs35l33_patch));
12163333cb71SPaul Handrigan 	if (ret < 0) {
12173333cb71SPaul Handrigan 		dev_err(&i2c_client->dev,
12183333cb71SPaul Handrigan 			"Error in applying regmap patch: %d\n", ret);
12193333cb71SPaul Handrigan 		goto err_enable;
12203333cb71SPaul Handrigan 	}
12213333cb71SPaul Handrigan 
12223333cb71SPaul Handrigan 	/* disable mclk and tdm */
12233333cb71SPaul Handrigan 	regmap_update_bits(cs35l33->regmap, CS35L33_CLK_CTL,
12243333cb71SPaul Handrigan 		CS35L33_MCLKDIS | CS35L33_SDOUT_3ST_TDM,
12253333cb71SPaul Handrigan 		CS35L33_MCLKDIS | CS35L33_SDOUT_3ST_TDM);
12263333cb71SPaul Handrigan 
12273333cb71SPaul Handrigan 	pm_runtime_set_autosuspend_delay(&i2c_client->dev, 100);
12283333cb71SPaul Handrigan 	pm_runtime_use_autosuspend(&i2c_client->dev);
12293333cb71SPaul Handrigan 	pm_runtime_set_active(&i2c_client->dev);
12303333cb71SPaul Handrigan 	pm_runtime_enable(&i2c_client->dev);
12313333cb71SPaul Handrigan 
1232cefcf594SKuninori Morimoto 	ret = devm_snd_soc_register_component(&i2c_client->dev,
1233cefcf594SKuninori Morimoto 			&soc_component_dev_cs35l33, &cs35l33_dai, 1);
12343333cb71SPaul Handrigan 	if (ret < 0) {
1235cefcf594SKuninori Morimoto 		dev_err(&i2c_client->dev, "%s: Register component failed\n",
12363333cb71SPaul Handrigan 			__func__);
1237beefe4a9SAxel Lin 		goto err_enable;
12383333cb71SPaul Handrigan 	}
12393333cb71SPaul Handrigan 
12403333cb71SPaul Handrigan 	return 0;
12413333cb71SPaul Handrigan 
12423333cb71SPaul Handrigan err_enable:
124377908dbeSCharles Keepax 	gpiod_set_value_cansleep(cs35l33->reset_gpio, 0);
124477908dbeSCharles Keepax 
12453333cb71SPaul Handrigan 	regulator_bulk_disable(cs35l33->num_core_supplies,
12463333cb71SPaul Handrigan 			       cs35l33->core_supplies);
12473333cb71SPaul Handrigan 
12483333cb71SPaul Handrigan 	return ret;
12493333cb71SPaul Handrigan }
12503333cb71SPaul Handrigan 
cs35l33_i2c_remove(struct i2c_client * client)1251ed5c2f5fSUwe Kleine-König static void cs35l33_i2c_remove(struct i2c_client *client)
12523333cb71SPaul Handrigan {
12533333cb71SPaul Handrigan 	struct cs35l33_private *cs35l33 = i2c_get_clientdata(client);
12543333cb71SPaul Handrigan 
12553333cb71SPaul Handrigan 	gpiod_set_value_cansleep(cs35l33->reset_gpio, 0);
12563333cb71SPaul Handrigan 
12573333cb71SPaul Handrigan 	pm_runtime_disable(&client->dev);
12583333cb71SPaul Handrigan 	regulator_bulk_disable(cs35l33->num_core_supplies,
12593333cb71SPaul Handrigan 		cs35l33->core_supplies);
12603333cb71SPaul Handrigan }
12613333cb71SPaul Handrigan 
12623333cb71SPaul Handrigan static const struct of_device_id cs35l33_of_match[] = {
12633333cb71SPaul Handrigan 	{ .compatible = "cirrus,cs35l33", },
12643333cb71SPaul Handrigan 	{},
12653333cb71SPaul Handrigan };
12663333cb71SPaul Handrigan MODULE_DEVICE_TABLE(of, cs35l33_of_match);
12673333cb71SPaul Handrigan 
12683333cb71SPaul Handrigan static const struct i2c_device_id cs35l33_id[] = {
12693333cb71SPaul Handrigan 	{"cs35l33", 0},
12703333cb71SPaul Handrigan 	{}
12713333cb71SPaul Handrigan };
12723333cb71SPaul Handrigan 
12733333cb71SPaul Handrigan MODULE_DEVICE_TABLE(i2c, cs35l33_id);
12743333cb71SPaul Handrigan 
12753333cb71SPaul Handrigan static struct i2c_driver cs35l33_i2c_driver = {
12763333cb71SPaul Handrigan 	.driver = {
12773333cb71SPaul Handrigan 		.name = "cs35l33",
12783333cb71SPaul Handrigan 		.pm = &cs35l33_pm_ops,
12793333cb71SPaul Handrigan 		.of_match_table = cs35l33_of_match,
12803333cb71SPaul Handrigan 
12813333cb71SPaul Handrigan 		},
12823333cb71SPaul Handrigan 	.id_table = cs35l33_id,
12839abcd240SUwe Kleine-König 	.probe = cs35l33_i2c_probe,
12843333cb71SPaul Handrigan 	.remove = cs35l33_i2c_remove,
12853333cb71SPaul Handrigan 
12863333cb71SPaul Handrigan };
12873333cb71SPaul Handrigan module_i2c_driver(cs35l33_i2c_driver);
12883333cb71SPaul Handrigan 
12893333cb71SPaul Handrigan MODULE_DESCRIPTION("ASoC CS35L33 driver");
12903333cb71SPaul Handrigan MODULE_AUTHOR("Paul Handrigan, Cirrus Logic Inc, <paul.handrigan@cirrus.com>");
12913333cb71SPaul Handrigan MODULE_LICENSE("GPL");
1292