Merge branch 'ib-5.8-jz47xx-ts' into HEAD

Immutable branch may be needed in input for a joystick set that is
dependent on it.
This commit is contained in:
Jonathan Cameron 2020-07-22 14:36:31 +01:00
commit d0d7c5845e
3 changed files with 358 additions and 40 deletions

View File

@ -500,6 +500,7 @@ config INA2XX_ADC
config INGENIC_ADC config INGENIC_ADC
tristate "Ingenic JZ47xx SoCs ADC driver" tristate "Ingenic JZ47xx SoCs ADC driver"
depends on MIPS || COMPILE_TEST depends on MIPS || COMPILE_TEST
select IIO_BUFFER
help help
Say yes here to build support for the Ingenic JZ47xx SoCs ADC unit. Say yes here to build support for the Ingenic JZ47xx SoCs ADC unit.

View File

@ -8,7 +8,9 @@
#include <dt-bindings/iio/adc/ingenic,adc.h> #include <dt-bindings/iio/adc/ingenic,adc.h>
#include <linux/clk.h> #include <linux/clk.h>
#include <linux/iio/buffer.h>
#include <linux/iio/iio.h> #include <linux/iio/iio.h>
#include <linux/interrupt.h>
#include <linux/io.h> #include <linux/io.h>
#include <linux/iopoll.h> #include <linux/iopoll.h>
#include <linux/kernel.h> #include <linux/kernel.h>
@ -21,19 +23,46 @@
#define JZ_ADC_REG_CFG 0x04 #define JZ_ADC_REG_CFG 0x04
#define JZ_ADC_REG_CTRL 0x08 #define JZ_ADC_REG_CTRL 0x08
#define JZ_ADC_REG_STATUS 0x0c #define JZ_ADC_REG_STATUS 0x0c
#define JZ_ADC_REG_ADSAME 0x10
#define JZ_ADC_REG_ADWAIT 0x14
#define JZ_ADC_REG_ADTCH 0x18 #define JZ_ADC_REG_ADTCH 0x18
#define JZ_ADC_REG_ADBDAT 0x1c #define JZ_ADC_REG_ADBDAT 0x1c
#define JZ_ADC_REG_ADSDAT 0x20 #define JZ_ADC_REG_ADSDAT 0x20
#define JZ_ADC_REG_ADCMD 0x24
#define JZ_ADC_REG_ADCLK 0x28 #define JZ_ADC_REG_ADCLK 0x28
#define JZ_ADC_REG_ENABLE_PD BIT(7) #define JZ_ADC_REG_ENABLE_PD BIT(7)
#define JZ_ADC_REG_CFG_AUX_MD (BIT(0) | BIT(1)) #define JZ_ADC_REG_CFG_AUX_MD (BIT(0) | BIT(1))
#define JZ_ADC_REG_CFG_BAT_MD BIT(4) #define JZ_ADC_REG_CFG_BAT_MD BIT(4)
#define JZ_ADC_REG_CFG_SAMPLE_NUM(n) ((n) << 10)
#define JZ_ADC_REG_CFG_PULL_UP(n) ((n) << 16)
#define JZ_ADC_REG_CFG_CMD_SEL BIT(22)
#define JZ_ADC_REG_CFG_TOUCH_OPS_MASK (BIT(31) | GENMASK(23, 10))
#define JZ_ADC_REG_ADCLK_CLKDIV_LSB 0 #define JZ_ADC_REG_ADCLK_CLKDIV_LSB 0
#define JZ4725B_ADC_REG_ADCLK_CLKDIV10US_LSB 16 #define JZ4725B_ADC_REG_ADCLK_CLKDIV10US_LSB 16
#define JZ4770_ADC_REG_ADCLK_CLKDIV10US_LSB 8 #define JZ4770_ADC_REG_ADCLK_CLKDIV10US_LSB 8
#define JZ4770_ADC_REG_ADCLK_CLKDIVMS_LSB 16 #define JZ4770_ADC_REG_ADCLK_CLKDIVMS_LSB 16
#define JZ_ADC_REG_ADCMD_YNADC BIT(7)
#define JZ_ADC_REG_ADCMD_YPADC BIT(8)
#define JZ_ADC_REG_ADCMD_XNADC BIT(9)
#define JZ_ADC_REG_ADCMD_XPADC BIT(10)
#define JZ_ADC_REG_ADCMD_VREFPYP BIT(11)
#define JZ_ADC_REG_ADCMD_VREFPXP BIT(12)
#define JZ_ADC_REG_ADCMD_VREFPXN BIT(13)
#define JZ_ADC_REG_ADCMD_VREFPAUX BIT(14)
#define JZ_ADC_REG_ADCMD_VREFPVDD33 BIT(15)
#define JZ_ADC_REG_ADCMD_VREFNYN BIT(16)
#define JZ_ADC_REG_ADCMD_VREFNXP BIT(17)
#define JZ_ADC_REG_ADCMD_VREFNXN BIT(18)
#define JZ_ADC_REG_ADCMD_VREFAUX BIT(19)
#define JZ_ADC_REG_ADCMD_YNGRU BIT(20)
#define JZ_ADC_REG_ADCMD_XNGRU BIT(21)
#define JZ_ADC_REG_ADCMD_XPGRU BIT(22)
#define JZ_ADC_REG_ADCMD_YPSUP BIT(23)
#define JZ_ADC_REG_ADCMD_XNSUP BIT(24)
#define JZ_ADC_REG_ADCMD_XPSUP BIT(25)
#define JZ_ADC_AUX_VREF 3300 #define JZ_ADC_AUX_VREF 3300
#define JZ_ADC_AUX_VREF_BITS 12 #define JZ_ADC_AUX_VREF_BITS 12
#define JZ_ADC_BATTERY_LOW_VREF 2500 #define JZ_ADC_BATTERY_LOW_VREF 2500
@ -45,6 +74,14 @@
#define JZ4770_ADC_BATTERY_VREF 6600 #define JZ4770_ADC_BATTERY_VREF 6600
#define JZ4770_ADC_BATTERY_VREF_BITS 12 #define JZ4770_ADC_BATTERY_VREF_BITS 12
#define JZ_ADC_IRQ_AUX BIT(0)
#define JZ_ADC_IRQ_BATTERY BIT(1)
#define JZ_ADC_IRQ_TOUCH BIT(2)
#define JZ_ADC_IRQ_PEN_DOWN BIT(3)
#define JZ_ADC_IRQ_PEN_UP BIT(4)
#define JZ_ADC_IRQ_PEN_DOWN_SLEEP BIT(5)
#define JZ_ADC_IRQ_SLEEP BIT(7)
struct ingenic_adc; struct ingenic_adc;
struct ingenic_adc_soc_data { struct ingenic_adc_soc_data {
@ -56,6 +93,8 @@ struct ingenic_adc_soc_data {
size_t battery_scale_avail_size; size_t battery_scale_avail_size;
unsigned int battery_vref_mode: 1; unsigned int battery_vref_mode: 1;
unsigned int has_aux2: 1; unsigned int has_aux2: 1;
const struct iio_chan_spec *channels;
unsigned int num_channels;
int (*init_clk_div)(struct device *dev, struct ingenic_adc *adc); int (*init_clk_div)(struct device *dev, struct ingenic_adc *adc);
}; };
@ -68,13 +107,67 @@ struct ingenic_adc {
bool low_vref_mode; bool low_vref_mode;
}; };
static void ingenic_adc_set_adcmd(struct iio_dev *iio_dev, unsigned long mask)
{
struct ingenic_adc *adc = iio_priv(iio_dev);
mutex_lock(&adc->lock);
/* Init ADCMD */
readl(adc->base + JZ_ADC_REG_ADCMD);
if (mask & 0x3) {
/* Second channel (INGENIC_ADC_TOUCH_YP): sample YP vs. GND */
writel(JZ_ADC_REG_ADCMD_XNGRU
| JZ_ADC_REG_ADCMD_VREFNXN | JZ_ADC_REG_ADCMD_VREFPVDD33
| JZ_ADC_REG_ADCMD_YPADC,
adc->base + JZ_ADC_REG_ADCMD);
/* First channel (INGENIC_ADC_TOUCH_XP): sample XP vs. GND */
writel(JZ_ADC_REG_ADCMD_YNGRU
| JZ_ADC_REG_ADCMD_VREFNYN | JZ_ADC_REG_ADCMD_VREFPVDD33
| JZ_ADC_REG_ADCMD_XPADC,
adc->base + JZ_ADC_REG_ADCMD);
}
if (mask & 0xc) {
/* Fourth channel (INGENIC_ADC_TOUCH_YN): sample YN vs. GND */
writel(JZ_ADC_REG_ADCMD_XNGRU
| JZ_ADC_REG_ADCMD_VREFNXN | JZ_ADC_REG_ADCMD_VREFPVDD33
| JZ_ADC_REG_ADCMD_YNADC,
adc->base + JZ_ADC_REG_ADCMD);
/* Third channel (INGENIC_ADC_TOUCH_XN): sample XN vs. GND */
writel(JZ_ADC_REG_ADCMD_YNGRU
| JZ_ADC_REG_ADCMD_VREFNYN | JZ_ADC_REG_ADCMD_VREFPVDD33
| JZ_ADC_REG_ADCMD_XNADC,
adc->base + JZ_ADC_REG_ADCMD);
}
if (mask & 0x30) {
/* Sixth channel (INGENIC_ADC_TOUCH_YD): sample YP vs. YN */
writel(JZ_ADC_REG_ADCMD_VREFNYN | JZ_ADC_REG_ADCMD_VREFPVDD33
| JZ_ADC_REG_ADCMD_YPADC,
adc->base + JZ_ADC_REG_ADCMD);
/* Fifth channel (INGENIC_ADC_TOUCH_XD): sample XP vs. XN */
writel(JZ_ADC_REG_ADCMD_VREFNXN | JZ_ADC_REG_ADCMD_VREFPVDD33
| JZ_ADC_REG_ADCMD_XPADC,
adc->base + JZ_ADC_REG_ADCMD);
}
/* We're done */
writel(0, adc->base + JZ_ADC_REG_ADCMD);
mutex_unlock(&adc->lock);
}
static void ingenic_adc_set_config(struct ingenic_adc *adc, static void ingenic_adc_set_config(struct ingenic_adc *adc,
uint32_t mask, uint32_t mask,
uint32_t val) uint32_t val)
{ {
uint32_t cfg; uint32_t cfg;
clk_enable(adc->clk);
mutex_lock(&adc->lock); mutex_lock(&adc->lock);
cfg = readl(adc->base + JZ_ADC_REG_CFG) & ~mask; cfg = readl(adc->base + JZ_ADC_REG_CFG) & ~mask;
@ -82,7 +175,6 @@ static void ingenic_adc_set_config(struct ingenic_adc *adc,
writel(cfg, adc->base + JZ_ADC_REG_CFG); writel(cfg, adc->base + JZ_ADC_REG_CFG);
mutex_unlock(&adc->lock); mutex_unlock(&adc->lock);
clk_disable(adc->clk);
} }
static void ingenic_adc_enable(struct ingenic_adc *adc, static void ingenic_adc_enable(struct ingenic_adc *adc,
@ -125,6 +217,8 @@ static int ingenic_adc_write_raw(struct iio_dev *iio_dev,
long m) long m)
{ {
struct ingenic_adc *adc = iio_priv(iio_dev); struct ingenic_adc *adc = iio_priv(iio_dev);
struct device *dev = iio_dev->dev.parent;
int ret;
switch (m) { switch (m) {
case IIO_CHAN_INFO_SCALE: case IIO_CHAN_INFO_SCALE:
@ -132,6 +226,14 @@ static int ingenic_adc_write_raw(struct iio_dev *iio_dev,
case INGENIC_ADC_BATTERY: case INGENIC_ADC_BATTERY:
if (!adc->soc_data->battery_vref_mode) if (!adc->soc_data->battery_vref_mode)
return -EINVAL; return -EINVAL;
ret = clk_enable(adc->clk);
if (ret) {
dev_err(dev, "Failed to enable clock: %d\n",
ret);
return ret;
}
if (val > JZ_ADC_BATTERY_LOW_VREF) { if (val > JZ_ADC_BATTERY_LOW_VREF) {
ingenic_adc_set_config(adc, ingenic_adc_set_config(adc,
JZ_ADC_REG_CFG_BAT_MD, JZ_ADC_REG_CFG_BAT_MD,
@ -143,6 +245,9 @@ static int ingenic_adc_write_raw(struct iio_dev *iio_dev,
JZ_ADC_REG_CFG_BAT_MD); JZ_ADC_REG_CFG_BAT_MD);
adc->low_vref_mode = true; adc->low_vref_mode = true;
} }
clk_disable(adc->clk);
return 0; return 0;
default: default:
return -EINVAL; return -EINVAL;
@ -252,6 +357,127 @@ static int jz4770_adc_init_clk_div(struct device *dev, struct ingenic_adc *adc)
return 0; return 0;
} }
static const struct iio_chan_spec jz4740_channels[] = {
{
.extend_name = "aux",
.type = IIO_VOLTAGE,
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
BIT(IIO_CHAN_INFO_SCALE),
.indexed = 1,
.channel = INGENIC_ADC_AUX,
.scan_index = -1,
},
{
.extend_name = "battery",
.type = IIO_VOLTAGE,
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
BIT(IIO_CHAN_INFO_SCALE),
.info_mask_separate_available = BIT(IIO_CHAN_INFO_RAW) |
BIT(IIO_CHAN_INFO_SCALE),
.indexed = 1,
.channel = INGENIC_ADC_BATTERY,
.scan_index = -1,
},
};
static const struct iio_chan_spec jz4770_channels[] = {
{
.type = IIO_VOLTAGE,
.indexed = 1,
.channel = INGENIC_ADC_TOUCH_XP,
.scan_index = 0,
.scan_type = {
.sign = 'u',
.realbits = 12,
.storagebits = 16,
},
},
{
.type = IIO_VOLTAGE,
.indexed = 1,
.channel = INGENIC_ADC_TOUCH_YP,
.scan_index = 1,
.scan_type = {
.sign = 'u',
.realbits = 12,
.storagebits = 16,
},
},
{
.type = IIO_VOLTAGE,
.indexed = 1,
.channel = INGENIC_ADC_TOUCH_XN,
.scan_index = 2,
.scan_type = {
.sign = 'u',
.realbits = 12,
.storagebits = 16,
},
},
{
.type = IIO_VOLTAGE,
.indexed = 1,
.channel = INGENIC_ADC_TOUCH_YN,
.scan_index = 3,
.scan_type = {
.sign = 'u',
.realbits = 12,
.storagebits = 16,
},
},
{
.type = IIO_VOLTAGE,
.indexed = 1,
.channel = INGENIC_ADC_TOUCH_XD,
.scan_index = 4,
.scan_type = {
.sign = 'u',
.realbits = 12,
.storagebits = 16,
},
},
{
.type = IIO_VOLTAGE,
.indexed = 1,
.channel = INGENIC_ADC_TOUCH_YD,
.scan_index = 5,
.scan_type = {
.sign = 'u',
.realbits = 12,
.storagebits = 16,
},
},
{
.extend_name = "aux",
.type = IIO_VOLTAGE,
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
BIT(IIO_CHAN_INFO_SCALE),
.indexed = 1,
.channel = INGENIC_ADC_AUX,
.scan_index = -1,
},
{
.extend_name = "battery",
.type = IIO_VOLTAGE,
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
BIT(IIO_CHAN_INFO_SCALE),
.info_mask_separate_available = BIT(IIO_CHAN_INFO_RAW) |
BIT(IIO_CHAN_INFO_SCALE),
.indexed = 1,
.channel = INGENIC_ADC_BATTERY,
.scan_index = -1,
},
{
.extend_name = "aux2",
.type = IIO_VOLTAGE,
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
BIT(IIO_CHAN_INFO_SCALE),
.indexed = 1,
.channel = INGENIC_ADC_AUX2,
.scan_index = -1,
},
};
static const struct ingenic_adc_soc_data jz4725b_adc_soc_data = { static const struct ingenic_adc_soc_data jz4725b_adc_soc_data = {
.battery_high_vref = JZ4725B_ADC_BATTERY_HIGH_VREF, .battery_high_vref = JZ4725B_ADC_BATTERY_HIGH_VREF,
.battery_high_vref_bits = JZ4725B_ADC_BATTERY_HIGH_VREF_BITS, .battery_high_vref_bits = JZ4725B_ADC_BATTERY_HIGH_VREF_BITS,
@ -261,6 +487,8 @@ static const struct ingenic_adc_soc_data jz4725b_adc_soc_data = {
.battery_scale_avail_size = ARRAY_SIZE(jz4725b_adc_battery_scale_avail), .battery_scale_avail_size = ARRAY_SIZE(jz4725b_adc_battery_scale_avail),
.battery_vref_mode = true, .battery_vref_mode = true,
.has_aux2 = false, .has_aux2 = false,
.channels = jz4740_channels,
.num_channels = ARRAY_SIZE(jz4740_channels),
.init_clk_div = jz4725b_adc_init_clk_div, .init_clk_div = jz4725b_adc_init_clk_div,
}; };
@ -273,6 +501,8 @@ static const struct ingenic_adc_soc_data jz4740_adc_soc_data = {
.battery_scale_avail_size = ARRAY_SIZE(jz4740_adc_battery_scale_avail), .battery_scale_avail_size = ARRAY_SIZE(jz4740_adc_battery_scale_avail),
.battery_vref_mode = true, .battery_vref_mode = true,
.has_aux2 = false, .has_aux2 = false,
.channels = jz4740_channels,
.num_channels = ARRAY_SIZE(jz4740_channels),
.init_clk_div = NULL, /* no ADCLK register on JZ4740 */ .init_clk_div = NULL, /* no ADCLK register on JZ4740 */
}; };
@ -285,6 +515,8 @@ static const struct ingenic_adc_soc_data jz4770_adc_soc_data = {
.battery_scale_avail_size = ARRAY_SIZE(jz4770_adc_battery_scale_avail), .battery_scale_avail_size = ARRAY_SIZE(jz4770_adc_battery_scale_avail),
.battery_vref_mode = false, .battery_vref_mode = false,
.has_aux2 = true, .has_aux2 = true,
.channels = jz4770_channels,
.num_channels = ARRAY_SIZE(jz4770_channels),
.init_clk_div = jz4770_adc_init_clk_div, .init_clk_div = jz4770_adc_init_clk_div,
}; };
@ -313,11 +545,19 @@ static int ingenic_adc_read_avail(struct iio_dev *iio_dev,
}; };
} }
static int ingenic_adc_read_chan_info_raw(struct ingenic_adc *adc, static int ingenic_adc_read_chan_info_raw(struct iio_dev *iio_dev,
struct iio_chan_spec const *chan, struct iio_chan_spec const *chan,
int *val) int *val)
{ {
int bit, ret, engine = (chan->channel == INGENIC_ADC_BATTERY); int bit, ret, engine = (chan->channel == INGENIC_ADC_BATTERY);
struct ingenic_adc *adc = iio_priv(iio_dev);
ret = clk_enable(adc->clk);
if (ret) {
dev_err(iio_dev->dev.parent, "Failed to enable clock: %d\n",
ret);
return ret;
}
/* We cannot sample AUX/AUX2 in parallel. */ /* We cannot sample AUX/AUX2 in parallel. */
mutex_lock(&adc->aux_lock); mutex_lock(&adc->aux_lock);
@ -326,7 +566,6 @@ static int ingenic_adc_read_chan_info_raw(struct ingenic_adc *adc,
ingenic_adc_set_config(adc, JZ_ADC_REG_CFG_AUX_MD, bit); ingenic_adc_set_config(adc, JZ_ADC_REG_CFG_AUX_MD, bit);
} }
clk_enable(adc->clk);
ret = ingenic_adc_capture(adc, engine); ret = ingenic_adc_capture(adc, engine);
if (ret) if (ret)
goto out; goto out;
@ -343,8 +582,8 @@ static int ingenic_adc_read_chan_info_raw(struct ingenic_adc *adc,
ret = IIO_VAL_INT; ret = IIO_VAL_INT;
out: out:
clk_disable(adc->clk);
mutex_unlock(&adc->aux_lock); mutex_unlock(&adc->aux_lock);
clk_disable(adc->clk);
return ret; return ret;
} }
@ -359,7 +598,7 @@ static int ingenic_adc_read_raw(struct iio_dev *iio_dev,
switch (m) { switch (m) {
case IIO_CHAN_INFO_RAW: case IIO_CHAN_INFO_RAW:
return ingenic_adc_read_chan_info_raw(adc, chan, val); return ingenic_adc_read_chan_info_raw(iio_dev, chan, val);
case IIO_CHAN_INFO_SCALE: case IIO_CHAN_INFO_SCALE:
switch (chan->channel) { switch (chan->channel) {
case INGENIC_ADC_AUX: case INGENIC_ADC_AUX:
@ -384,6 +623,21 @@ static int ingenic_adc_read_raw(struct iio_dev *iio_dev,
} }
} }
static int ingenic_adc_of_xlate(struct iio_dev *iio_dev,
const struct of_phandle_args *iiospec)
{
int i;
if (!iiospec->args_count)
return -EINVAL;
for (i = 0; i < iio_dev->num_channels; ++i)
if (iio_dev->channels[i].channel == iiospec->args[0])
return i;
return -EINVAL;
}
static void ingenic_adc_clk_cleanup(void *data) static void ingenic_adc_clk_cleanup(void *data)
{ {
clk_unprepare(data); clk_unprepare(data);
@ -393,44 +647,92 @@ static const struct iio_info ingenic_adc_info = {
.write_raw = ingenic_adc_write_raw, .write_raw = ingenic_adc_write_raw,
.read_raw = ingenic_adc_read_raw, .read_raw = ingenic_adc_read_raw,
.read_avail = ingenic_adc_read_avail, .read_avail = ingenic_adc_read_avail,
.of_xlate = ingenic_adc_of_xlate,
}; };
static const struct iio_chan_spec ingenic_channels[] = { static int ingenic_adc_buffer_enable(struct iio_dev *iio_dev)
{ {
.extend_name = "aux", struct ingenic_adc *adc = iio_priv(iio_dev);
.type = IIO_VOLTAGE, int ret;
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
BIT(IIO_CHAN_INFO_SCALE), ret = clk_enable(adc->clk);
.indexed = 1, if (ret) {
.channel = INGENIC_ADC_AUX, dev_err(iio_dev->dev.parent, "Failed to enable clock: %d\n",
}, ret);
{ return ret;
.extend_name = "battery", }
.type = IIO_VOLTAGE,
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | /* It takes significant time for the touchscreen hw to stabilize. */
BIT(IIO_CHAN_INFO_SCALE), msleep(50);
.info_mask_separate_available = BIT(IIO_CHAN_INFO_RAW) | ingenic_adc_set_config(adc, JZ_ADC_REG_CFG_TOUCH_OPS_MASK,
BIT(IIO_CHAN_INFO_SCALE), JZ_ADC_REG_CFG_SAMPLE_NUM(4) |
.indexed = 1, JZ_ADC_REG_CFG_PULL_UP(4));
.channel = INGENIC_ADC_BATTERY,
}, writew(80, adc->base + JZ_ADC_REG_ADWAIT);
{ /* Must always be last in the array. */ writew(2, adc->base + JZ_ADC_REG_ADSAME);
.extend_name = "aux2", writeb((u8)~JZ_ADC_IRQ_TOUCH, adc->base + JZ_ADC_REG_CTRL);
.type = IIO_VOLTAGE, writel(0, adc->base + JZ_ADC_REG_ADTCH);
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
BIT(IIO_CHAN_INFO_SCALE), ingenic_adc_set_config(adc, JZ_ADC_REG_CFG_CMD_SEL,
.indexed = 1, JZ_ADC_REG_CFG_CMD_SEL);
.channel = INGENIC_ADC_AUX2, ingenic_adc_set_adcmd(iio_dev, iio_dev->active_scan_mask[0]);
},
ingenic_adc_enable(adc, 2, true);
return 0;
}
static int ingenic_adc_buffer_disable(struct iio_dev *iio_dev)
{
struct ingenic_adc *adc = iio_priv(iio_dev);
ingenic_adc_enable(adc, 2, false);
ingenic_adc_set_config(adc, JZ_ADC_REG_CFG_CMD_SEL, 0);
writeb(0xff, adc->base + JZ_ADC_REG_CTRL);
writeb(0xff, adc->base + JZ_ADC_REG_STATUS);
ingenic_adc_set_config(adc, JZ_ADC_REG_CFG_TOUCH_OPS_MASK, 0);
writew(0, adc->base + JZ_ADC_REG_ADSAME);
writew(0, adc->base + JZ_ADC_REG_ADWAIT);
clk_disable(adc->clk);
return 0;
}
static const struct iio_buffer_setup_ops ingenic_buffer_setup_ops = {
.postenable = &ingenic_adc_buffer_enable,
.predisable = &ingenic_adc_buffer_disable
}; };
static irqreturn_t ingenic_adc_irq(int irq, void *data)
{
struct iio_dev *iio_dev = data;
struct ingenic_adc *adc = iio_priv(iio_dev);
unsigned long mask = iio_dev->active_scan_mask[0];
unsigned int i;
u32 tdat[3];
for (i = 0; i < ARRAY_SIZE(tdat); mask >>= 2, i++) {
if (mask & 0x3)
tdat[i] = readl(adc->base + JZ_ADC_REG_ADTCH);
else
tdat[i] = 0;
}
iio_push_to_buffers(iio_dev, tdat);
writeb(JZ_ADC_IRQ_TOUCH, adc->base + JZ_ADC_REG_STATUS);
return IRQ_HANDLED;
}
static int ingenic_adc_probe(struct platform_device *pdev) static int ingenic_adc_probe(struct platform_device *pdev)
{ {
struct device *dev = &pdev->dev; struct device *dev = &pdev->dev;
struct iio_dev *iio_dev; struct iio_dev *iio_dev;
struct ingenic_adc *adc; struct ingenic_adc *adc;
const struct ingenic_adc_soc_data *soc_data; const struct ingenic_adc_soc_data *soc_data;
int ret; int irq, ret;
soc_data = device_get_match_data(dev); soc_data = device_get_match_data(dev);
if (!soc_data) if (!soc_data)
@ -445,6 +747,17 @@ static int ingenic_adc_probe(struct platform_device *pdev)
mutex_init(&adc->aux_lock); mutex_init(&adc->aux_lock);
adc->soc_data = soc_data; adc->soc_data = soc_data;
irq = platform_get_irq(pdev, 0);
if (irq < 0)
return irq;
ret = devm_request_irq(dev, irq, ingenic_adc_irq, 0,
dev_name(dev), iio_dev);
if (ret < 0) {
dev_err(dev, "Failed to request irq: %d\n", ret);
return ret;
}
adc->base = devm_platform_ioremap_resource(pdev, 0); adc->base = devm_platform_ioremap_resource(pdev, 0);
if (IS_ERR(adc->base)) if (IS_ERR(adc->base))
return PTR_ERR(adc->base); return PTR_ERR(adc->base);
@ -483,12 +796,10 @@ static int ingenic_adc_probe(struct platform_device *pdev)
} }
iio_dev->name = "jz-adc"; iio_dev->name = "jz-adc";
iio_dev->modes = INDIO_DIRECT_MODE; iio_dev->modes = INDIO_DIRECT_MODE | INDIO_BUFFER_SOFTWARE;
iio_dev->channels = ingenic_channels; iio_dev->setup_ops = &ingenic_buffer_setup_ops;
iio_dev->num_channels = ARRAY_SIZE(ingenic_channels); iio_dev->channels = soc_data->channels;
/* Remove AUX2 from the list of supported channels. */ iio_dev->num_channels = soc_data->num_channels;
if (!adc->soc_data->has_aux2)
iio_dev->num_channels -= 1;
iio_dev->info = &ingenic_adc_info; iio_dev->info = &ingenic_adc_info;
ret = devm_iio_device_register(dev, iio_dev); ret = devm_iio_device_register(dev, iio_dev);

View File

@ -7,5 +7,11 @@
#define INGENIC_ADC_AUX 0 #define INGENIC_ADC_AUX 0
#define INGENIC_ADC_BATTERY 1 #define INGENIC_ADC_BATTERY 1
#define INGENIC_ADC_AUX2 2 #define INGENIC_ADC_AUX2 2
#define INGENIC_ADC_TOUCH_XP 3
#define INGENIC_ADC_TOUCH_YP 4
#define INGENIC_ADC_TOUCH_XN 5
#define INGENIC_ADC_TOUCH_YN 6
#define INGENIC_ADC_TOUCH_XD 7
#define INGENIC_ADC_TOUCH_YD 8
#endif #endif