Release 4.14 drivers/mfd/adp5520.c

/*
 * 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/slab.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;
	
uint8_t mode;
};



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;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
64
100.00%
1
100.00%
Total
64
100.00%
1
100.00%



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;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
59
100.00%
1
100.00%
Total
59
100.00%
1
100.00%



static 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, &reg_val);

	if (!ret) {
		reg_val |= bit_mask;
		ret = __adp5520_write(client, reg, reg_val);
	}

	mutex_unlock(&chip->lock);
	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
85
98.84%
1
50.00%
Mark Brown
1
1.16%
1
50.00%
Total
86
100.00%
2
100.00%



int adp5520_write(struct device *dev, int reg, uint8_t val)
{
	return __adp5520_write(to_i2c_client(dev), reg, val);
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
29
100.00%
1
100.00%
Total
29
100.00%
1
100.00%


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);
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
30
100.00%
1
100.00%
Total
30
100.00%
1
100.00%


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, &reg_val);

	if (!ret && ((reg_val & bit_mask) != bit_mask)) {
		reg_val |= bit_mask;
		ret = __adp5520_write(chip->client, reg, reg_val);
	}

	mutex_unlock(&chip->lock);
	return ret;
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
97
97.98%
1
50.00%
Axel Lin
2
2.02%
1
50.00%
Total
99
100.00%
2
100.00%


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, &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;
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
96
100.00%
1
100.00%
Total
96
100.00%
1
100.00%


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;
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
73
100.00%
1
100.00%
Total
73
100.00%
1
100.00%


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);
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
61
100.00%
1
100.00%
Total
61
100.00%
1
100.00%


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, &reg_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;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
96
100.00%
1
100.00%
Total
96
100.00%
1
100.00%



static int __remove_subdev(struct device *dev, void *unused)
{
	platform_device_unregister(to_platform_device(dev));
	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
26
100.00%
1
100.00%
Total
26
100.00%
1
100.00%



static int adp5520_remove_subdevs(struct adp5520_chip *chip)
{
	return device_for_each_child(chip->dev, NULL, __remove_subdev);
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
23
100.00%
1
100.00%
Total
23
100.00%
1
100.00%



static int adp5520_probe(struct i2c_client *client,
					const struct i2c_device_id *id)
{
	struct adp5520_platform_data *pdata = dev_get_platdata(&client->dev);
	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 = devm_kzalloc(&client->dev, 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);
			return ret;
		}
	}

	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);

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
491
97.42%
1
33.33%
Lee Jones
9
1.79%
1
33.33%
Jingoo Han
4
0.79%
1
33.33%
Total
504
100.00%
3
100.00%



static int 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);
	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
58
100.00%
1
100.00%
Total
58
100.00%
1
100.00%

#ifdef CONFIG_PM_SLEEP


static int adp5520_suspend(struct device *dev)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct adp5520_chip *chip = dev_get_drvdata(&client->dev);

	adp5520_read(chip->dev, ADP5520_MODE_STATUS, &chip->mode);
	/* All other bits are W1C */
	chip->mode &= ADP5520_BL_EN | ADP5520_DIM_EN | ADP5520_nSTNBY;
	adp5520_write(chip->dev, ADP5520_MODE_STATUS, 0);
	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
35
47.95%
1
33.33%
Lars-Peter Clausen
26
35.62%
1
33.33%
Mark Brown
12
16.44%
1
33.33%
Total
73
100.00%
3
100.00%



static int adp5520_resume(struct device *dev)
{
	struct i2c_client *client = to_i2c_client(dev);
	struct adp5520_chip *chip = dev_get_drvdata(&client->dev);

	adp5520_write(chip->dev, ADP5520_MODE_STATUS, chip->mode);
	return 0;
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
34
68.00%
1
33.33%
Mark Brown
12
24.00%
1
33.33%
Lars-Peter Clausen
4
8.00%
1
33.33%
Total
50
100.00%
3
100.00%

#endif

static SIMPLE_DEV_PM_OPS(adp5520_pm, adp5520_suspend, adp5520_resume);


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",
		.pm	= &adp5520_pm,
        },
	.probe		= adp5520_probe,
	.remove		= adp5520_remove,
	.id_table	= adp5520_id,
};


module_i2c_driver(adp5520_driver);

MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
MODULE_DESCRIPTION("ADP5520(01) PMIC-MFD Driver");
MODULE_LICENSE("GPL");
Overall Contributors
Person
Tokens
Prop
Commits
CommitProp
Michael Hennerich
1528
94.26%
1
9.09%
Mark Brown
39
2.41%
2
18.18%
Lars-Peter Clausen
33
2.04%
1
9.09%
Lee Jones
10
0.62%
2
18.18%
Jingoo Han
4
0.25%
1
9.09%
Tejun Heo
3
0.19%
1
9.09%
Axel Lin
3
0.19%
2
18.18%
Sachin Kamat
1
0.06%
1
9.09%
Total
1621
100.00%
11
100.00%
Directory: drivers/mfd

Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.