2 * Copyright (C) 2014-2015 Intel Corporation.
5 #include <hardware/sensors.h>
7 #include "enumeration.h"
9 #include "description.h"
12 /* This is the IIO Sensors HAL module entry points file */
14 static int init_count;
16 static int activate (__attribute__((unused)) struct sensors_poll_device_t* dev,
17 int handle, int enabled)
23 if (init_count == 0 || handle < 0 || handle >= sensor_count)
26 entry_ts = get_timestamp_boot();
29 * The Intel sensor hub seems to have trouble enabling sensors before
30 * a sampling rate has been configured, and setting the sampling rate
31 * after it's been enabled does not seem to revive affected sensors.
32 * The issue does not show up with an up to date ISH firmware but as the
33 * updater is a Windows only tool and is not widely available, implement
34 * a workaround for this behavior. We set the initial sampling rate to
35 * 10 events per second when the sensor is enabled for the first time.
38 if (enabled && sensor_get_quirks(handle) & QUIRK_INITIAL_RATE) {
39 ALOGI("Forcing initial sampling rate\n");
40 sensor_activate(handle, 1, 0);
41 sensor_set_delay(handle, 100000000); /* Start with 100 ms */
42 sensor_activate(handle, 0, 0);
44 /* Clear flag for this sensor as do this only once */
45 sensor[handle].quirks ^= QUIRK_INITIAL_RATE;
48 ret = sensor_activate(handle, enabled, 0);
50 elapsed_ms = (int) ((get_timestamp_boot() - entry_ts) / 1000000);
54 ALOGI("Activation of sensor %s took %d ms\n", sensor[handle].friendly_name, elapsed_ms);
56 ALOGI("Deactivation of sensor %s took %d ms\n", sensor[handle].friendly_name, elapsed_ms);
63 static int set_delay (__attribute__((unused)) struct sensors_poll_device_t* dev,
64 int handle, int64_t ns)
68 if (init_count == 0 || handle < 0 || handle >= sensor_count)
72 * If this sensor relies on other sensors, try to propagate the
73 * requested sampling rate to the base sensors.
76 for (i=0; i<sensor[handle].base_count; i++)
77 sensor_set_delay(sensor[handle].base[i], ns);
79 return sensor_set_delay(handle, ns);
83 static int poll (__attribute__((unused)) struct sensors_poll_device_t* dev,
84 sensors_event_t* data, int count)
86 if (init_count == 0 || !data || count < 1)
89 return sensor_poll(data, count);
93 static int batch (__attribute__((unused)) struct sensors_poll_device_1* dev,
94 int sensor_handle, __attribute__((unused)) int flags,
95 int64_t sampling_period_ns,
96 __attribute__((unused)) int64_t max_report_latency_ns)
98 return set_delay ((struct sensors_poll_device_t*)dev,
99 sensor_handle, sampling_period_ns);
102 static int flush (__attribute__((unused)) struct sensors_poll_device_1* dev,
105 return sensor_flush (handle);
109 static int close_module (__attribute__((unused)) hw_device_t *device)
116 if (init_count == 0) {
117 ALOGI("Closing IIO sensors HAL module\n");
118 delete_enumeration_data();
119 delete_control_data();
126 static int initialize_module(const struct hw_module_t *module, const char *id,
127 struct hw_device_t** device)
129 static struct sensors_poll_device_1 poll_device;
131 if (strcmp(id, SENSORS_HARDWARE_POLL))
134 poll_device.common.tag = HARDWARE_DEVICE_TAG;
135 poll_device.common.version = SENSORS_DEVICE_API_VERSION_1_3;
136 poll_device.common.module = (struct hw_module_t*) module;
137 poll_device.common.close = close_module;
139 poll_device.activate = activate;
140 poll_device.setDelay = set_delay;
141 poll_device.poll = poll;
142 poll_device.batch = batch;
143 poll_device.flush = flush;
145 *device = &poll_device.common;
147 if (init_count == 0) {
148 ALOGI("Initializing IIO sensors HAL module\n");
149 allocate_control_data();
158 static struct hw_module_methods_t module_methods = {
159 .open = initialize_module
163 /* Externally visible module descriptor */
164 struct sensors_module_t __attribute__ ((visibility ("default")))
165 HAL_MODULE_INFO_SYM = {
167 .tag = HARDWARE_MODULE_TAG,
170 .id = SENSORS_HARDWARE_MODULE_ID,
171 .name = "IIO sensors HAL",
173 .methods = &module_methods,
175 .get_sensors_list = get_sensors_list