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