[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / mfd / wm8350-core.c

/*
 * wm8350-core.c  --  Device access for Wolfson WM8350
 *
 * Copyright 2007, 2008 Wolfson Microelectronics PLC.
 *
 * Author: Liam Girdwood, Mark Brown
 *
 *  This program is free software; you can redistribute  it and/or modify it
 *  under  the terms of  the GNU General  Public License as published by the
 *  Free Software Foundation;  either version 2 of the  License, or (at your
 *  option) any later version.
 *
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/bug.h>
#include <linux/device.h>
#include <linux/delay.h>
#include <linux/interrupt.h>
#include <linux/regmap.h>
#include <linux/workqueue.h>

#include <linux/mfd/wm8350/core.h>
#include <linux/mfd/wm8350/audio.h>
#include <linux/mfd/wm8350/comparator.h>
#include <linux/mfd/wm8350/gpio.h>
#include <linux/mfd/wm8350/pmic.h>
#include <linux/mfd/wm8350/rtc.h>
#include <linux/mfd/wm8350/supply.h>
#include <linux/mfd/wm8350/wdt.h>

#define WM8350_CLOCK_CONTROL_1		0x28
#define WM8350_AIF_TEST			0x74

/* debug */
#define WM8350_BUS_DEBUG 0
#if WM8350_BUS_DEBUG
#define dump(regs, src) do { \
	int i_; \
	u16 *src_ = src; \
	printk(KERN_DEBUG); \
	for (i_ = 0; i_ < regs; i_++) \
		printk(" 0x%4.4x", *src_++); \
	printk("\n"); \
} while (0);
#else
#define dump(bytes, src)
#endif

#define WM8350_LOCK_DEBUG 0
#if WM8350_LOCK_DEBUG
#define ldbg(format, arg...) printk(format, ## arg)
#else
#define ldbg(format, arg...)
#endif

/*
 * WM8350 Device IO
 */
static DEFINE_MUTEX(reg_lock_mutex);

/*
 * Safe read, modify, write methods
 */
int wm8350_clear_bits(struct wm8350 *wm8350, u16 reg, u16 mask)
{
	return regmap_update_bits(wm8350->regmap, reg, mask, 0);
}
EXPORT_SYMBOL_GPL(wm8350_clear_bits);

int wm8350_set_bits(struct wm8350 *wm8350, u16 reg, u16 mask)
{
	return regmap_update_bits(wm8350->regmap, reg, mask, mask);
}
EXPORT_SYMBOL_GPL(wm8350_set_bits);

u16 wm8350_reg_read(struct wm8350 *wm8350, int reg)
{
	unsigned int data;
	int err;

	err = regmap_read(wm8350->regmap, reg, &data);
	if (err)
		dev_err(wm8350->dev, "read from reg R%d failed\n", reg);

	return data;
}
EXPORT_SYMBOL_GPL(wm8350_reg_read);

int wm8350_reg_write(struct wm8350 *wm8350, int reg, u16 val)
{
	int ret;

	ret = regmap_write(wm8350->regmap, reg, val);

	if (ret)
		dev_err(wm8350->dev, "write to reg R%d failed\n", reg);
	return ret;
}
EXPORT_SYMBOL_GPL(wm8350_reg_write);

int wm8350_block_read(struct wm8350 *wm8350, int start_reg, int regs,
		      u16 *dest)
{
	int err = 0;

	err = regmap_bulk_read(wm8350->regmap, start_reg, dest, regs);
	if (err)
		dev_err(wm8350->dev, "block read starting from R%d failed\n",
			start_reg);

	return err;
}
EXPORT_SYMBOL_GPL(wm8350_block_read);

int wm8350_block_write(struct wm8350 *wm8350, int start_reg, int regs,
		       u16 *src)
{
	int ret = 0;

	ret = regmap_bulk_write(wm8350->regmap, start_reg, src, regs);
	if (ret)
		dev_err(wm8350->dev, "block write starting at R%d failed\n",
			start_reg);

	return ret;
}
EXPORT_SYMBOL_GPL(wm8350_block_write);

/**
 * wm8350_reg_lock()
 *
 * The WM8350 has a hardware lock which can be used to prevent writes to
 * some registers (generally those which can cause particularly serious
 * problems if misused).  This function enables that lock.
 */
int wm8350_reg_lock(struct wm8350 *wm8350)
{
	int ret;

	mutex_lock(&reg_lock_mutex);

	ldbg(__func__);

	ret = wm8350_reg_write(wm8350, WM8350_SECURITY, WM8350_LOCK_KEY);
	if (ret)
		dev_err(wm8350->dev, "lock failed\n");

	wm8350->unlocked = false;

	mutex_unlock(&reg_lock_mutex);

	return ret;
}
EXPORT_SYMBOL_GPL(wm8350_reg_lock);

/**
 * wm8350_reg_unlock()
 *
 * The WM8350 has a hardware lock which can be used to prevent writes to
 * some registers (generally those which can cause particularly serious
 * problems if misused).  This function disables that lock so updates
 * can be performed.  For maximum safety this should be done only when
 * required.
 */
int wm8350_reg_unlock(struct wm8350 *wm8350)
{
	int ret;

	mutex_lock(&reg_lock_mutex);

	ldbg(__func__);

	ret = wm8350_reg_write(wm8350, WM8350_SECURITY, WM8350_UNLOCK_KEY);
	if (ret)
		dev_err(wm8350->dev, "unlock failed\n");

	wm8350->unlocked = true;

	mutex_unlock(&reg_lock_mutex);

	return ret;
}
EXPORT_SYMBOL_GPL(wm8350_reg_unlock);

int wm8350_read_auxadc(struct wm8350 *wm8350, int channel, int scale, int vref)
{
	u16 reg, result = 0;

	if (channel < WM8350_AUXADC_AUX1 || channel > WM8350_AUXADC_TEMP)
		return -EINVAL;
	if (channel >= WM8350_AUXADC_USB && channel <= WM8350_AUXADC_TEMP
	    && (scale != 0 || vref != 0))
		return -EINVAL;

	mutex_lock(&wm8350->auxadc_mutex);

	/* Turn on the ADC */
	reg = wm8350_reg_read(wm8350, WM8350_POWER_MGMT_5);
	wm8350_reg_write(wm8350, WM8350_POWER_MGMT_5, reg | WM8350_AUXADC_ENA);

	if (scale || vref) {
		reg = scale << 13;
		reg |= vref << 12;
		wm8350_reg_write(wm8350, WM8350_AUX1_READBACK + channel, reg);
	}

	reg = wm8350_reg_read(wm8350, WM8350_DIGITISER_CONTROL_1);
	reg |= 1 << channel | WM8350_AUXADC_POLL;
	wm8350_reg_write(wm8350, WM8350_DIGITISER_CONTROL_1, reg);

	/* If a late IRQ left the completion signalled then consume
	 * the completion. */
	try_wait_for_completion(&wm8350->auxadc_done);

	/* We ignore the result of the completion and just check for a
	 * conversion result, allowing us to soldier on if the IRQ
	 * infrastructure is not set up for the chip. */
	wait_for_completion_timeout(&wm8350->auxadc_done, msecs_to_jiffies(5));

	reg = wm8350_reg_read(wm8350, WM8350_DIGITISER_CONTROL_1);
	if (reg & WM8350_AUXADC_POLL)
		dev_err(wm8350->dev, "adc chn %d read timeout\n", channel);
	else
		result = wm8350_reg_read(wm8350,
					 WM8350_AUX1_READBACK + channel);

	/* Turn off the ADC */
	reg = wm8350_reg_read(wm8350, WM8350_POWER_MGMT_5);
	wm8350_reg_write(wm8350, WM8350_POWER_MGMT_5,
			 reg & ~WM8350_AUXADC_ENA);

	mutex_unlock(&wm8350->auxadc_mutex);

	return result & WM8350_AUXADC_DATA1_MASK;
}
EXPORT_SYMBOL_GPL(wm8350_read_auxadc);

static irqreturn_t wm8350_auxadc_irq(int irq, void *irq_data)
{
	struct wm8350 *wm8350 = irq_data;

	complete(&wm8350->auxadc_done);

	return IRQ_HANDLED;
}

/*
 * Register a client device.  This is non-fatal since there is no need to
 * fail the entire device init due to a single platform device failing.
 */
static void wm8350_client_dev_register(struct wm8350 *wm8350,
				       const char *name,
				       struct platform_device **pdev)
{
	int ret;

	*pdev = platform_device_alloc(name, -1);
	if (*pdev == NULL) {
		dev_err(wm8350->dev, "Failed to allocate %s\n", name);
		return;
	}

	(*pdev)->dev.parent = wm8350->dev;
	platform_set_drvdata(*pdev, wm8350);
	ret = platform_device_add(*pdev);
	if (ret != 0) {
		dev_err(wm8350->dev, "Failed to register %s: %d\n", name, ret);
		platform_device_put(*pdev);
		*pdev = NULL;
	}
}

int wm8350_device_init(struct wm8350 *wm8350, int irq,
		       struct wm8350_platform_data *pdata)
{
	int ret;
	unsigned int id1, id2, mask_rev;
	unsigned int cust_id, mode, chip_rev;

	dev_set_drvdata(wm8350->dev, wm8350);

	/* get WM8350 revision and config mode */
	ret = regmap_read(wm8350->regmap, WM8350_RESET_ID, &id1);
	if (ret != 0) {
		dev_err(wm8350->dev, "Failed to read ID: %d\n", ret);
		goto err;
	}

	ret = regmap_read(wm8350->regmap, WM8350_ID, &id2);
	if (ret != 0) {
		dev_err(wm8350->dev, "Failed to read ID: %d\n", ret);
		goto err;
	}

	ret = regmap_read(wm8350->regmap, WM8350_REVISION, &mask_rev);
	if (ret != 0) {
		dev_err(wm8350->dev, "Failed to read revision: %d\n", ret);
		goto err;
	}

	if (id1 != 0x6143) {
		dev_err(wm8350->dev,
			"Device with ID %x is not a WM8350\n", id1);
		ret = -ENODEV;
		goto err;
	}

	mode = id2 & WM8350_CONF_STS_MASK >> 10;
	cust_id = id2 & WM8350_CUST_ID_MASK;
	chip_rev = (id2 & WM8350_CHIP_REV_MASK) >> 12;
	dev_info(wm8350->dev,
		 "CONF_STS %d, CUST_ID %d, MASK_REV %d, CHIP_REV %d\n",
		 mode, cust_id, mask_rev, chip_rev);

	if (cust_id != 0) {
		dev_err(wm8350->dev, "Unsupported CUST_ID\n");
		ret = -ENODEV;
		goto err;
	}

	switch (mask_rev) {
	case 0:
		wm8350->pmic.max_dcdc = WM8350_DCDC_6;
		wm8350->pmic.max_isink = WM8350_ISINK_B;

		switch (chip_rev) {
		case WM8350_REV_E:
			dev_info(wm8350->dev, "WM8350 Rev E\n");
			break;
		case WM8350_REV_F:
			dev_info(wm8350->dev, "WM8350 Rev F\n");
			break;
		case WM8350_REV_G:
			dev_info(wm8350->dev, "WM8350 Rev G\n");
			wm8350->power.rev_g_coeff = 1;
			break;
		case WM8350_REV_H:
			dev_info(wm8350->dev, "WM8350 Rev H\n");
			wm8350->power.rev_g_coeff = 1;
			break;
		default:
			/* For safety we refuse to run on unknown hardware */
			dev_err(wm8350->dev, "Unknown WM8350 CHIP_REV\n");
			ret = -ENODEV;
			goto err;
		}
		break;

	case 1:
		wm8350->pmic.max_dcdc = WM8350_DCDC_4;
		wm8350->pmic.max_isink = WM8350_ISINK_A;

		switch (chip_rev) {
		case 0:
			dev_info(wm8350->dev, "WM8351 Rev A\n");
			wm8350->power.rev_g_coeff = 1;
			break;

		case 1:
			dev_info(wm8350->dev, "WM8351 Rev B\n");
			wm8350->power.rev_g_coeff = 1;
			break;

		default:
			dev_err(wm8350->dev, "Unknown WM8351 CHIP_REV\n");
			ret = -ENODEV;
			goto err;
		}
		break;

	case 2:
		wm8350->pmic.max_dcdc = WM8350_DCDC_6;
		wm8350->pmic.max_isink = WM8350_ISINK_B;

		switch (chip_rev) {
		case 0:
			dev_info(wm8350->dev, "WM8352 Rev A\n");
			wm8350->power.rev_g_coeff = 1;
			break;

		default:
			dev_err(wm8350->dev, "Unknown WM8352 CHIP_REV\n");
			ret = -ENODEV;
			goto err;
		}
		break;

	default:
		dev_err(wm8350->dev, "Unknown MASK_REV\n");
		ret = -ENODEV;
		goto err;
	}

	mutex_init(&wm8350->auxadc_mutex);
	init_completion(&wm8350->auxadc_done);

	ret = wm8350_irq_init(wm8350, irq, pdata);
	if (ret < 0)
		goto err;

	if (wm8350->irq_base) {
		ret = request_threaded_irq(wm8350->irq_base +
					   WM8350_IRQ_AUXADC_DATARDY,
					   NULL, wm8350_auxadc_irq, 0,
					   "auxadc", wm8350);
		if (ret < 0)
			dev_warn(wm8350->dev,
				 "Failed to request AUXADC IRQ: %d\n", ret);
	}

	if (pdata && pdata->init) {
		ret = pdata->init(wm8350);
		if (ret != 0) {
			dev_err(wm8350->dev, "Platform init() failed: %d\n",
				ret);
			goto err_irq;
		}
	}

	wm8350_reg_write(wm8350, WM8350_SYSTEM_INTERRUPTS_MASK, 0x0);

	wm8350_client_dev_register(wm8350, "wm8350-codec",
				   &(wm8350->codec.pdev));
	wm8350_client_dev_register(wm8350, "wm8350-gpio",
				   &(wm8350->gpio.pdev));
	wm8350_client_dev_register(wm8350, "wm8350-hwmon",
				   &(wm8350->hwmon.pdev));
	wm8350_client_dev_register(wm8350, "wm8350-power",
				   &(wm8350->power.pdev));
	wm8350_client_dev_register(wm8350, "wm8350-rtc", &(wm8350->rtc.pdev));
	wm8350_client_dev_register(wm8350, "wm8350-wdt", &(wm8350->wdt.pdev));

	return 0;

err_irq:
	wm8350_irq_exit(wm8350);
err:
	return ret;
}
EXPORT_SYMBOL_GPL(wm8350_device_init);

void wm8350_device_exit(struct wm8350 *wm8350)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(wm8350->pmic.led); i++)
		platform_device_unregister(wm8350->pmic.led[i].pdev);

	for (i = 0; i < ARRAY_SIZE(wm8350->pmic.pdev); i++)
		platform_device_unregister(wm8350->pmic.pdev[i]);

	platform_device_unregister(wm8350->wdt.pdev);
	platform_device_unregister(wm8350->rtc.pdev);
	platform_device_unregister(wm8350->power.pdev);
	platform_device_unregister(wm8350->hwmon.pdev);
	platform_device_unregister(wm8350->gpio.pdev);
	platform_device_unregister(wm8350->codec.pdev);

	if (wm8350->irq_base)
		free_irq(wm8350->irq_base + WM8350_IRQ_AUXADC_DATARDY, wm8350);

	wm8350_irq_exit(wm8350);
}
EXPORT_SYMBOL_GPL(wm8350_device_exit);

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