[go: nahoru, domu]

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 */
62static DEFINE_MUTEX(reg_lock_mutex);
63
64/*
65 * Safe read, modify, write methods
66 */
67int wm8350_clear_bits(struct wm8350 *wm8350, u16 reg, u16 mask)
68{
69	return regmap_update_bits(wm8350->regmap, reg, mask, 0);
70}
71EXPORT_SYMBOL_GPL(wm8350_clear_bits);
72
73int wm8350_set_bits(struct wm8350 *wm8350, u16 reg, u16 mask)
74{
75	return regmap_update_bits(wm8350->regmap, reg, mask, mask);
76}
77EXPORT_SYMBOL_GPL(wm8350_set_bits);
78
79u16 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}
90EXPORT_SYMBOL_GPL(wm8350_reg_read);
91
92int 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}
102EXPORT_SYMBOL_GPL(wm8350_reg_write);
103
104int 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}
116EXPORT_SYMBOL_GPL(wm8350_block_read);
117
118int 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}
130EXPORT_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 */
139int 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}
157EXPORT_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 */
168int 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}
186EXPORT_SYMBOL_GPL(wm8350_reg_unlock);
187
188int 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}
239EXPORT_SYMBOL_GPL(wm8350_read_auxadc);
240
241static 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 */
254static 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
276int 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, 0,
408					   "auxadc", wm8350);
409		if (ret < 0)
410			dev_warn(wm8350->dev,
411				 "Failed to request AUXADC IRQ: %d\n", ret);
412	}
413
414	if (pdata && pdata->init) {
415		ret = pdata->init(wm8350);
416		if (ret != 0) {
417			dev_err(wm8350->dev, "Platform init() failed: %d\n",
418				ret);
419			goto err_irq;
420		}
421	}
422
423	wm8350_reg_write(wm8350, WM8350_SYSTEM_INTERRUPTS_MASK, 0x0);
424
425	wm8350_client_dev_register(wm8350, "wm8350-codec",
426				   &(wm8350->codec.pdev));
427	wm8350_client_dev_register(wm8350, "wm8350-gpio",
428				   &(wm8350->gpio.pdev));
429	wm8350_client_dev_register(wm8350, "wm8350-hwmon",
430				   &(wm8350->hwmon.pdev));
431	wm8350_client_dev_register(wm8350, "wm8350-power",
432				   &(wm8350->power.pdev));
433	wm8350_client_dev_register(wm8350, "wm8350-rtc", &(wm8350->rtc.pdev));
434	wm8350_client_dev_register(wm8350, "wm8350-wdt", &(wm8350->wdt.pdev));
435
436	return 0;
437
438err_irq:
439	wm8350_irq_exit(wm8350);
440err:
441	return ret;
442}
443EXPORT_SYMBOL_GPL(wm8350_device_init);
444
445void wm8350_device_exit(struct wm8350 *wm8350)
446{
447	int i;
448
449	for (i = 0; i < ARRAY_SIZE(wm8350->pmic.led); i++)
450		platform_device_unregister(wm8350->pmic.led[i].pdev);
451
452	for (i = 0; i < ARRAY_SIZE(wm8350->pmic.pdev); i++)
453		platform_device_unregister(wm8350->pmic.pdev[i]);
454
455	platform_device_unregister(wm8350->wdt.pdev);
456	platform_device_unregister(wm8350->rtc.pdev);
457	platform_device_unregister(wm8350->power.pdev);
458	platform_device_unregister(wm8350->hwmon.pdev);
459	platform_device_unregister(wm8350->gpio.pdev);
460	platform_device_unregister(wm8350->codec.pdev);
461
462	if (wm8350->irq_base)
463		free_irq(wm8350->irq_base + WM8350_IRQ_AUXADC_DATARDY, wm8350);
464
465	wm8350_irq_exit(wm8350);
466}
467EXPORT_SYMBOL_GPL(wm8350_device_exit);
468
469MODULE_DESCRIPTION("WM8350 AudioPlus PMIC core driver");
470MODULE_LICENSE("GPL");
471