1
2
3
4
5
6
7
8
9
10#include <linux/module.h>
11#include <linux/moduleparam.h>
12#include <linux/init.h>
13#include <linux/delay.h>
14#include <linux/pm.h>
15#include <linux/i2c.h>
16#include <linux/platform_device.h>
17#include <linux/regmap.h>
18#include <linux/spi/spi.h>
19#include <linux/slab.h>
20#include <linux/of_device.h>
21#include <sound/core.h>
22#include <sound/pcm.h>
23#include <sound/pcm_params.h>
24#include <sound/soc.h>
25#include <sound/initval.h>
26#include <sound/tlv.h>
27
28#include "wm8728.h"
29
30
31
32
33
34
35
36static const struct reg_default wm8728_reg_defaults[] = {
37 { 0, 0x1ff },
38 { 1, 0x1ff },
39 { 2, 0x001 },
40 { 3, 0x100 },
41};
42
43
44struct wm8728_priv {
45 struct regmap *regmap;
46};
47
48static const DECLARE_TLV_DB_SCALE(wm8728_tlv, -12750, 50, 1);
49
50static const struct snd_kcontrol_new wm8728_snd_controls[] = {
51
52SOC_DOUBLE_R_TLV("Digital Playback Volume", WM8728_DACLVOL, WM8728_DACRVOL,
53 0, 255, 0, wm8728_tlv),
54
55SOC_SINGLE("Deemphasis", WM8728_DACCTL, 1, 1, 0),
56};
57
58
59
60
61static const struct snd_soc_dapm_widget wm8728_dapm_widgets[] = {
62SND_SOC_DAPM_DAC("DAC", "HiFi Playback", SND_SOC_NOPM, 0, 0),
63SND_SOC_DAPM_OUTPUT("VOUTL"),
64SND_SOC_DAPM_OUTPUT("VOUTR"),
65};
66
67static const struct snd_soc_dapm_route wm8728_intercon[] = {
68 {"VOUTL", NULL, "DAC"},
69 {"VOUTR", NULL, "DAC"},
70};
71
72static int wm8728_mute(struct snd_soc_dai *dai, int mute)
73{
74 struct snd_soc_component *component = dai->component;
75 u16 mute_reg = snd_soc_component_read32(component, WM8728_DACCTL);
76
77 if (mute)
78 snd_soc_component_write(component, WM8728_DACCTL, mute_reg | 1);
79 else
80 snd_soc_component_write(component, WM8728_DACCTL, mute_reg & ~1);
81
82 return 0;
83}
84
85static int wm8728_hw_params(struct snd_pcm_substream *substream,
86 struct snd_pcm_hw_params *params,
87 struct snd_soc_dai *dai)
88{
89 struct snd_soc_component *component = dai->component;
90 u16 dac = snd_soc_component_read32(component, WM8728_DACCTL);
91
92 dac &= ~0x18;
93
94 switch (params_width(params)) {
95 case 16:
96 break;
97 case 20:
98 dac |= 0x10;
99 break;
100 case 24:
101 dac |= 0x08;
102 break;
103 default:
104 return -EINVAL;
105 }
106
107 snd_soc_component_write(component, WM8728_DACCTL, dac);
108
109 return 0;
110}
111
112static int wm8728_set_dai_fmt(struct snd_soc_dai *codec_dai,
113 unsigned int fmt)
114{
115 struct snd_soc_component *component = codec_dai->component;
116 u16 iface = snd_soc_component_read32(component, WM8728_IFCTL);
117
118
119
120
121 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
122 case SND_SOC_DAIFMT_I2S:
123 iface |= 1;
124 break;
125 default:
126 return -EINVAL;
127 }
128
129
130 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
131 case SND_SOC_DAIFMT_CBS_CFS:
132 break;
133 default:
134 return -EINVAL;
135 }
136
137 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
138 case SND_SOC_DAIFMT_NB_NF:
139 iface &= ~0x22;
140 break;
141 case SND_SOC_DAIFMT_IB_NF:
142 iface |= 0x20;
143 iface &= ~0x02;
144 break;
145 case SND_SOC_DAIFMT_NB_IF:
146 iface |= 0x02;
147 iface &= ~0x20;
148 break;
149 case SND_SOC_DAIFMT_IB_IF:
150 iface |= 0x22;
151 break;
152 default:
153 return -EINVAL;
154 }
155
156 snd_soc_component_write(component, WM8728_IFCTL, iface);
157 return 0;
158}
159
160static int wm8728_set_bias_level(struct snd_soc_component *component,
161 enum snd_soc_bias_level level)
162{
163 struct wm8728_priv *wm8728 = snd_soc_component_get_drvdata(component);
164 u16 reg;
165
166 switch (level) {
167 case SND_SOC_BIAS_ON:
168 case SND_SOC_BIAS_PREPARE:
169 case SND_SOC_BIAS_STANDBY:
170 if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) {
171
172 reg = snd_soc_component_read32(component, WM8728_DACCTL);
173 snd_soc_component_write(component, WM8728_DACCTL, reg & ~0x4);
174
175
176 regcache_sync(wm8728->regmap);
177 }
178 break;
179
180 case SND_SOC_BIAS_OFF:
181 reg = snd_soc_component_read32(component, WM8728_DACCTL);
182 snd_soc_component_write(component, WM8728_DACCTL, reg | 0x4);
183 break;
184 }
185 return 0;
186}
187
188#define WM8728_RATES (SNDRV_PCM_RATE_8000_192000)
189
190#define WM8728_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
191 SNDRV_PCM_FMTBIT_S24_LE)
192
193static const struct snd_soc_dai_ops wm8728_dai_ops = {
194 .hw_params = wm8728_hw_params,
195 .digital_mute = wm8728_mute,
196 .set_fmt = wm8728_set_dai_fmt,
197};
198
199static struct snd_soc_dai_driver wm8728_dai = {
200 .name = "wm8728-hifi",
201 .playback = {
202 .stream_name = "Playback",
203 .channels_min = 2,
204 .channels_max = 2,
205 .rates = WM8728_RATES,
206 .formats = WM8728_FORMATS,
207 },
208 .ops = &wm8728_dai_ops,
209};
210
211static const struct snd_soc_component_driver soc_component_dev_wm8728 = {
212 .set_bias_level = wm8728_set_bias_level,
213 .controls = wm8728_snd_controls,
214 .num_controls = ARRAY_SIZE(wm8728_snd_controls),
215 .dapm_widgets = wm8728_dapm_widgets,
216 .num_dapm_widgets = ARRAY_SIZE(wm8728_dapm_widgets),
217 .dapm_routes = wm8728_intercon,
218 .num_dapm_routes = ARRAY_SIZE(wm8728_intercon),
219 .suspend_bias_off = 1,
220 .idle_bias_on = 1,
221 .use_pmdown_time = 1,
222 .endianness = 1,
223 .non_legacy_dai_naming = 1,
224};
225
226static const struct of_device_id wm8728_of_match[] = {
227 { .compatible = "wlf,wm8728", },
228 { }
229};
230MODULE_DEVICE_TABLE(of, wm8728_of_match);
231
232static const struct regmap_config wm8728_regmap = {
233 .reg_bits = 7,
234 .val_bits = 9,
235 .max_register = WM8728_IFCTL,
236
237 .reg_defaults = wm8728_reg_defaults,
238 .num_reg_defaults = ARRAY_SIZE(wm8728_reg_defaults),
239 .cache_type = REGCACHE_RBTREE,
240};
241
242#if defined(CONFIG_SPI_MASTER)
243static int wm8728_spi_probe(struct spi_device *spi)
244{
245 struct wm8728_priv *wm8728;
246 int ret;
247
248 wm8728 = devm_kzalloc(&spi->dev, sizeof(struct wm8728_priv),
249 GFP_KERNEL);
250 if (wm8728 == NULL)
251 return -ENOMEM;
252
253 wm8728->regmap = devm_regmap_init_spi(spi, &wm8728_regmap);
254 if (IS_ERR(wm8728->regmap))
255 return PTR_ERR(wm8728->regmap);
256
257 spi_set_drvdata(spi, wm8728);
258
259 ret = devm_snd_soc_register_component(&spi->dev,
260 &soc_component_dev_wm8728, &wm8728_dai, 1);
261
262 return ret;
263}
264
265static struct spi_driver wm8728_spi_driver = {
266 .driver = {
267 .name = "wm8728",
268 .of_match_table = wm8728_of_match,
269 },
270 .probe = wm8728_spi_probe,
271};
272#endif
273
274#if IS_ENABLED(CONFIG_I2C)
275static int wm8728_i2c_probe(struct i2c_client *i2c,
276 const struct i2c_device_id *id)
277{
278 struct wm8728_priv *wm8728;
279 int ret;
280
281 wm8728 = devm_kzalloc(&i2c->dev, sizeof(struct wm8728_priv),
282 GFP_KERNEL);
283 if (wm8728 == NULL)
284 return -ENOMEM;
285
286 wm8728->regmap = devm_regmap_init_i2c(i2c, &wm8728_regmap);
287 if (IS_ERR(wm8728->regmap))
288 return PTR_ERR(wm8728->regmap);
289
290 i2c_set_clientdata(i2c, wm8728);
291
292 ret = devm_snd_soc_register_component(&i2c->dev,
293 &soc_component_dev_wm8728, &wm8728_dai, 1);
294
295 return ret;
296}
297
298static const struct i2c_device_id wm8728_i2c_id[] = {
299 { "wm8728", 0 },
300 { }
301};
302MODULE_DEVICE_TABLE(i2c, wm8728_i2c_id);
303
304static struct i2c_driver wm8728_i2c_driver = {
305 .driver = {
306 .name = "wm8728",
307 .of_match_table = wm8728_of_match,
308 },
309 .probe = wm8728_i2c_probe,
310 .id_table = wm8728_i2c_id,
311};
312#endif
313
314static int __init wm8728_modinit(void)
315{
316 int ret = 0;
317#if IS_ENABLED(CONFIG_I2C)
318 ret = i2c_add_driver(&wm8728_i2c_driver);
319 if (ret != 0) {
320 printk(KERN_ERR "Failed to register wm8728 I2C driver: %d\n",
321 ret);
322 }
323#endif
324#if defined(CONFIG_SPI_MASTER)
325 ret = spi_register_driver(&wm8728_spi_driver);
326 if (ret != 0) {
327 printk(KERN_ERR "Failed to register wm8728 SPI driver: %d\n",
328 ret);
329 }
330#endif
331 return ret;
332}
333module_init(wm8728_modinit);
334
335static void __exit wm8728_exit(void)
336{
337#if IS_ENABLED(CONFIG_I2C)
338 i2c_del_driver(&wm8728_i2c_driver);
339#endif
340#if defined(CONFIG_SPI_MASTER)
341 spi_unregister_driver(&wm8728_spi_driver);
342#endif
343}
344module_exit(wm8728_exit);
345
346MODULE_DESCRIPTION("ASoC WM8728 driver");
347MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
348MODULE_LICENSE("GPL");
349
