Skip to content

K
kernel_linux

OpenHarmony / kernel_linux
上一次同步 4 年多

通知 15
Star 8
Fork 2
K
kernel_linux
提交 58c0323c 编写于 作者: J Jonathan Cameron 提交者： Greg Kroah-Hartman
浏览文件
操作

staging:iio:ad7291 move from old event system to current. 

This driver needed some tender loving care. It still does.
Signed-off-by: NJonathan Cameron <jic23@cam.ac.uk>
Signed-off-by: NGreg Kroah-Hartman <gregkh@suse.de>
上级 1142f709
隐藏空白更改
内联 并排
Showing with 137 addition and 285 deletion
drivers/staging/iio/adc/ad7291.c
浏览文件 @ 58c0323c
...@@ -8,14 +8,12 @@ ...@@ -8,14 +8,12 @@
#include <linux/interrupt.h> #include <linux/interrupt.h>
#include <linux/gpio.h> #include <linux/gpio.h>
#include <linux/workqueue.h>
#include <linux/device.h> #include <linux/device.h>
#include <linux/kernel.h> #include <linux/kernel.h>
#include <linux/slab.h> #include <linux/slab.h>
#include <linux/sysfs.h> #include <linux/sysfs.h>
#include <linux/list.h> #include <linux/list.h>
#include <linux/i2c.h> #include <linux/i2c.h>
#include <linux/rtc.h>
#include "../iio.h" #include "../iio.h"
#include "../sysfs.h" #include "../sysfs.h"
...@@ -65,8 +63,6 @@ struct ad7291_chip_info { ...@@ -65,8 +63,6 @@ struct ad7291_chip_info {
const char *name; const char *name;
struct i2c_client *client; struct i2c_client *client;
struct iio_dev *indio_dev; struct iio_dev *indio_dev;
struct work_struct thresh_work;
s64 last_timestamp;
u16 command; u16 command;
u8 channels; /* Active voltage channels */ u8 channels; /* Active voltage channels */
}; };
...@@ -477,22 +473,23 @@ static const struct attribute_group ad7291_attribute_group = { ...@@ -477,22 +473,23 @@ static const struct attribute_group ad7291_attribute_group = {
#define IIO_EVENT_CODE_AD7291_T_AVG_LOW IIO_BUFFER_EVENT_CODE(3) #define IIO_EVENT_CODE_AD7291_T_AVG_LOW IIO_BUFFER_EVENT_CODE(3)
#define IIO_EVENT_CODE_AD7291_VOLTAGE_BASE IIO_BUFFER_EVENT_CODE(4) #define IIO_EVENT_CODE_AD7291_VOLTAGE_BASE IIO_BUFFER_EVENT_CODE(4)
static void ad7291_interrupt_bh(struct work_struct *work_s) static irqreturn_t ad7291_event_handler(int irq, void *private)
{ {
struct ad7291_chip_info *chip = struct iio_dev *indio_dev = private;
container_of(work_s, struct ad7291_chip_info, thresh_work); struct ad7291_chip_info *chip = iio_dev_get_devdata(private);
u16 t_status, v_status; u16 t_status, v_status;
u16 command; u16 command;
int i; int i;
s64 timestamp = iio_get_time_ns();
if (ad7291_i2c_read(chip, AD7291_T_ALERT_STATUS, &t_status)) if (ad7291_i2c_read(chip, AD7291_T_ALERT_STATUS, &t_status))
return; return IRQ_HANDLED;
if (ad7291_i2c_read(chip, AD7291_VOLTAGE_ALERT_STATUS, &v_status)) if (ad7291_i2c_read(chip, AD7291_VOLTAGE_ALERT_STATUS, &v_status))
return; return IRQ_HANDLED;
if (!(t_status || v_status)) if (!(t_status || v_status))
return; return IRQ_HANDLED;
command = chip->command | AD7291_ALART_CLEAR; command = chip->command | AD7291_ALART_CLEAR;
ad7291_i2c_write(chip, AD7291_COMMAND, command); ad7291_i2c_write(chip, AD7291_COMMAND, command);
...@@ -500,50 +497,35 @@ static void ad7291_interrupt_bh(struct work_struct *work_s) ...@@ -500,50 +497,35 @@ static void ad7291_interrupt_bh(struct work_struct *work_s)
command = chip->command & ~AD7291_ALART_CLEAR; command = chip->command & ~AD7291_ALART_CLEAR;
ad7291_i2c_write(chip, AD7291_COMMAND, command); ad7291_i2c_write(chip, AD7291_COMMAND, command);
enable_irq(chip->client->irq);
for (i = 0; i < 4; i++) { for (i = 0; i < 4; i++) {
if (t_status & (1 << i)) if (t_status & (1 << i))
iio_push_event(chip->indio_dev, 0, iio_push_event(indio_dev, 0,
IIO_EVENT_CODE_AD7291_T_SENSE_HIGH + i, IIO_EVENT_CODE_AD7291_T_SENSE_HIGH + i,
chip->last_timestamp); timestamp);
} }
for (i = 0; i < AD7291_VOLTAGE_LIMIT_COUNT*2; i++) { for (i = 0; i < AD7291_VOLTAGE_LIMIT_COUNT*2; i++) {
if (v_status & (1 << i)) if (v_status & (1 << i))
iio_push_event(chip->indio_dev, 0, iio_push_event(indio_dev, 0,
IIO_EVENT_CODE_AD7291_VOLTAGE_BASE + i, IIO_EVENT_CODE_AD7291_VOLTAGE_BASE + i,
chip->last_timestamp); timestamp);
} }
}
static int ad7291_interrupt(struct iio_dev *dev_info, return IRQ_HANDLED;
int index,
s64 timestamp,
int no_test)
{
struct ad7291_chip_info *chip = dev_info->dev_data;
chip->last_timestamp = timestamp;
schedule_work(&chip->thresh_work);
return 0;
} }
IIO_EVENT_SH(ad7291, &ad7291_interrupt);
static inline ssize_t ad7291_show_t_bound(struct device *dev, static inline ssize_t ad7291_show_t_bound(struct device *dev,
struct device_attribute *attr, struct device_attribute *attr,
u8 bound_reg,
char *buf) char *buf)
{ {
struct iio_dev *dev_info = dev_get_drvdata(dev); struct iio_dev *dev_info = dev_get_drvdata(dev);
struct ad7291_chip_info *chip = dev_info->dev_data; struct ad7291_chip_info *chip = dev_info->dev_data;
struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
u16 data; u16 data;
char sign = ' '; char sign = ' ';
int ret; int ret;
ret = ad7291_i2c_read(chip, bound_reg, &data); ret = ad7291_i2c_read(chip, this_attr->address, &data);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -561,12 +543,12 @@ static inline ssize_t ad7291_show_t_bound(struct device *dev, ...@@ -561,12 +543,12 @@ static inline ssize_t ad7291_show_t_bound(struct device *dev,
static inline ssize_t ad7291_set_t_bound(struct device *dev, static inline ssize_t ad7291_set_t_bound(struct device *dev,
struct device_attribute *attr, struct device_attribute *attr,
u8 bound_reg,
const char *buf, const char *buf,
size_t len) size_t len)
{ {
struct iio_dev *dev_info = dev_get_drvdata(dev); struct iio_dev *dev_info = dev_get_drvdata(dev);
struct ad7291_chip_info *chip = dev_info->dev_data; struct ad7291_chip_info *chip = dev_info->dev_data;
struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
long tmp1, tmp2; long tmp1, tmp2;
u16 data; u16 data;
char *pos; char *pos;
...@@ -600,64 +582,13 @@ static inline ssize_t ad7291_set_t_bound(struct device *dev, ...@@ -600,64 +582,13 @@ static inline ssize_t ad7291_set_t_bound(struct device *dev,
/* convert positive value to supplyment */ /* convert positive value to supplyment */
data = (AD7291_T_VALUE_SIGN << 1) - data; data = (AD7291_T_VALUE_SIGN << 1) - data;
ret = ad7291_i2c_write(chip, bound_reg, data); ret = ad7291_i2c_write(chip, this_attr->address, data);
if (ret) if (ret)
return -EIO; return -EIO;
return ret; return ret;
} }
static ssize_t ad7291_show_t_sense_high(struct device *dev,
struct device_attribute *attr,
char *buf)
{
return ad7291_show_t_bound(dev, attr,
AD7291_T_SENSE_HIGH, buf);
}
static inline ssize_t ad7291_set_t_sense_high(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t len)
{
return ad7291_set_t_bound(dev, attr,
AD7291_T_SENSE_HIGH, buf, len);
}
static ssize_t ad7291_show_t_sense_low(struct device *dev,
struct device_attribute *attr,
char *buf)
{
return ad7291_show_t_bound(dev, attr,
AD7291_T_SENSE_LOW, buf);
}
static inline ssize_t ad7291_set_t_sense_low(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t len)
{
return ad7291_set_t_bound(dev, attr,
AD7291_T_SENSE_LOW, buf, len);
}
static ssize_t ad7291_show_t_sense_hyst(struct device *dev,
struct device_attribute *attr,
char *buf)
{
return ad7291_show_t_bound(dev, attr,
AD7291_T_SENSE_HYST, buf);
}
static inline ssize_t ad7291_set_t_sense_hyst(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t len)
{
return ad7291_set_t_bound(dev, attr,
AD7291_T_SENSE_HYST, buf, len);
}
static inline ssize_t ad7291_show_v_bound(struct device *dev, static inline ssize_t ad7291_show_v_bound(struct device *dev,
struct device_attribute *attr, struct device_attribute *attr,
u8 bound_reg, u8 bound_reg,
...@@ -712,191 +643,121 @@ static inline ssize_t ad7291_set_v_bound(struct device *dev, ...@@ -712,191 +643,121 @@ static inline ssize_t ad7291_set_v_bound(struct device *dev,
return ret; return ret;
} }
static int ad7291_get_voltage_limit_regs(const char *channel) static IIO_DEVICE_ATTR(t_sense_high_value,
{ S_IRUGO | S_IWUSR,
int index; ad7291_show_t_bound, ad7291_set_t_bound,
AD7291_T_SENSE_HIGH);
if (strlen(channel) < 3 && channel[0] != 'v') static IIO_DEVICE_ATTR(t_sense_low_value,
return -EINVAL; S_IRUGO | S_IWUSR,
ad7291_show_t_bound, ad7291_set_t_bound,
index = channel[1] - '0'; AD7291_T_SENSE_LOW);
if (index >= AD7291_VOLTAGE_LIMIT_COUNT) static IIO_DEVICE_ATTR(t_sense_hyst_value,
return -EINVAL; S_IRUGO | S_IWUSR,
ad7291_show_t_bound, ad7291_set_t_bound,
return index; AD7291_T_SENSE_HYST);
} static IIO_DEVICE_ATTR(v0_high,
S_IRUGO | S_IWUSR,
static ssize_t ad7291_show_voltage_high(struct device *dev, ad7291_show_t_bound, ad7291_set_t_bound, 0x04);
struct device_attribute *attr, static IIO_DEVICE_ATTR(v0_low,
char *buf) S_IRUGO | S_IWUSR,
{ ad7291_show_t_bound, ad7291_set_t_bound, 0x05);
int regs; static IIO_DEVICE_ATTR(v0_hyst,
S_IRUGO | S_IWUSR,
regs = ad7291_get_voltage_limit_regs(attr->attr.name); ad7291_show_t_bound, ad7291_set_t_bound, 0x06);
static IIO_DEVICE_ATTR(v1_high,
if (regs < 0) S_IRUGO | S_IWUSR,
return regs; ad7291_show_t_bound, ad7291_set_t_bound, 0x07);
static IIO_DEVICE_ATTR(v1_low,
return ad7291_show_t_bound(dev, attr, regs, buf); S_IRUGO | S_IWUSR,
} ad7291_show_t_bound, ad7291_set_t_bound, 0x08);
static IIO_DEVICE_ATTR(v1_hyst,
static inline ssize_t ad7291_set_voltage_high(struct device *dev, S_IRUGO | S_IWUSR,
struct device_attribute *attr, ad7291_show_t_bound, ad7291_set_t_bound, 0x09);
const char *buf, static IIO_DEVICE_ATTR(v2_high,
size_t len) S_IRUGO | S_IWUSR,
{ ad7291_show_t_bound, ad7291_set_t_bound, 0x0A);
int regs; static IIO_DEVICE_ATTR(v2_low,
S_IRUGO | S_IWUSR,
regs = ad7291_get_voltage_limit_regs(attr->attr.name); ad7291_show_t_bound, ad7291_set_t_bound, 0x0B);
static IIO_DEVICE_ATTR(v2_hyst,
if (regs < 0) S_IRUGO | S_IWUSR,
return regs; ad7291_show_t_bound, ad7291_set_t_bound, 0x0C);
static IIO_DEVICE_ATTR(v3_high,
return ad7291_set_t_bound(dev, attr, regs, buf, len); S_IRUGO | S_IWUSR,
} /* Datasheet suggests this one and this one only
has the registers in different order */
static ssize_t ad7291_show_voltage_low(struct device *dev, ad7291_show_t_bound, ad7291_set_t_bound, 0x0E);
struct device_attribute *attr, static IIO_DEVICE_ATTR(v3_low,
char *buf) S_IRUGO | S_IWUSR,
{ ad7291_show_t_bound, ad7291_set_t_bound, 0x0D);
int regs; static IIO_DEVICE_ATTR(v3_hyst,
S_IRUGO | S_IWUSR,
regs = ad7291_get_voltage_limit_regs(attr->attr.name); ad7291_show_t_bound, ad7291_set_t_bound, 0x0F);
static IIO_DEVICE_ATTR(v4_high,
if (regs < 0) S_IRUGO | S_IWUSR,
return regs; ad7291_show_t_bound, ad7291_set_t_bound, 0x10);
static IIO_DEVICE_ATTR(v4_low,
return ad7291_show_t_bound(dev, attr, regs+1, buf); S_IRUGO | S_IWUSR,
} ad7291_show_t_bound, ad7291_set_t_bound, 0x11);
static IIO_DEVICE_ATTR(v4_hyst,
static inline ssize_t ad7291_set_voltage_low(struct device *dev, S_IRUGO | S_IWUSR,
struct device_attribute *attr, ad7291_show_t_bound, ad7291_set_t_bound, 0x12);
const char *buf, static IIO_DEVICE_ATTR(v5_high,
size_t len) S_IRUGO | S_IWUSR,
{ ad7291_show_t_bound, ad7291_set_t_bound, 0x13);
int regs; static IIO_DEVICE_ATTR(v5_low,
S_IRUGO | S_IWUSR,
regs = ad7291_get_voltage_limit_regs(attr->attr.name); ad7291_show_t_bound, ad7291_set_t_bound, 0x14);
static IIO_DEVICE_ATTR(v5_hyst,
if (regs < 0) S_IRUGO | S_IWUSR,
return regs; ad7291_show_t_bound, ad7291_set_t_bound, 0x15);
static IIO_DEVICE_ATTR(v6_high,
return ad7291_set_t_bound(dev, attr, regs+1, buf, len); S_IRUGO | S_IWUSR,
} ad7291_show_t_bound, ad7291_set_t_bound, 0x16);
static IIO_DEVICE_ATTR(v6_low,
static ssize_t ad7291_show_voltage_hyst(struct device *dev, S_IRUGO | S_IWUSR,
struct device_attribute *attr, ad7291_show_t_bound, ad7291_set_t_bound, 0x17);
char *buf) static IIO_DEVICE_ATTR(v6_hyst,
{ S_IRUGO | S_IWUSR,
int regs; ad7291_show_t_bound, ad7291_set_t_bound, 0x18);
static IIO_DEVICE_ATTR(v7_high,
regs = ad7291_get_voltage_limit_regs(attr->attr.name); S_IRUGO | S_IWUSR,
ad7291_show_t_bound, ad7291_set_t_bound, 0x19);
if (regs < 0) static IIO_DEVICE_ATTR(v7_low,
return regs; S_IRUGO | S_IWUSR,
ad7291_show_t_bound, ad7291_set_t_bound, 0x1A);
return ad7291_show_t_bound(dev, attr, regs+2, buf); static IIO_DEVICE_ATTR(v7_hyst,
} S_IRUGO | S_IWUSR,
ad7291_show_t_bound, ad7291_set_t_bound, 0x1B);
static inline ssize_t ad7291_set_voltage_hyst(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t len)
{
int regs;
regs = ad7291_get_voltage_limit_regs(attr->attr.name);
if (regs < 0)
return regs;
return ad7291_set_t_bound(dev, attr, regs+2, buf, len);
}
IIO_EVENT_ATTR_SH(t_sense_high, iio_event_ad7291,
ad7291_show_t_sense_high, ad7291_set_t_sense_high, 0);
IIO_EVENT_ATTR_SH(t_sense_low, iio_event_ad7291,
ad7291_show_t_sense_low, ad7291_set_t_sense_low, 0);
IIO_EVENT_ATTR_SH(t_sense_hyst, iio_event_ad7291,
ad7291_show_t_sense_hyst, ad7291_set_t_sense_hyst, 0);
IIO_EVENT_ATTR_SH(v0_high, iio_event_ad7291,
ad7291_show_voltage_high, ad7291_set_voltage_high, 0);
IIO_EVENT_ATTR_SH(v0_low, iio_event_ad7291,
ad7291_show_voltage_low, ad7291_set_voltage_low, 0);
IIO_EVENT_ATTR_SH(v0_hyst, iio_event_ad7291,
ad7291_show_voltage_hyst, ad7291_set_voltage_hyst, 0);
IIO_EVENT_ATTR_SH(v1_high, iio_event_ad7291,
ad7291_show_voltage_high, ad7291_set_voltage_high, 0);
IIO_EVENT_ATTR_SH(v1_low, iio_event_ad7291,
ad7291_show_voltage_low, ad7291_set_voltage_low, 0);
IIO_EVENT_ATTR_SH(v1_hyst, iio_event_ad7291,
ad7291_show_voltage_hyst, ad7291_set_voltage_hyst, 0);
IIO_EVENT_ATTR_SH(v2_high, iio_event_ad7291,
ad7291_show_voltage_high, ad7291_set_voltage_high, 0);
IIO_EVENT_ATTR_SH(v2_low, iio_event_ad7291,
ad7291_show_voltage_low, ad7291_set_voltage_low, 0);
IIO_EVENT_ATTR_SH(v2_hyst, iio_event_ad7291,
ad7291_show_voltage_hyst, ad7291_set_voltage_hyst, 0);
IIO_EVENT_ATTR_SH(v3_high, iio_event_ad7291,
ad7291_show_voltage_high, ad7291_set_voltage_high, 0);
IIO_EVENT_ATTR_SH(v3_low, iio_event_ad7291,
ad7291_show_voltage_low, ad7291_set_voltage_low, 0);
IIO_EVENT_ATTR_SH(v3_hyst, iio_event_ad7291,
ad7291_show_voltage_hyst, ad7291_set_voltage_hyst, 0);
IIO_EVENT_ATTR_SH(v4_high, iio_event_ad7291,
ad7291_show_voltage_high, ad7291_set_voltage_high, 0);
IIO_EVENT_ATTR_SH(v4_low, iio_event_ad7291,
ad7291_show_voltage_low, ad7291_set_voltage_low, 0);
IIO_EVENT_ATTR_SH(v4_hyst, iio_event_ad7291,
ad7291_show_voltage_hyst, ad7291_set_voltage_hyst, 0);
IIO_EVENT_ATTR_SH(v5_high, iio_event_ad7291,
ad7291_show_voltage_high, ad7291_set_voltage_high, 0);
IIO_EVENT_ATTR_SH(v5_low, iio_event_ad7291,
ad7291_show_voltage_low, ad7291_set_voltage_low, 0);
IIO_EVENT_ATTR_SH(v5_hyst, iio_event_ad7291,
ad7291_show_voltage_hyst, ad7291_set_voltage_hyst, 0);
IIO_EVENT_ATTR_SH(v6_high, iio_event_ad7291,
ad7291_show_voltage_high, ad7291_set_voltage_high, 0);
IIO_EVENT_ATTR_SH(v6_low, iio_event_ad7291,
ad7291_show_voltage_low, ad7291_set_voltage_low, 0);
IIO_EVENT_ATTR_SH(v6_hyst, iio_event_ad7291,
ad7291_show_voltage_hyst, ad7291_set_voltage_hyst, 0);
IIO_EVENT_ATTR_SH(v7_high, iio_event_ad7291,
ad7291_show_voltage_high, ad7291_set_voltage_high, 0);
IIO_EVENT_ATTR_SH(v7_low, iio_event_ad7291,
ad7291_show_voltage_low, ad7291_set_voltage_low, 0);
IIO_EVENT_ATTR_SH(v7_hyst, iio_event_ad7291,
ad7291_show_voltage_hyst, ad7291_set_voltage_hyst, 0);
static struct attribute *ad7291_event_attributes[] = { static struct attribute *ad7291_event_attributes[] = {
&iio_event_attr_t_sense_high.dev_attr.attr, &iio_dev_attr_t_sense_high_value.dev_attr.attr,
&iio_event_attr_t_sense_low.dev_attr.attr, &iio_dev_attr_t_sense_low_value.dev_attr.attr,
&iio_event_attr_t_sense_hyst.dev_attr.attr, &iio_dev_attr_t_sense_hyst_value.dev_attr.attr,
&iio_event_attr_v0_high.dev_attr.attr, &iio_dev_attr_v0_high.dev_attr.attr,
&iio_event_attr_v0_low.dev_attr.attr, &iio_dev_attr_v0_low.dev_attr.attr,
&iio_event_attr_v0_hyst.dev_attr.attr, &iio_dev_attr_v0_hyst.dev_attr.attr,
&iio_event_attr_v1_high.dev_attr.attr, &iio_dev_attr_v1_high.dev_attr.attr,
&iio_event_attr_v1_low.dev_attr.attr, &iio_dev_attr_v1_low.dev_attr.attr,
&iio_event_attr_v1_hyst.dev_attr.attr, &iio_dev_attr_v1_hyst.dev_attr.attr,
&iio_event_attr_v2_high.dev_attr.attr, &iio_dev_attr_v2_high.dev_attr.attr,
&iio_event_attr_v2_low.dev_attr.attr, &iio_dev_attr_v2_low.dev_attr.attr,
&iio_event_attr_v2_hyst.dev_attr.attr, &iio_dev_attr_v2_hyst.dev_attr.attr,
&iio_event_attr_v3_high.dev_attr.attr, &iio_dev_attr_v3_high.dev_attr.attr,
&iio_event_attr_v3_low.dev_attr.attr, &iio_dev_attr_v3_low.dev_attr.attr,
&iio_event_attr_v3_hyst.dev_attr.attr, &iio_dev_attr_v3_hyst.dev_attr.attr,
&iio_event_attr_v4_high.dev_attr.attr, &iio_dev_attr_v4_high.dev_attr.attr,
&iio_event_attr_v4_low.dev_attr.attr, &iio_dev_attr_v4_low.dev_attr.attr,
&iio_event_attr_v4_hyst.dev_attr.attr, &iio_dev_attr_v4_hyst.dev_attr.attr,
&iio_event_attr_v5_high.dev_attr.attr, &iio_dev_attr_v5_high.dev_attr.attr,
&iio_event_attr_v5_low.dev_attr.attr, &iio_dev_attr_v5_low.dev_attr.attr,
&iio_event_attr_v5_hyst.dev_attr.attr, &iio_dev_attr_v5_hyst.dev_attr.attr,
&iio_event_attr_v6_high.dev_attr.attr, &iio_dev_attr_v6_high.dev_attr.attr,
&iio_event_attr_v6_low.dev_attr.attr, &iio_dev_attr_v6_low.dev_attr.attr,
&iio_event_attr_v6_hyst.dev_attr.attr, &iio_dev_attr_v6_hyst.dev_attr.attr,
&iio_event_attr_v7_high.dev_attr.attr, &iio_dev_attr_v7_high.dev_attr.attr,
&iio_event_attr_v7_low.dev_attr.attr, &iio_dev_attr_v7_low.dev_attr.attr,
&iio_event_attr_v7_hyst.dev_attr.attr, &iio_dev_attr_v7_hyst.dev_attr.attr,
NULL, NULL,
}; };
...@@ -945,24 +806,15 @@ static int __devinit ad7291_probe(struct i2c_client *client, ...@@ -945,24 +806,15 @@ static int __devinit ad7291_probe(struct i2c_client *client,
goto error_free_dev; goto error_free_dev;
if (client->irq > 0) { if (client->irq > 0) {
ret = iio_register_interrupt_line(client->irq, ret = request_threaded_irq(client->irq,
chip->indio_dev, NULL,
0, &ad7291_event_handler,
IRQF_TRIGGER_LOW, IRQF_TRIGGER_LOW | IRQF_ONESHOT,
chip->name); chip->name,
chip->indio_dev);
if (ret) if (ret)
goto error_unreg_dev; goto error_unreg_dev;
/*
* The event handler list element refer to iio_event_ad7291.
* All event attributes bind to the same event handler.
* So, only register event handler once.
*/
iio_add_event_to_list(&iio_event_ad7291,
&chip->indio_dev->interrupts[0]->ev_list);
INIT_WORK(&chip->thresh_work, ad7291_interrupt_bh);
/* set irq polarity low level */ /* set irq polarity low level */
chip->command |= AD7291_ALART_POLARITY; chip->command |= AD7291_ALART_POLARITY;
} }
...@@ -979,7 +831,7 @@ static int __devinit ad7291_probe(struct i2c_client *client, ...@@ -979,7 +831,7 @@ static int __devinit ad7291_probe(struct i2c_client *client,
return 0; return 0;
error_unreg_irq: error_unreg_irq:
iio_unregister_interrupt_line(chip->indio_dev, 0); free_irq(client->irq, chip->indio_dev);
error_unreg_dev: error_unreg_dev:
iio_device_unregister(chip->indio_dev); iio_device_unregister(chip->indio_dev);
error_free_dev: error_free_dev:
...@@ -996,7 +848,7 @@ static int __devexit ad7291_remove(struct i2c_client *client) ...@@ -996,7 +848,7 @@ static int __devexit ad7291_remove(struct i2c_client *client)
struct iio_dev *indio_dev = chip->indio_dev; struct iio_dev *indio_dev = chip->indio_dev;
if (client->irq) if (client->irq)
iio_unregister_interrupt_line(indio_dev, 0); free_irq(client->irq, chip->indio_dev);
iio_device_unregister(indio_dev); iio_device_unregister(indio_dev);
iio_free_device(chip->indio_dev); iio_free_device(chip->indio_dev);
kfree(chip); kfree(chip);
......
Markdown is supported
0% 或 .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑！
想要评论请 注册 或