123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714 |
- // SPDX-License-Identifier: GPL-2.0
- /* ADC driver for sunxi platforms' (A10, A13 and A31) GPADC
- *
- * Copyright (c) 2016 Quentin Schulz <[email protected]>
- *
- * The Allwinner SoCs all have an ADC that can also act as a touchscreen
- * controller and a thermal sensor.
- * The thermal sensor works only when the ADC acts as a touchscreen controller
- * and is configured to throw an interrupt every fixed periods of time (let say
- * every X seconds).
- * One would be tempted to disable the IP on the hardware side rather than
- * disabling interrupts to save some power but that resets the internal clock of
- * the IP, resulting in having to wait X seconds every time we want to read the
- * value of the thermal sensor.
- * This is also the reason of using autosuspend in pm_runtime. If there was no
- * autosuspend, the thermal sensor would need X seconds after every
- * pm_runtime_get_sync to get a value from the ADC. The autosuspend allows the
- * thermal sensor to be requested again in a certain time span before it gets
- * shutdown for not being used.
- */
- #include <linux/completion.h>
- #include <linux/interrupt.h>
- #include <linux/io.h>
- #include <linux/module.h>
- #include <linux/of.h>
- #include <linux/of_device.h>
- #include <linux/platform_device.h>
- #include <linux/pm_runtime.h>
- #include <linux/regmap.h>
- #include <linux/thermal.h>
- #include <linux/delay.h>
- #include <linux/iio/iio.h>
- #include <linux/iio/driver.h>
- #include <linux/iio/machine.h>
- #include <linux/mfd/sun4i-gpadc.h>
- static unsigned int sun4i_gpadc_chan_select(unsigned int chan)
- {
- return SUN4I_GPADC_CTRL1_ADC_CHAN_SELECT(chan);
- }
- static unsigned int sun6i_gpadc_chan_select(unsigned int chan)
- {
- return SUN6I_GPADC_CTRL1_ADC_CHAN_SELECT(chan);
- }
- struct gpadc_data {
- int temp_offset;
- int temp_scale;
- unsigned int tp_mode_en;
- unsigned int tp_adc_select;
- unsigned int (*adc_chan_select)(unsigned int chan);
- unsigned int adc_chan_mask;
- };
- static const struct gpadc_data sun4i_gpadc_data = {
- .temp_offset = -1932,
- .temp_scale = 133,
- .tp_mode_en = SUN4I_GPADC_CTRL1_TP_MODE_EN,
- .tp_adc_select = SUN4I_GPADC_CTRL1_TP_ADC_SELECT,
- .adc_chan_select = &sun4i_gpadc_chan_select,
- .adc_chan_mask = SUN4I_GPADC_CTRL1_ADC_CHAN_MASK,
- };
- static const struct gpadc_data sun5i_gpadc_data = {
- .temp_offset = -1447,
- .temp_scale = 100,
- .tp_mode_en = SUN4I_GPADC_CTRL1_TP_MODE_EN,
- .tp_adc_select = SUN4I_GPADC_CTRL1_TP_ADC_SELECT,
- .adc_chan_select = &sun4i_gpadc_chan_select,
- .adc_chan_mask = SUN4I_GPADC_CTRL1_ADC_CHAN_MASK,
- };
- static const struct gpadc_data sun6i_gpadc_data = {
- .temp_offset = -1623,
- .temp_scale = 167,
- .tp_mode_en = SUN6I_GPADC_CTRL1_TP_MODE_EN,
- .tp_adc_select = SUN6I_GPADC_CTRL1_TP_ADC_SELECT,
- .adc_chan_select = &sun6i_gpadc_chan_select,
- .adc_chan_mask = SUN6I_GPADC_CTRL1_ADC_CHAN_MASK,
- };
- static const struct gpadc_data sun8i_a33_gpadc_data = {
- .temp_offset = -1662,
- .temp_scale = 162,
- .tp_mode_en = SUN8I_GPADC_CTRL1_CHOP_TEMP_EN,
- };
- struct sun4i_gpadc_iio {
- struct iio_dev *indio_dev;
- struct completion completion;
- int temp_data;
- u32 adc_data;
- struct regmap *regmap;
- unsigned int fifo_data_irq;
- atomic_t ignore_fifo_data_irq;
- unsigned int temp_data_irq;
- atomic_t ignore_temp_data_irq;
- const struct gpadc_data *data;
- bool no_irq;
- /* prevents concurrent reads of temperature and ADC */
- struct mutex mutex;
- struct thermal_zone_device *tzd;
- struct device *sensor_device;
- };
- #define SUN4I_GPADC_ADC_CHANNEL(_channel, _name) { \
- .type = IIO_VOLTAGE, \
- .indexed = 1, \
- .channel = _channel, \
- .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
- .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \
- .datasheet_name = _name, \
- }
- static struct iio_map sun4i_gpadc_hwmon_maps[] = {
- {
- .adc_channel_label = "temp_adc",
- .consumer_dev_name = "iio_hwmon.0",
- },
- { /* sentinel */ },
- };
- static const struct iio_chan_spec sun4i_gpadc_channels[] = {
- SUN4I_GPADC_ADC_CHANNEL(0, "adc_chan0"),
- SUN4I_GPADC_ADC_CHANNEL(1, "adc_chan1"),
- SUN4I_GPADC_ADC_CHANNEL(2, "adc_chan2"),
- SUN4I_GPADC_ADC_CHANNEL(3, "adc_chan3"),
- {
- .type = IIO_TEMP,
- .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
- BIT(IIO_CHAN_INFO_SCALE) |
- BIT(IIO_CHAN_INFO_OFFSET),
- .datasheet_name = "temp_adc",
- },
- };
- static const struct iio_chan_spec sun4i_gpadc_channels_no_temp[] = {
- SUN4I_GPADC_ADC_CHANNEL(0, "adc_chan0"),
- SUN4I_GPADC_ADC_CHANNEL(1, "adc_chan1"),
- SUN4I_GPADC_ADC_CHANNEL(2, "adc_chan2"),
- SUN4I_GPADC_ADC_CHANNEL(3, "adc_chan3"),
- };
- static const struct iio_chan_spec sun8i_a33_gpadc_channels[] = {
- {
- .type = IIO_TEMP,
- .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
- BIT(IIO_CHAN_INFO_SCALE) |
- BIT(IIO_CHAN_INFO_OFFSET),
- .datasheet_name = "temp_adc",
- },
- };
- static const struct regmap_config sun4i_gpadc_regmap_config = {
- .reg_bits = 32,
- .val_bits = 32,
- .reg_stride = 4,
- .fast_io = true,
- };
- static int sun4i_prepare_for_irq(struct iio_dev *indio_dev, int channel,
- unsigned int irq)
- {
- struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
- int ret;
- u32 reg;
- pm_runtime_get_sync(indio_dev->dev.parent);
- reinit_completion(&info->completion);
- ret = regmap_write(info->regmap, SUN4I_GPADC_INT_FIFOC,
- SUN4I_GPADC_INT_FIFOC_TP_FIFO_TRIG_LEVEL(1) |
- SUN4I_GPADC_INT_FIFOC_TP_FIFO_FLUSH);
- if (ret)
- return ret;
- ret = regmap_read(info->regmap, SUN4I_GPADC_CTRL1, ®);
- if (ret)
- return ret;
- if (irq == info->fifo_data_irq) {
- ret = regmap_write(info->regmap, SUN4I_GPADC_CTRL1,
- info->data->tp_mode_en |
- info->data->tp_adc_select |
- info->data->adc_chan_select(channel));
- /*
- * When the IP changes channel, it needs a bit of time to get
- * correct values.
- */
- if ((reg & info->data->adc_chan_mask) !=
- info->data->adc_chan_select(channel))
- mdelay(10);
- } else {
- /*
- * The temperature sensor returns valid data only when the ADC
- * operates in touchscreen mode.
- */
- ret = regmap_write(info->regmap, SUN4I_GPADC_CTRL1,
- info->data->tp_mode_en);
- }
- if (ret)
- return ret;
- /*
- * When the IP changes mode between ADC or touchscreen, it
- * needs a bit of time to get correct values.
- */
- if ((reg & info->data->tp_adc_select) != info->data->tp_adc_select)
- mdelay(100);
- return 0;
- }
- static int sun4i_gpadc_read(struct iio_dev *indio_dev, int channel, int *val,
- unsigned int irq)
- {
- struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
- int ret;
- mutex_lock(&info->mutex);
- ret = sun4i_prepare_for_irq(indio_dev, channel, irq);
- if (ret)
- goto err;
- enable_irq(irq);
- /*
- * The temperature sensor throws an interruption periodically (currently
- * set at periods of ~0.6s in sun4i_gpadc_runtime_resume). A 1s delay
- * makes sure an interruption occurs in normal conditions. If it doesn't
- * occur, then there is a timeout.
- */
- if (!wait_for_completion_timeout(&info->completion,
- msecs_to_jiffies(1000))) {
- ret = -ETIMEDOUT;
- goto err;
- }
- if (irq == info->fifo_data_irq)
- *val = info->adc_data;
- else
- *val = info->temp_data;
- ret = 0;
- pm_runtime_mark_last_busy(indio_dev->dev.parent);
- err:
- pm_runtime_put_autosuspend(indio_dev->dev.parent);
- disable_irq(irq);
- mutex_unlock(&info->mutex);
- return ret;
- }
- static int sun4i_gpadc_adc_read(struct iio_dev *indio_dev, int channel,
- int *val)
- {
- struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
- return sun4i_gpadc_read(indio_dev, channel, val, info->fifo_data_irq);
- }
- static int sun4i_gpadc_temp_read(struct iio_dev *indio_dev, int *val)
- {
- struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
- if (info->no_irq) {
- pm_runtime_get_sync(indio_dev->dev.parent);
- regmap_read(info->regmap, SUN4I_GPADC_TEMP_DATA, val);
- pm_runtime_mark_last_busy(indio_dev->dev.parent);
- pm_runtime_put_autosuspend(indio_dev->dev.parent);
- return 0;
- }
- return sun4i_gpadc_read(indio_dev, 0, val, info->temp_data_irq);
- }
- static int sun4i_gpadc_temp_offset(struct iio_dev *indio_dev, int *val)
- {
- struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
- *val = info->data->temp_offset;
- return 0;
- }
- static int sun4i_gpadc_temp_scale(struct iio_dev *indio_dev, int *val)
- {
- struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
- *val = info->data->temp_scale;
- return 0;
- }
- static int sun4i_gpadc_read_raw(struct iio_dev *indio_dev,
- struct iio_chan_spec const *chan, int *val,
- int *val2, long mask)
- {
- int ret;
- switch (mask) {
- case IIO_CHAN_INFO_OFFSET:
- ret = sun4i_gpadc_temp_offset(indio_dev, val);
- if (ret)
- return ret;
- return IIO_VAL_INT;
- case IIO_CHAN_INFO_RAW:
- if (chan->type == IIO_VOLTAGE)
- ret = sun4i_gpadc_adc_read(indio_dev, chan->channel,
- val);
- else
- ret = sun4i_gpadc_temp_read(indio_dev, val);
- if (ret)
- return ret;
- return IIO_VAL_INT;
- case IIO_CHAN_INFO_SCALE:
- if (chan->type == IIO_VOLTAGE) {
- /* 3000mV / 4096 * raw */
- *val = 0;
- *val2 = 732421875;
- return IIO_VAL_INT_PLUS_NANO;
- }
- ret = sun4i_gpadc_temp_scale(indio_dev, val);
- if (ret)
- return ret;
- return IIO_VAL_INT;
- default:
- return -EINVAL;
- }
- return -EINVAL;
- }
- static const struct iio_info sun4i_gpadc_iio_info = {
- .read_raw = sun4i_gpadc_read_raw,
- };
- static irqreturn_t sun4i_gpadc_temp_data_irq_handler(int irq, void *dev_id)
- {
- struct sun4i_gpadc_iio *info = dev_id;
- if (atomic_read(&info->ignore_temp_data_irq))
- goto out;
- if (!regmap_read(info->regmap, SUN4I_GPADC_TEMP_DATA, &info->temp_data))
- complete(&info->completion);
- out:
- return IRQ_HANDLED;
- }
- static irqreturn_t sun4i_gpadc_fifo_data_irq_handler(int irq, void *dev_id)
- {
- struct sun4i_gpadc_iio *info = dev_id;
- if (atomic_read(&info->ignore_fifo_data_irq))
- goto out;
- if (!regmap_read(info->regmap, SUN4I_GPADC_DATA, &info->adc_data))
- complete(&info->completion);
- out:
- return IRQ_HANDLED;
- }
- static int sun4i_gpadc_runtime_suspend(struct device *dev)
- {
- struct sun4i_gpadc_iio *info = iio_priv(dev_get_drvdata(dev));
- /* Disable the ADC on IP */
- regmap_write(info->regmap, SUN4I_GPADC_CTRL1, 0);
- /* Disable temperature sensor on IP */
- regmap_write(info->regmap, SUN4I_GPADC_TPR, 0);
- return 0;
- }
- static int sun4i_gpadc_runtime_resume(struct device *dev)
- {
- struct sun4i_gpadc_iio *info = iio_priv(dev_get_drvdata(dev));
- /* clkin = 6MHz */
- regmap_write(info->regmap, SUN4I_GPADC_CTRL0,
- SUN4I_GPADC_CTRL0_ADC_CLK_DIVIDER(2) |
- SUN4I_GPADC_CTRL0_FS_DIV(7) |
- SUN4I_GPADC_CTRL0_T_ACQ(63));
- regmap_write(info->regmap, SUN4I_GPADC_CTRL1, info->data->tp_mode_en);
- regmap_write(info->regmap, SUN4I_GPADC_CTRL3,
- SUN4I_GPADC_CTRL3_FILTER_EN |
- SUN4I_GPADC_CTRL3_FILTER_TYPE(1));
- /* period = SUN4I_GPADC_TPR_TEMP_PERIOD * 256 * 16 / clkin; ~0.6s */
- regmap_write(info->regmap, SUN4I_GPADC_TPR,
- SUN4I_GPADC_TPR_TEMP_ENABLE |
- SUN4I_GPADC_TPR_TEMP_PERIOD(800));
- return 0;
- }
- static int sun4i_gpadc_get_temp(struct thermal_zone_device *tz, int *temp)
- {
- struct sun4i_gpadc_iio *info = tz->devdata;
- int val, scale, offset;
- if (sun4i_gpadc_temp_read(info->indio_dev, &val))
- return -ETIMEDOUT;
- sun4i_gpadc_temp_scale(info->indio_dev, &scale);
- sun4i_gpadc_temp_offset(info->indio_dev, &offset);
- *temp = (val + offset) * scale;
- return 0;
- }
- static const struct thermal_zone_device_ops sun4i_ts_tz_ops = {
- .get_temp = &sun4i_gpadc_get_temp,
- };
- static const struct dev_pm_ops sun4i_gpadc_pm_ops = {
- .runtime_suspend = &sun4i_gpadc_runtime_suspend,
- .runtime_resume = &sun4i_gpadc_runtime_resume,
- };
- static int sun4i_irq_init(struct platform_device *pdev, const char *name,
- irq_handler_t handler, const char *devname,
- unsigned int *irq, atomic_t *atomic)
- {
- int ret;
- struct sun4i_gpadc_dev *mfd_dev = dev_get_drvdata(pdev->dev.parent);
- struct sun4i_gpadc_iio *info = iio_priv(dev_get_drvdata(&pdev->dev));
- /*
- * Once the interrupt is activated, the IP continuously performs
- * conversions thus throws interrupts. The interrupt is activated right
- * after being requested but we want to control when these interrupts
- * occur thus we disable it right after being requested. However, an
- * interrupt might occur between these two instructions and we have to
- * make sure that does not happen, by using atomic flags. We set the
- * flag before requesting the interrupt and unset it right after
- * disabling the interrupt. When an interrupt occurs between these two
- * instructions, reading the atomic flag will tell us to ignore the
- * interrupt.
- */
- atomic_set(atomic, 1);
- ret = platform_get_irq_byname(pdev, name);
- if (ret < 0)
- return ret;
- ret = regmap_irq_get_virq(mfd_dev->regmap_irqc, ret);
- if (ret < 0) {
- dev_err(&pdev->dev, "failed to get virq for irq %s\n", name);
- return ret;
- }
- *irq = ret;
- ret = devm_request_any_context_irq(&pdev->dev, *irq, handler,
- IRQF_NO_AUTOEN,
- devname, info);
- if (ret < 0) {
- dev_err(&pdev->dev, "could not request %s interrupt: %d\n",
- name, ret);
- return ret;
- }
- atomic_set(atomic, 0);
- return 0;
- }
- static const struct of_device_id sun4i_gpadc_of_id[] = {
- {
- .compatible = "allwinner,sun8i-a33-ths",
- .data = &sun8i_a33_gpadc_data,
- },
- { /* sentinel */ }
- };
- static int sun4i_gpadc_probe_dt(struct platform_device *pdev,
- struct iio_dev *indio_dev)
- {
- struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
- void __iomem *base;
- int ret;
- info->data = of_device_get_match_data(&pdev->dev);
- if (!info->data)
- return -ENODEV;
- info->no_irq = true;
- indio_dev->num_channels = ARRAY_SIZE(sun8i_a33_gpadc_channels);
- indio_dev->channels = sun8i_a33_gpadc_channels;
- base = devm_platform_ioremap_resource(pdev, 0);
- if (IS_ERR(base))
- return PTR_ERR(base);
- info->regmap = devm_regmap_init_mmio(&pdev->dev, base,
- &sun4i_gpadc_regmap_config);
- if (IS_ERR(info->regmap)) {
- ret = PTR_ERR(info->regmap);
- dev_err(&pdev->dev, "failed to init regmap: %d\n", ret);
- return ret;
- }
- if (IS_ENABLED(CONFIG_THERMAL_OF))
- info->sensor_device = &pdev->dev;
- return 0;
- }
- static int sun4i_gpadc_probe_mfd(struct platform_device *pdev,
- struct iio_dev *indio_dev)
- {
- struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
- struct sun4i_gpadc_dev *sun4i_gpadc_dev =
- dev_get_drvdata(pdev->dev.parent);
- int ret;
- info->no_irq = false;
- info->regmap = sun4i_gpadc_dev->regmap;
- indio_dev->num_channels = ARRAY_SIZE(sun4i_gpadc_channels);
- indio_dev->channels = sun4i_gpadc_channels;
- info->data = (struct gpadc_data *)platform_get_device_id(pdev)->driver_data;
- /*
- * Since the controller needs to be in touchscreen mode for its thermal
- * sensor to operate properly, and that switching between the two modes
- * needs a delay, always registering in the thermal framework will
- * significantly slow down the conversion rate of the ADCs.
- *
- * Therefore, instead of depending on THERMAL_OF in Kconfig, we only
- * register the sensor if that option is enabled, eventually leaving
- * that choice to the user.
- */
- if (IS_ENABLED(CONFIG_THERMAL_OF)) {
- /*
- * This driver is a child of an MFD which has a node in the DT
- * but not its children, because of DT backward compatibility
- * for A10, A13 and A31 SoCs. Therefore, the resulting devices
- * of this driver do not have an of_node variable.
- * However, its parent (the MFD driver) has an of_node variable
- * and since devm_thermal_zone_of_sensor_register uses its first
- * argument to match the phandle defined in the node of the
- * thermal driver with the of_node of the device passed as first
- * argument and the third argument to call ops from
- * thermal_zone_of_device_ops, the solution is to use the parent
- * device as first argument to match the phandle with its
- * of_node, and the device from this driver as third argument to
- * return the temperature.
- */
- info->sensor_device = pdev->dev.parent;
- } else {
- indio_dev->num_channels =
- ARRAY_SIZE(sun4i_gpadc_channels_no_temp);
- indio_dev->channels = sun4i_gpadc_channels_no_temp;
- }
- if (IS_ENABLED(CONFIG_THERMAL_OF)) {
- ret = sun4i_irq_init(pdev, "TEMP_DATA_PENDING",
- sun4i_gpadc_temp_data_irq_handler,
- "temp_data", &info->temp_data_irq,
- &info->ignore_temp_data_irq);
- if (ret < 0)
- return ret;
- }
- ret = sun4i_irq_init(pdev, "FIFO_DATA_PENDING",
- sun4i_gpadc_fifo_data_irq_handler, "fifo_data",
- &info->fifo_data_irq, &info->ignore_fifo_data_irq);
- if (ret < 0)
- return ret;
- if (IS_ENABLED(CONFIG_THERMAL_OF)) {
- ret = iio_map_array_register(indio_dev, sun4i_gpadc_hwmon_maps);
- if (ret < 0) {
- dev_err(&pdev->dev,
- "failed to register iio map array\n");
- return ret;
- }
- }
- return 0;
- }
- static int sun4i_gpadc_probe(struct platform_device *pdev)
- {
- struct sun4i_gpadc_iio *info;
- struct iio_dev *indio_dev;
- int ret;
- indio_dev = devm_iio_device_alloc(&pdev->dev, sizeof(*info));
- if (!indio_dev)
- return -ENOMEM;
- info = iio_priv(indio_dev);
- platform_set_drvdata(pdev, indio_dev);
- mutex_init(&info->mutex);
- info->indio_dev = indio_dev;
- init_completion(&info->completion);
- indio_dev->name = dev_name(&pdev->dev);
- indio_dev->info = &sun4i_gpadc_iio_info;
- indio_dev->modes = INDIO_DIRECT_MODE;
- if (pdev->dev.of_node)
- ret = sun4i_gpadc_probe_dt(pdev, indio_dev);
- else
- ret = sun4i_gpadc_probe_mfd(pdev, indio_dev);
- if (ret)
- return ret;
- pm_runtime_set_autosuspend_delay(&pdev->dev,
- SUN4I_GPADC_AUTOSUSPEND_DELAY);
- pm_runtime_use_autosuspend(&pdev->dev);
- pm_runtime_set_suspended(&pdev->dev);
- pm_runtime_enable(&pdev->dev);
- if (IS_ENABLED(CONFIG_THERMAL_OF)) {
- info->tzd = devm_thermal_of_zone_register(info->sensor_device,
- 0, info,
- &sun4i_ts_tz_ops);
- /*
- * Do not fail driver probing when failing to register in
- * thermal because no thermal DT node is found.
- */
- if (IS_ERR(info->tzd) && PTR_ERR(info->tzd) != -ENODEV) {
- dev_err(&pdev->dev,
- "could not register thermal sensor: %ld\n",
- PTR_ERR(info->tzd));
- return PTR_ERR(info->tzd);
- }
- }
- ret = devm_iio_device_register(&pdev->dev, indio_dev);
- if (ret < 0) {
- dev_err(&pdev->dev, "could not register the device\n");
- goto err_map;
- }
- return 0;
- err_map:
- if (!info->no_irq && IS_ENABLED(CONFIG_THERMAL_OF))
- iio_map_array_unregister(indio_dev);
- pm_runtime_put(&pdev->dev);
- pm_runtime_disable(&pdev->dev);
- return ret;
- }
- static int sun4i_gpadc_remove(struct platform_device *pdev)
- {
- struct iio_dev *indio_dev = platform_get_drvdata(pdev);
- struct sun4i_gpadc_iio *info = iio_priv(indio_dev);
- pm_runtime_put(&pdev->dev);
- pm_runtime_disable(&pdev->dev);
- if (!IS_ENABLED(CONFIG_THERMAL_OF))
- return 0;
- if (!info->no_irq)
- iio_map_array_unregister(indio_dev);
- return 0;
- }
- static const struct platform_device_id sun4i_gpadc_id[] = {
- { "sun4i-a10-gpadc-iio", (kernel_ulong_t)&sun4i_gpadc_data },
- { "sun5i-a13-gpadc-iio", (kernel_ulong_t)&sun5i_gpadc_data },
- { "sun6i-a31-gpadc-iio", (kernel_ulong_t)&sun6i_gpadc_data },
- { /* sentinel */ },
- };
- MODULE_DEVICE_TABLE(platform, sun4i_gpadc_id);
- static struct platform_driver sun4i_gpadc_driver = {
- .driver = {
- .name = "sun4i-gpadc-iio",
- .of_match_table = sun4i_gpadc_of_id,
- .pm = &sun4i_gpadc_pm_ops,
- },
- .id_table = sun4i_gpadc_id,
- .probe = sun4i_gpadc_probe,
- .remove = sun4i_gpadc_remove,
- };
- MODULE_DEVICE_TABLE(of, sun4i_gpadc_of_id);
- module_platform_driver(sun4i_gpadc_driver);
- MODULE_DESCRIPTION("ADC driver for sunxi platforms");
- MODULE_AUTHOR("Quentin Schulz <[email protected]>");
- MODULE_LICENSE("GPL v2");
|