treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / sound / soc / codecs / cs4341.c
blobade7477d04f11e0e50061713b39c16065f33dfc2
1 /* SPDX-License-Identifier: GPL-2.0+ */
2 /*
3 * Cirrus Logic CS4341A ALSA SoC Codec Driver
4 * Author: Alexander Shiyan <shc_work@mail.ru>
5 */
7 #include <linux/i2c.h>
8 #include <linux/module.h>
9 #include <linux/of.h>
10 #include <linux/regmap.h>
11 #include <linux/spi/spi.h>
13 #include <sound/pcm.h>
14 #include <sound/pcm_params.h>
15 #include <sound/soc.h>
16 #include <sound/tlv.h>
18 #define CS4341_REG_MODE1 0x00
19 #define CS4341_REG_MODE2 0x01
20 #define CS4341_REG_MIX 0x02
21 #define CS4341_REG_VOLA 0x03
22 #define CS4341_REG_VOLB 0x04
24 #define CS4341_MODE2_DIF (7 << 4)
25 #define CS4341_MODE2_DIF_I2S_24 (0 << 4)
26 #define CS4341_MODE2_DIF_I2S_16 (1 << 4)
27 #define CS4341_MODE2_DIF_LJ_24 (2 << 4)
28 #define CS4341_MODE2_DIF_RJ_24 (3 << 4)
29 #define CS4341_MODE2_DIF_RJ_16 (5 << 4)
30 #define CS4341_VOLX_MUTE (1 << 7)
32 struct cs4341_priv {
33 unsigned int fmt;
34 struct regmap *regmap;
35 struct regmap_config regcfg;
38 static const struct reg_default cs4341_reg_defaults[] = {
39 { CS4341_REG_MODE1, 0x00 },
40 { CS4341_REG_MODE2, 0x82 },
41 { CS4341_REG_MIX, 0x49 },
42 { CS4341_REG_VOLA, 0x80 },
43 { CS4341_REG_VOLB, 0x80 },
46 static int cs4341_set_fmt(struct snd_soc_dai *dai, unsigned int format)
48 struct snd_soc_component *component = dai->component;
49 struct cs4341_priv *cs4341 = snd_soc_component_get_drvdata(component);
51 switch (format & SND_SOC_DAIFMT_MASTER_MASK) {
52 case SND_SOC_DAIFMT_CBS_CFS:
53 break;
54 default:
55 return -EINVAL;
58 switch (format & SND_SOC_DAIFMT_INV_MASK) {
59 case SND_SOC_DAIFMT_NB_NF:
60 break;
61 default:
62 return -EINVAL;
65 switch (format & SND_SOC_DAIFMT_FORMAT_MASK) {
66 case SND_SOC_DAIFMT_I2S:
67 case SND_SOC_DAIFMT_LEFT_J:
68 case SND_SOC_DAIFMT_RIGHT_J:
69 cs4341->fmt = format & SND_SOC_DAIFMT_FORMAT_MASK;
70 break;
71 default:
72 return -EINVAL;
75 return 0;
78 static int cs4341_hw_params(struct snd_pcm_substream *substream,
79 struct snd_pcm_hw_params *params,
80 struct snd_soc_dai *dai)
82 struct snd_soc_component *component = dai->component;
83 struct cs4341_priv *cs4341 = snd_soc_component_get_drvdata(component);
84 unsigned int mode = 0;
85 int b24 = 0;
87 switch (params_format(params)) {
88 case SNDRV_PCM_FORMAT_S24_LE:
89 b24 = 1;
90 break;
91 case SNDRV_PCM_FORMAT_S16_LE:
92 break;
93 default:
94 dev_err(component->dev, "Unsupported PCM format 0x%08x.\n",
95 params_format(params));
96 return -EINVAL;
99 switch (cs4341->fmt) {
100 case SND_SOC_DAIFMT_I2S:
101 mode = b24 ? CS4341_MODE2_DIF_I2S_24 : CS4341_MODE2_DIF_I2S_16;
102 break;
103 case SND_SOC_DAIFMT_LEFT_J:
104 mode = CS4341_MODE2_DIF_LJ_24;
105 break;
106 case SND_SOC_DAIFMT_RIGHT_J:
107 mode = b24 ? CS4341_MODE2_DIF_RJ_24 : CS4341_MODE2_DIF_RJ_16;
108 break;
109 default:
110 dev_err(component->dev, "Unsupported DAI format 0x%08x.\n",
111 cs4341->fmt);
112 return -EINVAL;
115 return snd_soc_component_update_bits(component, CS4341_REG_MODE2,
116 CS4341_MODE2_DIF, mode);
119 static int cs4341_digital_mute(struct snd_soc_dai *dai, int mute)
121 struct snd_soc_component *component = dai->component;
122 int ret;
124 ret = snd_soc_component_update_bits(component, CS4341_REG_VOLA,
125 CS4341_VOLX_MUTE,
126 mute ? CS4341_VOLX_MUTE : 0);
127 if (ret < 0)
128 return ret;
130 return snd_soc_component_update_bits(component, CS4341_REG_VOLB,
131 CS4341_VOLX_MUTE,
132 mute ? CS4341_VOLX_MUTE : 0);
135 static DECLARE_TLV_DB_SCALE(out_tlv, -9000, 100, 0);
137 static const char * const deemph[] = {
138 "None", "44.1k", "48k", "32k",
141 static const struct soc_enum deemph_enum =
142 SOC_ENUM_SINGLE(CS4341_REG_MODE2, 2, 4, deemph);
144 static const char * const srzc[] = {
145 "Immediate", "Zero Cross", "Soft Ramp", "SR on ZC",
148 static const struct soc_enum srzc_enum =
149 SOC_ENUM_SINGLE(CS4341_REG_MIX, 5, 4, srzc);
152 static const struct snd_soc_dapm_widget cs4341_dapm_widgets[] = {
153 SND_SOC_DAPM_DAC("HiFi DAC", NULL, SND_SOC_NOPM, 0, 0),
154 SND_SOC_DAPM_OUTPUT("OutA"),
155 SND_SOC_DAPM_OUTPUT("OutB"),
158 static const struct snd_soc_dapm_route cs4341_routes[] = {
159 { "OutA", NULL, "HiFi DAC" },
160 { "OutB", NULL, "HiFi DAC" },
161 { "DAC Playback", NULL, "OutA" },
162 { "DAC Playback", NULL, "OutB" },
165 static const struct snd_kcontrol_new cs4341_controls[] = {
166 SOC_DOUBLE_R_TLV("Master Playback Volume",
167 CS4341_REG_VOLA, CS4341_REG_VOLB, 0, 90, 1, out_tlv),
168 SOC_ENUM("De-Emphasis Control", deemph_enum),
169 SOC_ENUM("Soft Ramp Zero Cross Control", srzc_enum),
170 SOC_SINGLE("Auto-Mute Switch", CS4341_REG_MODE2, 7, 1, 0),
171 SOC_SINGLE("Popguard Transient Switch", CS4341_REG_MODE2, 1, 1, 0),
174 static const struct snd_soc_dai_ops cs4341_dai_ops = {
175 .set_fmt = cs4341_set_fmt,
176 .hw_params = cs4341_hw_params,
177 .digital_mute = cs4341_digital_mute,
180 static struct snd_soc_dai_driver cs4341_dai = {
181 .name = "cs4341a-hifi",
182 .playback = {
183 .stream_name = "DAC Playback",
184 .channels_min = 1,
185 .channels_max = 2,
186 .rates = SNDRV_PCM_RATE_8000_96000,
187 .formats = SNDRV_PCM_FMTBIT_S16_LE |
188 SNDRV_PCM_FMTBIT_S24_LE,
190 .ops = &cs4341_dai_ops,
191 .symmetric_rates = 1,
194 static const struct snd_soc_component_driver soc_component_cs4341 = {
195 .controls = cs4341_controls,
196 .num_controls = ARRAY_SIZE(cs4341_controls),
197 .dapm_widgets = cs4341_dapm_widgets,
198 .num_dapm_widgets = ARRAY_SIZE(cs4341_dapm_widgets),
199 .dapm_routes = cs4341_routes,
200 .num_dapm_routes = ARRAY_SIZE(cs4341_routes),
201 .idle_bias_on = 1,
202 .use_pmdown_time = 1,
203 .endianness = 1,
204 .non_legacy_dai_naming = 1,
207 static const struct of_device_id __maybe_unused cs4341_dt_ids[] = {
208 { .compatible = "cirrus,cs4341a", },
211 MODULE_DEVICE_TABLE(of, cs4341_dt_ids);
213 static int cs4341_probe(struct device *dev)
215 struct cs4341_priv *cs4341 = dev_get_drvdata(dev);
216 int i;
218 for (i = 0; i < ARRAY_SIZE(cs4341_reg_defaults); i++)
219 regmap_write(cs4341->regmap, cs4341_reg_defaults[i].reg,
220 cs4341_reg_defaults[i].def);
222 return devm_snd_soc_register_component(dev, &soc_component_cs4341,
223 &cs4341_dai, 1);
226 #if IS_ENABLED(CONFIG_I2C)
227 static int cs4341_i2c_probe(struct i2c_client *i2c,
228 const struct i2c_device_id *id)
230 struct cs4341_priv *cs4341;
232 cs4341 = devm_kzalloc(&i2c->dev, sizeof(*cs4341), GFP_KERNEL);
233 if (!cs4341)
234 return -ENOMEM;
236 i2c_set_clientdata(i2c, cs4341);
238 cs4341->regcfg.reg_bits = 8;
239 cs4341->regcfg.val_bits = 8;
240 cs4341->regcfg.max_register = CS4341_REG_VOLB;
241 cs4341->regcfg.cache_type = REGCACHE_FLAT;
242 cs4341->regcfg.reg_defaults = cs4341_reg_defaults;
243 cs4341->regcfg.num_reg_defaults = ARRAY_SIZE(cs4341_reg_defaults);
244 cs4341->regmap = devm_regmap_init_i2c(i2c, &cs4341->regcfg);
245 if (IS_ERR(cs4341->regmap))
246 return PTR_ERR(cs4341->regmap);
248 return cs4341_probe(&i2c->dev);
251 static const struct i2c_device_id cs4341_i2c_id[] = {
252 { "cs4341", 0 },
255 MODULE_DEVICE_TABLE(i2c, cs4341_i2c_id);
257 static struct i2c_driver cs4341_i2c_driver = {
258 .driver = {
259 .name = "cs4341-i2c",
260 .of_match_table = of_match_ptr(cs4341_dt_ids),
262 .probe = cs4341_i2c_probe,
263 .id_table = cs4341_i2c_id,
265 #endif
267 #if defined(CONFIG_SPI_MASTER)
268 static bool cs4341_reg_readable(struct device *dev, unsigned int reg)
270 return false;
273 static int cs4341_spi_probe(struct spi_device *spi)
275 struct cs4341_priv *cs4341;
276 int ret;
278 cs4341 = devm_kzalloc(&spi->dev, sizeof(*cs4341), GFP_KERNEL);
279 if (!cs4341)
280 return -ENOMEM;
282 if (!spi->bits_per_word)
283 spi->bits_per_word = 8;
284 if (!spi->max_speed_hz)
285 spi->max_speed_hz = 6000000;
286 ret = spi_setup(spi);
287 if (ret)
288 return ret;
290 spi_set_drvdata(spi, cs4341);
292 cs4341->regcfg.reg_bits = 16;
293 cs4341->regcfg.val_bits = 8;
294 cs4341->regcfg.write_flag_mask = 0x20;
295 cs4341->regcfg.max_register = CS4341_REG_VOLB;
296 cs4341->regcfg.cache_type = REGCACHE_FLAT;
297 cs4341->regcfg.readable_reg = cs4341_reg_readable;
298 cs4341->regcfg.reg_defaults = cs4341_reg_defaults;
299 cs4341->regcfg.num_reg_defaults = ARRAY_SIZE(cs4341_reg_defaults);
300 cs4341->regmap = devm_regmap_init_spi(spi, &cs4341->regcfg);
301 if (IS_ERR(cs4341->regmap))
302 return PTR_ERR(cs4341->regmap);
304 return cs4341_probe(&spi->dev);
307 static struct spi_driver cs4341_spi_driver = {
308 .driver = {
309 .name = "cs4341-spi",
310 .of_match_table = of_match_ptr(cs4341_dt_ids),
312 .probe = cs4341_spi_probe,
314 #endif
316 static int __init cs4341_init(void)
318 int ret = 0;
320 #if IS_ENABLED(CONFIG_I2C)
321 ret = i2c_add_driver(&cs4341_i2c_driver);
322 if (ret)
323 return ret;
324 #endif
325 #if defined(CONFIG_SPI_MASTER)
326 ret = spi_register_driver(&cs4341_spi_driver);
327 #endif
329 return ret;
331 module_init(cs4341_init);
333 static void __exit cs4341_exit(void)
335 #if IS_ENABLED(CONFIG_I2C)
336 i2c_del_driver(&cs4341_i2c_driver);
337 #endif
338 #if defined(CONFIG_SPI_MASTER)
339 spi_unregister_driver(&cs4341_spi_driver);
340 #endif
342 module_exit(cs4341_exit);
344 MODULE_AUTHOR("Alexander Shiyan <shc_work@mail.ru>");
345 MODULE_DESCRIPTION("Cirrus Logic CS4341 ALSA SoC Codec Driver");
346 MODULE_LICENSE("GPL");