62576ec6f3
Merge commit '3922484d7458a4ab72fc1ca8952a0776dd1c7d20' into gingerbread-plus-aosp * commit '3922484d7458a4ab72fc1ca8952a0776dd1c7d20': Optimize EventHub reads.
974 lines
31 KiB
C++
974 lines
31 KiB
C++
//
|
|
// Copyright 2005 The Android Open Source Project
|
|
//
|
|
// Handle events, like key input and vsync.
|
|
//
|
|
// The goal is to provide an optimized solution for Linux, not an
|
|
// implementation that works well across all platforms. We expect
|
|
// events to arrive on file descriptors, so that we can use a select()
|
|
// select() call to sleep.
|
|
//
|
|
// We can't select() on anything but network sockets in Windows, so we
|
|
// provide an alternative implementation of waitEvent for that platform.
|
|
//
|
|
#define LOG_TAG "EventHub"
|
|
|
|
//#define LOG_NDEBUG 0
|
|
|
|
#include <ui/EventHub.h>
|
|
#include <ui/KeycodeLabels.h>
|
|
#include <hardware_legacy/power.h>
|
|
|
|
#include <cutils/properties.h>
|
|
#include <utils/Log.h>
|
|
#include <utils/Timers.h>
|
|
#include <utils/threads.h>
|
|
#include <utils/Errors.h>
|
|
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include <fcntl.h>
|
|
#include <memory.h>
|
|
#include <errno.h>
|
|
#include <assert.h>
|
|
|
|
#include "KeyLayoutMap.h"
|
|
|
|
#include <string.h>
|
|
#include <stdint.h>
|
|
#include <dirent.h>
|
|
#ifdef HAVE_INOTIFY
|
|
# include <sys/inotify.h>
|
|
#endif
|
|
#ifdef HAVE_ANDROID_OS
|
|
# include <sys/limits.h> /* not part of Linux */
|
|
#endif
|
|
#include <sys/poll.h>
|
|
#include <sys/ioctl.h>
|
|
|
|
/* this macro is used to tell if "bit" is set in "array"
|
|
* it selects a byte from the array, and does a boolean AND
|
|
* operation with a byte that only has the relevant bit set.
|
|
* eg. to check for the 12th bit, we do (array[1] & 1<<4)
|
|
*/
|
|
#define test_bit(bit, array) (array[bit/8] & (1<<(bit%8)))
|
|
|
|
/* this macro computes the number of bytes needed to represent a bit array of the specified size */
|
|
#define sizeof_bit_array(bits) ((bits + 7) / 8)
|
|
|
|
#define ID_MASK 0x0000ffff
|
|
#define SEQ_MASK 0x7fff0000
|
|
#define SEQ_SHIFT 16
|
|
|
|
#ifndef ABS_MT_TOUCH_MAJOR
|
|
#define ABS_MT_TOUCH_MAJOR 0x30 /* Major axis of touching ellipse */
|
|
#endif
|
|
|
|
#ifndef ABS_MT_POSITION_X
|
|
#define ABS_MT_POSITION_X 0x35 /* Center X ellipse position */
|
|
#endif
|
|
|
|
#ifndef ABS_MT_POSITION_Y
|
|
#define ABS_MT_POSITION_Y 0x36 /* Center Y ellipse position */
|
|
#endif
|
|
|
|
namespace android {
|
|
|
|
static const char *WAKE_LOCK_ID = "KeyEvents";
|
|
static const char *device_path = "/dev/input";
|
|
|
|
/* return the larger integer */
|
|
static inline int max(int v1, int v2)
|
|
{
|
|
return (v1 > v2) ? v1 : v2;
|
|
}
|
|
|
|
EventHub::device_t::device_t(int32_t _id, const char* _path, const char* name)
|
|
: id(_id), path(_path), name(name), classes(0)
|
|
, keyBitmask(NULL), layoutMap(new KeyLayoutMap()), fd(-1), next(NULL) {
|
|
}
|
|
|
|
EventHub::device_t::~device_t() {
|
|
delete [] keyBitmask;
|
|
delete layoutMap;
|
|
}
|
|
|
|
EventHub::EventHub(void)
|
|
: mError(NO_INIT), mHaveFirstKeyboard(false), mFirstKeyboardId(0)
|
|
, mDevicesById(0), mNumDevicesById(0)
|
|
, mOpeningDevices(0), mClosingDevices(0)
|
|
, mDevices(0), mFDs(0), mFDCount(0), mOpened(false)
|
|
, mInputBufferIndex(0), mInputBufferCount(0), mInputDeviceIndex(0)
|
|
{
|
|
acquire_wake_lock(PARTIAL_WAKE_LOCK, WAKE_LOCK_ID);
|
|
#ifdef EV_SW
|
|
memset(mSwitches, 0, sizeof(mSwitches));
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* Clean up.
|
|
*/
|
|
EventHub::~EventHub(void)
|
|
{
|
|
release_wake_lock(WAKE_LOCK_ID);
|
|
// we should free stuff here...
|
|
}
|
|
|
|
status_t EventHub::errorCheck() const
|
|
{
|
|
return mError;
|
|
}
|
|
|
|
String8 EventHub::getDeviceName(int32_t deviceId) const
|
|
{
|
|
AutoMutex _l(mLock);
|
|
device_t* device = getDevice(deviceId);
|
|
if (device == NULL) return String8();
|
|
return device->name;
|
|
}
|
|
|
|
uint32_t EventHub::getDeviceClasses(int32_t deviceId) const
|
|
{
|
|
AutoMutex _l(mLock);
|
|
device_t* device = getDevice(deviceId);
|
|
if (device == NULL) return 0;
|
|
return device->classes;
|
|
}
|
|
|
|
status_t EventHub::getAbsoluteAxisInfo(int32_t deviceId, int axis,
|
|
RawAbsoluteAxisInfo* outAxisInfo) const {
|
|
outAxisInfo->valid = false;
|
|
outAxisInfo->minValue = 0;
|
|
outAxisInfo->maxValue = 0;
|
|
outAxisInfo->flat = 0;
|
|
outAxisInfo->fuzz = 0;
|
|
|
|
AutoMutex _l(mLock);
|
|
device_t* device = getDevice(deviceId);
|
|
if (device == NULL) return -1;
|
|
|
|
struct input_absinfo info;
|
|
|
|
if(ioctl(device->fd, EVIOCGABS(axis), &info)) {
|
|
LOGW("Error reading absolute controller %d for device %s fd %d\n",
|
|
axis, device->name.string(), device->fd);
|
|
return -errno;
|
|
}
|
|
|
|
if (info.minimum != info.maximum) {
|
|
outAxisInfo->valid = true;
|
|
outAxisInfo->minValue = info.minimum;
|
|
outAxisInfo->maxValue = info.maximum;
|
|
outAxisInfo->flat = info.flat;
|
|
outAxisInfo->fuzz = info.fuzz;
|
|
}
|
|
return OK;
|
|
}
|
|
|
|
int32_t EventHub::getScanCodeState(int32_t deviceId, int32_t scanCode) const {
|
|
if (scanCode >= 0 && scanCode <= KEY_MAX) {
|
|
AutoMutex _l(mLock);
|
|
|
|
device_t* device = getDevice(deviceId);
|
|
if (device != NULL) {
|
|
return getScanCodeStateLocked(device, scanCode);
|
|
}
|
|
}
|
|
return AKEY_STATE_UNKNOWN;
|
|
}
|
|
|
|
int32_t EventHub::getScanCodeStateLocked(device_t* device, int32_t scanCode) const {
|
|
uint8_t key_bitmask[sizeof_bit_array(KEY_MAX + 1)];
|
|
memset(key_bitmask, 0, sizeof(key_bitmask));
|
|
if (ioctl(device->fd,
|
|
EVIOCGKEY(sizeof(key_bitmask)), key_bitmask) >= 0) {
|
|
return test_bit(scanCode, key_bitmask) ? AKEY_STATE_DOWN : AKEY_STATE_UP;
|
|
}
|
|
return AKEY_STATE_UNKNOWN;
|
|
}
|
|
|
|
int32_t EventHub::getKeyCodeState(int32_t deviceId, int32_t keyCode) const {
|
|
AutoMutex _l(mLock);
|
|
|
|
device_t* device = getDevice(deviceId);
|
|
if (device != NULL) {
|
|
return getKeyCodeStateLocked(device, keyCode);
|
|
}
|
|
return AKEY_STATE_UNKNOWN;
|
|
}
|
|
|
|
int32_t EventHub::getKeyCodeStateLocked(device_t* device, int32_t keyCode) const {
|
|
Vector<int32_t> scanCodes;
|
|
device->layoutMap->findScancodes(keyCode, &scanCodes);
|
|
|
|
uint8_t key_bitmask[sizeof_bit_array(KEY_MAX + 1)];
|
|
memset(key_bitmask, 0, sizeof(key_bitmask));
|
|
if (ioctl(device->fd, EVIOCGKEY(sizeof(key_bitmask)), key_bitmask) >= 0) {
|
|
#if 0
|
|
for (size_t i=0; i<=KEY_MAX; i++) {
|
|
LOGI("(Scan code %d: down=%d)", i, test_bit(i, key_bitmask));
|
|
}
|
|
#endif
|
|
const size_t N = scanCodes.size();
|
|
for (size_t i=0; i<N && i<=KEY_MAX; i++) {
|
|
int32_t sc = scanCodes.itemAt(i);
|
|
//LOGI("Code %d: down=%d", sc, test_bit(sc, key_bitmask));
|
|
if (sc >= 0 && sc <= KEY_MAX && test_bit(sc, key_bitmask)) {
|
|
return AKEY_STATE_DOWN;
|
|
}
|
|
}
|
|
return AKEY_STATE_UP;
|
|
}
|
|
return AKEY_STATE_UNKNOWN;
|
|
}
|
|
|
|
int32_t EventHub::getSwitchState(int32_t deviceId, int32_t sw) const {
|
|
#ifdef EV_SW
|
|
if (sw >= 0 && sw <= SW_MAX) {
|
|
AutoMutex _l(mLock);
|
|
|
|
device_t* device = getDevice(deviceId);
|
|
if (device != NULL) {
|
|
return getSwitchStateLocked(device, sw);
|
|
}
|
|
}
|
|
#endif
|
|
return AKEY_STATE_UNKNOWN;
|
|
}
|
|
|
|
int32_t EventHub::getSwitchStateLocked(device_t* device, int32_t sw) const {
|
|
uint8_t sw_bitmask[sizeof_bit_array(SW_MAX + 1)];
|
|
memset(sw_bitmask, 0, sizeof(sw_bitmask));
|
|
if (ioctl(device->fd,
|
|
EVIOCGSW(sizeof(sw_bitmask)), sw_bitmask) >= 0) {
|
|
return test_bit(sw, sw_bitmask) ? AKEY_STATE_DOWN : AKEY_STATE_UP;
|
|
}
|
|
return AKEY_STATE_UNKNOWN;
|
|
}
|
|
|
|
bool EventHub::markSupportedKeyCodes(int32_t deviceId, size_t numCodes,
|
|
const int32_t* keyCodes, uint8_t* outFlags) const {
|
|
AutoMutex _l(mLock);
|
|
|
|
device_t* device = getDevice(deviceId);
|
|
if (device != NULL) {
|
|
return markSupportedKeyCodesLocked(device, numCodes, keyCodes, outFlags);
|
|
}
|
|
return false;
|
|
}
|
|
|
|
bool EventHub::markSupportedKeyCodesLocked(device_t* device, size_t numCodes,
|
|
const int32_t* keyCodes, uint8_t* outFlags) const {
|
|
if (device->layoutMap == NULL || device->keyBitmask == NULL) {
|
|
return false;
|
|
}
|
|
|
|
Vector<int32_t> scanCodes;
|
|
for (size_t codeIndex = 0; codeIndex < numCodes; codeIndex++) {
|
|
scanCodes.clear();
|
|
|
|
status_t err = device->layoutMap->findScancodes(keyCodes[codeIndex], &scanCodes);
|
|
if (! err) {
|
|
// check the possible scan codes identified by the layout map against the
|
|
// map of codes actually emitted by the driver
|
|
for (size_t sc = 0; sc < scanCodes.size(); sc++) {
|
|
if (test_bit(scanCodes[sc], device->keyBitmask)) {
|
|
outFlags[codeIndex] = 1;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return true;
|
|
}
|
|
|
|
status_t EventHub::scancodeToKeycode(int32_t deviceId, int scancode,
|
|
int32_t* outKeycode, uint32_t* outFlags) const
|
|
{
|
|
AutoMutex _l(mLock);
|
|
device_t* device = getDevice(deviceId);
|
|
|
|
if (device != NULL && device->layoutMap != NULL) {
|
|
status_t err = device->layoutMap->map(scancode, outKeycode, outFlags);
|
|
if (err == NO_ERROR) {
|
|
return NO_ERROR;
|
|
}
|
|
}
|
|
|
|
if (mHaveFirstKeyboard) {
|
|
device = getDevice(mFirstKeyboardId);
|
|
|
|
if (device != NULL && device->layoutMap != NULL) {
|
|
status_t err = device->layoutMap->map(scancode, outKeycode, outFlags);
|
|
if (err == NO_ERROR) {
|
|
return NO_ERROR;
|
|
}
|
|
}
|
|
}
|
|
|
|
*outKeycode = 0;
|
|
*outFlags = 0;
|
|
return NAME_NOT_FOUND;
|
|
}
|
|
|
|
void EventHub::addExcludedDevice(const char* deviceName)
|
|
{
|
|
String8 name(deviceName);
|
|
mExcludedDevices.push_back(name);
|
|
}
|
|
|
|
EventHub::device_t* EventHub::getDevice(int32_t deviceId) const
|
|
{
|
|
if (deviceId == 0) deviceId = mFirstKeyboardId;
|
|
int32_t id = deviceId & ID_MASK;
|
|
if (id >= mNumDevicesById || id < 0) return NULL;
|
|
device_t* dev = mDevicesById[id].device;
|
|
if (dev == NULL) return NULL;
|
|
if (dev->id == deviceId) {
|
|
return dev;
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
bool EventHub::getEvent(RawEvent* outEvent)
|
|
{
|
|
outEvent->deviceId = 0;
|
|
outEvent->type = 0;
|
|
outEvent->scanCode = 0;
|
|
outEvent->keyCode = 0;
|
|
outEvent->flags = 0;
|
|
outEvent->value = 0;
|
|
outEvent->when = 0;
|
|
|
|
// Note that we only allow one caller to getEvent(), so don't need
|
|
// to do locking here... only when adding/removing devices.
|
|
|
|
if (!mOpened) {
|
|
mError = openPlatformInput() ? NO_ERROR : UNKNOWN_ERROR;
|
|
mOpened = true;
|
|
}
|
|
|
|
for (;;) {
|
|
// Report any devices that had last been added/removed.
|
|
if (mClosingDevices != NULL) {
|
|
device_t* device = mClosingDevices;
|
|
LOGV("Reporting device closed: id=0x%x, name=%s\n",
|
|
device->id, device->path.string());
|
|
mClosingDevices = device->next;
|
|
if (device->id == mFirstKeyboardId) {
|
|
outEvent->deviceId = 0;
|
|
} else {
|
|
outEvent->deviceId = device->id;
|
|
}
|
|
outEvent->type = DEVICE_REMOVED;
|
|
delete device;
|
|
return true;
|
|
}
|
|
|
|
if (mOpeningDevices != NULL) {
|
|
device_t* device = mOpeningDevices;
|
|
LOGV("Reporting device opened: id=0x%x, name=%s\n",
|
|
device->id, device->path.string());
|
|
mOpeningDevices = device->next;
|
|
if (device->id == mFirstKeyboardId) {
|
|
outEvent->deviceId = 0;
|
|
} else {
|
|
outEvent->deviceId = device->id;
|
|
}
|
|
outEvent->type = DEVICE_ADDED;
|
|
return true;
|
|
}
|
|
|
|
// Grab the next input event.
|
|
for (;;) {
|
|
// Consume buffered input events, if any.
|
|
if (mInputBufferIndex < mInputBufferCount) {
|
|
const struct input_event& iev = mInputBufferData[mInputBufferIndex++];
|
|
const device_t* device = mDevices[mInputDeviceIndex];
|
|
|
|
LOGV("%s got: t0=%d, t1=%d, type=%d, code=%d, v=%d", device->path.string(),
|
|
(int) iev.time.tv_sec, (int) iev.time.tv_usec, iev.type, iev.code, iev.value);
|
|
if (device->id == mFirstKeyboardId) {
|
|
outEvent->deviceId = 0;
|
|
} else {
|
|
outEvent->deviceId = device->id;
|
|
}
|
|
outEvent->type = iev.type;
|
|
outEvent->scanCode = iev.code;
|
|
if (iev.type == EV_KEY) {
|
|
status_t err = device->layoutMap->map(iev.code,
|
|
& outEvent->keyCode, & outEvent->flags);
|
|
LOGV("iev.code=%d keyCode=%d flags=0x%08x err=%d\n",
|
|
iev.code, outEvent->keyCode, outEvent->flags, err);
|
|
if (err != 0) {
|
|
outEvent->keyCode = AKEYCODE_UNKNOWN;
|
|
outEvent->flags = 0;
|
|
}
|
|
} else {
|
|
outEvent->keyCode = iev.code;
|
|
}
|
|
outEvent->value = iev.value;
|
|
|
|
// Use an event timestamp in the same timebase as
|
|
// java.lang.System.nanoTime() and android.os.SystemClock.uptimeMillis()
|
|
// as expected by the rest of the system.
|
|
outEvent->when = systemTime(SYSTEM_TIME_MONOTONIC);
|
|
return true;
|
|
}
|
|
|
|
// Finish reading all events from devices identified in previous poll().
|
|
// This code assumes that mInputDeviceIndex is initially 0 and that the
|
|
// revents member of pollfd is initialized to 0 when the device is first added.
|
|
// Since mFDs[0] is used for inotify, we process regular events starting at index 1.
|
|
mInputDeviceIndex += 1;
|
|
if (mInputDeviceIndex >= mFDCount) {
|
|
mInputDeviceIndex = 0;
|
|
break;
|
|
}
|
|
|
|
const struct pollfd &pfd = mFDs[mInputDeviceIndex];
|
|
if (pfd.revents & POLLIN) {
|
|
int32_t readSize = read(pfd.fd, mInputBufferData,
|
|
sizeof(struct input_event) * INPUT_BUFFER_SIZE);
|
|
if (readSize < 0) {
|
|
if (errno != EAGAIN && errno != EINTR) {
|
|
LOGW("could not get event (errno=%d)", errno);
|
|
}
|
|
} else if ((readSize % sizeof(struct input_event)) != 0) {
|
|
LOGE("could not get event (wrong size: %d)", readSize);
|
|
} else {
|
|
mInputBufferCount = readSize / sizeof(struct input_event);
|
|
mInputBufferIndex = 0;
|
|
}
|
|
}
|
|
}
|
|
|
|
// read_notify() will modify mFDs and mFDCount, so this must be done after
|
|
// processing all other events.
|
|
if(mFDs[0].revents & POLLIN) {
|
|
read_notify(mFDs[0].fd);
|
|
}
|
|
|
|
// Poll for events. Mind the wake lock dance!
|
|
// We hold a wake lock at all times except during poll(). This works due to some
|
|
// subtle choreography. When a device driver has pending (unread) events, it acquires
|
|
// a kernel wake lock. However, once the last pending event has been read, the device
|
|
// driver will release the kernel wake lock. To prevent the system from going to sleep
|
|
// when this happens, the EventHub holds onto its own user wake lock while the client
|
|
// is processing events. Thus the system can only sleep if there are no events
|
|
// pending or currently being processed.
|
|
release_wake_lock(WAKE_LOCK_ID);
|
|
|
|
int pollResult = poll(mFDs, mFDCount, -1);
|
|
|
|
acquire_wake_lock(PARTIAL_WAKE_LOCK, WAKE_LOCK_ID);
|
|
|
|
if (pollResult <= 0) {
|
|
if (errno != EINTR) {
|
|
LOGW("select failed (errno=%d)\n", errno);
|
|
usleep(100000);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Open the platform-specific input device.
|
|
*/
|
|
bool EventHub::openPlatformInput(void)
|
|
{
|
|
/*
|
|
* Open platform-specific input device(s).
|
|
*/
|
|
int res;
|
|
|
|
mFDCount = 1;
|
|
mFDs = (pollfd *)calloc(1, sizeof(mFDs[0]));
|
|
mDevices = (device_t **)calloc(1, sizeof(mDevices[0]));
|
|
mFDs[0].events = POLLIN;
|
|
mFDs[0].revents = 0;
|
|
mDevices[0] = NULL;
|
|
#ifdef HAVE_INOTIFY
|
|
mFDs[0].fd = inotify_init();
|
|
res = inotify_add_watch(mFDs[0].fd, device_path, IN_DELETE | IN_CREATE);
|
|
if(res < 0) {
|
|
LOGE("could not add watch for %s, %s\n", device_path, strerror(errno));
|
|
}
|
|
#else
|
|
/*
|
|
* The code in EventHub::getEvent assumes that mFDs[0] is an inotify fd.
|
|
* We allocate space for it and set it to something invalid.
|
|
*/
|
|
mFDs[0].fd = -1;
|
|
#endif
|
|
|
|
res = scan_dir(device_path);
|
|
if(res < 0) {
|
|
LOGE("scan dir failed for %s\n", device_path);
|
|
//open_device("/dev/input/event0");
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
// ----------------------------------------------------------------------------
|
|
|
|
static bool containsNonZeroByte(const uint8_t* array, uint32_t startIndex, uint32_t endIndex) {
|
|
const uint8_t* end = array + endIndex;
|
|
array += startIndex;
|
|
while (array != end) {
|
|
if (*(array++) != 0) {
|
|
return true;
|
|
}
|
|
}
|
|
return false;
|
|
}
|
|
|
|
static const int32_t GAMEPAD_KEYCODES[] = {
|
|
AKEYCODE_BUTTON_A, AKEYCODE_BUTTON_B, AKEYCODE_BUTTON_C,
|
|
AKEYCODE_BUTTON_X, AKEYCODE_BUTTON_Y, AKEYCODE_BUTTON_Z,
|
|
AKEYCODE_BUTTON_L1, AKEYCODE_BUTTON_R1,
|
|
AKEYCODE_BUTTON_L2, AKEYCODE_BUTTON_R2,
|
|
AKEYCODE_BUTTON_THUMBL, AKEYCODE_BUTTON_THUMBR,
|
|
AKEYCODE_BUTTON_START, AKEYCODE_BUTTON_SELECT, AKEYCODE_BUTTON_MODE
|
|
};
|
|
|
|
int EventHub::open_device(const char *deviceName)
|
|
{
|
|
int version;
|
|
int fd;
|
|
struct pollfd *new_mFDs;
|
|
device_t **new_devices;
|
|
char **new_device_names;
|
|
char name[80];
|
|
char location[80];
|
|
char idstr[80];
|
|
struct input_id id;
|
|
|
|
LOGV("Opening device: %s", deviceName);
|
|
|
|
AutoMutex _l(mLock);
|
|
|
|
fd = open(deviceName, O_RDWR);
|
|
if(fd < 0) {
|
|
LOGE("could not open %s, %s\n", deviceName, strerror(errno));
|
|
return -1;
|
|
}
|
|
|
|
if(ioctl(fd, EVIOCGVERSION, &version)) {
|
|
LOGE("could not get driver version for %s, %s\n", deviceName, strerror(errno));
|
|
return -1;
|
|
}
|
|
if(ioctl(fd, EVIOCGID, &id)) {
|
|
LOGE("could not get driver id for %s, %s\n", deviceName, strerror(errno));
|
|
return -1;
|
|
}
|
|
name[sizeof(name) - 1] = '\0';
|
|
location[sizeof(location) - 1] = '\0';
|
|
idstr[sizeof(idstr) - 1] = '\0';
|
|
if(ioctl(fd, EVIOCGNAME(sizeof(name) - 1), &name) < 1) {
|
|
//fprintf(stderr, "could not get device name for %s, %s\n", deviceName, strerror(errno));
|
|
name[0] = '\0';
|
|
}
|
|
|
|
// check to see if the device is on our excluded list
|
|
List<String8>::iterator iter = mExcludedDevices.begin();
|
|
List<String8>::iterator end = mExcludedDevices.end();
|
|
for ( ; iter != end; iter++) {
|
|
const char* test = *iter;
|
|
if (strcmp(name, test) == 0) {
|
|
LOGI("ignoring event id %s driver %s\n", deviceName, test);
|
|
close(fd);
|
|
fd = -1;
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
if(ioctl(fd, EVIOCGPHYS(sizeof(location) - 1), &location) < 1) {
|
|
//fprintf(stderr, "could not get location for %s, %s\n", deviceName, strerror(errno));
|
|
location[0] = '\0';
|
|
}
|
|
if(ioctl(fd, EVIOCGUNIQ(sizeof(idstr) - 1), &idstr) < 1) {
|
|
//fprintf(stderr, "could not get idstring for %s, %s\n", deviceName, strerror(errno));
|
|
idstr[0] = '\0';
|
|
}
|
|
|
|
if (fcntl(fd, F_SETFL, O_NONBLOCK)) {
|
|
LOGE("Error %d making device file descriptor non-blocking.", errno);
|
|
close(fd);
|
|
return -1;
|
|
}
|
|
|
|
int devid = 0;
|
|
while (devid < mNumDevicesById) {
|
|
if (mDevicesById[devid].device == NULL) {
|
|
break;
|
|
}
|
|
devid++;
|
|
}
|
|
if (devid >= mNumDevicesById) {
|
|
device_ent* new_devids = (device_ent*)realloc(mDevicesById,
|
|
sizeof(mDevicesById[0]) * (devid + 1));
|
|
if (new_devids == NULL) {
|
|
LOGE("out of memory");
|
|
return -1;
|
|
}
|
|
mDevicesById = new_devids;
|
|
mNumDevicesById = devid+1;
|
|
mDevicesById[devid].device = NULL;
|
|
mDevicesById[devid].seq = 0;
|
|
}
|
|
|
|
mDevicesById[devid].seq = (mDevicesById[devid].seq+(1<<SEQ_SHIFT))&SEQ_MASK;
|
|
if (mDevicesById[devid].seq == 0) {
|
|
mDevicesById[devid].seq = 1<<SEQ_SHIFT;
|
|
}
|
|
|
|
new_mFDs = (pollfd*)realloc(mFDs, sizeof(mFDs[0]) * (mFDCount + 1));
|
|
new_devices = (device_t**)realloc(mDevices, sizeof(mDevices[0]) * (mFDCount + 1));
|
|
if (new_mFDs == NULL || new_devices == NULL) {
|
|
LOGE("out of memory");
|
|
return -1;
|
|
}
|
|
mFDs = new_mFDs;
|
|
mDevices = new_devices;
|
|
|
|
#if 0
|
|
LOGI("add device %d: %s\n", mFDCount, deviceName);
|
|
LOGI(" bus: %04x\n"
|
|
" vendor %04x\n"
|
|
" product %04x\n"
|
|
" version %04x\n",
|
|
id.bustype, id.vendor, id.product, id.version);
|
|
LOGI(" name: \"%s\"\n", name);
|
|
LOGI(" location: \"%s\"\n"
|
|
" id: \"%s\"\n", location, idstr);
|
|
LOGI(" version: %d.%d.%d\n",
|
|
version >> 16, (version >> 8) & 0xff, version & 0xff);
|
|
#endif
|
|
|
|
device_t* device = new device_t(devid|mDevicesById[devid].seq, deviceName, name);
|
|
if (device == NULL) {
|
|
LOGE("out of memory");
|
|
return -1;
|
|
}
|
|
|
|
device->fd = fd;
|
|
mFDs[mFDCount].fd = fd;
|
|
mFDs[mFDCount].events = POLLIN;
|
|
mFDs[mFDCount].revents = 0;
|
|
|
|
// Figure out the kinds of events the device reports.
|
|
|
|
uint8_t key_bitmask[sizeof_bit_array(KEY_MAX + 1)];
|
|
memset(key_bitmask, 0, sizeof(key_bitmask));
|
|
|
|
LOGV("Getting keys...");
|
|
if (ioctl(fd, EVIOCGBIT(EV_KEY, sizeof(key_bitmask)), key_bitmask) >= 0) {
|
|
//LOGI("MAP\n");
|
|
//for (int i = 0; i < sizeof(key_bitmask); i++) {
|
|
// LOGI("%d: 0x%02x\n", i, key_bitmask[i]);
|
|
//}
|
|
|
|
// See if this is a keyboard. Ignore everything in the button range except for
|
|
// gamepads which are also considered keyboards.
|
|
if (containsNonZeroByte(key_bitmask, 0, sizeof_bit_array(BTN_MISC))
|
|
|| containsNonZeroByte(key_bitmask, sizeof_bit_array(BTN_GAMEPAD),
|
|
sizeof_bit_array(BTN_DIGI))
|
|
|| containsNonZeroByte(key_bitmask, sizeof_bit_array(KEY_OK),
|
|
sizeof_bit_array(KEY_MAX + 1))) {
|
|
device->classes |= INPUT_DEVICE_CLASS_KEYBOARD;
|
|
|
|
device->keyBitmask = new uint8_t[sizeof(key_bitmask)];
|
|
if (device->keyBitmask != NULL) {
|
|
memcpy(device->keyBitmask, key_bitmask, sizeof(key_bitmask));
|
|
} else {
|
|
delete device;
|
|
LOGE("out of memory allocating key bitmask");
|
|
return -1;
|
|
}
|
|
}
|
|
}
|
|
|
|
// See if this is a trackball (or mouse).
|
|
if (test_bit(BTN_MOUSE, key_bitmask)) {
|
|
uint8_t rel_bitmask[sizeof_bit_array(REL_MAX + 1)];
|
|
memset(rel_bitmask, 0, sizeof(rel_bitmask));
|
|
LOGV("Getting relative controllers...");
|
|
if (ioctl(fd, EVIOCGBIT(EV_REL, sizeof(rel_bitmask)), rel_bitmask) >= 0) {
|
|
if (test_bit(REL_X, rel_bitmask) && test_bit(REL_Y, rel_bitmask)) {
|
|
device->classes |= INPUT_DEVICE_CLASS_TRACKBALL;
|
|
}
|
|
}
|
|
}
|
|
|
|
// See if this is a touch pad.
|
|
uint8_t abs_bitmask[sizeof_bit_array(ABS_MAX + 1)];
|
|
memset(abs_bitmask, 0, sizeof(abs_bitmask));
|
|
LOGV("Getting absolute controllers...");
|
|
if (ioctl(fd, EVIOCGBIT(EV_ABS, sizeof(abs_bitmask)), abs_bitmask) >= 0) {
|
|
// Is this a new modern multi-touch driver?
|
|
if (test_bit(ABS_MT_TOUCH_MAJOR, abs_bitmask)
|
|
&& test_bit(ABS_MT_POSITION_X, abs_bitmask)
|
|
&& test_bit(ABS_MT_POSITION_Y, abs_bitmask)) {
|
|
device->classes |= INPUT_DEVICE_CLASS_TOUCHSCREEN | INPUT_DEVICE_CLASS_TOUCHSCREEN_MT;
|
|
|
|
// Is this an old style single-touch driver?
|
|
} else if (test_bit(BTN_TOUCH, key_bitmask)
|
|
&& test_bit(ABS_X, abs_bitmask) && test_bit(ABS_Y, abs_bitmask)) {
|
|
device->classes |= INPUT_DEVICE_CLASS_TOUCHSCREEN;
|
|
}
|
|
}
|
|
|
|
#ifdef EV_SW
|
|
// figure out the switches this device reports
|
|
uint8_t sw_bitmask[sizeof_bit_array(SW_MAX + 1)];
|
|
memset(sw_bitmask, 0, sizeof(sw_bitmask));
|
|
bool hasSwitches = false;
|
|
if (ioctl(fd, EVIOCGBIT(EV_SW, sizeof(sw_bitmask)), sw_bitmask) >= 0) {
|
|
for (int i=0; i<EV_SW; i++) {
|
|
//LOGI("Device 0x%x sw %d: has=%d", device->id, i, test_bit(i, sw_bitmask));
|
|
if (test_bit(i, sw_bitmask)) {
|
|
hasSwitches = true;
|
|
if (mSwitches[i] == 0) {
|
|
mSwitches[i] = device->id;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
if (hasSwitches) {
|
|
device->classes |= INPUT_DEVICE_CLASS_SWITCH;
|
|
}
|
|
#endif
|
|
|
|
if ((device->classes & INPUT_DEVICE_CLASS_KEYBOARD) != 0) {
|
|
char tmpfn[sizeof(name)];
|
|
char keylayoutFilename[300];
|
|
|
|
// a more descriptive name
|
|
device->name = name;
|
|
|
|
// replace all the spaces with underscores
|
|
strcpy(tmpfn, name);
|
|
for (char *p = strchr(tmpfn, ' '); p && *p; p = strchr(tmpfn, ' '))
|
|
*p = '_';
|
|
|
|
// find the .kl file we need for this device
|
|
const char* root = getenv("ANDROID_ROOT");
|
|
snprintf(keylayoutFilename, sizeof(keylayoutFilename),
|
|
"%s/usr/keylayout/%s.kl", root, tmpfn);
|
|
bool defaultKeymap = false;
|
|
if (access(keylayoutFilename, R_OK)) {
|
|
snprintf(keylayoutFilename, sizeof(keylayoutFilename),
|
|
"%s/usr/keylayout/%s", root, "qwerty.kl");
|
|
defaultKeymap = true;
|
|
}
|
|
status_t status = device->layoutMap->load(keylayoutFilename);
|
|
if (status) {
|
|
LOGE("Error %d loading key layout.", status);
|
|
}
|
|
|
|
// tell the world about the devname (the descriptive name)
|
|
if (!mHaveFirstKeyboard && !defaultKeymap && strstr(name, "-keypad")) {
|
|
// the built-in keyboard has a well-known device ID of 0,
|
|
// this device better not go away.
|
|
mHaveFirstKeyboard = true;
|
|
mFirstKeyboardId = device->id;
|
|
property_set("hw.keyboards.0.devname", name);
|
|
} else {
|
|
// ensure mFirstKeyboardId is set to -something-.
|
|
if (mFirstKeyboardId == 0) {
|
|
mFirstKeyboardId = device->id;
|
|
}
|
|
}
|
|
char propName[100];
|
|
sprintf(propName, "hw.keyboards.%u.devname", device->id);
|
|
property_set(propName, name);
|
|
|
|
// 'Q' key support = cheap test of whether this is an alpha-capable kbd
|
|
if (hasKeycode(device, AKEYCODE_Q)) {
|
|
device->classes |= INPUT_DEVICE_CLASS_ALPHAKEY;
|
|
}
|
|
|
|
// See if this device has a DPAD.
|
|
if (hasKeycode(device, AKEYCODE_DPAD_UP) &&
|
|
hasKeycode(device, AKEYCODE_DPAD_DOWN) &&
|
|
hasKeycode(device, AKEYCODE_DPAD_LEFT) &&
|
|
hasKeycode(device, AKEYCODE_DPAD_RIGHT) &&
|
|
hasKeycode(device, AKEYCODE_DPAD_CENTER)) {
|
|
device->classes |= INPUT_DEVICE_CLASS_DPAD;
|
|
}
|
|
|
|
// See if this device has a gamepad.
|
|
for (size_t i = 0; i < sizeof(GAMEPAD_KEYCODES); i++) {
|
|
if (hasKeycode(device, GAMEPAD_KEYCODES[i])) {
|
|
device->classes |= INPUT_DEVICE_CLASS_GAMEPAD;
|
|
break;
|
|
}
|
|
}
|
|
|
|
LOGI("New keyboard: device->id=0x%x devname='%s' propName='%s' keylayout='%s'\n",
|
|
device->id, name, propName, keylayoutFilename);
|
|
}
|
|
|
|
LOGI("New device: path=%s name=%s id=0x%x (of 0x%x) index=%d fd=%d classes=0x%x\n",
|
|
deviceName, name, device->id, mNumDevicesById, mFDCount, fd, device->classes);
|
|
|
|
LOGV("Adding device %s %p at %d, id = %d, classes = 0x%x\n",
|
|
deviceName, device, mFDCount, devid, device->classes);
|
|
|
|
mDevicesById[devid].device = device;
|
|
device->next = mOpeningDevices;
|
|
mOpeningDevices = device;
|
|
mDevices[mFDCount] = device;
|
|
|
|
mFDCount++;
|
|
return 0;
|
|
}
|
|
|
|
bool EventHub::hasKeycode(device_t* device, int keycode) const
|
|
{
|
|
if (device->keyBitmask == NULL || device->layoutMap == NULL) {
|
|
return false;
|
|
}
|
|
|
|
Vector<int32_t> scanCodes;
|
|
device->layoutMap->findScancodes(keycode, &scanCodes);
|
|
const size_t N = scanCodes.size();
|
|
for (size_t i=0; i<N && i<=KEY_MAX; i++) {
|
|
int32_t sc = scanCodes.itemAt(i);
|
|
if (sc >= 0 && sc <= KEY_MAX && test_bit(sc, device->keyBitmask)) {
|
|
return true;
|
|
}
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
int EventHub::close_device(const char *deviceName)
|
|
{
|
|
AutoMutex _l(mLock);
|
|
|
|
int i;
|
|
for(i = 1; i < mFDCount; i++) {
|
|
if(strcmp(mDevices[i]->path.string(), deviceName) == 0) {
|
|
//LOGD("remove device %d: %s\n", i, deviceName);
|
|
device_t* device = mDevices[i];
|
|
|
|
LOGI("Removed device: path=%s name=%s id=0x%x (of 0x%x) index=%d fd=%d classes=0x%x\n",
|
|
device->path.string(), device->name.string(), device->id,
|
|
mNumDevicesById, mFDCount, mFDs[i].fd, device->classes);
|
|
|
|
// Clear this device's entry.
|
|
int index = (device->id&ID_MASK);
|
|
mDevicesById[index].device = NULL;
|
|
|
|
// Close the file descriptor and compact the fd array.
|
|
close(mFDs[i].fd);
|
|
int count = mFDCount - i - 1;
|
|
memmove(mDevices + i, mDevices + i + 1, sizeof(mDevices[0]) * count);
|
|
memmove(mFDs + i, mFDs + i + 1, sizeof(mFDs[0]) * count);
|
|
mFDCount--;
|
|
|
|
#ifdef EV_SW
|
|
for (int j=0; j<EV_SW; j++) {
|
|
if (mSwitches[j] == device->id) {
|
|
mSwitches[j] = 0;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
device->next = mClosingDevices;
|
|
mClosingDevices = device;
|
|
|
|
if (device->id == mFirstKeyboardId) {
|
|
LOGW("built-in keyboard device %s (id=%d) is closing! the apps will not like this",
|
|
device->path.string(), mFirstKeyboardId);
|
|
mFirstKeyboardId = 0;
|
|
property_set("hw.keyboards.0.devname", NULL);
|
|
}
|
|
// clear the property
|
|
char propName[100];
|
|
sprintf(propName, "hw.keyboards.%u.devname", device->id);
|
|
property_set(propName, NULL);
|
|
return 0;
|
|
}
|
|
}
|
|
LOGE("remove device: %s not found\n", deviceName);
|
|
return -1;
|
|
}
|
|
|
|
int EventHub::read_notify(int nfd)
|
|
{
|
|
#ifdef HAVE_INOTIFY
|
|
int res;
|
|
char devname[PATH_MAX];
|
|
char *filename;
|
|
char event_buf[512];
|
|
int event_size;
|
|
int event_pos = 0;
|
|
struct inotify_event *event;
|
|
|
|
LOGV("EventHub::read_notify nfd: %d\n", nfd);
|
|
res = read(nfd, event_buf, sizeof(event_buf));
|
|
if(res < (int)sizeof(*event)) {
|
|
if(errno == EINTR)
|
|
return 0;
|
|
LOGW("could not get event, %s\n", strerror(errno));
|
|
return 1;
|
|
}
|
|
//printf("got %d bytes of event information\n", res);
|
|
|
|
strcpy(devname, device_path);
|
|
filename = devname + strlen(devname);
|
|
*filename++ = '/';
|
|
|
|
while(res >= (int)sizeof(*event)) {
|
|
event = (struct inotify_event *)(event_buf + event_pos);
|
|
//printf("%d: %08x \"%s\"\n", event->wd, event->mask, event->len ? event->name : "");
|
|
if(event->len) {
|
|
strcpy(filename, event->name);
|
|
if(event->mask & IN_CREATE) {
|
|
open_device(devname);
|
|
}
|
|
else {
|
|
close_device(devname);
|
|
}
|
|
}
|
|
event_size = sizeof(*event) + event->len;
|
|
res -= event_size;
|
|
event_pos += event_size;
|
|
}
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
|
|
int EventHub::scan_dir(const char *dirname)
|
|
{
|
|
char devname[PATH_MAX];
|
|
char *filename;
|
|
DIR *dir;
|
|
struct dirent *de;
|
|
dir = opendir(dirname);
|
|
if(dir == NULL)
|
|
return -1;
|
|
strcpy(devname, dirname);
|
|
filename = devname + strlen(devname);
|
|
*filename++ = '/';
|
|
while((de = readdir(dir))) {
|
|
if(de->d_name[0] == '.' &&
|
|
(de->d_name[1] == '\0' ||
|
|
(de->d_name[1] == '.' && de->d_name[2] == '\0')))
|
|
continue;
|
|
strcpy(filename, de->d_name);
|
|
open_device(devname);
|
|
}
|
|
closedir(dir);
|
|
return 0;
|
|
}
|
|
|
|
}; // namespace android
|