static int
control__activate(struct sensors_control_device_t *dev,
int handle,
int enabled)
{
D("%s", __FUNCTION__);
SensorControl* ctl = (void*)dev;
uint32_t mask, sensors, active, new_sensors, changed;
int ret;
D("%s: handle=%s (%d) enabled=%d", __FUNCTION__,
_sensorIdToName(handle), handle, enabled);
if (!ID_CHECK(handle)) {
E("%s: bad handle ID", __FUNCTION__);
return -1;
}
mask = (1<<handle);
sensors = enabled ? mask : 0;
active = active_sensors;
new_sensors = (active & ~mask) | (sensors & mask);
changed = active ^ new_sensors;
if (!changed)
return 0;
active_sensors = new_sensors;
return 0;
}
static int sensor_device_activate(struct sensors_poll_device_t *dev0,
int handle,
int enabled)
{
SensorDevice* dev = (void*)dev0;
D("%s: handle=%s (%d) enabled=%d", __FUNCTION__,
_sensorIdToName(handle), handle, enabled);
/* Sanity check */
if (!ID_CHECK(handle)) {
E("%s: bad handle ID", __FUNCTION__);
return -EINVAL;
}
/* Exit early if sensor is already enabled/disabled. */
uint32_t mask = (1U << handle);
uint32_t sensors = enabled ? mask : 0;
pthread_mutex_lock(&dev->lock);
uint32_t active = dev->active_sensors;
uint32_t new_sensors = (active & ~mask) | (sensors & mask);
uint32_t changed = active ^ new_sensors;
int ret = 0;
if (changed) {
/* Send command to the emulator. */
char command[64];
snprintf(command,
sizeof command,
"set:%s:%d",
_sensorIdToName(handle),
enabled != 0);
ret = sensor_device_send_command_locked(dev, command);
if (ret < 0) {
E("%s: when sending command errno=%d: %s", __FUNCTION__, -ret,
strerror(-ret));
} else {
dev->active_sensors = new_sensors;
}
}
pthread_mutex_unlock(&dev->lock);
return ret;
}
static int
control__activate(struct sensors_poll_device_t *dev,
int handle,
int enabled)
{
SensorPoll* ctl = (void*)dev;
uint32_t mask, sensors, active, new_sensors, changed;
char command[128];
int ret;
D("%s: handle=%s (%d) fd=%d enabled=%d", __FUNCTION__,
_sensorIdToName(handle), handle, ctl->fd, enabled);
if (!ID_CHECK(handle)) {
E("%s: bad handle ID", __FUNCTION__);
return -1;
}
mask = (1<<handle);
sensors = enabled ? mask : 0;
active = ctl->active_sensors;
new_sensors = (active & ~mask) | (sensors & mask);
changed = active ^ new_sensors;
if (!changed)
return 0;
snprintf(command, sizeof command, "set:%s:%d",
_sensorIdToName(handle), enabled != 0);
if (ctl->fd < 0) {
ctl->fd = qemud_channel_open(SENSORS_SERVICE_NAME);
}
ret = qemud_channel_send(ctl->fd, command, -1);
if (ret < 0) {
E("%s: when sending command errno=%d: %s", __FUNCTION__, errno, strerror(errno));
return -1;
}
ctl->active_sensors = new_sensors;
return 0;
}