Skip to content

L
linux
Commit 1180c883 authored by Greg Kroah-Hartman's avatar Greg Kroah-Hartman
Browse files
Options

Merge tag 'iio-for-3.8b' of... 

Merge tag 'iio-for-3.8b' of git://git.kernel.org/pub/scm/linux/kernel/git/jic23/iio into staging-next

Second round of new IIO drivers and cleanups for the 3.8 cycle.

Usual mixed bag of cleanups and minor improvements including
one reversion for a patch in the previous series.

* adt7310 and adt7410 drivers merged into one.
* Revert use devm_kcalloc in at91_adc (because it doesn't exist)
* unlocking fix for error path in the ad5449
* isl29018 suspend and resume support.
* improved pseudo floating point parsing for info_mask write
attributes (and hence into write_raw).  Reject some messed up
strings.
parents abcdc99f 1e45cf3c
Hide whitespace changes
Inline Side-by-side
Showing with 427 additions and 1002 deletions
drivers/iio/adc/at91_adc.c
View file @ 1180c883
...@@ -123,8 +123,10 @@ static int at91_adc_channel_init(struct iio_dev *idev) ...@@ -123,8 +123,10 @@ static int at91_adc_channel_init(struct iio_dev *idev)
idev->num_channels = bitmap_weight(&st->channels_mask, idev->num_channels = bitmap_weight(&st->channels_mask,
st->num_channels) + 1; st->num_channels) + 1;
chan_array = devm_kcalloc(&idev->dev, idev->num_channels + 1, chan_array = devm_kzalloc(&idev->dev,
sizeof(*chan_array), GFP_KERNEL); ((idev->num_channels + 1) *
sizeof(struct iio_chan_spec)),
GFP_KERNEL);
if (!chan_array) if (!chan_array)
return -ENOMEM; return -ENOMEM;
...@@ -268,8 +270,9 @@ static int at91_adc_trigger_init(struct iio_dev *idev) ...@@ -268,8 +270,9 @@ static int at91_adc_trigger_init(struct iio_dev *idev)
struct at91_adc_state *st = iio_priv(idev); struct at91_adc_state *st = iio_priv(idev);
int i, ret; int i, ret;
st->trig = devm_kcalloc(&idev->dev, st->trigger_number, st->trig = devm_kzalloc(&idev->dev,
sizeof(*st->trig), GFP_KERNEL); st->trigger_number * sizeof(st->trig),
GFP_KERNEL);
if (st->trig == NULL) { if (st->trig == NULL) {
ret = -ENOMEM; ret = -ENOMEM;
...@@ -451,8 +454,9 @@ static int at91_adc_probe_dt(struct at91_adc_state *st, ...@@ -451,8 +454,9 @@ static int at91_adc_probe_dt(struct at91_adc_state *st,
st->registers->trigger_register = prop; st->registers->trigger_register = prop;
st->trigger_number = of_get_child_count(node); st->trigger_number = of_get_child_count(node);
st->trigger_list = devm_kcalloc(&idev->dev, st->trigger_number, st->trigger_list = devm_kzalloc(&idev->dev, st->trigger_number *
sizeof(*st->trigger_list), GFP_KERNEL); sizeof(struct at91_adc_trigger),
GFP_KERNEL);
if (!st->trigger_list) { if (!st->trigger_list) {
dev_err(&idev->dev, "Could not allocate trigger list memory.\n"); dev_err(&idev->dev, "Could not allocate trigger list memory.\n");
ret = -ENOMEM; ret = -ENOMEM;
......
drivers/iio/dac/ad5449.c
View file @ 1180c883
...@@ -124,12 +124,13 @@ static int ad5449_read(struct iio_dev *indio_dev, unsigned int addr, ...@@ -124,12 +124,13 @@ static int ad5449_read(struct iio_dev *indio_dev, unsigned int addr,
ret = spi_sync(st->spi, &msg); ret = spi_sync(st->spi, &msg);
if (ret < 0) if (ret < 0)
return ret; goto out_unlock;
*val = be16_to_cpu(st->data[1]); *val = be16_to_cpu(st->data[1]);
mutex_unlock(&indio_dev->mlock);
return 0; out_unlock:
mutex_unlock(&indio_dev->mlock);
return ret;
} }
static int ad5449_read_raw(struct iio_dev *indio_dev, static int ad5449_read_raw(struct iio_dev *indio_dev,
......
drivers/iio/industrialio-core.c
View file @ 1180c883
...@@ -437,6 +437,8 @@ static ssize_t iio_write_channel_info(struct device *dev, ...@@ -437,6 +437,8 @@ static ssize_t iio_write_channel_info(struct device *dev,
if (buf[0] == '-') { if (buf[0] == '-') {
negative = true; negative = true;
buf++; buf++;
} else if (buf[0] == '+') {
buf++;
} }
while (*buf) { while (*buf) {
...@@ -445,8 +447,6 @@ static ssize_t iio_write_channel_info(struct device *dev, ...@@ -445,8 +447,6 @@ static ssize_t iio_write_channel_info(struct device *dev,
integer = integer*10 + *buf - '0'; integer = integer*10 + *buf - '0';
else { else {
fract += fract_mult*(*buf - '0'); fract += fract_mult*(*buf - '0');
if (fract_mult == 1)
break;
fract_mult /= 10; fract_mult /= 10;
} }
} else if (*buf == '\n') { } else if (*buf == '\n') {
...@@ -454,7 +454,7 @@ static ssize_t iio_write_channel_info(struct device *dev, ...@@ -454,7 +454,7 @@ static ssize_t iio_write_channel_info(struct device *dev,
break; break;
else else
return -EINVAL; return -EINVAL;
} else if (*buf == '.') { } else if (*buf == '.' && integer_part) {
integer_part = false; integer_part = false;
} else { } else {
return -EINVAL; return -EINVAL;
......
drivers/staging/iio/adc/Kconfig
View file @ 1180c883
...@@ -126,18 +126,11 @@ config AD7192 ...@@ -126,18 +126,11 @@ config AD7192
To compile this driver as a module, choose M here: the To compile this driver as a module, choose M here: the
module will be called ad7192. module will be called ad7192.
config ADT7310
tristate "Analog Devices ADT7310 temperature sensor driver"
depends on SPI
help
Say yes here to build support for Analog Devices ADT7310
temperature sensors.
config ADT7410 config ADT7410
tristate "Analog Devices ADT7410 temperature sensor driver" tristate "Analog Devices ADT7310/ADT7410 temperature sensor driver"
depends on I2C depends on I2C || SPI_MASTER
help help
Say yes here to build support for Analog Devices ADT7410 Say yes here to build support for Analog Devices ADT7310/ADT7410
temperature sensors. temperature sensors.
config AD7280 config AD7280
......
drivers/staging/iio/adc/Makefile
View file @ 1180c883
...@@ -30,7 +30,6 @@ obj-$(CONFIG_AD7780) += ad7780.o ...@@ -30,7 +30,6 @@ obj-$(CONFIG_AD7780) += ad7780.o
obj-$(CONFIG_AD7793) += ad7793.o obj-$(CONFIG_AD7793) += ad7793.o
obj-$(CONFIG_AD7816) += ad7816.o obj-$(CONFIG_AD7816) += ad7816.o
obj-$(CONFIG_AD7192) += ad7192.o obj-$(CONFIG_AD7192) += ad7192.o
obj-$(CONFIG_ADT7310) += adt7310.o
obj-$(CONFIG_ADT7410) += adt7410.o obj-$(CONFIG_ADT7410) += adt7410.o
obj-$(CONFIG_AD7280) += ad7280a.o obj-$(CONFIG_AD7280) += ad7280a.o
obj-$(CONFIG_LPC32XX_ADC) += lpc32xx_adc.o obj-$(CONFIG_LPC32XX_ADC) += lpc32xx_adc.o
......
drivers/staging/iio/adc/ad7280a.c
View file @ 1180c883
...@@ -117,7 +117,7 @@ ...@@ -117,7 +117,7 @@
*/ */
#define POLYNOM 0x2F #define POLYNOM 0x2F
#define POLYNOM_ORDER 8 #define POLYNOM_ORDER 8
#define HIGHBIT 1 << (POLYNOM_ORDER - 1); #define HIGHBIT (1 << (POLYNOM_ORDER - 1))
struct ad7280_state { struct ad7280_state {
struct spi_device *spi; struct spi_device *spi;
......
drivers/staging/iio/adc/adt7310.c deleted 100644 → 0
View file @ abcdc99f
/*
* ADT7310 digital temperature sensor driver supporting ADT7310
*
* Copyright 2010 Analog Devices Inc.
*
* Licensed under the GPL-2 or later.
*/
#include <linux/interrupt.h>
#include <linux/device.h>
#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/sysfs.h>
#include <linux/list.h>
#include <linux/spi/spi.h>
#include <linux/module.h>
#include <linux/iio/iio.h>
#include <linux/iio/sysfs.h>
#include <linux/iio/events.h>
/*
* ADT7310 registers definition
*/
#define ADT7310_STATUS 0
#define ADT7310_CONFIG 1
#define ADT7310_TEMPERATURE 2
#define ADT7310_ID 3
#define ADT7310_T_CRIT 4
#define ADT7310_T_HYST 5
#define ADT7310_T_ALARM_HIGH 6
#define ADT7310_T_ALARM_LOW 7
/*
* ADT7310 status
*/
#define ADT7310_STAT_T_LOW 0x10
#define ADT7310_STAT_T_HIGH 0x20
#define ADT7310_STAT_T_CRIT 0x40
#define ADT7310_STAT_NOT_RDY 0x80
/*
* ADT7310 config
*/
#define ADT7310_FAULT_QUEUE_MASK 0x3
#define ADT7310_CT_POLARITY 0x4
#define ADT7310_INT_POLARITY 0x8
#define ADT7310_EVENT_MODE 0x10
#define ADT7310_MODE_MASK 0x60
#define ADT7310_ONESHOT 0x20
#define ADT7310_SPS 0x40
#define ADT7310_PD 0x60
#define ADT7310_RESOLUTION 0x80
/*
* ADT7310 masks
*/
#define ADT7310_T16_VALUE_SIGN 0x8000
#define ADT7310_T16_VALUE_FLOAT_OFFSET 7
#define ADT7310_T16_VALUE_FLOAT_MASK 0x7F
#define ADT7310_T13_VALUE_SIGN 0x1000
#define ADT7310_T13_VALUE_OFFSET 3
#define ADT7310_T13_VALUE_FLOAT_OFFSET 4
#define ADT7310_T13_VALUE_FLOAT_MASK 0xF
#define ADT7310_T_HYST_MASK 0xF
#define ADT7310_DEVICE_ID_MASK 0x7
#define ADT7310_MANUFACTORY_ID_MASK 0xF8
#define ADT7310_MANUFACTORY_ID_OFFSET 3
#define ADT7310_CMD_REG_MASK 0x28
#define ADT7310_CMD_REG_OFFSET 3
#define ADT7310_CMD_READ 0x40
#define ADT7310_CMD_CON_READ 0x4
#define ADT7310_IRQS 2
/*
* struct adt7310_chip_info - chip specifc information
*/
struct adt7310_chip_info {
struct spi_device *spi_dev;
u8 config;
};
/*
* adt7310 register access by SPI
*/
static int adt7310_spi_read_word(struct adt7310_chip_info *chip, u8 reg, u16 *data)
{
struct spi_device *spi_dev = chip->spi_dev;
u8 command = (reg << ADT7310_CMD_REG_OFFSET) & ADT7310_CMD_REG_MASK;
int ret = 0;
command |= ADT7310_CMD_READ;
ret = spi_write(spi_dev, &command, sizeof(command));
if (ret < 0) {
dev_err(&spi_dev->dev, "SPI write command error\n");
return ret;
}
ret = spi_read(spi_dev, (u8 *)data, sizeof(*data));
if (ret < 0) {
dev_err(&spi_dev->dev, "SPI read word error\n");
return ret;
}
*data = be16_to_cpu(*data);
return 0;
}
static int adt7310_spi_write_word(struct adt7310_chip_info *chip, u8 reg, u16 data)
{
struct spi_device *spi_dev = chip->spi_dev;
u8 buf[3];
int ret = 0;
buf[0] = (reg << ADT7310_CMD_REG_OFFSET) & ADT7310_CMD_REG_MASK;
buf[1] = (u8)(data >> 8);
buf[2] = (u8)(data & 0xFF);
ret = spi_write(spi_dev, buf, 3);
if (ret < 0) {
dev_err(&spi_dev->dev, "SPI write word error\n");
return ret;
}
return ret;
}
static int adt7310_spi_read_byte(struct adt7310_chip_info *chip, u8 reg, u8 *data)
{
struct spi_device *spi_dev = chip->spi_dev;
u8 command = (reg << ADT7310_CMD_REG_OFFSET) & ADT7310_CMD_REG_MASK;
int ret = 0;
command |= ADT7310_CMD_READ;
ret = spi_write(spi_dev, &command, sizeof(command));
if (ret < 0) {
dev_err(&spi_dev->dev, "SPI write command error\n");
return ret;
}
ret = spi_read(spi_dev, data, sizeof(*data));
if (ret < 0) {
dev_err(&spi_dev->dev, "SPI read byte error\n");
return ret;
}
return 0;
}
static int adt7310_spi_write_byte(struct adt7310_chip_info *chip, u8 reg, u8 data)
{
struct spi_device *spi_dev = chip->spi_dev;
u8 buf[2];
int ret = 0;
buf[0] = (reg << ADT7310_CMD_REG_OFFSET) & ADT7310_CMD_REG_MASK;
buf[1] = data;
ret = spi_write(spi_dev, buf, 2);
if (ret < 0) {
dev_err(&spi_dev->dev, "SPI write byte error\n");
return ret;
}
return ret;
}
static ssize_t adt7310_show_mode(struct device *dev,
struct device_attribute *attr,
char *buf)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
u8 config;
config = chip->config & ADT7310_MODE_MASK;
switch (config) {
case ADT7310_PD:
return sprintf(buf, "power-down\n");
case ADT7310_ONESHOT:
return sprintf(buf, "one-shot\n");
case ADT7310_SPS:
return sprintf(buf, "sps\n");
default:
return sprintf(buf, "full\n");
}
}
static ssize_t adt7310_store_mode(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t len)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
u16 config;
int ret;
ret = adt7310_spi_read_byte(chip, ADT7310_CONFIG, &chip->config);
if (ret)
return -EIO;
config = chip->config & (~ADT7310_MODE_MASK);
if (strcmp(buf, "power-down"))
config |= ADT7310_PD;
else if (strcmp(buf, "one-shot"))
config |= ADT7310_ONESHOT;
else if (strcmp(buf, "sps"))
config |= ADT7310_SPS;
ret = adt7310_spi_write_byte(chip, ADT7310_CONFIG, config);
if (ret)
return -EIO;
chip->config = config;
return len;
}
static IIO_DEVICE_ATTR(mode, S_IRUGO | S_IWUSR,
adt7310_show_mode,
adt7310_store_mode,
0);
static ssize_t adt7310_show_available_modes(struct device *dev,
struct device_attribute *attr,
char *buf)
{
return sprintf(buf, "full\none-shot\nsps\npower-down\n");
}
static IIO_DEVICE_ATTR(available_modes, S_IRUGO, adt7310_show_available_modes, NULL, 0);
static ssize_t adt7310_show_resolution(struct device *dev,
struct device_attribute *attr,
char *buf)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
int ret;
int bits;
ret = adt7310_spi_read_byte(chip, ADT7310_CONFIG, &chip->config);
if (ret)
return -EIO;
if (chip->config & ADT7310_RESOLUTION)
bits = 16;
else
bits = 13;
return sprintf(buf, "%d bits\n", bits);
}
static ssize_t adt7310_store_resolution(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t len)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
unsigned long data;
u16 config;
int ret;
ret = strict_strtoul(buf, 10, &data);
if (ret)
return -EINVAL;
ret = adt7310_spi_read_byte(chip, ADT7310_CONFIG, &chip->config);
if (ret)
return -EIO;
config = chip->config & (~ADT7310_RESOLUTION);
if (data)
config |= ADT7310_RESOLUTION;
ret = adt7310_spi_write_byte(chip, ADT7310_CONFIG, config);
if (ret)
return -EIO;
chip->config = config;
return len;
}
static IIO_DEVICE_ATTR(resolution, S_IRUGO | S_IWUSR,
adt7310_show_resolution,
adt7310_store_resolution,
0);
static ssize_t adt7310_show_id(struct device *dev,
struct device_attribute *attr,
char *buf)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
u8 id;
int ret;
ret = adt7310_spi_read_byte(chip, ADT7310_ID, &id);
if (ret)
return -EIO;
return sprintf(buf, "device id: 0x%x\nmanufactory id: 0x%x\n",
id & ADT7310_DEVICE_ID_MASK,
(id & ADT7310_MANUFACTORY_ID_MASK) >> ADT7310_MANUFACTORY_ID_OFFSET);
}
static IIO_DEVICE_ATTR(id, S_IRUGO | S_IWUSR,
adt7310_show_id,
NULL,
0);
static ssize_t adt7310_convert_temperature(struct adt7310_chip_info *chip,
u16 data, char *buf)
{
char sign = ' ';
if (chip->config & ADT7310_RESOLUTION) {
if (data & ADT7310_T16_VALUE_SIGN) {
/* convert supplement to positive value */
data = (u16)((ADT7310_T16_VALUE_SIGN << 1) - (u32)data);
sign = '-';
}
return sprintf(buf, "%c%d.%.7d\n", sign,
(data >> ADT7310_T16_VALUE_FLOAT_OFFSET),
(data & ADT7310_T16_VALUE_FLOAT_MASK) * 78125);
} else {
if (data & ADT7310_T13_VALUE_SIGN) {
/* convert supplement to positive value */
data >>= ADT7310_T13_VALUE_OFFSET;
data = (ADT7310_T13_VALUE_SIGN << 1) - data;
sign = '-';
}
return sprintf(buf, "%c%d.%.4d\n", sign,
(data >> ADT7310_T13_VALUE_FLOAT_OFFSET),
(data & ADT7310_T13_VALUE_FLOAT_MASK) * 625);
}
}
static ssize_t adt7310_show_value(struct device *dev,
struct device_attribute *attr,
char *buf)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
u8 status;
u16 data;
int ret, i = 0;
do {
ret = adt7310_spi_read_byte(chip, ADT7310_STATUS, &status);
if (ret)
return -EIO;
i++;
if (i == 10000)
return -EIO;
} while (status & ADT7310_STAT_NOT_RDY);
ret = adt7310_spi_read_word(chip, ADT7310_TEMPERATURE, &data);
if (ret)
return -EIO;
return adt7310_convert_temperature(chip, data, buf);
}
static IIO_DEVICE_ATTR(value, S_IRUGO, adt7310_show_value, NULL, 0);
static struct attribute *adt7310_attributes[] = {
&iio_dev_attr_available_modes.dev_attr.attr,
&iio_dev_attr_mode.dev_attr.attr,
&iio_dev_attr_resolution.dev_attr.attr,
&iio_dev_attr_id.dev_attr.attr,
&iio_dev_attr_value.dev_attr.attr,
NULL,
};
static const struct attribute_group adt7310_attribute_group = {
.attrs = adt7310_attributes,
};
static irqreturn_t adt7310_event_handler(int irq, void *private)
{
struct iio_dev *indio_dev = private;
struct adt7310_chip_info *chip = iio_priv(indio_dev);
s64 timestamp = iio_get_time_ns();
u8 status;
int ret;
ret = adt7310_spi_read_byte(chip, ADT7310_STATUS, &status);
if (ret)
goto done;
if (status & ADT7310_STAT_T_HIGH)
iio_push_event(indio_dev,
IIO_UNMOD_EVENT_CODE(IIO_TEMP, 0,
IIO_EV_TYPE_THRESH,
IIO_EV_DIR_RISING),
timestamp);
if (status & ADT7310_STAT_T_LOW)
iio_push_event(indio_dev,
IIO_UNMOD_EVENT_CODE(IIO_TEMP, 0,
IIO_EV_TYPE_THRESH,
IIO_EV_DIR_FALLING),
timestamp);
if (status & ADT7310_STAT_T_CRIT)
iio_push_event(indio_dev,
IIO_UNMOD_EVENT_CODE(IIO_TEMP, 0,
IIO_EV_TYPE_THRESH,
IIO_EV_DIR_RISING),
timestamp);
done:
return IRQ_HANDLED;
}
static ssize_t adt7310_show_event_mode(struct device *dev,
struct device_attribute *attr,
char *buf)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
int ret;
ret = adt7310_spi_read_byte(chip, ADT7310_CONFIG, &chip->config);
if (ret)
return -EIO;
if (chip->config & ADT7310_EVENT_MODE)
return sprintf(buf, "interrupt\n");
else
return sprintf(buf, "comparator\n");
}
static ssize_t adt7310_set_event_mode(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t len)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
u16 config;
int ret;
ret = adt7310_spi_read_byte(chip, ADT7310_CONFIG, &chip->config);
if (ret)
return -EIO;
config = chip->config &= ~ADT7310_EVENT_MODE;
if (strcmp(buf, "comparator") != 0)
config |= ADT7310_EVENT_MODE;
ret = adt7310_spi_write_byte(chip, ADT7310_CONFIG, config);
if (ret)
return -EIO;
chip->config = config;
return len;
}
static ssize_t adt7310_show_available_event_modes(struct device *dev,
struct device_attribute *attr,
char *buf)
{
return sprintf(buf, "comparator\ninterrupt\n");
}
static ssize_t adt7310_show_fault_queue(struct device *dev,
struct device_attribute *attr,
char *buf)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
int ret;
ret = adt7310_spi_read_byte(chip, ADT7310_CONFIG, &chip->config);
if (ret)
return -EIO;
return sprintf(buf, "%d\n", chip->config & ADT7310_FAULT_QUEUE_MASK);
}
static ssize_t adt7310_set_fault_queue(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t len)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
unsigned long data;
int ret;
u8 config;
ret = strict_strtoul(buf, 10, &data);
if (ret || data > 3)
return -EINVAL;
ret = adt7310_spi_read_byte(chip, ADT7310_CONFIG, &chip->config);
if (ret)
return -EIO;
config = chip->config & ~ADT7310_FAULT_QUEUE_MASK;
config |= data;
ret = adt7310_spi_write_byte(chip, ADT7310_CONFIG, config);
if (ret)
return -EIO;
chip->config = config;
return len;
}
static inline ssize_t adt7310_show_t_bound(struct device *dev,
struct device_attribute *attr,
u8 bound_reg,
char *buf)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
u16 data;
int ret;
ret = adt7310_spi_read_word(chip, bound_reg, &data);
if (ret)
return -EIO;
return adt7310_convert_temperature(chip, data, buf);
}
static inline ssize_t adt7310_set_t_bound(struct device *dev,
struct device_attribute *attr,
u8 bound_reg,
const char *buf,
size_t len)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
long tmp1, tmp2;
u16 data;
char *pos;
int ret;
pos = strchr(buf, '.');
ret = strict_strtol(buf, 10, &tmp1);
if (ret || tmp1 > 127 || tmp1 < -128)
return -EINVAL;
if (pos) {
len = strlen(pos);
if (chip->config & ADT7310_RESOLUTION) {
if (len > ADT7310_T16_VALUE_FLOAT_OFFSET)
len = ADT7310_T16_VALUE_FLOAT_OFFSET;
pos[len] = 0;
ret = strict_strtol(pos, 10, &tmp2);
if (!ret)
tmp2 = (tmp2 / 78125) * 78125;
} else {
if (len > ADT7310_T13_VALUE_FLOAT_OFFSET)
len = ADT7310_T13_VALUE_FLOAT_OFFSET;
pos[len] = 0;
ret = strict_strtol(pos, 10, &tmp2);
if (!ret)
tmp2 = (tmp2 / 625) * 625;
}
}
if (tmp1 < 0)
data = (u16)(-tmp1);
else
data = (u16)tmp1;
if (chip->config & ADT7310_RESOLUTION) {
data = (data << ADT7310_T16_VALUE_FLOAT_OFFSET) |
(tmp2 & ADT7310_T16_VALUE_FLOAT_MASK);
if (tmp1 < 0)
/* convert positive value to supplyment */
data = (u16)((ADT7310_T16_VALUE_SIGN << 1) - (u32)data);
} else {
data = (data << ADT7310_T13_VALUE_FLOAT_OFFSET) |
(tmp2 & ADT7310_T13_VALUE_FLOAT_MASK);
if (tmp1 < 0)
/* convert positive value to supplyment */
data = (ADT7310_T13_VALUE_SIGN << 1) - data;
data <<= ADT7310_T13_VALUE_OFFSET;
}
ret = adt7310_spi_write_word(chip, bound_reg, data);
if (ret)
return -EIO;
return len;
}
static ssize_t adt7310_show_t_alarm_high(struct device *dev,
struct device_attribute *attr,
char *buf)
{
return adt7310_show_t_bound(dev, attr,
ADT7310_T_ALARM_HIGH, buf);
}
static inline ssize_t adt7310_set_t_alarm_high(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t len)
{
return adt7310_set_t_bound(dev, attr,
ADT7310_T_ALARM_HIGH, buf, len);
}
static ssize_t adt7310_show_t_alarm_low(struct device *dev,
struct device_attribute *attr,
char *buf)
{
return adt7310_show_t_bound(dev, attr,
ADT7310_T_ALARM_LOW, buf);
}
static inline ssize_t adt7310_set_t_alarm_low(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t len)
{
return adt7310_set_t_bound(dev, attr,
ADT7310_T_ALARM_LOW, buf, len);
}
static ssize_t adt7310_show_t_crit(struct device *dev,
struct device_attribute *attr,
char *buf)
{
return adt7310_show_t_bound(dev, attr,
ADT7310_T_CRIT, buf);
}
static inline ssize_t adt7310_set_t_crit(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t len)
{
return adt7310_set_t_bound(dev, attr,
ADT7310_T_CRIT, buf, len);
}
static ssize_t adt7310_show_t_hyst(struct device *dev,
struct device_attribute *attr,
char *buf)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
int ret;
u8 t_hyst;
ret = adt7310_spi_read_byte(chip, ADT7310_T_HYST, &t_hyst);
if (ret)
return -EIO;
return sprintf(buf, "%d\n", t_hyst & ADT7310_T_HYST_MASK);
}
static inline ssize_t adt7310_set_t_hyst(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t len)
{
struct iio_dev *dev_info = dev_to_iio_dev(dev);
struct adt7310_chip_info *chip = iio_priv(dev_info);
int ret;
unsigned long data;
u8 t_hyst;
ret = strict_strtol(buf, 10, &data);
if (ret || data > ADT7310_T_HYST_MASK)
return -EINVAL;
t_hyst = (u8)data;
ret = adt7310_spi_write_byte(chip, ADT7310_T_HYST, t_hyst);
if (ret)
return -EIO;
return len;
}
static IIO_DEVICE_ATTR(event_mode,
S_IRUGO | S_IWUSR,
adt7310_show_event_mode, adt7310_set_event_mode, 0);
static IIO_DEVICE_ATTR(available_event_modes,
S_IRUGO | S_IWUSR,
adt7310_show_available_event_modes, NULL, 0);
static IIO_DEVICE_ATTR(fault_queue,
S_IRUGO | S_IWUSR,
adt7310_show_fault_queue, adt7310_set_fault_queue, 0);
static IIO_DEVICE_ATTR(t_alarm_high,
S_IRUGO | S_IWUSR,
adt7310_show_t_alarm_high, adt7310_set_t_alarm_high, 0);
static IIO_DEVICE_ATTR(t_alarm_low,
S_IRUGO | S_IWUSR,
adt7310_show_t_alarm_low, adt7310_set_t_alarm_low, 0);
static IIO_DEVICE_ATTR(t_crit,
S_IRUGO | S_IWUSR,
adt7310_show_t_crit, adt7310_set_t_crit, 0);
static IIO_DEVICE_ATTR(t_hyst,
S_IRUGO | S_IWUSR,
adt7310_show_t_hyst, adt7310_set_t_hyst, 0);
static struct attribute *adt7310_event_int_attributes[] = {
&iio_dev_attr_event_mode.dev_attr.attr,
&iio_dev_attr_available_event_modes.dev_attr.attr,
&iio_dev_attr_fault_queue.dev_attr.attr,
&iio_dev_attr_t_alarm_high.dev_attr.attr,
&iio_dev_attr_t_alarm_low.dev_attr.attr,
&iio_dev_attr_t_crit.dev_attr.attr,
&iio_dev_attr_t_hyst.dev_attr.attr,
NULL,
};
static struct attribute_group adt7310_event_attribute_group = {
.attrs = adt7310_event_int_attributes,
.name = "events",
};
static const struct iio_info adt7310_info = {
.attrs = &adt7310_attribute_group,
.event_attrs = &adt7310_event_attribute_group,
.driver_module = THIS_MODULE,
};
/*
* device probe and remove
*/
static int __devinit adt7310_probe(struct spi_device *spi_dev)
{
struct adt7310_chip_info *chip;
struct iio_dev *indio_dev;
int ret = 0;
unsigned long *adt7310_platform_data = spi_dev->dev.platform_data;
unsigned long irq_flags;
indio_dev = iio_device_alloc(sizeof(*chip));
if (indio_dev == NULL) {
ret = -ENOMEM;
goto error_ret;
}
chip = iio_priv(indio_dev);
/* this is only used for device removal purposes */
dev_set_drvdata(&spi_dev->dev, indio_dev);
chip->spi_dev = spi_dev;
indio_dev->dev.parent = &spi_dev->dev;
indio_dev->name = spi_get_device_id(spi_dev)->name;
indio_dev->info = &adt7310_info;
indio_dev->modes = INDIO_DIRECT_MODE;
/* CT critcal temperature event. line 0 */
if (spi_dev->irq) {
if (adt7310_platform_data[2])
irq_flags = adt7310_platform_data[2];
else
irq_flags = IRQF_TRIGGER_LOW;
ret = request_threaded_irq(spi_dev->irq,
NULL,
&adt7310_event_handler,
irq_flags | IRQF_ONESHOT,
indio_dev->name,
indio_dev);
if (ret)
goto error_free_dev;
}
/* INT bound temperature alarm event. line 1 */
if (adt7310_platform_data[0]) {
ret = request_threaded_irq(adt7310_platform_data[0],
NULL,
&adt7310_event_handler,
adt7310_platform_data[1] |
IRQF_ONESHOT,
indio_dev->name,
indio_dev);
if (ret)
goto error_unreg_ct_irq;
}
if (spi_dev->irq && adt7310_platform_data[0]) {
ret = adt7310_spi_read_byte(chip, ADT7310_CONFIG, &chip->config);
if (ret) {
ret = -EIO;
goto error_unreg_int_irq;
}
/* set irq polarity low level */
chip->config &= ~ADT7310_CT_POLARITY;
if (adt7310_platform_data[1] & IRQF_TRIGGER_HIGH)
chip->config |= ADT7310_INT_POLARITY;
else
chip->config &= ~ADT7310_INT_POLARITY;
ret = adt7310_spi_write_byte(chip, ADT7310_CONFIG, chip->config);
if (ret) {
ret = -EIO;
goto error_unreg_int_irq;
}
}
ret = iio_device_register(indio_dev);
if (ret)
goto error_unreg_int_irq;
dev_info(&spi_dev->dev, "%s temperature sensor registered.\n",
indio_dev->name);
return 0;
error_unreg_int_irq:
free_irq(adt7310_platform_data[0], indio_dev);
error_unreg_ct_irq:
free_irq(spi_dev->irq, indio_dev);
error_free_dev:
iio_device_free(indio_dev);
error_ret:
return ret;
}
static int __devexit adt7310_remove(struct spi_device *spi_dev)
{
struct iio_dev *indio_dev = dev_get_drvdata(&spi_dev->dev);
unsigned long *adt7310_platform_data = spi_dev->dev.platform_data;
iio_device_unregister(indio_dev);
dev_set_drvdata(&spi_dev->dev, NULL);
if (adt7310_platform_data[0])
free_irq(adt7310_platform_data[0], indio_dev);
if (spi_dev->irq)
free_irq(spi_dev->irq, indio_dev);
iio_device_free(indio_dev);
return 0;
}
static const struct spi_device_id adt7310_id[] = {
{ "adt7310", 0 },
{}
};
MODULE_DEVICE_TABLE(spi, adt7310_id);
static struct spi_driver adt7310_driver = {
.driver = {
.name = "adt7310",
.owner = THIS_MODULE,
},
.probe = adt7310_probe,
.remove = __devexit_p(adt7310_remove),
.id_table = adt7310_id,
};
module_spi_driver(adt7310_driver);
MODULE_AUTHOR("Sonic Zhang <sonic.zhang@analog.com>");
MODULE_DESCRIPTION("Analog Devices ADT7310 digital"
" temperature sensor driver");
MODULE_LICENSE("GPL v2");
drivers/staging/iio/adc/adt7410.c
View file @ 1180c883
/* /*
* ADT7410 digital temperature sensor driver supporting ADT7410 * ADT7410 digital temperature sensor driver supporting ADT7310/ADT7410
* *
* Copyright 2010 Analog Devices Inc. * Copyright 2010 Analog Devices Inc.
* *
...@@ -13,6 +13,7 @@ ...@@ -13,6 +13,7 @@
#include <linux/sysfs.h> #include <linux/sysfs.h>
#include <linux/list.h> #include <linux/list.h>
#include <linux/i2c.h> #include <linux/i2c.h>
#include <linux/spi/spi.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/iio/iio.h> #include <linux/iio/iio.h>
...@@ -33,6 +34,19 @@ ...@@ -33,6 +34,19 @@
#define ADT7410_ID 0xB #define ADT7410_ID 0xB
#define ADT7410_RESET 0x2F #define ADT7410_RESET 0x2F
/*
* ADT7310 registers definition
*/
#define ADT7310_STATUS 0
#define ADT7310_CONFIG 1
#define ADT7310_TEMPERATURE 2
#define ADT7310_ID 3
#define ADT7310_T_CRIT 4
#define ADT7310_T_HYST 5
#define ADT7310_T_ALARM_HIGH 6
#define ADT7310_T_ALARM_LOW 7
/* /*
* ADT7410 status * ADT7410 status
*/ */
...@@ -69,75 +83,52 @@ ...@@ -69,75 +83,52 @@
#define ADT7410_MANUFACTORY_ID_MASK 0xF0 #define ADT7410_MANUFACTORY_ID_MASK 0xF0
#define ADT7410_MANUFACTORY_ID_OFFSET 4 #define ADT7410_MANUFACTORY_ID_OFFSET 4
#define ADT7310_CMD_REG_MASK 0x28
#define ADT7310_CMD_REG_OFFSET 3
#define ADT7310_CMD_READ 0x40
#define ADT7310_CMD_CON_READ 0x4
#define ADT7410_IRQS 2 #define ADT7410_IRQS 2
/* /*
* struct adt7410_chip_info - chip specifc information * struct adt7410_chip_info - chip specifc information
*/ */
struct adt7410_chip_info;
struct adt7410_ops {
int (*read_word)(struct adt7410_chip_info *, u8 reg, u16 *data);
int (*write_word)(struct adt7410_chip_info *, u8 reg, u16 data);
int (*read_byte)(struct adt7410_chip_info *, u8 reg, u8 *data);
int (*write_byte)(struct adt7410_chip_info *, u8 reg, u8 data);
};
struct adt7410_chip_info { struct adt7410_chip_info {
struct i2c_client *client; struct device *dev;
u8 config; u8 config;
};
/* const struct adt7410_ops *ops;
* adt7410 register access by I2C };
*/
static int adt7410_i2c_read_word(struct adt7410_chip_info *chip, u8 reg, u16 *data) static int adt7410_read_word(struct adt7410_chip_info *chip, u8 reg, u16 *data)
{ {
struct i2c_client *client = chip->client; return chip->ops->read_word(chip, reg, data);
int ret = 0;
ret = i2c_smbus_read_word_data(client, reg);
if (ret < 0) {
dev_err(&client->dev, "I2C read error\n");
return ret;
}
*data = swab16((u16)ret);
return 0;
} }
static int adt7410_i2c_write_word(struct adt7410_chip_info *chip, u8 reg, u16 data) static int adt7410_write_word(struct adt7410_chip_info *chip, u8 reg, u16 data)
{ {
struct i2c_client *client = chip->client; return chip->ops->write_word(chip, reg, data);
int ret = 0;
ret = i2c_smbus_write_word_data(client, reg, swab16(data));
if (ret < 0)
dev_err(&client->dev, "I2C write error\n");
return ret;
} }
static int adt7410_i2c_read_byte(struct adt7410_chip_info *chip, u8 reg, u8 *data) static int adt7410_read_byte(struct adt7410_chip_info *chip, u8 reg, u8 *data)
{ {
struct i2c_client *client = chip->client; return chip->ops->read_byte(chip, reg, data);
int ret = 0;
ret = i2c_smbus_read_byte_data(client, reg);
if (ret < 0) {
dev_err(&client->dev, "I2C read error\n");
return ret;
}
*data = (u8)ret;
return 0;
} }
static int adt7410_i2c_write_byte(struct adt7410_chip_info *chip, u8 reg, u8 data) static int adt7410_write_byte(struct adt7410_chip_info *chip, u8 reg, u8 data)
{ {
struct i2c_client *client = chip->client; return chip->ops->write_byte(chip, reg, data);
int ret = 0;
ret = i2c_smbus_write_byte_data(client, reg, data);
if (ret < 0)
dev_err(&client->dev, "I2C write error\n");
return ret;
} }
static ssize_t adt7410_show_mode(struct device *dev, static ssize_t adt7410_show_mode(struct device *dev,
...@@ -172,7 +163,7 @@ static ssize_t adt7410_store_mode(struct device *dev, ...@@ -172,7 +163,7 @@ static ssize_t adt7410_store_mode(struct device *dev,
u16 config; u16 config;
int ret; int ret;
ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -184,7 +175,7 @@ static ssize_t adt7410_store_mode(struct device *dev, ...@@ -184,7 +175,7 @@ static ssize_t adt7410_store_mode(struct device *dev,
else if (strcmp(buf, "sps")) else if (strcmp(buf, "sps"))
config |= ADT7410_SPS; config |= ADT7410_SPS;
ret = adt7410_i2c_write_byte(chip, ADT7410_CONFIG, config); ret = adt7410_write_byte(chip, ADT7410_CONFIG, config);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -216,7 +207,7 @@ static ssize_t adt7410_show_resolution(struct device *dev, ...@@ -216,7 +207,7 @@ static ssize_t adt7410_show_resolution(struct device *dev,
int ret; int ret;
int bits; int bits;
ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -243,7 +234,7 @@ static ssize_t adt7410_store_resolution(struct device *dev, ...@@ -243,7 +234,7 @@ static ssize_t adt7410_store_resolution(struct device *dev,
if (ret) if (ret)
return -EINVAL; return -EINVAL;
ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -251,7 +242,7 @@ static ssize_t adt7410_store_resolution(struct device *dev, ...@@ -251,7 +242,7 @@ static ssize_t adt7410_store_resolution(struct device *dev,
if (data) if (data)
config |= ADT7410_RESOLUTION; config |= ADT7410_RESOLUTION;
ret = adt7410_i2c_write_byte(chip, ADT7410_CONFIG, config); ret = adt7410_write_byte(chip, ADT7410_CONFIG, config);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -274,7 +265,7 @@ static ssize_t adt7410_show_id(struct device *dev, ...@@ -274,7 +265,7 @@ static ssize_t adt7410_show_id(struct device *dev,
u8 id; u8 id;
int ret; int ret;
ret = adt7410_i2c_read_byte(chip, ADT7410_ID, &id); ret = adt7410_read_byte(chip, ADT7410_ID, &id);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -317,7 +308,7 @@ static ssize_t adt7410_show_value(struct device *dev, ...@@ -317,7 +308,7 @@ static ssize_t adt7410_show_value(struct device *dev,
int ret, i = 0; int ret, i = 0;
do { do {
ret = adt7410_i2c_read_byte(chip, ADT7410_STATUS, &status); ret = adt7410_read_byte(chip, ADT7410_STATUS, &status);
if (ret) if (ret)
return -EIO; return -EIO;
i++; i++;
...@@ -325,7 +316,7 @@ static ssize_t adt7410_show_value(struct device *dev, ...@@ -325,7 +316,7 @@ static ssize_t adt7410_show_value(struct device *dev,
return -EIO; return -EIO;
} while (status & ADT7410_STAT_NOT_RDY); } while (status & ADT7410_STAT_NOT_RDY);
ret = adt7410_i2c_read_word(chip, ADT7410_TEMPERATURE, &data); ret = adt7410_read_word(chip, ADT7410_TEMPERATURE, &data);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -354,7 +345,7 @@ static irqreturn_t adt7410_event_handler(int irq, void *private) ...@@ -354,7 +345,7 @@ static irqreturn_t adt7410_event_handler(int irq, void *private)
s64 timestamp = iio_get_time_ns(); s64 timestamp = iio_get_time_ns();
u8 status; u8 status;
if (adt7410_i2c_read_byte(chip, ADT7410_STATUS, &status)) if (adt7410_read_byte(chip, ADT7410_STATUS, &status))
return IRQ_HANDLED; return IRQ_HANDLED;
if (status & ADT7410_STAT_T_HIGH) if (status & ADT7410_STAT_T_HIGH)
...@@ -387,7 +378,7 @@ static ssize_t adt7410_show_event_mode(struct device *dev, ...@@ -387,7 +378,7 @@ static ssize_t adt7410_show_event_mode(struct device *dev,
struct adt7410_chip_info *chip = iio_priv(dev_info); struct adt7410_chip_info *chip = iio_priv(dev_info);
int ret; int ret;
ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -407,7 +398,7 @@ static ssize_t adt7410_set_event_mode(struct device *dev, ...@@ -407,7 +398,7 @@ static ssize_t adt7410_set_event_mode(struct device *dev,
u16 config; u16 config;
int ret; int ret;
ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -415,7 +406,7 @@ static ssize_t adt7410_set_event_mode(struct device *dev, ...@@ -415,7 +406,7 @@ static ssize_t adt7410_set_event_mode(struct device *dev,
if (strcmp(buf, "comparator") != 0) if (strcmp(buf, "comparator") != 0)
config |= ADT7410_EVENT_MODE; config |= ADT7410_EVENT_MODE;
ret = adt7410_i2c_write_byte(chip, ADT7410_CONFIG, config); ret = adt7410_write_byte(chip, ADT7410_CONFIG, config);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -439,7 +430,7 @@ static ssize_t adt7410_show_fault_queue(struct device *dev, ...@@ -439,7 +430,7 @@ static ssize_t adt7410_show_fault_queue(struct device *dev,
struct adt7410_chip_info *chip = iio_priv(dev_info); struct adt7410_chip_info *chip = iio_priv(dev_info);
int ret; int ret;
ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -461,13 +452,13 @@ static ssize_t adt7410_set_fault_queue(struct device *dev, ...@@ -461,13 +452,13 @@ static ssize_t adt7410_set_fault_queue(struct device *dev,
if (ret || data > 3) if (ret || data > 3)
return -EINVAL; return -EINVAL;
ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config);
if (ret) if (ret)
return -EIO; return -EIO;
config = chip->config & ~ADT7410_FAULT_QUEUE_MASK; config = chip->config & ~ADT7410_FAULT_QUEUE_MASK;
config |= data; config |= data;
ret = adt7410_i2c_write_byte(chip, ADT7410_CONFIG, config); ret = adt7410_write_byte(chip, ADT7410_CONFIG, config);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -486,7 +477,7 @@ static inline ssize_t adt7410_show_t_bound(struct device *dev, ...@@ -486,7 +477,7 @@ static inline ssize_t adt7410_show_t_bound(struct device *dev,
u16 data; u16 data;
int ret; int ret;
ret = adt7410_i2c_read_word(chip, bound_reg, &data); ret = adt7410_read_word(chip, bound_reg, &data);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -557,7 +548,7 @@ static inline ssize_t adt7410_set_t_bound(struct device *dev, ...@@ -557,7 +548,7 @@ static inline ssize_t adt7410_set_t_bound(struct device *dev,
data <<= ADT7410_T13_VALUE_OFFSET; data <<= ADT7410_T13_VALUE_OFFSET;
} }
ret = adt7410_i2c_write_word(chip, bound_reg, data); ret = adt7410_write_word(chip, bound_reg, data);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -624,7 +615,7 @@ static ssize_t adt7410_show_t_hyst(struct device *dev, ...@@ -624,7 +615,7 @@ static ssize_t adt7410_show_t_hyst(struct device *dev,
int ret; int ret;
u8 t_hyst; u8 t_hyst;
ret = adt7410_i2c_read_byte(chip, ADT7410_T_HYST, &t_hyst); ret = adt7410_read_byte(chip, ADT7410_T_HYST, &t_hyst);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -649,7 +640,7 @@ static inline ssize_t adt7410_set_t_hyst(struct device *dev, ...@@ -649,7 +640,7 @@ static inline ssize_t adt7410_set_t_hyst(struct device *dev,
t_hyst = (u8)data; t_hyst = (u8)data;
ret = adt7410_i2c_write_byte(chip, ADT7410_T_HYST, t_hyst); ret = adt7410_write_byte(chip, ADT7410_T_HYST, t_hyst);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -704,14 +695,14 @@ static const struct iio_info adt7410_info = { ...@@ -704,14 +695,14 @@ static const struct iio_info adt7410_info = {
* device probe and remove * device probe and remove
*/ */
static int __devinit adt7410_probe(struct i2c_client *client, static int __devinit adt7410_probe(struct device *dev, int irq,
const struct i2c_device_id *id) const char *name, const struct adt7410_ops *ops)
{ {
unsigned long *adt7410_platform_data = dev->platform_data;
unsigned long local_pdata[] = {0, 0};
struct adt7410_chip_info *chip; struct adt7410_chip_info *chip;
struct iio_dev *indio_dev; struct iio_dev *indio_dev;
int ret = 0; int ret = 0;
unsigned long *adt7410_platform_data = client->dev.platform_data;
unsigned long local_pdata[] = {0, 0};
indio_dev = iio_device_alloc(sizeof(*chip)); indio_dev = iio_device_alloc(sizeof(*chip));
if (indio_dev == NULL) { if (indio_dev == NULL) {
...@@ -720,12 +711,13 @@ static int __devinit adt7410_probe(struct i2c_client *client, ...@@ -720,12 +711,13 @@ static int __devinit adt7410_probe(struct i2c_client *client,
} }
chip = iio_priv(indio_dev); chip = iio_priv(indio_dev);
/* this is only used for device removal purposes */ /* this is only used for device removal purposes */
i2c_set_clientdata(client, indio_dev); dev_set_drvdata(dev, indio_dev);
chip->client = client; chip->dev = dev;
chip->ops = ops;
indio_dev->name = id->name; indio_dev->name = name;
indio_dev->dev.parent = &client->dev; indio_dev->dev.parent = dev;
indio_dev->info = &adt7410_info; indio_dev->info = &adt7410_info;
indio_dev->modes = INDIO_DIRECT_MODE; indio_dev->modes = INDIO_DIRECT_MODE;
...@@ -733,12 +725,12 @@ static int __devinit adt7410_probe(struct i2c_client *client, ...@@ -733,12 +725,12 @@ static int __devinit adt7410_probe(struct i2c_client *client,
adt7410_platform_data = local_pdata; adt7410_platform_data = local_pdata;
/* CT critcal temperature event. line 0 */ /* CT critcal temperature event. line 0 */
if (client->irq) { if (irq) {
ret = request_threaded_irq(client->irq, ret = request_threaded_irq(irq,
NULL, NULL,
&adt7410_event_handler, &adt7410_event_handler,
IRQF_TRIGGER_LOW | IRQF_ONESHOT, IRQF_TRIGGER_LOW | IRQF_ONESHOT,
id->name, name,
indio_dev); indio_dev);
if (ret) if (ret)
goto error_free_dev; goto error_free_dev;
...@@ -751,13 +743,13 @@ static int __devinit adt7410_probe(struct i2c_client *client, ...@@ -751,13 +743,13 @@ static int __devinit adt7410_probe(struct i2c_client *client,
&adt7410_event_handler, &adt7410_event_handler,
adt7410_platform_data[1] | adt7410_platform_data[1] |
IRQF_ONESHOT, IRQF_ONESHOT,
id->name, name,
indio_dev); indio_dev);
if (ret) if (ret)
goto error_unreg_ct_irq; goto error_unreg_ct_irq;
} }
ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config);
if (ret) { if (ret) {
ret = -EIO; ret = -EIO;
goto error_unreg_int_irq; goto error_unreg_int_irq;
...@@ -765,7 +757,7 @@ static int __devinit adt7410_probe(struct i2c_client *client, ...@@ -765,7 +757,7 @@ static int __devinit adt7410_probe(struct i2c_client *client,
chip->config |= ADT7410_RESOLUTION; chip->config |= ADT7410_RESOLUTION;
if (client->irq && adt7410_platform_data[0]) { if (irq && adt7410_platform_data[0]) {
/* set irq polarity low level */ /* set irq polarity low level */
chip->config &= ~ADT7410_CT_POLARITY; chip->config &= ~ADT7410_CT_POLARITY;
...@@ -776,7 +768,7 @@ static int __devinit adt7410_probe(struct i2c_client *client, ...@@ -776,7 +768,7 @@ static int __devinit adt7410_probe(struct i2c_client *client,
chip->config &= ~ADT7410_INT_POLARITY; chip->config &= ~ADT7410_INT_POLARITY;
} }
ret = adt7410_i2c_write_byte(chip, ADT7410_CONFIG, chip->config); ret = adt7410_write_byte(chip, ADT7410_CONFIG, chip->config);
if (ret) { if (ret) {
ret = -EIO; ret = -EIO;
goto error_unreg_int_irq; goto error_unreg_int_irq;
...@@ -785,36 +777,117 @@ static int __devinit adt7410_probe(struct i2c_client *client, ...@@ -785,36 +777,117 @@ static int __devinit adt7410_probe(struct i2c_client *client,
if (ret) if (ret)
goto error_unreg_int_irq; goto error_unreg_int_irq;
dev_info(&client->dev, "%s temperature sensor registered.\n", dev_info(dev, "%s temperature sensor registered.\n",
id->name); name);
return 0; return 0;
error_unreg_int_irq: error_unreg_int_irq:
free_irq(adt7410_platform_data[0], indio_dev); free_irq(adt7410_platform_data[0], indio_dev);
error_unreg_ct_irq: error_unreg_ct_irq:
free_irq(client->irq, indio_dev); free_irq(irq, indio_dev);
error_free_dev: error_free_dev:
iio_device_free(indio_dev); iio_device_free(indio_dev);
error_ret: error_ret:
return ret; return ret;
} }
static int __devexit adt7410_remove(struct i2c_client *client) static int __devexit adt7410_remove(struct device *dev, int irq)
{ {
struct iio_dev *indio_dev = i2c_get_clientdata(client); struct iio_dev *indio_dev = dev_get_drvdata(dev);
unsigned long *adt7410_platform_data = client->dev.platform_data; unsigned long *adt7410_platform_data = dev->platform_data;
iio_device_unregister(indio_dev); iio_device_unregister(indio_dev);
if (adt7410_platform_data[0]) if (adt7410_platform_data[0])
free_irq(adt7410_platform_data[0], indio_dev); free_irq(adt7410_platform_data[0], indio_dev);
if (client->irq) if (irq)
free_irq(client->irq, indio_dev); free_irq(irq, indio_dev);
iio_device_free(indio_dev); iio_device_free(indio_dev);
return 0; return 0;
} }
#if IS_ENABLED(CONFIG_I2C)
static int adt7410_i2c_read_word(struct adt7410_chip_info *chip, u8 reg,
u16 *data)
{
struct i2c_client *client = to_i2c_client(chip->dev);
int ret = 0;
ret = i2c_smbus_read_word_data(client, reg);
if (ret < 0) {
dev_err(&client->dev, "I2C read error\n");
return ret;
}
*data = swab16((u16)ret);
return 0;
}
static int adt7410_i2c_write_word(struct adt7410_chip_info *chip, u8 reg,
u16 data)
{
struct i2c_client *client = to_i2c_client(chip->dev);
int ret = 0;
ret = i2c_smbus_write_word_data(client, reg, swab16(data));
if (ret < 0)
dev_err(&client->dev, "I2C write error\n");
return ret;
}
static int adt7410_i2c_read_byte(struct adt7410_chip_info *chip, u8 reg,
u8 *data)
{
struct i2c_client *client = to_i2c_client(chip->dev);
int ret = 0;
ret = i2c_smbus_read_byte_data(client, reg);
if (ret < 0) {
dev_err(&client->dev, "I2C read error\n");
return ret;
}
*data = (u8)ret;
return 0;
}
static int adt7410_i2c_write_byte(struct adt7410_chip_info *chip, u8 reg,
u8 data)
{
struct i2c_client *client = to_i2c_client(chip->dev);
int ret = 0;
ret = i2c_smbus_write_byte_data(client, reg, data);
if (ret < 0)
dev_err(&client->dev, "I2C write error\n");
return ret;
}
static const struct adt7410_ops adt7410_i2c_ops = {
.read_word = adt7410_i2c_read_word,
.write_word = adt7410_i2c_write_word,
.read_byte = adt7410_i2c_read_byte,
.write_byte = adt7410_i2c_write_byte,
};
static int __devinit adt7410_i2c_probe(struct i2c_client *client,
const struct i2c_device_id *id)
{
return adt7410_probe(&client->dev, client->irq, id->name,
&adt7410_i2c_ops);
}
static int __devexit adt7410_i2c_remove(struct i2c_client *client)
{
return adt7410_remove(&client->dev, client->irq);
}
static const struct i2c_device_id adt7410_id[] = { static const struct i2c_device_id adt7410_id[] = {
{ "adt7410", 0 }, { "adt7410", 0 },
{} {}
...@@ -826,13 +899,204 @@ static struct i2c_driver adt7410_driver = { ...@@ -826,13 +899,204 @@ static struct i2c_driver adt7410_driver = {
.driver = { .driver = {
.name = "adt7410", .name = "adt7410",
}, },
.probe = adt7410_probe, .probe = adt7410_i2c_probe,
.remove = __devexit_p(adt7410_remove), .remove = __devexit_p(adt7410_i2c_remove),
.id_table = adt7410_id, .id_table = adt7410_id,
}; };
module_i2c_driver(adt7410_driver);
static int __init adt7410_i2c_init(void)
{
return i2c_add_driver(&adt7410_driver);
}
static void __exit adt7410_i2c_exit(void)
{
i2c_del_driver(&adt7410_driver);
}
#else
static int __init adt7410_i2c_init(void) { return 0; };
static void __exit adt7410_i2c_exit(void) {};
#endif
#if IS_ENABLED(CONFIG_SPI_MASTER)
static const u8 adt7371_reg_table[] = {
[ADT7410_TEMPERATURE] = ADT7310_TEMPERATURE,
[ADT7410_STATUS] = ADT7310_STATUS,
[ADT7410_CONFIG] = ADT7310_CONFIG,
[ADT7410_T_ALARM_HIGH] = ADT7310_T_ALARM_HIGH,
[ADT7410_T_ALARM_LOW] = ADT7310_T_ALARM_LOW,
[ADT7410_T_CRIT] = ADT7310_T_CRIT,
[ADT7410_T_HYST] = ADT7310_T_HYST,
[ADT7410_ID] = ADT7310_ID,
};
#define AD7310_COMMAND(reg) (adt7371_reg_table[(reg)] << ADT7310_CMD_REG_OFFSET)
static int adt7310_spi_read_word(struct adt7410_chip_info *chip,
u8 reg, u16 *data)
{
struct spi_device *spi = to_spi_device(chip->dev);
u8 command = AD7310_COMMAND(reg);
int ret = 0;
command |= ADT7310_CMD_READ;
ret = spi_write(spi, &command, sizeof(command));
if (ret < 0) {
dev_err(&spi->dev, "SPI write command error\n");
return ret;
}
ret = spi_read(spi, (u8 *)data, sizeof(*data));
if (ret < 0) {
dev_err(&spi->dev, "SPI read word error\n");
return ret;
}
*data = be16_to_cpu(*data);
return 0;
}
static int adt7310_spi_write_word(struct adt7410_chip_info *chip, u8 reg,
u16 data)
{
struct spi_device *spi = to_spi_device(chip->dev);
u8 buf[3];
int ret = 0;
buf[0] = AD7310_COMMAND(reg);
buf[1] = (u8)(data >> 8);
buf[2] = (u8)(data & 0xFF);
ret = spi_write(spi, buf, 3);
if (ret < 0) {
dev_err(&spi->dev, "SPI write word error\n");
return ret;
}
return ret;
}
static int adt7310_spi_read_byte(struct adt7410_chip_info *chip, u8 reg,
u8 *data)
{
struct spi_device *spi = to_spi_device(chip->dev);
u8 command = AD7310_COMMAND(reg);
int ret = 0;
command |= ADT7310_CMD_READ;
ret = spi_write(spi, &command, sizeof(command));
if (ret < 0) {
dev_err(&spi->dev, "SPI write command error\n");
return ret;
}
ret = spi_read(spi, data, sizeof(*data));
if (ret < 0) {
dev_err(&spi->dev, "SPI read byte error\n");
return ret;
}
return 0;
}
static int adt7310_spi_write_byte(struct adt7410_chip_info *chip, u8 reg,
u8 data)
{
struct spi_device *spi = to_spi_device(chip->dev);
u8 buf[2];
int ret = 0;
buf[0] = AD7310_COMMAND(reg);
buf[1] = data;
ret = spi_write(spi, buf, 2);
if (ret < 0) {
dev_err(&spi->dev, "SPI write byte error\n");
return ret;
}
return ret;
}
static const struct adt7410_ops adt7310_spi_ops = {
.read_word = adt7310_spi_read_word,
.write_word = adt7310_spi_write_word,
.read_byte = adt7310_spi_read_byte,
.write_byte = adt7310_spi_write_byte,
};
static int __devinit adt7310_spi_probe(struct spi_device *spi)
{
return adt7410_probe(&spi->dev, spi->irq,
spi_get_device_id(spi)->name, &adt7310_spi_ops);
}
static int __devexit adt7310_spi_remove(struct spi_device *spi)
{
return adt7410_remove(&spi->dev, spi->irq);
}
static const struct spi_device_id adt7310_id[] = {
{ "adt7310", 0 },
{}
};
MODULE_DEVICE_TABLE(spi, adt7310_id);
static struct spi_driver adt7310_driver = {
.driver = {
.name = "adt7310",
.owner = THIS_MODULE,
},
.probe = adt7310_spi_probe,
.remove = __devexit_p(adt7310_spi_remove),
.id_table = adt7310_id,
};
static int __init adt7310_spi_init(void)
{
return spi_register_driver(&adt7310_driver);
}
static void adt7310_spi_exit(void)
{
spi_unregister_driver(&adt7310_driver);
}
#else
static int __init adt7310_spi_init(void) { return 0; };
static void adt7310_spi_exit(void) {};
#endif
static int __init adt7410_init(void)
{
int ret;
ret = adt7310_spi_init();
if (ret)
return ret;
ret = adt7410_i2c_init();
if (ret)
adt7310_spi_exit();
return ret;
}
module_init(adt7410_init);
static void __exit adt7410_exit(void)
{
adt7410_i2c_exit();
adt7310_spi_exit();
}
module_exit(adt7410_exit);
MODULE_AUTHOR("Sonic Zhang <sonic.zhang@analog.com>"); MODULE_AUTHOR("Sonic Zhang <sonic.zhang@analog.com>");
MODULE_DESCRIPTION("Analog Devices ADT7410 digital" MODULE_DESCRIPTION("Analog Devices ADT7310/ADT7410 digital temperature sensor driver");
" temperature sensor driver");
MODULE_LICENSE("GPL v2"); MODULE_LICENSE("GPL v2");
drivers/staging/iio/light/isl29018.c
View file @ 1180c883
...@@ -67,6 +67,7 @@ struct isl29018_chip { ...@@ -67,6 +67,7 @@ struct isl29018_chip {
unsigned int range; unsigned int range;
unsigned int adc_bit; unsigned int adc_bit;
int prox_scheme; int prox_scheme;
bool suspended;
}; };
static int isl29018_set_range(struct isl29018_chip *chip, unsigned long range, static int isl29018_set_range(struct isl29018_chip *chip, unsigned long range,
...@@ -368,6 +369,10 @@ static int isl29018_read_raw(struct iio_dev *indio_dev, ...@@ -368,6 +369,10 @@ static int isl29018_read_raw(struct iio_dev *indio_dev,
struct isl29018_chip *chip = iio_priv(indio_dev); struct isl29018_chip *chip = iio_priv(indio_dev);
mutex_lock(&chip->lock); mutex_lock(&chip->lock);
if (chip->suspended) {
mutex_unlock(&chip->lock);
return -EBUSY;
}
switch (mask) { switch (mask) {
case IIO_CHAN_INFO_RAW: case IIO_CHAN_INFO_RAW:
case IIO_CHAN_INFO_PROCESSED: case IIO_CHAN_INFO_PROCESSED:
...@@ -561,6 +566,7 @@ static int __devinit isl29018_probe(struct i2c_client *client, ...@@ -561,6 +566,7 @@ static int __devinit isl29018_probe(struct i2c_client *client,
chip->lux_scale = 1; chip->lux_scale = 1;
chip->range = 1000; chip->range = 1000;
chip->adc_bit = 16; chip->adc_bit = 16;
chip->suspended = false;
chip->regmap = devm_regmap_init_i2c(client, &isl29018_regmap_config); chip->regmap = devm_regmap_init_i2c(client, &isl29018_regmap_config);
if (IS_ERR(chip->regmap)) { if (IS_ERR(chip->regmap)) {
...@@ -603,6 +609,44 @@ static int __devexit isl29018_remove(struct i2c_client *client) ...@@ -603,6 +609,44 @@ static int __devexit isl29018_remove(struct i2c_client *client)
return 0; return 0;
} }
#ifdef CONFIG_PM_SLEEP
static int isl29018_suspend(struct device *dev)
{
struct isl29018_chip *chip = iio_priv(dev_get_drvdata(dev));
mutex_lock(&chip->lock);
/* Since this driver uses only polling commands, we are by default in
* auto shutdown (ie, power-down) mode.
* So we do not have much to do here.
*/
chip->suspended = true;
mutex_unlock(&chip->lock);
return 0;
}
static int isl29018_resume(struct device *dev)
{
struct isl29018_chip *chip = iio_priv(dev_get_drvdata(dev));
int err;
mutex_lock(&chip->lock);
err = isl29018_chip_init(chip);
if (!err)
chip->suspended = false;
mutex_unlock(&chip->lock);
return err;
}
static SIMPLE_DEV_PM_OPS(isl29018_pm_ops, isl29018_suspend, isl29018_resume);
#define ISL29018_PM_OPS (&isl29018_pm_ops)
#else
#define ISL29018_PM_OPS NULL
#endif
static const struct i2c_device_id isl29018_id[] = { static const struct i2c_device_id isl29018_id[] = {
{"isl29018", 0}, {"isl29018", 0},
{} {}
...@@ -620,6 +664,7 @@ static struct i2c_driver isl29018_driver = { ...@@ -620,6 +664,7 @@ static struct i2c_driver isl29018_driver = {
.class = I2C_CLASS_HWMON, .class = I2C_CLASS_HWMON,
.driver = { .driver = {
.name = "isl29018", .name = "isl29018",
.pm = ISL29018_PM_OPS,
.owner = THIS_MODULE, .owner = THIS_MODULE,
.of_match_table = isl29018_of_match, .of_match_table = isl29018_of_match,
}, },
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7