NetBSD/usr.sbin/tpctl/tp.c

/*	$NetBSD: tp.c,v 1.2 2003/01/03 04:41:49 takemura Exp $	*/

/*-
 * Copyright (c) 2002, 2003 TAKEMRUA Shin
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. Neither the name of The NetBSD Foundation nor the names of its
 *    contributors may be used to endorse or promote products derived
 *    from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include <stdio.h>
#include <string.h>
#include <sys/ioctl.h>
#include <sys/fcntl.h>
#include <sys/mman.h>
#include <errno.h>
#include <unistd.h>

#include "tpctl.h"

#define MIN(a, b)	((a) < (b) ? (a) : (b))

#ifndef lint
#include <sys/cdefs.h>
__RCSID("$NetBSD: tp.c,v 1.2 2003/01/03 04:41:49 takemura Exp $");
#endif /* not lint */

int
tp_init(struct tp *tp, int fd)
{
	u_int flags;
	struct wsmouse_calibcoords calibcoords;
	struct wsmouse_id id;

	tp->fd = fd;

#if 0
	if (ioctl(tp->fd, WSMOUSEIO_GTYPE, &type) < 0)
		return (-1);
	if (type != WSMOUSE_TYPE_TPANEL) {
		errno = EINVAL;
		return (-1);
	}
#else
	if (ioctl(tp->fd, WSMOUSEIO_GCALIBCOORDS, &calibcoords) < 0)
		return (-1);
#endif
	flags = fcntl(tp->fd, F_GETFL);
	if (flags == -1)
		return (-1);
	flags |= O_NONBLOCK;
	if (fcntl(tp->fd, F_SETFL, flags) < 0)
		return (-1);

	id.type = WSMOUSE_ID_TYPE_UIDSTR;
	if (ioctl(tp->fd, WSMOUSEIO_GETID, &id) == 0) {
		strncpy(tp->id, id.data, MIN(sizeof(tp->id), id.length));
		tp->id[sizeof(tp->id) - 1] = '\0';
	} else {
		tp->id[0] = '*';
		tp->id[1] = '\0';
	}

	return (0);
}

int
tp_setrawmode(struct tp *tp)
{
	struct wsmouse_calibcoords raw;

	memset(&raw, 0, sizeof(raw));
	raw.samplelen = WSMOUSE_CALIBCOORDS_RESET;

	return ioctl(tp->fd, WSMOUSEIO_SCALIBCOORDS, &raw);
}

int
tp_setcalibcoords(struct tp *tp, struct wsmouse_calibcoords *calibcoords)
{
	return ioctl(tp->fd, WSMOUSEIO_SCALIBCOORDS, calibcoords);
}

int
tp_flush(struct tp *tp)
{
	struct wscons_event ev;
	int count;

	count = 0;
	while (read(tp->fd, &ev, sizeof(ev)) == sizeof(ev)) {
		switch (ev.type) {
		case WSCONS_EVENT_MOUSE_UP:
		case WSCONS_EVENT_MOUSE_DOWN:
		case WSCONS_EVENT_MOUSE_DELTA_X:
		case WSCONS_EVENT_MOUSE_DELTA_Y:
		case WSCONS_EVENT_MOUSE_ABSOLUTE_X:
		case WSCONS_EVENT_MOUSE_ABSOLUTE_Y:
		case WSCONS_EVENT_MOUSE_DELTA_Z:
		case WSCONS_EVENT_MOUSE_ABSOLUTE_Z:
			count++;
			break;

		default:
			break;
		}
	}

	return (count);
}

int
tp_get(struct tp *tp, int *x, int *y, int (*cancel)(void *), void *data)
{
	struct wscons_event ev;
	int x_done, y_done, res;

	x_done = y_done = 0;
	while (1) {
		if (cancel != NULL && (res = (*cancel)(data)) != 0)
			return (res);
		if ((res = read(tp->fd, &ev, sizeof(ev))) < 0) {
			if (errno != EWOULDBLOCK)
				return (-1);
			continue;
		}
		if (res != sizeof(ev)) {
			errno = EINVAL;
			return (-1);
		}
		switch (ev.type) {
		case WSCONS_EVENT_MOUSE_ABSOLUTE_X:
			*x = ev.value;
			if (y_done)
				return (0);
			x_done = 1;
			break;

		case WSCONS_EVENT_MOUSE_ABSOLUTE_Y:
			*y = ev.value;
			if (x_done)
				return (0);
			y_done = 1;
			break;

		default:
			break;
		}
	}
}

int
tp_waitup(struct tp *tp, int msec, int (*cancel)(void*), void *data)
{
	int res;

	while (1) {
		if (cancel != NULL && (res = (*cancel)(data)) != 0)
			return (res);
		usleep(msec * 1000);
		if (tp_flush(tp) == 0)
			break;
	}

	return (0);
}