drivers/usb/gadget/legacy/hid.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * hid.c -- HID Composite driver
   4  *
   5  * Based on multi.c
   6  *
   7  * Copyright (C) 2010 Fabien Chouteau <fabien.chouteau@barco.com>
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License as published by
  11  * the Free Software Foundation; either version 2 of the License, or
  12  * (at your option) any later version.
  13  */
  14
  15
  16 #include <linux/kernel.h>
  17 #include <linux/platform_device.h>
  18 #include <linux/list.h>
  19 #include <linux/module.h>
  20 #include <linux/usb/composite.h>
  21 #include <linux/usb/g_hid.h>
  22
  23 #define DRIVER_DESC             "HID Gadget"
  24 #define DRIVER_VERSION          "2010/03/16"
  25
  26 #include "u_hid.h"
  27
  28 /*-------------------------------------------------------------------------*/
  29
  30 #define HIDG_VENDOR_NUM         0x0525  /* XXX NetChip */
  31 #define HIDG_PRODUCT_NUM        0xa4ac  /* Linux-USB HID gadget */
  32
  33 /*-------------------------------------------------------------------------*/
  34
  35 struct hidg_func_node {
  36         struct usb_function_instance *fi;
  37         struct usb_function *f;
  38         struct list_head node;
  39         struct hidg_func_descriptor *func;
  40 };
  41
  42 static LIST_HEAD(hidg_func_list);
  43
  44 /*-------------------------------------------------------------------------*/
  45 USB_GADGET_COMPOSITE_OPTIONS();
  46
  47 static struct usb_device_descriptor device_desc = {
  48         .bLength =              sizeof device_desc,
  49         .bDescriptorType =      USB_DT_DEVICE,
  50
  51         /* .bcdUSB = DYNAMIC */
  52
  53         /* .bDeviceClass =              USB_CLASS_COMM, */
  54         /* .bDeviceSubClass =   0, */
  55         /* .bDeviceProtocol =   0, */
  56         .bDeviceClass =         USB_CLASS_PER_INTERFACE,
  57         .bDeviceSubClass =      0,
  58         .bDeviceProtocol =      0,
  59         /* .bMaxPacketSize0 = f(hardware) */
  60
  61         /* Vendor and product id can be overridden by module parameters.  */
  62         .idVendor =             cpu_to_le16(HIDG_VENDOR_NUM),
  63         .idProduct =            cpu_to_le16(HIDG_PRODUCT_NUM),
  64         /* .bcdDevice = f(hardware) */
  65         /* .iManufacturer = DYNAMIC */
  66         /* .iProduct = DYNAMIC */
  67         /* NO SERIAL NUMBER */
  68         .bNumConfigurations =   1,
  69 };
  70
  71 static const struct usb_descriptor_header *otg_desc[2];
  72
  73 /* string IDs are assigned dynamically */
  74 static struct usb_string strings_dev[] = {
  75         [USB_GADGET_MANUFACTURER_IDX].s = "",
  76         [USB_GADGET_PRODUCT_IDX].s = DRIVER_DESC,
  77         [USB_GADGET_SERIAL_IDX].s = "",
  78         {  } /* end of list */
  79 };
  80
  81 static struct usb_gadget_strings stringtab_dev = {
  82         .language       = 0x0409,       /* en-us */
  83         .strings        = strings_dev,
  84 };
  85
  86 static struct usb_gadget_strings *dev_strings[] = {
  87         &stringtab_dev,
  88         NULL,
  89 };
  90
  91
  92
  93 /****************************** Configurations ******************************/
  94
  95 static int do_config(struct usb_configuration *c)
  96 {
  97         struct hidg_func_node *e, *n;
  98         int status = 0;
  99
 100         if (gadget_is_otg(c->cdev->gadget)) {
 101                 c->descriptors = otg_desc;
 102                 c->bmAttributes |= USB_CONFIG_ATT_WAKEUP;
 103         }
 104
 105         list_for_each_entry(e, &hidg_func_list, node) {
 106                 e->f = usb_get_function(e->fi);
 107                 if (IS_ERR(e->f))
 108                         goto put;
 109                 status = usb_add_function(c, e->f);
 110                 if (status < 0) {
 111                         usb_put_function(e->f);
 112                         goto put;
 113                 }
 114         }
 115
 116         return 0;
 117 put:
 118         list_for_each_entry(n, &hidg_func_list, node) {
 119                 if (n == e)
 120                         break;
 121                 usb_remove_function(c, n->f);
 122                 usb_put_function(n->f);
 123         }
 124         return status;
 125 }
 126
 127 static struct usb_configuration config_driver = {
 128         .label                  = "HID Gadget",
 129         .bConfigurationValue    = 1,
 130         /* .iConfiguration = DYNAMIC */
 131         .bmAttributes           = USB_CONFIG_ATT_SELFPOWER,
 132 };
 133
 134 /****************************** Gadget Bind ******************************/
 135
 136 static int hid_bind(struct usb_composite_dev *cdev)
 137 {
 138         struct usb_gadget *gadget = cdev->gadget;
 139         struct list_head *tmp;
 140         struct hidg_func_node *n, *m;
 141         struct f_hid_opts *hid_opts;
 142         int status, funcs = 0;
 143
 144         list_for_each(tmp, &hidg_func_list)
 145                 funcs++;
 146
 147         if (!funcs)
 148                 return -ENODEV;
 149
 150         list_for_each_entry(n, &hidg_func_list, node) {
 151                 n->fi = usb_get_function_instance("hid");
 152                 if (IS_ERR(n->fi)) {
 153                         status = PTR_ERR(n->fi);
 154                         goto put;
 155                 }
 156                 hid_opts = container_of(n->fi, struct f_hid_opts, func_inst);
 157                 hid_opts->subclass = n->func->subclass;
 158                 hid_opts->protocol = n->func->protocol;
 159                 hid_opts->report_length = n->func->report_length;
 160                 hid_opts->report_desc_length = n->func->report_desc_length;
 161                 hid_opts->report_desc = n->func->report_desc;
 162         }
 163
 164
 165         /* Allocate string descriptor numbers ... note that string
 166          * contents can be overridden by the composite_dev glue.
 167          */
 168
 169         status = usb_string_ids_tab(cdev, strings_dev);
 170         if (status < 0)
 171                 goto put;
 172         device_desc.iManufacturer = strings_dev[USB_GADGET_MANUFACTURER_IDX].id;
 173         device_desc.iProduct = strings_dev[USB_GADGET_PRODUCT_IDX].id;
 174
 175         if (gadget_is_otg(gadget) && !otg_desc[0]) {
 176                 struct usb_descriptor_header *usb_desc;
 177
 178                 usb_desc = usb_otg_descriptor_alloc(gadget);
 179                 if (!usb_desc)
 180                         goto put;
 181                 usb_otg_descriptor_init(gadget, usb_desc);
 182                 otg_desc[0] = usb_desc;
 183                 otg_desc[1] = NULL;
 184         }
 185
 186         /* register our configuration */
 187         status = usb_add_config(cdev, &config_driver, do_config);
 188         if (status < 0)
 189                 goto free_otg_desc;
 190
 191         usb_composite_overwrite_options(cdev, &coverwrite);
 192         dev_info(&gadget->dev, DRIVER_DESC ", version: " DRIVER_VERSION "\n");
 193
 194         return 0;
 195
 196 free_otg_desc:
 197         kfree(otg_desc[0]);
 198         otg_desc[0] = NULL;
 199 put:
 200         list_for_each_entry(m, &hidg_func_list, node) {
 201                 if (m == n)
 202                         break;
 203                 usb_put_function_instance(m->fi);
 204         }
 205         return status;
 206 }
 207
 208 static int hid_unbind(struct usb_composite_dev *cdev)
 209 {
 210         struct hidg_func_node *n;
 211
 212         list_for_each_entry(n, &hidg_func_list, node) {
 213                 usb_put_function(n->f);
 214                 usb_put_function_instance(n->fi);
 215         }
 216
 217         kfree(otg_desc[0]);
 218         otg_desc[0] = NULL;
 219
 220         return 0;
 221 }
 222
 223 static int hidg_plat_driver_probe(struct platform_device *pdev)
 224 {
 225         struct hidg_func_descriptor *func = dev_get_platdata(&pdev->dev);
 226         struct hidg_func_node *entry;
 227
 228         if (!func) {
 229                 dev_err(&pdev->dev, "Platform data missing\n");
 230                 return -ENODEV;
 231         }
 232
 233         entry = kzalloc(sizeof(*entry), GFP_KERNEL);
 234         if (!entry)
 235                 return -ENOMEM;
 236
 237         entry->func = func;
 238         list_add_tail(&entry->node, &hidg_func_list);
 239
 240         return 0;
 241 }
 242
 243 static int hidg_plat_driver_remove(struct platform_device *pdev)
 244 {
 245         struct hidg_func_node *e, *n;
 246
 247         list_for_each_entry_safe(e, n, &hidg_func_list, node) {
 248                 list_del(&e->node);
 249                 kfree(e);
 250         }
 251
 252         return 0;
 253 }
 254
 255
 256 /****************************** Some noise ******************************/
 257
 258
 259 static struct usb_composite_driver hidg_driver = {
 260         .name           = "g_hid",
 261         .dev            = &device_desc,
 262         .strings        = dev_strings,
 263         .max_speed      = USB_SPEED_HIGH,
 264         .bind           = hid_bind,
 265         .unbind         = hid_unbind,
 266 };
 267
 268 static struct platform_driver hidg_plat_driver = {
 269         .remove         = hidg_plat_driver_remove,
 270         .driver         = {
 271                 .name   = "hidg",
 272         },
 273 };
 274
 275
 276 MODULE_DESCRIPTION(DRIVER_DESC);
 277 MODULE_AUTHOR("Fabien Chouteau, Peter Korsgaard");
 278 MODULE_LICENSE("GPL");
 279
 280 static int __init hidg_init(void)
 281 {
 282         int status;
 283
 284         status = platform_driver_probe(&hidg_plat_driver,
 285                                 hidg_plat_driver_probe);
 286         if (status < 0)
 287                 return status;
 288
 289         status = usb_composite_probe(&hidg_driver);
 290         if (status < 0)
 291                 platform_driver_unregister(&hidg_plat_driver);
 292
 293         return status;
 294 }
 295 module_init(hidg_init);
 296
 297 static void __exit hidg_cleanup(void)
 298 {
 299         usb_composite_unregister(&hidg_driver);
 300         platform_driver_unregister(&hidg_plat_driver);
 301 }
 302 module_exit(hidg_cleanup);