/* * Copyright (C) 2008 The Android Open Source Project * * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. * See the License for the specific language governing permissions and * limitations under the License. */ #include #include #include #include #include #include #include #include #include #define ALOG_NDEBUG 0 #define LOG_NDEBUG 0 #include #include "ProximitySensor.h" #include "SensorBase.h" #define LOGTAG "ProximitySensor" /*****************************************************************************/ ProximitySensor::ProximitySensor() : SensorBase(NULL, "proximity_sensor"), mEnabled(0), mInputReader(4), mHasPendingEvent(false) { mPendingEvent.version = sizeof(sensors_event_t); mPendingEvent.sensor = ID_P; mPendingEvent.type = SENSOR_TYPE_PROXIMITY; memset(mPendingEvent.data, 0, sizeof(mPendingEvent.data)); if (data_fd) { ALOGE("%s: got input_name %s", LOGTAG, input_name); strcpy(input_sysfs_path, "/sys/class/input/"); strcat(input_sysfs_path, input_name); strcat(input_sysfs_path, "/device/"); input_sysfs_path_len = strlen(input_sysfs_path); enable(0, 1); } } ProximitySensor::~ProximitySensor() { if (mEnabled) { enable(0, 0); } } int ProximitySensor::setInitialState() { struct input_absinfo absinfo; if (!ioctl(data_fd, EVIOCGABS(EVENT_TYPE_PROXIMITY), &absinfo)) { // make sure to report an event immediately mHasPendingEvent = true; mPendingEvent.distance = indexToValue(absinfo.value); } return 0; } int ProximitySensor::setDelay(int32_t handle, int64_t ns) { // unsupported return 0; } int ProximitySensor::enable(int32_t handle, int en) { int fd; int flags = en ? 1 : 0; int err; ALOGD("%s: Enable: %i", __func__, en); if (flags != mEnabled) { strcpy(&input_sysfs_path[input_sysfs_path_len], "enable"); fd = open(input_sysfs_path, O_RDWR); if (fd >= 0) { write(fd, en == 1 ? "1" : "0", 2); close(fd); mEnabled = flags; setInitialState(); return 0; } return -1; } return 0; } bool ProximitySensor::hasPendingEvents() const { return mHasPendingEvent; } int ProximitySensor::readEvents(sensors_event_t* data, int count) { if (count < 1) return -EINVAL; if (mHasPendingEvent) { mHasPendingEvent = false; mPendingEvent.timestamp = getTimestamp(); *data = mPendingEvent; return mEnabled ? 1 : 0; } ssize_t n = mInputReader.fill(data_fd); if (n < 0) return n; int numEventReceived = 0; input_event const* event; while (count && mInputReader.readEvent(&event)) { int type = event->type; if (type == EV_ABS) { if (event->code == EVENT_TYPE_PROXIMITY) { if (event->value != -1) { // FIXME: not sure why we're getting -1 sometimes mPendingEvent.distance = indexToValue(event->value); } } } else if (type == EV_SYN) { mPendingEvent.timestamp = timevalToNano(event->time); if (mEnabled) { *data++ = mPendingEvent; count--; numEventReceived++; } } else { ALOGE("%s: unknown event (type=%d, code=%d)",LOGTAG, type, event->code); } mInputReader.next(); } return numEventReceived; } float ProximitySensor::indexToValue(size_t index) const { ALOGV("%s: Index = %zu",LOGTAG, index); return index * PROXIMITY_THRESHOLD_CM; }