123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452 |
- Linux USB HID gadget driver
- Introduction
- The HID Gadget driver provides emulation of USB Human Interface
- Devices (HID). The basic HID handling is done in the kernel,
- and HID reports can be sent/received through I/O on the
- /dev/hidgX character devices.
- For more details about HID, see the developer page on
- http://www.usb.org/developers/hidpage/
- Configuration
- g_hid is a platform driver, so to use it you need to add
- struct platform_device(s) to your platform code defining the
- HID function descriptors you want to use - E.G. something
- like:
- #include <linux/platform_device.h>
- #include <linux/usb/g_hid.h>
- /* hid descriptor for a keyboard */
- static struct hidg_func_descriptor my_hid_data = {
- .subclass = 0, /* No subclass */
- .protocol = 1, /* Keyboard */
- .report_length = 8,
- .report_desc_length = 63,
- .report_desc = {
- 0x05, 0x01, /* USAGE_PAGE (Generic Desktop) */
- 0x09, 0x06, /* USAGE (Keyboard) */
- 0xa1, 0x01, /* COLLECTION (Application) */
- 0x05, 0x07, /* USAGE_PAGE (Keyboard) */
- 0x19, 0xe0, /* USAGE_MINIMUM (Keyboard LeftControl) */
- 0x29, 0xe7, /* USAGE_MAXIMUM (Keyboard Right GUI) */
- 0x15, 0x00, /* LOGICAL_MINIMUM (0) */
- 0x25, 0x01, /* LOGICAL_MAXIMUM (1) */
- 0x75, 0x01, /* REPORT_SIZE (1) */
- 0x95, 0x08, /* REPORT_COUNT (8) */
- 0x81, 0x02, /* INPUT (Data,Var,Abs) */
- 0x95, 0x01, /* REPORT_COUNT (1) */
- 0x75, 0x08, /* REPORT_SIZE (8) */
- 0x81, 0x03, /* INPUT (Cnst,Var,Abs) */
- 0x95, 0x05, /* REPORT_COUNT (5) */
- 0x75, 0x01, /* REPORT_SIZE (1) */
- 0x05, 0x08, /* USAGE_PAGE (LEDs) */
- 0x19, 0x01, /* USAGE_MINIMUM (Num Lock) */
- 0x29, 0x05, /* USAGE_MAXIMUM (Kana) */
- 0x91, 0x02, /* OUTPUT (Data,Var,Abs) */
- 0x95, 0x01, /* REPORT_COUNT (1) */
- 0x75, 0x03, /* REPORT_SIZE (3) */
- 0x91, 0x03, /* OUTPUT (Cnst,Var,Abs) */
- 0x95, 0x06, /* REPORT_COUNT (6) */
- 0x75, 0x08, /* REPORT_SIZE (8) */
- 0x15, 0x00, /* LOGICAL_MINIMUM (0) */
- 0x25, 0x65, /* LOGICAL_MAXIMUM (101) */
- 0x05, 0x07, /* USAGE_PAGE (Keyboard) */
- 0x19, 0x00, /* USAGE_MINIMUM (Reserved) */
- 0x29, 0x65, /* USAGE_MAXIMUM (Keyboard Application) */
- 0x81, 0x00, /* INPUT (Data,Ary,Abs) */
- 0xc0 /* END_COLLECTION */
- }
- };
- static struct platform_device my_hid = {
- .name = "hidg",
- .id = 0,
- .num_resources = 0,
- .resource = 0,
- .dev.platform_data = &my_hid_data,
- };
- You can add as many HID functions as you want, only limited by
- the amount of interrupt endpoints your gadget driver supports.
- Configuration with configfs
- Instead of adding fake platform devices and drivers in order to pass
- some data to the kernel, if HID is a part of a gadget composed with
- configfs the hidg_func_descriptor.report_desc is passed to the kernel
- by writing the appropriate stream of bytes to a configfs attribute.
- Send and receive HID reports
- HID reports can be sent/received using read/write on the
- /dev/hidgX character devices. See below for an example program
- to do this.
- hid_gadget_test is a small interactive program to test the HID
- gadget driver. To use, point it at a hidg device and set the
- device type (keyboard / mouse / joystick) - E.G.:
- # hid_gadget_test /dev/hidg0 keyboard
- You are now in the prompt of hid_gadget_test. You can type any
- combination of options and values. Available options and
- values are listed at program start. In keyboard mode you can
- send up to six values.
- For example type: g i s t r --left-shift
- Hit return and the corresponding report will be sent by the
- HID gadget.
- Another interesting example is the caps lock test. Type
- --caps-lock and hit return. A report is then sent by the
- gadget and you should receive the host answer, corresponding
- to the caps lock LED status.
- --caps-lock
- recv report:2
- With this command:
- # hid_gadget_test /dev/hidg1 mouse
- You can test the mouse emulation. Values are two signed numbers.
- Sample code
- /* 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 = "--return", .val = 0x28},
- {.opt = "--esc", .val = 0x29},
- {.opt = "--bckspc", .val = 0x2a},
- {.opt = "--tab", .val = 0x2b},
- {.opt = "--spacebar", .val = 0x2c},
- {.opt = "--caps-lock", .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 = "--insert", .val = 0x49},
- {.opt = "--home", .val = 0x4a},
- {.opt = "--pageup", .val = 0x4b},
- {.opt = "--del", .val = 0x4c},
- {.opt = "--end", .val = 0x4d},
- {.opt = "--pagedown", .val = 0x4e},
- {.opt = "--right", .val = 0x4f},
- {.opt = "--left", .val = 0x50},
- {.opt = "--down", .val = 0x51},
- {.opt = "--kp-enter", .val = 0x58},
- {.opt = "--up", .val = 0x52},
- {.opt = "--num-lock", .val = 0x53},
- {.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 (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;
- }
- if (key < 6)
- if (islower(tok[0])) {
- report[2 + key++] = (tok[0] - ('a' - 0x04));
- 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\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"
- "--quit to close\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]);
- 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;
- }
- print_options(argv[2][0]);
- 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;
- }
|