Blame src/caps.c

Packit 2663c2
/*****************************************************************************
Packit 2663c2
 *
Packit 2663c2
 * mtdev - Multitouch Protocol Translation Library (MIT license)
Packit 2663c2
 *
Packit 2663c2
 * Copyright (C) 2010 Henrik Rydberg <rydberg@euromail.se>
Packit 2663c2
 * Copyright (C) 2010 Canonical Ltd.
Packit 2663c2
 *
Packit 2663c2
 * Permission is hereby granted, free of charge, to any person obtaining a
Packit 2663c2
 * copy of this software and associated documentation files (the "Software"),
Packit 2663c2
 * to deal in the Software without restriction, including without limitation
Packit 2663c2
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
Packit 2663c2
 * and/or sell copies of the Software, and to permit persons to whom the
Packit 2663c2
 * Software is furnished to do so, subject to the following conditions:
Packit 2663c2
 *
Packit 2663c2
 * The above copyright notice and this permission notice (including the next
Packit 2663c2
 * paragraph) shall be included in all copies or substantial portions of the
Packit 2663c2
 * Software.
Packit 2663c2
 *
Packit 2663c2
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
Packit 2663c2
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
Packit 2663c2
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
Packit 2663c2
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
Packit 2663c2
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
Packit 2663c2
 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
Packit 2663c2
 * DEALINGS IN THE SOFTWARE.
Packit 2663c2
 *
Packit 2663c2
 ****************************************************************************/
Packit 2663c2
Packit 2663c2
#include "state.h"
Packit 2663c2
Packit 2663c2
static const int SN_COORD = 250;	/* coordinate signal-to-noise ratio */
Packit 2663c2
static const int SN_WIDTH = 100;	/* width signal-to-noise ratio */
Packit 2663c2
static const int SN_ORIENT = 10;	/* orientation signal-to-noise ratio */
Packit 2663c2
Packit 2663c2
static const int bits_per_long = 8 * sizeof(long);
Packit 2663c2
Packit 2663c2
static inline int nlongs(int nbit)
Packit 2663c2
{
Packit 2663c2
	return (nbit + bits_per_long - 1) / bits_per_long;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
static inline int getbit(const unsigned long *map, int key)
Packit 2663c2
{
Packit 2663c2
	return (map[key / bits_per_long] >> (key % bits_per_long)) & 0x01;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
static int getabs(struct input_absinfo *abs, int key, int fd)
Packit 2663c2
{
Packit 2663c2
	int rc;
Packit 2663c2
	SYSCALL(rc = ioctl(fd, EVIOCGABS(key), abs));
Packit 2663c2
	return rc >= 0;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
static struct input_absinfo *get_info(struct mtdev *dev, int code)
Packit 2663c2
{
Packit 2663c2
	int ix;
Packit 2663c2
Packit 2663c2
	if (code == ABS_MT_SLOT)
Packit 2663c2
		return &dev->slot;
Packit 2663c2
	if (!mtdev_is_absmt(code))
Packit 2663c2
		return NULL;
Packit 2663c2
Packit 2663c2
	ix = mtdev_abs2mt(code);
Packit 2663c2
	if (ix < LEGACY_API_NUM_MT_AXES)
Packit 2663c2
		return &dev->abs[ix];
Packit 2663c2
	else
Packit 2663c2
		return &dev->state->ext_abs[ix - LEGACY_API_NUM_MT_AXES];
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
static void set_info(struct mtdev *dev, int code,
Packit 2663c2
		     const unsigned long *bits, int fd)
Packit 2663c2
{
Packit 2663c2
	int has = getbit(bits, code) && getabs(get_info(dev, code), code, fd);
Packit 2663c2
	mtdev_set_mt_event(dev, code, has);
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
static void default_fuzz(struct mtdev *dev, int code, int sn)
Packit 2663c2
{
Packit 2663c2
	struct input_absinfo *abs = get_info(dev, code);
Packit 2663c2
	if (!mtdev_has_mt_event(dev, code) || abs->fuzz)
Packit 2663c2
		return;
Packit 2663c2
	abs->fuzz = (abs->maximum - abs->minimum) / sn;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
int mtdev_set_slots(struct mtdev *dev, int fd)
Packit 2663c2
{
Packit 2663c2
	struct { unsigned code; int values[DIM_FINGER]; } req;
Packit 2663c2
	struct mtdev_state *state = dev->state;
Packit 2663c2
	int rc, i, s, nslot;
Packit 2663c2
Packit 2663c2
	nslot = mtdev_get_abs_maximum(dev, ABS_MT_SLOT) + 1;
Packit 2663c2
Packit 2663c2
	for (i = 0; i < MT_ABS_SIZE; i++) {
Packit 2663c2
		req.code = mtdev_mt2abs(i);
Packit 2663c2
		if (!mtdev_has_mt_event(dev, req.code))
Packit 2663c2
			continue;
Packit 2663c2
		SYSCALL(rc = ioctl(fd, EVIOCGMTSLOTS(sizeof(req)), &req));
Packit 2663c2
		if (rc < 0)
Packit 2663c2
			return rc;
Packit 2663c2
		for (s = 0; s < DIM_FINGER && s < nslot; s++)
Packit 2663c2
			set_sval(&state->data[s], i, req.values[s]);
Packit 2663c2
	}
Packit 2663c2
Packit 2663c2
	return 0;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
int mtdev_configure(struct mtdev *dev, int fd)
Packit 2663c2
{
Packit 2663c2
	unsigned long absbits[nlongs(ABS_MAX)];
Packit 2663c2
	int rc, i;
Packit 2663c2
Packit 2663c2
	SYSCALL(rc = ioctl(fd, EVIOCGBIT(EV_ABS, sizeof(absbits)), absbits));
Packit 2663c2
	if (rc < 0)
Packit 2663c2
		return rc;
Packit 2663c2
Packit 2663c2
	set_info(dev, ABS_MT_SLOT, absbits, fd);
Packit 2663c2
	for (i = 0; i < MT_ABS_SIZE; i++)
Packit 2663c2
		set_info(dev, mtdev_mt2abs(i), absbits, fd);
Packit 2663c2
Packit 2663c2
	dev->has_mtdata = mtdev_has_mt_event(dev, ABS_MT_POSITION_X) &&
Packit 2663c2
		mtdev_has_mt_event(dev, ABS_MT_POSITION_Y);
Packit 2663c2
Packit 2663c2
	if (!mtdev_has_mt_event(dev, ABS_MT_POSITION_X))
Packit 2663c2
		getabs(get_info(dev, ABS_MT_POSITION_X), ABS_X, fd);
Packit 2663c2
	if (!mtdev_has_mt_event(dev, ABS_MT_POSITION_Y))
Packit 2663c2
		getabs(get_info(dev, ABS_MT_POSITION_Y), ABS_Y, fd);
Packit 2663c2
	if (!mtdev_has_mt_event(dev, ABS_MT_PRESSURE))
Packit 2663c2
		getabs(get_info(dev, ABS_MT_PRESSURE), ABS_PRESSURE, fd);
Packit 2663c2
Packit 2663c2
	if (!mtdev_has_mt_event(dev, ABS_MT_TRACKING_ID)) {
Packit 2663c2
		mtdev_set_abs_minimum(dev, ABS_MT_TRACKING_ID, MT_ID_MIN);
Packit 2663c2
		mtdev_set_abs_maximum(dev, ABS_MT_TRACKING_ID, MT_ID_MAX);
Packit 2663c2
	}
Packit 2663c2
Packit 2663c2
	default_fuzz(dev, ABS_MT_POSITION_X, SN_COORD);
Packit 2663c2
	default_fuzz(dev, ABS_MT_POSITION_Y, SN_COORD);
Packit 2663c2
	default_fuzz(dev, ABS_MT_TOUCH_MAJOR, SN_WIDTH);
Packit 2663c2
	default_fuzz(dev, ABS_MT_TOUCH_MINOR, SN_WIDTH);
Packit 2663c2
	default_fuzz(dev, ABS_MT_WIDTH_MAJOR, SN_WIDTH);
Packit 2663c2
	default_fuzz(dev, ABS_MT_WIDTH_MINOR, SN_WIDTH);
Packit 2663c2
	default_fuzz(dev, ABS_MT_ORIENTATION, SN_ORIENT);
Packit 2663c2
Packit 2663c2
	if (dev->has_slot)
Packit 2663c2
		mtdev_set_slots(dev, fd);
Packit 2663c2
Packit 2663c2
	return 0;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
int mtdev_has_mt_event(const struct mtdev *dev, int code)
Packit 2663c2
{
Packit 2663c2
	int ix;
Packit 2663c2
Packit 2663c2
	if (code == ABS_MT_SLOT)
Packit 2663c2
		return dev->has_slot;
Packit 2663c2
	if (!mtdev_is_absmt(code))
Packit 2663c2
		return 0;
Packit 2663c2
Packit 2663c2
	ix = mtdev_abs2mt(code);
Packit 2663c2
	if (ix < LEGACY_API_NUM_MT_AXES)
Packit 2663c2
		return dev->has_abs[ix];
Packit 2663c2
	else
Packit 2663c2
		return dev->state->has_ext_abs[ix - LEGACY_API_NUM_MT_AXES];
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
int mtdev_get_abs_minimum(const struct mtdev *dev, int code)
Packit 2663c2
{
Packit 2663c2
	const struct input_absinfo *abs = get_info((struct mtdev *)dev, code);
Packit 2663c2
	return abs ? abs->minimum : 0;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
int mtdev_get_abs_maximum(const struct mtdev *dev, int code)
Packit 2663c2
{
Packit 2663c2
	const struct input_absinfo *abs = get_info((struct mtdev *)dev, code);
Packit 2663c2
	return abs ? abs->maximum : 0;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
int mtdev_get_abs_fuzz(const struct mtdev *dev, int code)
Packit 2663c2
{
Packit 2663c2
	const struct input_absinfo *abs = get_info((struct mtdev *)dev, code);
Packit 2663c2
	return abs ? abs->fuzz : 0;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
int mtdev_get_abs_resolution(const struct mtdev *dev, int code)
Packit 2663c2
{
Packit 2663c2
	const struct input_absinfo *abs = get_info((struct mtdev *)dev, code);
Packit 2663c2
	return abs ? abs->resolution : 0;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
void mtdev_set_abs_minimum(struct mtdev *dev, int code, int value)
Packit 2663c2
{
Packit 2663c2
	struct input_absinfo *abs = get_info(dev, code);
Packit 2663c2
	if (abs)
Packit 2663c2
		abs->minimum = value;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
void mtdev_set_mt_event(struct mtdev *dev, int code, int value)
Packit 2663c2
{
Packit 2663c2
	int ix;
Packit 2663c2
Packit 2663c2
	if (code == ABS_MT_SLOT)
Packit 2663c2
		dev->has_slot = value;
Packit 2663c2
	if (!mtdev_is_absmt(code))
Packit 2663c2
		return;
Packit 2663c2
Packit 2663c2
	ix = mtdev_abs2mt(code);
Packit 2663c2
	if (ix < LEGACY_API_NUM_MT_AXES)
Packit 2663c2
		dev->has_abs[ix] = value;
Packit 2663c2
	else
Packit 2663c2
		dev->state->has_ext_abs[ix - LEGACY_API_NUM_MT_AXES] = value;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
void mtdev_set_abs_maximum(struct mtdev *dev, int code, int value)
Packit 2663c2
{
Packit 2663c2
	struct input_absinfo *abs = get_info(dev, code);
Packit 2663c2
	if (abs)
Packit 2663c2
		abs->maximum = value;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
void mtdev_set_abs_fuzz(struct mtdev *dev, int code, int value)
Packit 2663c2
{
Packit 2663c2
	struct input_absinfo *abs = get_info(dev, code);
Packit 2663c2
	if (abs)
Packit 2663c2
		abs->fuzz = value;
Packit 2663c2
}
Packit 2663c2
Packit 2663c2
void mtdev_set_abs_resolution(struct mtdev *dev, int code, int value)
Packit 2663c2
{
Packit 2663c2
	struct input_absinfo *abs = get_info(dev, code);
Packit 2663c2
	if (abs)
Packit 2663c2
		abs->resolution = value;
Packit 2663c2
}
Packit 2663c2