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_component *component = dai->component;
78 u16 mute_reg = snd_soc_component_read32(component, WM8728_DACCTL);
79
80 if (mute)
81 snd_soc_component_write(component, WM8728_DACCTL, mute_reg | 1);
82 else
83 snd_soc_component_write(component, 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_component *component = dai->component;
93 u16 dac = snd_soc_component_read32(component, 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_component_write(component, 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_component *component = codec_dai->component;
119 u16 iface = snd_soc_component_read32(component, 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_component_write(component, WM8728_IFCTL, iface);
160 return 0;
161}
162
163static int wm8728_set_bias_level(struct snd_soc_component *component,
164 enum snd_soc_bias_level level)
165{
166 struct wm8728_priv *wm8728 = snd_soc_component_get_drvdata(component);
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_component_get_bias_level(component) == SND_SOC_BIAS_OFF) {
174
175 reg = snd_soc_component_read32(component, WM8728_DACCTL);
176 snd_soc_component_write(component, 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_component_read32(component, WM8728_DACCTL);
185 snd_soc_component_write(component, 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 const struct snd_soc_component_driver soc_component_dev_wm8728 = {
215 .set_bias_level = wm8728_set_bias_level,
216 .controls = wm8728_snd_controls,
217 .num_controls = ARRAY_SIZE(wm8728_snd_controls),
218 .dapm_widgets = wm8728_dapm_widgets,
219 .num_dapm_widgets = ARRAY_SIZE(wm8728_dapm_widgets),
220 .dapm_routes = wm8728_intercon,
221 .num_dapm_routes = ARRAY_SIZE(wm8728_intercon),
222 .suspend_bias_off = 1,
223 .idle_bias_on = 1,
224 .use_pmdown_time = 1,
225 .endianness = 1,
226 .non_legacy_dai_naming = 1,
227};
228
229static const struct of_device_id wm8728_of_match[] = {
230 { .compatible = "wlf,wm8728", },
231 { }
232};
233MODULE_DEVICE_TABLE(of, wm8728_of_match);
234
235static const struct regmap_config wm8728_regmap = {
236 .reg_bits = 7,
237 .val_bits = 9,
238 .max_register = WM8728_IFCTL,
239
240 .reg_defaults = wm8728_reg_defaults,
241 .num_reg_defaults = ARRAY_SIZE(wm8728_reg_defaults),
242 .cache_type = REGCACHE_RBTREE,
243};
244
245#if defined(CONFIG_SPI_MASTER)
246static int wm8728_spi_probe(struct spi_device *spi)
247{
248 struct wm8728_priv *wm8728;
249 int ret;
250
251 wm8728 = devm_kzalloc(&spi->dev, sizeof(struct wm8728_priv),
252 GFP_KERNEL);
253 if (wm8728 == NULL)
254 return -ENOMEM;
255
256 wm8728->regmap = devm_regmap_init_spi(spi, &wm8728_regmap);
257 if (IS_ERR(wm8728->regmap))
258 return PTR_ERR(wm8728->regmap);
259
260 spi_set_drvdata(spi, wm8728);
261
262 ret = devm_snd_soc_register_component(&spi->dev,
263 &soc_component_dev_wm8728, &wm8728_dai, 1);
264
265 return ret;
266}
267
268static struct spi_driver wm8728_spi_driver = {
269 .driver = {
270 .name = "wm8728",
271 .of_match_table = wm8728_of_match,
272 },
273 .probe = wm8728_spi_probe,
274};
275#endif
276
277#if IS_ENABLED(CONFIG_I2C)
278static int wm8728_i2c_probe(struct i2c_client *i2c,
279 const struct i2c_device_id *id)
280{
281 struct wm8728_priv *wm8728;
282 int ret;
283
284 wm8728 = devm_kzalloc(&i2c->dev, sizeof(struct wm8728_priv),
285 GFP_KERNEL);
286 if (wm8728 == NULL)
287 return -ENOMEM;
288
289 wm8728->regmap = devm_regmap_init_i2c(i2c, &wm8728_regmap);
290 if (IS_ERR(wm8728->regmap))
291 return PTR_ERR(wm8728->regmap);
292
293 i2c_set_clientdata(i2c, wm8728);
294
295 ret = devm_snd_soc_register_component(&i2c->dev,
296 &soc_component_dev_wm8728, &wm8728_dai, 1);
297
298 return ret;
299}
300
301static const struct i2c_device_id wm8728_i2c_id[] = {
302 { "wm8728", 0 },
303 { }
304};
305MODULE_DEVICE_TABLE(i2c, wm8728_i2c_id);
306
307static struct i2c_driver wm8728_i2c_driver = {
308 .driver = {
309 .name = "wm8728",
310 .of_match_table = wm8728_of_match,
311 },
312 .probe = wm8728_i2c_probe,
313 .id_table = wm8728_i2c_id,
314};
315#endif
316
317static int __init wm8728_modinit(void)
318{
319 int ret = 0;
320#if IS_ENABLED(CONFIG_I2C)
321 ret = i2c_add_driver(&wm8728_i2c_driver);
322 if (ret != 0) {
323 printk(KERN_ERR "Failed to register wm8728 I2C driver: %d\n",
324 ret);
325 }
326#endif
327#if defined(CONFIG_SPI_MASTER)
328 ret = spi_register_driver(&wm8728_spi_driver);
329 if (ret != 0) {
330 printk(KERN_ERR "Failed to register wm8728 SPI driver: %d\n",
331 ret);
332 }
333#endif
334 return ret;
335}
336module_init(wm8728_modinit);
337
338static void __exit wm8728_exit(void)
339{
340#if IS_ENABLED(CONFIG_I2C)
341 i2c_del_driver(&wm8728_i2c_driver);
342#endif
343#if defined(CONFIG_SPI_MASTER)
344 spi_unregister_driver(&wm8728_spi_driver);
345#endif
346}
347module_exit(wm8728_exit);
348
349MODULE_DESCRIPTION("ASoC WM8728 driver");
350MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
351MODULE_LICENSE("GPL");
352
