TWL5031 introduces two new interrupts in PIH. Moreover, BCI
has changed remarkably and, thus, it's disabled when TWL5031
is in use.
Signed-off-by: Ilkka Koskinen <[email protected]>
---
drivers/mfd/twl4030-core.c | 15 +++++-
drivers/mfd/twl4030-irq.c | 126 ++++++++++++++++++++++++++++++++++++++++--
include/linux/i2c/twl4030.h | 47 ++++++++++++++--
3 files changed, 175 insertions(+), 13 deletions(-)
diff --git a/drivers/mfd/twl4030-core.c b/drivers/mfd/twl4030-core.c
index cd1008c..952bea5 100644
--- a/drivers/mfd/twl4030-core.c
+++ b/drivers/mfd/twl4030-core.c
@@ -134,6 +134,9 @@
#define TWL4030_BASEADD_PWMB 0x00F1
#define TWL4030_BASEADD_KEYPAD 0x00D2
+#define TWL5031_BASEADD_ACCESSORY 0x0074 /* Replaces Main Charge */
+#define TWL5031_BASEADD_INTERRUPTS 0x00B9 /* Different to TWL4030's one */
+
/* subchip/slave 3 - POWER ID */
#define TWL4030_BASEADD_BACKUP 0x0014
#define TWL4030_BASEADD_INT 0x002E
@@ -164,6 +167,7 @@
/* chip-specific feature flags, for i2c_device_id.driver_data */
#define TWL4030_VAUX2 BIT(0) /* pre-5030 voltage ranges */
#define TPS_SUBSET BIT(1) /* tps659[23]0 have fewer LDOs */
+#define TWL5031 BIT(2) /* twl5031 has different registers */
/*----------------------------------------------------------------------*/
@@ -216,6 +220,8 @@ static struct twl4030mapping twl4030_map[TWL4030_MODULE_LAST + 1] = {
{ 2, TWL4030_BASEADD_PWM1 },
{ 2, TWL4030_BASEADD_PWMA },
{ 2, TWL4030_BASEADD_PWMB },
+ { 2, TWL5031_BASEADD_ACCESSORY },
+ { 2, TWL5031_BASEADD_INTERRUPTS },
{ 3, TWL4030_BASEADD_BACKUP },
{ 3, TWL4030_BASEADD_INT },
@@ -464,7 +470,8 @@ add_children(struct twl4030_platform_data *pdata, unsigned long features)
struct device *child;
struct device *usb_transceiver = NULL;
- if (twl_has_bci() && pdata->bci && !(features & TPS_SUBSET)) {
+ if (twl_has_bci() && pdata->bci &&
+ !((features & TPS_SUBSET) || (features & TWL5031))) {
child = add_child(3, "twl4030_bci",
pdata->bci, sizeof(*pdata->bci),
false,
@@ -707,6 +714,7 @@ static void clocks_init(struct device *dev)
int twl_init_irq(int irq_num, unsigned irq_base, unsigned irq_end);
int twl_exit_irq(void);
+int twl_init_chip_irq(const char *chip);
static int twl4030_remove(struct i2c_client *client)
{
@@ -780,6 +788,10 @@ twl4030_probe(struct i2c_client *client, const struct i2c_device_id *id)
if (client->irq
&& pdata->irq_base
&& pdata->irq_end > pdata->irq_base) {
+ status = twl_init_chip_irq(id->name);
+ if (status < 0)
+ goto fail;
+
status = twl_init_irq(client->irq, pdata->irq_base, pdata->irq_end);
if (status < 0)
goto fail;
@@ -795,6 +807,7 @@ fail:
static const struct i2c_device_id twl4030_ids[] = {
{ "twl4030", TWL4030_VAUX2 }, /* "Triton 2" */
{ "twl5030", 0 }, /* T2 updated */
+ { "twl5031", TWL5031 }, /* TWL5030 updated */
{ "tps65950", 0 }, /* catalog version of twl5030 */
{ "tps65930", TPS_SUBSET }, /* fewer LDOs and DACs; no charger */
{ "tps65920", TPS_SUBSET }, /* fewer LDOs; no codec or charger */
diff --git a/drivers/mfd/twl4030-irq.c b/drivers/mfd/twl4030-irq.c
index aca2670..d781788 100644
--- a/drivers/mfd/twl4030-irq.c
+++ b/drivers/mfd/twl4030-irq.c
@@ -61,6 +61,7 @@
/* Linux could (eventually) use either IRQ line */
static int irq_line;
+static int chip_is_twl5031;
struct sih {
char name[8];
@@ -82,6 +83,9 @@ struct sih {
/* + 2 bytes padding */
};
+static const struct sih *sih_modules;
+static int nr_sih_modules;
+
#define SIH_INITIALIZER(modname, nbits) \
.module = TWL4030_MODULE_ ## modname, \
.control_offset = TWL4030_ ## modname ## _SIH_CTRL, \
@@ -107,7 +111,7 @@ struct sih {
/* Order in this table matches order in PIH_ISR. That is,
* BIT(n) in PIH_ISR is sih_modules[n].
*/
-static const struct sih sih_modules[6] = {
+static const struct sih sih_modules_twl4030[6] = {
[0] = {
.name = "gpio",
.module = TWL4030_MODULE_GPIO,
@@ -164,6 +168,84 @@ static const struct sih sih_modules[6] = {
/* there are no SIH modules #6 or #7 ... */
};
+static const struct sih sih_modules_twl5031[8] = {
+ [0] = {
+ .name = "gpio",
+ .module = TWL4030_MODULE_GPIO,
+ .control_offset = REG_GPIO_SIH_CTRL,
+ .set_cor = true,
+ .bits = TWL4030_GPIO_MAX,
+ .bytes_ixr = 3,
+ /* Note: *all* of these IRQs default to no-trigger */
+ .edr_offset = REG_GPIO_EDR1,
+ .bytes_edr = 5,
+ .mask = { {
+ .isr_offset = REG_GPIO_ISR1A,
+ .imr_offset = REG_GPIO_IMR1A,
+ }, {
+ .isr_offset = REG_GPIO_ISR1B,
+ .imr_offset = REG_GPIO_IMR1B,
+ }, },
+ },
+ [1] = {
+ .name = "keypad",
+ .set_cor = true,
+ SIH_INITIALIZER(KEYPAD_KEYP, 4)
+ },
+ [2] = {
+ .name = "bci",
+ .module = TWL5031_MODULE_INTERRUPTS,
+ .control_offset = TWL5031_INTERRUPTS_BCISIHCTRL,
+ .bits = 7,
+ .bytes_ixr = 1,
+ .edr_offset = TWL5031_INTERRUPTS_BCIEDR1,
+ /* Note: most of these IRQs default to no-trigger */
+ .bytes_edr = 2,
+ .mask = { {
+ .isr_offset = TWL5031_INTERRUPTS_BCIISR1,
+ .imr_offset = TWL5031_INTERRUPTS_BCIIMR1,
+ }, {
+ .isr_offset = TWL5031_INTERRUPTS_BCIISR2,
+ .imr_offset = TWL5031_INTERRUPTS_BCIIMR2,
+ }, },
+ },
+ [3] = {
+ .name = "madc",
+ SIH_INITIALIZER(MADC, 4)
+ },
+ [4] = {
+ /* USB doesn't use the same SIH organization */
+ .name = "usb",
+ },
+ [5] = {
+ .name = "power",
+ .set_cor = true,
+ SIH_INITIALIZER(INT_PWR, 8)
+ },
+ [6] = {
+ /* ECI/DBI/BSI (ACI) does not have SIH */
+ .name = "aci",
+ },
+ [7] = {
+ /* Accessory */
+ .name = "acc",
+ .module = TWL5031_MODULE_ACCESSORY,
+ .control_offset = TWL5031_ACCSIHCTRL,
+ .bits = 2,
+ .bytes_ixr = 1,
+ .edr_offset = TWL5031_ACCEDR1,
+ /* Note: most of these IRQs default to no-trigger */
+ .bytes_edr = 1,
+ .mask = { {
+ .isr_offset = TWL5031_ACCISR1,
+ .imr_offset = TWL5031_ACCIMR1,
+ }, {
+ .isr_offset = TWL5031_ACCISR2,
+ .imr_offset = TWL5031_ACCIMR2,
+ }, },
+ },
+};
+
#undef TWL4030_MODULE_KEYPAD_KEYP
#undef TWL4030_MODULE_INT_PWR
#undef TWL4030_INT_PWR_EDR
@@ -301,11 +383,20 @@ static int twl4030_init_sih_modules(unsigned line)
/* disable all interrupts on our line */
memset(buf, 0xff, sizeof buf);
sih = sih_modules;
- for (i = 0; i < ARRAY_SIZE(sih_modules); i++, sih++) {
+ for (i = 0; i < nr_sih_modules; i++, sih++) {
/* skip USB -- it's funky */
- if (!sih->bytes_ixr)
+ /* But don't skip TWL5031's ACI */
+ if (!sih->bytes_ixr) {
+ if (chip_is_twl5031 && !strcmp(sih->name, "aci")) {
+ twl4030_i2c_write(TWL5031_MODULE_ACCESSORY,
+ buf, TWL5031_ACIIMR_LSB, 1);
+ twl4030_i2c_write(TWL5031_MODULE_ACCESSORY,
+ buf, TWL5031_ACIIMR_MSB, 1);
+ }
+
continue;
+ }
status = twl4030_i2c_write(sih->module, buf,
sih->mask[line].imr_offset, sih->bytes_ixr);
@@ -331,13 +422,22 @@ static int twl4030_init_sih_modules(unsigned line)
}
sih = sih_modules;
- for (i = 0; i < ARRAY_SIZE(sih_modules); i++, sih++) {
+ for (i = 0; i < nr_sih_modules; i++, sih++) {
u8 rxbuf[4];
int j;
/* skip USB */
- if (!sih->bytes_ixr)
+ /* But don't skip TWL5031's ACI */
+ if (!sih->bytes_ixr) {
+ if (chip_is_twl5031 && !strcmp(sih->name, "aci")) {
+ twl4030_i2c_write(TWL5031_MODULE_ACCESSORY,
+ buf, TWL5031_ACIIDR_LSB, 1);
+ twl4030_i2c_write(TWL5031_MODULE_ACCESSORY,
+ buf, TWL5031_ACIIDR_MSB, 1);
+ }
+
continue;
+ }
/* Clear pending interrupt status. Either the read was
* enough, or we need to write those bits. Repeat, in
@@ -628,7 +728,7 @@ int twl4030_sih_setup(int module)
/* only support modules with standard clear-on-read for now */
for (sih_mod = 0, sih = sih_modules;
- sih_mod < ARRAY_SIZE(sih_modules);
+ sih_mod < nr_sih_modules;
sih_mod++, sih++) {
if (sih->module == module && sih->set_cor) {
if (!WARN((irq_base + sih->bits) > NR_IRQS,
@@ -763,3 +863,17 @@ int twl_exit_irq(void)
}
return 0;
}
+
+int twl_init_chip_irq(const char *chip)
+{
+ if (!strcmp(chip, "twl5031")) {
+ chip_is_twl5031 = 1;
+ sih_modules = sih_modules_twl5031;
+ nr_sih_modules = ARRAY_SIZE(sih_modules_twl5031);
+ } else {
+ sih_modules = sih_modules_twl4030;
+ nr_sih_modules = ARRAY_SIZE(sih_modules_twl4030);
+ }
+
+ return 0;
+}
diff --git a/include/linux/i2c/twl4030.h b/include/linux/i2c/twl4030.h
index 0dc80ef..838916f 100644
--- a/include/linux/i2c/twl4030.h
+++ b/include/linux/i2c/twl4030.h
@@ -58,13 +58,16 @@
#define TWL4030_MODULE_PWMA 0x0E
#define TWL4030_MODULE_PWMB 0x0F
+#define TWL5031_MODULE_ACCESSORY 0x10
+#define TWL5031_MODULE_INTERRUPTS 0x11
+
/* Slave 3 (i2c address 0x4b) */
-#define TWL4030_MODULE_BACKUP 0x10
-#define TWL4030_MODULE_INT 0x11
-#define TWL4030_MODULE_PM_MASTER 0x12
-#define TWL4030_MODULE_PM_RECEIVER 0x13
-#define TWL4030_MODULE_RTC 0x14
-#define TWL4030_MODULE_SECURED_REG 0x15
+#define TWL4030_MODULE_BACKUP 0x12
+#define TWL4030_MODULE_INT 0x13
+#define TWL4030_MODULE_PM_MASTER 0x14
+#define TWL4030_MODULE_PM_RECEIVER 0x15
+#define TWL4030_MODULE_RTC 0x16
+#define TWL4030_MODULE_SECURED_REG 0x17
/*
* Read and write single 8-bit registers
@@ -218,6 +221,38 @@ int twl4030_i2c_read(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes);
/*----------------------------------------------------------------------*/
+/*
+ * Accessory Interrupts
+ */
+#define TWL5031_ACIIMR_LSB 0x05
+#define TWL5031_ACIIMR_MSB 0x06
+#define TWL5031_ACIIDR_LSB 0x07
+#define TWL5031_ACIIDR_MSB 0x08
+#define TWL5031_ACCISR1 0x0F
+#define TWL5031_ACCIMR1 0x10
+#define TWL5031_ACCISR2 0x11
+#define TWL5031_ACCIMR2 0x12
+#define TWL5031_ACCSIR 0x13
+#define TWL5031_ACCEDR1 0x14
+#define TWL5031_ACCSIHCTRL 0x15
+
+/*----------------------------------------------------------------------*/
+
+/*
+ * Battery Charger Controller
+ */
+
+#define TWL5031_INTERRUPTS_BCIISR1 0x0
+#define TWL5031_INTERRUPTS_BCIIMR1 0x1
+#define TWL5031_INTERRUPTS_BCIISR2 0x2
+#define TWL5031_INTERRUPTS_BCIIMR2 0x3
+#define TWL5031_INTERRUPTS_BCISIR 0x4
+#define TWL5031_INTERRUPTS_BCIEDR1 0x5
+#define TWL5031_INTERRUPTS_BCIEDR2 0x6
+#define TWL5031_INTERRUPTS_BCISIHCTRL 0x7
+
+/*----------------------------------------------------------------------*/
+
/* Power bus message definitions */
#define DEV_GRP_NULL 0x0
--
1.6.0.4
Koskinen,
> -----Original Message-----
> From: [email protected]
> [mailto:[email protected]] On Behalf Of Ilkka Koskinen
> Sent: Thursday, September 24, 2009 9:24 PM
> To: [email protected]; [email protected]
> Cc: [email protected]; [email protected];
> [email protected]; [email protected]
> Subject: [PATCH] twl4030: Initial support for twl5031
>
> TWL5031 introduces two new interrupts in PIH. Moreover, BCI
> has changed remarkably and, thus, it's disabled when TWL5031
> is in use.
>
> Signed-off-by: Ilkka Koskinen <[email protected]>
> ---
> drivers/mfd/twl4030-core.c | 15 +++++-
> drivers/mfd/twl4030-irq.c | 126
> ++++++++++++++++++++++++++++++++++++++++--
> include/linux/i2c/twl4030.h | 47 ++++++++++++++--
> 3 files changed, 175 insertions(+), 13 deletions(-)
>
> diff --git a/drivers/mfd/twl4030-core.c b/drivers/mfd/twl4030-core.c
> index cd1008c..952bea5 100644
> --- a/drivers/mfd/twl4030-core.c
> +++ b/drivers/mfd/twl4030-core.c
> @@ -134,6 +134,9 @@
> #define TWL4030_BASEADD_PWMB 0x00F1
> #define TWL4030_BASEADD_KEYPAD 0x00D2
>
> +#define TWL5031_BASEADD_ACCESSORY 0x0074 /* Replaces Main
> Charge */
> +#define TWL5031_BASEADD_INTERRUPTS 0x00B9 /* Different to
> TWL4030's one */
> +
> /* subchip/slave 3 - POWER ID */
> #define TWL4030_BASEADD_BACKUP 0x0014
> #define TWL4030_BASEADD_INT 0x002E
> @@ -164,6 +167,7 @@
> /* chip-specific feature flags, for i2c_device_id.driver_data */
> #define TWL4030_VAUX2 BIT(0) /* pre-5030
> voltage ranges */
> #define TPS_SUBSET BIT(1) /* tps659[23]0 have
> fewer LDOs */
> +#define TWL5031 BIT(2) /* twl5031 has
> different registers */
>
>
> /*------------------------------------------------------------
> ----------*/
>
> @@ -216,6 +220,8 @@ static struct twl4030mapping
> twl4030_map[TWL4030_MODULE_LAST + 1] = {
> { 2, TWL4030_BASEADD_PWM1 },
> { 2, TWL4030_BASEADD_PWMA },
> { 2, TWL4030_BASEADD_PWMB },
> + { 2, TWL5031_BASEADD_ACCESSORY },
> + { 2, TWL5031_BASEADD_INTERRUPTS },
>
> { 3, TWL4030_BASEADD_BACKUP },
> { 3, TWL4030_BASEADD_INT },
> @@ -464,7 +470,8 @@ add_children(struct twl4030_platform_data
> *pdata, unsigned long features)
> struct device *child;
> struct device *usb_transceiver = NULL;
>
> - if (twl_has_bci() && pdata->bci && !(features & TPS_SUBSET)) {
> + if (twl_has_bci() && pdata->bci &&
> + !((features & TPS_SUBSET) || (features & TWL5031))) {
> child = add_child(3, "twl4030_bci",
> pdata->bci, sizeof(*pdata->bci),
> false,
> @@ -707,6 +714,7 @@ static void clocks_init(struct device *dev)
>
> int twl_init_irq(int irq_num, unsigned irq_base, unsigned irq_end);
> int twl_exit_irq(void);
> +int twl_init_chip_irq(const char *chip);
>
> static int twl4030_remove(struct i2c_client *client)
> {
> @@ -780,6 +788,10 @@ twl4030_probe(struct i2c_client *client,
> const struct i2c_device_id *id)
> if (client->irq
> && pdata->irq_base
> && pdata->irq_end > pdata->irq_base) {
> + status = twl_init_chip_irq(id->name);
> + if (status < 0)
> + goto fail;
No need to check since status is always zero.
> +
> status = twl_init_irq(client->irq,
> pdata->irq_base, pdata->irq_end);
> if (status < 0)
> goto fail;
> @@ -795,6 +807,7 @@ fail:
> static const struct i2c_device_id twl4030_ids[] = {
> { "twl4030", TWL4030_VAUX2 }, /* "Triton 2" */
> { "twl5030", 0 }, /* T2 updated */
> + { "twl5031", TWL5031 }, /* TWL5030 updated */
> { "tps65950", 0 }, /* catalog version of twl5030 */
> { "tps65930", TPS_SUBSET }, /* fewer LDOs and DACs;
> no charger */
> { "tps65920", TPS_SUBSET }, /* fewer LDOs; no codec
> or charger */
> diff --git a/drivers/mfd/twl4030-irq.c b/drivers/mfd/twl4030-irq.c
> index aca2670..d781788 100644
> --- a/drivers/mfd/twl4030-irq.c
> +++ b/drivers/mfd/twl4030-irq.c
> @@ -61,6 +61,7 @@
>
> /* Linux could (eventually) use either IRQ line */
> static int irq_line;
> +static int chip_is_twl5031;
>
> struct sih {
> char name[8];
> @@ -82,6 +83,9 @@ struct sih {
> /* + 2 bytes padding */
> };
>
> +static const struct sih *sih_modules;
> +static int nr_sih_modules;
> +
> #define SIH_INITIALIZER(modname, nbits) \
> .module = TWL4030_MODULE_ ## modname, \
> .control_offset = TWL4030_ ## modname ## _SIH_CTRL, \
> @@ -107,7 +111,7 @@ struct sih {
> /* Order in this table matches order in PIH_ISR. That is,
> * BIT(n) in PIH_ISR is sih_modules[n].
> */
> -static const struct sih sih_modules[6] = {
> +static const struct sih sih_modules_twl4030[6] = {
> [0] = {
> .name = "gpio",
> .module = TWL4030_MODULE_GPIO,
> @@ -164,6 +168,84 @@ static const struct sih sih_modules[6] = {
> /* there are no SIH modules #6 or #7 ... */
> };
>
Can you add comment saying sih_modules_twl4030 is for both twl4030
and twl5030 chips?
> +static const struct sih sih_modules_twl5031[8] = {
> + [0] = {
> + .name = "gpio",
> + .module = TWL4030_MODULE_GPIO,
> + .control_offset = REG_GPIO_SIH_CTRL,
> + .set_cor = true,
> + .bits = TWL4030_GPIO_MAX,
> + .bytes_ixr = 3,
> + /* Note: *all* of these IRQs default to no-trigger */
> + .edr_offset = REG_GPIO_EDR1,
> + .bytes_edr = 5,
> + .mask = { {
> + .isr_offset = REG_GPIO_ISR1A,
> + .imr_offset = REG_GPIO_IMR1A,
> + }, {
> + .isr_offset = REG_GPIO_ISR1B,
> + .imr_offset = REG_GPIO_IMR1B,
> + }, },
> + },
> + [1] = {
> + .name = "keypad",
> + .set_cor = true,
> + SIH_INITIALIZER(KEYPAD_KEYP, 4)
> + },
> + [2] = {
> + .name = "bci",
> + .module = TWL5031_MODULE_INTERRUPTS,
> + .control_offset = TWL5031_INTERRUPTS_BCISIHCTRL,
> + .bits = 7,
> + .bytes_ixr = 1,
> + .edr_offset = TWL5031_INTERRUPTS_BCIEDR1,
> + /* Note: most of these IRQs default to no-trigger */
> + .bytes_edr = 2,
> + .mask = { {
> + .isr_offset = TWL5031_INTERRUPTS_BCIISR1,
> + .imr_offset = TWL5031_INTERRUPTS_BCIIMR1,
> + }, {
> + .isr_offset = TWL5031_INTERRUPTS_BCIISR2,
> + .imr_offset = TWL5031_INTERRUPTS_BCIIMR2,
> + }, },
> + },
> + [3] = {
> + .name = "madc",
> + SIH_INITIALIZER(MADC, 4)
> + },
> + [4] = {
> + /* USB doesn't use the same SIH organization */
> + .name = "usb",
> + },
> + [5] = {
> + .name = "power",
> + .set_cor = true,
> + SIH_INITIALIZER(INT_PWR, 8)
> + },
> + [6] = {
> + /* ECI/DBI/BSI (ACI) does not have SIH */
> + .name = "aci",
> + },
If there is no SIH, How do you determine source of interrupt in PIH? I see
you are masking ACI interrupts during init. If you unmask these interrupts,
How do you handle these interrupts?
> + [7] = {
> + /* Accessory */
> + .name = "acc",
> + .module = TWL5031_MODULE_ACCESSORY,
> + .control_offset = TWL5031_ACCSIHCTRL,
> + .bits = 2,
> + .bytes_ixr = 1,
> + .edr_offset = TWL5031_ACCEDR1,
> + /* Note: most of these IRQs default to no-trigger */
> + .bytes_edr = 1,
> + .mask = { {
> + .isr_offset = TWL5031_ACCISR1,
> + .imr_offset = TWL5031_ACCIMR1,
> + }, {
> + .isr_offset = TWL5031_ACCISR2,
> + .imr_offset = TWL5031_ACCIMR2,
> + }, },
> + },
> +};
> +
> #undef TWL4030_MODULE_KEYPAD_KEYP
> #undef TWL4030_MODULE_INT_PWR
> #undef TWL4030_INT_PWR_EDR
> @@ -301,11 +383,20 @@ static int
> twl4030_init_sih_modules(unsigned line)
> /* disable all interrupts on our line */
> memset(buf, 0xff, sizeof buf);
> sih = sih_modules;
> - for (i = 0; i < ARRAY_SIZE(sih_modules); i++, sih++) {
> + for (i = 0; i < nr_sih_modules; i++, sih++) {
>
> /* skip USB -- it's funky */
> - if (!sih->bytes_ixr)
> + /* But don't skip TWL5031's ACI */
> + if (!sih->bytes_ixr) {
> + if (chip_is_twl5031 &&
> !strcmp(sih->name, "aci")) {
> +
> twl4030_i2c_write(TWL5031_MODULE_ACCESSORY,
> + buf,
> TWL5031_ACIIMR_LSB, 1);
> +
> twl4030_i2c_write(TWL5031_MODULE_ACCESSORY,
> + buf,
> TWL5031_ACIIMR_MSB, 1);
> + }
> +
> continue;
> + }
>
> status = twl4030_i2c_write(sih->module, buf,
> sih->mask[line].imr_offset,
> sih->bytes_ixr);
> @@ -331,13 +422,22 @@ static int
> twl4030_init_sih_modules(unsigned line)
> }
>
> sih = sih_modules;
> - for (i = 0; i < ARRAY_SIZE(sih_modules); i++, sih++) {
> + for (i = 0; i < nr_sih_modules; i++, sih++) {
> u8 rxbuf[4];
> int j;
>
> /* skip USB */
> - if (!sih->bytes_ixr)
> + /* But don't skip TWL5031's ACI */
> + if (!sih->bytes_ixr) {
> + if (chip_is_twl5031 &&
> !strcmp(sih->name, "aci")) {
> +
Regards,
Manjunath
> twl4030_i2c_write(TWL5031_MODULE_ACCESSORY,
> + buf,
> TWL5031_ACIIDR_LSB, 1);
> +
> twl4030_i2c_write(TWL5031_MODULE_ACCESSORY,
> + buf,
> TWL5031_ACIIDR_MSB, 1);
> + }
> +
> continue;
> + }
>
> /* Clear pending interrupt status. Either the read was
> * enough, or we need to write those bits. Repeat, in
> @@ -628,7 +728,7 @@ int twl4030_sih_setup(int module)
>
> /* only support modules with standard clear-on-read for now */
> for (sih_mod = 0, sih = sih_modules;
> - sih_mod < ARRAY_SIZE(sih_modules);
> + sih_mod < nr_sih_modules;
> sih_mod++, sih++) {
> if (sih->module == module && sih->set_cor) {
> if (!WARN((irq_base + sih->bits) > NR_IRQS,
> @@ -763,3 +863,17 @@ int twl_exit_irq(void)
> }
> return 0;
> }
> +
> +int twl_init_chip_irq(const char *chip)
> +{
> + if (!strcmp(chip, "twl5031")) {
> + chip_is_twl5031 = 1;
> + sih_modules = sih_modules_twl5031;
> + nr_sih_modules = ARRAY_SIZE(sih_modules_twl5031);
> + } else {
> + sih_modules = sih_modules_twl4030;
> + nr_sih_modules = ARRAY_SIZE(sih_modules_twl4030);
> + }
> +
> + return 0;
> +}
> diff --git a/include/linux/i2c/twl4030.h b/include/linux/i2c/twl4030.h
> index 0dc80ef..838916f 100644
> --- a/include/linux/i2c/twl4030.h
> +++ b/include/linux/i2c/twl4030.h
> @@ -58,13 +58,16 @@
> #define TWL4030_MODULE_PWMA 0x0E
> #define TWL4030_MODULE_PWMB 0x0F
>
> +#define TWL5031_MODULE_ACCESSORY 0x10
> +#define TWL5031_MODULE_INTERRUPTS 0x11
> +
> /* Slave 3 (i2c address 0x4b) */
> -#define TWL4030_MODULE_BACKUP 0x10
> -#define TWL4030_MODULE_INT 0x11
> -#define TWL4030_MODULE_PM_MASTER 0x12
> -#define TWL4030_MODULE_PM_RECEIVER 0x13
> -#define TWL4030_MODULE_RTC 0x14
> -#define TWL4030_MODULE_SECURED_REG 0x15
> +#define TWL4030_MODULE_BACKUP 0x12
> +#define TWL4030_MODULE_INT 0x13
> +#define TWL4030_MODULE_PM_MASTER 0x14
> +#define TWL4030_MODULE_PM_RECEIVER 0x15
> +#define TWL4030_MODULE_RTC 0x16
> +#define TWL4030_MODULE_SECURED_REG 0x17
>
> /*
> * Read and write single 8-bit registers
> @@ -218,6 +221,38 @@ int twl4030_i2c_read(u8 mod_no, u8
> *value, u8 reg, unsigned num_bytes);
>
>
> /*------------------------------------------------------------
> ----------*/
>
> +/*
> + * Accessory Interrupts
> + */
> +#define TWL5031_ACIIMR_LSB 0x05
> +#define TWL5031_ACIIMR_MSB 0x06
> +#define TWL5031_ACIIDR_LSB 0x07
> +#define TWL5031_ACIIDR_MSB 0x08
> +#define TWL5031_ACCISR1 0x0F
> +#define TWL5031_ACCIMR1 0x10
> +#define TWL5031_ACCISR2 0x11
> +#define TWL5031_ACCIMR2 0x12
> +#define TWL5031_ACCSIR 0x13
> +#define TWL5031_ACCEDR1 0x14
> +#define TWL5031_ACCSIHCTRL 0x15
> +
> +/*-----------------------------------------------------------
> -----------*/
> +
> +/*
> + * Battery Charger Controller
> + */
> +
> +#define TWL5031_INTERRUPTS_BCIISR1 0x0
> +#define TWL5031_INTERRUPTS_BCIIMR1 0x1
> +#define TWL5031_INTERRUPTS_BCIISR2 0x2
> +#define TWL5031_INTERRUPTS_BCIIMR2 0x3
> +#define TWL5031_INTERRUPTS_BCISIR 0x4
> +#define TWL5031_INTERRUPTS_BCIEDR1 0x5
> +#define TWL5031_INTERRUPTS_BCIEDR2 0x6
> +#define TWL5031_INTERRUPTS_BCISIHCTRL 0x7
> +
> +/*-----------------------------------------------------------
> -----------*/
> +
> /* Power bus message definitions */
>
> #define DEV_GRP_NULL 0x0
> --
> 1.6.0.4
>
> --
> To unsubscribe from this list: send the line "unsubscribe
> linux-omap" in
> the body of a message to [email protected]
> More majordomo info at http://vger.kernel.org/majordomo-info.html
>
> -
Hi,
>From: ext G, Manjunath Kondaiah [mailto:[email protected]]
>Sent: 14 October, 2009 13:51
>> -----Original Message-----
>> From: [email protected]
>> [mailto:[email protected]] On Behalf Of Ilkka Koskinen
>> Sent: Thursday, September 24, 2009 9:24 PM
>> To: [email protected]; [email protected]
>> Cc: [email protected]; [email protected];
>> [email protected]; [email protected]
>> Subject: [PATCH] twl4030: Initial support for twl5031
>>
>> TWL5031 introduces two new interrupts in PIH. Moreover, BCI
>> has changed remarkably and, thus, it's disabled when TWL5031
>> is in use.
>>
>> Signed-off-by: Ilkka Koskinen <[email protected]>
>> ---
>> drivers/mfd/twl4030-core.c | 15 +++++-
>> drivers/mfd/twl4030-irq.c | 126
>> ++++++++++++++++++++++++++++++++++++++++--
>> include/linux/i2c/twl4030.h | 47 ++++++++++++++--
>> 3 files changed, 175 insertions(+), 13 deletions(-)
>>
>> diff --git a/drivers/mfd/twl4030-core.c b/drivers/mfd/twl4030-core.c
>> index cd1008c..952bea5 100644
>> --- a/drivers/mfd/twl4030-core.c
>> +++ b/drivers/mfd/twl4030-core.c
>> @@ -134,6 +134,9 @@
>> #define TWL4030_BASEADD_PWMB 0x00F1
>> #define TWL4030_BASEADD_KEYPAD 0x00D2
>>
>> +#define TWL5031_BASEADD_ACCESSORY 0x0074 /* Replaces Main
>> Charge */
>> +#define TWL5031_BASEADD_INTERRUPTS 0x00B9 /* Different to
>> TWL4030's one */
>> +
>> /* subchip/slave 3 - POWER ID */
>> #define TWL4030_BASEADD_BACKUP 0x0014
>> #define TWL4030_BASEADD_INT 0x002E
>> @@ -164,6 +167,7 @@
>> /* chip-specific feature flags, for i2c_device_id.driver_data */
>> #define TWL4030_VAUX2 BIT(0) /* pre-5030
>> voltage ranges */
>> #define TPS_SUBSET BIT(1) /* tps659[23]0 have
>> fewer LDOs */
>> +#define TWL5031 BIT(2) /* twl5031 has
>> different registers */
>>
>>
>> /*------------------------------------------------------------
>> ----------*/
>>
>> @@ -216,6 +220,8 @@ static struct twl4030mapping
>> twl4030_map[TWL4030_MODULE_LAST + 1] = {
>> { 2, TWL4030_BASEADD_PWM1 },
>> { 2, TWL4030_BASEADD_PWMA },
>> { 2, TWL4030_BASEADD_PWMB },
>> + { 2, TWL5031_BASEADD_ACCESSORY },
>> + { 2, TWL5031_BASEADD_INTERRUPTS },
>>
>> { 3, TWL4030_BASEADD_BACKUP },
>> { 3, TWL4030_BASEADD_INT },
>> @@ -464,7 +470,8 @@ add_children(struct twl4030_platform_data
>> *pdata, unsigned long features)
>> struct device *child;
>> struct device *usb_transceiver = NULL;
>>
>> - if (twl_has_bci() && pdata->bci && !(features & TPS_SUBSET)) {
>> + if (twl_has_bci() && pdata->bci &&
>> + !((features & TPS_SUBSET) || (features & TWL5031))) {
>> child = add_child(3, "twl4030_bci",
>> pdata->bci, sizeof(*pdata->bci),
>> false,
>> @@ -707,6 +714,7 @@ static void clocks_init(struct device *dev)
>>
>> int twl_init_irq(int irq_num, unsigned irq_base, unsigned irq_end);
>> int twl_exit_irq(void);
>> +int twl_init_chip_irq(const char *chip);
>>
>> static int twl4030_remove(struct i2c_client *client)
>> {
>> @@ -780,6 +788,10 @@ twl4030_probe(struct i2c_client *client,
>> const struct i2c_device_id *id)
>> if (client->irq
>> && pdata->irq_base
>> && pdata->irq_end > pdata->irq_base) {
>> + status = twl_init_chip_irq(id->name);
>> + if (status < 0)
>> + goto fail;
>
>No need to check since status is always zero.
Right, I'll remove the check.
>> +
>> status = twl_init_irq(client->irq,
>> pdata->irq_base, pdata->irq_end);
>> if (status < 0)
>> goto fail;
>> @@ -795,6 +807,7 @@ fail:
>> static const struct i2c_device_id twl4030_ids[] = {
>> { "twl4030", TWL4030_VAUX2 }, /* "Triton 2" */
>> { "twl5030", 0 }, /* T2 updated */
>> + { "twl5031", TWL5031 }, /* TWL5030 updated */
>> { "tps65950", 0 }, /* catalog version of twl5030 */
>> { "tps65930", TPS_SUBSET }, /* fewer LDOs and DACs;
>> no charger */
>> { "tps65920", TPS_SUBSET }, /* fewer LDOs; no codec
>> or charger */
>> diff --git a/drivers/mfd/twl4030-irq.c b/drivers/mfd/twl4030-irq.c
>> index aca2670..d781788 100644
>> --- a/drivers/mfd/twl4030-irq.c
>> +++ b/drivers/mfd/twl4030-irq.c
>> @@ -61,6 +61,7 @@
>>
>> /* Linux could (eventually) use either IRQ line */
>> static int irq_line;
>> +static int chip_is_twl5031;
>>
>> struct sih {
>> char name[8];
>> @@ -82,6 +83,9 @@ struct sih {
>> /* + 2 bytes padding */
>> };
>>
>> +static const struct sih *sih_modules;
>> +static int nr_sih_modules;
>> +
>> #define SIH_INITIALIZER(modname, nbits) \
>> .module = TWL4030_MODULE_ ## modname, \
>> .control_offset = TWL4030_ ## modname ## _SIH_CTRL, \
>> @@ -107,7 +111,7 @@ struct sih {
>> /* Order in this table matches order in PIH_ISR. That is,
>> * BIT(n) in PIH_ISR is sih_modules[n].
>> */
>> -static const struct sih sih_modules[6] = {
>> +static const struct sih sih_modules_twl4030[6] = {
>> [0] = {
>> .name = "gpio",
>> .module = TWL4030_MODULE_GPIO,
>> @@ -164,6 +168,84 @@ static const struct sih sih_modules[6] = {
>> /* there are no SIH modules #6 or #7 ... */
>> };
>>
>
>Can you add comment saying sih_modules_twl4030 is for both twl4030
>and twl5030 chips?
Sure, I'll do that.
>> +static const struct sih sih_modules_twl5031[8] = {
>> + [0] = {
>> + .name = "gpio",
>> + .module = TWL4030_MODULE_GPIO,
>> + .control_offset = REG_GPIO_SIH_CTRL,
>> + .set_cor = true,
>> + .bits = TWL4030_GPIO_MAX,
>> + .bytes_ixr = 3,
>> + /* Note: *all* of these IRQs default to no-trigger */
>> + .edr_offset = REG_GPIO_EDR1,
>> + .bytes_edr = 5,
>> + .mask = { {
>> + .isr_offset = REG_GPIO_ISR1A,
>> + .imr_offset = REG_GPIO_IMR1A,
>> + }, {
>> + .isr_offset = REG_GPIO_ISR1B,
>> + .imr_offset = REG_GPIO_IMR1B,
>> + }, },
>> + },
>> + [1] = {
>> + .name = "keypad",
>> + .set_cor = true,
>> + SIH_INITIALIZER(KEYPAD_KEYP, 4)
>> + },
>> + [2] = {
>> + .name = "bci",
>> + .module = TWL5031_MODULE_INTERRUPTS,
>> + .control_offset = TWL5031_INTERRUPTS_BCISIHCTRL,
>> + .bits = 7,
>> + .bytes_ixr = 1,
>> + .edr_offset = TWL5031_INTERRUPTS_BCIEDR1,
>> + /* Note: most of these IRQs default to no-trigger */
>> + .bytes_edr = 2,
>> + .mask = { {
>> + .isr_offset = TWL5031_INTERRUPTS_BCIISR1,
>> + .imr_offset = TWL5031_INTERRUPTS_BCIIMR1,
>> + }, {
>> + .isr_offset = TWL5031_INTERRUPTS_BCIISR2,
>> + .imr_offset = TWL5031_INTERRUPTS_BCIIMR2,
>> + }, },
>> + },
>> + [3] = {
>> + .name = "madc",
>> + SIH_INITIALIZER(MADC, 4)
>> + },
>> + [4] = {
>> + /* USB doesn't use the same SIH organization */
>> + .name = "usb",
>> + },
>> + [5] = {
>> + .name = "power",
>> + .set_cor = true,
>> + SIH_INITIALIZER(INT_PWR, 8)
>> + },
>> + [6] = {
>> + /* ECI/DBI/BSI (ACI) does not have SIH */
>> + .name = "aci",
>> + },
>
>If there is no SIH, How do you determine source of interrupt
>in PIH? I see
>you are masking ACI interrupts during init. If you unmask
>these interrupts,
>How do you handle these interrupts?
You're correct, the comment is wrong.
How about if I use similar comment as is in usb block:
/* ACI doesn't use the same SIH organization */
Cheers, Ilkka
>> + [7] = {
>> + /* Accessory */
>> + .name = "acc",
>> + .module = TWL5031_MODULE_ACCESSORY,
>> + .control_offset = TWL5031_ACCSIHCTRL,
>> + .bits = 2,
>> + .bytes_ixr = 1,
>> + .edr_offset = TWL5031_ACCEDR1,
>> + /* Note: most of these IRQs default to no-trigger */
>> + .bytes_edr = 1,
>> + .mask = { {
>> + .isr_offset = TWL5031_ACCISR1,
>> + .imr_offset = TWL5031_ACCIMR1,
>> + }, {
>> + .isr_offset = TWL5031_ACCISR2,
>> + .imr_offset = TWL5031_ACCIMR2,
>> + }, },
>> + },
>> +};
>> +
>> #undef TWL4030_MODULE_KEYPAD_KEYP
>> #undef TWL4030_MODULE_INT_PWR
>> #undef TWL4030_INT_PWR_EDR
>> @@ -301,11 +383,20 @@ static int
>> twl4030_init_sih_modules(unsigned line)
>> /* disable all interrupts on our line */
>> memset(buf, 0xff, sizeof buf);
>> sih = sih_modules;
>> - for (i = 0; i < ARRAY_SIZE(sih_modules); i++, sih++) {
>> + for (i = 0; i < nr_sih_modules; i++, sih++) {
>>
>> /* skip USB -- it's funky */
>> - if (!sih->bytes_ixr)
>> + /* But don't skip TWL5031's ACI */
>> + if (!sih->bytes_ixr) {
>> + if (chip_is_twl5031 &&
>> !strcmp(sih->name, "aci")) {
>> +
>> twl4030_i2c_write(TWL5031_MODULE_ACCESSORY,
>> + buf,
>> TWL5031_ACIIMR_LSB, 1);
>> +
>> twl4030_i2c_write(TWL5031_MODULE_ACCESSORY,
>> + buf,
>> TWL5031_ACIIMR_MSB, 1);
>> + }
>> +
>> continue;
>> + }
>>
>> status = twl4030_i2c_write(sih->module, buf,
>> sih->mask[line].imr_offset,
>> sih->bytes_ixr);
>> @@ -331,13 +422,22 @@ static int
>> twl4030_init_sih_modules(unsigned line)
>> }
>>
>> sih = sih_modules;
>> - for (i = 0; i < ARRAY_SIZE(sih_modules); i++, sih++) {
>> + for (i = 0; i < nr_sih_modules; i++, sih++) {
>> u8 rxbuf[4];
>> int j;
>>
>> /* skip USB */
>> - if (!sih->bytes_ixr)
>> + /* But don't skip TWL5031's ACI */
>> + if (!sih->bytes_ixr) {
>> + if (chip_is_twl5031 &&
>> !strcmp(sih->name, "aci")) {
>> +
>
>Regards,
>Manjunath
>> twl4030_i2c_write(TWL5031_MODULE_ACCESSORY,
>> + buf,
>> TWL5031_ACIIDR_LSB, 1);
>> +
>> twl4030_i2c_write(TWL5031_MODULE_ACCESSORY,
>> + buf,
>> TWL5031_ACIIDR_MSB, 1);
>> + }
>> +
>> continue;
>> + }
>>
>> /* Clear pending interrupt status. Either the read was
>> * enough, or we need to write those bits. Repeat, in
>> @@ -628,7 +728,7 @@ int twl4030_sih_setup(int module)
>>
>> /* only support modules with standard clear-on-read for now */
>> for (sih_mod = 0, sih = sih_modules;
>> - sih_mod < ARRAY_SIZE(sih_modules);
>> + sih_mod < nr_sih_modules;
>> sih_mod++, sih++) {
>> if (sih->module == module && sih->set_cor) {
>> if (!WARN((irq_base + sih->bits) > NR_IRQS,
>> @@ -763,3 +863,17 @@ int twl_exit_irq(void)
>> }
>> return 0;
>> }
>> +
>> +int twl_init_chip_irq(const char *chip)
>> +{
>> + if (!strcmp(chip, "twl5031")) {
>> + chip_is_twl5031 = 1;
>> + sih_modules = sih_modules_twl5031;
>> + nr_sih_modules = ARRAY_SIZE(sih_modules_twl5031);
>> + } else {
>> + sih_modules = sih_modules_twl4030;
>> + nr_sih_modules = ARRAY_SIZE(sih_modules_twl4030);
>> + }
>> +
>> + return 0;
>> +}
>> diff --git a/include/linux/i2c/twl4030.h
>b/include/linux/i2c/twl4030.h
>> index 0dc80ef..838916f 100644
>> --- a/include/linux/i2c/twl4030.h
>> +++ b/include/linux/i2c/twl4030.h
>> @@ -58,13 +58,16 @@
>> #define TWL4030_MODULE_PWMA 0x0E
>> #define TWL4030_MODULE_PWMB 0x0F
>>
>> +#define TWL5031_MODULE_ACCESSORY 0x10
>> +#define TWL5031_MODULE_INTERRUPTS 0x11
>> +
>> /* Slave 3 (i2c address 0x4b) */
>> -#define TWL4030_MODULE_BACKUP 0x10
>> -#define TWL4030_MODULE_INT 0x11
>> -#define TWL4030_MODULE_PM_MASTER 0x12
>> -#define TWL4030_MODULE_PM_RECEIVER 0x13
>> -#define TWL4030_MODULE_RTC 0x14
>> -#define TWL4030_MODULE_SECURED_REG 0x15
>> +#define TWL4030_MODULE_BACKUP 0x12
>> +#define TWL4030_MODULE_INT 0x13
>> +#define TWL4030_MODULE_PM_MASTER 0x14
>> +#define TWL4030_MODULE_PM_RECEIVER 0x15
>> +#define TWL4030_MODULE_RTC 0x16
>> +#define TWL4030_MODULE_SECURED_REG 0x17
>>
>> /*
>> * Read and write single 8-bit registers
>> @@ -218,6 +221,38 @@ int twl4030_i2c_read(u8 mod_no, u8
>> *value, u8 reg, unsigned num_bytes);
>>
>>
>> /*------------------------------------------------------------
>> ----------*/
>>
>> +/*
>> + * Accessory Interrupts
>> + */
>> +#define TWL5031_ACIIMR_LSB 0x05
>> +#define TWL5031_ACIIMR_MSB 0x06
>> +#define TWL5031_ACIIDR_LSB 0x07
>> +#define TWL5031_ACIIDR_MSB 0x08
>> +#define TWL5031_ACCISR1 0x0F
>> +#define TWL5031_ACCIMR1 0x10
>> +#define TWL5031_ACCISR2 0x11
>> +#define TWL5031_ACCIMR2 0x12
>> +#define TWL5031_ACCSIR 0x13
>> +#define TWL5031_ACCEDR1 0x14
>> +#define TWL5031_ACCSIHCTRL 0x15
>> +
>> +/*-----------------------------------------------------------
>> -----------*/
>> +
>> +/*
>> + * Battery Charger Controller
>> + */
>> +
>> +#define TWL5031_INTERRUPTS_BCIISR1 0x0
>> +#define TWL5031_INTERRUPTS_BCIIMR1 0x1
>> +#define TWL5031_INTERRUPTS_BCIISR2 0x2
>> +#define TWL5031_INTERRUPTS_BCIIMR2 0x3
>> +#define TWL5031_INTERRUPTS_BCISIR 0x4
>> +#define TWL5031_INTERRUPTS_BCIEDR1 0x5
>> +#define TWL5031_INTERRUPTS_BCIEDR2 0x6
>> +#define TWL5031_INTERRUPTS_BCISIHCTRL 0x7
>> +
>> +/*-----------------------------------------------------------
>> -----------*/
>> +
>> /* Power bus message definitions */
>>
>> #define DEV_GRP_NULL 0x0
>> --
>> 1.6.0.4
>>
>> --
>> To unsubscribe from this list: send the line "unsubscribe
>> linux-omap" in
>> the body of a message to [email protected]
>> More majordomo info at http://vger.kernel.org/majordomo-info.html
>>
>> -