Permalink
Switch branches/tags
Find file Copy path
Fetching contributors…
Cannot retrieve contributors at this time
442 lines (392 sloc) 10.6 KB
/* hid_gadget_test */
#include <pthread.h>
#include <string.h>
#include <stdio.h>
#include <ctype.h>
#include <fcntl.h>
#include <errno.h>
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#define BUF_LEN 512
struct options {
const char *opt;
unsigned char val;
};
static struct options kmod[] = {
{.opt = "left-ctrl", .val = 0x01},
{.opt = "right-ctrl", .val = 0x10},
{.opt = "left-shift", .val = 0x02},
{.opt = "right-shift", .val = 0x20},
{.opt = "left-alt", .val = 0x04},
{.opt = "right-alt", .val = 0x40},
{.opt = "left-meta", .val = 0x08},
{.opt = "right-meta", .val = 0x80},
{.opt = NULL}
};
static struct options kval[] = {
{.opt = "a", .val = 0x04},
{.opt = "b", .val = 0x05},
{.opt = "c", .val = 0x06},
{.opt = "d", .val = 0x07},
{.opt = "e", .val = 0x08},
{.opt = "f", .val = 0x09},
{.opt = "g", .val = 0x0a},
{.opt = "h", .val = 0x0b},
{.opt = "i", .val = 0x0c},
{.opt = "j", .val = 0x0d},
{.opt = "k", .val = 0x0e},
{.opt = "l", .val = 0x0f},
{.opt = "m", .val = 0x10},
{.opt = "n", .val = 0x11},
{.opt = "o", .val = 0x12},
{.opt = "p", .val = 0x13},
{.opt = "q", .val = 0x14},
{.opt = "r", .val = 0x15},
{.opt = "s", .val = 0x16},
{.opt = "t", .val = 0x17},
{.opt = "u", .val = 0x18},
{.opt = "v", .val = 0x19},
{.opt = "w", .val = 0x1a},
{.opt = "x", .val = 0x1b},
{.opt = "y", .val = 0x1c},
{.opt = "z", .val = 0x1d},
{.opt = "1", .val = 0x1e},
{.opt = "2", .val = 0x1f},
{.opt = "3", .val = 0x20},
{.opt = "4", .val = 0x21},
{.opt = "5", .val = 0x22},
{.opt = "6", .val = 0x23},
{.opt = "7", .val = 0x24},
{.opt = "8", .val = 0x25},
{.opt = "9", .val = 0x26},
{.opt = "0", .val = 0x27},
{.opt = "return", .val = 0x28},
{.opt = "enter", .val = 0x28},
{.opt = "esc", .val = 0x29},
{.opt = "escape", .val = 0x29},
{.opt = "bckspc", .val = 0x2a},
{.opt = "backspace", .val = 0x2a},
{.opt = "tab", .val = 0x2b},
{.opt = "space", .val = 0x2c},
{.opt = "minus", .val = 0x2d},
{.opt = "dash", .val = 0x2d},
{.opt = "equals", .val = 0x2e},
{.opt = "equal", .val = 0x2e},
{.opt = "lbracket", .val = 0x2f},
{.opt = "rbracket", .val = 0x30},
{.opt = "backslash", .val = 0x31},
{.opt = "hash", .val = 0x32},
{.opt = "number", .val = 0x32},
{.opt = "semicolon", .val = 0x33},
{.opt = "quote", .val = 0x34},
{.opt = "backquote", .val = 0x35},
{.opt = "tilde", .val = 0x35},
{.opt = "comma", .val = 0x36},
{.opt = "period", .val = 0x37},
{.opt = "stop", .val = 0x37},
{.opt = "slash", .val = 0x38},
{.opt = "caps-lock", .val = 0x39},
{.opt = "capslock", .val = 0x39},
{.opt = "f1", .val = 0x3a},
{.opt = "f2", .val = 0x3b},
{.opt = "f3", .val = 0x3c},
{.opt = "f4", .val = 0x3d},
{.opt = "f5", .val = 0x3e},
{.opt = "f6", .val = 0x3f},
{.opt = "f7", .val = 0x40},
{.opt = "f8", .val = 0x41},
{.opt = "f9", .val = 0x42},
{.opt = "f10", .val = 0x43},
{.opt = "f11", .val = 0x44},
{.opt = "f12", .val = 0x45},
{.opt = "print", .val = 0x46},
{.opt = "scroll-lock", .val = 0x47},
{.opt = "scrolllock", .val = 0x47},
{.opt = "pause", .val = 0x48},
{.opt = "insert", .val = 0x49},
{.opt = "home", .val = 0x4a},
{.opt = "pageup", .val = 0x4b},
{.opt = "pgup", .val = 0x4b},
{.opt = "del", .val = 0x4c},
{.opt = "delete", .val = 0x4c},
{.opt = "end", .val = 0x4d},
{.opt = "pagedown", .val = 0x4e},
{.opt = "pgdown", .val = 0x4e},
{.opt = "right", .val = 0x4f},
{.opt = "left", .val = 0x50},
{.opt = "down", .val = 0x51},
{.opt = "up", .val = 0x52},
{.opt = "num-lock", .val = 0x53},
{.opt = "numlock", .val = 0x53},
{.opt = "kp-divide", .val = 0x54},
{.opt = "kp-multiply", .val = 0x55},
{.opt = "kp-minus", .val = 0x56},
{.opt = "kp-plus", .val = 0x57},
{.opt = "kp-enter", .val = 0x58},
{.opt = "kp-return", .val = 0x58},
{.opt = "kp-1", .val = 0x59},
{.opt = "kp-2", .val = 0x5a},
{.opt = "kp-3", .val = 0x5b},
{.opt = "kp-4", .val = 0x5c},
{.opt = "kp-5", .val = 0x5d},
{.opt = "kp-6", .val = 0x5e},
{.opt = "kp-7", .val = 0x5f},
{.opt = "kp-8", .val = 0x60},
{.opt = "kp-9", .val = 0x61},
{.opt = "kp-0", .val = 0x62},
{.opt = "kp-period", .val = 0x63},
{.opt = "kp-stop", .val = 0x63},
{.opt = "application", .val = 0x65},
{.opt = "power", .val = 0x66},
{.opt = "kp-equals", .val = 0x67},
{.opt = "kp-equal", .val = 0x67},
{.opt = "f13", .val = 0x68},
{.opt = "f14", .val = 0x69},
{.opt = "f15", .val = 0x6a},
{.opt = "f16", .val = 0x6b},
{.opt = "f17", .val = 0x6c},
{.opt = "f18", .val = 0x6d},
{.opt = "f19", .val = 0x6e},
{.opt = "f20", .val = 0x6f},
{.opt = "f21", .val = 0x70},
{.opt = "f22", .val = 0x71},
{.opt = "f23", .val = 0x72},
{.opt = "f24", .val = 0x73},
{.opt = "execute", .val = 0x74},
{.opt = "help", .val = 0x75},
{.opt = "menu", .val = 0x76},
{.opt = "select", .val = 0x77},
{.opt = "cancel", .val = 0x78},
{.opt = "redo", .val = 0x79},
{.opt = "undo", .val = 0x7a},
{.opt = "cut", .val = 0x7b},
{.opt = "copy", .val = 0x7c},
{.opt = "paste", .val = 0x7d},
{.opt = "find", .val = 0x7e},
{.opt = "mute", .val = 0x7f},
{.opt = "volume-up", .val = 0x80}, // These are multimedia keys, they will not work on standard keyboard, they need a different USB descriptor
{.opt = "volume-down", .val = 0x81},
{.opt = NULL}
};
int keyboard_fill_report(char report[8], char buf[BUF_LEN], int *hold)
{
char *tok = strtok(buf, " ");
int key = 0;
int i = 0;
for (; tok != NULL; tok = strtok(NULL, " ")) {
if (strncmp(tok, "--", 2) == 0)
tok += 2;
if (strcmp(tok, "quit") == 0)
return -1;
if (strcmp(tok, "hold") == 0) {
*hold = 1;
continue;
}
if (key < 6) {
for (i = 0; kval[i].opt != NULL; i++)
if (strcmp(tok, kval[i].opt) == 0) {
report[2 + key++] = kval[i].val;
break;
}
if (kval[i].opt != NULL)
continue;
}
for (i = 0; kmod[i].opt != NULL; i++)
if (strcmp(tok, kmod[i].opt) == 0) {
report[0] = report[0] | kmod[i].val;
break;
}
if (kmod[i].opt != NULL)
continue;
if (key < 6)
fprintf(stderr, "unknown option: %s\n", tok);
}
return 8;
}
static struct options mmod[] = {
{.opt = "--b1", .val = 0x01},
{.opt = "--b2", .val = 0x02},
{.opt = "--b3", .val = 0x04},
{.opt = NULL}
};
int mouse_fill_report(char report[8], char buf[BUF_LEN], int *hold)
{
char *tok = strtok(buf, " ");
int mvt = 0;
int i = 0;
for (; tok != NULL; tok = strtok(NULL, " ")) {
if (strcmp(tok, "--quit") == 0)
return -1;
if (strcmp(tok, "--hold") == 0) {
*hold = 1;
continue;
}
for (i = 0; mmod[i].opt != NULL; i++)
if (strcmp(tok, mmod[i].opt) == 0) {
report[0] = report[0] | mmod[i].val;
break;
}
if (mmod[i].opt != NULL)
continue;
if (!(tok[0] == '-' && tok[1] == '-') && mvt < 2) {
errno = 0;
report[1 + mvt++] = (char)strtol(tok, NULL, 0);
if (errno != 0) {
fprintf(stderr, "Bad value:'%s'\n", tok);
report[1 + mvt--] = 0;
}
continue;
}
fprintf(stderr, "unknown option: %s\n", tok);
}
return 3;
}
static struct options jmod[] = {
{.opt = "--b1", .val = 0x10},
{.opt = "--b2", .val = 0x20},
{.opt = "--b3", .val = 0x40},
{.opt = "--b4", .val = 0x80},
{.opt = "--hat1", .val = 0x00},
{.opt = "--hat2", .val = 0x01},
{.opt = "--hat3", .val = 0x02},
{.opt = "--hat4", .val = 0x03},
{.opt = "--hatneutral", .val = 0x04},
{.opt = NULL}
};
int joystick_fill_report(char report[8], char buf[BUF_LEN], int *hold)
{
char *tok = strtok(buf, " ");
int mvt = 0;
int i = 0;
*hold = 1;
/* set default hat position: neutral */
report[3] = 0x04;
for (; tok != NULL; tok = strtok(NULL, " ")) {
if (strcmp(tok, "--quit") == 0)
return -1;
for (i = 0; jmod[i].opt != NULL; i++)
if (strcmp(tok, jmod[i].opt) == 0) {
report[3] = (report[3] & 0xF0) | jmod[i].val;
break;
}
if (jmod[i].opt != NULL)
continue;
if (!(tok[0] == '-' && tok[1] == '-') && mvt < 3) {
errno = 0;
report[mvt++] = (char)strtol(tok, NULL, 0);
if (errno != 0) {
fprintf(stderr, "Bad value:'%s'\n", tok);
report[mvt--] = 0;
}
continue;
}
fprintf(stderr, "unknown option: %s\n", tok);
}
return 4;
}
void print_options(char c)
{
int i = 0;
if (c == 'k') {
printf(" keyboard options:\n"
" hold\n");
for (i = 0; kmod[i].opt != NULL; i++)
printf("\t\t%s\n", kmod[i].opt);
printf("\n keyboard values:\n"
" [a-z] or [0-9] or\n");
for (i = 0; kval[i].opt != NULL; i++)
printf("\t\t%-8s%s", kval[i].opt, i % 2 ? "\n" : "");
printf("\n");
} else if (c == 'm') {
printf(" mouse options:\n"
" --hold\n");
for (i = 0; mmod[i].opt != NULL; i++)
printf("\t\t%s\n", mmod[i].opt);
printf("\n mouse values:\n"
" Two signed numbers\n\n");
} else {
printf(" joystick options:\n");
for (i = 0; jmod[i].opt != NULL; i++)
printf("\t\t%s\n", jmod[i].opt);
printf("\n joystick values:\n"
" three signed numbers\n"
"--quit to close\n");
}
}
int main(int argc, const char *argv[])
{
const char *filename = NULL;
int fd = 0;
char buf[BUF_LEN];
int cmd_len;
char report[8];
int to_send = 8;
int hold = 0;
fd_set rfds;
int retval, i;
if (argc < 3) {
fprintf(stderr, "Usage: %s devname mouse|keyboard|joystick\n",
argv[0]);
print_options('k');
print_options('m');
print_options('j');
return 1;
}
if (argv[2][0] != 'k' && argv[2][0] != 'm' && argv[2][0] != 'j')
return 2;
filename = argv[1];
if ((fd = open(filename, O_RDWR, 0666)) == -1) {
perror(filename);
return 3;
}
while (42) {
FD_ZERO(&rfds);
FD_SET(STDIN_FILENO, &rfds);
FD_SET(fd, &rfds);
retval = select(fd + 1, &rfds, NULL, NULL, NULL);
if (retval == -1 && errno == EINTR)
continue;
if (retval < 0) {
perror("select()");
return 4;
}
if (FD_ISSET(fd, &rfds)) {
cmd_len = read(fd, buf, BUF_LEN - 1);
printf("recv report:");
for (i = 0; i < cmd_len; i++)
printf(" %02x", buf[i]);
printf("\n");
}
if (FD_ISSET(STDIN_FILENO, &rfds)) {
memset(report, 0x0, sizeof(report));
cmd_len = read(STDIN_FILENO, buf, BUF_LEN - 1);
if (cmd_len == 0)
break;
buf[cmd_len - 1] = '\0';
hold = 0;
memset(report, 0x0, sizeof(report));
if (argv[2][0] == 'k')
to_send = keyboard_fill_report(report, buf, &hold);
else if (argv[2][0] == 'm')
to_send = mouse_fill_report(report, buf, &hold);
else
to_send = joystick_fill_report(report, buf, &hold);
if (to_send == -1)
break;
if (write(fd, report, to_send) != to_send) {
perror(filename);
return 5;
}
if (!hold) {
memset(report, 0x0, sizeof(report));
if (write(fd, report, to_send) != to_send) {
perror(filename);
return 6;
}
}
}
}
close(fd);
return 0;
}