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-iio" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
