mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-01 16:14:13 +08:00
eb6e8ddf06
The original code had a compile warning: drivers/mfd/88pm860x-core.c:431: warning: ‘ret’ may be used uninitialized in this function It seems like the warning is valid if either pdata or pdata->touch is NULL. This patch checks pdata and pdata->touch at the beginning of the function. That means everything can be pulled in one indent level. Now all the statements fit within the 80 character limit. Also at that point the "use_gpadc" variable isn't needed and removing it simplifies the logic. Signed-off-by: Dan Carpenter <error27@gmail.com> Acked-by: Haojian Zhuang <hzhuang1@marvell.com> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
735 lines
17 KiB
C
735 lines
17 KiB
C
/*
|
|
* Base driver for Marvell 88PM8607
|
|
*
|
|
* Copyright (C) 2009 Marvell International Ltd.
|
|
* Haojian Zhuang <haojian.zhuang@marvell.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/irq.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/mfd/core.h>
|
|
#include <linux/mfd/88pm860x.h>
|
|
|
|
#define INT_STATUS_NUM 3
|
|
|
|
char pm860x_backlight_name[][MFD_NAME_SIZE] = {
|
|
"backlight-0",
|
|
"backlight-1",
|
|
"backlight-2",
|
|
};
|
|
EXPORT_SYMBOL(pm860x_backlight_name);
|
|
|
|
char pm860x_led_name[][MFD_NAME_SIZE] = {
|
|
"led0-red",
|
|
"led0-green",
|
|
"led0-blue",
|
|
"led1-red",
|
|
"led1-green",
|
|
"led1-blue",
|
|
};
|
|
EXPORT_SYMBOL(pm860x_led_name);
|
|
|
|
#define PM8606_BACKLIGHT_RESOURCE(_i, _x) \
|
|
{ \
|
|
.name = pm860x_backlight_name[_i], \
|
|
.start = PM8606_##_x, \
|
|
.end = PM8606_##_x, \
|
|
.flags = IORESOURCE_IO, \
|
|
}
|
|
|
|
static struct resource backlight_resources[] = {
|
|
PM8606_BACKLIGHT_RESOURCE(PM8606_BACKLIGHT1, WLED1A),
|
|
PM8606_BACKLIGHT_RESOURCE(PM8606_BACKLIGHT2, WLED2A),
|
|
PM8606_BACKLIGHT_RESOURCE(PM8606_BACKLIGHT3, WLED3A),
|
|
};
|
|
|
|
#define PM8606_BACKLIGHT_DEVS(_i) \
|
|
{ \
|
|
.name = "88pm860x-backlight", \
|
|
.num_resources = 1, \
|
|
.resources = &backlight_resources[_i], \
|
|
.id = _i, \
|
|
}
|
|
|
|
static struct mfd_cell backlight_devs[] = {
|
|
PM8606_BACKLIGHT_DEVS(PM8606_BACKLIGHT1),
|
|
PM8606_BACKLIGHT_DEVS(PM8606_BACKLIGHT2),
|
|
PM8606_BACKLIGHT_DEVS(PM8606_BACKLIGHT3),
|
|
};
|
|
|
|
#define PM8606_LED_RESOURCE(_i, _x) \
|
|
{ \
|
|
.name = pm860x_led_name[_i], \
|
|
.start = PM8606_##_x, \
|
|
.end = PM8606_##_x, \
|
|
.flags = IORESOURCE_IO, \
|
|
}
|
|
|
|
static struct resource led_resources[] = {
|
|
PM8606_LED_RESOURCE(PM8606_LED1_RED, RGB1B),
|
|
PM8606_LED_RESOURCE(PM8606_LED1_GREEN, RGB1C),
|
|
PM8606_LED_RESOURCE(PM8606_LED1_BLUE, RGB1D),
|
|
PM8606_LED_RESOURCE(PM8606_LED2_RED, RGB2B),
|
|
PM8606_LED_RESOURCE(PM8606_LED2_GREEN, RGB2C),
|
|
PM8606_LED_RESOURCE(PM8606_LED2_BLUE, RGB2D),
|
|
};
|
|
|
|
#define PM8606_LED_DEVS(_i) \
|
|
{ \
|
|
.name = "88pm860x-led", \
|
|
.num_resources = 1, \
|
|
.resources = &led_resources[_i], \
|
|
.id = _i, \
|
|
}
|
|
|
|
static struct mfd_cell led_devs[] = {
|
|
PM8606_LED_DEVS(PM8606_LED1_RED),
|
|
PM8606_LED_DEVS(PM8606_LED1_GREEN),
|
|
PM8606_LED_DEVS(PM8606_LED1_BLUE),
|
|
PM8606_LED_DEVS(PM8606_LED2_RED),
|
|
PM8606_LED_DEVS(PM8606_LED2_GREEN),
|
|
PM8606_LED_DEVS(PM8606_LED2_BLUE),
|
|
};
|
|
|
|
static struct resource touch_resources[] = {
|
|
{
|
|
.start = PM8607_IRQ_PEN,
|
|
.end = PM8607_IRQ_PEN,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct mfd_cell touch_devs[] = {
|
|
{
|
|
.name = "88pm860x-touch",
|
|
.num_resources = 1,
|
|
.resources = &touch_resources[0],
|
|
},
|
|
};
|
|
|
|
#define PM8607_REG_RESOURCE(_start, _end) \
|
|
{ \
|
|
.start = PM8607_##_start, \
|
|
.end = PM8607_##_end, \
|
|
.flags = IORESOURCE_IO, \
|
|
}
|
|
|
|
static struct resource power_supply_resources[] = {
|
|
{
|
|
.name = "88pm860x-power",
|
|
.start = PM8607_IRQ_CHG,
|
|
.end = PM8607_IRQ_CHG,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct mfd_cell power_devs[] = {
|
|
{
|
|
.name = "88pm860x-power",
|
|
.num_resources = 1,
|
|
.resources = &power_supply_resources[0],
|
|
.id = -1,
|
|
},
|
|
};
|
|
|
|
static struct resource onkey_resources[] = {
|
|
{
|
|
.name = "88pm860x-onkey",
|
|
.start = PM8607_IRQ_ONKEY,
|
|
.end = PM8607_IRQ_ONKEY,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct mfd_cell onkey_devs[] = {
|
|
{
|
|
.name = "88pm860x-onkey",
|
|
.num_resources = 1,
|
|
.resources = &onkey_resources[0],
|
|
.id = -1,
|
|
},
|
|
};
|
|
|
|
static struct resource regulator_resources[] = {
|
|
PM8607_REG_RESOURCE(BUCK1, BUCK1),
|
|
PM8607_REG_RESOURCE(BUCK2, BUCK2),
|
|
PM8607_REG_RESOURCE(BUCK3, BUCK3),
|
|
PM8607_REG_RESOURCE(LDO1, LDO1),
|
|
PM8607_REG_RESOURCE(LDO2, LDO2),
|
|
PM8607_REG_RESOURCE(LDO3, LDO3),
|
|
PM8607_REG_RESOURCE(LDO4, LDO4),
|
|
PM8607_REG_RESOURCE(LDO5, LDO5),
|
|
PM8607_REG_RESOURCE(LDO6, LDO6),
|
|
PM8607_REG_RESOURCE(LDO7, LDO7),
|
|
PM8607_REG_RESOURCE(LDO8, LDO8),
|
|
PM8607_REG_RESOURCE(LDO9, LDO9),
|
|
PM8607_REG_RESOURCE(LDO10, LDO10),
|
|
PM8607_REG_RESOURCE(LDO12, LDO12),
|
|
PM8607_REG_RESOURCE(VIBRATOR_SET, VIBRATOR_SET),
|
|
PM8607_REG_RESOURCE(LDO14, LDO14),
|
|
};
|
|
|
|
#define PM8607_REG_DEVS(_id) \
|
|
{ \
|
|
.name = "88pm860x-regulator", \
|
|
.num_resources = 1, \
|
|
.resources = ®ulator_resources[PM8607_ID_##_id], \
|
|
.id = PM8607_ID_##_id, \
|
|
}
|
|
|
|
static struct mfd_cell regulator_devs[] = {
|
|
PM8607_REG_DEVS(BUCK1),
|
|
PM8607_REG_DEVS(BUCK2),
|
|
PM8607_REG_DEVS(BUCK3),
|
|
PM8607_REG_DEVS(LDO1),
|
|
PM8607_REG_DEVS(LDO2),
|
|
PM8607_REG_DEVS(LDO3),
|
|
PM8607_REG_DEVS(LDO4),
|
|
PM8607_REG_DEVS(LDO5),
|
|
PM8607_REG_DEVS(LDO6),
|
|
PM8607_REG_DEVS(LDO7),
|
|
PM8607_REG_DEVS(LDO8),
|
|
PM8607_REG_DEVS(LDO9),
|
|
PM8607_REG_DEVS(LDO10),
|
|
PM8607_REG_DEVS(LDO12),
|
|
PM8607_REG_DEVS(LDO13),
|
|
PM8607_REG_DEVS(LDO14),
|
|
};
|
|
|
|
struct pm860x_irq_data {
|
|
int reg;
|
|
int mask_reg;
|
|
int enable; /* enable or not */
|
|
int offs; /* bit offset in mask register */
|
|
};
|
|
|
|
static struct pm860x_irq_data pm860x_irqs[] = {
|
|
[PM8607_IRQ_ONKEY] = {
|
|
.reg = PM8607_INT_STATUS1,
|
|
.mask_reg = PM8607_INT_MASK_1,
|
|
.offs = 1 << 0,
|
|
},
|
|
[PM8607_IRQ_EXTON] = {
|
|
.reg = PM8607_INT_STATUS1,
|
|
.mask_reg = PM8607_INT_MASK_1,
|
|
.offs = 1 << 1,
|
|
},
|
|
[PM8607_IRQ_CHG] = {
|
|
.reg = PM8607_INT_STATUS1,
|
|
.mask_reg = PM8607_INT_MASK_1,
|
|
.offs = 1 << 2,
|
|
},
|
|
[PM8607_IRQ_BAT] = {
|
|
.reg = PM8607_INT_STATUS1,
|
|
.mask_reg = PM8607_INT_MASK_1,
|
|
.offs = 1 << 3,
|
|
},
|
|
[PM8607_IRQ_RTC] = {
|
|
.reg = PM8607_INT_STATUS1,
|
|
.mask_reg = PM8607_INT_MASK_1,
|
|
.offs = 1 << 4,
|
|
},
|
|
[PM8607_IRQ_CC] = {
|
|
.reg = PM8607_INT_STATUS1,
|
|
.mask_reg = PM8607_INT_MASK_1,
|
|
.offs = 1 << 5,
|
|
},
|
|
[PM8607_IRQ_VBAT] = {
|
|
.reg = PM8607_INT_STATUS2,
|
|
.mask_reg = PM8607_INT_MASK_2,
|
|
.offs = 1 << 0,
|
|
},
|
|
[PM8607_IRQ_VCHG] = {
|
|
.reg = PM8607_INT_STATUS2,
|
|
.mask_reg = PM8607_INT_MASK_2,
|
|
.offs = 1 << 1,
|
|
},
|
|
[PM8607_IRQ_VSYS] = {
|
|
.reg = PM8607_INT_STATUS2,
|
|
.mask_reg = PM8607_INT_MASK_2,
|
|
.offs = 1 << 2,
|
|
},
|
|
[PM8607_IRQ_TINT] = {
|
|
.reg = PM8607_INT_STATUS2,
|
|
.mask_reg = PM8607_INT_MASK_2,
|
|
.offs = 1 << 3,
|
|
},
|
|
[PM8607_IRQ_GPADC0] = {
|
|
.reg = PM8607_INT_STATUS2,
|
|
.mask_reg = PM8607_INT_MASK_2,
|
|
.offs = 1 << 4,
|
|
},
|
|
[PM8607_IRQ_GPADC1] = {
|
|
.reg = PM8607_INT_STATUS2,
|
|
.mask_reg = PM8607_INT_MASK_2,
|
|
.offs = 1 << 5,
|
|
},
|
|
[PM8607_IRQ_GPADC2] = {
|
|
.reg = PM8607_INT_STATUS2,
|
|
.mask_reg = PM8607_INT_MASK_2,
|
|
.offs = 1 << 6,
|
|
},
|
|
[PM8607_IRQ_GPADC3] = {
|
|
.reg = PM8607_INT_STATUS2,
|
|
.mask_reg = PM8607_INT_MASK_2,
|
|
.offs = 1 << 7,
|
|
},
|
|
[PM8607_IRQ_AUDIO_SHORT] = {
|
|
.reg = PM8607_INT_STATUS3,
|
|
.mask_reg = PM8607_INT_MASK_3,
|
|
.offs = 1 << 0,
|
|
},
|
|
[PM8607_IRQ_PEN] = {
|
|
.reg = PM8607_INT_STATUS3,
|
|
.mask_reg = PM8607_INT_MASK_3,
|
|
.offs = 1 << 1,
|
|
},
|
|
[PM8607_IRQ_HEADSET] = {
|
|
.reg = PM8607_INT_STATUS3,
|
|
.mask_reg = PM8607_INT_MASK_3,
|
|
.offs = 1 << 2,
|
|
},
|
|
[PM8607_IRQ_HOOK] = {
|
|
.reg = PM8607_INT_STATUS3,
|
|
.mask_reg = PM8607_INT_MASK_3,
|
|
.offs = 1 << 3,
|
|
},
|
|
[PM8607_IRQ_MICIN] = {
|
|
.reg = PM8607_INT_STATUS3,
|
|
.mask_reg = PM8607_INT_MASK_3,
|
|
.offs = 1 << 4,
|
|
},
|
|
[PM8607_IRQ_CHG_FAIL] = {
|
|
.reg = PM8607_INT_STATUS3,
|
|
.mask_reg = PM8607_INT_MASK_3,
|
|
.offs = 1 << 5,
|
|
},
|
|
[PM8607_IRQ_CHG_DONE] = {
|
|
.reg = PM8607_INT_STATUS3,
|
|
.mask_reg = PM8607_INT_MASK_3,
|
|
.offs = 1 << 6,
|
|
},
|
|
[PM8607_IRQ_CHG_FAULT] = {
|
|
.reg = PM8607_INT_STATUS3,
|
|
.mask_reg = PM8607_INT_MASK_3,
|
|
.offs = 1 << 7,
|
|
},
|
|
};
|
|
|
|
static inline struct pm860x_irq_data *irq_to_pm860x(struct pm860x_chip *chip,
|
|
int irq)
|
|
{
|
|
return &pm860x_irqs[irq - chip->irq_base];
|
|
}
|
|
|
|
static irqreturn_t pm860x_irq(int irq, void *data)
|
|
{
|
|
struct pm860x_chip *chip = data;
|
|
struct pm860x_irq_data *irq_data;
|
|
struct i2c_client *i2c;
|
|
int read_reg = -1, value = 0;
|
|
int i;
|
|
|
|
i2c = (chip->id == CHIP_PM8607) ? chip->client : chip->companion;
|
|
for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {
|
|
irq_data = &pm860x_irqs[i];
|
|
if (read_reg != irq_data->reg) {
|
|
read_reg = irq_data->reg;
|
|
value = pm860x_reg_read(i2c, irq_data->reg);
|
|
}
|
|
if (value & irq_data->enable)
|
|
handle_nested_irq(chip->irq_base + i);
|
|
}
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static void pm860x_irq_lock(unsigned int irq)
|
|
{
|
|
struct pm860x_chip *chip = get_irq_chip_data(irq);
|
|
|
|
mutex_lock(&chip->irq_lock);
|
|
}
|
|
|
|
static void pm860x_irq_sync_unlock(unsigned int irq)
|
|
{
|
|
struct pm860x_chip *chip = get_irq_chip_data(irq);
|
|
struct pm860x_irq_data *irq_data;
|
|
struct i2c_client *i2c;
|
|
static unsigned char cached[3] = {0x0, 0x0, 0x0};
|
|
unsigned char mask[3];
|
|
int i;
|
|
|
|
i2c = (chip->id == CHIP_PM8607) ? chip->client : chip->companion;
|
|
/* Load cached value. In initial, all IRQs are masked */
|
|
for (i = 0; i < 3; i++)
|
|
mask[i] = cached[i];
|
|
for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {
|
|
irq_data = &pm860x_irqs[i];
|
|
switch (irq_data->mask_reg) {
|
|
case PM8607_INT_MASK_1:
|
|
mask[0] &= ~irq_data->offs;
|
|
mask[0] |= irq_data->enable;
|
|
break;
|
|
case PM8607_INT_MASK_2:
|
|
mask[1] &= ~irq_data->offs;
|
|
mask[1] |= irq_data->enable;
|
|
break;
|
|
case PM8607_INT_MASK_3:
|
|
mask[2] &= ~irq_data->offs;
|
|
mask[2] |= irq_data->enable;
|
|
break;
|
|
default:
|
|
dev_err(chip->dev, "wrong IRQ\n");
|
|
break;
|
|
}
|
|
}
|
|
/* update mask into registers */
|
|
for (i = 0; i < 3; i++) {
|
|
if (mask[i] != cached[i]) {
|
|
cached[i] = mask[i];
|
|
pm860x_reg_write(i2c, PM8607_INT_MASK_1 + i, mask[i]);
|
|
}
|
|
}
|
|
|
|
mutex_unlock(&chip->irq_lock);
|
|
}
|
|
|
|
static void pm860x_irq_enable(unsigned int irq)
|
|
{
|
|
struct pm860x_chip *chip = get_irq_chip_data(irq);
|
|
pm860x_irqs[irq - chip->irq_base].enable
|
|
= pm860x_irqs[irq - chip->irq_base].offs;
|
|
}
|
|
|
|
static void pm860x_irq_disable(unsigned int irq)
|
|
{
|
|
struct pm860x_chip *chip = get_irq_chip_data(irq);
|
|
pm860x_irqs[irq - chip->irq_base].enable = 0;
|
|
}
|
|
|
|
static struct irq_chip pm860x_irq_chip = {
|
|
.name = "88pm860x",
|
|
.bus_lock = pm860x_irq_lock,
|
|
.bus_sync_unlock = pm860x_irq_sync_unlock,
|
|
.enable = pm860x_irq_enable,
|
|
.disable = pm860x_irq_disable,
|
|
};
|
|
|
|
static int __devinit device_gpadc_init(struct pm860x_chip *chip,
|
|
struct pm860x_platform_data *pdata)
|
|
{
|
|
struct i2c_client *i2c = (chip->id == CHIP_PM8607) ? chip->client \
|
|
: chip->companion;
|
|
int data;
|
|
int ret;
|
|
|
|
/* initialize GPADC without activating it */
|
|
|
|
if (!pdata || !pdata->touch)
|
|
return -EINVAL;
|
|
|
|
/* set GPADC MISC1 register */
|
|
data = 0;
|
|
data |= (pdata->touch->gpadc_prebias << 1) & PM8607_GPADC_PREBIAS_MASK;
|
|
data |= (pdata->touch->slot_cycle << 3) & PM8607_GPADC_SLOT_CYCLE_MASK;
|
|
data |= (pdata->touch->off_scale << 5) & PM8607_GPADC_OFF_SCALE_MASK;
|
|
data |= (pdata->touch->sw_cal << 7) & PM8607_GPADC_SW_CAL_MASK;
|
|
if (data) {
|
|
ret = pm860x_reg_write(i2c, PM8607_GPADC_MISC1, data);
|
|
if (ret < 0)
|
|
goto out;
|
|
}
|
|
/* set tsi prebias time */
|
|
if (pdata->touch->tsi_prebias) {
|
|
data = pdata->touch->tsi_prebias;
|
|
ret = pm860x_reg_write(i2c, PM8607_TSI_PREBIAS, data);
|
|
if (ret < 0)
|
|
goto out;
|
|
}
|
|
/* set prebias & prechg time of pen detect */
|
|
data = 0;
|
|
data |= pdata->touch->pen_prebias & PM8607_PD_PREBIAS_MASK;
|
|
data |= (pdata->touch->pen_prechg << 5) & PM8607_PD_PRECHG_MASK;
|
|
if (data) {
|
|
ret = pm860x_reg_write(i2c, PM8607_PD_PREBIAS, data);
|
|
if (ret < 0)
|
|
goto out;
|
|
}
|
|
|
|
ret = pm860x_set_bits(i2c, PM8607_GPADC_MISC1,
|
|
PM8607_GPADC_EN, PM8607_GPADC_EN);
|
|
out:
|
|
return ret;
|
|
}
|
|
|
|
static int __devinit device_irq_init(struct pm860x_chip *chip,
|
|
struct pm860x_platform_data *pdata)
|
|
{
|
|
struct i2c_client *i2c = (chip->id == CHIP_PM8607) ? chip->client \
|
|
: chip->companion;
|
|
unsigned char status_buf[INT_STATUS_NUM];
|
|
unsigned long flags = IRQF_TRIGGER_FALLING | IRQF_ONESHOT;
|
|
struct irq_desc *desc;
|
|
int i, data, mask, ret = -EINVAL;
|
|
int __irq;
|
|
|
|
if (!pdata || !pdata->irq_base) {
|
|
dev_warn(chip->dev, "No interrupt support on IRQ base\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
mask = PM8607_B0_MISC1_INV_INT | PM8607_B0_MISC1_INT_CLEAR
|
|
| PM8607_B0_MISC1_INT_MASK;
|
|
data = 0;
|
|
chip->irq_mode = 0;
|
|
if (pdata && pdata->irq_mode) {
|
|
/*
|
|
* irq_mode defines the way of clearing interrupt. If it's 1,
|
|
* clear IRQ by write. Otherwise, clear it by read.
|
|
* This control bit is valid from 88PM8607 B0 steping.
|
|
*/
|
|
data |= PM8607_B0_MISC1_INT_CLEAR;
|
|
chip->irq_mode = 1;
|
|
}
|
|
ret = pm860x_set_bits(i2c, PM8607_B0_MISC1, mask, data);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
/* mask all IRQs */
|
|
memset(status_buf, 0, INT_STATUS_NUM);
|
|
ret = pm860x_bulk_write(i2c, PM8607_INT_MASK_1,
|
|
INT_STATUS_NUM, status_buf);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
if (chip->irq_mode) {
|
|
/* clear interrupt status by write */
|
|
memset(status_buf, 0xFF, INT_STATUS_NUM);
|
|
ret = pm860x_bulk_write(i2c, PM8607_INT_STATUS1,
|
|
INT_STATUS_NUM, status_buf);
|
|
} else {
|
|
/* clear interrupt status by read */
|
|
ret = pm860x_bulk_read(i2c, PM8607_INT_STATUS1,
|
|
INT_STATUS_NUM, status_buf);
|
|
}
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
mutex_init(&chip->irq_lock);
|
|
chip->irq_base = pdata->irq_base;
|
|
chip->core_irq = i2c->irq;
|
|
if (!chip->core_irq)
|
|
goto out;
|
|
|
|
desc = irq_to_desc(chip->core_irq);
|
|
|
|
/* register IRQ by genirq */
|
|
for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {
|
|
__irq = i + chip->irq_base;
|
|
set_irq_chip_data(__irq, chip);
|
|
set_irq_chip_and_handler(__irq, &pm860x_irq_chip,
|
|
handle_edge_irq);
|
|
set_irq_nested_thread(__irq, 1);
|
|
#ifdef CONFIG_ARM
|
|
set_irq_flags(__irq, IRQF_VALID);
|
|
#else
|
|
set_irq_noprobe(__irq);
|
|
#endif
|
|
}
|
|
|
|
ret = request_threaded_irq(chip->core_irq, NULL, pm860x_irq, flags,
|
|
"88pm860x", chip);
|
|
if (ret) {
|
|
dev_err(chip->dev, "Failed to request IRQ: %d\n", ret);
|
|
chip->core_irq = 0;
|
|
}
|
|
|
|
return 0;
|
|
out:
|
|
chip->core_irq = 0;
|
|
return ret;
|
|
}
|
|
|
|
static void device_irq_exit(struct pm860x_chip *chip)
|
|
{
|
|
if (chip->core_irq)
|
|
free_irq(chip->core_irq, chip);
|
|
}
|
|
|
|
static void __devinit device_8606_init(struct pm860x_chip *chip,
|
|
struct i2c_client *i2c,
|
|
struct pm860x_platform_data *pdata)
|
|
{
|
|
int ret;
|
|
|
|
if (pdata && pdata->backlight) {
|
|
ret = mfd_add_devices(chip->dev, 0, &backlight_devs[0],
|
|
ARRAY_SIZE(backlight_devs),
|
|
&backlight_resources[0], 0);
|
|
if (ret < 0) {
|
|
dev_err(chip->dev, "Failed to add backlight "
|
|
"subdev\n");
|
|
goto out_dev;
|
|
}
|
|
}
|
|
|
|
if (pdata && pdata->led) {
|
|
ret = mfd_add_devices(chip->dev, 0, &led_devs[0],
|
|
ARRAY_SIZE(led_devs),
|
|
&led_resources[0], 0);
|
|
if (ret < 0) {
|
|
dev_err(chip->dev, "Failed to add led "
|
|
"subdev\n");
|
|
goto out_dev;
|
|
}
|
|
}
|
|
return;
|
|
out_dev:
|
|
mfd_remove_devices(chip->dev);
|
|
device_irq_exit(chip);
|
|
}
|
|
|
|
static void __devinit device_8607_init(struct pm860x_chip *chip,
|
|
struct i2c_client *i2c,
|
|
struct pm860x_platform_data *pdata)
|
|
{
|
|
int data, ret;
|
|
|
|
ret = pm860x_reg_read(i2c, PM8607_CHIP_ID);
|
|
if (ret < 0) {
|
|
dev_err(chip->dev, "Failed to read CHIP ID: %d\n", ret);
|
|
goto out;
|
|
}
|
|
if ((ret & PM8607_VERSION_MASK) == PM8607_VERSION)
|
|
dev_info(chip->dev, "Marvell 88PM8607 (ID: %02x) detected\n",
|
|
ret);
|
|
else {
|
|
dev_err(chip->dev, "Failed to detect Marvell 88PM8607. "
|
|
"Chip ID: %02x\n", ret);
|
|
goto out;
|
|
}
|
|
|
|
ret = pm860x_reg_read(i2c, PM8607_BUCK3);
|
|
if (ret < 0) {
|
|
dev_err(chip->dev, "Failed to read BUCK3 register: %d\n", ret);
|
|
goto out;
|
|
}
|
|
if (ret & PM8607_BUCK3_DOUBLE)
|
|
chip->buck3_double = 1;
|
|
|
|
ret = pm860x_reg_read(i2c, PM8607_B0_MISC1);
|
|
if (ret < 0) {
|
|
dev_err(chip->dev, "Failed to read MISC1 register: %d\n", ret);
|
|
goto out;
|
|
}
|
|
|
|
if (pdata && (pdata->i2c_port == PI2C_PORT))
|
|
data = PM8607_B0_MISC1_PI2C;
|
|
else
|
|
data = 0;
|
|
ret = pm860x_set_bits(i2c, PM8607_B0_MISC1, PM8607_B0_MISC1_PI2C, data);
|
|
if (ret < 0) {
|
|
dev_err(chip->dev, "Failed to access MISC1:%d\n", ret);
|
|
goto out;
|
|
}
|
|
|
|
ret = device_gpadc_init(chip, pdata);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
ret = device_irq_init(chip, pdata);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
ret = mfd_add_devices(chip->dev, 0, ®ulator_devs[0],
|
|
ARRAY_SIZE(regulator_devs),
|
|
®ulator_resources[0], 0);
|
|
if (ret < 0) {
|
|
dev_err(chip->dev, "Failed to add regulator subdev\n");
|
|
goto out_dev;
|
|
}
|
|
|
|
if (pdata && pdata->touch) {
|
|
ret = mfd_add_devices(chip->dev, 0, &touch_devs[0],
|
|
ARRAY_SIZE(touch_devs),
|
|
&touch_resources[0], 0);
|
|
if (ret < 0) {
|
|
dev_err(chip->dev, "Failed to add touch "
|
|
"subdev\n");
|
|
goto out_dev;
|
|
}
|
|
}
|
|
|
|
if (pdata && pdata->power) {
|
|
ret = mfd_add_devices(chip->dev, 0, &power_devs[0],
|
|
ARRAY_SIZE(power_devs),
|
|
&power_supply_resources[0], 0);
|
|
if (ret < 0) {
|
|
dev_err(chip->dev, "Failed to add power supply "
|
|
"subdev\n");
|
|
goto out_dev;
|
|
}
|
|
}
|
|
|
|
ret = mfd_add_devices(chip->dev, 0, &onkey_devs[0],
|
|
ARRAY_SIZE(onkey_devs),
|
|
&onkey_resources[0], 0);
|
|
if (ret < 0) {
|
|
dev_err(chip->dev, "Failed to add onkey subdev\n");
|
|
goto out_dev;
|
|
}
|
|
|
|
return;
|
|
out_dev:
|
|
mfd_remove_devices(chip->dev);
|
|
device_irq_exit(chip);
|
|
out:
|
|
return;
|
|
}
|
|
|
|
int __devinit pm860x_device_init(struct pm860x_chip *chip,
|
|
struct pm860x_platform_data *pdata)
|
|
{
|
|
chip->core_irq = 0;
|
|
|
|
switch (chip->id) {
|
|
case CHIP_PM8606:
|
|
device_8606_init(chip, chip->client, pdata);
|
|
break;
|
|
case CHIP_PM8607:
|
|
device_8607_init(chip, chip->client, pdata);
|
|
break;
|
|
}
|
|
|
|
if (chip->companion) {
|
|
switch (chip->id) {
|
|
case CHIP_PM8607:
|
|
device_8606_init(chip, chip->companion, pdata);
|
|
break;
|
|
case CHIP_PM8606:
|
|
device_8607_init(chip, chip->companion, pdata);
|
|
break;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void __devexit pm860x_device_exit(struct pm860x_chip *chip)
|
|
{
|
|
device_irq_exit(chip);
|
|
mfd_remove_devices(chip->dev);
|
|
}
|
|
|
|
MODULE_DESCRIPTION("PMIC Driver for Marvell 88PM860x");
|
|
MODULE_AUTHOR("Haojian Zhuang <haojian.zhuang@marvell.com>");
|
|
MODULE_LICENSE("GPL");
|