1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/device.h>
20#include <linux/platform_device.h>
21#include <linux/module.h>
22#include <linux/interrupt.h>
23#include <linux/irq.h>
24#include <linux/slab.h>
25#include <linux/hid-sensor-hub.h>
26#include <linux/iio/iio.h>
27#include <linux/iio/trigger.h>
28#include <linux/iio/sysfs.h>
29#include "hid-sensor-trigger.h"
30
31static int hid_sensor_data_rdy_trigger_set_state(struct iio_trigger *trig,
32 bool state)
33{
34 struct hid_sensor_common *st = iio_trigger_get_drvdata(trig);
35 int state_val;
36
37 state_val = state ? 1 : 0;
38 if (IS_ENABLED(CONFIG_HID_SENSOR_ENUM_BASE_QUIRKS))
39 ++state_val;
40 st->data_ready = state;
41 sensor_hub_set_feature(st->hsdev, st->power_state.report_id,
42 st->power_state.index,
43 (s32)state_val);
44
45 sensor_hub_set_feature(st->hsdev, st->report_state.report_id,
46 st->report_state.index,
47 (s32)state_val);
48
49 return 0;
50}
51
52void hid_sensor_remove_trigger(struct iio_dev *indio_dev)
53{
54 iio_trigger_unregister(indio_dev->trig);
55 iio_trigger_free(indio_dev->trig);
56 indio_dev->trig = NULL;
57}
58EXPORT_SYMBOL(hid_sensor_remove_trigger);
59
60static const struct iio_trigger_ops hid_sensor_trigger_ops = {
61 .owner = THIS_MODULE,
62 .set_trigger_state = &hid_sensor_data_rdy_trigger_set_state,
63};
64
65int hid_sensor_setup_trigger(struct iio_dev *indio_dev, const char *name,
66 struct hid_sensor_common *attrb)
67{
68 int ret;
69 struct iio_trigger *trig;
70
71 trig = iio_trigger_alloc("%s-dev%d", name, indio_dev->id);
72 if (trig == NULL) {
73 dev_err(&indio_dev->dev, "Trigger Allocate Failed\n");
74 ret = -ENOMEM;
75 goto error_ret;
76 }
77
78 trig->dev.parent = indio_dev->dev.parent;
79 iio_trigger_set_drvdata(trig, attrb);
80 trig->ops = &hid_sensor_trigger_ops;
81 ret = iio_trigger_register(trig);
82
83 if (ret) {
84 dev_err(&indio_dev->dev, "Trigger Register Failed\n");
85 goto error_free_trig;
86 }
87 indio_dev->trig = trig;
88
89 return ret;
90
91error_free_trig:
92 iio_trigger_free(trig);
93error_ret:
94 return ret;
95}
96EXPORT_SYMBOL(hid_sensor_setup_trigger);
97
98MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@intel.com>");
99MODULE_DESCRIPTION("HID Sensor trigger processing");
100MODULE_LICENSE("GPL");
101