| /* |
| * 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; |
| |
| ret = i2c_smbus_write_i2c_block_data(client, reg, len, val); |
| if (ret < 0) { |
| dev_err(&client->dev, "failed writings to 0x%02x\n", reg); |
| 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) == 0) { |
| 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_write(tps6586x->client, TPS6586X_GPIOSET2, |
| value << 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 void tps6586x_gpio_init(struct tps6586x *tps6586x, int gpio_base) |
| { |
| int ret; |
| |
| if (!gpio_base) |
| return; |
| |
| 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; |
| |
| ret = gpiochip_add(&tps6586x->gpio); |
| if (ret) |
| dev_warn(tps6586x->dev, "GPIO registration failed: %d\n", ret); |
| } |
| |
| 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; |
| set_irq_chip_data(__irq, tps6586x); |
| set_irq_chip_and_handler(__irq, &tps6586x->irq_chip, |
| handle_simple_irq); |
| set_irq_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_add_subdevs(tps6586x, pdata); |
| if (ret) { |
| dev_err(&client->dev, "add devices failed: %d\n", ret); |
| goto err_add_devs; |
| } |
| |
| tps6586x_gpio_init(tps6586x, pdata->gpio_base); |
| |
| return 0; |
| |
| err_add_devs: |
| 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"); |
| |