mfd: Add ADP5520/ADP5501 driver
Base driver for Analog Devices ADP5520/ADP5501 MFD PMICs Subdevs: LCD Backlight : drivers/video/backlight/adp5520_bl.c LEDs : drivers/led/leds-adp5520.c GPIO : drivers/gpio/adp5520-gpio.c (ADP5520 only) Keys : drivers/input/keyboard/adp5520-keys.c (ADP5520 only) Signed-off-by: Michael Hennerich <michael.hennerich@analog.com> Signed-off-by: Bryan Wu <cooloney@kernel.org> Signed-off-by: Mike Frysinger <vapier@gentoo.org> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
This commit is contained in:
Michael Hennerich
committed by
Samuel Ortiz
Samuel Ortiz
parent
7c29a47668
commit
a5736e0b62
@@ -174,6 +174,16 @@ config PMIC_DA903X
|
||||
individual components like LCD backlight, voltage regulators,
|
||||
LEDs and battery-charger under the corresponding menus.
|
||||
|
||||
config PMIC_ADP5520
|
||||
bool "Analog Devices ADP5520/01 MFD PMIC Core Support"
|
||||
depends on I2C=y
|
||||
help
|
||||
Say yes here to add support for Analog Devices AD5520 and ADP5501,
|
||||
Multifunction Power Management IC. This includes
|
||||
the I2C driver and the core APIs _only_, you have to select
|
||||
individual components like LCD backlight, LEDs, GPIOs and Kepad
|
||||
under the corresponding menus.
|
||||
|
||||
config MFD_WM8400
|
||||
tristate "Support Wolfson Microelectronics WM8400"
|
||||
select MFD_CORE
|
||||
|
||||
@@ -54,3 +54,4 @@ obj-$(CONFIG_AB3100_CORE) += ab3100-core.o
|
||||
obj-$(CONFIG_AB3100_OTP) += ab3100-otp.o
|
||||
obj-$(CONFIG_AB4500_CORE) += ab4500-core.o
|
||||
obj-$(CONFIG_MFD_88PM8607) += 88pm8607.o
|
||||
obj-$(CONFIG_PMIC_ADP5520) += adp5520.o
|
||||
378
drivers/mfd/adp5520.c
Normal file
378
drivers/mfd/adp5520.c
Normal file
@@ -0,0 +1,378 @@
|
||||
/*
|
||||
* Base driver for Analog Devices ADP5520/ADP5501 MFD PMICs
|
||||
* LCD Backlight: drivers/video/backlight/adp5520_bl
|
||||
* LEDs : drivers/led/leds-adp5520
|
||||
* GPIO : drivers/gpio/adp5520-gpio (ADP5520 only)
|
||||
* Keys : drivers/input/keyboard/adp5520-keys (ADP5520 only)
|
||||
*
|
||||
* Copyright 2009 Analog Devices Inc.
|
||||
*
|
||||
* Derived from da903x:
|
||||
* Copyright (C) 2008 Compulab, Ltd.
|
||||
* Mike Rapoport <mike@compulab.co.il>
|
||||
*
|
||||
* Copyright (C) 2006-2008 Marvell International Ltd.
|
||||
* Eric Miao <eric.miao@marvell.com>
|
||||
*
|
||||
* Licensed under the GPL-2 or later.
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/i2c.h>
|
||||
|
||||
#include <linux/mfd/adp5520.h>
|
||||
|
||||
struct adp5520_chip {
|
||||
struct i2c_client *client;
|
||||
struct device *dev;
|
||||
struct mutex lock;
|
||||
struct blocking_notifier_head notifier_list;
|
||||
int irq;
|
||||
unsigned long id;
|
||||
};
|
||||
|
||||
static int __adp5520_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 int __adp5520_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;
|
||||
}
|
||||
|
||||
int __adp5520_ack_bits(struct i2c_client *client, int reg, uint8_t bit_mask)
|
||||
{
|
||||
struct adp5520_chip *chip = i2c_get_clientdata(client);
|
||||
uint8_t reg_val;
|
||||
int ret;
|
||||
|
||||
mutex_lock(&chip->lock);
|
||||
|
||||
ret = __adp5520_read(client, reg, ®_val);
|
||||
|
||||
if (!ret) {
|
||||
reg_val |= bit_mask;
|
||||
ret = __adp5520_write(client, reg, reg_val);
|
||||
}
|
||||
|
||||
mutex_unlock(&chip->lock);
|
||||
return ret;
|
||||
}
|
||||
|
||||
int adp5520_write(struct device *dev, int reg, uint8_t val)
|
||||
{
|
||||
return __adp5520_write(to_i2c_client(dev), reg, val);
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(adp5520_write);
|
||||
|
||||
int adp5520_read(struct device *dev, int reg, uint8_t *val)
|
||||
{
|
||||
return __adp5520_read(to_i2c_client(dev), reg, val);
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(adp5520_read);
|
||||
|
||||
int adp5520_set_bits(struct device *dev, int reg, uint8_t bit_mask)
|
||||
{
|
||||
struct adp5520_chip *chip = dev_get_drvdata(dev);
|
||||
uint8_t reg_val;
|
||||
int ret;
|
||||
|
||||
mutex_lock(&chip->lock);
|
||||
|
||||
ret = __adp5520_read(chip->client, reg, ®_val);
|
||||
|
||||
if (!ret && ((reg_val & bit_mask) == 0)) {
|
||||
reg_val |= bit_mask;
|
||||
ret = __adp5520_write(chip->client, reg, reg_val);
|
||||
}
|
||||
|
||||
mutex_unlock(&chip->lock);
|
||||
return ret;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(adp5520_set_bits);
|
||||
|
||||
int adp5520_clr_bits(struct device *dev, int reg, uint8_t bit_mask)
|
||||
{
|
||||
struct adp5520_chip *chip = dev_get_drvdata(dev);
|
||||
uint8_t reg_val;
|
||||
int ret;
|
||||
|
||||
mutex_lock(&chip->lock);
|
||||
|
||||
ret = __adp5520_read(chip->client, reg, ®_val);
|
||||
|
||||
if (!ret && (reg_val & bit_mask)) {
|
||||
reg_val &= ~bit_mask;
|
||||
ret = __adp5520_write(chip->client, reg, reg_val);
|
||||
}
|
||||
|
||||
mutex_unlock(&chip->lock);
|
||||
return ret;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(adp5520_clr_bits);
|
||||
|
||||
int adp5520_register_notifier(struct device *dev, struct notifier_block *nb,
|
||||
unsigned int events)
|
||||
{
|
||||
struct adp5520_chip *chip = dev_get_drvdata(dev);
|
||||
|
||||
if (chip->irq) {
|
||||
adp5520_set_bits(chip->dev, ADP5520_INTERRUPT_ENABLE,
|
||||
events & (ADP5520_KP_IEN | ADP5520_KR_IEN |
|
||||
ADP5520_OVP_IEN | ADP5520_CMPR_IEN));
|
||||
|
||||
return blocking_notifier_chain_register(&chip->notifier_list,
|
||||
nb);
|
||||
}
|
||||
|
||||
return -ENODEV;
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(adp5520_register_notifier);
|
||||
|
||||
int adp5520_unregister_notifier(struct device *dev, struct notifier_block *nb,
|
||||
unsigned int events)
|
||||
{
|
||||
struct adp5520_chip *chip = dev_get_drvdata(dev);
|
||||
|
||||
adp5520_clr_bits(chip->dev, ADP5520_INTERRUPT_ENABLE,
|
||||
events & (ADP5520_KP_IEN | ADP5520_KR_IEN |
|
||||
ADP5520_OVP_IEN | ADP5520_CMPR_IEN));
|
||||
|
||||
return blocking_notifier_chain_unregister(&chip->notifier_list, nb);
|
||||
}
|
||||
EXPORT_SYMBOL_GPL(adp5520_unregister_notifier);
|
||||
|
||||
static irqreturn_t adp5520_irq_thread(int irq, void *data)
|
||||
{
|
||||
struct adp5520_chip *chip = data;
|
||||
unsigned int events;
|
||||
uint8_t reg_val;
|
||||
int ret;
|
||||
|
||||
ret = __adp5520_read(chip->client, ADP5520_MODE_STATUS, ®_val);
|
||||
if (ret)
|
||||
goto out;
|
||||
|
||||
events = reg_val & (ADP5520_OVP_INT | ADP5520_CMPR_INT |
|
||||
ADP5520_GPI_INT | ADP5520_KR_INT | ADP5520_KP_INT);
|
||||
|
||||
blocking_notifier_call_chain(&chip->notifier_list, events, NULL);
|
||||
/* ACK, Sticky bits are W1C */
|
||||
__adp5520_ack_bits(chip->client, ADP5520_MODE_STATUS, events);
|
||||
|
||||
out:
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static int __remove_subdev(struct device *dev, void *unused)
|
||||
{
|
||||
platform_device_unregister(to_platform_device(dev));
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int adp5520_remove_subdevs(struct adp5520_chip *chip)
|
||||
{
|
||||
return device_for_each_child(chip->dev, NULL, __remove_subdev);
|
||||
}
|
||||
|
||||
static int __devinit adp5520_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct adp5520_platform_data *pdata = client->dev.platform_data;
|
||||
struct platform_device *pdev;
|
||||
struct adp5520_chip *chip;
|
||||
int ret;
|
||||
|
||||
if (!i2c_check_functionality(client->adapter,
|
||||
I2C_FUNC_SMBUS_BYTE_DATA)) {
|
||||
dev_err(&client->dev, "SMBUS Word Data not Supported\n");
|
||||
return -EIO;
|
||||
}
|
||||
|
||||
if (pdata == NULL) {
|
||||
dev_err(&client->dev, "missing platform data\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
chip = kzalloc(sizeof(*chip), GFP_KERNEL);
|
||||
if (!chip)
|
||||
return -ENOMEM;
|
||||
|
||||
i2c_set_clientdata(client, chip);
|
||||
chip->client = client;
|
||||
|
||||
chip->dev = &client->dev;
|
||||
chip->irq = client->irq;
|
||||
chip->id = id->driver_data;
|
||||
mutex_init(&chip->lock);
|
||||
|
||||
if (chip->irq) {
|
||||
BLOCKING_INIT_NOTIFIER_HEAD(&chip->notifier_list);
|
||||
|
||||
ret = request_threaded_irq(chip->irq, NULL, adp5520_irq_thread,
|
||||
IRQF_TRIGGER_LOW | IRQF_ONESHOT,
|
||||
"adp5520", chip);
|
||||
if (ret) {
|
||||
dev_err(&client->dev, "failed to request irq %d\n",
|
||||
chip->irq);
|
||||
goto out_free_chip;
|
||||
}
|
||||
}
|
||||
|
||||
ret = adp5520_write(chip->dev, ADP5520_MODE_STATUS, ADP5520_nSTNBY);
|
||||
if (ret) {
|
||||
dev_err(&client->dev, "failed to write\n");
|
||||
goto out_free_irq;
|
||||
}
|
||||
|
||||
if (pdata->keys) {
|
||||
pdev = platform_device_register_data(chip->dev, "adp5520-keys",
|
||||
chip->id, pdata->keys, sizeof(*pdata->keys));
|
||||
if (IS_ERR(pdev)) {
|
||||
ret = PTR_ERR(pdev);
|
||||
goto out_remove_subdevs;
|
||||
}
|
||||
}
|
||||
|
||||
if (pdata->gpio) {
|
||||
pdev = platform_device_register_data(chip->dev, "adp5520-gpio",
|
||||
chip->id, pdata->gpio, sizeof(*pdata->gpio));
|
||||
if (IS_ERR(pdev)) {
|
||||
ret = PTR_ERR(pdev);
|
||||
goto out_remove_subdevs;
|
||||
}
|
||||
}
|
||||
|
||||
if (pdata->leds) {
|
||||
pdev = platform_device_register_data(chip->dev, "adp5520-led",
|
||||
chip->id, pdata->leds, sizeof(*pdata->leds));
|
||||
if (IS_ERR(pdev)) {
|
||||
ret = PTR_ERR(pdev);
|
||||
goto out_remove_subdevs;
|
||||
}
|
||||
}
|
||||
|
||||
if (pdata->backlight) {
|
||||
pdev = platform_device_register_data(chip->dev,
|
||||
"adp5520-backlight",
|
||||
chip->id,
|
||||
pdata->backlight,
|
||||
sizeof(*pdata->backlight));
|
||||
if (IS_ERR(pdev)) {
|
||||
ret = PTR_ERR(pdev);
|
||||
goto out_remove_subdevs;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
out_remove_subdevs:
|
||||
adp5520_remove_subdevs(chip);
|
||||
|
||||
out_free_irq:
|
||||
if (chip->irq)
|
||||
free_irq(chip->irq, chip);
|
||||
|
||||
out_free_chip:
|
||||
i2c_set_clientdata(client, NULL);
|
||||
kfree(chip);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int __devexit adp5520_remove(struct i2c_client *client)
|
||||
{
|
||||
struct adp5520_chip *chip = dev_get_drvdata(&client->dev);
|
||||
|
||||
if (chip->irq)
|
||||
free_irq(chip->irq, chip);
|
||||
|
||||
adp5520_remove_subdevs(chip);
|
||||
adp5520_write(chip->dev, ADP5520_MODE_STATUS, 0);
|
||||
i2c_set_clientdata(client, NULL);
|
||||
kfree(chip);
|
||||
return 0;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_PM
|
||||
static int adp5520_suspend(struct i2c_client *client,
|
||||
pm_message_t state)
|
||||
{
|
||||
struct adp5520_chip *chip = dev_get_drvdata(&client->dev);
|
||||
|
||||
adp5520_clr_bits(chip->dev, ADP5520_MODE_STATUS, ADP5520_nSTNBY);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int adp5520_resume(struct i2c_client *client)
|
||||
{
|
||||
struct adp5520_chip *chip = dev_get_drvdata(&client->dev);
|
||||
|
||||
adp5520_set_bits(chip->dev, ADP5520_MODE_STATUS, ADP5520_nSTNBY);
|
||||
return 0;
|
||||
}
|
||||
#else
|
||||
#define adp5520_suspend NULL
|
||||
#define adp5520_resume NULL
|
||||
#endif
|
||||
|
||||
static const struct i2c_device_id adp5520_id[] = {
|
||||
{ "pmic-adp5520", ID_ADP5520 },
|
||||
{ "pmic-adp5501", ID_ADP5501 },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, adp5520_id);
|
||||
|
||||
static struct i2c_driver adp5520_driver = {
|
||||
.driver = {
|
||||
.name = "adp5520",
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.probe = adp5520_probe,
|
||||
.remove = __devexit_p(adp5520_remove),
|
||||
.suspend = adp5520_suspend,
|
||||
.resume = adp5520_resume,
|
||||
.id_table = adp5520_id,
|
||||
};
|
||||
|
||||
static int __init adp5520_init(void)
|
||||
{
|
||||
return i2c_add_driver(&adp5520_driver);
|
||||
}
|
||||
module_init(adp5520_init);
|
||||
|
||||
static void __exit adp5520_exit(void)
|
||||
{
|
||||
i2c_del_driver(&adp5520_driver);
|
||||
}
|
||||
module_exit(adp5520_exit);
|
||||
|
||||
MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
|
||||
MODULE_DESCRIPTION("ADP5520(01) PMIC-MFD Driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
Reference in New Issue
Block a user