#include <sys/ioctl.h>
#include <sys/time.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wsdisplay_usl_io.h>
#include <err.h>
#include <fcntl.h>
#include <signal.h>
#include <stdbool.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <termios.h>
#include <unistd.h>

volatile int done = 0;

void
usage(void)
{
	errx(2, "usage: twskbd [-rR] [-v version]");
}
	    
	
void
sighandler(int sig)
{
	done = 1;
}

int 
main(int argc, char **argv)
{
	struct wscons_event ev;
	struct wscons_event_ex evx;
	struct termios kbdtty, okbdtty;
	int ch, fd, n, option = 0;
	char *dev;
	unsigned int type;
	unsigned char buf[1];
	bool raw = false;
	bool reset = false;
	int version = 0;

	while ((ch = getopt(argc, argv, "rRv:")) != -1) {
		switch (ch) {
		case 'r':
			raw = true;
			break;
		case 'R':
			reset = true;
			break;
		case 'v':
			version = atoi(optarg);
			break;
		default:
			usage();
		}
	}
	argc -= optind;
	argv += optind;
	
	signal(SIGINT, sighandler);
	signal(SIGTERM, sighandler);

	printf("Signals installed\n");
	dev = argv[0] != NULL ? argv[0]:"/dev/wskbd";
	if ((fd = open(dev, O_RDWR)) == -1) 
		err(1, "open '%s'", dev);
	tcgetattr(fd, &kbdtty);
	okbdtty = kbdtty;
	cfmakeraw(&kbdtty);
	/* kbdtty.c_cc[VTIME] = 0;
	   kbdtty.c_cc[VMIN] = 1; */
	tcsetattr(fd, TCSANOW, &kbdtty);

	if (version > 0)
		if (ioctl(fd, WSKBDIO_SETVERSION, &version) == -1)
			err(1, "SETVERSION %d", version);
	if (raw)
		option = WSKBD_RAW;
	
	if (ioctl(fd, WSKBDIO_SETMODE, &option) == -1)
		err(1, "SETMODE RAW");

	if (ioctl(fd, WSKBDIO_GTYPE, &type) == -1)
		err(2, "ioctl WSKBDIO_GTYPE");
	printf("keyboard type: %ud\n", type);
	if (reset)
		exit(0);
	printf("entering loop\n");
	done = 0;
	while (!done) {
		if (!raw) {
			if (version == 0) {
				n = read(fd, &ev, sizeof(ev));
				printf("%d dev: %#x, type: %#x, value %#x\n", n,
				    /* ev.device */ 0, ev.type, ev.value);
			} else {
				n = read(fd, &evx, sizeof(evx));
				printf("%d dev: %#x, type: %#x, value %#x\n", n,
				    evx.device, evx.type, evx.value);
			}
		} else {
			n = read(fd, buf, sizeof buf);
			printf("-> %d\n", n);
			for (int i = 0; i < n; i++) {
				printf("0x%02x\n", buf[i]);
			}
		}
	}
	tcsetattr(fd, TCSANOW, &okbdtty);
	option = WSKBD_TRANSLATED;
	ioctl(fd, WSKBDIO_SETMODE, &option);
	exit(0);
}