• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * wm8350-core.c  --  Device access for Wolfson WM8350
3  *
4  * Copyright 2007, 2008 Wolfson Microelectronics PLC.
5  *
6  * Author: Liam Girdwood, Mark Brown
7  *
8  *  This program is free software; you can redistribute  it and/or modify it
9  *  under  the terms of  the GNU General  Public License as published by the
10  *  Free Software Foundation;  either version 2 of the  License, or (at your
11  *  option) any later version.
12  *
13  */
14 
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/slab.h>
18 #include <linux/bug.h>
19 #include <linux/device.h>
20 #include <linux/delay.h>
21 #include <linux/interrupt.h>
22 #include <linux/regmap.h>
23 #include <linux/workqueue.h>
24 
25 #include <linux/mfd/wm8350/core.h>
26 #include <linux/mfd/wm8350/audio.h>
27 #include <linux/mfd/wm8350/comparator.h>
28 #include <linux/mfd/wm8350/gpio.h>
29 #include <linux/mfd/wm8350/pmic.h>
30 #include <linux/mfd/wm8350/rtc.h>
31 #include <linux/mfd/wm8350/supply.h>
32 #include <linux/mfd/wm8350/wdt.h>
33 
34 #define WM8350_CLOCK_CONTROL_1		0x28
35 #define WM8350_AIF_TEST			0x74
36 
37 /* debug */
38 #define WM8350_BUS_DEBUG 0
39 #if WM8350_BUS_DEBUG
40 #define dump(regs, src) do { \
41 	int i_; \
42 	u16 *src_ = src; \
43 	printk(KERN_DEBUG); \
44 	for (i_ = 0; i_ < regs; i_++) \
45 		printk(" 0x%4.4x", *src_++); \
46 	printk("\n"); \
47 } while (0);
48 #else
49 #define dump(bytes, src)
50 #endif
51 
52 #define WM8350_LOCK_DEBUG 0
53 #if WM8350_LOCK_DEBUG
54 #define ldbg(format, arg...) printk(format, ## arg)
55 #else
56 #define ldbg(format, arg...)
57 #endif
58 
59 /*
60  * WM8350 Device IO
61  */
62 static DEFINE_MUTEX(reg_lock_mutex);
63 
64 /*
65  * Safe read, modify, write methods
66  */
wm8350_clear_bits(struct wm8350 * wm8350,u16 reg,u16 mask)67 int wm8350_clear_bits(struct wm8350 *wm8350, u16 reg, u16 mask)
68 {
69 	return regmap_update_bits(wm8350->regmap, reg, mask, 0);
70 }
71 EXPORT_SYMBOL_GPL(wm8350_clear_bits);
72 
wm8350_set_bits(struct wm8350 * wm8350,u16 reg,u16 mask)73 int wm8350_set_bits(struct wm8350 *wm8350, u16 reg, u16 mask)
74 {
75 	return regmap_update_bits(wm8350->regmap, reg, mask, mask);
76 }
77 EXPORT_SYMBOL_GPL(wm8350_set_bits);
78 
wm8350_reg_read(struct wm8350 * wm8350,int reg)79 u16 wm8350_reg_read(struct wm8350 *wm8350, int reg)
80 {
81 	unsigned int data;
82 	int err;
83 
84 	err = regmap_read(wm8350->regmap, reg, &data);
85 	if (err)
86 		dev_err(wm8350->dev, "read from reg R%d failed\n", reg);
87 
88 	return data;
89 }
90 EXPORT_SYMBOL_GPL(wm8350_reg_read);
91 
wm8350_reg_write(struct wm8350 * wm8350,int reg,u16 val)92 int wm8350_reg_write(struct wm8350 *wm8350, int reg, u16 val)
93 {
94 	int ret;
95 
96 	ret = regmap_write(wm8350->regmap, reg, val);
97 
98 	if (ret)
99 		dev_err(wm8350->dev, "write to reg R%d failed\n", reg);
100 	return ret;
101 }
102 EXPORT_SYMBOL_GPL(wm8350_reg_write);
103 
wm8350_block_read(struct wm8350 * wm8350,int start_reg,int regs,u16 * dest)104 int wm8350_block_read(struct wm8350 *wm8350, int start_reg, int regs,
105 		      u16 *dest)
106 {
107 	int err = 0;
108 
109 	err = regmap_bulk_read(wm8350->regmap, start_reg, dest, regs);
110 	if (err)
111 		dev_err(wm8350->dev, "block read starting from R%d failed\n",
112 			start_reg);
113 
114 	return err;
115 }
116 EXPORT_SYMBOL_GPL(wm8350_block_read);
117 
wm8350_block_write(struct wm8350 * wm8350,int start_reg,int regs,u16 * src)118 int wm8350_block_write(struct wm8350 *wm8350, int start_reg, int regs,
119 		       u16 *src)
120 {
121 	int ret = 0;
122 
123 	ret = regmap_bulk_write(wm8350->regmap, start_reg, src, regs);
124 	if (ret)
125 		dev_err(wm8350->dev, "block write starting at R%d failed\n",
126 			start_reg);
127 
128 	return ret;
129 }
130 EXPORT_SYMBOL_GPL(wm8350_block_write);
131 
132 /**
133  * wm8350_reg_lock()
134  *
135  * The WM8350 has a hardware lock which can be used to prevent writes to
136  * some registers (generally those which can cause particularly serious
137  * problems if misused).  This function enables that lock.
138  */
wm8350_reg_lock(struct wm8350 * wm8350)139 int wm8350_reg_lock(struct wm8350 *wm8350)
140 {
141 	int ret;
142 
143 	mutex_lock(&reg_lock_mutex);
144 
145 	ldbg(__func__);
146 
147 	ret = wm8350_reg_write(wm8350, WM8350_SECURITY, WM8350_LOCK_KEY);
148 	if (ret)
149 		dev_err(wm8350->dev, "lock failed\n");
150 
151 	wm8350->unlocked = false;
152 
153 	mutex_unlock(&reg_lock_mutex);
154 
155 	return ret;
156 }
157 EXPORT_SYMBOL_GPL(wm8350_reg_lock);
158 
159 /**
160  * wm8350_reg_unlock()
161  *
162  * The WM8350 has a hardware lock which can be used to prevent writes to
163  * some registers (generally those which can cause particularly serious
164  * problems if misused).  This function disables that lock so updates
165  * can be performed.  For maximum safety this should be done only when
166  * required.
167  */
wm8350_reg_unlock(struct wm8350 * wm8350)168 int wm8350_reg_unlock(struct wm8350 *wm8350)
169 {
170 	int ret;
171 
172 	mutex_lock(&reg_lock_mutex);
173 
174 	ldbg(__func__);
175 
176 	ret = wm8350_reg_write(wm8350, WM8350_SECURITY, WM8350_UNLOCK_KEY);
177 	if (ret)
178 		dev_err(wm8350->dev, "unlock failed\n");
179 
180 	wm8350->unlocked = true;
181 
182 	mutex_unlock(&reg_lock_mutex);
183 
184 	return ret;
185 }
186 EXPORT_SYMBOL_GPL(wm8350_reg_unlock);
187 
wm8350_read_auxadc(struct wm8350 * wm8350,int channel,int scale,int vref)188 int wm8350_read_auxadc(struct wm8350 *wm8350, int channel, int scale, int vref)
189 {
190 	u16 reg, result = 0;
191 
192 	if (channel < WM8350_AUXADC_AUX1 || channel > WM8350_AUXADC_TEMP)
193 		return -EINVAL;
194 	if (channel >= WM8350_AUXADC_USB && channel <= WM8350_AUXADC_TEMP
195 	    && (scale != 0 || vref != 0))
196 		return -EINVAL;
197 
198 	mutex_lock(&wm8350->auxadc_mutex);
199 
200 	/* Turn on the ADC */
201 	reg = wm8350_reg_read(wm8350, WM8350_POWER_MGMT_5);
202 	wm8350_reg_write(wm8350, WM8350_POWER_MGMT_5, reg | WM8350_AUXADC_ENA);
203 
204 	if (scale || vref) {
205 		reg = scale << 13;
206 		reg |= vref << 12;
207 		wm8350_reg_write(wm8350, WM8350_AUX1_READBACK + channel, reg);
208 	}
209 
210 	reg = wm8350_reg_read(wm8350, WM8350_DIGITISER_CONTROL_1);
211 	reg |= 1 << channel | WM8350_AUXADC_POLL;
212 	wm8350_reg_write(wm8350, WM8350_DIGITISER_CONTROL_1, reg);
213 
214 	/* If a late IRQ left the completion signalled then consume
215 	 * the completion. */
216 	try_wait_for_completion(&wm8350->auxadc_done);
217 
218 	/* We ignore the result of the completion and just check for a
219 	 * conversion result, allowing us to soldier on if the IRQ
220 	 * infrastructure is not set up for the chip. */
221 	wait_for_completion_timeout(&wm8350->auxadc_done, msecs_to_jiffies(5));
222 
223 	reg = wm8350_reg_read(wm8350, WM8350_DIGITISER_CONTROL_1);
224 	if (reg & WM8350_AUXADC_POLL)
225 		dev_err(wm8350->dev, "adc chn %d read timeout\n", channel);
226 	else
227 		result = wm8350_reg_read(wm8350,
228 					 WM8350_AUX1_READBACK + channel);
229 
230 	/* Turn off the ADC */
231 	reg = wm8350_reg_read(wm8350, WM8350_POWER_MGMT_5);
232 	wm8350_reg_write(wm8350, WM8350_POWER_MGMT_5,
233 			 reg & ~WM8350_AUXADC_ENA);
234 
235 	mutex_unlock(&wm8350->auxadc_mutex);
236 
237 	return result & WM8350_AUXADC_DATA1_MASK;
238 }
239 EXPORT_SYMBOL_GPL(wm8350_read_auxadc);
240 
wm8350_auxadc_irq(int irq,void * irq_data)241 static irqreturn_t wm8350_auxadc_irq(int irq, void *irq_data)
242 {
243 	struct wm8350 *wm8350 = irq_data;
244 
245 	complete(&wm8350->auxadc_done);
246 
247 	return IRQ_HANDLED;
248 }
249 
250 /*
251  * Register a client device.  This is non-fatal since there is no need to
252  * fail the entire device init due to a single platform device failing.
253  */
wm8350_client_dev_register(struct wm8350 * wm8350,const char * name,struct platform_device ** pdev)254 static void wm8350_client_dev_register(struct wm8350 *wm8350,
255 				       const char *name,
256 				       struct platform_device **pdev)
257 {
258 	int ret;
259 
260 	*pdev = platform_device_alloc(name, -1);
261 	if (*pdev == NULL) {
262 		dev_err(wm8350->dev, "Failed to allocate %s\n", name);
263 		return;
264 	}
265 
266 	(*pdev)->dev.parent = wm8350->dev;
267 	platform_set_drvdata(*pdev, wm8350);
268 	ret = platform_device_add(*pdev);
269 	if (ret != 0) {
270 		dev_err(wm8350->dev, "Failed to register %s: %d\n", name, ret);
271 		platform_device_put(*pdev);
272 		*pdev = NULL;
273 	}
274 }
275 
wm8350_device_init(struct wm8350 * wm8350,int irq,struct wm8350_platform_data * pdata)276 int wm8350_device_init(struct wm8350 *wm8350, int irq,
277 		       struct wm8350_platform_data *pdata)
278 {
279 	int ret;
280 	unsigned int id1, id2, mask_rev;
281 	unsigned int cust_id, mode, chip_rev;
282 
283 	dev_set_drvdata(wm8350->dev, wm8350);
284 
285 	/* get WM8350 revision and config mode */
286 	ret = regmap_read(wm8350->regmap, WM8350_RESET_ID, &id1);
287 	if (ret != 0) {
288 		dev_err(wm8350->dev, "Failed to read ID: %d\n", ret);
289 		goto err;
290 	}
291 
292 	ret = regmap_read(wm8350->regmap, WM8350_ID, &id2);
293 	if (ret != 0) {
294 		dev_err(wm8350->dev, "Failed to read ID: %d\n", ret);
295 		goto err;
296 	}
297 
298 	ret = regmap_read(wm8350->regmap, WM8350_REVISION, &mask_rev);
299 	if (ret != 0) {
300 		dev_err(wm8350->dev, "Failed to read revision: %d\n", ret);
301 		goto err;
302 	}
303 
304 	if (id1 != 0x6143) {
305 		dev_err(wm8350->dev,
306 			"Device with ID %x is not a WM8350\n", id1);
307 		ret = -ENODEV;
308 		goto err;
309 	}
310 
311 	mode = (id2 & WM8350_CONF_STS_MASK) >> 10;
312 	cust_id = id2 & WM8350_CUST_ID_MASK;
313 	chip_rev = (id2 & WM8350_CHIP_REV_MASK) >> 12;
314 	dev_info(wm8350->dev,
315 		 "CONF_STS %d, CUST_ID %d, MASK_REV %d, CHIP_REV %d\n",
316 		 mode, cust_id, mask_rev, chip_rev);
317 
318 	if (cust_id != 0) {
319 		dev_err(wm8350->dev, "Unsupported CUST_ID\n");
320 		ret = -ENODEV;
321 		goto err;
322 	}
323 
324 	switch (mask_rev) {
325 	case 0:
326 		wm8350->pmic.max_dcdc = WM8350_DCDC_6;
327 		wm8350->pmic.max_isink = WM8350_ISINK_B;
328 
329 		switch (chip_rev) {
330 		case WM8350_REV_E:
331 			dev_info(wm8350->dev, "WM8350 Rev E\n");
332 			break;
333 		case WM8350_REV_F:
334 			dev_info(wm8350->dev, "WM8350 Rev F\n");
335 			break;
336 		case WM8350_REV_G:
337 			dev_info(wm8350->dev, "WM8350 Rev G\n");
338 			wm8350->power.rev_g_coeff = 1;
339 			break;
340 		case WM8350_REV_H:
341 			dev_info(wm8350->dev, "WM8350 Rev H\n");
342 			wm8350->power.rev_g_coeff = 1;
343 			break;
344 		default:
345 			/* For safety we refuse to run on unknown hardware */
346 			dev_err(wm8350->dev, "Unknown WM8350 CHIP_REV\n");
347 			ret = -ENODEV;
348 			goto err;
349 		}
350 		break;
351 
352 	case 1:
353 		wm8350->pmic.max_dcdc = WM8350_DCDC_4;
354 		wm8350->pmic.max_isink = WM8350_ISINK_A;
355 
356 		switch (chip_rev) {
357 		case 0:
358 			dev_info(wm8350->dev, "WM8351 Rev A\n");
359 			wm8350->power.rev_g_coeff = 1;
360 			break;
361 
362 		case 1:
363 			dev_info(wm8350->dev, "WM8351 Rev B\n");
364 			wm8350->power.rev_g_coeff = 1;
365 			break;
366 
367 		default:
368 			dev_err(wm8350->dev, "Unknown WM8351 CHIP_REV\n");
369 			ret = -ENODEV;
370 			goto err;
371 		}
372 		break;
373 
374 	case 2:
375 		wm8350->pmic.max_dcdc = WM8350_DCDC_6;
376 		wm8350->pmic.max_isink = WM8350_ISINK_B;
377 
378 		switch (chip_rev) {
379 		case 0:
380 			dev_info(wm8350->dev, "WM8352 Rev A\n");
381 			wm8350->power.rev_g_coeff = 1;
382 			break;
383 
384 		default:
385 			dev_err(wm8350->dev, "Unknown WM8352 CHIP_REV\n");
386 			ret = -ENODEV;
387 			goto err;
388 		}
389 		break;
390 
391 	default:
392 		dev_err(wm8350->dev, "Unknown MASK_REV\n");
393 		ret = -ENODEV;
394 		goto err;
395 	}
396 
397 	mutex_init(&wm8350->auxadc_mutex);
398 	init_completion(&wm8350->auxadc_done);
399 
400 	ret = wm8350_irq_init(wm8350, irq, pdata);
401 	if (ret < 0)
402 		goto err;
403 
404 	if (wm8350->irq_base) {
405 		ret = request_threaded_irq(wm8350->irq_base +
406 					   WM8350_IRQ_AUXADC_DATARDY,
407 					   NULL, wm8350_auxadc_irq,
408 					   IRQF_ONESHOT,
409 					   "auxadc", wm8350);
410 		if (ret < 0)
411 			dev_warn(wm8350->dev,
412 				 "Failed to request AUXADC IRQ: %d\n", ret);
413 	}
414 
415 	if (pdata && pdata->init) {
416 		ret = pdata->init(wm8350);
417 		if (ret != 0) {
418 			dev_err(wm8350->dev, "Platform init() failed: %d\n",
419 				ret);
420 			goto err_irq;
421 		}
422 	}
423 
424 	wm8350_reg_write(wm8350, WM8350_SYSTEM_INTERRUPTS_MASK, 0x0);
425 
426 	wm8350_client_dev_register(wm8350, "wm8350-codec",
427 				   &(wm8350->codec.pdev));
428 	wm8350_client_dev_register(wm8350, "wm8350-gpio",
429 				   &(wm8350->gpio.pdev));
430 	wm8350_client_dev_register(wm8350, "wm8350-hwmon",
431 				   &(wm8350->hwmon.pdev));
432 	wm8350_client_dev_register(wm8350, "wm8350-power",
433 				   &(wm8350->power.pdev));
434 	wm8350_client_dev_register(wm8350, "wm8350-rtc", &(wm8350->rtc.pdev));
435 	wm8350_client_dev_register(wm8350, "wm8350-wdt", &(wm8350->wdt.pdev));
436 
437 	return 0;
438 
439 err_irq:
440 	wm8350_irq_exit(wm8350);
441 err:
442 	return ret;
443 }
444 EXPORT_SYMBOL_GPL(wm8350_device_init);
445 
wm8350_device_exit(struct wm8350 * wm8350)446 void wm8350_device_exit(struct wm8350 *wm8350)
447 {
448 	int i;
449 
450 	for (i = 0; i < ARRAY_SIZE(wm8350->pmic.led); i++)
451 		platform_device_unregister(wm8350->pmic.led[i].pdev);
452 
453 	for (i = 0; i < ARRAY_SIZE(wm8350->pmic.pdev); i++)
454 		platform_device_unregister(wm8350->pmic.pdev[i]);
455 
456 	platform_device_unregister(wm8350->wdt.pdev);
457 	platform_device_unregister(wm8350->rtc.pdev);
458 	platform_device_unregister(wm8350->power.pdev);
459 	platform_device_unregister(wm8350->hwmon.pdev);
460 	platform_device_unregister(wm8350->gpio.pdev);
461 	platform_device_unregister(wm8350->codec.pdev);
462 
463 	if (wm8350->irq_base)
464 		free_irq(wm8350->irq_base + WM8350_IRQ_AUXADC_DATARDY, wm8350);
465 
466 	wm8350_irq_exit(wm8350);
467 }
468 EXPORT_SYMBOL_GPL(wm8350_device_exit);
469 
470 MODULE_DESCRIPTION("WM8350 AudioPlus PMIC core driver");
471 MODULE_LICENSE("GPL");
472