|
@@ -35,8 +35,9 @@
|
|
|
#define CC10001_ADC_EOC_SET BIT(0)
|
|
|
|
|
|
#define CC10001_ADC_CHSEL_SAMPLED 0x0c
|
|
|
-#define CC10001_ADC_POWER_UP 0x10
|
|
|
-#define CC10001_ADC_POWER_UP_SET BIT(0)
|
|
|
+#define CC10001_ADC_POWER_DOWN 0x10
|
|
|
+#define CC10001_ADC_POWER_DOWN_SET BIT(0)
|
|
|
+
|
|
|
#define CC10001_ADC_DEBUG 0x14
|
|
|
#define CC10001_ADC_DATA_COUNT 0x20
|
|
|
|
|
@@ -62,7 +63,6 @@ struct cc10001_adc_device {
|
|
|
u16 *buf;
|
|
|
|
|
|
struct mutex lock;
|
|
|
- unsigned long channel_map;
|
|
|
unsigned int start_delay_ns;
|
|
|
unsigned int eoc_delay_ns;
|
|
|
};
|
|
@@ -79,6 +79,18 @@ static inline u32 cc10001_adc_read_reg(struct cc10001_adc_device *adc_dev,
|
|
|
return readl(adc_dev->reg_base + reg);
|
|
|
}
|
|
|
|
|
|
+static void cc10001_adc_power_up(struct cc10001_adc_device *adc_dev)
|
|
|
+{
|
|
|
+ cc10001_adc_write_reg(adc_dev, CC10001_ADC_POWER_DOWN, 0);
|
|
|
+ ndelay(adc_dev->start_delay_ns);
|
|
|
+}
|
|
|
+
|
|
|
+static void cc10001_adc_power_down(struct cc10001_adc_device *adc_dev)
|
|
|
+{
|
|
|
+ cc10001_adc_write_reg(adc_dev, CC10001_ADC_POWER_DOWN,
|
|
|
+ CC10001_ADC_POWER_DOWN_SET);
|
|
|
+}
|
|
|
+
|
|
|
static void cc10001_adc_start(struct cc10001_adc_device *adc_dev,
|
|
|
unsigned int channel)
|
|
|
{
|
|
@@ -88,6 +100,7 @@ static void cc10001_adc_start(struct cc10001_adc_device *adc_dev,
|
|
|
val = (channel & CC10001_ADC_CH_MASK) | CC10001_ADC_MODE_SINGLE_CONV;
|
|
|
cc10001_adc_write_reg(adc_dev, CC10001_ADC_CONFIG, val);
|
|
|
|
|
|
+ udelay(1);
|
|
|
val = cc10001_adc_read_reg(adc_dev, CC10001_ADC_CONFIG);
|
|
|
val = val | CC10001_ADC_START_CONV;
|
|
|
cc10001_adc_write_reg(adc_dev, CC10001_ADC_CONFIG, val);
|
|
@@ -129,6 +142,7 @@ static irqreturn_t cc10001_adc_trigger_h(int irq, void *p)
|
|
|
struct iio_dev *indio_dev;
|
|
|
unsigned int delay_ns;
|
|
|
unsigned int channel;
|
|
|
+ unsigned int scan_idx;
|
|
|
bool sample_invalid;
|
|
|
u16 *data;
|
|
|
int i;
|
|
@@ -139,20 +153,17 @@ static irqreturn_t cc10001_adc_trigger_h(int irq, void *p)
|
|
|
|
|
|
mutex_lock(&adc_dev->lock);
|
|
|
|
|
|
- cc10001_adc_write_reg(adc_dev, CC10001_ADC_POWER_UP,
|
|
|
- CC10001_ADC_POWER_UP_SET);
|
|
|
-
|
|
|
- /* Wait for 8 (6+2) clock cycles before activating START */
|
|
|
- ndelay(adc_dev->start_delay_ns);
|
|
|
+ cc10001_adc_power_up(adc_dev);
|
|
|
|
|
|
/* Calculate delay step for eoc and sampled data */
|
|
|
delay_ns = adc_dev->eoc_delay_ns / CC10001_MAX_POLL_COUNT;
|
|
|
|
|
|
i = 0;
|
|
|
sample_invalid = false;
|
|
|
- for_each_set_bit(channel, indio_dev->active_scan_mask,
|
|
|
+ for_each_set_bit(scan_idx, indio_dev->active_scan_mask,
|
|
|
indio_dev->masklength) {
|
|
|
|
|
|
+ channel = indio_dev->channels[scan_idx].channel;
|
|
|
cc10001_adc_start(adc_dev, channel);
|
|
|
|
|
|
data[i] = cc10001_adc_poll_done(indio_dev, channel, delay_ns);
|
|
@@ -166,7 +177,7 @@ static irqreturn_t cc10001_adc_trigger_h(int irq, void *p)
|
|
|
}
|
|
|
|
|
|
done:
|
|
|
- cc10001_adc_write_reg(adc_dev, CC10001_ADC_POWER_UP, 0);
|
|
|
+ cc10001_adc_power_down(adc_dev);
|
|
|
|
|
|
mutex_unlock(&adc_dev->lock);
|
|
|
|
|
@@ -185,11 +196,7 @@ static u16 cc10001_adc_read_raw_voltage(struct iio_dev *indio_dev,
|
|
|
unsigned int delay_ns;
|
|
|
u16 val;
|
|
|
|
|
|
- cc10001_adc_write_reg(adc_dev, CC10001_ADC_POWER_UP,
|
|
|
- CC10001_ADC_POWER_UP_SET);
|
|
|
-
|
|
|
- /* Wait for 8 (6+2) clock cycles before activating START */
|
|
|
- ndelay(adc_dev->start_delay_ns);
|
|
|
+ cc10001_adc_power_up(adc_dev);
|
|
|
|
|
|
/* Calculate delay step for eoc and sampled data */
|
|
|
delay_ns = adc_dev->eoc_delay_ns / CC10001_MAX_POLL_COUNT;
|
|
@@ -198,7 +205,7 @@ static u16 cc10001_adc_read_raw_voltage(struct iio_dev *indio_dev,
|
|
|
|
|
|
val = cc10001_adc_poll_done(indio_dev, chan->channel, delay_ns);
|
|
|
|
|
|
- cc10001_adc_write_reg(adc_dev, CC10001_ADC_POWER_UP, 0);
|
|
|
+ cc10001_adc_power_down(adc_dev);
|
|
|
|
|
|
return val;
|
|
|
}
|
|
@@ -224,7 +231,7 @@ static int cc10001_adc_read_raw(struct iio_dev *indio_dev,
|
|
|
|
|
|
case IIO_CHAN_INFO_SCALE:
|
|
|
ret = regulator_get_voltage(adc_dev->reg);
|
|
|
- if (ret)
|
|
|
+ if (ret < 0)
|
|
|
return ret;
|
|
|
|
|
|
*val = ret / 1000;
|
|
@@ -255,22 +262,22 @@ static const struct iio_info cc10001_adc_info = {
|
|
|
.update_scan_mode = &cc10001_update_scan_mode,
|
|
|
};
|
|
|
|
|
|
-static int cc10001_adc_channel_init(struct iio_dev *indio_dev)
|
|
|
+static int cc10001_adc_channel_init(struct iio_dev *indio_dev,
|
|
|
+ unsigned long channel_map)
|
|
|
{
|
|
|
- struct cc10001_adc_device *adc_dev = iio_priv(indio_dev);
|
|
|
struct iio_chan_spec *chan_array, *timestamp;
|
|
|
unsigned int bit, idx = 0;
|
|
|
|
|
|
- indio_dev->num_channels = bitmap_weight(&adc_dev->channel_map,
|
|
|
- CC10001_ADC_NUM_CHANNELS);
|
|
|
+ indio_dev->num_channels = bitmap_weight(&channel_map,
|
|
|
+ CC10001_ADC_NUM_CHANNELS) + 1;
|
|
|
|
|
|
- chan_array = devm_kcalloc(&indio_dev->dev, indio_dev->num_channels + 1,
|
|
|
+ chan_array = devm_kcalloc(&indio_dev->dev, indio_dev->num_channels,
|
|
|
sizeof(struct iio_chan_spec),
|
|
|
GFP_KERNEL);
|
|
|
if (!chan_array)
|
|
|
return -ENOMEM;
|
|
|
|
|
|
- for_each_set_bit(bit, &adc_dev->channel_map, CC10001_ADC_NUM_CHANNELS) {
|
|
|
+ for_each_set_bit(bit, &channel_map, CC10001_ADC_NUM_CHANNELS) {
|
|
|
struct iio_chan_spec *chan = &chan_array[idx];
|
|
|
|
|
|
chan->type = IIO_VOLTAGE;
|
|
@@ -305,6 +312,7 @@ static int cc10001_adc_probe(struct platform_device *pdev)
|
|
|
unsigned long adc_clk_rate;
|
|
|
struct resource *res;
|
|
|
struct iio_dev *indio_dev;
|
|
|
+ unsigned long channel_map;
|
|
|
int ret;
|
|
|
|
|
|
indio_dev = devm_iio_device_alloc(&pdev->dev, sizeof(*adc_dev));
|
|
@@ -313,9 +321,9 @@ static int cc10001_adc_probe(struct platform_device *pdev)
|
|
|
|
|
|
adc_dev = iio_priv(indio_dev);
|
|
|
|
|
|
- adc_dev->channel_map = GENMASK(CC10001_ADC_NUM_CHANNELS - 1, 0);
|
|
|
+ channel_map = GENMASK(CC10001_ADC_NUM_CHANNELS - 1, 0);
|
|
|
if (!of_property_read_u32(node, "adc-reserved-channels", &ret))
|
|
|
- adc_dev->channel_map &= ~ret;
|
|
|
+ channel_map &= ~ret;
|
|
|
|
|
|
adc_dev->reg = devm_regulator_get(&pdev->dev, "vref");
|
|
|
if (IS_ERR(adc_dev->reg))
|
|
@@ -361,7 +369,7 @@ static int cc10001_adc_probe(struct platform_device *pdev)
|
|
|
adc_dev->start_delay_ns = adc_dev->eoc_delay_ns * CC10001_WAIT_CYCLES;
|
|
|
|
|
|
/* Setup the ADC channels available on the device */
|
|
|
- ret = cc10001_adc_channel_init(indio_dev);
|
|
|
+ ret = cc10001_adc_channel_init(indio_dev, channel_map);
|
|
|
if (ret < 0)
|
|
|
goto err_disable_clk;
|
|
|
|