On 10/22/2012 10:42 AM, Lars-Peter Clausen wrote: > The adt7310 is the SPI version of the adt7410, so there is no need to have a > separate driver for it. The register map layout is a bit different, i.e. the > addresses of the register differ, but the individual register layouts are > identical. We solve this by adding a small look-up table, which translates > adt7410 register addresses to ad7310 register addresses. > > Signed-off-by: Lars-Peter Clausen <lars@xxxxxxxxxx> Nice work. Added to togreg branch of iio.git > --- > drivers/staging/iio/adc/Kconfig | 13 +- > drivers/staging/iio/adc/Makefile | 1 - > drivers/staging/iio/adc/adt7310.c | 881 ------------------------------------- > drivers/staging/iio/adc/adt7410.c | 458 +++++++++++++++---- > 4 files changed, 364 insertions(+), 989 deletions(-) > delete mode 100644 drivers/staging/iio/adc/adt7310.c > > diff --git a/drivers/staging/iio/adc/Kconfig b/drivers/staging/iio/adc/Kconfig > index a525143..71a515d 100644 > --- a/drivers/staging/iio/adc/Kconfig > +++ b/drivers/staging/iio/adc/Kconfig > @@ -126,18 +126,11 @@ config AD7192 > To compile this driver as a module, choose M here: the > 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 > - tristate "Analog Devices ADT7410 temperature sensor driver" > - depends on I2C > + tristate "Analog Devices ADT7310/ADT7410 temperature sensor driver" > + depends on I2C || SPI_MASTER > help > - Say yes here to build support for Analog Devices ADT7410 > + Say yes here to build support for Analog Devices ADT7310/ADT7410 > temperature sensors. > > config AD7280 > diff --git a/drivers/staging/iio/adc/Makefile b/drivers/staging/iio/adc/Makefile > index 62ee02e..ff561c5 100644 > --- a/drivers/staging/iio/adc/Makefile > +++ b/drivers/staging/iio/adc/Makefile > @@ -30,7 +30,6 @@ obj-$(CONFIG_AD7780) += ad7780.o > obj-$(CONFIG_AD7793) += ad7793.o > obj-$(CONFIG_AD7816) += ad7816.o > obj-$(CONFIG_AD7192) += ad7192.o > -obj-$(CONFIG_ADT7310) += adt7310.o > obj-$(CONFIG_ADT7410) += adt7410.o > obj-$(CONFIG_AD7280) += ad7280a.o > obj-$(CONFIG_LPC32XX_ADC) += lpc32xx_adc.o > diff --git a/drivers/staging/iio/adc/adt7310.c b/drivers/staging/iio/adc/adt7310.c > deleted file mode 100644 > index 72460b6..0000000 > --- a/drivers/staging/iio/adc/adt7310.c > +++ /dev/null > @@ -1,881 +0,0 @@ > -/* > - * 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@xxxxxxxxxx>"); > -MODULE_DESCRIPTION("Analog Devices ADT7310 digital" > - " temperature sensor driver"); > -MODULE_LICENSE("GPL v2"); > diff --git a/drivers/staging/iio/adc/adt7410.c b/drivers/staging/iio/adc/adt7410.c > index 3cf5103..6493cd0 100644 > --- a/drivers/staging/iio/adc/adt7410.c > +++ b/drivers/staging/iio/adc/adt7410.c > @@ -1,5 +1,5 @@ > /* > - * ADT7410 digital temperature sensor driver supporting ADT7410 > + * ADT7410 digital temperature sensor driver supporting ADT7310/ADT7410 > * > * Copyright 2010 Analog Devices Inc. > * > @@ -13,6 +13,7 @@ > #include <linux/sysfs.h> > #include <linux/list.h> > #include <linux/i2c.h> > +#include <linux/spi/spi.h> > #include <linux/module.h> > > #include <linux/iio/iio.h> > @@ -34,6 +35,19 @@ > #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 > */ > #define ADT7410_STAT_T_LOW 0x10 > @@ -69,75 +83,52 @@ > #define ADT7410_MANUFACTORY_ID_MASK 0xF0 > #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 > > /* > * 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 i2c_client *client; > + struct device *dev; > u8 config; > -}; > > -/* > - * adt7410 register access by I2C > - */ > + const struct adt7410_ops *ops; > +}; > > -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; > - 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; > + return chip->ops->read_word(chip, reg, data); > } > > -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; > - 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; > + return chip->ops->write_word(chip, reg, data); > } > > -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; > - 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; > + return chip->ops->read_byte(chip, reg, data); > } > > -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; > - 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; > + return chip->ops->write_byte(chip, reg, data); > } > > static ssize_t adt7410_show_mode(struct device *dev, > @@ -172,7 +163,7 @@ static ssize_t adt7410_store_mode(struct device *dev, > u16 config; > int ret; > > - ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); > + ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config); > if (ret) > return -EIO; > > @@ -184,7 +175,7 @@ static ssize_t adt7410_store_mode(struct device *dev, > else if (strcmp(buf, "sps")) > config |= ADT7410_SPS; > > - ret = adt7410_i2c_write_byte(chip, ADT7410_CONFIG, config); > + ret = adt7410_write_byte(chip, ADT7410_CONFIG, config); > if (ret) > return -EIO; > > @@ -216,7 +207,7 @@ static ssize_t adt7410_show_resolution(struct device *dev, > int ret; > int bits; > > - ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); > + ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config); > if (ret) > return -EIO; > > @@ -243,7 +234,7 @@ static ssize_t adt7410_store_resolution(struct device *dev, > if (ret) > return -EINVAL; > > - ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); > + ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config); > if (ret) > return -EIO; > > @@ -251,7 +242,7 @@ static ssize_t adt7410_store_resolution(struct device *dev, > if (data) > config |= ADT7410_RESOLUTION; > > - ret = adt7410_i2c_write_byte(chip, ADT7410_CONFIG, config); > + ret = adt7410_write_byte(chip, ADT7410_CONFIG, config); > if (ret) > return -EIO; > > @@ -274,7 +265,7 @@ static ssize_t adt7410_show_id(struct device *dev, > u8 id; > int ret; > > - ret = adt7410_i2c_read_byte(chip, ADT7410_ID, &id); > + ret = adt7410_read_byte(chip, ADT7410_ID, &id); > if (ret) > return -EIO; > > @@ -317,7 +308,7 @@ static ssize_t adt7410_show_value(struct device *dev, > int ret, i = 0; > > do { > - ret = adt7410_i2c_read_byte(chip, ADT7410_STATUS, &status); > + ret = adt7410_read_byte(chip, ADT7410_STATUS, &status); > if (ret) > return -EIO; > i++; > @@ -325,7 +316,7 @@ static ssize_t adt7410_show_value(struct device *dev, > return -EIO; > } 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) > return -EIO; > > @@ -354,7 +345,7 @@ static irqreturn_t adt7410_event_handler(int irq, void *private) > s64 timestamp = iio_get_time_ns(); > u8 status; > > - if (adt7410_i2c_read_byte(chip, ADT7410_STATUS, &status)) > + if (adt7410_read_byte(chip, ADT7410_STATUS, &status)) > return IRQ_HANDLED; > > if (status & ADT7410_STAT_T_HIGH) > @@ -387,7 +378,7 @@ static ssize_t adt7410_show_event_mode(struct device *dev, > struct adt7410_chip_info *chip = iio_priv(dev_info); > int ret; > > - ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); > + ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config); > if (ret) > return -EIO; > > @@ -407,7 +398,7 @@ static ssize_t adt7410_set_event_mode(struct device *dev, > u16 config; > int ret; > > - ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); > + ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config); > if (ret) > return -EIO; > > @@ -415,7 +406,7 @@ static ssize_t adt7410_set_event_mode(struct device *dev, > if (strcmp(buf, "comparator") != 0) > config |= ADT7410_EVENT_MODE; > > - ret = adt7410_i2c_write_byte(chip, ADT7410_CONFIG, config); > + ret = adt7410_write_byte(chip, ADT7410_CONFIG, config); > if (ret) > return -EIO; > > @@ -439,7 +430,7 @@ static ssize_t adt7410_show_fault_queue(struct device *dev, > struct adt7410_chip_info *chip = iio_priv(dev_info); > int ret; > > - ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); > + ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config); > if (ret) > return -EIO; > > @@ -461,13 +452,13 @@ static ssize_t adt7410_set_fault_queue(struct device *dev, > if (ret || data > 3) > return -EINVAL; > > - ret = adt7410_i2c_read_byte(chip, ADT7410_CONFIG, &chip->config); > + ret = adt7410_read_byte(chip, ADT7410_CONFIG, &chip->config); > if (ret) > return -EIO; > > config = chip->config & ~ADT7410_FAULT_QUEUE_MASK; > config |= data; > - ret = adt7410_i2c_write_byte(chip, ADT7410_CONFIG, config); > + ret = adt7410_write_byte(chip, ADT7410_CONFIG, config); > if (ret) > return -EIO; > > @@ -486,7 +477,7 @@ static inline ssize_t adt7410_show_t_bound(struct device *dev, > u16 data; > int ret; > > - ret = adt7410_i2c_read_word(chip, bound_reg, &data); > + ret = adt7410_read_word(chip, bound_reg, &data); > if (ret) > return -EIO; > > @@ -557,7 +548,7 @@ static inline ssize_t adt7410_set_t_bound(struct device *dev, > data <<= ADT7410_T13_VALUE_OFFSET; > } > > - ret = adt7410_i2c_write_word(chip, bound_reg, data); > + ret = adt7410_write_word(chip, bound_reg, data); > if (ret) > return -EIO; > > @@ -624,7 +615,7 @@ static ssize_t adt7410_show_t_hyst(struct device *dev, > int ret; > 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) > return -EIO; > > @@ -649,7 +640,7 @@ static inline ssize_t adt7410_set_t_hyst(struct device *dev, > > 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) > return -EIO; > > @@ -704,14 +695,14 @@ static const struct iio_info adt7410_info = { > * device probe and remove > */ > > -static int __devinit adt7410_probe(struct i2c_client *client, > - const struct i2c_device_id *id) > +static int __devinit adt7410_probe(struct device *dev, int irq, > + 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 iio_dev *indio_dev; > 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)); > if (indio_dev == NULL) { > @@ -720,12 +711,13 @@ static int __devinit adt7410_probe(struct i2c_client *client, > } > chip = iio_priv(indio_dev); > /* 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->dev.parent = &client->dev; > + indio_dev->name = name; > + indio_dev->dev.parent = dev; > indio_dev->info = &adt7410_info; > indio_dev->modes = INDIO_DIRECT_MODE; > > @@ -733,12 +725,12 @@ static int __devinit adt7410_probe(struct i2c_client *client, > adt7410_platform_data = local_pdata; > > /* CT critcal temperature event. line 0 */ > - if (client->irq) { > - ret = request_threaded_irq(client->irq, > + if (irq) { > + ret = request_threaded_irq(irq, > NULL, > &adt7410_event_handler, > IRQF_TRIGGER_LOW | IRQF_ONESHOT, > - id->name, > + name, > indio_dev); > if (ret) > goto error_free_dev; > @@ -751,13 +743,13 @@ static int __devinit adt7410_probe(struct i2c_client *client, > &adt7410_event_handler, > adt7410_platform_data[1] | > IRQF_ONESHOT, > - id->name, > + name, > indio_dev); > if (ret) > 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) { > ret = -EIO; > goto error_unreg_int_irq; > @@ -765,7 +757,7 @@ static int __devinit adt7410_probe(struct i2c_client *client, > > chip->config |= ADT7410_RESOLUTION; > > - if (client->irq && adt7410_platform_data[0]) { > + if (irq && adt7410_platform_data[0]) { > > /* set irq polarity low level */ > chip->config &= ~ADT7410_CT_POLARITY; > @@ -776,7 +768,7 @@ static int __devinit adt7410_probe(struct i2c_client *client, > 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) { > ret = -EIO; > goto error_unreg_int_irq; > @@ -785,36 +777,117 @@ static int __devinit adt7410_probe(struct i2c_client *client, > if (ret) > goto error_unreg_int_irq; > > - dev_info(&client->dev, "%s temperature sensor registered.\n", > - id->name); > + dev_info(dev, "%s temperature sensor registered.\n", > + name); > > return 0; > > error_unreg_int_irq: > free_irq(adt7410_platform_data[0], indio_dev); > error_unreg_ct_irq: > - free_irq(client->irq, indio_dev); > + free_irq(irq, indio_dev); > error_free_dev: > iio_device_free(indio_dev); > error_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); > - unsigned long *adt7410_platform_data = client->dev.platform_data; > + struct iio_dev *indio_dev = dev_get_drvdata(dev); > + unsigned long *adt7410_platform_data = dev->platform_data; > > iio_device_unregister(indio_dev); > if (adt7410_platform_data[0]) > free_irq(adt7410_platform_data[0], indio_dev); > - if (client->irq) > - free_irq(client->irq, indio_dev); > + if (irq) > + free_irq(irq, indio_dev); > iio_device_free(indio_dev); > > 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[] = { > { "adt7410", 0 }, > {} > @@ -826,13 +899,204 @@ static struct i2c_driver adt7410_driver = { > .driver = { > .name = "adt7410", > }, > - .probe = adt7410_probe, > - .remove = __devexit_p(adt7410_remove), > + .probe = adt7410_i2c_probe, > + .remove = __devexit_p(adt7410_i2c_remove), > .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@xxxxxxxxxx>"); > -MODULE_DESCRIPTION("Analog Devices ADT7410 digital" > - " temperature sensor driver"); > +MODULE_DESCRIPTION("Analog Devices ADT7310/ADT7410 digital temperature sensor driver"); > MODULE_LICENSE("GPL v2"); > -- To unsubscribe from this list: send the line "unsubscribe linux-iio" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html