openkylin
/
linux
mirror of https://gitee.com/openkylin/linux.git
9
0
Fork 0
Code Issues Projects Releases Wiki Activity

staging:iio:triggers:interrupt trigger - one per platform device. 

Switching from one platform device registering a lot of triggers
to one for each trigger simplifies the code somewhat. It would be
relatively unusual to have more than a couple of such devices
registered so this change will not result in much additional overhead.

Signed-off-by: Jonathan Cameron <jic23@kernel.org>
Reviewed-by: Lars-Peter Clausen <lars@metafoo.de>
This commit is contained in:
Jonathan Cameron 2013-06-02 20:00:00 +01:00
parent d4fd73bf25
commit 3c1e02dbb3
1 changed files with 39 additions and 70 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

109
drivers/staging/iio/trigger/iio-trig-interrupt.c
View File

@ -17,11 +17,8 @@
#include <linux/iio/iio.h> #include <linux/iio/iio.h>
#include <linux/iio/trigger.h> #include <linux/iio/trigger.h>
static LIST_HEAD(iio_interrupt_trigger_list);
static DEFINE_MUTEX(iio_interrupt_trigger_list_lock);
struct iio_interrupt_trigger_info { struct iio_interrupt_trigger_info {
struct mutex in_use;
unsigned int irq; unsigned int irq;
}; };
@ -39,57 +36,46 @@ static const struct iio_trigger_ops iio_interrupt_trigger_ops = {
static int iio_interrupt_trigger_probe(struct platform_device *pdev) static int iio_interrupt_trigger_probe(struct platform_device *pdev)
{ {
struct iio_interrupt_trigger_info *trig_info; struct iio_interrupt_trigger_info *trig_info;
struct iio_trigger *trig, *trig2; struct iio_trigger *trig;
unsigned long irqflags; unsigned long irqflags;
struct resource *irq_res; struct resource *irq_res;
int irq, ret = 0, irq_res_cnt = 0; int irq, ret = 0;
do { irq_res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
irq_res = platform_get_resource(pdev,
IORESOURCE_IRQ, irq_res_cnt);
if (irq_res == NULL) { if (irq_res == NULL)
if (irq_res_cnt == 0) return -ENODEV;
dev_err(&pdev->dev, "No IRQs specified");
break;
}
irqflags = (irq_res->flags & IRQF_TRIGGER_MASK) | IRQF_SHARED;
for (irq = irq_res->start; irq <= irq_res->end; irq++) { irqflags = (irq_res->flags & IRQF_TRIGGER_MASK) | IRQF_SHARED;
trig = iio_trigger_alloc("irqtrig%d", irq); irq = irq_res->start;
if (!trig) {
ret = -ENOMEM;
goto error_free_completed_registrations;
}
trig_info = kzalloc(sizeof(*trig_info), GFP_KERNEL); trig = iio_trigger_alloc("irqtrig%d", irq_res->start);
if (!trig_info) { if (!trig) {
ret = -ENOMEM; ret = -ENOMEM;
goto error_put_trigger; goto error_ret;
} }
iio_trigger_set_drvdata(trig, trig_info);
trig_info->irq = irq;
trig->ops = &iio_interrupt_trigger_ops;
ret = request_irq(irq, iio_interrupt_trigger_poll,
irqflags, trig->name, trig);
if (ret) {
dev_err(&pdev->dev,
"request IRQ-%d failed", irq);
goto error_free_trig_info;
}
ret = iio_trigger_register(trig); trig_info = kzalloc(sizeof(*trig_info), GFP_KERNEL);
if (ret) if (!trig_info) {
goto error_release_irq; ret = -ENOMEM;
goto error_put_trigger;
list_add_tail(&trig->alloc_list, }
&iio_interrupt_trigger_list); iio_trigger_set_drvdata(trig, trig_info);
} trig_info->irq = irq;
trig->ops = &iio_interrupt_trigger_ops;
irq_res_cnt++; ret = request_irq(irq, iio_interrupt_trigger_poll,
} while (irq_res != NULL); irqflags, trig->name, trig);
if (ret) {
dev_err(&pdev->dev,
"request IRQ-%d failed", irq);
goto error_free_trig_info;
}
ret = iio_trigger_register(trig);
if (ret)
goto error_release_irq;
platform_set_drvdata(pdev, trig);
return 0; return 0;
@ -100,38 +86,21 @@ static int iio_interrupt_trigger_probe(struct platform_device *pdev)
kfree(trig_info); kfree(trig_info);
error_put_trigger: error_put_trigger:
iio_trigger_put(trig); iio_trigger_put(trig);
error_free_completed_registrations: error_ret:
/* The rest should have been added to the iio_interrupt_trigger_list */
list_for_each_entry_safe(trig,
trig2,
&iio_interrupt_trigger_list,
alloc_list) {
trig_info = iio_trigger_get_drvdata(trig);
free_irq(trig_info->irq, trig);
kfree(trig_info);
iio_trigger_unregister(trig);
}
return ret; return ret;
} }
static int iio_interrupt_trigger_remove(struct platform_device *pdev) static int iio_interrupt_trigger_remove(struct platform_device *pdev)
{ {
struct iio_trigger *trig, *trig2; struct iio_trigger *trig;
struct iio_interrupt_trigger_info *trig_info; struct iio_interrupt_trigger_info *trig_info;
mutex_lock(&iio_interrupt_trigger_list_lock); trig = platform_get_drvdata(pdev);
list_for_each_entry_safe(trig, trig_info = iio_trigger_get_drvdata(trig);
trig2, iio_trigger_unregister(trig);
&iio_interrupt_trigger_list, free_irq(trig_info->irq, trig);
alloc_list) { kfree(trig_info);
trig_info = iio_trigger_get_drvdata(trig); iio_trigger_put(trig);
iio_trigger_unregister(trig);
free_irq(trig_info->irq, trig);
kfree(trig_info);
iio_trigger_put(trig);
}
mutex_unlock(&iio_interrupt_trigger_list_lock);
return 0; return 0;
} }