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