162579266SRabin Vincent /* 262579266SRabin Vincent * Copyright (C) ST-Ericsson SA 2010 362579266SRabin Vincent * 462579266SRabin Vincent * License Terms: GNU General Public License v2 562579266SRabin Vincent * Author: Srinidhi Kasagar <srinidhi.kasagar@stericsson.com> 662579266SRabin Vincent * Author: Rabin Vincent <rabin.vincent@stericsson.com> 762579266SRabin Vincent */ 862579266SRabin Vincent 962579266SRabin Vincent #include <linux/kernel.h> 1062579266SRabin Vincent #include <linux/slab.h> 1162579266SRabin Vincent #include <linux/init.h> 1262579266SRabin Vincent #include <linux/irq.h> 1362579266SRabin Vincent #include <linux/delay.h> 1462579266SRabin Vincent #include <linux/interrupt.h> 1562579266SRabin Vincent #include <linux/module.h> 1662579266SRabin Vincent #include <linux/platform_device.h> 1762579266SRabin Vincent #include <linux/mfd/core.h> 1862579266SRabin Vincent #include <linux/mfd/ab8500.h> 19549931f9SSundar R Iyer #include <linux/regulator/ab8500.h> 2062579266SRabin Vincent 2162579266SRabin Vincent /* 2262579266SRabin Vincent * Interrupt register offsets 2362579266SRabin Vincent * Bank : 0x0E 2462579266SRabin Vincent */ 2562579266SRabin Vincent #define AB8500_IT_SOURCE1_REG 0x0E00 2662579266SRabin Vincent #define AB8500_IT_SOURCE2_REG 0x0E01 2762579266SRabin Vincent #define AB8500_IT_SOURCE3_REG 0x0E02 2862579266SRabin Vincent #define AB8500_IT_SOURCE4_REG 0x0E03 2962579266SRabin Vincent #define AB8500_IT_SOURCE5_REG 0x0E04 3062579266SRabin Vincent #define AB8500_IT_SOURCE6_REG 0x0E05 3162579266SRabin Vincent #define AB8500_IT_SOURCE7_REG 0x0E06 3262579266SRabin Vincent #define AB8500_IT_SOURCE8_REG 0x0E07 3362579266SRabin Vincent #define AB8500_IT_SOURCE19_REG 0x0E12 3462579266SRabin Vincent #define AB8500_IT_SOURCE20_REG 0x0E13 3562579266SRabin Vincent #define AB8500_IT_SOURCE21_REG 0x0E14 3662579266SRabin Vincent #define AB8500_IT_SOURCE22_REG 0x0E15 3762579266SRabin Vincent #define AB8500_IT_SOURCE23_REG 0x0E16 3862579266SRabin Vincent #define AB8500_IT_SOURCE24_REG 0x0E17 3962579266SRabin Vincent 4062579266SRabin Vincent /* 4162579266SRabin Vincent * latch registers 4262579266SRabin Vincent */ 4362579266SRabin Vincent #define AB8500_IT_LATCH1_REG 0x0E20 4462579266SRabin Vincent #define AB8500_IT_LATCH2_REG 0x0E21 4562579266SRabin Vincent #define AB8500_IT_LATCH3_REG 0x0E22 4662579266SRabin Vincent #define AB8500_IT_LATCH4_REG 0x0E23 4762579266SRabin Vincent #define AB8500_IT_LATCH5_REG 0x0E24 4862579266SRabin Vincent #define AB8500_IT_LATCH6_REG 0x0E25 4962579266SRabin Vincent #define AB8500_IT_LATCH7_REG 0x0E26 5062579266SRabin Vincent #define AB8500_IT_LATCH8_REG 0x0E27 5162579266SRabin Vincent #define AB8500_IT_LATCH9_REG 0x0E28 5262579266SRabin Vincent #define AB8500_IT_LATCH10_REG 0x0E29 5362579266SRabin Vincent #define AB8500_IT_LATCH19_REG 0x0E32 5462579266SRabin Vincent #define AB8500_IT_LATCH20_REG 0x0E33 5562579266SRabin Vincent #define AB8500_IT_LATCH21_REG 0x0E34 5662579266SRabin Vincent #define AB8500_IT_LATCH22_REG 0x0E35 5762579266SRabin Vincent #define AB8500_IT_LATCH23_REG 0x0E36 5862579266SRabin Vincent #define AB8500_IT_LATCH24_REG 0x0E37 5962579266SRabin Vincent 6062579266SRabin Vincent /* 6162579266SRabin Vincent * mask registers 6262579266SRabin Vincent */ 6362579266SRabin Vincent 6462579266SRabin Vincent #define AB8500_IT_MASK1_REG 0x0E40 6562579266SRabin Vincent #define AB8500_IT_MASK2_REG 0x0E41 6662579266SRabin Vincent #define AB8500_IT_MASK3_REG 0x0E42 6762579266SRabin Vincent #define AB8500_IT_MASK4_REG 0x0E43 6862579266SRabin Vincent #define AB8500_IT_MASK5_REG 0x0E44 6962579266SRabin Vincent #define AB8500_IT_MASK6_REG 0x0E45 7062579266SRabin Vincent #define AB8500_IT_MASK7_REG 0x0E46 7162579266SRabin Vincent #define AB8500_IT_MASK8_REG 0x0E47 7262579266SRabin Vincent #define AB8500_IT_MASK9_REG 0x0E48 7362579266SRabin Vincent #define AB8500_IT_MASK10_REG 0x0E49 7462579266SRabin Vincent #define AB8500_IT_MASK11_REG 0x0E4A 7562579266SRabin Vincent #define AB8500_IT_MASK12_REG 0x0E4B 7662579266SRabin Vincent #define AB8500_IT_MASK13_REG 0x0E4C 7762579266SRabin Vincent #define AB8500_IT_MASK14_REG 0x0E4D 7862579266SRabin Vincent #define AB8500_IT_MASK15_REG 0x0E4E 7962579266SRabin Vincent #define AB8500_IT_MASK16_REG 0x0E4F 8062579266SRabin Vincent #define AB8500_IT_MASK17_REG 0x0E50 8162579266SRabin Vincent #define AB8500_IT_MASK18_REG 0x0E51 8262579266SRabin Vincent #define AB8500_IT_MASK19_REG 0x0E52 8362579266SRabin Vincent #define AB8500_IT_MASK20_REG 0x0E53 8462579266SRabin Vincent #define AB8500_IT_MASK21_REG 0x0E54 8562579266SRabin Vincent #define AB8500_IT_MASK22_REG 0x0E55 8662579266SRabin Vincent #define AB8500_IT_MASK23_REG 0x0E56 8762579266SRabin Vincent #define AB8500_IT_MASK24_REG 0x0E57 8862579266SRabin Vincent 8962579266SRabin Vincent #define AB8500_REV_REG 0x1080 9062579266SRabin Vincent 9162579266SRabin Vincent /* 9262579266SRabin Vincent * Map interrupt numbers to the LATCH and MASK register offsets, Interrupt 9362579266SRabin Vincent * numbers are indexed into this array with (num / 8). 9462579266SRabin Vincent * 9562579266SRabin Vincent * This is one off from the register names, i.e. AB8500_IT_MASK1_REG is at 9662579266SRabin Vincent * offset 0. 9762579266SRabin Vincent */ 9862579266SRabin Vincent static const int ab8500_irq_regoffset[AB8500_NUM_IRQ_REGS] = { 9962579266SRabin Vincent 0, 1, 2, 3, 4, 6, 7, 8, 9, 18, 19, 20, 21, 10062579266SRabin Vincent }; 10162579266SRabin Vincent 10262579266SRabin Vincent static int __ab8500_write(struct ab8500 *ab8500, u16 addr, u8 data) 10362579266SRabin Vincent { 10462579266SRabin Vincent int ret; 10562579266SRabin Vincent 10662579266SRabin Vincent dev_vdbg(ab8500->dev, "wr: addr %#x <= %#x\n", addr, data); 10762579266SRabin Vincent 10862579266SRabin Vincent ret = ab8500->write(ab8500, addr, data); 10962579266SRabin Vincent if (ret < 0) 11062579266SRabin Vincent dev_err(ab8500->dev, "failed to write reg %#x: %d\n", 11162579266SRabin Vincent addr, ret); 11262579266SRabin Vincent 11362579266SRabin Vincent return ret; 11462579266SRabin Vincent } 11562579266SRabin Vincent 11662579266SRabin Vincent /** 11762579266SRabin Vincent * ab8500_write() - write an AB8500 register 11862579266SRabin Vincent * @ab8500: device to write to 11962579266SRabin Vincent * @addr: address of the register 12062579266SRabin Vincent * @data: value to write 12162579266SRabin Vincent */ 12262579266SRabin Vincent int ab8500_write(struct ab8500 *ab8500, u16 addr, u8 data) 12362579266SRabin Vincent { 12462579266SRabin Vincent int ret; 12562579266SRabin Vincent 12662579266SRabin Vincent mutex_lock(&ab8500->lock); 12762579266SRabin Vincent ret = __ab8500_write(ab8500, addr, data); 12862579266SRabin Vincent mutex_unlock(&ab8500->lock); 12962579266SRabin Vincent 13062579266SRabin Vincent return ret; 13162579266SRabin Vincent } 13262579266SRabin Vincent EXPORT_SYMBOL_GPL(ab8500_write); 13362579266SRabin Vincent 13462579266SRabin Vincent static int __ab8500_read(struct ab8500 *ab8500, u16 addr) 13562579266SRabin Vincent { 13662579266SRabin Vincent int ret; 13762579266SRabin Vincent 13862579266SRabin Vincent ret = ab8500->read(ab8500, addr); 13962579266SRabin Vincent if (ret < 0) 14062579266SRabin Vincent dev_err(ab8500->dev, "failed to read reg %#x: %d\n", 14162579266SRabin Vincent addr, ret); 14262579266SRabin Vincent 14362579266SRabin Vincent dev_vdbg(ab8500->dev, "rd: addr %#x => data %#x\n", addr, ret); 14462579266SRabin Vincent 14562579266SRabin Vincent return ret; 14662579266SRabin Vincent } 14762579266SRabin Vincent 14862579266SRabin Vincent /** 14962579266SRabin Vincent * ab8500_read() - read an AB8500 register 15062579266SRabin Vincent * @ab8500: device to read from 15162579266SRabin Vincent * @addr: address of the register 15262579266SRabin Vincent */ 15362579266SRabin Vincent int ab8500_read(struct ab8500 *ab8500, u16 addr) 15462579266SRabin Vincent { 15562579266SRabin Vincent int ret; 15662579266SRabin Vincent 15762579266SRabin Vincent mutex_lock(&ab8500->lock); 15862579266SRabin Vincent ret = __ab8500_read(ab8500, addr); 15962579266SRabin Vincent mutex_unlock(&ab8500->lock); 16062579266SRabin Vincent 16162579266SRabin Vincent return ret; 16262579266SRabin Vincent } 16362579266SRabin Vincent EXPORT_SYMBOL_GPL(ab8500_read); 16462579266SRabin Vincent 16562579266SRabin Vincent /** 16662579266SRabin Vincent * ab8500_set_bits() - set a bitfield in an AB8500 register 16762579266SRabin Vincent * @ab8500: device to read from 16862579266SRabin Vincent * @addr: address of the register 16962579266SRabin Vincent * @mask: mask of the bitfield to modify 17062579266SRabin Vincent * @data: value to set to the bitfield 17162579266SRabin Vincent */ 17262579266SRabin Vincent int ab8500_set_bits(struct ab8500 *ab8500, u16 addr, u8 mask, u8 data) 17362579266SRabin Vincent { 17462579266SRabin Vincent int ret; 17562579266SRabin Vincent 17662579266SRabin Vincent mutex_lock(&ab8500->lock); 17762579266SRabin Vincent 17862579266SRabin Vincent ret = __ab8500_read(ab8500, addr); 17962579266SRabin Vincent if (ret < 0) 18062579266SRabin Vincent goto out; 18162579266SRabin Vincent 18262579266SRabin Vincent ret &= ~mask; 18362579266SRabin Vincent ret |= data; 18462579266SRabin Vincent 18562579266SRabin Vincent ret = __ab8500_write(ab8500, addr, ret); 18662579266SRabin Vincent 18762579266SRabin Vincent out: 18862579266SRabin Vincent mutex_unlock(&ab8500->lock); 18962579266SRabin Vincent return ret; 19062579266SRabin Vincent } 19162579266SRabin Vincent EXPORT_SYMBOL_GPL(ab8500_set_bits); 19262579266SRabin Vincent 19362579266SRabin Vincent static void ab8500_irq_lock(unsigned int irq) 19462579266SRabin Vincent { 19562579266SRabin Vincent struct ab8500 *ab8500 = get_irq_chip_data(irq); 19662579266SRabin Vincent 19762579266SRabin Vincent mutex_lock(&ab8500->irq_lock); 19862579266SRabin Vincent } 19962579266SRabin Vincent 20062579266SRabin Vincent static void ab8500_irq_sync_unlock(unsigned int irq) 20162579266SRabin Vincent { 20262579266SRabin Vincent struct ab8500 *ab8500 = get_irq_chip_data(irq); 20362579266SRabin Vincent int i; 20462579266SRabin Vincent 20562579266SRabin Vincent for (i = 0; i < AB8500_NUM_IRQ_REGS; i++) { 20662579266SRabin Vincent u8 old = ab8500->oldmask[i]; 20762579266SRabin Vincent u8 new = ab8500->mask[i]; 20862579266SRabin Vincent int reg; 20962579266SRabin Vincent 21062579266SRabin Vincent if (new == old) 21162579266SRabin Vincent continue; 21262579266SRabin Vincent 21362579266SRabin Vincent ab8500->oldmask[i] = new; 21462579266SRabin Vincent 21562579266SRabin Vincent reg = AB8500_IT_MASK1_REG + ab8500_irq_regoffset[i]; 21662579266SRabin Vincent ab8500_write(ab8500, reg, new); 21762579266SRabin Vincent } 21862579266SRabin Vincent 21962579266SRabin Vincent mutex_unlock(&ab8500->irq_lock); 22062579266SRabin Vincent } 22162579266SRabin Vincent 22262579266SRabin Vincent static void ab8500_irq_mask(unsigned int irq) 22362579266SRabin Vincent { 22462579266SRabin Vincent struct ab8500 *ab8500 = get_irq_chip_data(irq); 22562579266SRabin Vincent int offset = irq - ab8500->irq_base; 22662579266SRabin Vincent int index = offset / 8; 22762579266SRabin Vincent int mask = 1 << (offset % 8); 22862579266SRabin Vincent 22962579266SRabin Vincent ab8500->mask[index] |= mask; 23062579266SRabin Vincent } 23162579266SRabin Vincent 23262579266SRabin Vincent static void ab8500_irq_unmask(unsigned int irq) 23362579266SRabin Vincent { 23462579266SRabin Vincent struct ab8500 *ab8500 = get_irq_chip_data(irq); 23562579266SRabin Vincent int offset = irq - ab8500->irq_base; 23662579266SRabin Vincent int index = offset / 8; 23762579266SRabin Vincent int mask = 1 << (offset % 8); 23862579266SRabin Vincent 23962579266SRabin Vincent ab8500->mask[index] &= ~mask; 24062579266SRabin Vincent } 24162579266SRabin Vincent 24262579266SRabin Vincent static struct irq_chip ab8500_irq_chip = { 24362579266SRabin Vincent .name = "ab8500", 24462579266SRabin Vincent .bus_lock = ab8500_irq_lock, 24562579266SRabin Vincent .bus_sync_unlock = ab8500_irq_sync_unlock, 24662579266SRabin Vincent .mask = ab8500_irq_mask, 24762579266SRabin Vincent .unmask = ab8500_irq_unmask, 24862579266SRabin Vincent }; 24962579266SRabin Vincent 25062579266SRabin Vincent static irqreturn_t ab8500_irq(int irq, void *dev) 25162579266SRabin Vincent { 25262579266SRabin Vincent struct ab8500 *ab8500 = dev; 25362579266SRabin Vincent int i; 25462579266SRabin Vincent 25562579266SRabin Vincent dev_vdbg(ab8500->dev, "interrupt\n"); 25662579266SRabin Vincent 25762579266SRabin Vincent for (i = 0; i < AB8500_NUM_IRQ_REGS; i++) { 25862579266SRabin Vincent int regoffset = ab8500_irq_regoffset[i]; 25962579266SRabin Vincent int status; 26062579266SRabin Vincent 26162579266SRabin Vincent status = ab8500_read(ab8500, AB8500_IT_LATCH1_REG + regoffset); 26262579266SRabin Vincent if (status <= 0) 26362579266SRabin Vincent continue; 26462579266SRabin Vincent 26562579266SRabin Vincent do { 26662579266SRabin Vincent int bit = __ffs(status); 26762579266SRabin Vincent int line = i * 8 + bit; 26862579266SRabin Vincent 26962579266SRabin Vincent handle_nested_irq(ab8500->irq_base + line); 27062579266SRabin Vincent status &= ~(1 << bit); 27162579266SRabin Vincent } while (status); 27262579266SRabin Vincent } 27362579266SRabin Vincent 27462579266SRabin Vincent return IRQ_HANDLED; 27562579266SRabin Vincent } 27662579266SRabin Vincent 27762579266SRabin Vincent static int ab8500_irq_init(struct ab8500 *ab8500) 27862579266SRabin Vincent { 27962579266SRabin Vincent int base = ab8500->irq_base; 28062579266SRabin Vincent int irq; 28162579266SRabin Vincent 28262579266SRabin Vincent for (irq = base; irq < base + AB8500_NR_IRQS; irq++) { 28362579266SRabin Vincent set_irq_chip_data(irq, ab8500); 28462579266SRabin Vincent set_irq_chip_and_handler(irq, &ab8500_irq_chip, 28562579266SRabin Vincent handle_simple_irq); 28662579266SRabin Vincent set_irq_nested_thread(irq, 1); 28762579266SRabin Vincent #ifdef CONFIG_ARM 28862579266SRabin Vincent set_irq_flags(irq, IRQF_VALID); 28962579266SRabin Vincent #else 29062579266SRabin Vincent set_irq_noprobe(irq); 29162579266SRabin Vincent #endif 29262579266SRabin Vincent } 29362579266SRabin Vincent 29462579266SRabin Vincent return 0; 29562579266SRabin Vincent } 29662579266SRabin Vincent 29762579266SRabin Vincent static void ab8500_irq_remove(struct ab8500 *ab8500) 29862579266SRabin Vincent { 29962579266SRabin Vincent int base = ab8500->irq_base; 30062579266SRabin Vincent int irq; 30162579266SRabin Vincent 30262579266SRabin Vincent for (irq = base; irq < base + AB8500_NR_IRQS; irq++) { 30362579266SRabin Vincent #ifdef CONFIG_ARM 30462579266SRabin Vincent set_irq_flags(irq, 0); 30562579266SRabin Vincent #endif 30662579266SRabin Vincent set_irq_chip_and_handler(irq, NULL, NULL); 30762579266SRabin Vincent set_irq_chip_data(irq, NULL); 30862579266SRabin Vincent } 30962579266SRabin Vincent } 31062579266SRabin Vincent 31162579266SRabin Vincent static struct resource ab8500_gpadc_resources[] = { 31262579266SRabin Vincent { 31362579266SRabin Vincent .name = "HW_CONV_END", 31462579266SRabin Vincent .start = AB8500_INT_GP_HW_ADC_CONV_END, 31562579266SRabin Vincent .end = AB8500_INT_GP_HW_ADC_CONV_END, 31662579266SRabin Vincent .flags = IORESOURCE_IRQ, 31762579266SRabin Vincent }, 31862579266SRabin Vincent { 31962579266SRabin Vincent .name = "SW_CONV_END", 32062579266SRabin Vincent .start = AB8500_INT_GP_SW_ADC_CONV_END, 32162579266SRabin Vincent .end = AB8500_INT_GP_SW_ADC_CONV_END, 32262579266SRabin Vincent .flags = IORESOURCE_IRQ, 32362579266SRabin Vincent }, 32462579266SRabin Vincent }; 32562579266SRabin Vincent 32662579266SRabin Vincent static struct resource ab8500_rtc_resources[] = { 32762579266SRabin Vincent { 32862579266SRabin Vincent .name = "60S", 32962579266SRabin Vincent .start = AB8500_INT_RTC_60S, 33062579266SRabin Vincent .end = AB8500_INT_RTC_60S, 33162579266SRabin Vincent .flags = IORESOURCE_IRQ, 33262579266SRabin Vincent }, 33362579266SRabin Vincent { 33462579266SRabin Vincent .name = "ALARM", 33562579266SRabin Vincent .start = AB8500_INT_RTC_ALARM, 33662579266SRabin Vincent .end = AB8500_INT_RTC_ALARM, 33762579266SRabin Vincent .flags = IORESOURCE_IRQ, 33862579266SRabin Vincent }, 33962579266SRabin Vincent }; 34062579266SRabin Vincent 341*77686517SSundar R Iyer static struct resource ab8500_poweronkey_db_resources[] = { 342*77686517SSundar R Iyer { 343*77686517SSundar R Iyer .name = "ONKEY_DBF", 344*77686517SSundar R Iyer .start = AB8500_INT_PON_KEY1DB_F, 345*77686517SSundar R Iyer .end = AB8500_INT_PON_KEY1DB_F, 346*77686517SSundar R Iyer .flags = IORESOURCE_IRQ, 347*77686517SSundar R Iyer }, 348*77686517SSundar R Iyer { 349*77686517SSundar R Iyer .name = "ONKEY_DBR", 350*77686517SSundar R Iyer .start = AB8500_INT_PON_KEY1DB_R, 351*77686517SSundar R Iyer .end = AB8500_INT_PON_KEY1DB_R, 352*77686517SSundar R Iyer .flags = IORESOURCE_IRQ, 353*77686517SSundar R Iyer }, 354*77686517SSundar R Iyer }; 355*77686517SSundar R Iyer 35662579266SRabin Vincent static struct mfd_cell ab8500_devs[] = { 35762579266SRabin Vincent { 35862579266SRabin Vincent .name = "ab8500-gpadc", 35962579266SRabin Vincent .num_resources = ARRAY_SIZE(ab8500_gpadc_resources), 36062579266SRabin Vincent .resources = ab8500_gpadc_resources, 36162579266SRabin Vincent }, 36262579266SRabin Vincent { 36362579266SRabin Vincent .name = "ab8500-rtc", 36462579266SRabin Vincent .num_resources = ARRAY_SIZE(ab8500_rtc_resources), 36562579266SRabin Vincent .resources = ab8500_rtc_resources, 36662579266SRabin Vincent }, 36762579266SRabin Vincent { .name = "ab8500-charger", }, 36862579266SRabin Vincent { .name = "ab8500-audio", }, 36962579266SRabin Vincent { .name = "ab8500-usb", }, 37062579266SRabin Vincent { .name = "ab8500-pwm", }, 371549931f9SSundar R Iyer { .name = "ab8500-regulator", }, 372*77686517SSundar R Iyer { 373*77686517SSundar R Iyer .name = "ab8500-poweron-key", 374*77686517SSundar R Iyer .num_resources = ARRAY_SIZE(ab8500_poweronkey_db_resources), 375*77686517SSundar R Iyer .resources = ab8500_poweronkey_db_resources, 376*77686517SSundar R Iyer }, 37762579266SRabin Vincent }; 37862579266SRabin Vincent 37962579266SRabin Vincent int __devinit ab8500_init(struct ab8500 *ab8500) 38062579266SRabin Vincent { 38162579266SRabin Vincent struct ab8500_platform_data *plat = dev_get_platdata(ab8500->dev); 38262579266SRabin Vincent int ret; 38362579266SRabin Vincent int i; 38462579266SRabin Vincent 38562579266SRabin Vincent if (plat) 38662579266SRabin Vincent ab8500->irq_base = plat->irq_base; 38762579266SRabin Vincent 38862579266SRabin Vincent mutex_init(&ab8500->lock); 38962579266SRabin Vincent mutex_init(&ab8500->irq_lock); 39062579266SRabin Vincent 39162579266SRabin Vincent ret = ab8500_read(ab8500, AB8500_REV_REG); 39262579266SRabin Vincent if (ret < 0) 39362579266SRabin Vincent return ret; 39462579266SRabin Vincent 39562579266SRabin Vincent /* 39662579266SRabin Vincent * 0x0 - Early Drop 39762579266SRabin Vincent * 0x10 - Cut 1.0 39862579266SRabin Vincent * 0x11 - Cut 1.1 39962579266SRabin Vincent */ 40062579266SRabin Vincent if (ret == 0x0 || ret == 0x10 || ret == 0x11) { 40162579266SRabin Vincent ab8500->revision = ret; 40262579266SRabin Vincent dev_info(ab8500->dev, "detected chip, revision: %#x\n", ret); 40362579266SRabin Vincent } else { 40462579266SRabin Vincent dev_err(ab8500->dev, "unknown chip, revision: %#x\n", ret); 40562579266SRabin Vincent return -EINVAL; 40662579266SRabin Vincent } 40762579266SRabin Vincent 40862579266SRabin Vincent if (plat && plat->init) 40962579266SRabin Vincent plat->init(ab8500); 41062579266SRabin Vincent 41162579266SRabin Vincent /* Clear and mask all interrupts */ 41262579266SRabin Vincent for (i = 0; i < 10; i++) { 41362579266SRabin Vincent ab8500_read(ab8500, AB8500_IT_LATCH1_REG + i); 41462579266SRabin Vincent ab8500_write(ab8500, AB8500_IT_MASK1_REG + i, 0xff); 41562579266SRabin Vincent } 41662579266SRabin Vincent 41762579266SRabin Vincent for (i = 18; i < 24; i++) { 41862579266SRabin Vincent ab8500_read(ab8500, AB8500_IT_LATCH1_REG + i); 41962579266SRabin Vincent ab8500_write(ab8500, AB8500_IT_MASK1_REG + i, 0xff); 42062579266SRabin Vincent } 42162579266SRabin Vincent 42262579266SRabin Vincent for (i = 0; i < AB8500_NUM_IRQ_REGS; i++) 42362579266SRabin Vincent ab8500->mask[i] = ab8500->oldmask[i] = 0xff; 42462579266SRabin Vincent 42562579266SRabin Vincent if (ab8500->irq_base) { 42662579266SRabin Vincent ret = ab8500_irq_init(ab8500); 42762579266SRabin Vincent if (ret) 42862579266SRabin Vincent return ret; 42962579266SRabin Vincent 43062579266SRabin Vincent ret = request_threaded_irq(ab8500->irq, NULL, ab8500_irq, 43162579266SRabin Vincent IRQF_ONESHOT, "ab8500", ab8500); 43262579266SRabin Vincent if (ret) 43362579266SRabin Vincent goto out_removeirq; 43462579266SRabin Vincent } 43562579266SRabin Vincent 436549931f9SSundar R Iyer ret = mfd_add_devices(ab8500->dev, 0, ab8500_devs, 43762579266SRabin Vincent ARRAY_SIZE(ab8500_devs), NULL, 43862579266SRabin Vincent ab8500->irq_base); 43962579266SRabin Vincent if (ret) 44062579266SRabin Vincent goto out_freeirq; 44162579266SRabin Vincent 44262579266SRabin Vincent return ret; 44362579266SRabin Vincent 44462579266SRabin Vincent out_freeirq: 44562579266SRabin Vincent if (ab8500->irq_base) { 44662579266SRabin Vincent free_irq(ab8500->irq, ab8500); 44762579266SRabin Vincent out_removeirq: 44862579266SRabin Vincent ab8500_irq_remove(ab8500); 44962579266SRabin Vincent } 45062579266SRabin Vincent return ret; 45162579266SRabin Vincent } 45262579266SRabin Vincent 45362579266SRabin Vincent int __devexit ab8500_exit(struct ab8500 *ab8500) 45462579266SRabin Vincent { 45562579266SRabin Vincent mfd_remove_devices(ab8500->dev); 45662579266SRabin Vincent if (ab8500->irq_base) { 45762579266SRabin Vincent free_irq(ab8500->irq, ab8500); 45862579266SRabin Vincent ab8500_irq_remove(ab8500); 45962579266SRabin Vincent } 46062579266SRabin Vincent 46162579266SRabin Vincent return 0; 46262579266SRabin Vincent } 46362579266SRabin Vincent 46462579266SRabin Vincent MODULE_AUTHOR("Srinidhi Kasagar, Rabin Vincent"); 46562579266SRabin Vincent MODULE_DESCRIPTION("AB8500 MFD core"); 46662579266SRabin Vincent MODULE_LICENSE("GPL v2"); 467