96 lines
1.8 KiB
C
96 lines
1.8 KiB
C
|
#include <sys/ioctl.h>
|
||
|
|
#include <sys/time.h>
|
||
|
|
#include <dev/wscons/wsconsio.h>
|
||
|
|
#include <dev/wscons/wsdisplay_usl_io.h>
|
||
|
|
#include <errno.h>
|
||
|
|
#include <fcntl.h>
|
||
|
|
#include <poll.h>
|
||
|
|
#include <signal.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <stdlib.h>
|
||
|
|
#include <termios.h>
|
||
|
|
#include <unistd.h>
|
||
|
|
|
||
|
|
volatile int done = 0;
|
||
|
|
|
||
|
|
void
|
||
|
|
sighandler(int sig)
|
||
|
|
{
|
||
|
|
done = 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
int
|
||
|
|
main(int argc, char **argv)
|
||
|
|
{
|
||
|
|
struct wscons_event ev;
|
||
|
|
struct termios kbdtty, okbdtty;
|
||
|
|
int fd, i, n, option = WSKBD_TRANSLATED;
|
||
|
|
unsigned char buf[256];
|
||
|
|
|
||
|
|
signal(SIGINT, sighandler);
|
||
|
|
signal(SIGTERM, sighandler);
|
||
|
|
|
||
|
|
printf("Signals installed\n");
|
||
|
|
|
||
|
|
if ((fd = open(argv[1] != NULL ? argv[1]:"/dev/wskbd0", O_RDWR))
|
||
|
|
< 0) {
|
||
|
|
perror("open");
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
#if 0
|
||
|
|
tcgetattr(fd, &kbdtty);
|
||
|
|
okbdtty = kbdtty;
|
||
|
|
cfmakeraw(&kbdtty);
|
||
|
|
kbdtty.c_cc[VTIME] = 0;
|
||
|
|
kbdtty.c_cc[VMIN] = 1;
|
||
|
|
tcsetattr(fd, TCSANOW, &kbdtty);
|
||
|
|
#endif
|
||
|
|
#if 1
|
||
|
|
if (argv[2] != NULL) {
|
||
|
|
if (argv[2][0] == 'r') {
|
||
|
|
option = WSKBD_RAW;
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
option = WSKBD_TRANSLATED;
|
||
|
|
}
|
||
|
|
if (ioctl(fd, WSKBDIO_SETMODE, &option) < 0) {
|
||
|
|
perror("SETMODE RAW");
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
if (option == WSKBD_RAW) {
|
||
|
|
printf("mode RAW\n");
|
||
|
|
} else {
|
||
|
|
printf("mode TRANSLATED\n");
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif
|
||
|
|
printf("entering loop\n");
|
||
|
|
done = 0;
|
||
|
|
while (!done) {
|
||
|
|
if (option == WSKBD_TRANSLATED) {
|
||
|
|
n = read(fd, &ev, sizeof(ev));
|
||
|
|
printf("-> %d type: %d, value %d\n",
|
||
|
|
n, ev.type, ev.value);
|
||
|
|
} else {
|
||
|
|
struct pollfd pfd[1];
|
||
|
|
pfd[0].fd = fd;
|
||
|
|
pfd[0].events = POLLIN;
|
||
|
|
|
||
|
|
n = poll(pfd, 1, INFTIM);
|
||
|
|
if (n <= 0) {
|
||
|
|
printf("nothing %d\n", n);
|
||
|
|
continue;
|
||
|
|
}
|
||
|
|
n = read(fd, buf, sizeof(buf));
|
||
|
|
printf("-> %d\r\n", n);
|
||
|
|
for (i = 0; i < n; i++) {
|
||
|
|
printf(" 0x%02x\r\n", buf[i]);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
tcsetattr(fd, TCSANOW, &okbdtty);
|
||
|
|
option = WSKBD_TRANSLATED;
|
||
|
|
ioctl(fd, WSKBDIO_SETMODE, &option);
|
||
|
|
exit(0);
|
||
|
|
}
|