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 int report_val;
37
38 if (state) {
39 if (sensor_hub_device_open(st->hsdev))
40 return -EIO;
41 state_val =
42 HID_USAGE_SENSOR_PROP_POWER_STATE_D0_FULL_POWER_ENUM;
43 report_val =
44 HID_USAGE_SENSOR_PROP_REPORTING_STATE_ALL_EVENTS_ENUM;
45
46 } else {
47 sensor_hub_device_close(st->hsdev);
48 state_val =
49 HID_USAGE_SENSOR_PROP_POWER_STATE_D4_POWER_OFF_ENUM;
50 report_val =
51 HID_USAGE_SENSOR_PROP_REPORTING_STATE_NO_EVENTS_ENUM;
52 }
53
54 st->data_ready = state;
55 state_val += st->power_state.logical_minimum;
56 report_val += st->report_state.logical_minimum;
57 sensor_hub_set_feature(st->hsdev, st->power_state.report_id,
58 st->power_state.index,
59 (s32)state_val);
60
61 sensor_hub_set_feature(st->hsdev, st->report_state.report_id,
62 st->report_state.index,
63 (s32)report_val);
64
65 return 0;
66}
67
68void hid_sensor_remove_trigger(struct hid_sensor_common *attrb)
69{
70 iio_trigger_unregister(attrb->trigger);
71 iio_trigger_free(attrb->trigger);
72}
73EXPORT_SYMBOL(hid_sensor_remove_trigger);
74
75static const struct iio_trigger_ops hid_sensor_trigger_ops = {
76 .owner = THIS_MODULE,
77 .set_trigger_state = &hid_sensor_data_rdy_trigger_set_state,
78};
79
80int hid_sensor_setup_trigger(struct iio_dev *indio_dev, const char *name,
81 struct hid_sensor_common *attrb)
82{
83 int ret;
84 struct iio_trigger *trig;
85
86 trig = iio_trigger_alloc("%s-dev%d", name, indio_dev->id);
87 if (trig == NULL) {
88 dev_err(&indio_dev->dev, "Trigger Allocate Failed\n");
89 ret = -ENOMEM;
90 goto error_ret;
91 }
92
93 trig->dev.parent = indio_dev->dev.parent;
94 iio_trigger_set_drvdata(trig, attrb);
95 trig->ops = &hid_sensor_trigger_ops;
96 ret = iio_trigger_register(trig);
97
98 if (ret) {
99 dev_err(&indio_dev->dev, "Trigger Register Failed\n");
100 goto error_free_trig;
101 }
102 indio_dev->trig = attrb->trigger = trig;
103
104 return ret;
105
106error_free_trig:
107 iio_trigger_free(trig);
108error_ret:
109 return ret;
110}
111EXPORT_SYMBOL(hid_sensor_setup_trigger);
112
113MODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@intel.com>");
114MODULE_DESCRIPTION("HID Sensor trigger processing");
115MODULE_LICENSE("GPL");
116