diff options
Diffstat (limited to 'ANDROID_3.4.5/drivers/mfd/tps6586x.c')
| -rw-r--r-- | ANDROID_3.4.5/drivers/mfd/tps6586x.c | 596 |
1 files changed, 0 insertions, 596 deletions
diff --git a/ANDROID_3.4.5/drivers/mfd/tps6586x.c b/ANDROID_3.4.5/drivers/mfd/tps6586x.c deleted file mode 100644 index a5ddf31b..00000000 --- a/ANDROID_3.4.5/drivers/mfd/tps6586x.c +++ /dev/null @@ -1,596 +0,0 @@ -/* - * Core driver for TI TPS6586x PMIC family - * - * Copyright (c) 2010 CompuLab Ltd. - * Mike Rapoport <mike@compulab.co.il> - * - * Based on da903x.c. - * Copyright (C) 2008 Compulab, Ltd. - * Mike Rapoport <mike@compulab.co.il> - * Copyright (C) 2006-2008 Marvell International Ltd. - * Eric Miao <eric.miao@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/interrupt.h> -#include <linux/irq.h> -#include <linux/kernel.h> -#include <linux/module.h> -#include <linux/mutex.h> -#include <linux/slab.h> -#include <linux/gpio.h> -#include <linux/i2c.h> - -#include <linux/mfd/core.h> -#include <linux/mfd/tps6586x.h> - -/* GPIO control registers */ -#define TPS6586X_GPIOSET1 0x5d -#define TPS6586X_GPIOSET2 0x5e - -/* interrupt control registers */ -#define TPS6586X_INT_ACK1 0xb5 -#define TPS6586X_INT_ACK2 0xb6 -#define TPS6586X_INT_ACK3 0xb7 -#define TPS6586X_INT_ACK4 0xb8 - -/* interrupt mask registers */ -#define TPS6586X_INT_MASK1 0xb0 -#define TPS6586X_INT_MASK2 0xb1 -#define TPS6586X_INT_MASK3 0xb2 -#define TPS6586X_INT_MASK4 0xb3 -#define TPS6586X_INT_MASK5 0xb4 - -/* device id */ -#define TPS6586X_VERSIONCRC 0xcd - -struct tps6586x_irq_data { - u8 mask_reg; - u8 mask_mask; -}; - -#define TPS6586X_IRQ(_reg, _mask) \ - { \ - .mask_reg = (_reg) - TPS6586X_INT_MASK1, \ - .mask_mask = (_mask), \ - } - -static const struct tps6586x_irq_data tps6586x_irqs[] = { - [TPS6586X_INT_PLDO_0] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 0), - [TPS6586X_INT_PLDO_1] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 1), - [TPS6586X_INT_PLDO_2] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 2), - [TPS6586X_INT_PLDO_3] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 3), - [TPS6586X_INT_PLDO_4] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 4), - [TPS6586X_INT_PLDO_5] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 5), - [TPS6586X_INT_PLDO_6] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 6), - [TPS6586X_INT_PLDO_7] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 7), - [TPS6586X_INT_COMP_DET] = TPS6586X_IRQ(TPS6586X_INT_MASK4, 1 << 0), - [TPS6586X_INT_ADC] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 1), - [TPS6586X_INT_PLDO_8] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 2), - [TPS6586X_INT_PLDO_9] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 3), - [TPS6586X_INT_PSM_0] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 4), - [TPS6586X_INT_PSM_1] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 5), - [TPS6586X_INT_PSM_2] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 6), - [TPS6586X_INT_PSM_3] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 7), - [TPS6586X_INT_RTC_ALM1] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 4), - [TPS6586X_INT_ACUSB_OVP] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 0x03), - [TPS6586X_INT_USB_DET] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 2), - [TPS6586X_INT_AC_DET] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 3), - [TPS6586X_INT_BAT_DET] = TPS6586X_IRQ(TPS6586X_INT_MASK3, 1 << 0), - [TPS6586X_INT_CHG_STAT] = TPS6586X_IRQ(TPS6586X_INT_MASK4, 0xfc), - [TPS6586X_INT_CHG_TEMP] = TPS6586X_IRQ(TPS6586X_INT_MASK3, 0x06), - [TPS6586X_INT_PP] = TPS6586X_IRQ(TPS6586X_INT_MASK3, 0xf0), - [TPS6586X_INT_RESUME] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 5), - [TPS6586X_INT_LOW_SYS] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 6), - [TPS6586X_INT_RTC_ALM2] = TPS6586X_IRQ(TPS6586X_INT_MASK4, 1 << 1), -}; - -struct tps6586x { - struct mutex lock; - struct device *dev; - struct i2c_client *client; - - struct gpio_chip gpio; - struct irq_chip irq_chip; - struct mutex irq_lock; - int irq_base; - u32 irq_en; - u8 mask_cache[5]; - u8 mask_reg[5]; -}; - -static inline int __tps6586x_read(struct i2c_client *client, - int reg, uint8_t *val) -{ - int ret; - - ret = i2c_smbus_read_byte_data(client, reg); - if (ret < 0) { - dev_err(&client->dev, "failed reading at 0x%02x\n", reg); - return ret; - } - - *val = (uint8_t)ret; - - return 0; -} - -static inline int __tps6586x_reads(struct i2c_client *client, int reg, - int len, uint8_t *val) -{ - int ret; - - ret = i2c_smbus_read_i2c_block_data(client, reg, len, val); - if (ret < 0) { - dev_err(&client->dev, "failed reading from 0x%02x\n", reg); - return ret; - } - - return 0; -} - -static inline int __tps6586x_write(struct i2c_client *client, - int reg, uint8_t val) -{ - int ret; - - ret = i2c_smbus_write_byte_data(client, reg, val); - if (ret < 0) { - dev_err(&client->dev, "failed writing 0x%02x to 0x%02x\n", - val, reg); - return ret; - } - - return 0; -} - -static inline int __tps6586x_writes(struct i2c_client *client, int reg, - int len, uint8_t *val) -{ - int ret, i; - - for (i = 0; i < len; i++) { - ret = __tps6586x_write(client, reg + i, *(val + i)); - if (ret < 0) - return ret; - } - - return 0; -} - -int tps6586x_write(struct device *dev, int reg, uint8_t val) -{ - return __tps6586x_write(to_i2c_client(dev), reg, val); -} -EXPORT_SYMBOL_GPL(tps6586x_write); - -int tps6586x_writes(struct device *dev, int reg, int len, uint8_t *val) -{ - return __tps6586x_writes(to_i2c_client(dev), reg, len, val); -} -EXPORT_SYMBOL_GPL(tps6586x_writes); - -int tps6586x_read(struct device *dev, int reg, uint8_t *val) -{ - return __tps6586x_read(to_i2c_client(dev), reg, val); -} -EXPORT_SYMBOL_GPL(tps6586x_read); - -int tps6586x_reads(struct device *dev, int reg, int len, uint8_t *val) -{ - return __tps6586x_reads(to_i2c_client(dev), reg, len, val); -} -EXPORT_SYMBOL_GPL(tps6586x_reads); - -int tps6586x_set_bits(struct device *dev, int reg, uint8_t bit_mask) -{ - struct tps6586x *tps6586x = dev_get_drvdata(dev); - uint8_t reg_val; - int ret = 0; - - mutex_lock(&tps6586x->lock); - - ret = __tps6586x_read(to_i2c_client(dev), reg, ®_val); - if (ret) - goto out; - - if ((reg_val & bit_mask) != bit_mask) { - reg_val |= bit_mask; - ret = __tps6586x_write(to_i2c_client(dev), reg, reg_val); - } -out: - mutex_unlock(&tps6586x->lock); - return ret; -} -EXPORT_SYMBOL_GPL(tps6586x_set_bits); - -int tps6586x_clr_bits(struct device *dev, int reg, uint8_t bit_mask) -{ - struct tps6586x *tps6586x = dev_get_drvdata(dev); - uint8_t reg_val; - int ret = 0; - - mutex_lock(&tps6586x->lock); - - ret = __tps6586x_read(to_i2c_client(dev), reg, ®_val); - if (ret) - goto out; - - if (reg_val & bit_mask) { - reg_val &= ~bit_mask; - ret = __tps6586x_write(to_i2c_client(dev), reg, reg_val); - } -out: - mutex_unlock(&tps6586x->lock); - return ret; -} -EXPORT_SYMBOL_GPL(tps6586x_clr_bits); - -int tps6586x_update(struct device *dev, int reg, uint8_t val, uint8_t mask) -{ - struct tps6586x *tps6586x = dev_get_drvdata(dev); - uint8_t reg_val; - int ret = 0; - - mutex_lock(&tps6586x->lock); - - ret = __tps6586x_read(tps6586x->client, reg, ®_val); - if (ret) - goto out; - - if ((reg_val & mask) != val) { - reg_val = (reg_val & ~mask) | val; - ret = __tps6586x_write(tps6586x->client, reg, reg_val); - } -out: - mutex_unlock(&tps6586x->lock); - return ret; -} -EXPORT_SYMBOL_GPL(tps6586x_update); - -static int tps6586x_gpio_get(struct gpio_chip *gc, unsigned offset) -{ - struct tps6586x *tps6586x = container_of(gc, struct tps6586x, gpio); - uint8_t val; - int ret; - - ret = __tps6586x_read(tps6586x->client, TPS6586X_GPIOSET2, &val); - if (ret) - return ret; - - return !!(val & (1 << offset)); -} - - -static void tps6586x_gpio_set(struct gpio_chip *chip, unsigned offset, - int value) -{ - struct tps6586x *tps6586x = container_of(chip, struct tps6586x, gpio); - - tps6586x_update(tps6586x->dev, TPS6586X_GPIOSET2, - value << offset, 1 << offset); -} - -static int tps6586x_gpio_output(struct gpio_chip *gc, unsigned offset, - int value) -{ - struct tps6586x *tps6586x = container_of(gc, struct tps6586x, gpio); - uint8_t val, mask; - - tps6586x_gpio_set(gc, offset, value); - - val = 0x1 << (offset * 2); - mask = 0x3 << (offset * 2); - - return tps6586x_update(tps6586x->dev, TPS6586X_GPIOSET1, val, mask); -} - -static int tps6586x_gpio_init(struct tps6586x *tps6586x, int gpio_base) -{ - if (!gpio_base) - return 0; - - tps6586x->gpio.owner = THIS_MODULE; - tps6586x->gpio.label = tps6586x->client->name; - tps6586x->gpio.dev = tps6586x->dev; - tps6586x->gpio.base = gpio_base; - tps6586x->gpio.ngpio = 4; - tps6586x->gpio.can_sleep = 1; - - /* FIXME: add handling of GPIOs as dedicated inputs */ - tps6586x->gpio.direction_output = tps6586x_gpio_output; - tps6586x->gpio.set = tps6586x_gpio_set; - tps6586x->gpio.get = tps6586x_gpio_get; - - return gpiochip_add(&tps6586x->gpio); -} - -static int __remove_subdev(struct device *dev, void *unused) -{ - platform_device_unregister(to_platform_device(dev)); - return 0; -} - -static int tps6586x_remove_subdevs(struct tps6586x *tps6586x) -{ - return device_for_each_child(tps6586x->dev, NULL, __remove_subdev); -} - -static void tps6586x_irq_lock(struct irq_data *data) -{ - struct tps6586x *tps6586x = irq_data_get_irq_chip_data(data); - - mutex_lock(&tps6586x->irq_lock); -} - -static void tps6586x_irq_enable(struct irq_data *irq_data) -{ - struct tps6586x *tps6586x = irq_data_get_irq_chip_data(irq_data); - unsigned int __irq = irq_data->irq - tps6586x->irq_base; - const struct tps6586x_irq_data *data = &tps6586x_irqs[__irq]; - - tps6586x->mask_reg[data->mask_reg] &= ~data->mask_mask; - tps6586x->irq_en |= (1 << __irq); -} - -static void tps6586x_irq_disable(struct irq_data *irq_data) -{ - struct tps6586x *tps6586x = irq_data_get_irq_chip_data(irq_data); - - unsigned int __irq = irq_data->irq - tps6586x->irq_base; - const struct tps6586x_irq_data *data = &tps6586x_irqs[__irq]; - - tps6586x->mask_reg[data->mask_reg] |= data->mask_mask; - tps6586x->irq_en &= ~(1 << __irq); -} - -static void tps6586x_irq_sync_unlock(struct irq_data *data) -{ - struct tps6586x *tps6586x = irq_data_get_irq_chip_data(data); - int i; - - for (i = 0; i < ARRAY_SIZE(tps6586x->mask_reg); i++) { - if (tps6586x->mask_reg[i] != tps6586x->mask_cache[i]) { - if (!WARN_ON(tps6586x_write(tps6586x->dev, - TPS6586X_INT_MASK1 + i, - tps6586x->mask_reg[i]))) - tps6586x->mask_cache[i] = tps6586x->mask_reg[i]; - } - } - - mutex_unlock(&tps6586x->irq_lock); -} - -static irqreturn_t tps6586x_irq(int irq, void *data) -{ - struct tps6586x *tps6586x = data; - u32 acks; - int ret = 0; - - ret = tps6586x_reads(tps6586x->dev, TPS6586X_INT_ACK1, - sizeof(acks), (uint8_t *)&acks); - - if (ret < 0) { - dev_err(tps6586x->dev, "failed to read interrupt status\n"); - return IRQ_NONE; - } - - acks = le32_to_cpu(acks); - - while (acks) { - int i = __ffs(acks); - - if (tps6586x->irq_en & (1 << i)) - handle_nested_irq(tps6586x->irq_base + i); - - acks &= ~(1 << i); - } - - return IRQ_HANDLED; -} - -static int __devinit tps6586x_irq_init(struct tps6586x *tps6586x, int irq, - int irq_base) -{ - int i, ret; - u8 tmp[4]; - - if (!irq_base) { - dev_warn(tps6586x->dev, "No interrupt support on IRQ base\n"); - return -EINVAL; - } - - mutex_init(&tps6586x->irq_lock); - for (i = 0; i < 5; i++) { - tps6586x->mask_cache[i] = 0xff; - tps6586x->mask_reg[i] = 0xff; - tps6586x_write(tps6586x->dev, TPS6586X_INT_MASK1 + i, 0xff); - } - - tps6586x_reads(tps6586x->dev, TPS6586X_INT_ACK1, sizeof(tmp), tmp); - - tps6586x->irq_base = irq_base; - - tps6586x->irq_chip.name = "tps6586x"; - tps6586x->irq_chip.irq_enable = tps6586x_irq_enable; - tps6586x->irq_chip.irq_disable = tps6586x_irq_disable; - tps6586x->irq_chip.irq_bus_lock = tps6586x_irq_lock; - tps6586x->irq_chip.irq_bus_sync_unlock = tps6586x_irq_sync_unlock; - - for (i = 0; i < ARRAY_SIZE(tps6586x_irqs); i++) { - int __irq = i + tps6586x->irq_base; - irq_set_chip_data(__irq, tps6586x); - irq_set_chip_and_handler(__irq, &tps6586x->irq_chip, - handle_simple_irq); - irq_set_nested_thread(__irq, 1); -#ifdef CONFIG_ARM - set_irq_flags(__irq, IRQF_VALID); -#endif - } - - ret = request_threaded_irq(irq, NULL, tps6586x_irq, IRQF_ONESHOT, - "tps6586x", tps6586x); - - if (!ret) { - device_init_wakeup(tps6586x->dev, 1); - enable_irq_wake(irq); - } - - return ret; -} - -static int __devinit tps6586x_add_subdevs(struct tps6586x *tps6586x, - struct tps6586x_platform_data *pdata) -{ - struct tps6586x_subdev_info *subdev; - struct platform_device *pdev; - int i, ret = 0; - - for (i = 0; i < pdata->num_subdevs; i++) { - subdev = &pdata->subdevs[i]; - - pdev = platform_device_alloc(subdev->name, subdev->id); - if (!pdev) { - ret = -ENOMEM; - goto failed; - } - - pdev->dev.parent = tps6586x->dev; - pdev->dev.platform_data = subdev->platform_data; - - ret = platform_device_add(pdev); - if (ret) { - platform_device_put(pdev); - goto failed; - } - } - return 0; - -failed: - tps6586x_remove_subdevs(tps6586x); - return ret; -} - -static int __devinit tps6586x_i2c_probe(struct i2c_client *client, - const struct i2c_device_id *id) -{ - struct tps6586x_platform_data *pdata = client->dev.platform_data; - struct tps6586x *tps6586x; - int ret; - - if (!pdata) { - dev_err(&client->dev, "tps6586x requires platform data\n"); - return -ENOTSUPP; - } - - ret = i2c_smbus_read_byte_data(client, TPS6586X_VERSIONCRC); - if (ret < 0) { - dev_err(&client->dev, "Chip ID read failed: %d\n", ret); - return -EIO; - } - - dev_info(&client->dev, "VERSIONCRC is %02x\n", ret); - - tps6586x = kzalloc(sizeof(struct tps6586x), GFP_KERNEL); - if (tps6586x == NULL) - return -ENOMEM; - - tps6586x->client = client; - tps6586x->dev = &client->dev; - i2c_set_clientdata(client, tps6586x); - - mutex_init(&tps6586x->lock); - - if (client->irq) { - ret = tps6586x_irq_init(tps6586x, client->irq, - pdata->irq_base); - if (ret) { - dev_err(&client->dev, "IRQ init failed: %d\n", ret); - goto err_irq_init; - } - } - - ret = tps6586x_gpio_init(tps6586x, pdata->gpio_base); - if (ret) { - dev_err(&client->dev, "GPIO registration failed: %d\n", ret); - goto err_gpio_init; - } - - ret = tps6586x_add_subdevs(tps6586x, pdata); - if (ret) { - dev_err(&client->dev, "add devices failed: %d\n", ret); - goto err_add_devs; - } - - return 0; - -err_add_devs: - if (pdata->gpio_base) { - ret = gpiochip_remove(&tps6586x->gpio); - if (ret) - dev_err(&client->dev, "Can't remove gpio chip: %d\n", - ret); - } -err_gpio_init: - if (client->irq) - free_irq(client->irq, tps6586x); -err_irq_init: - kfree(tps6586x); - return ret; -} - -static int __devexit tps6586x_i2c_remove(struct i2c_client *client) -{ - struct tps6586x *tps6586x = i2c_get_clientdata(client); - struct tps6586x_platform_data *pdata = client->dev.platform_data; - int ret; - - if (client->irq) - free_irq(client->irq, tps6586x); - - if (pdata->gpio_base) { - ret = gpiochip_remove(&tps6586x->gpio); - if (ret) - dev_err(&client->dev, "Can't remove gpio chip: %d\n", - ret); - } - - tps6586x_remove_subdevs(tps6586x); - kfree(tps6586x); - return 0; -} - -static const struct i2c_device_id tps6586x_id_table[] = { - { "tps6586x", 0 }, - { }, -}; -MODULE_DEVICE_TABLE(i2c, tps6586x_id_table); - -static struct i2c_driver tps6586x_driver = { - .driver = { - .name = "tps6586x", - .owner = THIS_MODULE, - }, - .probe = tps6586x_i2c_probe, - .remove = __devexit_p(tps6586x_i2c_remove), - .id_table = tps6586x_id_table, -}; - -static int __init tps6586x_init(void) -{ - return i2c_add_driver(&tps6586x_driver); -} -subsys_initcall(tps6586x_init); - -static void __exit tps6586x_exit(void) -{ - i2c_del_driver(&tps6586x_driver); -} -module_exit(tps6586x_exit); - -MODULE_DESCRIPTION("TPS6586X core driver"); -MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>"); -MODULE_LICENSE("GPL"); |