| /* ADC driver for sunxi platforms' (A10, A13 and A31) GPADC | 
 |  * | 
 |  * Copyright (c) 2016 Quentin Schulz <quentin.schulz@free-electrons.com> | 
 |  * | 
 |  * This program is free software; you can redistribute it and/or modify it under | 
 |  * the terms of the GNU General Public License version 2 as published by the | 
 |  * Free Software Foundation. | 
 |  * | 
 |  * 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(void *data, int *temp) | 
 | { | 
 | 	struct sun4i_gpadc_iio *info = data; | 
 | 	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_of_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) { | 
 | 		dev_err(&pdev->dev, "no %s interrupt registered\n", name); | 
 | 		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, 0, | 
 | 					   devname, info); | 
 | 	if (ret < 0) { | 
 | 		dev_err(&pdev->dev, "could not request %s interrupt: %d\n", | 
 | 			name, ret); | 
 | 		return ret; | 
 | 	} | 
 |  | 
 | 	disable_irq(*irq); | 
 | 	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); | 
 | 	struct resource *mem; | 
 | 	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; | 
 |  | 
 | 	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); | 
 | 	base = devm_ioremap_resource(&pdev->dev, mem); | 
 | 	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->dev.parent = &pdev->dev; | 
 | 	indio_dev->dev.of_node = pdev->dev.of_node; | 
 | 	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 = thermal_zone_of_sensor_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; | 
 |  | 
 | 	thermal_zone_of_sensor_unregister(info->sensor_device, info->tzd); | 
 |  | 
 | 	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 <quentin.schulz@free-electrons.com>"); | 
 | MODULE_LICENSE("GPL v2"); |