Re: [PATCH v4 2/3] iio/adc: add support for axp288 adc

[Hartmut Knaack]

Hartmut Knaack schrieb, Am 18.09.2014 00:20:
> Jacob Pan schrieb, Am 17.09.2014 02:11:
>> Platform driver for X-Powers AXP288 ADC, which is a sub-device of the
>> customized AXP288 PMIC for Intel Baytrail-CR platforms. GPADC device
>> enumerates as one of the MFD cell devices. It uses IIO infrastructure
>> to communicate with userspace and consumer drivers.
>>
>> Usages of ADC channels include battery charging and thermal sensors.
>>
> You are progressing, but still a few issues left. One thing is indentation in some places (I feel like being pretty annoying about this), others are commented in line.
>> Based on initial work by:
>> Ramakrishna Pallala <ramakrishna.pallala@xxxxxxxxx>
>>
>> Signed-off-by: Jacob Pan <jacob.jun.pan@xxxxxxxxxxxxxxx>
>> ---
>>  drivers/iio/adc/Kconfig      |   8 ++
>>  drivers/iio/adc/Makefile     |   1 +
>>  drivers/iio/adc/axp288_adc.c | 254 +++++++++++++++++++++++++++++++++++++++++++
>>  3 files changed, 263 insertions(+)
>>  create mode 100644 drivers/iio/adc/axp288_adc.c
>>
>> diff --git a/drivers/iio/adc/Kconfig b/drivers/iio/adc/Kconfig
>> index 11b048a..db2681b 100644
>> --- a/drivers/iio/adc/Kconfig
>> +++ b/drivers/iio/adc/Kconfig
>> @@ -127,6 +127,14 @@ config AT91_ADC
>>  	help
>>  	  Say yes here to build support for Atmel AT91 ADC.
>>  
>> +config AXP288_ADC
>> +	tristate "X-Powers AXP288 ADC driver"
>> +	depends on MFD_AXP20X
>> +	help
>> +	  Say yes here to have support for X-Powers power management IC (PMIC) ADC
>> +	  device. Depending on platform configuration, this general purpose ADC can
>> +	  be used for sampling sensors such as thermal resistors.
>> +
>>  config EXYNOS_ADC
>>  	tristate "Exynos ADC driver support"
>>  	depends on ARCH_EXYNOS || (OF && COMPILE_TEST)
>> diff --git a/drivers/iio/adc/Makefile b/drivers/iio/adc/Makefile
>> index ad81b51..19640f9 100644
>> --- a/drivers/iio/adc/Makefile
>> +++ b/drivers/iio/adc/Makefile
>> @@ -14,6 +14,7 @@ obj-$(CONFIG_AD7793) += ad7793.o
>>  obj-$(CONFIG_AD7887) += ad7887.o
>>  obj-$(CONFIG_AD799X) += ad799x.o
>>  obj-$(CONFIG_AT91_ADC) += at91_adc.o
>> +obj-$(CONFIG_AXP288_ADC) += axp288_adc.o
>>  obj-$(CONFIG_EXYNOS_ADC) += exynos_adc.o
>>  obj-$(CONFIG_LP8788_ADC) += lp8788_adc.o
>>  obj-$(CONFIG_MAX1027) += max1027.o
>> diff --git a/drivers/iio/adc/axp288_adc.c b/drivers/iio/adc/axp288_adc.c
>> new file mode 100644
>> index 0000000..333c624
>> --- /dev/null
>> +++ b/drivers/iio/adc/axp288_adc.c
>> @@ -0,0 +1,254 @@
>> +/*
>> + * axp288_adc.c - X-Powers AXP288 PMIC ADC Driver
>> + *
>> + * Copyright (C) 2014 Intel Corporation
>> + *
>> + * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
>> + *
>> + * 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; version 2 of the License.
>> + *
>> + * This program is distributed in the hope that it will be useful, but
>> + * WITHOUT ANY WARRANTY; without even the implied warranty of
>> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.	See the GNU
>> + * General Public License for more details.
>> + *
>> + */
>> +
>> +#include <linux/module.h>
>> +#include <linux/kernel.h>
>> +#include <linux/device.h>
>> +#include <linux/regmap.h>
>> +#include <linux/mfd/axp20x.h>
>> +#include <linux/platform_device.h>
>> +
>> +#include <linux/iio/iio.h>
>> +#include <linux/iio/machine.h>
>> +#include <linux/iio/driver.h>
>> +
>> +#define AXP288_ADC_EN_MASK		0xF1
>> +#define AXP288_ADC_TS_PIN_GPADC		0xF2
>> +#define AXP288_ADC_TS_PIN_ON		0xF3
>> +
>> +enum axp288_adc_id {
>> +	AXP288_ADC_TS,
>> +	AXP288_ADC_PMIC,
>> +	AXP288_ADC_GP,
>> +	AXP288_ADC_BATT_CHRG_I,
>> +	AXP288_ADC_BATT_DISCHRG_I,
>> +	AXP288_ADC_BATT_V,
>> +	AXP288_ADC_NR_CHAN,
>> +};
>> +
>> +struct axp288_adc_info {
>> +	int irq;
>> +	struct device *dev;
>> +	struct regmap *regmap;
>> +};
>> +
>> +static const struct iio_chan_spec const axp288_adc_channels[] = {
>> +	{
>> +		.indexed = 1,
>> +		.type = IIO_TEMP,
>> +		.channel = 0,
>> +		.address = AXP288_TS_ADC_H,
>> +		.datasheet_name = "CH0",
>> +	}, {
>> +		.indexed = 1,
>> +		.type = IIO_TEMP,
>> +		.channel = 1,
>> +		.address = AXP288_PMIC_ADC_H,
>> +		.datasheet_name = "CH1",
>> +	}, {
>> +		.indexed = 1,
>> +		.type = IIO_TEMP,
>> +		.channel = 2,
>> +		.address = AXP288_GP_ADC_H,
>> +		.datasheet_name = "CH2",
>> +	}, {
>> +		.indexed = 1,
>> +		.type = IIO_CURRENT,
>> +		.channel = 3,
>> +		.address = AXP20X_BATT_CHRG_I_H,
>> +		.datasheet_name = "CH3",
>> +		.info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),
>> +	}, {
>> +		.indexed = 1,
>> +		.type = IIO_CURRENT,
>> +		.channel = 4,
>> +		.address = AXP20X_BATT_DISCHRG_I_H,
>> +		.datasheet_name = "CH4",
>> +		.info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),
>> +	}, {
>> +		.indexed = 1,
>> +		.type = IIO_VOLTAGE,
>> +		.channel = 5,
>> +		.address = AXP20X_BATT_V_H,
>> +		.datasheet_name = "CH5",
>> +		.info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),
>> +	},
>> +};
>> +
>> +#define AXP288_ADC_MAP(_adc_channel_label, _consumer_dev_name,	\
>> +		_consumer_channel)				\
>> +	{							\
>> +		.adc_channel_label = _adc_channel_label,	\
>> +		.consumer_dev_name = _consumer_dev_name,	\
>> +		.consumer_channel = _consumer_channel,		\
>> +	}
>> +
>> +/* for consumer drivers */
>> +static struct iio_map axp288_adc_default_maps[] = {
>> +	AXP288_ADC_MAP("TS_PIN", "axp288-batt", "axp288-batt-temp"),
>> +	AXP288_ADC_MAP("PMIC_TEMP", "axp288-pmic", "axp288-pmic-temp"),
>> +	AXP288_ADC_MAP("GPADC", "axp288-gpadc", "axp288-system-temp"),
>> +	AXP288_ADC_MAP("BATT_CHG_I", "axp288-chrg", "axp288-chrg-curr"),
>> +	AXP288_ADC_MAP("BATT_DISCHRG_I", "axp288-chrg", "axp288-chrg-d-curr"),
>> +	AXP288_ADC_MAP("BATT_V", "axp288-batt", "axp288-batt-volt"),
>> +	{},
>> +};
>> +
>> +static int axp288_adc_read_raw(struct iio_dev *indio_dev,
>> +			struct iio_chan_spec const *chan,
>> +			int *val, int *val2, long mask)
>> +{
>> +	int ret;
>> +	struct axp288_adc_info *info = iio_priv(indio_dev);
>> +	u8 buf[2];
> You could use __be16 instead. Then you just need to use be16_to_cpu(), shift 4 bits to the right and mask the result with 0xFF.
On second thought, there is not even a need for masking (was not clear to me before, that the device is 12 bit - my bad).
>> +
>> +	mutex_lock(&indio_dev->mlock);
>> +	switch (mask) {
>> +	case IIO_CHAN_INFO_RAW:
>> +		/* special case for GPADC sample */
>> +		if (chan->address == AXP288_GP_ADC_H) {
>> +			ret = regmap_write(info->regmap, AXP288_ADC_TS_PIN_CTRL,
>> +					AXP288_ADC_TS_PIN_GPADC);
>> +			if (ret) {
>> +				dev_err(&indio_dev->dev, "GPADC mode\n");
>> +				mutex_unlock(&indio_dev->mlock);
>> +				return ret;
> You may even just goto the mutex_unlock at the end of the function. Would safe a few bytes here in the source - up to you. More interesting is, if the error message is required, as you don't have one below, when switching to TS_PIN_ON.
>> +			}
>> +		}
>> +	case IIO_CHAN_INFO_PROCESSED:
>> +		ret = regmap_bulk_read(info->regmap, chan->address, buf, 2);
>> +		if (ret) {
>> +			dev_err(&indio_dev->dev, "sample raw data failed\n");
>> +			break;
>> +		}
>> +		*val = (buf[0] << 4) + ((buf[1] >> 4) & 0x0F);
>> +		ret = IIO_VAL_INT;
>> +		break;
>> +	default:
>> +		ret = -EINVAL;
>> +	}
>> +
>> +	if (mask == IIO_CHAN_INFO_RAW && chan->address == AXP288_GP_ADC_H)
>> +		ret = regmap_write(info->regmap, AXP288_ADC_TS_PIN_CTRL,
>> +			AXP288_ADC_TS_PIN_ON);
>> +
>> +	mutex_unlock(&indio_dev->mlock);
>> +
>> +	return ret;
>> +}
>> +
>> +static int axp288_adc_enable(struct regmap *regmap, bool enable)
>> +{
>> +	unsigned int pin_on, adc_en;
>> +
>> +	if (enable) {
>> +		pin_on = AXP288_ADC_TS_PIN_ON;
>> +		adc_en = AXP288_ADC_EN_MASK;
>> +	} else {
>> +		pin_on = ~AXP288_ADC_TS_PIN_ON;
>> +		adc_en = ~AXP288_ADC_EN_MASK;
>> +	}
>> +	if (regmap_write(regmap, AXP288_ADC_TS_PIN_CTRL, pin_on))
>> +		return -EIO;
>> +
>> +	return regmap_write(regmap, AXP20X_ADC_EN1, ~AXP288_ADC_EN_MASK);
> So, what's the deal about the variable adc_en?
>> +}
>> +
>> +static const struct iio_info axp288_adc_iio_info = {
>> +	.read_raw = &axp288_adc_read_raw,
>> +	.driver_module = THIS_MODULE,
>> +};
>> +
>> +static int axp288_adc_probe(struct platform_device *pdev)
>> +{
>> +	int ret;
>> +	struct axp288_adc_info *info;
>> +	struct iio_dev *indio_dev;
>> +	struct axp20x_dev *axp20x = dev_get_drvdata(pdev->dev.parent);
>> +
>> +	indio_dev = devm_iio_device_alloc(&pdev->dev, sizeof(*info));
>> +	if (!indio_dev)
>> +		return -ENOMEM;
>> +
>> +	info = iio_priv(indio_dev);
>> +	info->irq = platform_get_irq(pdev, 0);
>> +	if (info->irq < 0) {
>> +		dev_err(&pdev->dev, "no irq resource?\n");
>> +		return info->irq;
>> +	}
>> +	platform_set_drvdata(pdev, indio_dev);
>> +	info->regmap = axp20x->regmap;
>> +	ret = axp288_adc_enable(axp20x->regmap, true);
>> +	if (ret) {
>> +		dev_err(&pdev->dev, "Unable to enable ADC device\n");
>> +		return ret;
>> +	}
>> +
>> +	indio_dev->dev.parent = &pdev->dev;
>> +	indio_dev->name = pdev->name;
>> +	indio_dev->channels = axp288_adc_channels;
>> +	indio_dev->num_channels = ARRAY_SIZE(axp288_adc_channels);
>> +	indio_dev->info = &axp288_adc_iio_info;
>> +	indio_dev->modes = INDIO_DIRECT_MODE;
>> +	ret = iio_map_array_register(indio_dev, axp288_adc_default_maps);
>> +	if (ret < 0)
>> +		goto err_disable_dev;
>> +
>> +	ret = iio_device_register(indio_dev);
>> +	if (ret < 0) {
>> +		dev_err(&pdev->dev, "unable to register iio device\n");
>> +		goto err_array_unregister;
>> +	}
>> +
>> +	return 0;
>> +
>> +err_array_unregister:
>> +	iio_map_array_unregister(indio_dev);
>> +err_disable_dev:
>> +	ret = axp288_adc_enable(axp20x->regmap, false);
> Don't set ret here. We want to return the error code from the function that failed above.
>> +
>> +	return ret;
>> +}
>> +
>> +static int axp288_adc_remove(struct platform_device *pdev)
>> +{
>> +	struct iio_dev *indio_dev = platform_get_drvdata(pdev);
>> +	struct axp20x_dev *axp20x = dev_get_drvdata(pdev->dev.parent);
>> +
>> +	if (axp288_adc_enable(axp20x->regmap, false))
>> +		dev_err(&pdev->dev, "Unable to disable ADC device\n");
>> +	iio_device_unregister(indio_dev);
>> +	iio_map_array_unregister(indio_dev);
>> +
>> +	return 0;
>> +}
>> +
>> +static struct platform_driver axp288_adc_driver = {
>> +	.probe = axp288_adc_probe,
>> +	.remove = axp288_adc_remove,
>> +	.driver = {
>> +		.name = "axp288_adc",
>> +		.owner = THIS_MODULE,
>> +	},
>> +};
>> +
>> +module_platform_driver(axp288_adc_driver);
>> +
>> +MODULE_AUTHOR("Jacob Pan <jacob.jun.pan@xxxxxxxxxxxxxxx>");
>> +MODULE_DESCRIPTION("X-Powers AXP288 ADC Driver");
>> +MODULE_LICENSE("GPL");
>>
> 
> --
> To unsubscribe from this list: send the line "unsubscribe linux-iio" in
> the body of a message to majordomo@xxxxxxxxxxxxxxx
> More majordomo info at  http://vger.kernel.org/majordomo-info.html
> 

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/