diff options
| author | Jiri Kosina <jkosina@suse.cz> | 2011-09-15 15:08:05 +0200 | 
|---|---|---|
| committer | Jiri Kosina <jkosina@suse.cz> | 2011-09-15 15:08:18 +0200 | 
| commit | e060c38434b2caa78efe7cedaff4191040b65a15 (patch) | |
| tree | 407361230bf6733f63d8e788e4b5e6566ee04818 /drivers/mfd/tps65912-core.c | |
| parent | 10e4ac572eeffe5317019bd7330b6058a400dfc2 (diff) | |
| parent | cc39c6a9bbdebfcf1a7dee64d83bf302bc38d941 (diff) | |
| download | olio-linux-3.10-e060c38434b2caa78efe7cedaff4191040b65a15.tar.xz olio-linux-3.10-e060c38434b2caa78efe7cedaff4191040b65a15.zip  | |
Merge branch 'master' into for-next
Fast-forward merge with Linus to be able to merge patches
based on more recent version of the tree.
Diffstat (limited to 'drivers/mfd/tps65912-core.c')
| -rw-r--r-- | drivers/mfd/tps65912-core.c | 177 | 
1 files changed, 177 insertions, 0 deletions
diff --git a/drivers/mfd/tps65912-core.c b/drivers/mfd/tps65912-core.c new file mode 100644 index 00000000000..955bc00e4b2 --- /dev/null +++ b/drivers/mfd/tps65912-core.c @@ -0,0 +1,177 @@ +/* + * tps65912-core.c  --  TI TPS65912x + * + * Copyright 2011 Texas Instruments Inc. + * + * Author: Margarita Olaya Cabrera <magi@slimlogic.co.uk> + * + *  This program is free software; you can redistribute it and/or modify it + *  under  the terms of the GNU General  Public License as published by the + *  Free Software Foundation;  either version 2 of the License, or (at your + *  option) any later version. + * + *  This driver is based on wm8350 implementation. + */ + +#include <linux/module.h> +#include <linux/moduleparam.h> +#include <linux/init.h> +#include <linux/slab.h> +#include <linux/gpio.h> +#include <linux/mfd/core.h> +#include <linux/mfd/tps65912.h> + +static struct mfd_cell tps65912s[] = { +	{ +		.name = "tps65912-pmic", +	}, +}; + +int tps65912_set_bits(struct tps65912 *tps65912, u8 reg, u8 mask) +{ +	u8 data; +	int err; + +	mutex_lock(&tps65912->io_mutex); + +	err = tps65912->read(tps65912, reg, 1, &data); +	if (err) { +		dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg); +		goto out; +	} + +	data |= mask; +	err = tps65912->write(tps65912, reg, 1, &data); +	if (err) +		dev_err(tps65912->dev, "Write to reg 0x%x failed\n", reg); + +out: +	mutex_unlock(&tps65912->io_mutex); +	return err; +} +EXPORT_SYMBOL_GPL(tps65912_set_bits); + +int tps65912_clear_bits(struct tps65912 *tps65912, u8 reg, u8 mask) +{ +	u8 data; +	int err; + +	mutex_lock(&tps65912->io_mutex); +	err = tps65912->read(tps65912, reg, 1, &data); +	if (err) { +		dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg); +		goto out; +	} + +	data &= ~mask; +	err = tps65912->write(tps65912, reg, 1, &data); +	if (err) +		dev_err(tps65912->dev, "Write to reg 0x%x failed\n", reg); + +out: +	mutex_unlock(&tps65912->io_mutex); +	return err; +} +EXPORT_SYMBOL_GPL(tps65912_clear_bits); + +static inline int tps65912_read(struct tps65912 *tps65912, u8 reg) +{ +	u8 val; +	int err; + +	err = tps65912->read(tps65912, reg, 1, &val); +	if (err < 0) +		return err; + +	return val; +} + +static inline int tps65912_write(struct tps65912 *tps65912, u8 reg, u8 val) +{ +	return tps65912->write(tps65912, reg, 1, &val); +} + +int tps65912_reg_read(struct tps65912 *tps65912, u8 reg) +{ +	int data; + +	mutex_lock(&tps65912->io_mutex); + +	data = tps65912_read(tps65912, reg); +	if (data < 0) +		dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg); + +	mutex_unlock(&tps65912->io_mutex); +	return data; +} +EXPORT_SYMBOL_GPL(tps65912_reg_read); + +int tps65912_reg_write(struct tps65912 *tps65912, u8 reg, u8 val) +{ +	int err; + +	mutex_lock(&tps65912->io_mutex); + +	err = tps65912_write(tps65912, reg, val); +	if (err < 0) +		dev_err(tps65912->dev, "Write for reg 0x%x failed\n", reg); + +	mutex_unlock(&tps65912->io_mutex); +	return err; +} +EXPORT_SYMBOL_GPL(tps65912_reg_write); + +int tps65912_device_init(struct tps65912 *tps65912) +{ +	struct tps65912_board *pmic_plat_data = tps65912->dev->platform_data; +	struct tps65912_platform_data *init_data; +	int ret, dcdc_avs, value; + +	init_data = kzalloc(sizeof(struct tps65912_platform_data), GFP_KERNEL); +	if (init_data == NULL) +		return -ENOMEM; + +	init_data->irq = pmic_plat_data->irq; +	init_data->irq_base = pmic_plat_data->irq; + +	mutex_init(&tps65912->io_mutex); +	dev_set_drvdata(tps65912->dev, tps65912); + +	dcdc_avs = (pmic_plat_data->is_dcdc1_avs << 0 | +			pmic_plat_data->is_dcdc2_avs  << 1 | +				pmic_plat_data->is_dcdc3_avs << 2 | +					pmic_plat_data->is_dcdc4_avs << 3); +	if (dcdc_avs) { +		tps65912->read(tps65912, TPS65912_I2C_SPI_CFG, 1, &value); +		dcdc_avs |= value; +		tps65912->write(tps65912, TPS65912_I2C_SPI_CFG, 1, &dcdc_avs); +	} + +	ret = mfd_add_devices(tps65912->dev, -1, +			      tps65912s, ARRAY_SIZE(tps65912s), +			      NULL, 0); +	if (ret < 0) +		goto err; + +	ret = tps65912_irq_init(tps65912, init_data->irq, init_data); +	if (ret < 0) +		goto err; + +	return ret; + +err: +	kfree(init_data); +	mfd_remove_devices(tps65912->dev); +	kfree(tps65912); +	return ret; +} + +void tps65912_device_exit(struct tps65912 *tps65912) +{ +	mfd_remove_devices(tps65912->dev); +	kfree(tps65912); +} + +MODULE_AUTHOR("Margarita Olaya	<magi@slimlogic.co.uk>"); +MODULE_DESCRIPTION("TPS65912x chip family multi-function driver"); +MODULE_LICENSE("GPL");  |