Skip to content

L
linux
Commit 552206ad authored by Maciej Strozek's avatar Maciej Strozek Committed by Mark Brown
Browse files
Options

ASoC: cs43130: Store device in private struct and use it more consistently 

Also remove one unnecessary debug print
Signed-off-by: default avatarMaciej Strozek <mstrozek@opensource.cirrus.com>
Acked-by: default avatarCharles Keepax <ckeepax@opensource.cirrus.com>
Link: https://lore.kernel.org/r/20231117141344.64320-5-mstrozek@opensource.cirrus.comSigned-off-by: default avatarMark Brown <broonie@kernel.org>
parent aa7e8e5e
Show whitespace changes
Inline Side-by-side
Showing with 75 additions and 77 deletions
sound/soc/codecs/cs43130.c
View file @ 552206ad
...@@ -238,7 +238,7 @@ static int cs43130_pll_config(struct snd_soc_component *component) ...@@ -238,7 +238,7 @@ static int cs43130_pll_config(struct snd_soc_component *component)
struct cs43130_private *cs43130 = snd_soc_component_get_drvdata(component); struct cs43130_private *cs43130 = snd_soc_component_get_drvdata(component);
const struct cs43130_pll_params *pll_entry; const struct cs43130_pll_params *pll_entry;
dev_dbg(component->dev, "cs43130->mclk = %u, cs43130->mclk_int = %u\n", dev_dbg(cs43130->dev, "cs43130->mclk = %u, cs43130->mclk_int = %u\n",
cs43130->mclk, cs43130->mclk_int); cs43130->mclk, cs43130->mclk_int);
pll_entry = cs43130_get_pll_table(cs43130->mclk, cs43130->mclk_int); pll_entry = cs43130_get_pll_table(cs43130->mclk, cs43130->mclk_int);
...@@ -303,7 +303,7 @@ static int cs43130_set_pll(struct snd_soc_component *component, int pll_id, int ...@@ -303,7 +303,7 @@ static int cs43130_set_pll(struct snd_soc_component *component, int pll_id, int
cs43130->mclk = freq_in; cs43130->mclk = freq_in;
break; break;
default: default:
dev_err(component->dev, dev_err(cs43130->dev,
"unsupported pll input reference clock:%d\n", freq_in); "unsupported pll input reference clock:%d\n", freq_in);
return -EINVAL; return -EINVAL;
} }
...@@ -316,13 +316,13 @@ static int cs43130_set_pll(struct snd_soc_component *component, int pll_id, int ...@@ -316,13 +316,13 @@ static int cs43130_set_pll(struct snd_soc_component *component, int pll_id, int
cs43130->mclk_int = freq_out; cs43130->mclk_int = freq_out;
break; break;
default: default:
dev_err(component->dev, dev_err(cs43130->dev,
"unsupported pll output ref clock: %u\n", freq_out); "unsupported pll output ref clock: %u\n", freq_out);
return -EINVAL; return -EINVAL;
} }
ret = cs43130_pll_config(component); ret = cs43130_pll_config(component);
dev_dbg(component->dev, "cs43130->pll_bypass = %d", cs43130->pll_bypass); dev_dbg(cs43130->dev, "cs43130->pll_bypass = %d", cs43130->pll_bypass);
return ret; return ret;
} }
...@@ -346,7 +346,7 @@ static int cs43130_change_clksrc(struct snd_soc_component *component, ...@@ -346,7 +346,7 @@ static int cs43130_change_clksrc(struct snd_soc_component *component,
mclk_int_decoded = CS43130_MCLK_24P5; mclk_int_decoded = CS43130_MCLK_24P5;
break; break;
default: default:
dev_err(component->dev, "Invalid MCLK INT freq: %u\n", cs43130->mclk_int); dev_err(cs43130->dev, "Invalid MCLK INT freq: %u\n", cs43130->mclk_int);
return -EINVAL; return -EINVAL;
} }
...@@ -370,7 +370,7 @@ static int cs43130_change_clksrc(struct snd_soc_component *component, ...@@ -370,7 +370,7 @@ static int cs43130_change_clksrc(struct snd_soc_component *component,
CS43130_XTAL_RDY_INT_MASK, CS43130_XTAL_RDY_INT_MASK,
1 << CS43130_XTAL_RDY_INT_SHIFT); 1 << CS43130_XTAL_RDY_INT_SHIFT);
if (ret == 0) { if (ret == 0) {
dev_err(component->dev, "Timeout waiting for XTAL_READY interrupt\n"); dev_err(cs43130->dev, "Timeout waiting for XTAL_READY interrupt\n");
return -ETIMEDOUT; return -ETIMEDOUT;
} }
} }
...@@ -406,7 +406,7 @@ static int cs43130_change_clksrc(struct snd_soc_component *component, ...@@ -406,7 +406,7 @@ static int cs43130_change_clksrc(struct snd_soc_component *component,
CS43130_XTAL_RDY_INT_MASK, CS43130_XTAL_RDY_INT_MASK,
1 << CS43130_XTAL_RDY_INT_SHIFT); 1 << CS43130_XTAL_RDY_INT_SHIFT);
if (ret == 0) { if (ret == 0) {
dev_err(component->dev, "Timeout waiting for XTAL_READY interrupt\n"); dev_err(cs43130->dev, "Timeout waiting for XTAL_READY interrupt\n");
return -ETIMEDOUT; return -ETIMEDOUT;
} }
} }
...@@ -422,7 +422,7 @@ static int cs43130_change_clksrc(struct snd_soc_component *component, ...@@ -422,7 +422,7 @@ static int cs43130_change_clksrc(struct snd_soc_component *component,
CS43130_PLL_RDY_INT_MASK, CS43130_PLL_RDY_INT_MASK,
1 << CS43130_PLL_RDY_INT_SHIFT); 1 << CS43130_PLL_RDY_INT_SHIFT);
if (ret == 0) { if (ret == 0) {
dev_err(component->dev, "Timeout waiting for PLL_READY interrupt\n"); dev_err(cs43130->dev, "Timeout waiting for PLL_READY interrupt\n");
return -ETIMEDOUT; return -ETIMEDOUT;
} }
...@@ -453,7 +453,7 @@ static int cs43130_change_clksrc(struct snd_soc_component *component, ...@@ -453,7 +453,7 @@ static int cs43130_change_clksrc(struct snd_soc_component *component,
1 << CS43130_PDN_PLL_SHIFT); 1 << CS43130_PDN_PLL_SHIFT);
break; break;
default: default:
dev_err(component->dev, "Invalid MCLK source value\n"); dev_err(cs43130->dev, "Invalid MCLK source value\n");
return -EINVAL; return -EINVAL;
} }
...@@ -804,7 +804,7 @@ static int cs43130_dsd_hw_params(struct snd_pcm_substream *substream, ...@@ -804,7 +804,7 @@ static int cs43130_dsd_hw_params(struct snd_pcm_substream *substream,
dsd_speed = 1; dsd_speed = 1;
break; break;
default: default:
dev_err(component->dev, "Rate(%u) not supported\n", dev_err(cs43130->dev, "Rate(%u) not supported\n",
params_rate(params)); params_rate(params));
return -EINVAL; return -EINVAL;
} }
...@@ -875,7 +875,7 @@ static int cs43130_hw_params(struct snd_pcm_substream *substream, ...@@ -875,7 +875,7 @@ static int cs43130_hw_params(struct snd_pcm_substream *substream,
dsd_speed = 1; dsd_speed = 1;
break; break;
default: default:
dev_err(component->dev, "Rate(%u) not supported\n", dev_err(cs43130->dev, "Rate(%u) not supported\n",
params_rate(params)); params_rate(params));
return -EINVAL; return -EINVAL;
} }
...@@ -892,7 +892,7 @@ static int cs43130_hw_params(struct snd_pcm_substream *substream, ...@@ -892,7 +892,7 @@ static int cs43130_hw_params(struct snd_pcm_substream *substream,
regmap_write(cs43130->regmap, CS43130_SP_SRATE, rate_map->val); regmap_write(cs43130->regmap, CS43130_SP_SRATE, rate_map->val);
break; break;
default: default:
dev_err(component->dev, "Invalid DAI (%d)\n", dai->id); dev_err(cs43130->dev, "Invalid DAI (%d)\n", dai->id);
return -EINVAL; return -EINVAL;
} }
...@@ -916,21 +916,21 @@ static int cs43130_hw_params(struct snd_pcm_substream *substream, ...@@ -916,21 +916,21 @@ static int cs43130_hw_params(struct snd_pcm_substream *substream,
if (!sclk) { if (!sclk) {
/* at this point, SCLK must be set */ /* at this point, SCLK must be set */
dev_err(component->dev, "SCLK freq is not set\n"); dev_err(cs43130->dev, "SCLK freq is not set\n");
return -EINVAL; return -EINVAL;
} }
bitwidth_sclk = (sclk / params_rate(params)) / params_channels(params); bitwidth_sclk = (sclk / params_rate(params)) / params_channels(params);
if (bitwidth_sclk < bitwidth_dai) { if (bitwidth_sclk < bitwidth_dai) {
dev_err(component->dev, "Format not supported: SCLK freq is too low\n"); dev_err(cs43130->dev, "Format not supported: SCLK freq is too low\n");
return -EINVAL; return -EINVAL;
} }
dev_dbg(component->dev, dev_dbg(cs43130->dev,
"sclk = %u, fs = %d, bitwidth_dai = %u\n", "sclk = %u, fs = %d, bitwidth_dai = %u\n",
sclk, params_rate(params), bitwidth_dai); sclk, params_rate(params), bitwidth_dai);
dev_dbg(component->dev, dev_dbg(cs43130->dev,
"bitwidth_sclk = %u, num_ch = %u\n", "bitwidth_sclk = %u, num_ch = %u\n",
bitwidth_sclk, params_channels(params)); bitwidth_sclk, params_channels(params));
...@@ -1189,7 +1189,7 @@ static int cs43130_dsd_event(struct snd_soc_dapm_widget *w, ...@@ -1189,7 +1189,7 @@ static int cs43130_dsd_event(struct snd_soc_dapm_widget *w,
} }
break; break;
default: default:
dev_err(component->dev, "Invalid event = 0x%x\n", event); dev_err(cs43130->dev, "Invalid event = 0x%x\n", event);
return -EINVAL; return -EINVAL;
} }
return 0; return 0;
...@@ -1246,7 +1246,7 @@ static int cs43130_pcm_event(struct snd_soc_dapm_widget *w, ...@@ -1246,7 +1246,7 @@ static int cs43130_pcm_event(struct snd_soc_dapm_widget *w,
} }
break; break;
default: default:
dev_err(component->dev, "Invalid event = 0x%x\n", event); dev_err(cs43130->dev, "Invalid event = 0x%x\n", event);
return -EINVAL; return -EINVAL;
} }
return 0; return 0;
...@@ -1322,7 +1322,7 @@ static int cs43130_dac_event(struct snd_soc_dapm_widget *w, ...@@ -1322,7 +1322,7 @@ static int cs43130_dac_event(struct snd_soc_dapm_widget *w,
} }
break; break;
default: default:
dev_err(component->dev, "Invalid DAC event = 0x%x\n", event); dev_err(cs43130->dev, "Invalid DAC event = 0x%x\n", event);
return -EINVAL; return -EINVAL;
} }
return 0; return 0;
...@@ -1360,7 +1360,7 @@ static int cs43130_hpin_event(struct snd_soc_dapm_widget *w, ...@@ -1360,7 +1360,7 @@ static int cs43130_hpin_event(struct snd_soc_dapm_widget *w,
ARRAY_SIZE(hpin_postpmu_seq)); ARRAY_SIZE(hpin_postpmu_seq));
break; break;
default: default:
dev_err(component->dev, "Invalid HPIN event = 0x%x\n", event); dev_err(cs43130->dev, "Invalid HPIN event = 0x%x\n", event);
return -EINVAL; return -EINVAL;
} }
return 0; return 0;
...@@ -1479,7 +1479,7 @@ static int cs43130_pcm_set_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt) ...@@ -1479,7 +1479,7 @@ static int cs43130_pcm_set_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
cs43130->dais[codec_dai->id].dai_mode = SND_SOC_DAIFMT_CBM_CFM; cs43130->dais[codec_dai->id].dai_mode = SND_SOC_DAIFMT_CBM_CFM;
break; break;
default: default:
dev_err(component->dev, "unsupported mode\n"); dev_err(cs43130->dev, "unsupported mode\n");
return -EINVAL; return -EINVAL;
} }
...@@ -1497,12 +1497,12 @@ static int cs43130_pcm_set_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt) ...@@ -1497,12 +1497,12 @@ static int cs43130_pcm_set_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
cs43130->dais[codec_dai->id].dai_format = SND_SOC_DAIFMT_DSP_B; cs43130->dais[codec_dai->id].dai_format = SND_SOC_DAIFMT_DSP_B;
break; break;
default: default:
dev_err(component->dev, dev_err(cs43130->dev,
"unsupported audio format\n"); "unsupported audio format\n");
return -EINVAL; return -EINVAL;
} }
dev_dbg(component->dev, "dai_id = %d, dai_mode = %u, dai_format = %u\n", dev_dbg(cs43130->dev, "dai_id = %d, dai_mode = %u, dai_format = %u\n",
codec_dai->id, codec_dai->id,
cs43130->dais[codec_dai->id].dai_mode, cs43130->dais[codec_dai->id].dai_mode,
cs43130->dais[codec_dai->id].dai_format); cs43130->dais[codec_dai->id].dai_format);
...@@ -1523,11 +1523,11 @@ static int cs43130_dsd_set_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt) ...@@ -1523,11 +1523,11 @@ static int cs43130_dsd_set_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
cs43130->dais[codec_dai->id].dai_mode = SND_SOC_DAIFMT_CBM_CFM; cs43130->dais[codec_dai->id].dai_mode = SND_SOC_DAIFMT_CBM_CFM;
break; break;
default: default:
dev_err(component->dev, "Unsupported DAI format.\n"); dev_err(cs43130->dev, "Unsupported DAI format.\n");
return -EINVAL; return -EINVAL;
} }
dev_dbg(component->dev, "dai_mode = 0x%x\n", dev_dbg(cs43130->dev, "dai_mode = 0x%x\n",
cs43130->dais[codec_dai->id].dai_mode); cs43130->dais[codec_dai->id].dai_mode);
return 0; return 0;
...@@ -1540,7 +1540,7 @@ static int cs43130_set_sysclk(struct snd_soc_dai *codec_dai, ...@@ -1540,7 +1540,7 @@ static int cs43130_set_sysclk(struct snd_soc_dai *codec_dai,
struct cs43130_private *cs43130 = snd_soc_component_get_drvdata(component); struct cs43130_private *cs43130 = snd_soc_component_get_drvdata(component);
cs43130->dais[codec_dai->id].sclk = freq; cs43130->dais[codec_dai->id].sclk = freq;
dev_dbg(component->dev, "dai_id = %d, sclk = %u\n", codec_dai->id, dev_dbg(cs43130->dev, "dai_id = %d, sclk = %u\n", codec_dai->id,
cs43130->dais[codec_dai->id].sclk); cs43130->dais[codec_dai->id].sclk);
return 0; return 0;
...@@ -1630,7 +1630,7 @@ static int cs43130_component_set_sysclk(struct snd_soc_component *component, ...@@ -1630,7 +1630,7 @@ static int cs43130_component_set_sysclk(struct snd_soc_component *component,
{ {
struct cs43130_private *cs43130 = snd_soc_component_get_drvdata(component); struct cs43130_private *cs43130 = snd_soc_component_get_drvdata(component);
dev_dbg(component->dev, "clk_id = %d, source = %d, freq = %d, dir = %d\n", dev_dbg(cs43130->dev, "clk_id = %d, source = %d, freq = %d, dir = %d\n",
clk_id, source, freq, dir); clk_id, source, freq, dir);
switch (freq) { switch (freq) {
...@@ -1639,14 +1639,14 @@ static int cs43130_component_set_sysclk(struct snd_soc_component *component, ...@@ -1639,14 +1639,14 @@ static int cs43130_component_set_sysclk(struct snd_soc_component *component,
cs43130->mclk = freq; cs43130->mclk = freq;
break; break;
default: default:
dev_err(component->dev, "Invalid MCLK INT freq: %u\n", freq); dev_err(cs43130->dev, "Invalid MCLK INT freq: %u\n", freq);
return -EINVAL; return -EINVAL;
} }
if (source == CS43130_MCLK_SRC_EXT) { if (source == CS43130_MCLK_SRC_EXT) {
cs43130->pll_bypass = true; cs43130->pll_bypass = true;
} else { } else {
dev_err(component->dev, "Invalid MCLK source\n"); dev_err(cs43130->dev, "Invalid MCLK source\n");
return -EINVAL; return -EINVAL;
} }
...@@ -1933,7 +1933,6 @@ static int cs43130_update_hpload(unsigned int msk, int ac_idx, ...@@ -1933,7 +1933,6 @@ static int cs43130_update_hpload(unsigned int msk, int ac_idx,
unsigned int reg; unsigned int reg;
u32 addr; u32 addr;
u16 impedance; u16 impedance;
struct snd_soc_component *component = cs43130->component;
switch (msk) { switch (msk) {
case CS43130_HPLOAD_DC_INT: case CS43130_HPLOAD_DC_INT:
...@@ -1963,7 +1962,7 @@ static int cs43130_update_hpload(unsigned int msk, int ac_idx, ...@@ -1963,7 +1962,7 @@ static int cs43130_update_hpload(unsigned int msk, int ac_idx,
else else
cs43130->hpload_dc[HP_RIGHT] = impedance; cs43130->hpload_dc[HP_RIGHT] = impedance;
dev_dbg(component->dev, "HP DC impedance (Ch %u): %u\n", !left_ch, dev_dbg(cs43130->dev, "HP DC impedance (Ch %u): %u\n", !left_ch,
impedance); impedance);
} else { } else {
if (left_ch) if (left_ch)
...@@ -1971,7 +1970,7 @@ static int cs43130_update_hpload(unsigned int msk, int ac_idx, ...@@ -1971,7 +1970,7 @@ static int cs43130_update_hpload(unsigned int msk, int ac_idx,
else else
cs43130->hpload_ac[ac_idx][HP_RIGHT] = impedance; cs43130->hpload_ac[ac_idx][HP_RIGHT] = impedance;
dev_dbg(component->dev, "HP AC (%u Hz) impedance (Ch %u): %u\n", dev_dbg(cs43130->dev, "HP AC (%u Hz) impedance (Ch %u): %u\n",
cs43130->ac_freq[ac_idx], !left_ch, impedance); cs43130->ac_freq[ac_idx], !left_ch, impedance);
} }
...@@ -1985,7 +1984,6 @@ static int cs43130_hpload_proc(struct cs43130_private *cs43130, ...@@ -1985,7 +1984,6 @@ static int cs43130_hpload_proc(struct cs43130_private *cs43130,
int ret; int ret;
unsigned int msk; unsigned int msk;
u16 ac_reg_val; u16 ac_reg_val;
struct snd_soc_component *component = cs43130->component;
reinit_completion(&cs43130->hpload_evt); reinit_completion(&cs43130->hpload_evt);
...@@ -2008,17 +2006,17 @@ static int cs43130_hpload_proc(struct cs43130_private *cs43130, ...@@ -2008,17 +2006,17 @@ static int cs43130_hpload_proc(struct cs43130_private *cs43130,
msecs_to_jiffies(1000)); msecs_to_jiffies(1000));
regmap_read(cs43130->regmap, CS43130_INT_MASK_4, &msk); regmap_read(cs43130->regmap, CS43130_INT_MASK_4, &msk);
if (!ret) { if (!ret) {
dev_err(component->dev, "Timeout waiting for HPLOAD interrupt\n"); dev_err(cs43130->dev, "Timeout waiting for HPLOAD interrupt\n");
return -1; return -1;
} }
dev_dbg(component->dev, "HP load stat: %x, INT_MASK_4: %x\n", dev_dbg(cs43130->dev, "HP load stat: %x, INT_MASK_4: %x\n",
cs43130->hpload_stat, msk); cs43130->hpload_stat, msk);
if ((cs43130->hpload_stat & (CS43130_HPLOAD_NO_DC_INT | if ((cs43130->hpload_stat & (CS43130_HPLOAD_NO_DC_INT |
CS43130_HPLOAD_UNPLUG_INT | CS43130_HPLOAD_UNPLUG_INT |
CS43130_HPLOAD_OOR_INT)) || CS43130_HPLOAD_OOR_INT)) ||
!(cs43130->hpload_stat & rslt_msk)) { !(cs43130->hpload_stat & rslt_msk)) {
dev_dbg(component->dev, "HP load measure failed\n"); dev_dbg(cs43130->dev, "HP load measure failed\n");
return -1; return -1;
} }
...@@ -2129,9 +2127,9 @@ static void cs43130_imp_meas(struct work_struct *wk) ...@@ -2129,9 +2127,9 @@ static void cs43130_imp_meas(struct work_struct *wk)
snd_soc_jack_report(&cs43130->jack, CS43130_JACK_HEADPHONE, snd_soc_jack_report(&cs43130->jack, CS43130_JACK_HEADPHONE,
CS43130_JACK_MASK); CS43130_JACK_MASK);
dev_dbg(component->dev, "Set HP output control. DC threshold\n"); dev_dbg(cs43130->dev, "Set HP output control. DC threshold\n");
for (i = 0; i < CS43130_DC_THRESHOLD; i++) for (i = 0; i < CS43130_DC_THRESHOLD; i++)
dev_dbg(component->dev, "DC threshold[%d]: %u.\n", i, dev_dbg(cs43130->dev, "DC threshold[%d]: %u.\n", i,
cs43130->dc_threshold[i]); cs43130->dc_threshold[i]);
cs43130_set_hv(cs43130->regmap, cs43130->hpload_dc[HP_LEFT], cs43130_set_hv(cs43130->regmap, cs43130->hpload_dc[HP_LEFT],
...@@ -2165,7 +2163,6 @@ static void cs43130_imp_meas(struct work_struct *wk) ...@@ -2165,7 +2163,6 @@ static void cs43130_imp_meas(struct work_struct *wk)
static irqreturn_t cs43130_irq_thread(int irq, void *data) static irqreturn_t cs43130_irq_thread(int irq, void *data)
{ {
struct cs43130_private *cs43130 = (struct cs43130_private *)data; struct cs43130_private *cs43130 = (struct cs43130_private *)data;
struct snd_soc_component *component = cs43130->component;
unsigned int stickies[CS43130_NUM_INT]; unsigned int stickies[CS43130_NUM_INT];
unsigned int irq_occurrence = 0; unsigned int irq_occurrence = 0;
unsigned int masks[CS43130_NUM_INT]; unsigned int masks[CS43130_NUM_INT];
...@@ -2183,8 +2180,6 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data) ...@@ -2183,8 +2180,6 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data)
for (j = 0; j < 8; j++) for (j = 0; j < 8; j++)
irq_occurrence += (stickies[i] >> j) & 1; irq_occurrence += (stickies[i] >> j) & 1;
} }
dev_dbg(component->dev, "number of interrupts occurred (%u)\n",
irq_occurrence);
if (!irq_occurrence) if (!irq_occurrence)
return IRQ_NONE; return IRQ_NONE;
...@@ -2201,7 +2196,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data) ...@@ -2201,7 +2196,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data)
if (stickies[3] & CS43130_HPLOAD_NO_DC_INT) { if (stickies[3] & CS43130_HPLOAD_NO_DC_INT) {
cs43130->hpload_stat = stickies[3]; cs43130->hpload_stat = stickies[3];
dev_err(component->dev, dev_err(cs43130->dev,
"DC load has not completed before AC load (%x)\n", "DC load has not completed before AC load (%x)\n",
cs43130->hpload_stat); cs43130->hpload_stat);
complete(&cs43130->hpload_evt); complete(&cs43130->hpload_evt);
...@@ -2210,7 +2205,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data) ...@@ -2210,7 +2205,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data)
if (stickies[3] & CS43130_HPLOAD_UNPLUG_INT) { if (stickies[3] & CS43130_HPLOAD_UNPLUG_INT) {
cs43130->hpload_stat = stickies[3]; cs43130->hpload_stat = stickies[3];
dev_err(component->dev, "HP unplugged during measurement (%x)\n", dev_err(cs43130->dev, "HP unplugged during measurement (%x)\n",
cs43130->hpload_stat); cs43130->hpload_stat);
complete(&cs43130->hpload_evt); complete(&cs43130->hpload_evt);
return IRQ_HANDLED; return IRQ_HANDLED;
...@@ -2218,7 +2213,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data) ...@@ -2218,7 +2213,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data)
if (stickies[3] & CS43130_HPLOAD_OOR_INT) { if (stickies[3] & CS43130_HPLOAD_OOR_INT) {
cs43130->hpload_stat = stickies[3]; cs43130->hpload_stat = stickies[3];
dev_err(component->dev, "HP load out of range (%x)\n", dev_err(cs43130->dev, "HP load out of range (%x)\n",
cs43130->hpload_stat); cs43130->hpload_stat);
complete(&cs43130->hpload_evt); complete(&cs43130->hpload_evt);
return IRQ_HANDLED; return IRQ_HANDLED;
...@@ -2226,7 +2221,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data) ...@@ -2226,7 +2221,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data)
if (stickies[3] & CS43130_HPLOAD_AC_INT) { if (stickies[3] & CS43130_HPLOAD_AC_INT) {
cs43130->hpload_stat = stickies[3]; cs43130->hpload_stat = stickies[3];
dev_dbg(component->dev, "HP AC load measurement done (%x)\n", dev_dbg(cs43130->dev, "HP AC load measurement done (%x)\n",
cs43130->hpload_stat); cs43130->hpload_stat);
complete(&cs43130->hpload_evt); complete(&cs43130->hpload_evt);
return IRQ_HANDLED; return IRQ_HANDLED;
...@@ -2234,7 +2229,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data) ...@@ -2234,7 +2229,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data)
if (stickies[3] & CS43130_HPLOAD_DC_INT) { if (stickies[3] & CS43130_HPLOAD_DC_INT) {
cs43130->hpload_stat = stickies[3]; cs43130->hpload_stat = stickies[3];
dev_dbg(component->dev, "HP DC load measurement done (%x)\n", dev_dbg(cs43130->dev, "HP DC load measurement done (%x)\n",
cs43130->hpload_stat); cs43130->hpload_stat);
complete(&cs43130->hpload_evt); complete(&cs43130->hpload_evt);
return IRQ_HANDLED; return IRQ_HANDLED;
...@@ -2242,7 +2237,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data) ...@@ -2242,7 +2237,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data)
if (stickies[3] & CS43130_HPLOAD_ON_INT) { if (stickies[3] & CS43130_HPLOAD_ON_INT) {
cs43130->hpload_stat = stickies[3]; cs43130->hpload_stat = stickies[3];
dev_dbg(component->dev, "HP load state machine on done (%x)\n", dev_dbg(cs43130->dev, "HP load state machine on done (%x)\n",
cs43130->hpload_stat); cs43130->hpload_stat);
complete(&cs43130->hpload_evt); complete(&cs43130->hpload_evt);
return IRQ_HANDLED; return IRQ_HANDLED;
...@@ -2250,19 +2245,19 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data) ...@@ -2250,19 +2245,19 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data)
if (stickies[3] & CS43130_HPLOAD_OFF_INT) { if (stickies[3] & CS43130_HPLOAD_OFF_INT) {
cs43130->hpload_stat = stickies[3]; cs43130->hpload_stat = stickies[3];
dev_dbg(component->dev, "HP load state machine off done (%x)\n", dev_dbg(cs43130->dev, "HP load state machine off done (%x)\n",
cs43130->hpload_stat); cs43130->hpload_stat);
complete(&cs43130->hpload_evt); complete(&cs43130->hpload_evt);
return IRQ_HANDLED; return IRQ_HANDLED;
} }
if (stickies[0] & CS43130_XTAL_ERR_INT) { if (stickies[0] & CS43130_XTAL_ERR_INT) {
dev_err(component->dev, "Crystal err: clock is not running\n"); dev_err(cs43130->dev, "Crystal err: clock is not running\n");
return IRQ_HANDLED; return IRQ_HANDLED;
} }
if (stickies[0] & CS43130_HP_UNPLUG_INT) { if (stickies[0] & CS43130_HP_UNPLUG_INT) {
dev_dbg(component->dev, "HP unplugged\n"); dev_dbg(cs43130->dev, "HP unplugged\n");
cs43130->hpload_done = false; cs43130->hpload_done = false;
snd_soc_jack_report(&cs43130->jack, 0, CS43130_JACK_MASK); snd_soc_jack_report(&cs43130->jack, 0, CS43130_JACK_MASK);
return IRQ_HANDLED; return IRQ_HANDLED;
...@@ -2271,7 +2266,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data) ...@@ -2271,7 +2266,7 @@ static irqreturn_t cs43130_irq_thread(int irq, void *data)
if (stickies[0] & CS43130_HP_PLUG_INT) { if (stickies[0] & CS43130_HP_PLUG_INT) {
if (cs43130->dc_meas && !cs43130->hpload_done && if (cs43130->dc_meas && !cs43130->hpload_done &&
!work_busy(&cs43130->work)) { !work_busy(&cs43130->work)) {
dev_dbg(component->dev, "HP load queue work\n"); dev_dbg(cs43130->dev, "HP load queue work\n");
queue_work(cs43130->wq, &cs43130->work); queue_work(cs43130->wq, &cs43130->work);
} }
...@@ -2303,19 +2298,19 @@ static int cs43130_probe(struct snd_soc_component *component) ...@@ -2303,19 +2298,19 @@ static int cs43130_probe(struct snd_soc_component *component)
ret = snd_soc_card_jack_new(card, "Headphone", CS43130_JACK_MASK, ret = snd_soc_card_jack_new(card, "Headphone", CS43130_JACK_MASK,
&cs43130->jack); &cs43130->jack);
if (ret < 0) { if (ret < 0) {
dev_err(component->dev, "Cannot create jack\n"); dev_err(cs43130->dev, "Cannot create jack\n");
return ret; return ret;
} }
cs43130->hpload_done = false; cs43130->hpload_done = false;
if (cs43130->dc_meas) { if (cs43130->dc_meas) {
ret = sysfs_create_groups(&component->dev->kobj, hpload_groups); ret = sysfs_create_groups(&cs43130->dev->kobj, hpload_groups);
if (ret) if (ret)
return ret; return ret;
cs43130->wq = create_singlethread_workqueue("cs43130_hp"); cs43130->wq = create_singlethread_workqueue("cs43130_hp");
if (!cs43130->wq) { if (!cs43130->wq) {
sysfs_remove_groups(&component->dev->kobj, hpload_groups); sysfs_remove_groups(&cs43130->dev->kobj, hpload_groups);
return -ENOMEM; return -ENOMEM;
} }
INIT_WORK(&cs43130->work, cs43130_imp_meas); INIT_WORK(&cs43130->work, cs43130_imp_meas);
...@@ -2391,7 +2386,7 @@ static int cs43130_handle_device_data(struct i2c_client *i2c_client, ...@@ -2391,7 +2386,7 @@ static int cs43130_handle_device_data(struct i2c_client *i2c_client,
cs43130->xtal_ibias = CS43130_XTAL_IBIAS_15UA; cs43130->xtal_ibias = CS43130_XTAL_IBIAS_15UA;
break; break;
default: default:
dev_err(&i2c_client->dev, dev_err(cs43130->dev,
"Invalid cirrus,xtal-ibias value: %d\n", val); "Invalid cirrus,xtal-ibias value: %d\n", val);
return -EINVAL; return -EINVAL;
} }
...@@ -2426,6 +2421,8 @@ static int cs43130_i2c_probe(struct i2c_client *client) ...@@ -2426,6 +2421,8 @@ static int cs43130_i2c_probe(struct i2c_client *client)
if (!cs43130) if (!cs43130)
return -ENOMEM; return -ENOMEM;
cs43130->dev = &client->dev;
i2c_set_clientdata(client, cs43130); i2c_set_clientdata(client, cs43130);
cs43130->regmap = devm_regmap_init_i2c(client, &cs43130_regmap); cs43130->regmap = devm_regmap_init_i2c(client, &cs43130_regmap);
...@@ -2434,7 +2431,7 @@ static int cs43130_i2c_probe(struct i2c_client *client) ...@@ -2434,7 +2431,7 @@ static int cs43130_i2c_probe(struct i2c_client *client)
return ret; return ret;
} }
if (client->dev.of_node) { if (cs43130->dev->of_node) {
ret = cs43130_handle_device_data(client, cs43130); ret = cs43130_handle_device_data(client, cs43130);
if (ret != 0) if (ret != 0)
return ret; return ret;
...@@ -2442,21 +2439,21 @@ static int cs43130_i2c_probe(struct i2c_client *client) ...@@ -2442,21 +2439,21 @@ static int cs43130_i2c_probe(struct i2c_client *client)
for (i = 0; i < ARRAY_SIZE(cs43130->supplies); i++) for (i = 0; i < ARRAY_SIZE(cs43130->supplies); i++)
cs43130->supplies[i].supply = cs43130_supply_names[i]; cs43130->supplies[i].supply = cs43130_supply_names[i];
ret = devm_regulator_bulk_get(&client->dev, ret = devm_regulator_bulk_get(cs43130->dev,
ARRAY_SIZE(cs43130->supplies), ARRAY_SIZE(cs43130->supplies),
cs43130->supplies); cs43130->supplies);
if (ret != 0) { if (ret != 0) {
dev_err(&client->dev, "Failed to request supplies: %d\n", ret); dev_err(cs43130->dev, "Failed to request supplies: %d\n", ret);
return ret; return ret;
} }
ret = regulator_bulk_enable(ARRAY_SIZE(cs43130->supplies), ret = regulator_bulk_enable(ARRAY_SIZE(cs43130->supplies),
cs43130->supplies); cs43130->supplies);
if (ret != 0) { if (ret != 0) {
dev_err(&client->dev, "Failed to enable supplies: %d\n", ret); dev_err(cs43130->dev, "Failed to enable supplies: %d\n", ret);
return ret; return ret;
} }
cs43130->reset_gpio = devm_gpiod_get_optional(&client->dev, cs43130->reset_gpio = devm_gpiod_get_optional(cs43130->dev,
"reset", GPIOD_OUT_LOW); "reset", GPIOD_OUT_LOW);
if (IS_ERR(cs43130->reset_gpio)) { if (IS_ERR(cs43130->reset_gpio)) {
ret = PTR_ERR(cs43130->reset_gpio); ret = PTR_ERR(cs43130->reset_gpio);
...@@ -2470,7 +2467,7 @@ static int cs43130_i2c_probe(struct i2c_client *client) ...@@ -2470,7 +2467,7 @@ static int cs43130_i2c_probe(struct i2c_client *client)
devid = cirrus_read_device_id(cs43130->regmap, CS43130_DEVID_AB); devid = cirrus_read_device_id(cs43130->regmap, CS43130_DEVID_AB);
if (devid < 0) { if (devid < 0) {
ret = devid; ret = devid;
dev_err(&client->dev, "Failed to read device ID: %d\n", ret); dev_err(cs43130->dev, "Failed to read device ID: %d\n", ret);
goto err; goto err;
} }
...@@ -2481,7 +2478,7 @@ static int cs43130_i2c_probe(struct i2c_client *client) ...@@ -2481,7 +2478,7 @@ static int cs43130_i2c_probe(struct i2c_client *client)
case CS43198_CHIP_ID: case CS43198_CHIP_ID:
break; break;
default: default:
dev_err(&client->dev, dev_err(cs43130->dev,
"CS43130 Device ID %X. Expected ID %X, %X, %X or %X\n", "CS43130 Device ID %X. Expected ID %X, %X, %X or %X\n",
devid, CS43130_CHIP_ID, CS4399_CHIP_ID, devid, CS43130_CHIP_ID, CS4399_CHIP_ID,
CS43131_CHIP_ID, CS43198_CHIP_ID); CS43131_CHIP_ID, CS43198_CHIP_ID);
...@@ -2492,11 +2489,11 @@ static int cs43130_i2c_probe(struct i2c_client *client) ...@@ -2492,11 +2489,11 @@ static int cs43130_i2c_probe(struct i2c_client *client)
cs43130->dev_id = devid; cs43130->dev_id = devid;
ret = regmap_read(cs43130->regmap, CS43130_REV_ID, &reg); ret = regmap_read(cs43130->regmap, CS43130_REV_ID, &reg);
if (ret < 0) { if (ret < 0) {
dev_err(&client->dev, "Get Revision ID failed\n"); dev_err(cs43130->dev, "Get Revision ID failed\n");
goto err; goto err;
} }
dev_info(&client->dev, dev_info(cs43130->dev,
"Cirrus Logic CS43130 (%x), Revision: %02X\n", devid, "Cirrus Logic CS43130 (%x), Revision: %02X\n", devid,
reg & 0xFF); reg & 0xFF);
...@@ -2506,21 +2503,21 @@ static int cs43130_i2c_probe(struct i2c_client *client) ...@@ -2506,21 +2503,21 @@ static int cs43130_i2c_probe(struct i2c_client *client)
init_completion(&cs43130->pll_rdy); init_completion(&cs43130->pll_rdy);
init_completion(&cs43130->hpload_evt); init_completion(&cs43130->hpload_evt);
ret = devm_request_threaded_irq(&client->dev, client->irq, ret = devm_request_threaded_irq(cs43130->dev, client->irq,
NULL, cs43130_irq_thread, NULL, cs43130_irq_thread,
IRQF_ONESHOT | IRQF_TRIGGER_LOW, IRQF_ONESHOT | IRQF_TRIGGER_LOW,
"cs43130", cs43130); "cs43130", cs43130);
if (ret != 0) { if (ret != 0) {
dev_err(&client->dev, "Failed to request IRQ: %d\n", ret); dev_err(cs43130->dev, "Failed to request IRQ: %d\n", ret);
goto err; goto err;
} }
cs43130->mclk_int_src = CS43130_MCLK_SRC_RCO; cs43130->mclk_int_src = CS43130_MCLK_SRC_RCO;
pm_runtime_set_autosuspend_delay(&client->dev, 100); pm_runtime_set_autosuspend_delay(cs43130->dev, 100);
pm_runtime_use_autosuspend(&client->dev); pm_runtime_use_autosuspend(cs43130->dev);
pm_runtime_set_active(&client->dev); pm_runtime_set_active(cs43130->dev);
pm_runtime_enable(&client->dev); pm_runtime_enable(cs43130->dev);
switch (cs43130->dev_id) { switch (cs43130->dev_id) {
case CS43130_CHIP_ID: case CS43130_CHIP_ID:
...@@ -2556,11 +2553,11 @@ static int cs43130_i2c_probe(struct i2c_client *client) ...@@ -2556,11 +2553,11 @@ static int cs43130_i2c_probe(struct i2c_client *client)
break; break;
} }
ret = devm_snd_soc_register_component(&client->dev, ret = devm_snd_soc_register_component(cs43130->dev,
&soc_component_dev_cs43130, &soc_component_dev_cs43130,
cs43130_dai, ARRAY_SIZE(cs43130_dai)); cs43130_dai, ARRAY_SIZE(cs43130_dai));
if (ret < 0) { if (ret < 0) {
dev_err(&client->dev, dev_err(cs43130->dev,
"snd_soc_register_component failed with ret = %d\n", ret); "snd_soc_register_component failed with ret = %d\n", ret);
goto err; goto err;
} }
...@@ -2598,15 +2595,15 @@ static void cs43130_i2c_remove(struct i2c_client *client) ...@@ -2598,15 +2595,15 @@ static void cs43130_i2c_remove(struct i2c_client *client)
cancel_work_sync(&cs43130->work); cancel_work_sync(&cs43130->work);
flush_workqueue(cs43130->wq); flush_workqueue(cs43130->wq);
device_remove_file(&client->dev, &dev_attr_hpload_dc_l); device_remove_file(cs43130->dev, &dev_attr_hpload_dc_l);
device_remove_file(&client->dev, &dev_attr_hpload_dc_r); device_remove_file(cs43130->dev, &dev_attr_hpload_dc_r);
device_remove_file(&client->dev, &dev_attr_hpload_ac_l); device_remove_file(cs43130->dev, &dev_attr_hpload_ac_l);
device_remove_file(&client->dev, &dev_attr_hpload_ac_r); device_remove_file(cs43130->dev, &dev_attr_hpload_ac_r);
} }
gpiod_set_value_cansleep(cs43130->reset_gpio, 0); gpiod_set_value_cansleep(cs43130->reset_gpio, 0);
pm_runtime_disable(&client->dev); pm_runtime_disable(cs43130->dev);
regulator_bulk_disable(CS43130_NUM_SUPPLIES, cs43130->supplies); regulator_bulk_disable(CS43130_NUM_SUPPLIES, cs43130->supplies);
} }
......
sound/soc/codecs/cs43130.h
View file @ 552206ad
...@@ -500,6 +500,7 @@ struct cs43130_dai { ...@@ -500,6 +500,7 @@ struct cs43130_dai {
}; };
struct cs43130_private { struct cs43130_private {
struct device *dev;
struct snd_soc_component *component; struct snd_soc_component *component;
struct regmap *regmap; struct regmap *regmap;
struct regulator_bulk_data supplies[CS43130_NUM_SUPPLIES]; struct regulator_bulk_data supplies[CS43130_NUM_SUPPLIES];
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7