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;
}