748 lines
18 KiB
C
748 lines
18 KiB
C
|
/*
|
||
|
* ADS1015 - Texas Instruments Analog-to-Digital Converter
|
||
|
*
|
||
|
* Copyright (c) 2016, Intel Corporation.
|
||
|
*
|
||
|
* This file is subject to the terms and conditions of version 2 of
|
||
|
* the GNU General Public License. See the file COPYING in the main
|
||
|
* directory of this archive for more details.
|
||
|
*
|
||
|
* IIO driver for ADS1015 ADC 7-bit I2C slave address:
|
||
|
* * 0x48 - ADDR connected to Ground
|
||
|
* * 0x49 - ADDR connected to Vdd
|
||
|
* * 0x4A - ADDR connected to SDA
|
||
|
* * 0x4B - ADDR connected to SCL
|
||
|
*/
|
||
|
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/i2c.h>
|
||
|
#include <linux/regmap.h>
|
||
|
#include <linux/pm_runtime.h>
|
||
|
#include <linux/mutex.h>
|
||
|
#include <linux/delay.h>
|
||
|
|
||
|
#include <linux/i2c/ads1015.h>
|
||
|
|
||
|
#include <linux/iio/iio.h>
|
||
|
#include <linux/iio/types.h>
|
||
|
#include <linux/iio/sysfs.h>
|
||
|
#include <linux/iio/buffer.h>
|
||
|
#include <linux/iio/triggered_buffer.h>
|
||
|
#include <linux/iio/trigger_consumer.h>
|
||
|
|
||
|
#define ADS1015_DRV_NAME "ads1015"
|
||
|
|
||
|
#define ADS1015_CONV_REG 0x00
|
||
|
#define ADS1015_CFG_REG 0x01
|
||
|
|
||
|
#define ADS1015_CFG_DR_SHIFT 5
|
||
|
#define ADS1015_CFG_MOD_SHIFT 8
|
||
|
#define ADS1015_CFG_PGA_SHIFT 9
|
||
|
#define ADS1015_CFG_MUX_SHIFT 12
|
||
|
|
||
|
#define ADS1015_CFG_DR_MASK GENMASK(7, 5)
|
||
|
#define ADS1015_CFG_MOD_MASK BIT(8)
|
||
|
#define ADS1015_CFG_PGA_MASK GENMASK(11, 9)
|
||
|
#define ADS1015_CFG_MUX_MASK GENMASK(14, 12)
|
||
|
|
||
|
/* device operating modes */
|
||
|
#define ADS1015_CONTINUOUS 0
|
||
|
#define ADS1015_SINGLESHOT 1
|
||
|
|
||
|
#define ADS1015_SLEEP_DELAY_MS 2000
|
||
|
#define ADS1015_DEFAULT_PGA 2
|
||
|
#define ADS1015_DEFAULT_DATA_RATE 4
|
||
|
#define ADS1015_DEFAULT_CHAN 0
|
||
|
|
||
|
enum {
|
||
|
ADS1015,
|
||
|
ADS1115,
|
||
|
};
|
||
|
|
||
|
enum ads1015_channels {
|
||
|
ADS1015_AIN0_AIN1 = 0,
|
||
|
ADS1015_AIN0_AIN3,
|
||
|
ADS1015_AIN1_AIN3,
|
||
|
ADS1015_AIN2_AIN3,
|
||
|
ADS1015_AIN0,
|
||
|
ADS1015_AIN1,
|
||
|
ADS1015_AIN2,
|
||
|
ADS1015_AIN3,
|
||
|
ADS1015_TIMESTAMP,
|
||
|
};
|
||
|
|
||
|
static const unsigned int ads1015_data_rate[] = {
|
||
|
128, 250, 490, 920, 1600, 2400, 3300, 3300
|
||
|
};
|
||
|
|
||
|
static const unsigned int ads1115_data_rate[] = {
|
||
|
8, 16, 32, 64, 128, 250, 475, 860
|
||
|
};
|
||
|
|
||
|
/*
|
||
|
* Translation from PGA bits to full-scale positive and negative input voltage
|
||
|
* range in mV
|
||
|
*/
|
||
|
static int ads1015_fullscale_range[] = {
|
||
|
6144, 4096, 2048, 1024, 512, 256, 256, 256
|
||
|
};
|
||
|
|
||
|
#define ADS1015_V_CHAN(_chan, _addr) { \
|
||
|
.type = IIO_VOLTAGE, \
|
||
|
.indexed = 1, \
|
||
|
.address = _addr, \
|
||
|
.channel = _chan, \
|
||
|
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
|
||
|
BIT(IIO_CHAN_INFO_SCALE) | \
|
||
|
BIT(IIO_CHAN_INFO_SAMP_FREQ), \
|
||
|
.scan_index = _addr, \
|
||
|
.scan_type = { \
|
||
|
.sign = 's', \
|
||
|
.realbits = 12, \
|
||
|
.storagebits = 16, \
|
||
|
.shift = 4, \
|
||
|
.endianness = IIO_CPU, \
|
||
|
}, \
|
||
|
.datasheet_name = "AIN"#_chan, \
|
||
|
}
|
||
|
|
||
|
#define ADS1015_V_DIFF_CHAN(_chan, _chan2, _addr) { \
|
||
|
.type = IIO_VOLTAGE, \
|
||
|
.differential = 1, \
|
||
|
.indexed = 1, \
|
||
|
.address = _addr, \
|
||
|
.channel = _chan, \
|
||
|
.channel2 = _chan2, \
|
||
|
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
|
||
|
BIT(IIO_CHAN_INFO_SCALE) | \
|
||
|
BIT(IIO_CHAN_INFO_SAMP_FREQ), \
|
||
|
.scan_index = _addr, \
|
||
|
.scan_type = { \
|
||
|
.sign = 's', \
|
||
|
.realbits = 12, \
|
||
|
.storagebits = 16, \
|
||
|
.shift = 4, \
|
||
|
.endianness = IIO_CPU, \
|
||
|
}, \
|
||
|
.datasheet_name = "AIN"#_chan"-AIN"#_chan2, \
|
||
|
}
|
||
|
|
||
|
#define ADS1115_V_CHAN(_chan, _addr) { \
|
||
|
.type = IIO_VOLTAGE, \
|
||
|
.indexed = 1, \
|
||
|
.address = _addr, \
|
||
|
.channel = _chan, \
|
||
|
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
|
||
|
BIT(IIO_CHAN_INFO_SCALE) | \
|
||
|
BIT(IIO_CHAN_INFO_SAMP_FREQ), \
|
||
|
.scan_index = _addr, \
|
||
|
.scan_type = { \
|
||
|
.sign = 's', \
|
||
|
.realbits = 16, \
|
||
|
.storagebits = 16, \
|
||
|
.endianness = IIO_CPU, \
|
||
|
}, \
|
||
|
.datasheet_name = "AIN"#_chan, \
|
||
|
}
|
||
|
|
||
|
#define ADS1115_V_DIFF_CHAN(_chan, _chan2, _addr) { \
|
||
|
.type = IIO_VOLTAGE, \
|
||
|
.differential = 1, \
|
||
|
.indexed = 1, \
|
||
|
.address = _addr, \
|
||
|
.channel = _chan, \
|
||
|
.channel2 = _chan2, \
|
||
|
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
|
||
|
BIT(IIO_CHAN_INFO_SCALE) | \
|
||
|
BIT(IIO_CHAN_INFO_SAMP_FREQ), \
|
||
|
.scan_index = _addr, \
|
||
|
.scan_type = { \
|
||
|
.sign = 's', \
|
||
|
.realbits = 16, \
|
||
|
.storagebits = 16, \
|
||
|
.endianness = IIO_CPU, \
|
||
|
}, \
|
||
|
.datasheet_name = "AIN"#_chan"-AIN"#_chan2, \
|
||
|
}
|
||
|
|
||
|
struct ads1015_data {
|
||
|
struct regmap *regmap;
|
||
|
/*
|
||
|
* Protects ADC ops, e.g: concurrent sysfs/buffered
|
||
|
* data reads, configuration updates
|
||
|
*/
|
||
|
struct mutex lock;
|
||
|
struct ads1015_channel_data channel_data[ADS1015_CHANNELS];
|
||
|
|
||
|
unsigned int *data_rate;
|
||
|
/*
|
||
|
* Set to true when the ADC is switched to the continuous-conversion
|
||
|
* mode and exits from a power-down state. This flag is used to avoid
|
||
|
* getting the stale result from the conversion register.
|
||
|
*/
|
||
|
bool conv_invalid;
|
||
|
};
|
||
|
|
||
|
static bool ads1015_is_writeable_reg(struct device *dev, unsigned int reg)
|
||
|
{
|
||
|
return (reg == ADS1015_CFG_REG);
|
||
|
}
|
||
|
|
||
|
static const struct regmap_config ads1015_regmap_config = {
|
||
|
.reg_bits = 8,
|
||
|
.val_bits = 16,
|
||
|
.max_register = ADS1015_CFG_REG,
|
||
|
.writeable_reg = ads1015_is_writeable_reg,
|
||
|
};
|
||
|
|
||
|
static const struct iio_chan_spec ads1015_channels[] = {
|
||
|
ADS1015_V_DIFF_CHAN(0, 1, ADS1015_AIN0_AIN1),
|
||
|
ADS1015_V_DIFF_CHAN(0, 3, ADS1015_AIN0_AIN3),
|
||
|
ADS1015_V_DIFF_CHAN(1, 3, ADS1015_AIN1_AIN3),
|
||
|
ADS1015_V_DIFF_CHAN(2, 3, ADS1015_AIN2_AIN3),
|
||
|
ADS1015_V_CHAN(0, ADS1015_AIN0),
|
||
|
ADS1015_V_CHAN(1, ADS1015_AIN1),
|
||
|
ADS1015_V_CHAN(2, ADS1015_AIN2),
|
||
|
ADS1015_V_CHAN(3, ADS1015_AIN3),
|
||
|
IIO_CHAN_SOFT_TIMESTAMP(ADS1015_TIMESTAMP),
|
||
|
};
|
||
|
|
||
|
static const struct iio_chan_spec ads1115_channels[] = {
|
||
|
ADS1115_V_DIFF_CHAN(0, 1, ADS1015_AIN0_AIN1),
|
||
|
ADS1115_V_DIFF_CHAN(0, 3, ADS1015_AIN0_AIN3),
|
||
|
ADS1115_V_DIFF_CHAN(1, 3, ADS1015_AIN1_AIN3),
|
||
|
ADS1115_V_DIFF_CHAN(2, 3, ADS1015_AIN2_AIN3),
|
||
|
ADS1115_V_CHAN(0, ADS1015_AIN0),
|
||
|
ADS1115_V_CHAN(1, ADS1015_AIN1),
|
||
|
ADS1115_V_CHAN(2, ADS1015_AIN2),
|
||
|
ADS1115_V_CHAN(3, ADS1015_AIN3),
|
||
|
IIO_CHAN_SOFT_TIMESTAMP(ADS1015_TIMESTAMP),
|
||
|
};
|
||
|
|
||
|
#ifdef CONFIG_PM
|
||
|
static int ads1015_set_power_state(struct ads1015_data *data, bool on)
|
||
|
{
|
||
|
int ret;
|
||
|
struct device *dev = regmap_get_device(data->regmap);
|
||
|
|
||
|
if (on) {
|
||
|
ret = pm_runtime_get_sync(dev);
|
||
|
if (ret < 0)
|
||
|
pm_runtime_put_noidle(dev);
|
||
|
} else {
|
||
|
pm_runtime_mark_last_busy(dev);
|
||
|
ret = pm_runtime_put_autosuspend(dev);
|
||
|
}
|
||
|
|
||
|
return ret < 0 ? ret : 0;
|
||
|
}
|
||
|
|
||
|
#else /* !CONFIG_PM */
|
||
|
|
||
|
static int ads1015_set_power_state(struct ads1015_data *data, bool on)
|
||
|
{
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
#endif /* !CONFIG_PM */
|
||
|
|
||
|
static
|
||
|
int ads1015_get_adc_result(struct ads1015_data *data, int chan, int *val)
|
||
|
{
|
||
|
int ret, pga, dr, conv_time;
|
||
|
unsigned int old, mask, cfg;
|
||
|
|
||
|
if (chan < 0 || chan >= ADS1015_CHANNELS)
|
||
|
return -EINVAL;
|
||
|
|
||
|
ret = regmap_read(data->regmap, ADS1015_CFG_REG, &old);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
pga = data->channel_data[chan].pga;
|
||
|
dr = data->channel_data[chan].data_rate;
|
||
|
mask = ADS1015_CFG_MUX_MASK | ADS1015_CFG_PGA_MASK |
|
||
|
ADS1015_CFG_DR_MASK;
|
||
|
cfg = chan << ADS1015_CFG_MUX_SHIFT | pga << ADS1015_CFG_PGA_SHIFT |
|
||
|
dr << ADS1015_CFG_DR_SHIFT;
|
||
|
|
||
|
cfg = (old & ~mask) | (cfg & mask);
|
||
|
|
||
|
ret = regmap_write(data->regmap, ADS1015_CFG_REG, cfg);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
if (old != cfg || data->conv_invalid) {
|
||
|
int dr_old = (old & ADS1015_CFG_DR_MASK) >>
|
||
|
ADS1015_CFG_DR_SHIFT;
|
||
|
|
||
|
conv_time = DIV_ROUND_UP(USEC_PER_SEC, data->data_rate[dr_old]);
|
||
|
conv_time += DIV_ROUND_UP(USEC_PER_SEC, data->data_rate[dr]);
|
||
|
conv_time += conv_time / 10; /* 10% internal clock inaccuracy */
|
||
|
usleep_range(conv_time, conv_time + 1);
|
||
|
data->conv_invalid = false;
|
||
|
}
|
||
|
|
||
|
return regmap_read(data->regmap, ADS1015_CONV_REG, val);
|
||
|
}
|
||
|
|
||
|
static irqreturn_t ads1015_trigger_handler(int irq, void *p)
|
||
|
{
|
||
|
struct iio_poll_func *pf = p;
|
||
|
struct iio_dev *indio_dev = pf->indio_dev;
|
||
|
struct ads1015_data *data = iio_priv(indio_dev);
|
||
|
s16 buf[8]; /* 1x s16 ADC val + 3x s16 padding + 4x s16 timestamp */
|
||
|
int chan, ret, res;
|
||
|
|
||
|
memset(buf, 0, sizeof(buf));
|
||
|
|
||
|
mutex_lock(&data->lock);
|
||
|
chan = find_first_bit(indio_dev->active_scan_mask,
|
||
|
indio_dev->masklength);
|
||
|
ret = ads1015_get_adc_result(data, chan, &res);
|
||
|
if (ret < 0) {
|
||
|
mutex_unlock(&data->lock);
|
||
|
goto err;
|
||
|
}
|
||
|
|
||
|
buf[0] = res;
|
||
|
mutex_unlock(&data->lock);
|
||
|
|
||
|
iio_push_to_buffers_with_timestamp(indio_dev, buf,
|
||
|
iio_get_time_ns(indio_dev));
|
||
|
|
||
|
err:
|
||
|
iio_trigger_notify_done(indio_dev->trig);
|
||
|
|
||
|
return IRQ_HANDLED;
|
||
|
}
|
||
|
|
||
|
static int ads1015_set_scale(struct ads1015_data *data,
|
||
|
struct iio_chan_spec const *chan,
|
||
|
int scale, int uscale)
|
||
|
{
|
||
|
int i, ret, rindex = -1;
|
||
|
int fullscale = div_s64((scale * 1000000LL + uscale) <<
|
||
|
(chan->scan_type.realbits - 1), 1000000);
|
||
|
|
||
|
for (i = 0; i < ARRAY_SIZE(ads1015_fullscale_range); i++) {
|
||
|
if (ads1015_fullscale_range[i] == fullscale) {
|
||
|
rindex = i;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
if (rindex < 0)
|
||
|
return -EINVAL;
|
||
|
|
||
|
ret = regmap_update_bits(data->regmap, ADS1015_CFG_REG,
|
||
|
ADS1015_CFG_PGA_MASK,
|
||
|
rindex << ADS1015_CFG_PGA_SHIFT);
|
||
|
if (ret < 0)
|
||
|
return ret;
|
||
|
|
||
|
data->channel_data[chan->address].pga = rindex;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int ads1015_set_data_rate(struct ads1015_data *data, int chan, int rate)
|
||
|
{
|
||
|
int i;
|
||
|
|
||
|
for (i = 0; i < ARRAY_SIZE(ads1015_data_rate); i++) {
|
||
|
if (data->data_rate[i] == rate) {
|
||
|
data->channel_data[chan].data_rate = i;
|
||
|
return 0;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
static int ads1015_read_raw(struct iio_dev *indio_dev,
|
||
|
struct iio_chan_spec const *chan, int *val,
|
||
|
int *val2, long mask)
|
||
|
{
|
||
|
int ret, idx;
|
||
|
struct ads1015_data *data = iio_priv(indio_dev);
|
||
|
|
||
|
mutex_lock(&indio_dev->mlock);
|
||
|
mutex_lock(&data->lock);
|
||
|
switch (mask) {
|
||
|
case IIO_CHAN_INFO_RAW: {
|
||
|
int shift = chan->scan_type.shift;
|
||
|
|
||
|
if (iio_buffer_enabled(indio_dev)) {
|
||
|
ret = -EBUSY;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
ret = ads1015_set_power_state(data, true);
|
||
|
if (ret < 0)
|
||
|
break;
|
||
|
|
||
|
ret = ads1015_get_adc_result(data, chan->address, val);
|
||
|
if (ret < 0) {
|
||
|
ads1015_set_power_state(data, false);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
*val = sign_extend32(*val >> shift, 15 - shift);
|
||
|
|
||
|
ret = ads1015_set_power_state(data, false);
|
||
|
if (ret < 0)
|
||
|
break;
|
||
|
|
||
|
ret = IIO_VAL_INT;
|
||
|
break;
|
||
|
}
|
||
|
case IIO_CHAN_INFO_SCALE:
|
||
|
idx = data->channel_data[chan->address].pga;
|
||
|
*val = ads1015_fullscale_range[idx];
|
||
|
*val2 = chan->scan_type.realbits - 1;
|
||
|
ret = IIO_VAL_FRACTIONAL_LOG2;
|
||
|
break;
|
||
|
case IIO_CHAN_INFO_SAMP_FREQ:
|
||
|
idx = data->channel_data[chan->address].data_rate;
|
||
|
*val = data->data_rate[idx];
|
||
|
ret = IIO_VAL_INT;
|
||
|
break;
|
||
|
default:
|
||
|
ret = -EINVAL;
|
||
|
break;
|
||
|
}
|
||
|
mutex_unlock(&data->lock);
|
||
|
mutex_unlock(&indio_dev->mlock);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int ads1015_write_raw(struct iio_dev *indio_dev,
|
||
|
struct iio_chan_spec const *chan, int val,
|
||
|
int val2, long mask)
|
||
|
{
|
||
|
struct ads1015_data *data = iio_priv(indio_dev);
|
||
|
int ret;
|
||
|
|
||
|
mutex_lock(&data->lock);
|
||
|
switch (mask) {
|
||
|
case IIO_CHAN_INFO_SCALE:
|
||
|
ret = ads1015_set_scale(data, chan, val, val2);
|
||
|
break;
|
||
|
case IIO_CHAN_INFO_SAMP_FREQ:
|
||
|
ret = ads1015_set_data_rate(data, chan->address, val);
|
||
|
break;
|
||
|
default:
|
||
|
ret = -EINVAL;
|
||
|
break;
|
||
|
}
|
||
|
mutex_unlock(&data->lock);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int ads1015_buffer_preenable(struct iio_dev *indio_dev)
|
||
|
{
|
||
|
return ads1015_set_power_state(iio_priv(indio_dev), true);
|
||
|
}
|
||
|
|
||
|
static int ads1015_buffer_postdisable(struct iio_dev *indio_dev)
|
||
|
{
|
||
|
return ads1015_set_power_state(iio_priv(indio_dev), false);
|
||
|
}
|
||
|
|
||
|
static const struct iio_buffer_setup_ops ads1015_buffer_setup_ops = {
|
||
|
.preenable = ads1015_buffer_preenable,
|
||
|
.postenable = iio_triggered_buffer_postenable,
|
||
|
.predisable = iio_triggered_buffer_predisable,
|
||
|
.postdisable = ads1015_buffer_postdisable,
|
||
|
.validate_scan_mask = &iio_validate_scan_mask_onehot,
|
||
|
};
|
||
|
|
||
|
static IIO_CONST_ATTR_NAMED(ads1015_scale_available, scale_available,
|
||
|
"3 2 1 0.5 0.25 0.125");
|
||
|
static IIO_CONST_ATTR_NAMED(ads1115_scale_available, scale_available,
|
||
|
"0.1875 0.125 0.0625 0.03125 0.015625 0.007813");
|
||
|
|
||
|
static IIO_CONST_ATTR_NAMED(ads1015_sampling_frequency_available,
|
||
|
sampling_frequency_available, "128 250 490 920 1600 2400 3300");
|
||
|
static IIO_CONST_ATTR_NAMED(ads1115_sampling_frequency_available,
|
||
|
sampling_frequency_available, "8 16 32 64 128 250 475 860");
|
||
|
|
||
|
static struct attribute *ads1015_attributes[] = {
|
||
|
&iio_const_attr_ads1015_scale_available.dev_attr.attr,
|
||
|
&iio_const_attr_ads1015_sampling_frequency_available.dev_attr.attr,
|
||
|
NULL,
|
||
|
};
|
||
|
|
||
|
static const struct attribute_group ads1015_attribute_group = {
|
||
|
.attrs = ads1015_attributes,
|
||
|
};
|
||
|
|
||
|
static struct attribute *ads1115_attributes[] = {
|
||
|
&iio_const_attr_ads1115_scale_available.dev_attr.attr,
|
||
|
&iio_const_attr_ads1115_sampling_frequency_available.dev_attr.attr,
|
||
|
NULL,
|
||
|
};
|
||
|
|
||
|
static const struct attribute_group ads1115_attribute_group = {
|
||
|
.attrs = ads1115_attributes,
|
||
|
};
|
||
|
|
||
|
static struct iio_info ads1015_info = {
|
||
|
.driver_module = THIS_MODULE,
|
||
|
.read_raw = ads1015_read_raw,
|
||
|
.write_raw = ads1015_write_raw,
|
||
|
.attrs = &ads1015_attribute_group,
|
||
|
};
|
||
|
|
||
|
static struct iio_info ads1115_info = {
|
||
|
.driver_module = THIS_MODULE,
|
||
|
.read_raw = ads1015_read_raw,
|
||
|
.write_raw = ads1015_write_raw,
|
||
|
.attrs = &ads1115_attribute_group,
|
||
|
};
|
||
|
|
||
|
#ifdef CONFIG_OF
|
||
|
static int ads1015_get_channels_config_of(struct i2c_client *client)
|
||
|
{
|
||
|
struct iio_dev *indio_dev = i2c_get_clientdata(client);
|
||
|
struct ads1015_data *data = iio_priv(indio_dev);
|
||
|
struct device_node *node;
|
||
|
|
||
|
if (!client->dev.of_node ||
|
||
|
!of_get_next_child(client->dev.of_node, NULL))
|
||
|
return -EINVAL;
|
||
|
|
||
|
for_each_child_of_node(client->dev.of_node, node) {
|
||
|
u32 pval;
|
||
|
unsigned int channel;
|
||
|
unsigned int pga = ADS1015_DEFAULT_PGA;
|
||
|
unsigned int data_rate = ADS1015_DEFAULT_DATA_RATE;
|
||
|
|
||
|
if (of_property_read_u32(node, "reg", &pval)) {
|
||
|
dev_err(&client->dev, "invalid reg on %s\n",
|
||
|
node->full_name);
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
channel = pval;
|
||
|
if (channel >= ADS1015_CHANNELS) {
|
||
|
dev_err(&client->dev,
|
||
|
"invalid channel index %d on %s\n",
|
||
|
channel, node->full_name);
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
if (!of_property_read_u32(node, "ti,gain", &pval)) {
|
||
|
pga = pval;
|
||
|
if (pga > 6) {
|
||
|
dev_err(&client->dev, "invalid gain on %s\n",
|
||
|
node->full_name);
|
||
|
of_node_put(node);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (!of_property_read_u32(node, "ti,datarate", &pval)) {
|
||
|
data_rate = pval;
|
||
|
if (data_rate > 7) {
|
||
|
dev_err(&client->dev,
|
||
|
"invalid data_rate on %s\n",
|
||
|
node->full_name);
|
||
|
of_node_put(node);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
data->channel_data[channel].pga = pga;
|
||
|
data->channel_data[channel].data_rate = data_rate;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
static void ads1015_get_channels_config(struct i2c_client *client)
|
||
|
{
|
||
|
unsigned int k;
|
||
|
|
||
|
struct iio_dev *indio_dev = i2c_get_clientdata(client);
|
||
|
struct ads1015_data *data = iio_priv(indio_dev);
|
||
|
struct ads1015_platform_data *pdata = dev_get_platdata(&client->dev);
|
||
|
|
||
|
/* prefer platform data */
|
||
|
if (pdata) {
|
||
|
memcpy(data->channel_data, pdata->channel_data,
|
||
|
sizeof(data->channel_data));
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
#ifdef CONFIG_OF
|
||
|
if (!ads1015_get_channels_config_of(client))
|
||
|
return;
|
||
|
#endif
|
||
|
/* fallback on default configuration */
|
||
|
for (k = 0; k < ADS1015_CHANNELS; ++k) {
|
||
|
data->channel_data[k].pga = ADS1015_DEFAULT_PGA;
|
||
|
data->channel_data[k].data_rate = ADS1015_DEFAULT_DATA_RATE;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static int ads1015_probe(struct i2c_client *client,
|
||
|
const struct i2c_device_id *id)
|
||
|
{
|
||
|
struct iio_dev *indio_dev;
|
||
|
struct ads1015_data *data;
|
||
|
int ret;
|
||
|
|
||
|
indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
|
||
|
if (!indio_dev)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
data = iio_priv(indio_dev);
|
||
|
i2c_set_clientdata(client, indio_dev);
|
||
|
|
||
|
mutex_init(&data->lock);
|
||
|
|
||
|
indio_dev->dev.parent = &client->dev;
|
||
|
indio_dev->dev.of_node = client->dev.of_node;
|
||
|
indio_dev->name = ADS1015_DRV_NAME;
|
||
|
indio_dev->modes = INDIO_DIRECT_MODE;
|
||
|
|
||
|
switch (id->driver_data) {
|
||
|
case ADS1015:
|
||
|
indio_dev->channels = ads1015_channels;
|
||
|
indio_dev->num_channels = ARRAY_SIZE(ads1015_channels);
|
||
|
indio_dev->info = &ads1015_info;
|
||
|
data->data_rate = (unsigned int *) &ads1015_data_rate;
|
||
|
break;
|
||
|
case ADS1115:
|
||
|
indio_dev->channels = ads1115_channels;
|
||
|
indio_dev->num_channels = ARRAY_SIZE(ads1115_channels);
|
||
|
indio_dev->info = &ads1115_info;
|
||
|
data->data_rate = (unsigned int *) &ads1115_data_rate;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
/* we need to keep this ABI the same as used by hwmon ADS1015 driver */
|
||
|
ads1015_get_channels_config(client);
|
||
|
|
||
|
data->regmap = devm_regmap_init_i2c(client, &ads1015_regmap_config);
|
||
|
if (IS_ERR(data->regmap)) {
|
||
|
dev_err(&client->dev, "Failed to allocate register map\n");
|
||
|
return PTR_ERR(data->regmap);
|
||
|
}
|
||
|
|
||
|
ret = iio_triggered_buffer_setup(indio_dev, NULL,
|
||
|
ads1015_trigger_handler,
|
||
|
&ads1015_buffer_setup_ops);
|
||
|
if (ret < 0) {
|
||
|
dev_err(&client->dev, "iio triggered buffer setup failed\n");
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
ret = regmap_update_bits(data->regmap, ADS1015_CFG_REG,
|
||
|
ADS1015_CFG_MOD_MASK,
|
||
|
ADS1015_CONTINUOUS << ADS1015_CFG_MOD_SHIFT);
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
data->conv_invalid = true;
|
||
|
|
||
|
ret = pm_runtime_set_active(&client->dev);
|
||
|
if (ret)
|
||
|
goto err_buffer_cleanup;
|
||
|
pm_runtime_set_autosuspend_delay(&client->dev, ADS1015_SLEEP_DELAY_MS);
|
||
|
pm_runtime_use_autosuspend(&client->dev);
|
||
|
pm_runtime_enable(&client->dev);
|
||
|
|
||
|
ret = iio_device_register(indio_dev);
|
||
|
if (ret < 0) {
|
||
|
dev_err(&client->dev, "Failed to register IIO device\n");
|
||
|
goto err_buffer_cleanup;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
err_buffer_cleanup:
|
||
|
iio_triggered_buffer_cleanup(indio_dev);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int ads1015_remove(struct i2c_client *client)
|
||
|
{
|
||
|
struct iio_dev *indio_dev = i2c_get_clientdata(client);
|
||
|
struct ads1015_data *data = iio_priv(indio_dev);
|
||
|
|
||
|
iio_device_unregister(indio_dev);
|
||
|
|
||
|
pm_runtime_disable(&client->dev);
|
||
|
pm_runtime_set_suspended(&client->dev);
|
||
|
pm_runtime_put_noidle(&client->dev);
|
||
|
|
||
|
iio_triggered_buffer_cleanup(indio_dev);
|
||
|
|
||
|
/* power down single shot mode */
|
||
|
return regmap_update_bits(data->regmap, ADS1015_CFG_REG,
|
||
|
ADS1015_CFG_MOD_MASK,
|
||
|
ADS1015_SINGLESHOT << ADS1015_CFG_MOD_SHIFT);
|
||
|
}
|
||
|
|
||
|
#ifdef CONFIG_PM
|
||
|
static int ads1015_runtime_suspend(struct device *dev)
|
||
|
{
|
||
|
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
||
|
struct ads1015_data *data = iio_priv(indio_dev);
|
||
|
|
||
|
return regmap_update_bits(data->regmap, ADS1015_CFG_REG,
|
||
|
ADS1015_CFG_MOD_MASK,
|
||
|
ADS1015_SINGLESHOT << ADS1015_CFG_MOD_SHIFT);
|
||
|
}
|
||
|
|
||
|
static int ads1015_runtime_resume(struct device *dev)
|
||
|
{
|
||
|
struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
|
||
|
struct ads1015_data *data = iio_priv(indio_dev);
|
||
|
int ret;
|
||
|
|
||
|
ret = regmap_update_bits(data->regmap, ADS1015_CFG_REG,
|
||
|
ADS1015_CFG_MOD_MASK,
|
||
|
ADS1015_CONTINUOUS << ADS1015_CFG_MOD_SHIFT);
|
||
|
if (!ret)
|
||
|
data->conv_invalid = true;
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
static const struct dev_pm_ops ads1015_pm_ops = {
|
||
|
SET_RUNTIME_PM_OPS(ads1015_runtime_suspend,
|
||
|
ads1015_runtime_resume, NULL)
|
||
|
};
|
||
|
|
||
|
static const struct i2c_device_id ads1015_id[] = {
|
||
|
{"ads1015", ADS1015},
|
||
|
{"ads1115", ADS1115},
|
||
|
{}
|
||
|
};
|
||
|
MODULE_DEVICE_TABLE(i2c, ads1015_id);
|
||
|
|
||
|
static struct i2c_driver ads1015_driver = {
|
||
|
.driver = {
|
||
|
.name = ADS1015_DRV_NAME,
|
||
|
.pm = &ads1015_pm_ops,
|
||
|
},
|
||
|
.probe = ads1015_probe,
|
||
|
.remove = ads1015_remove,
|
||
|
.id_table = ads1015_id,
|
||
|
};
|
||
|
|
||
|
module_i2c_driver(ads1015_driver);
|
||
|
|
||
|
MODULE_AUTHOR("Daniel Baluta <daniel.baluta@intel.com>");
|
||
|
MODULE_DESCRIPTION("Texas Instruments ADS1015 ADC driver");
|
||
|
MODULE_LICENSE("GPL v2");
|