staging:iio: Consolidate adt7310 and adt7410 driver
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@metafoo.de> Signed-off-by: Jonathan Cameron <jic23@kernel.org>
This commit is contained in:
parent
e446f5a854
commit
2b0c856ad9
|
@ -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
|
||||
|
|
|
@ -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
|
||||
|
|
|
@ -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@analog.com>");
|
||||
MODULE_DESCRIPTION("Analog Devices ADT7310 digital"
|
||||
" temperature sensor driver");
|
||||
MODULE_LICENSE("GPL v2");
|
|
@ -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>
|
||||
|
@ -33,6 +34,19 @@
|
|||
#define ADT7410_ID 0xB
|
||||
#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
|
||||
*/
|
||||
|
@ -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 i2c_client *client;
|
||||
u8 config;
|
||||
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);
|
||||
};
|
||||
|
||||
/*
|
||||
* adt7410 register access by I2C
|
||||
*/
|
||||
struct adt7410_chip_info {
|
||||
struct device *dev;
|
||||
u8 config;
|
||||
|
||||
static int adt7410_i2c_read_word(struct adt7410_chip_info *chip, u8 reg, u16 *data)
|
||||
const struct adt7410_ops *ops;
|
||||
};
|
||||
|
||||
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@analog.com>");
|
||||
MODULE_DESCRIPTION("Analog Devices ADT7410 digital"
|
||||
" temperature sensor driver");
|
||||
MODULE_DESCRIPTION("Analog Devices ADT7310/ADT7410 digital temperature sensor driver");
|
||||
MODULE_LICENSE("GPL v2");
|
||||
|
|
Loading…
Reference in New Issue