From 12b0a79f9e5bc483b5c16f702ae5b8836425827e Mon Sep 17 00:00:00 2001 From: Henrik Rydberg Date: Wed, 5 Nov 2008 00:02:22 +0100 Subject: Break out capabilities Signed-off-by: Henrik Rydberg --- src/capabilities.c | 87 ++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 87 insertions(+) create mode 100644 src/capabilities.c (limited to 'src/capabilities.c') diff --git a/src/capabilities.c b/src/capabilities.c new file mode 100644 index 0000000..3149131 --- /dev/null +++ b/src/capabilities.c @@ -0,0 +1,87 @@ +#include "capabilities.h" +#include + +//////////////////////////////////////////////////////// + +#define SETABS(c, x, map, key, fd) \ + c->has_##x = getbit(map, key) && getabs(&c->abs_##x, key, fd) + +#define ADDCAP(s, c, x) strcat(s, c->has_##x ? " " #x : "") + +//////////////////////////////////////////////////////// + +static const int bits_per_long = 8 * sizeof(long); + +static inline int nlongs(int nbit) +{ + return (nbit + bits_per_long - 1) / bits_per_long; +} + +static inline bool getbit(const unsigned long* map, int key) +{ + return (map[key / bits_per_long] >> (key % bits_per_long)) & 0x01; +} + +static bool getabs(struct input_absinfo *abs, int key, int fd) +{ + int rc; + SYSCALL(rc = ioctl(fd, EVIOCGABS(key), abs)); + return rc >= 0; +} + +//////////////////////////////////////////////////////// + +static int read_capabilities(struct Capabilities *cap, int fd) +{ + unsigned long evbits[nlongs(EV_MAX)]; + unsigned long absbits[nlongs(ABS_MAX)]; + unsigned long keybits[nlongs(KEY_MAX)]; + int rc; + + memset(cap, 0, sizeof(struct Capabilities)); + + SYSCALL(rc = ioctl(fd, EVIOCGBIT(EV_SYN, sizeof(evbits)), evbits)); + if (rc < 0) + return rc; + SYSCALL(rc = ioctl(fd, EVIOCGBIT(EV_KEY, sizeof(keybits)), keybits)); + if (rc < 0) + return rc; + SYSCALL(rc = ioctl(fd, EVIOCGBIT(EV_ABS, sizeof(absbits)), absbits)); + if (rc < 0) + return rc; + + cap->has_left = getbit(keybits, BTN_LEFT); + cap->has_middle = getbit(keybits, BTN_MIDDLE); + cap->has_right = getbit(keybits, BTN_RIGHT); + cap->has_mtdata = getbit(keybits, BTN_MT_REPORT_PACKET); + + SETABS(cap, touch_major, absbits, ABS_MT_TOUCH_MAJOR, fd); + SETABS(cap, touch_minor, absbits, ABS_MT_TOUCH_MINOR, fd); + SETABS(cap, width_major, absbits, ABS_MT_WIDTH_MAJOR, fd); + SETABS(cap, width_minor, absbits, ABS_MT_WIDTH_MINOR, fd); + SETABS(cap, orientation, absbits, ABS_MT_ORIENTATION, fd); + SETABS(cap, position_x, absbits, ABS_MT_POSITION_X, fd); + SETABS(cap, position_y, absbits, ABS_MT_POSITION_Y, fd); +} + +//////////////////////////////////////////////////////// + +static int output_capabilities(const struct Capabilities *cap) +{ + char line[1024]; + memset(line, 0, sizeof(line)); + ADDCAP(line, cap, left); + ADDCAP(line, cap, middle); + ADDCAP(line, cap, right); + ADDCAP(line, cap, mtdata); + ADDCAP(line, cap, touch_major); + ADDCAP(line, cap, touch_minor); + ADDCAP(line, cap, width_major); + ADDCAP(line, cap, width_minor); + ADDCAP(line, cap, orientation); + ADDCAP(line, cap, position_x); + ADDCAP(line, cap, position_y); + xf86Msg(X_INFO, "multitouch: caps:%s\n", line); +} + +//////////////////////////////////////////////////////// -- cgit v1.2.3