Re: [PATCH 2/2] staging:iio: Consolidate adt7310 and adt7410 driver

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



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


[Index of Archives]     [Linux USB Devel]     [Video for Linux]     [Linux Audio Users]     [Yosemite News]     [Linux Input]     [Linux Kernel]     [Linux SCSI]     [X.org]

  Powered by Linux