Michael Hennerich | 69c272c | 2011-05-18 14:42:03 +0100 | [diff] [blame] | 1 | /* |
| 2 | * ADE7758 Poly Phase Multifunction Energy Metering IC driver |
| 3 | * |
| 4 | * Copyright 2010-2011 Analog Devices Inc. |
| 5 | * |
| 6 | * Licensed under the GPL-2. |
| 7 | */ |
| 8 | |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 9 | #include <linux/interrupt.h> |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 10 | #include <linux/kernel.h> |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 11 | #include <linux/spi/spi.h> |
Paul Gortmaker | 8e336a7 | 2011-07-10 13:09:12 -0400 | [diff] [blame] | 12 | #include <linux/export.h> |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 13 | |
Jonathan Cameron | 06458e2 | 2012-04-25 15:54:58 +0100 | [diff] [blame] | 14 | #include <linux/iio/iio.h> |
| 15 | #include <linux/iio/trigger.h> |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 16 | #include "ade7758.h" |
| 17 | |
| 18 | /** |
| 19 | * ade7758_data_rdy_trig_poll() the event handler for the data rdy trig |
| 20 | **/ |
Jonathan Cameron | 4be6f5d | 2011-04-18 12:59:06 +0100 | [diff] [blame] | 21 | static irqreturn_t ade7758_data_rdy_trig_poll(int irq, void *private) |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 22 | { |
Jonathan Cameron | 4be6f5d | 2011-04-18 12:59:06 +0100 | [diff] [blame] | 23 | disable_irq_nosync(irq); |
Peter Meerwald | 398fd22 | 2014-12-06 06:46:00 +0000 | [diff] [blame] | 24 | iio_trigger_poll(private); |
Michael Hennerich | 69c272c | 2011-05-18 14:42:03 +0100 | [diff] [blame] | 25 | |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 26 | return IRQ_HANDLED; |
| 27 | } |
| 28 | |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 29 | /** |
| 30 | * ade7758_data_rdy_trigger_set_state() set datardy interrupt state |
| 31 | **/ |
| 32 | static int ade7758_data_rdy_trigger_set_state(struct iio_trigger *trig, |
| 33 | bool state) |
| 34 | { |
Lars-Peter Clausen | 1e9663c | 2013-03-25 08:58:00 +0000 | [diff] [blame] | 35 | struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig); |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 36 | |
| 37 | dev_dbg(&indio_dev->dev, "%s (%d)\n", __func__, state); |
Jonathan Cameron | 4be6f5d | 2011-04-18 12:59:06 +0100 | [diff] [blame] | 38 | return ade7758_set_irq(&indio_dev->dev, state); |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 39 | } |
| 40 | |
| 41 | /** |
| 42 | * ade7758_trig_try_reen() try renabling irq for data rdy trigger |
| 43 | * @trig: the datardy trigger |
| 44 | **/ |
| 45 | static int ade7758_trig_try_reen(struct iio_trigger *trig) |
| 46 | { |
Lars-Peter Clausen | 1e9663c | 2013-03-25 08:58:00 +0000 | [diff] [blame] | 47 | struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig); |
Michael Hennerich | a3f0237 | 2011-05-18 14:42:36 +0100 | [diff] [blame] | 48 | struct ade7758_state *st = iio_priv(indio_dev); |
Michael Hennerich | 69c272c | 2011-05-18 14:42:03 +0100 | [diff] [blame] | 49 | |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 50 | enable_irq(st->us->irq); |
| 51 | /* irq reenabled so success! */ |
| 52 | return 0; |
| 53 | } |
| 54 | |
Jonathan Cameron | d29f73d | 2011-08-12 17:08:38 +0100 | [diff] [blame] | 55 | static const struct iio_trigger_ops ade7758_trigger_ops = { |
| 56 | .owner = THIS_MODULE, |
| 57 | .set_trigger_state = &ade7758_data_rdy_trigger_set_state, |
| 58 | .try_reenable = &ade7758_trig_try_reen, |
| 59 | }; |
| 60 | |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 61 | int ade7758_probe_trigger(struct iio_dev *indio_dev) |
| 62 | { |
Michael Hennerich | a3f0237 | 2011-05-18 14:42:36 +0100 | [diff] [blame] | 63 | struct ade7758_state *st = iio_priv(indio_dev); |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 64 | int ret; |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 65 | |
Lars-Peter Clausen | 7cbb753 | 2012-04-26 13:35:01 +0200 | [diff] [blame] | 66 | st->trig = iio_trigger_alloc("%s-dev%d", |
Jonathan Cameron | 59c85e8 | 2011-05-18 14:42:22 +0100 | [diff] [blame] | 67 | spi_get_device_id(st->us)->name, |
| 68 | indio_dev->id); |
Cristina Opriceana | 4529757 | 2015-03-31 13:01:18 +0300 | [diff] [blame] | 69 | if (!st->trig) { |
Michael Hennerich | 69c272c | 2011-05-18 14:42:03 +0100 | [diff] [blame] | 70 | ret = -ENOMEM; |
Jonathan Cameron | 59c85e8 | 2011-05-18 14:42:22 +0100 | [diff] [blame] | 71 | goto error_ret; |
Michael Hennerich | 69c272c | 2011-05-18 14:42:03 +0100 | [diff] [blame] | 72 | } |
| 73 | |
Jonathan Cameron | 4be6f5d | 2011-04-18 12:59:06 +0100 | [diff] [blame] | 74 | ret = request_irq(st->us->irq, |
| 75 | ade7758_data_rdy_trig_poll, |
Michael Hennerich | 69c272c | 2011-05-18 14:42:03 +0100 | [diff] [blame] | 76 | IRQF_TRIGGER_LOW, |
| 77 | spi_get_device_id(st->us)->name, |
Jonathan Cameron | 4be6f5d | 2011-04-18 12:59:06 +0100 | [diff] [blame] | 78 | st->trig); |
| 79 | if (ret) |
| 80 | goto error_free_trig; |
| 81 | |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 82 | st->trig->dev.parent = &st->us->dev; |
Jonathan Cameron | d29f73d | 2011-08-12 17:08:38 +0100 | [diff] [blame] | 83 | st->trig->ops = &ade7758_trigger_ops; |
Lars-Peter Clausen | 1e9663c | 2013-03-25 08:58:00 +0000 | [diff] [blame] | 84 | iio_trigger_set_drvdata(st->trig, indio_dev); |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 85 | ret = iio_trigger_register(st->trig); |
| 86 | |
| 87 | /* select default trigger */ |
Srinivas Pandruvada | 0495081 | 2014-08-22 21:48:00 +0100 | [diff] [blame] | 88 | indio_dev->trig = iio_trigger_get(st->trig); |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 89 | if (ret) |
Michael Hennerich | 69c272c | 2011-05-18 14:42:03 +0100 | [diff] [blame] | 90 | goto error_free_irq; |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 91 | |
| 92 | return 0; |
| 93 | |
Jonathan Cameron | 4be6f5d | 2011-04-18 12:59:06 +0100 | [diff] [blame] | 94 | error_free_irq: |
| 95 | free_irq(st->us->irq, st->trig); |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 96 | error_free_trig: |
Lars-Peter Clausen | 7cbb753 | 2012-04-26 13:35:01 +0200 | [diff] [blame] | 97 | iio_trigger_free(st->trig); |
Jonathan Cameron | 4be6f5d | 2011-04-18 12:59:06 +0100 | [diff] [blame] | 98 | error_ret: |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 99 | return ret; |
| 100 | } |
| 101 | |
| 102 | void ade7758_remove_trigger(struct iio_dev *indio_dev) |
| 103 | { |
Michael Hennerich | a3f0237 | 2011-05-18 14:42:36 +0100 | [diff] [blame] | 104 | struct ade7758_state *st = iio_priv(indio_dev); |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 105 | |
Michael Hennerich | a3f0237 | 2011-05-18 14:42:36 +0100 | [diff] [blame] | 106 | iio_trigger_unregister(st->trig); |
| 107 | free_irq(st->us->irq, st->trig); |
Lars-Peter Clausen | 7cbb753 | 2012-04-26 13:35:01 +0200 | [diff] [blame] | 108 | iio_trigger_free(st->trig); |
Barry Song | 8210cfe | 2010-10-27 21:44:16 -0400 | [diff] [blame] | 109 | } |