cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

max98373-i2c.c (17835B)


      1// SPDX-License-Identifier: GPL-2.0
      2// Copyright (c) 2017, Maxim Integrated
      3
      4#include <linux/acpi.h>
      5#include <linux/delay.h>
      6#include <linux/gpio.h>
      7#include <linux/i2c.h>
      8#include <linux/module.h>
      9#include <linux/mod_devicetable.h>
     10#include <linux/of.h>
     11#include <linux/of_gpio.h>
     12#include <linux/pm_runtime.h>
     13#include <linux/regmap.h>
     14#include <linux/slab.h>
     15#include <linux/cdev.h>
     16#include <sound/pcm.h>
     17#include <sound/pcm_params.h>
     18#include <sound/soc.h>
     19#include <sound/tlv.h>
     20#include "max98373.h"
     21
     22static const u32 max98373_i2c_cache_reg[] = {
     23	MAX98373_R2054_MEAS_ADC_PVDD_CH_READBACK,
     24	MAX98373_R2055_MEAS_ADC_THERM_CH_READBACK,
     25	MAX98373_R20B6_BDE_CUR_STATE_READBACK,
     26};
     27
     28static struct reg_default max98373_reg[] = {
     29	{MAX98373_R2000_SW_RESET, 0x00},
     30	{MAX98373_R2001_INT_RAW1, 0x00},
     31	{MAX98373_R2002_INT_RAW2, 0x00},
     32	{MAX98373_R2003_INT_RAW3, 0x00},
     33	{MAX98373_R2004_INT_STATE1, 0x00},
     34	{MAX98373_R2005_INT_STATE2, 0x00},
     35	{MAX98373_R2006_INT_STATE3, 0x00},
     36	{MAX98373_R2007_INT_FLAG1, 0x00},
     37	{MAX98373_R2008_INT_FLAG2, 0x00},
     38	{MAX98373_R2009_INT_FLAG3, 0x00},
     39	{MAX98373_R200A_INT_EN1, 0x00},
     40	{MAX98373_R200B_INT_EN2, 0x00},
     41	{MAX98373_R200C_INT_EN3, 0x00},
     42	{MAX98373_R200D_INT_FLAG_CLR1, 0x00},
     43	{MAX98373_R200E_INT_FLAG_CLR2, 0x00},
     44	{MAX98373_R200F_INT_FLAG_CLR3, 0x00},
     45	{MAX98373_R2010_IRQ_CTRL, 0x00},
     46	{MAX98373_R2014_THERM_WARN_THRESH, 0x10},
     47	{MAX98373_R2015_THERM_SHDN_THRESH, 0x27},
     48	{MAX98373_R2016_THERM_HYSTERESIS, 0x01},
     49	{MAX98373_R2017_THERM_FOLDBACK_SET, 0xC0},
     50	{MAX98373_R2018_THERM_FOLDBACK_EN, 0x00},
     51	{MAX98373_R201E_PIN_DRIVE_STRENGTH, 0x55},
     52	{MAX98373_R2020_PCM_TX_HIZ_EN_1, 0xFE},
     53	{MAX98373_R2021_PCM_TX_HIZ_EN_2, 0xFF},
     54	{MAX98373_R2022_PCM_TX_SRC_1, 0x00},
     55	{MAX98373_R2023_PCM_TX_SRC_2, 0x00},
     56	{MAX98373_R2024_PCM_DATA_FMT_CFG, 0xC0},
     57	{MAX98373_R2025_AUDIO_IF_MODE, 0x00},
     58	{MAX98373_R2026_PCM_CLOCK_RATIO, 0x04},
     59	{MAX98373_R2027_PCM_SR_SETUP_1, 0x08},
     60	{MAX98373_R2028_PCM_SR_SETUP_2, 0x88},
     61	{MAX98373_R2029_PCM_TO_SPK_MONO_MIX_1, 0x00},
     62	{MAX98373_R202A_PCM_TO_SPK_MONO_MIX_2, 0x00},
     63	{MAX98373_R202B_PCM_RX_EN, 0x00},
     64	{MAX98373_R202C_PCM_TX_EN, 0x00},
     65	{MAX98373_R202E_ICC_RX_CH_EN_1, 0x00},
     66	{MAX98373_R202F_ICC_RX_CH_EN_2, 0x00},
     67	{MAX98373_R2030_ICC_TX_HIZ_EN_1, 0xFF},
     68	{MAX98373_R2031_ICC_TX_HIZ_EN_2, 0xFF},
     69	{MAX98373_R2032_ICC_LINK_EN_CFG, 0x30},
     70	{MAX98373_R2034_ICC_TX_CNTL, 0x00},
     71	{MAX98373_R2035_ICC_TX_EN, 0x00},
     72	{MAX98373_R2036_SOUNDWIRE_CTRL, 0x05},
     73	{MAX98373_R203D_AMP_DIG_VOL_CTRL, 0x00},
     74	{MAX98373_R203E_AMP_PATH_GAIN, 0x08},
     75	{MAX98373_R203F_AMP_DSP_CFG, 0x02},
     76	{MAX98373_R2040_TONE_GEN_CFG, 0x00},
     77	{MAX98373_R2041_AMP_CFG, 0x03},
     78	{MAX98373_R2042_AMP_EDGE_RATE_CFG, 0x00},
     79	{MAX98373_R2043_AMP_EN, 0x00},
     80	{MAX98373_R2046_IV_SENSE_ADC_DSP_CFG, 0x04},
     81	{MAX98373_R2047_IV_SENSE_ADC_EN, 0x00},
     82	{MAX98373_R2051_MEAS_ADC_SAMPLING_RATE, 0x00},
     83	{MAX98373_R2052_MEAS_ADC_PVDD_FLT_CFG, 0x00},
     84	{MAX98373_R2053_MEAS_ADC_THERM_FLT_CFG, 0x00},
     85	{MAX98373_R2054_MEAS_ADC_PVDD_CH_READBACK, 0x00},
     86	{MAX98373_R2055_MEAS_ADC_THERM_CH_READBACK, 0x00},
     87	{MAX98373_R2056_MEAS_ADC_PVDD_CH_EN, 0x00},
     88	{MAX98373_R2090_BDE_LVL_HOLD, 0x00},
     89	{MAX98373_R2091_BDE_GAIN_ATK_REL_RATE, 0x00},
     90	{MAX98373_R2092_BDE_CLIPPER_MODE, 0x00},
     91	{MAX98373_R2097_BDE_L1_THRESH, 0x00},
     92	{MAX98373_R2098_BDE_L2_THRESH, 0x00},
     93	{MAX98373_R2099_BDE_L3_THRESH, 0x00},
     94	{MAX98373_R209A_BDE_L4_THRESH, 0x00},
     95	{MAX98373_R209B_BDE_THRESH_HYST, 0x00},
     96	{MAX98373_R20A8_BDE_L1_CFG_1, 0x00},
     97	{MAX98373_R20A9_BDE_L1_CFG_2, 0x00},
     98	{MAX98373_R20AA_BDE_L1_CFG_3, 0x00},
     99	{MAX98373_R20AB_BDE_L2_CFG_1, 0x00},
    100	{MAX98373_R20AC_BDE_L2_CFG_2, 0x00},
    101	{MAX98373_R20AD_BDE_L2_CFG_3, 0x00},
    102	{MAX98373_R20AE_BDE_L3_CFG_1, 0x00},
    103	{MAX98373_R20AF_BDE_L3_CFG_2, 0x00},
    104	{MAX98373_R20B0_BDE_L3_CFG_3, 0x00},
    105	{MAX98373_R20B1_BDE_L4_CFG_1, 0x00},
    106	{MAX98373_R20B2_BDE_L4_CFG_2, 0x00},
    107	{MAX98373_R20B3_BDE_L4_CFG_3, 0x00},
    108	{MAX98373_R20B4_BDE_INFINITE_HOLD_RELEASE, 0x00},
    109	{MAX98373_R20B5_BDE_EN, 0x00},
    110	{MAX98373_R20B6_BDE_CUR_STATE_READBACK, 0x00},
    111	{MAX98373_R20D1_DHT_CFG, 0x01},
    112	{MAX98373_R20D2_DHT_ATTACK_CFG, 0x02},
    113	{MAX98373_R20D3_DHT_RELEASE_CFG, 0x03},
    114	{MAX98373_R20D4_DHT_EN, 0x00},
    115	{MAX98373_R20E0_LIMITER_THRESH_CFG, 0x00},
    116	{MAX98373_R20E1_LIMITER_ATK_REL_RATES, 0x00},
    117	{MAX98373_R20E2_LIMITER_EN, 0x00},
    118	{MAX98373_R20FE_DEVICE_AUTO_RESTART_CFG, 0x00},
    119	{MAX98373_R20FF_GLOBAL_SHDN, 0x00},
    120	{MAX98373_R21FF_REV_ID, 0x42},
    121};
    122
    123static int max98373_dai_set_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
    124{
    125	struct snd_soc_component *component = codec_dai->component;
    126	struct max98373_priv *max98373 = snd_soc_component_get_drvdata(component);
    127	unsigned int format = 0;
    128	unsigned int invert = 0;
    129
    130	dev_dbg(component->dev, "%s: fmt 0x%08X\n", __func__, fmt);
    131
    132	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
    133	case SND_SOC_DAIFMT_NB_NF:
    134		break;
    135	case SND_SOC_DAIFMT_IB_NF:
    136		invert = MAX98373_PCM_MODE_CFG_PCM_BCLKEDGE;
    137		break;
    138	default:
    139		dev_err(component->dev, "DAI invert mode unsupported\n");
    140		return -EINVAL;
    141	}
    142
    143	regmap_update_bits(max98373->regmap,
    144			   MAX98373_R2026_PCM_CLOCK_RATIO,
    145			   MAX98373_PCM_MODE_CFG_PCM_BCLKEDGE,
    146			   invert);
    147
    148	/* interface format */
    149	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
    150	case SND_SOC_DAIFMT_I2S:
    151		format = MAX98373_PCM_FORMAT_I2S;
    152		break;
    153	case SND_SOC_DAIFMT_LEFT_J:
    154		format = MAX98373_PCM_FORMAT_LJ;
    155		break;
    156	case SND_SOC_DAIFMT_DSP_A:
    157		format = MAX98373_PCM_FORMAT_TDM_MODE1;
    158		break;
    159	case SND_SOC_DAIFMT_DSP_B:
    160		format = MAX98373_PCM_FORMAT_TDM_MODE0;
    161		break;
    162	default:
    163		return -EINVAL;
    164	}
    165
    166	regmap_update_bits(max98373->regmap,
    167			   MAX98373_R2024_PCM_DATA_FMT_CFG,
    168			   MAX98373_PCM_MODE_CFG_FORMAT_MASK,
    169			   format << MAX98373_PCM_MODE_CFG_FORMAT_SHIFT);
    170
    171	return 0;
    172}
    173
    174/* BCLKs per LRCLK */
    175static const int bclk_sel_table[] = {
    176	32, 48, 64, 96, 128, 192, 256, 384, 512, 320,
    177};
    178
    179static int max98373_get_bclk_sel(int bclk)
    180{
    181	int i;
    182	/* match BCLKs per LRCLK */
    183	for (i = 0; i < ARRAY_SIZE(bclk_sel_table); i++) {
    184		if (bclk_sel_table[i] == bclk)
    185			return i + 2;
    186	}
    187	return 0;
    188}
    189
    190static int max98373_set_clock(struct snd_soc_component *component,
    191			      struct snd_pcm_hw_params *params)
    192{
    193	struct max98373_priv *max98373 = snd_soc_component_get_drvdata(component);
    194	/* BCLK/LRCLK ratio calculation */
    195	int blr_clk_ratio = params_channels(params) * max98373->ch_size;
    196	int value;
    197
    198	if (!max98373->tdm_mode) {
    199		/* BCLK configuration */
    200		value = max98373_get_bclk_sel(blr_clk_ratio);
    201		if (!value) {
    202			dev_err(component->dev, "format unsupported %d\n",
    203				params_format(params));
    204			return -EINVAL;
    205		}
    206
    207		regmap_update_bits(max98373->regmap,
    208				   MAX98373_R2026_PCM_CLOCK_RATIO,
    209				   MAX98373_PCM_CLK_SETUP_BSEL_MASK,
    210				   value);
    211	}
    212	return 0;
    213}
    214
    215static int max98373_dai_hw_params(struct snd_pcm_substream *substream,
    216				  struct snd_pcm_hw_params *params,
    217				  struct snd_soc_dai *dai)
    218{
    219	struct snd_soc_component *component = dai->component;
    220	struct max98373_priv *max98373 = snd_soc_component_get_drvdata(component);
    221	unsigned int sampling_rate = 0;
    222	unsigned int chan_sz = 0;
    223
    224	/* pcm mode configuration */
    225	switch (snd_pcm_format_width(params_format(params))) {
    226	case 16:
    227		chan_sz = MAX98373_PCM_MODE_CFG_CHANSZ_16;
    228		break;
    229	case 24:
    230		chan_sz = MAX98373_PCM_MODE_CFG_CHANSZ_24;
    231		break;
    232	case 32:
    233		chan_sz = MAX98373_PCM_MODE_CFG_CHANSZ_32;
    234		break;
    235	default:
    236		dev_err(component->dev, "format unsupported %d\n",
    237			params_format(params));
    238		goto err;
    239	}
    240
    241	max98373->ch_size = snd_pcm_format_width(params_format(params));
    242
    243	regmap_update_bits(max98373->regmap,
    244			   MAX98373_R2024_PCM_DATA_FMT_CFG,
    245			   MAX98373_PCM_MODE_CFG_CHANSZ_MASK, chan_sz);
    246
    247	dev_dbg(component->dev, "format supported %d",
    248		params_format(params));
    249
    250	/* sampling rate configuration */
    251	switch (params_rate(params)) {
    252	case 8000:
    253		sampling_rate = MAX98373_PCM_SR_SET1_SR_8000;
    254		break;
    255	case 11025:
    256		sampling_rate = MAX98373_PCM_SR_SET1_SR_11025;
    257		break;
    258	case 12000:
    259		sampling_rate = MAX98373_PCM_SR_SET1_SR_12000;
    260		break;
    261	case 16000:
    262		sampling_rate = MAX98373_PCM_SR_SET1_SR_16000;
    263		break;
    264	case 22050:
    265		sampling_rate = MAX98373_PCM_SR_SET1_SR_22050;
    266		break;
    267	case 24000:
    268		sampling_rate = MAX98373_PCM_SR_SET1_SR_24000;
    269		break;
    270	case 32000:
    271		sampling_rate = MAX98373_PCM_SR_SET1_SR_32000;
    272		break;
    273	case 44100:
    274		sampling_rate = MAX98373_PCM_SR_SET1_SR_44100;
    275		break;
    276	case 48000:
    277		sampling_rate = MAX98373_PCM_SR_SET1_SR_48000;
    278		break;
    279	case 88200:
    280		sampling_rate = MAX98373_PCM_SR_SET1_SR_88200;
    281		break;
    282	case 96000:
    283		sampling_rate = MAX98373_PCM_SR_SET1_SR_96000;
    284		break;
    285	default:
    286		dev_err(component->dev, "rate %d not supported\n",
    287			params_rate(params));
    288		goto err;
    289	}
    290
    291	/* set DAI_SR to correct LRCLK frequency */
    292	regmap_update_bits(max98373->regmap,
    293			   MAX98373_R2027_PCM_SR_SETUP_1,
    294			   MAX98373_PCM_SR_SET1_SR_MASK,
    295			   sampling_rate);
    296	regmap_update_bits(max98373->regmap,
    297			   MAX98373_R2028_PCM_SR_SETUP_2,
    298			   MAX98373_PCM_SR_SET2_SR_MASK,
    299			   sampling_rate << MAX98373_PCM_SR_SET2_SR_SHIFT);
    300
    301	/* set sampling rate of IV */
    302	if (max98373->interleave_mode &&
    303	    sampling_rate > MAX98373_PCM_SR_SET1_SR_16000)
    304		regmap_update_bits(max98373->regmap,
    305				   MAX98373_R2028_PCM_SR_SETUP_2,
    306				   MAX98373_PCM_SR_SET2_IVADC_SR_MASK,
    307				   sampling_rate - 3);
    308	else
    309		regmap_update_bits(max98373->regmap,
    310				   MAX98373_R2028_PCM_SR_SETUP_2,
    311				   MAX98373_PCM_SR_SET2_IVADC_SR_MASK,
    312				   sampling_rate);
    313
    314	return max98373_set_clock(component, params);
    315err:
    316	return -EINVAL;
    317}
    318
    319static int max98373_dai_tdm_slot(struct snd_soc_dai *dai,
    320				 unsigned int tx_mask, unsigned int rx_mask,
    321				 int slots, int slot_width)
    322{
    323	struct snd_soc_component *component = dai->component;
    324	struct max98373_priv *max98373 = snd_soc_component_get_drvdata(component);
    325	int bsel = 0;
    326	unsigned int chan_sz = 0;
    327	unsigned int mask;
    328	int x, slot_found;
    329
    330	if (!tx_mask && !rx_mask && !slots && !slot_width)
    331		max98373->tdm_mode = false;
    332	else
    333		max98373->tdm_mode = true;
    334
    335	/* BCLK configuration */
    336	bsel = max98373_get_bclk_sel(slots * slot_width);
    337	if (bsel == 0) {
    338		dev_err(component->dev, "BCLK %d not supported\n",
    339			slots * slot_width);
    340		return -EINVAL;
    341	}
    342
    343	regmap_update_bits(max98373->regmap,
    344			   MAX98373_R2026_PCM_CLOCK_RATIO,
    345			   MAX98373_PCM_CLK_SETUP_BSEL_MASK,
    346			   bsel);
    347
    348	/* Channel size configuration */
    349	switch (slot_width) {
    350	case 16:
    351		chan_sz = MAX98373_PCM_MODE_CFG_CHANSZ_16;
    352		break;
    353	case 24:
    354		chan_sz = MAX98373_PCM_MODE_CFG_CHANSZ_24;
    355		break;
    356	case 32:
    357		chan_sz = MAX98373_PCM_MODE_CFG_CHANSZ_32;
    358		break;
    359	default:
    360		dev_err(component->dev, "format unsupported %d\n",
    361			slot_width);
    362		return -EINVAL;
    363	}
    364
    365	regmap_update_bits(max98373->regmap,
    366			   MAX98373_R2024_PCM_DATA_FMT_CFG,
    367			   MAX98373_PCM_MODE_CFG_CHANSZ_MASK, chan_sz);
    368
    369	/* Rx slot configuration */
    370	slot_found = 0;
    371	mask = rx_mask;
    372	for (x = 0 ; x < 16 ; x++, mask >>= 1) {
    373		if (mask & 0x1) {
    374			if (slot_found == 0)
    375				regmap_update_bits(max98373->regmap,
    376						   MAX98373_R2029_PCM_TO_SPK_MONO_MIX_1,
    377						   MAX98373_PCM_TO_SPK_CH0_SRC_MASK, x);
    378			else
    379				regmap_write(max98373->regmap,
    380					     MAX98373_R202A_PCM_TO_SPK_MONO_MIX_2,
    381					     x);
    382			slot_found++;
    383			if (slot_found > 1)
    384				break;
    385		}
    386	}
    387
    388	/* Tx slot Hi-Z configuration */
    389	regmap_write(max98373->regmap,
    390		     MAX98373_R2020_PCM_TX_HIZ_EN_1,
    391		     ~tx_mask & 0xFF);
    392	regmap_write(max98373->regmap,
    393		     MAX98373_R2021_PCM_TX_HIZ_EN_2,
    394		     (~tx_mask & 0xFF00) >> 8);
    395
    396	return 0;
    397}
    398
    399#define MAX98373_RATES SNDRV_PCM_RATE_8000_96000
    400
    401#define MAX98373_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \
    402	SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE)
    403
    404static const struct snd_soc_dai_ops max98373_dai_ops = {
    405	.set_fmt = max98373_dai_set_fmt,
    406	.hw_params = max98373_dai_hw_params,
    407	.set_tdm_slot = max98373_dai_tdm_slot,
    408};
    409
    410static bool max98373_readable_register(struct device *dev, unsigned int reg)
    411{
    412	switch (reg) {
    413	case MAX98373_R2000_SW_RESET:
    414	case MAX98373_R2001_INT_RAW1 ... MAX98373_R200C_INT_EN3:
    415	case MAX98373_R2010_IRQ_CTRL:
    416	case MAX98373_R2014_THERM_WARN_THRESH
    417		... MAX98373_R2018_THERM_FOLDBACK_EN:
    418	case MAX98373_R201E_PIN_DRIVE_STRENGTH
    419		... MAX98373_R2036_SOUNDWIRE_CTRL:
    420	case MAX98373_R203D_AMP_DIG_VOL_CTRL ... MAX98373_R2043_AMP_EN:
    421	case MAX98373_R2046_IV_SENSE_ADC_DSP_CFG
    422		... MAX98373_R2047_IV_SENSE_ADC_EN:
    423	case MAX98373_R2051_MEAS_ADC_SAMPLING_RATE
    424		... MAX98373_R2056_MEAS_ADC_PVDD_CH_EN:
    425	case MAX98373_R2090_BDE_LVL_HOLD ... MAX98373_R2092_BDE_CLIPPER_MODE:
    426	case MAX98373_R2097_BDE_L1_THRESH
    427		... MAX98373_R209B_BDE_THRESH_HYST:
    428	case MAX98373_R20A8_BDE_L1_CFG_1 ... MAX98373_R20B3_BDE_L4_CFG_3:
    429	case MAX98373_R20B5_BDE_EN ... MAX98373_R20B6_BDE_CUR_STATE_READBACK:
    430	case MAX98373_R20D1_DHT_CFG ... MAX98373_R20D4_DHT_EN:
    431	case MAX98373_R20E0_LIMITER_THRESH_CFG ... MAX98373_R20E2_LIMITER_EN:
    432	case MAX98373_R20FE_DEVICE_AUTO_RESTART_CFG
    433		... MAX98373_R20FF_GLOBAL_SHDN:
    434	case MAX98373_R21FF_REV_ID:
    435		return true;
    436	default:
    437		return false;
    438	}
    439};
    440
    441static bool max98373_volatile_reg(struct device *dev, unsigned int reg)
    442{
    443	switch (reg) {
    444	case MAX98373_R2000_SW_RESET ... MAX98373_R2009_INT_FLAG3:
    445	case MAX98373_R203E_AMP_PATH_GAIN:
    446	case MAX98373_R2054_MEAS_ADC_PVDD_CH_READBACK:
    447	case MAX98373_R2055_MEAS_ADC_THERM_CH_READBACK:
    448	case MAX98373_R20B6_BDE_CUR_STATE_READBACK:
    449	case MAX98373_R20FF_GLOBAL_SHDN:
    450	case MAX98373_R21FF_REV_ID:
    451		return true;
    452	default:
    453		return false;
    454	}
    455}
    456
    457static struct snd_soc_dai_driver max98373_dai[] = {
    458	{
    459		.name = "max98373-aif1",
    460		.playback = {
    461			.stream_name = "HiFi Playback",
    462			.channels_min = 1,
    463			.channels_max = 2,
    464			.rates = MAX98373_RATES,
    465			.formats = MAX98373_FORMATS,
    466		},
    467		.capture = {
    468			.stream_name = "HiFi Capture",
    469			.channels_min = 1,
    470			.channels_max = 2,
    471			.rates = MAX98373_RATES,
    472			.formats = MAX98373_FORMATS,
    473		},
    474		.ops = &max98373_dai_ops,
    475	}
    476};
    477
    478#ifdef CONFIG_PM_SLEEP
    479static int max98373_suspend(struct device *dev)
    480{
    481	struct max98373_priv *max98373 = dev_get_drvdata(dev);
    482	int i;
    483
    484	/* cache feedback register values before suspend */
    485	for (i = 0; i < max98373->cache_num; i++)
    486		regmap_read(max98373->regmap, max98373->cache[i].reg, &max98373->cache[i].val);
    487
    488	regcache_cache_only(max98373->regmap, true);
    489	regcache_mark_dirty(max98373->regmap);
    490	return 0;
    491}
    492
    493static int max98373_resume(struct device *dev)
    494{
    495	struct max98373_priv *max98373 = dev_get_drvdata(dev);
    496
    497	regcache_cache_only(max98373->regmap, false);
    498	max98373_reset(max98373, dev);
    499	regcache_sync(max98373->regmap);
    500	return 0;
    501}
    502#endif
    503
    504static const struct dev_pm_ops max98373_pm = {
    505	SET_SYSTEM_SLEEP_PM_OPS(max98373_suspend, max98373_resume)
    506};
    507
    508static const struct regmap_config max98373_regmap = {
    509	.reg_bits = 16,
    510	.val_bits = 8,
    511	.max_register = MAX98373_R21FF_REV_ID,
    512	.reg_defaults  = max98373_reg,
    513	.num_reg_defaults = ARRAY_SIZE(max98373_reg),
    514	.readable_reg = max98373_readable_register,
    515	.volatile_reg = max98373_volatile_reg,
    516	.cache_type = REGCACHE_RBTREE,
    517};
    518
    519static int max98373_i2c_probe(struct i2c_client *i2c)
    520{
    521	int ret = 0;
    522	int reg = 0;
    523	int i;
    524	struct max98373_priv *max98373 = NULL;
    525
    526	max98373 = devm_kzalloc(&i2c->dev, sizeof(*max98373), GFP_KERNEL);
    527
    528	if (!max98373) {
    529		ret = -ENOMEM;
    530		return ret;
    531	}
    532	i2c_set_clientdata(i2c, max98373);
    533
    534	/* update interleave mode info */
    535	if (device_property_read_bool(&i2c->dev, "maxim,interleave_mode"))
    536		max98373->interleave_mode = true;
    537	else
    538		max98373->interleave_mode = false;
    539
    540	/* regmap initialization */
    541	max98373->regmap = devm_regmap_init_i2c(i2c, &max98373_regmap);
    542	if (IS_ERR(max98373->regmap)) {
    543		ret = PTR_ERR(max98373->regmap);
    544		dev_err(&i2c->dev,
    545			"Failed to allocate regmap: %d\n", ret);
    546		return ret;
    547	}
    548
    549	max98373->cache_num = ARRAY_SIZE(max98373_i2c_cache_reg);
    550	max98373->cache = devm_kcalloc(&i2c->dev, max98373->cache_num,
    551				       sizeof(*max98373->cache),
    552				       GFP_KERNEL);
    553
    554	for (i = 0; i < max98373->cache_num; i++)
    555		max98373->cache[i].reg = max98373_i2c_cache_reg[i];
    556
    557	/* voltage/current slot & gpio configuration */
    558	max98373_slot_config(&i2c->dev, max98373);
    559
    560	/* Power on device */
    561	if (gpio_is_valid(max98373->reset_gpio)) {
    562		ret = devm_gpio_request(&i2c->dev, max98373->reset_gpio,
    563					"MAX98373_RESET");
    564		if (ret) {
    565			dev_err(&i2c->dev, "%s: Failed to request gpio %d\n",
    566				__func__, max98373->reset_gpio);
    567			return -EINVAL;
    568		}
    569		gpio_direction_output(max98373->reset_gpio, 0);
    570		msleep(50);
    571		gpio_direction_output(max98373->reset_gpio, 1);
    572		msleep(20);
    573	}
    574
    575	/* Check Revision ID */
    576	ret = regmap_read(max98373->regmap,
    577			  MAX98373_R21FF_REV_ID, &reg);
    578	if (ret < 0) {
    579		dev_err(&i2c->dev,
    580			"Failed to read: 0x%02X\n", MAX98373_R21FF_REV_ID);
    581		return ret;
    582	}
    583	dev_info(&i2c->dev, "MAX98373 revisionID: 0x%02X\n", reg);
    584
    585	/* codec registration */
    586	ret = devm_snd_soc_register_component(&i2c->dev, &soc_codec_dev_max98373,
    587					      max98373_dai, ARRAY_SIZE(max98373_dai));
    588	if (ret < 0)
    589		dev_err(&i2c->dev, "Failed to register codec: %d\n", ret);
    590
    591	return ret;
    592}
    593
    594static const struct i2c_device_id max98373_i2c_id[] = {
    595	{ "max98373", 0},
    596	{ },
    597};
    598
    599MODULE_DEVICE_TABLE(i2c, max98373_i2c_id);
    600
    601#if defined(CONFIG_OF)
    602static const struct of_device_id max98373_of_match[] = {
    603	{ .compatible = "maxim,max98373", },
    604	{ }
    605};
    606MODULE_DEVICE_TABLE(of, max98373_of_match);
    607#endif
    608
    609#ifdef CONFIG_ACPI
    610static const struct acpi_device_id max98373_acpi_match[] = {
    611	{ "MX98373", 0 },
    612	{},
    613};
    614MODULE_DEVICE_TABLE(acpi, max98373_acpi_match);
    615#endif
    616
    617static struct i2c_driver max98373_i2c_driver = {
    618	.driver = {
    619		.name = "max98373",
    620		.of_match_table = of_match_ptr(max98373_of_match),
    621		.acpi_match_table = ACPI_PTR(max98373_acpi_match),
    622		.pm = &max98373_pm,
    623	},
    624	.probe_new = max98373_i2c_probe,
    625	.id_table = max98373_i2c_id,
    626};
    627
    628module_i2c_driver(max98373_i2c_driver)
    629
    630MODULE_DESCRIPTION("ALSA SoC MAX98373 driver");
    631MODULE_AUTHOR("Ryan Lee <ryans.lee@maximintegrated.com>");
    632MODULE_LICENSE("GPL");