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