This source file includes following definitions.
- wm97xx_readable_reg
- wm97xx_writeable_reg
- wm9712_volatile_reg
- wm97xx_ac97_probe
- wm97xx_ac97_remove
- wm97xx_module_init
- wm97xx_module_exit
1
2
3
4
5
6
7
8
9
10
11
12
13 #include <linux/device.h>
14 #include <linux/mfd/core.h>
15 #include <linux/mfd/wm97xx.h>
16 #include <linux/module.h>
17 #include <linux/regmap.h>
18 #include <linux/slab.h>
19 #include <linux/wm97xx.h>
20 #include <sound/ac97/codec.h>
21 #include <sound/ac97/compat.h>
22
23 #define WM9705_VENDOR_ID 0x574d4c05
24 #define WM9712_VENDOR_ID 0x574d4c12
25 #define WM9713_VENDOR_ID 0x574d4c13
26 #define WM97xx_VENDOR_ID_MASK 0xffffffff
27
28 struct wm97xx_priv {
29 struct regmap *regmap;
30 struct snd_ac97 *ac97;
31 struct device *dev;
32 struct wm97xx_platform_data codec_pdata;
33 };
34
35 static bool wm97xx_readable_reg(struct device *dev, unsigned int reg)
36 {
37 switch (reg) {
38 case AC97_RESET ... AC97_PCM_SURR_DAC_RATE:
39 case AC97_PCM_LR_ADC_RATE:
40 case AC97_CENTER_LFE_MASTER:
41 case AC97_SPDIF ... AC97_LINE1_LEVEL:
42 case AC97_GPIO_CFG ... 0x5c:
43 case AC97_CODEC_CLASS_REV ... AC97_PCI_SID:
44 case 0x74 ... AC97_VENDOR_ID2:
45 return true;
46 default:
47 return false;
48 }
49 }
50
51 static bool wm97xx_writeable_reg(struct device *dev, unsigned int reg)
52 {
53 switch (reg) {
54 case AC97_VENDOR_ID1:
55 case AC97_VENDOR_ID2:
56 return false;
57 default:
58 return wm97xx_readable_reg(dev, reg);
59 }
60 }
61
62 static const struct reg_default wm9705_reg_defaults[] = {
63 { 0x02, 0x8000 },
64 { 0x04, 0x8000 },
65 { 0x06, 0x8000 },
66 { 0x0a, 0x8000 },
67 { 0x0c, 0x8008 },
68 { 0x0e, 0x8008 },
69 { 0x10, 0x8808 },
70 { 0x12, 0x8808 },
71 { 0x14, 0x8808 },
72 { 0x16, 0x8808 },
73 { 0x18, 0x8808 },
74 { 0x1a, 0x0000 },
75 { 0x1c, 0x8000 },
76 { 0x20, 0x0000 },
77 { 0x22, 0x0000 },
78 { 0x26, 0x000f },
79 { 0x28, 0x0605 },
80 { 0x2a, 0x0000 },
81 { 0x2c, 0xbb80 },
82 { 0x32, 0xbb80 },
83 { 0x34, 0x2000 },
84 { 0x5a, 0x0000 },
85 { 0x5c, 0x0000 },
86 { 0x72, 0x0808 },
87 { 0x74, 0x0000 },
88 { 0x76, 0x0006 },
89 { 0x78, 0x0000 },
90 { 0x7a, 0x0000 },
91 };
92
93 static const struct regmap_config wm9705_regmap_config = {
94 .reg_bits = 16,
95 .reg_stride = 2,
96 .val_bits = 16,
97 .max_register = 0x7e,
98 .cache_type = REGCACHE_RBTREE,
99
100 .reg_defaults = wm9705_reg_defaults,
101 .num_reg_defaults = ARRAY_SIZE(wm9705_reg_defaults),
102 .volatile_reg = regmap_ac97_default_volatile,
103 .readable_reg = wm97xx_readable_reg,
104 .writeable_reg = wm97xx_writeable_reg,
105 };
106
107 static struct mfd_cell wm9705_cells[] = {
108 { .name = "wm9705-codec", },
109 { .name = "wm97xx-ts", },
110 };
111
112 static bool wm9712_volatile_reg(struct device *dev, unsigned int reg)
113 {
114 switch (reg) {
115 case AC97_REC_GAIN:
116 return true;
117 default:
118 return regmap_ac97_default_volatile(dev, reg);
119 }
120 }
121
122 static const struct reg_default wm9712_reg_defaults[] = {
123 { 0x02, 0x8000 },
124 { 0x04, 0x8000 },
125 { 0x06, 0x8000 },
126 { 0x08, 0x0f0f },
127 { 0x0a, 0xaaa0 },
128 { 0x0c, 0xc008 },
129 { 0x0e, 0x6808 },
130 { 0x10, 0xe808 },
131 { 0x12, 0xaaa0 },
132 { 0x14, 0xad00 },
133 { 0x16, 0x8000 },
134 { 0x18, 0xe808 },
135 { 0x1a, 0x3000 },
136 { 0x1c, 0x8000 },
137 { 0x20, 0x0000 },
138 { 0x22, 0x0000 },
139 { 0x26, 0x000f },
140 { 0x28, 0x0605 },
141 { 0x2a, 0x0410 },
142 { 0x2c, 0xbb80 },
143 { 0x2e, 0xbb80 },
144 { 0x32, 0xbb80 },
145 { 0x34, 0x2000 },
146 { 0x4c, 0xf83e },
147 { 0x4e, 0xffff },
148 { 0x50, 0x0000 },
149 { 0x52, 0x0000 },
150 { 0x56, 0xf83e },
151 { 0x58, 0x0008 },
152 { 0x5c, 0x0000 },
153 { 0x60, 0xb032 },
154 { 0x62, 0x3e00 },
155 { 0x64, 0x0000 },
156 { 0x76, 0x0006 },
157 { 0x78, 0x0001 },
158 { 0x7a, 0x0000 },
159 };
160
161 static const struct regmap_config wm9712_regmap_config = {
162 .reg_bits = 16,
163 .reg_stride = 2,
164 .val_bits = 16,
165 .max_register = 0x7e,
166 .cache_type = REGCACHE_RBTREE,
167
168 .reg_defaults = wm9712_reg_defaults,
169 .num_reg_defaults = ARRAY_SIZE(wm9712_reg_defaults),
170 .volatile_reg = wm9712_volatile_reg,
171 .readable_reg = wm97xx_readable_reg,
172 .writeable_reg = wm97xx_writeable_reg,
173 };
174
175 static struct mfd_cell wm9712_cells[] = {
176 { .name = "wm9712-codec", },
177 { .name = "wm97xx-ts", },
178 };
179
180 static const struct reg_default wm9713_reg_defaults[] = {
181 { 0x02, 0x8080 },
182 { 0x04, 0x8080 },
183 { 0x06, 0x8080 },
184 { 0x08, 0xc880 },
185 { 0x0a, 0xe808 },
186 { 0x0c, 0xe808 },
187 { 0x0e, 0x0808 },
188 { 0x10, 0x00da },
189 { 0x12, 0x8000 },
190 { 0x14, 0xd600 },
191 { 0x16, 0xaaa0 },
192 { 0x18, 0xaaa0 },
193 { 0x1a, 0xaaa0 },
194 { 0x1c, 0x0000 },
195 { 0x1e, 0x0000 },
196 { 0x20, 0x0f0f },
197 { 0x22, 0x0040 },
198 { 0x24, 0x0000 },
199 { 0x26, 0x7f00 },
200 { 0x28, 0x0405 },
201 { 0x2a, 0x0410 },
202 { 0x2c, 0xbb80 },
203 { 0x2e, 0xbb80 },
204 { 0x32, 0xbb80 },
205 { 0x36, 0x4523 },
206 { 0x3a, 0x2000 },
207 { 0x3c, 0xfdff },
208 { 0x3e, 0xffff },
209 { 0x40, 0x0000 },
210 { 0x42, 0x0000 },
211 { 0x44, 0x0080 },
212 { 0x46, 0x0000 },
213
214 { 0x4c, 0xfffe },
215 { 0x4e, 0xffff },
216 { 0x50, 0x0000 },
217 { 0x52, 0x0000 },
218
219 { 0x56, 0xfffe },
220 { 0x58, 0x4000 },
221 { 0x5a, 0x0000 },
222 { 0x5c, 0x0000 },
223 { 0x60, 0xb032 },
224 { 0x62, 0x3e00 },
225 { 0x64, 0x0000 },
226 { 0x74, 0x0000 },
227 { 0x76, 0x0006 },
228 { 0x78, 0x0001 },
229 { 0x7a, 0x0000 },
230 };
231
232 static const struct regmap_config wm9713_regmap_config = {
233 .reg_bits = 16,
234 .reg_stride = 2,
235 .val_bits = 16,
236 .max_register = 0x7e,
237 .cache_type = REGCACHE_RBTREE,
238
239 .reg_defaults = wm9713_reg_defaults,
240 .num_reg_defaults = ARRAY_SIZE(wm9713_reg_defaults),
241 .volatile_reg = regmap_ac97_default_volatile,
242 .readable_reg = wm97xx_readable_reg,
243 .writeable_reg = wm97xx_writeable_reg,
244 };
245
246 static struct mfd_cell wm9713_cells[] = {
247 { .name = "wm9713-codec", },
248 { .name = "wm97xx-ts", },
249 };
250
251 static int wm97xx_ac97_probe(struct ac97_codec_device *adev)
252 {
253 struct wm97xx_priv *wm97xx;
254 const struct regmap_config *config;
255 struct wm97xx_platform_data *codec_pdata;
256 struct mfd_cell *cells;
257 int ret = -ENODEV, nb_cells, i;
258 struct wm97xx_pdata *pdata = snd_ac97_codec_get_platdata(adev);
259
260 wm97xx = devm_kzalloc(ac97_codec_dev2dev(adev),
261 sizeof(*wm97xx), GFP_KERNEL);
262 if (!wm97xx)
263 return -ENOMEM;
264
265 wm97xx->dev = ac97_codec_dev2dev(adev);
266 wm97xx->ac97 = snd_ac97_compat_alloc(adev);
267 if (IS_ERR(wm97xx->ac97))
268 return PTR_ERR(wm97xx->ac97);
269
270
271 ac97_set_drvdata(adev, wm97xx);
272 dev_info(wm97xx->dev, "wm97xx core found, id=0x%x\n",
273 adev->vendor_id);
274
275 codec_pdata = &wm97xx->codec_pdata;
276 codec_pdata->ac97 = wm97xx->ac97;
277 codec_pdata->batt_pdata = pdata ? pdata->batt_pdata : NULL;
278
279 switch (adev->vendor_id) {
280 case WM9705_VENDOR_ID:
281 config = &wm9705_regmap_config;
282 cells = wm9705_cells;
283 nb_cells = ARRAY_SIZE(wm9705_cells);
284 break;
285 case WM9712_VENDOR_ID:
286 config = &wm9712_regmap_config;
287 cells = wm9712_cells;
288 nb_cells = ARRAY_SIZE(wm9712_cells);
289 break;
290 case WM9713_VENDOR_ID:
291 config = &wm9713_regmap_config;
292 cells = wm9713_cells;
293 nb_cells = ARRAY_SIZE(wm9713_cells);
294 break;
295 default:
296 goto err_free_compat;
297 }
298
299 for (i = 0; i < nb_cells; i++) {
300 cells[i].platform_data = codec_pdata;
301 cells[i].pdata_size = sizeof(*codec_pdata);
302 }
303
304 codec_pdata->regmap = devm_regmap_init_ac97(wm97xx->ac97, config);
305 if (IS_ERR(codec_pdata->regmap)) {
306 ret = PTR_ERR(codec_pdata->regmap);
307 goto err_free_compat;
308 }
309
310 ret = devm_mfd_add_devices(wm97xx->dev, PLATFORM_DEVID_NONE,
311 cells, nb_cells, NULL, 0, NULL);
312 if (ret)
313 goto err_free_compat;
314
315 return ret;
316
317 err_free_compat:
318 snd_ac97_compat_release(wm97xx->ac97);
319 return ret;
320 }
321
322 static int wm97xx_ac97_remove(struct ac97_codec_device *adev)
323 {
324 struct wm97xx_priv *wm97xx = ac97_get_drvdata(adev);
325
326 snd_ac97_compat_release(wm97xx->ac97);
327
328 return 0;
329 }
330
331 static const struct ac97_id wm97xx_ac97_ids[] = {
332 { .id = WM9705_VENDOR_ID, .mask = WM97xx_VENDOR_ID_MASK },
333 { .id = WM9712_VENDOR_ID, .mask = WM97xx_VENDOR_ID_MASK },
334 { .id = WM9713_VENDOR_ID, .mask = WM97xx_VENDOR_ID_MASK },
335 { }
336 };
337
338 static struct ac97_codec_driver wm97xx_ac97_driver = {
339 .driver = {
340 .name = "wm97xx-core",
341 },
342 .probe = wm97xx_ac97_probe,
343 .remove = wm97xx_ac97_remove,
344 .id_table = wm97xx_ac97_ids,
345 };
346
347 static int __init wm97xx_module_init(void)
348 {
349 return snd_ac97_codec_driver_register(&wm97xx_ac97_driver);
350 }
351 module_init(wm97xx_module_init);
352
353 static void __exit wm97xx_module_exit(void)
354 {
355 snd_ac97_codec_driver_unregister(&wm97xx_ac97_driver);
356 }
357 module_exit(wm97xx_module_exit);
358
359 MODULE_DESCRIPTION("WM9712, WM9713 core driver");
360 MODULE_AUTHOR("Robert Jarzmik <robert.jarzmik@free.fr>");
361 MODULE_LICENSE("GPL");
362