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