Add a separate structure for events and add the infrastructure to support an arbitrary number of events. Each event is associated with an interrupt and has an enabled/disabled state. Signed-off-by: Octavian Purdila <octavian.purdila@xxxxxxxxx> --- drivers/iio/accel/bmc150-accel.c | 177 ++++++++++++++++++++++++++++++--------- 1 file changed, 139 insertions(+), 38 deletions(-) diff --git a/drivers/iio/accel/bmc150-accel.c b/drivers/iio/accel/bmc150-accel.c index ed02ced..72d2dca 100644 --- a/drivers/iio/accel/bmc150-accel.c +++ b/drivers/iio/accel/bmc150-accel.c @@ -163,21 +163,37 @@ struct bmc150_accel_trigger { bool enabled; }; +struct bmc150_accel_event { + struct bmc150_accel_interrupt *intr; + struct bmc150_accel_data *data; + enum iio_event_type type; + bool enabled; + int (*read)(struct bmc150_accel_event *event, enum iio_event_info info, + int *val, int *val2); + int (*write)(struct bmc150_accel_event *event, enum iio_event_info info, + int val, int val2); + union { + struct { + u32 duration; + u32 threshold; + } slope; + }; +}; + #define BMC150_ACCEL_INTERRUPTS 2 #define BMC150_ACCEL_TRIGGERS 2 +#define BMC150_ACCEL_EVENTS 1 struct bmc150_accel_data { struct i2c_client *client; struct bmc150_accel_interrupt interrupts[BMC150_ACCEL_INTERRUPTS]; atomic_t active_intr; struct bmc150_accel_trigger triggers[BMC150_ACCEL_TRIGGERS]; + struct bmc150_accel_event events[BMC150_ACCEL_EVENTS]; struct mutex mutex; s16 buffer[8]; u8 bw_bits; - u32 slope_dur; - u32 slope_thres; u32 range; - int ev_enable_state; int64_t timestamp; const struct bmc150_accel_chip_info *chip_info; }; @@ -287,7 +303,8 @@ static int bmc150_accel_set_bw(struct bmc150_accel_data *data, int val, return -EINVAL; } -static int bmc150_accel_update_slope_threshold(struct bmc150_accel_data *data, +static int bmc150_accel_update_slope_threshold(struct bmc150_accel_event *event, + struct bmc150_accel_data *data, int val) { int ret = 0; @@ -300,14 +317,15 @@ static int bmc150_accel_update_slope_threshold(struct bmc150_accel_data *data, dev_err(&data->client->dev, "Error writing reg_int_6\n"); return ret; } - data->slope_thres = val; + event->slope.threshold = val; dev_dbg(&data->client->dev, "%s: %x\n", __func__, val); return ret; } -static int bmc150_accel_update_slope_duration(struct bmc150_accel_data *data, +static int bmc150_accel_update_slope_duration(struct bmc150_accel_event *event, + struct bmc150_accel_data *data, int val) { int ret; @@ -325,7 +343,7 @@ static int bmc150_accel_update_slope_duration(struct bmc150_accel_data *data, dev_err(&data->client->dev, "Error write reg_int_5\n"); return ret; } - data->slope_dur = val; + event->slope.duration = val; dev_dbg(&data->client->dev, "%s: %x\n", __func__, val); @@ -371,12 +389,12 @@ static int bmc150_accel_chip_init(struct bmc150_accel_data *data) data->range = BMC150_ACCEL_DEF_RANGE_4G; /* Set default slope duration and thresholds */ - ret = bmc150_accel_update_slope_duration(data, + ret = bmc150_accel_update_slope_duration(&data->events[0], data, BMC150_ACCEL_DEF_SLOPE_DURATION); if (ret < 0) return ret; - ret = bmc150_accel_update_slope_threshold(data, + ret = bmc150_accel_update_slope_threshold(&data->events[0], data, BMC150_ACCEL_DEF_SLOPE_THRESHOLD); if (ret < 0) return ret; @@ -714,22 +732,30 @@ static int bmc150_accel_write_raw(struct iio_dev *indio_dev, return ret; } -static int bmc150_accel_read_event(struct iio_dev *indio_dev, - const struct iio_chan_spec *chan, - enum iio_event_type type, - enum iio_event_direction dir, - enum iio_event_info info, - int *val, int *val2) +static struct bmc150_accel_event* +bmc150_accel_get_event(struct iio_dev *indio_dev, enum iio_event_type type) { struct bmc150_accel_data *data = iio_priv(indio_dev); + int i; + + for (i = 0; i < BMC150_ACCEL_EVENTS; i++) + if (data->events[i].type == type) + return &data->events[i]; + + return NULL; +} +static int bmc150_accel_event_roc_read(struct bmc150_accel_event *event, + enum iio_event_info info, + int *val, int *val2) +{ *val2 = 0; switch (info) { case IIO_EV_INFO_VALUE: - *val = data->slope_thres; + *val = event->slope.threshold; break; case IIO_EV_INFO_PERIOD: - *val = data->slope_dur; + *val = event->slope.duration; break; default: return -EINVAL; @@ -738,28 +764,40 @@ static int bmc150_accel_read_event(struct iio_dev *indio_dev, return IIO_VAL_INT; } -static int bmc150_accel_write_event(struct iio_dev *indio_dev, - const struct iio_chan_spec *chan, - enum iio_event_type type, - enum iio_event_direction dir, - enum iio_event_info info, - int val, int val2) +static int bmc150_accel_read_event(struct iio_dev *indio_dev, + const struct iio_chan_spec *chan, + enum iio_event_type type, + enum iio_event_direction dir, + enum iio_event_info info, + int *val, int *val2) { - struct bmc150_accel_data *data = iio_priv(indio_dev); - int ret; + struct bmc150_accel_event *event; - if (data->ev_enable_state) - return -EBUSY; + event = bmc150_accel_get_event(indio_dev, type); + if (!event || !event->read) + return -EINVAL; + + return event->read(event, info, val, val2); +} + +static int bmc150_accel_event_roc_write(struct bmc150_accel_event *event, + enum iio_event_info info, + int val, int val2) +{ + struct bmc150_accel_data *data = event->data; + int ret; switch (info) { case IIO_EV_INFO_VALUE: mutex_lock(&data->mutex); - ret = bmc150_accel_update_slope_threshold(data, val); + ret = bmc150_accel_update_slope_threshold(event, event->data, + val); mutex_unlock(&data->mutex); break; case IIO_EV_INFO_PERIOD: mutex_lock(&data->mutex); - ret = bmc150_accel_update_slope_duration(data, val); + ret = bmc150_accel_update_slope_duration(event, event->data, + val); mutex_unlock(&data->mutex); break; default: @@ -769,15 +807,37 @@ static int bmc150_accel_write_event(struct iio_dev *indio_dev, return ret; } +static int bmc150_accel_write_event(struct iio_dev *indio_dev, + const struct iio_chan_spec *chan, + enum iio_event_type type, + enum iio_event_direction dir, + enum iio_event_info info, + int val, int val2) +{ + struct bmc150_accel_event *event; + + event = bmc150_accel_get_event(indio_dev, type); + if (!event || !event->write) + return -EINVAL; + + if (event->enabled) + return -EBUSY; + + return event->write(event, info, val, val2); +} + static int bmc150_accel_read_event_config(struct iio_dev *indio_dev, const struct iio_chan_spec *chan, enum iio_event_type type, enum iio_event_direction dir) { + struct bmc150_accel_event *event; - struct bmc150_accel_data *data = iio_priv(indio_dev); + event = bmc150_accel_get_event(indio_dev, type); + if (!event) + return -EINVAL; - return data->ev_enable_state; + return event->enabled; } static int bmc150_accel_write_event_config(struct iio_dev *indio_dev, @@ -787,15 +847,20 @@ static int bmc150_accel_write_event_config(struct iio_dev *indio_dev, int state) { struct bmc150_accel_data *data = iio_priv(indio_dev); + struct bmc150_accel_event *event; int ret; - if (state == data->ev_enable_state) + event = bmc150_accel_get_event(indio_dev, type); + if (!event) + return -EINVAL; + + if (state == event->enabled) return 0; mutex_lock(&data->mutex); - ret = bmc150_accel_set_interrupt(data, &data->interrupts[1], state); + ret = bmc150_accel_set_interrupt(data, event->intr, state); if (!ret) - data->ev_enable_state = state; + event->enabled = state; mutex_unlock(&data->mutex); return ret; @@ -827,12 +892,14 @@ static const struct attribute_group bmc150_accel_attrs_group = { .attrs = bmc150_accel_attributes, }; -static const struct iio_event_spec bmc150_accel_event = { +static const struct iio_event_spec bmc150_accel_events[BMC150_ACCEL_EVENTS] = { + { .type = IIO_EV_TYPE_ROC, .dir = IIO_EV_DIR_RISING | IIO_EV_DIR_FALLING, .mask_separate = BIT(IIO_EV_INFO_VALUE) | BIT(IIO_EV_INFO_ENABLE) | BIT(IIO_EV_INFO_PERIOD) + }, }; #define BMC150_ACCEL_CHANNEL(_axis, bits) { \ @@ -849,8 +916,8 @@ static const struct iio_event_spec bmc150_accel_event = { .storagebits = 16, \ .shift = 16 - (bits), \ }, \ - .event_spec = &bmc150_accel_event, \ - .num_event_specs = 1 \ + .event_spec = bmc150_accel_events, \ + .num_event_specs = ARRAY_SIZE(bmc150_accel_events) \ } #define BMC150_ACCEL_CHANNELS(bits) { \ @@ -1092,7 +1159,7 @@ static irqreturn_t bmc150_accel_data_rdy_trig_poll(int irq, void *private) } } - if (data->ev_enable_state) + if (data->events[0].enabled) return IRQ_WAKE_THREAD; else return IRQ_HANDLED; @@ -1205,6 +1272,38 @@ static int bmc150_accel_triggers_setup(struct iio_dev *indio_dev, return ret; } +static struct { + int intr; + enum iio_event_type type; + int (*read)(struct bmc150_accel_event *event, enum iio_event_info info, + int *val, int *val2); + int (*write)(struct bmc150_accel_event *event, enum iio_event_info info, + int val, int val2); +} bmc150_accel_events_info[BMC150_ACCEL_EVENTS] = { + { + .intr = 1, + .type = IIO_EV_TYPE_ROC, + .read = bmc150_accel_event_roc_read, + .write = bmc150_accel_event_roc_write, + }, +}; + +static void bmc150_accel_events_setup(struct iio_dev *indio_dev, + struct bmc150_accel_data *data) +{ + int i; + + for (i = 0; i < BMC150_ACCEL_EVENTS; i++) { + int intr = bmc150_accel_events_info[i].intr; + + data->events[i].intr = &data->interrupts[intr]; + data->events[i].data = data; + data->events[i].type = bmc150_accel_events_info[i].type; + data->events[i].read = bmc150_accel_events_info[i].read; + data->events[i].write = bmc150_accel_events_info[i].write; + } +} + static int bmc150_accel_probe(struct i2c_client *client, const struct i2c_device_id *id) { @@ -1279,6 +1378,8 @@ static int bmc150_accel_probe(struct i2c_client *client, if (ret) return ret; + bmc150_accel_events_setup(indio_dev, data); + ret = iio_triggered_buffer_setup(indio_dev, &iio_pollfunc_store_time, bmc150_accel_trigger_handler, -- 1.9.1 -- 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