1550 lines
31 KiB
C
1550 lines
31 KiB
C
/*
|
|
* wm831x-core.c -- Device access for Wolfson WM831x PMICs
|
|
*
|
|
* Copyright 2009 Wolfson Microelectronics PLC.
|
|
*
|
|
* Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
|
|
*
|
|
* 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/i2c.h>
|
|
#include <linux/bcd.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/mfd/core.h>
|
|
|
|
#include <linux/mfd/wm831x/core.h>
|
|
#include <linux/mfd/wm831x/pdata.h>
|
|
#include <linux/mfd/wm831x/irq.h>
|
|
#include <linux/mfd/wm831x/auxadc.h>
|
|
#include <linux/mfd/wm831x/otp.h>
|
|
#include <linux/mfd/wm831x/regulator.h>
|
|
|
|
/* Current settings - values are 2*2^(reg_val/4) microamps. These are
|
|
* exported since they are used by multiple drivers.
|
|
*/
|
|
int wm831x_isinkv_values[WM831X_ISINK_MAX_ISEL] = {
|
|
2,
|
|
2,
|
|
3,
|
|
3,
|
|
4,
|
|
5,
|
|
6,
|
|
7,
|
|
8,
|
|
10,
|
|
11,
|
|
13,
|
|
16,
|
|
19,
|
|
23,
|
|
27,
|
|
32,
|
|
38,
|
|
45,
|
|
54,
|
|
64,
|
|
76,
|
|
91,
|
|
108,
|
|
128,
|
|
152,
|
|
181,
|
|
215,
|
|
256,
|
|
304,
|
|
362,
|
|
431,
|
|
512,
|
|
609,
|
|
724,
|
|
861,
|
|
1024,
|
|
1218,
|
|
1448,
|
|
1722,
|
|
2048,
|
|
2435,
|
|
2896,
|
|
3444,
|
|
4096,
|
|
4871,
|
|
5793,
|
|
6889,
|
|
8192,
|
|
9742,
|
|
11585,
|
|
13777,
|
|
16384,
|
|
19484,
|
|
23170,
|
|
27554,
|
|
};
|
|
EXPORT_SYMBOL_GPL(wm831x_isinkv_values);
|
|
|
|
enum wm831x_parent {
|
|
WM8310 = 0,
|
|
WM8311 = 1,
|
|
WM8312 = 2,
|
|
};
|
|
|
|
static int wm831x_reg_locked(struct wm831x *wm831x, unsigned short reg)
|
|
{
|
|
if (!wm831x->locked)
|
|
return 0;
|
|
|
|
switch (reg) {
|
|
case WM831X_WATCHDOG:
|
|
case WM831X_DC4_CONTROL:
|
|
case WM831X_ON_PIN_CONTROL:
|
|
case WM831X_BACKUP_CHARGER_CONTROL:
|
|
case WM831X_CHARGER_CONTROL_1:
|
|
case WM831X_CHARGER_CONTROL_2:
|
|
return 1;
|
|
|
|
default:
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* wm831x_reg_unlock: Unlock user keyed registers
|
|
*
|
|
* The WM831x has a user key preventing writes to particularly
|
|
* critical registers. This function locks those registers,
|
|
* allowing writes to them.
|
|
*/
|
|
void wm831x_reg_lock(struct wm831x *wm831x)
|
|
{
|
|
int ret;
|
|
|
|
ret = wm831x_reg_write(wm831x, WM831X_SECURITY_KEY, 0);
|
|
if (ret == 0) {
|
|
dev_vdbg(wm831x->dev, "Registers locked\n");
|
|
|
|
mutex_lock(&wm831x->io_lock);
|
|
WARN_ON(wm831x->locked);
|
|
wm831x->locked = 1;
|
|
mutex_unlock(&wm831x->io_lock);
|
|
} else {
|
|
dev_err(wm831x->dev, "Failed to lock registers: %d\n", ret);
|
|
}
|
|
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_reg_lock);
|
|
|
|
/**
|
|
* wm831x_reg_unlock: Unlock user keyed registers
|
|
*
|
|
* The WM831x has a user key preventing writes to particularly
|
|
* critical registers. This function locks those registers,
|
|
* preventing spurious writes.
|
|
*/
|
|
int wm831x_reg_unlock(struct wm831x *wm831x)
|
|
{
|
|
int ret;
|
|
|
|
/* 0x9716 is the value required to unlock the registers */
|
|
ret = wm831x_reg_write(wm831x, WM831X_SECURITY_KEY, 0x9716);
|
|
if (ret == 0) {
|
|
dev_vdbg(wm831x->dev, "Registers unlocked\n");
|
|
|
|
mutex_lock(&wm831x->io_lock);
|
|
WARN_ON(!wm831x->locked);
|
|
wm831x->locked = 0;
|
|
mutex_unlock(&wm831x->io_lock);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_reg_unlock);
|
|
|
|
static int wm831x_read(struct wm831x *wm831x, unsigned short reg,
|
|
int bytes, void *dest)
|
|
{
|
|
int ret, i;
|
|
u16 *buf = dest;
|
|
|
|
BUG_ON(bytes % 2);
|
|
BUG_ON(bytes <= 0);
|
|
|
|
ret = wm831x->read_dev(wm831x, reg, bytes, dest);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
for (i = 0; i < bytes / 2; i++) {
|
|
buf[i] = be16_to_cpu(buf[i]);
|
|
|
|
dev_vdbg(wm831x->dev, "Read %04x from R%d(0x%x)\n",
|
|
buf[i], reg + i, reg + i);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* wm831x_reg_read: Read a single WM831x register.
|
|
*
|
|
* @wm831x: Device to read from.
|
|
* @reg: Register to read.
|
|
*/
|
|
int wm831x_reg_read(struct wm831x *wm831x, unsigned short reg)
|
|
{
|
|
unsigned short val;
|
|
int ret;
|
|
|
|
mutex_lock(&wm831x->io_lock);
|
|
|
|
ret = wm831x_read(wm831x, reg, 2, &val);
|
|
|
|
mutex_unlock(&wm831x->io_lock);
|
|
|
|
if (ret < 0)
|
|
return ret;
|
|
else
|
|
return val;
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_reg_read);
|
|
|
|
/**
|
|
* wm831x_bulk_read: Read multiple WM831x registers
|
|
*
|
|
* @wm831x: Device to read from
|
|
* @reg: First register
|
|
* @count: Number of registers
|
|
* @buf: Buffer to fill.
|
|
*/
|
|
int wm831x_bulk_read(struct wm831x *wm831x, unsigned short reg,
|
|
int count, u16 *buf)
|
|
{
|
|
int ret;
|
|
|
|
mutex_lock(&wm831x->io_lock);
|
|
|
|
ret = wm831x_read(wm831x, reg, count * 2, buf);
|
|
|
|
mutex_unlock(&wm831x->io_lock);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_bulk_read);
|
|
|
|
static int wm831x_write(struct wm831x *wm831x, unsigned short reg,
|
|
int bytes, void *src)
|
|
{
|
|
u16 *buf = src;
|
|
int i;
|
|
|
|
BUG_ON(bytes % 2);
|
|
BUG_ON(bytes <= 0);
|
|
|
|
for (i = 0; i < bytes / 2; i++) {
|
|
if (wm831x_reg_locked(wm831x, reg))
|
|
return -EPERM;
|
|
|
|
dev_vdbg(wm831x->dev, "Write %04x to R%d(0x%x)\n",
|
|
buf[i], reg + i, reg + i);
|
|
|
|
buf[i] = cpu_to_be16(buf[i]);
|
|
}
|
|
|
|
return wm831x->write_dev(wm831x, reg, bytes, src);
|
|
}
|
|
|
|
/**
|
|
* wm831x_reg_write: Write a single WM831x register.
|
|
*
|
|
* @wm831x: Device to write to.
|
|
* @reg: Register to write to.
|
|
* @val: Value to write.
|
|
*/
|
|
int wm831x_reg_write(struct wm831x *wm831x, unsigned short reg,
|
|
unsigned short val)
|
|
{
|
|
int ret;
|
|
|
|
mutex_lock(&wm831x->io_lock);
|
|
|
|
ret = wm831x_write(wm831x, reg, 2, &val);
|
|
|
|
mutex_unlock(&wm831x->io_lock);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_reg_write);
|
|
|
|
/**
|
|
* wm831x_set_bits: Set the value of a bitfield in a WM831x register
|
|
*
|
|
* @wm831x: Device to write to.
|
|
* @reg: Register to write to.
|
|
* @mask: Mask of bits to set.
|
|
* @val: Value to set (unshifted)
|
|
*/
|
|
int wm831x_set_bits(struct wm831x *wm831x, unsigned short reg,
|
|
unsigned short mask, unsigned short val)
|
|
{
|
|
int ret;
|
|
u16 r;
|
|
|
|
mutex_lock(&wm831x->io_lock);
|
|
|
|
ret = wm831x_read(wm831x, reg, 2, &r);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
r &= ~mask;
|
|
r |= val;
|
|
|
|
ret = wm831x_write(wm831x, reg, 2, &r);
|
|
|
|
out:
|
|
mutex_unlock(&wm831x->io_lock);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_set_bits);
|
|
|
|
/**
|
|
* wm831x_auxadc_read: Read a value from the WM831x AUXADC
|
|
*
|
|
* @wm831x: Device to read from.
|
|
* @input: AUXADC input to read.
|
|
*/
|
|
int wm831x_auxadc_read(struct wm831x *wm831x, enum wm831x_auxadc input)
|
|
{
|
|
int tries = 10;
|
|
int ret, src;
|
|
|
|
mutex_lock(&wm831x->auxadc_lock);
|
|
|
|
ret = wm831x_set_bits(wm831x, WM831X_AUXADC_CONTROL,
|
|
WM831X_AUX_ENA, WM831X_AUX_ENA);
|
|
if (ret < 0) {
|
|
dev_err(wm831x->dev, "Failed to enable AUXADC: %d\n", ret);
|
|
goto out;
|
|
}
|
|
|
|
/* We force a single source at present */
|
|
src = input;
|
|
ret = wm831x_reg_write(wm831x, WM831X_AUXADC_SOURCE,
|
|
1 << src);
|
|
if (ret < 0) {
|
|
dev_err(wm831x->dev, "Failed to set AUXADC source: %d\n", ret);
|
|
goto out;
|
|
}
|
|
|
|
ret = wm831x_set_bits(wm831x, WM831X_AUXADC_CONTROL,
|
|
WM831X_AUX_CVT_ENA, WM831X_AUX_CVT_ENA);
|
|
if (ret < 0) {
|
|
dev_err(wm831x->dev, "Failed to start AUXADC: %d\n", ret);
|
|
goto disable;
|
|
}
|
|
|
|
do {
|
|
msleep(1);
|
|
|
|
ret = wm831x_reg_read(wm831x, WM831X_AUXADC_CONTROL);
|
|
if (ret < 0)
|
|
ret = WM831X_AUX_CVT_ENA;
|
|
} while ((ret & WM831X_AUX_CVT_ENA) && --tries);
|
|
|
|
if (ret & WM831X_AUX_CVT_ENA) {
|
|
dev_err(wm831x->dev, "Timed out reading AUXADC\n");
|
|
ret = -EBUSY;
|
|
goto disable;
|
|
}
|
|
|
|
ret = wm831x_reg_read(wm831x, WM831X_AUXADC_DATA);
|
|
if (ret < 0) {
|
|
dev_err(wm831x->dev, "Failed to read AUXADC data: %d\n", ret);
|
|
} else {
|
|
src = ((ret & WM831X_AUX_DATA_SRC_MASK)
|
|
>> WM831X_AUX_DATA_SRC_SHIFT) - 1;
|
|
|
|
if (src == 14)
|
|
src = WM831X_AUX_CAL;
|
|
|
|
if (src != input) {
|
|
dev_err(wm831x->dev, "Data from source %d not %d\n",
|
|
src, input);
|
|
ret = -EINVAL;
|
|
} else {
|
|
ret &= WM831X_AUX_DATA_MASK;
|
|
}
|
|
}
|
|
|
|
disable:
|
|
wm831x_set_bits(wm831x, WM831X_AUXADC_CONTROL, WM831X_AUX_ENA, 0);
|
|
out:
|
|
mutex_unlock(&wm831x->auxadc_lock);
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_auxadc_read);
|
|
|
|
/**
|
|
* wm831x_auxadc_read_uv: Read a voltage from the WM831x AUXADC
|
|
*
|
|
* @wm831x: Device to read from.
|
|
* @input: AUXADC input to read.
|
|
*/
|
|
int wm831x_auxadc_read_uv(struct wm831x *wm831x, enum wm831x_auxadc input)
|
|
{
|
|
int ret;
|
|
|
|
ret = wm831x_auxadc_read(wm831x, input);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret *= 1465;
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_auxadc_read_uv);
|
|
|
|
static struct resource wm831x_dcdc1_resources[] = {
|
|
{
|
|
.start = WM831X_DC1_CONTROL_1,
|
|
.end = WM831X_DC1_DVS_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_DC1,
|
|
.end = WM831X_IRQ_UV_DC1,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "HC",
|
|
.start = WM831X_IRQ_HC_DC1,
|
|
.end = WM831X_IRQ_HC_DC1,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
|
|
static struct resource wm831x_dcdc2_resources[] = {
|
|
{
|
|
.start = WM831X_DC2_CONTROL_1,
|
|
.end = WM831X_DC2_DVS_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_DC2,
|
|
.end = WM831X_IRQ_UV_DC2,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "HC",
|
|
.start = WM831X_IRQ_HC_DC2,
|
|
.end = WM831X_IRQ_HC_DC2,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_dcdc3_resources[] = {
|
|
{
|
|
.start = WM831X_DC3_CONTROL_1,
|
|
.end = WM831X_DC3_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_DC3,
|
|
.end = WM831X_IRQ_UV_DC3,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_dcdc4_resources[] = {
|
|
{
|
|
.start = WM831X_DC4_CONTROL,
|
|
.end = WM831X_DC4_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_DC4,
|
|
.end = WM831X_IRQ_UV_DC4,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_gpio_resources[] = {
|
|
{
|
|
.start = WM831X_IRQ_GPIO_1,
|
|
.end = WM831X_IRQ_GPIO_16,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_isink1_resources[] = {
|
|
{
|
|
.start = WM831X_CURRENT_SINK_1,
|
|
.end = WM831X_CURRENT_SINK_1,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.start = WM831X_IRQ_CS1,
|
|
.end = WM831X_IRQ_CS1,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_isink2_resources[] = {
|
|
{
|
|
.start = WM831X_CURRENT_SINK_2,
|
|
.end = WM831X_CURRENT_SINK_2,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.start = WM831X_IRQ_CS2,
|
|
.end = WM831X_IRQ_CS2,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo1_resources[] = {
|
|
{
|
|
.start = WM831X_LDO1_CONTROL,
|
|
.end = WM831X_LDO1_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO1,
|
|
.end = WM831X_IRQ_UV_LDO1,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo2_resources[] = {
|
|
{
|
|
.start = WM831X_LDO2_CONTROL,
|
|
.end = WM831X_LDO2_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO2,
|
|
.end = WM831X_IRQ_UV_LDO2,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo3_resources[] = {
|
|
{
|
|
.start = WM831X_LDO3_CONTROL,
|
|
.end = WM831X_LDO3_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO3,
|
|
.end = WM831X_IRQ_UV_LDO3,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo4_resources[] = {
|
|
{
|
|
.start = WM831X_LDO4_CONTROL,
|
|
.end = WM831X_LDO4_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO4,
|
|
.end = WM831X_IRQ_UV_LDO4,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo5_resources[] = {
|
|
{
|
|
.start = WM831X_LDO5_CONTROL,
|
|
.end = WM831X_LDO5_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO5,
|
|
.end = WM831X_IRQ_UV_LDO5,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo6_resources[] = {
|
|
{
|
|
.start = WM831X_LDO6_CONTROL,
|
|
.end = WM831X_LDO6_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO6,
|
|
.end = WM831X_IRQ_UV_LDO6,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo7_resources[] = {
|
|
{
|
|
.start = WM831X_LDO7_CONTROL,
|
|
.end = WM831X_LDO7_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO7,
|
|
.end = WM831X_IRQ_UV_LDO7,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo8_resources[] = {
|
|
{
|
|
.start = WM831X_LDO8_CONTROL,
|
|
.end = WM831X_LDO8_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO8,
|
|
.end = WM831X_IRQ_UV_LDO8,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo9_resources[] = {
|
|
{
|
|
.start = WM831X_LDO9_CONTROL,
|
|
.end = WM831X_LDO9_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO9,
|
|
.end = WM831X_IRQ_UV_LDO9,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo10_resources[] = {
|
|
{
|
|
.start = WM831X_LDO10_CONTROL,
|
|
.end = WM831X_LDO10_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO10,
|
|
.end = WM831X_IRQ_UV_LDO10,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo11_resources[] = {
|
|
{
|
|
.start = WM831X_LDO11_ON_CONTROL,
|
|
.end = WM831X_LDO11_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_on_resources[] = {
|
|
{
|
|
.start = WM831X_IRQ_ON,
|
|
.end = WM831X_IRQ_ON,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
|
|
static struct resource wm831x_power_resources[] = {
|
|
{
|
|
.name = "SYSLO",
|
|
.start = WM831X_IRQ_PPM_SYSLO,
|
|
.end = WM831X_IRQ_PPM_SYSLO,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "PWR SRC",
|
|
.start = WM831X_IRQ_PPM_PWR_SRC,
|
|
.end = WM831X_IRQ_PPM_PWR_SRC,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "USB CURR",
|
|
.start = WM831X_IRQ_PPM_USB_CURR,
|
|
.end = WM831X_IRQ_PPM_USB_CURR,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "BATT HOT",
|
|
.start = WM831X_IRQ_CHG_BATT_HOT,
|
|
.end = WM831X_IRQ_CHG_BATT_HOT,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "BATT COLD",
|
|
.start = WM831X_IRQ_CHG_BATT_COLD,
|
|
.end = WM831X_IRQ_CHG_BATT_COLD,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "BATT FAIL",
|
|
.start = WM831X_IRQ_CHG_BATT_FAIL,
|
|
.end = WM831X_IRQ_CHG_BATT_FAIL,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "OV",
|
|
.start = WM831X_IRQ_CHG_OV,
|
|
.end = WM831X_IRQ_CHG_OV,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "END",
|
|
.start = WM831X_IRQ_CHG_END,
|
|
.end = WM831X_IRQ_CHG_END,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "TO",
|
|
.start = WM831X_IRQ_CHG_TO,
|
|
.end = WM831X_IRQ_CHG_TO,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "MODE",
|
|
.start = WM831X_IRQ_CHG_MODE,
|
|
.end = WM831X_IRQ_CHG_MODE,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "START",
|
|
.start = WM831X_IRQ_CHG_START,
|
|
.end = WM831X_IRQ_CHG_START,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_rtc_resources[] = {
|
|
{
|
|
.name = "PER",
|
|
.start = WM831X_IRQ_RTC_PER,
|
|
.end = WM831X_IRQ_RTC_PER,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "ALM",
|
|
.start = WM831X_IRQ_RTC_ALM,
|
|
.end = WM831X_IRQ_RTC_ALM,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_status1_resources[] = {
|
|
{
|
|
.start = WM831X_STATUS_LED_1,
|
|
.end = WM831X_STATUS_LED_1,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_status2_resources[] = {
|
|
{
|
|
.start = WM831X_STATUS_LED_2,
|
|
.end = WM831X_STATUS_LED_2,
|
|
.flags = IORESOURCE_IO,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_touch_resources[] = {
|
|
{
|
|
.name = "TCHPD",
|
|
.start = WM831X_IRQ_TCHPD,
|
|
.end = WM831X_IRQ_TCHPD,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "TCHDATA",
|
|
.start = WM831X_IRQ_TCHDATA,
|
|
.end = WM831X_IRQ_TCHDATA,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_wdt_resources[] = {
|
|
{
|
|
.start = WM831X_IRQ_WDOG_TO,
|
|
.end = WM831X_IRQ_WDOG_TO,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct mfd_cell wm8310_devs[] = {
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc1_resources),
|
|
.resources = wm831x_dcdc1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc2_resources),
|
|
.resources = wm831x_dcdc2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckp",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc3_resources),
|
|
.resources = wm831x_dcdc3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-boostp",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc4_resources),
|
|
.resources = wm831x_dcdc4_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-epe",
|
|
.id = 1,
|
|
},
|
|
{
|
|
.name = "wm831x-epe",
|
|
.id = 2,
|
|
},
|
|
{
|
|
.name = "wm831x-gpio",
|
|
.num_resources = ARRAY_SIZE(wm831x_gpio_resources),
|
|
.resources = wm831x_gpio_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-hwmon",
|
|
},
|
|
{
|
|
.name = "wm831x-isink",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_isink1_resources),
|
|
.resources = wm831x_isink1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-isink",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_isink2_resources),
|
|
.resources = wm831x_isink2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo1_resources),
|
|
.resources = wm831x_ldo1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo2_resources),
|
|
.resources = wm831x_ldo2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo3_resources),
|
|
.resources = wm831x_ldo3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo4_resources),
|
|
.resources = wm831x_ldo4_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 5,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo5_resources),
|
|
.resources = wm831x_ldo5_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 6,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo6_resources),
|
|
.resources = wm831x_ldo6_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 7,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo7_resources),
|
|
.resources = wm831x_ldo7_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 8,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo8_resources),
|
|
.resources = wm831x_ldo8_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 9,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo9_resources),
|
|
.resources = wm831x_ldo9_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 10,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo10_resources),
|
|
.resources = wm831x_ldo10_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-alive-ldo",
|
|
.id = 11,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo11_resources),
|
|
.resources = wm831x_ldo11_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-on",
|
|
.num_resources = ARRAY_SIZE(wm831x_on_resources),
|
|
.resources = wm831x_on_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-power",
|
|
.num_resources = ARRAY_SIZE(wm831x_power_resources),
|
|
.resources = wm831x_power_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-rtc",
|
|
.num_resources = ARRAY_SIZE(wm831x_rtc_resources),
|
|
.resources = wm831x_rtc_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_status1_resources),
|
|
.resources = wm831x_status1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_status2_resources),
|
|
.resources = wm831x_status2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-watchdog",
|
|
.num_resources = ARRAY_SIZE(wm831x_wdt_resources),
|
|
.resources = wm831x_wdt_resources,
|
|
},
|
|
};
|
|
|
|
static struct mfd_cell wm8311_devs[] = {
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc1_resources),
|
|
.resources = wm831x_dcdc1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc2_resources),
|
|
.resources = wm831x_dcdc2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckp",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc3_resources),
|
|
.resources = wm831x_dcdc3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-boostp",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc4_resources),
|
|
.resources = wm831x_dcdc4_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-epe",
|
|
.id = 1,
|
|
},
|
|
{
|
|
.name = "wm831x-epe",
|
|
.id = 2,
|
|
},
|
|
{
|
|
.name = "wm831x-gpio",
|
|
.num_resources = ARRAY_SIZE(wm831x_gpio_resources),
|
|
.resources = wm831x_gpio_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-hwmon",
|
|
},
|
|
{
|
|
.name = "wm831x-isink",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_isink1_resources),
|
|
.resources = wm831x_isink1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-isink",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_isink2_resources),
|
|
.resources = wm831x_isink2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo1_resources),
|
|
.resources = wm831x_ldo1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo2_resources),
|
|
.resources = wm831x_ldo2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo3_resources),
|
|
.resources = wm831x_ldo3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo4_resources),
|
|
.resources = wm831x_ldo4_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 5,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo5_resources),
|
|
.resources = wm831x_ldo5_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 7,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo7_resources),
|
|
.resources = wm831x_ldo7_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-alive-ldo",
|
|
.id = 11,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo11_resources),
|
|
.resources = wm831x_ldo11_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-on",
|
|
.num_resources = ARRAY_SIZE(wm831x_on_resources),
|
|
.resources = wm831x_on_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-power",
|
|
.num_resources = ARRAY_SIZE(wm831x_power_resources),
|
|
.resources = wm831x_power_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-rtc",
|
|
.num_resources = ARRAY_SIZE(wm831x_rtc_resources),
|
|
.resources = wm831x_rtc_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_status1_resources),
|
|
.resources = wm831x_status1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_status2_resources),
|
|
.resources = wm831x_status2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-touch",
|
|
.num_resources = ARRAY_SIZE(wm831x_touch_resources),
|
|
.resources = wm831x_touch_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-watchdog",
|
|
.num_resources = ARRAY_SIZE(wm831x_wdt_resources),
|
|
.resources = wm831x_wdt_resources,
|
|
},
|
|
};
|
|
|
|
static struct mfd_cell wm8312_devs[] = {
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc1_resources),
|
|
.resources = wm831x_dcdc1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc2_resources),
|
|
.resources = wm831x_dcdc2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckp",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc3_resources),
|
|
.resources = wm831x_dcdc3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-boostp",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc4_resources),
|
|
.resources = wm831x_dcdc4_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-epe",
|
|
.id = 1,
|
|
},
|
|
{
|
|
.name = "wm831x-epe",
|
|
.id = 2,
|
|
},
|
|
{
|
|
.name = "wm831x-gpio",
|
|
.num_resources = ARRAY_SIZE(wm831x_gpio_resources),
|
|
.resources = wm831x_gpio_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-hwmon",
|
|
},
|
|
{
|
|
.name = "wm831x-isink",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_isink1_resources),
|
|
.resources = wm831x_isink1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-isink",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_isink2_resources),
|
|
.resources = wm831x_isink2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo1_resources),
|
|
.resources = wm831x_ldo1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo2_resources),
|
|
.resources = wm831x_ldo2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo3_resources),
|
|
.resources = wm831x_ldo3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo4_resources),
|
|
.resources = wm831x_ldo4_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 5,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo5_resources),
|
|
.resources = wm831x_ldo5_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 6,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo6_resources),
|
|
.resources = wm831x_ldo6_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 7,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo7_resources),
|
|
.resources = wm831x_ldo7_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 8,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo8_resources),
|
|
.resources = wm831x_ldo8_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 9,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo9_resources),
|
|
.resources = wm831x_ldo9_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 10,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo10_resources),
|
|
.resources = wm831x_ldo10_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-alive-ldo",
|
|
.id = 11,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo11_resources),
|
|
.resources = wm831x_ldo11_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-on",
|
|
.num_resources = ARRAY_SIZE(wm831x_on_resources),
|
|
.resources = wm831x_on_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-power",
|
|
.num_resources = ARRAY_SIZE(wm831x_power_resources),
|
|
.resources = wm831x_power_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-rtc",
|
|
.num_resources = ARRAY_SIZE(wm831x_rtc_resources),
|
|
.resources = wm831x_rtc_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_status1_resources),
|
|
.resources = wm831x_status1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_status2_resources),
|
|
.resources = wm831x_status2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-touch",
|
|
.num_resources = ARRAY_SIZE(wm831x_touch_resources),
|
|
.resources = wm831x_touch_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-watchdog",
|
|
.num_resources = ARRAY_SIZE(wm831x_wdt_resources),
|
|
.resources = wm831x_wdt_resources,
|
|
},
|
|
};
|
|
|
|
static struct mfd_cell backlight_devs[] = {
|
|
{
|
|
.name = "wm831x-backlight",
|
|
},
|
|
};
|
|
|
|
/*
|
|
* Instantiate the generic non-control parts of the device.
|
|
*/
|
|
static int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq)
|
|
{
|
|
struct wm831x_pdata *pdata = wm831x->dev->platform_data;
|
|
int rev;
|
|
enum wm831x_parent parent;
|
|
int ret;
|
|
|
|
mutex_init(&wm831x->io_lock);
|
|
mutex_init(&wm831x->key_lock);
|
|
mutex_init(&wm831x->auxadc_lock);
|
|
dev_set_drvdata(wm831x->dev, wm831x);
|
|
|
|
ret = wm831x_reg_read(wm831x, WM831X_PARENT_ID);
|
|
if (ret < 0) {
|
|
dev_err(wm831x->dev, "Failed to read parent ID: %d\n", ret);
|
|
goto err;
|
|
}
|
|
if (ret != 0x6204) {
|
|
dev_err(wm831x->dev, "Device is not a WM831x: ID %x\n", ret);
|
|
ret = -EINVAL;
|
|
goto err;
|
|
}
|
|
|
|
ret = wm831x_reg_read(wm831x, WM831X_REVISION);
|
|
if (ret < 0) {
|
|
dev_err(wm831x->dev, "Failed to read revision: %d\n", ret);
|
|
goto err;
|
|
}
|
|
rev = (ret & WM831X_PARENT_REV_MASK) >> WM831X_PARENT_REV_SHIFT;
|
|
|
|
ret = wm831x_reg_read(wm831x, WM831X_RESET_ID);
|
|
if (ret < 0) {
|
|
dev_err(wm831x->dev, "Failed to read device ID: %d\n", ret);
|
|
goto err;
|
|
}
|
|
|
|
switch (ret) {
|
|
case 0x8310:
|
|
parent = WM8310;
|
|
switch (rev) {
|
|
case 0:
|
|
dev_info(wm831x->dev, "WM8310 revision %c\n",
|
|
'A' + rev);
|
|
break;
|
|
}
|
|
break;
|
|
|
|
case 0x8311:
|
|
parent = WM8311;
|
|
switch (rev) {
|
|
case 0:
|
|
dev_info(wm831x->dev, "WM8311 revision %c\n",
|
|
'A' + rev);
|
|
break;
|
|
}
|
|
break;
|
|
|
|
case 0x8312:
|
|
parent = WM8312;
|
|
switch (rev) {
|
|
case 0:
|
|
dev_info(wm831x->dev, "WM8312 revision %c\n",
|
|
'A' + rev);
|
|
break;
|
|
}
|
|
break;
|
|
|
|
case 0:
|
|
/* Some engineering samples do not have the ID set,
|
|
* rely on the device being registered correctly.
|
|
* This will need revisiting for future devices with
|
|
* multiple dies.
|
|
*/
|
|
parent = id;
|
|
switch (rev) {
|
|
case 0:
|
|
dev_info(wm831x->dev, "WM831%d ES revision %c\n",
|
|
parent, 'A' + rev);
|
|
break;
|
|
}
|
|
break;
|
|
|
|
default:
|
|
dev_err(wm831x->dev, "Unknown WM831x device %04x\n", ret);
|
|
ret = -EINVAL;
|
|
goto err;
|
|
}
|
|
|
|
/* This will need revisiting in future but is OK for all
|
|
* current parts.
|
|
*/
|
|
if (parent != id)
|
|
dev_warn(wm831x->dev, "Device was registered as a WM831%lu\n",
|
|
id);
|
|
|
|
/* Bootstrap the user key */
|
|
ret = wm831x_reg_read(wm831x, WM831X_SECURITY_KEY);
|
|
if (ret < 0) {
|
|
dev_err(wm831x->dev, "Failed to read security key: %d\n", ret);
|
|
goto err;
|
|
}
|
|
if (ret != 0) {
|
|
dev_warn(wm831x->dev, "Security key had non-zero value %x\n",
|
|
ret);
|
|
wm831x_reg_write(wm831x, WM831X_SECURITY_KEY, 0);
|
|
}
|
|
wm831x->locked = 1;
|
|
|
|
if (pdata && pdata->pre_init) {
|
|
ret = pdata->pre_init(wm831x);
|
|
if (ret != 0) {
|
|
dev_err(wm831x->dev, "pre_init() failed: %d\n", ret);
|
|
goto err;
|
|
}
|
|
}
|
|
|
|
ret = wm831x_irq_init(wm831x, irq);
|
|
if (ret != 0)
|
|
goto err;
|
|
|
|
/* The core device is up, instantiate the subdevices. */
|
|
switch (parent) {
|
|
case WM8310:
|
|
ret = mfd_add_devices(wm831x->dev, -1,
|
|
wm8310_devs, ARRAY_SIZE(wm8310_devs),
|
|
NULL, 0);
|
|
break;
|
|
|
|
case WM8311:
|
|
ret = mfd_add_devices(wm831x->dev, -1,
|
|
wm8311_devs, ARRAY_SIZE(wm8311_devs),
|
|
NULL, 0);
|
|
break;
|
|
|
|
case WM8312:
|
|
ret = mfd_add_devices(wm831x->dev, -1,
|
|
wm8312_devs, ARRAY_SIZE(wm8312_devs),
|
|
NULL, 0);
|
|
break;
|
|
|
|
default:
|
|
/* If this happens the bus probe function is buggy */
|
|
BUG();
|
|
}
|
|
|
|
if (ret != 0) {
|
|
dev_err(wm831x->dev, "Failed to add children\n");
|
|
goto err_irq;
|
|
}
|
|
|
|
if (pdata && pdata->backlight) {
|
|
/* Treat errors as non-critical */
|
|
ret = mfd_add_devices(wm831x->dev, -1, backlight_devs,
|
|
ARRAY_SIZE(backlight_devs), NULL, 0);
|
|
if (ret < 0)
|
|
dev_err(wm831x->dev, "Failed to add backlight: %d\n",
|
|
ret);
|
|
}
|
|
|
|
wm831x_otp_init(wm831x);
|
|
|
|
if (pdata && pdata->post_init) {
|
|
ret = pdata->post_init(wm831x);
|
|
if (ret != 0) {
|
|
dev_err(wm831x->dev, "post_init() failed: %d\n", ret);
|
|
goto err_irq;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
|
|
err_irq:
|
|
wm831x_irq_exit(wm831x);
|
|
err:
|
|
mfd_remove_devices(wm831x->dev);
|
|
kfree(wm831x);
|
|
return ret;
|
|
}
|
|
|
|
static void wm831x_device_exit(struct wm831x *wm831x)
|
|
{
|
|
wm831x_otp_exit(wm831x);
|
|
mfd_remove_devices(wm831x->dev);
|
|
wm831x_irq_exit(wm831x);
|
|
kfree(wm831x);
|
|
}
|
|
|
|
static int wm831x_i2c_read_device(struct wm831x *wm831x, unsigned short reg,
|
|
int bytes, void *dest)
|
|
{
|
|
struct i2c_client *i2c = wm831x->control_data;
|
|
int ret;
|
|
u16 r = cpu_to_be16(reg);
|
|
|
|
ret = i2c_master_send(i2c, (unsigned char *)&r, 2);
|
|
if (ret < 0)
|
|
return ret;
|
|
if (ret != 2)
|
|
return -EIO;
|
|
|
|
ret = i2c_master_recv(i2c, dest, bytes);
|
|
if (ret < 0)
|
|
return ret;
|
|
if (ret != bytes)
|
|
return -EIO;
|
|
return 0;
|
|
}
|
|
|
|
/* Currently we allocate the write buffer on the stack; this is OK for
|
|
* small writes - if we need to do large writes this will need to be
|
|
* revised.
|
|
*/
|
|
static int wm831x_i2c_write_device(struct wm831x *wm831x, unsigned short reg,
|
|
int bytes, void *src)
|
|
{
|
|
struct i2c_client *i2c = wm831x->control_data;
|
|
unsigned char msg[bytes + 2];
|
|
int ret;
|
|
|
|
reg = cpu_to_be16(reg);
|
|
memcpy(&msg[0], ®, 2);
|
|
memcpy(&msg[2], src, bytes);
|
|
|
|
ret = i2c_master_send(i2c, msg, bytes + 2);
|
|
if (ret < 0)
|
|
return ret;
|
|
if (ret < bytes + 2)
|
|
return -EIO;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int wm831x_i2c_probe(struct i2c_client *i2c,
|
|
const struct i2c_device_id *id)
|
|
{
|
|
struct wm831x *wm831x;
|
|
|
|
wm831x = kzalloc(sizeof(struct wm831x), GFP_KERNEL);
|
|
if (wm831x == NULL) {
|
|
kfree(i2c);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
i2c_set_clientdata(i2c, wm831x);
|
|
wm831x->dev = &i2c->dev;
|
|
wm831x->control_data = i2c;
|
|
wm831x->read_dev = wm831x_i2c_read_device;
|
|
wm831x->write_dev = wm831x_i2c_write_device;
|
|
|
|
return wm831x_device_init(wm831x, id->driver_data, i2c->irq);
|
|
}
|
|
|
|
static int wm831x_i2c_remove(struct i2c_client *i2c)
|
|
{
|
|
struct wm831x *wm831x = i2c_get_clientdata(i2c);
|
|
|
|
wm831x_device_exit(wm831x);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct i2c_device_id wm831x_i2c_id[] = {
|
|
{ "wm8310", WM8310 },
|
|
{ "wm8311", WM8311 },
|
|
{ "wm8312", WM8312 },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, wm831x_i2c_id);
|
|
|
|
|
|
static struct i2c_driver wm831x_i2c_driver = {
|
|
.driver = {
|
|
.name = "wm831x",
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.probe = wm831x_i2c_probe,
|
|
.remove = wm831x_i2c_remove,
|
|
.id_table = wm831x_i2c_id,
|
|
};
|
|
|
|
static int __init wm831x_i2c_init(void)
|
|
{
|
|
int ret;
|
|
|
|
ret = i2c_add_driver(&wm831x_i2c_driver);
|
|
if (ret != 0)
|
|
pr_err("Failed to register wm831x I2C driver: %d\n", ret);
|
|
|
|
return ret;
|
|
}
|
|
subsys_initcall(wm831x_i2c_init);
|
|
|
|
static void __exit wm831x_i2c_exit(void)
|
|
{
|
|
i2c_del_driver(&wm831x_i2c_driver);
|
|
}
|
|
module_exit(wm831x_i2c_exit);
|
|
|
|
MODULE_DESCRIPTION("I2C support for the WM831X AudioPlus PMIC");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_AUTHOR("Mark Brown");
|