arch/all-pc/boot/grub2-aros/grub-core/bus/usb/serial/common.c

   1 /*
   2  *  GRUB  --  GRand Unified Bootloader
   3  *  Copyright (C) 2000,2001,2002,2003,2004,2005,2007,2008,2009,2010  Free Software Foundation, Inc.
   4  *
   5  *  GRUB is free software: you can redistribute it and/or modify
   6  *  it under the terms of the GNU General Public License as published by
   7  *  the Free Software Foundation, either version 3 of the License, or
   8  *  (at your option) any later version.
   9  *
  10  *  GRUB is distributed in the hope that it will be useful,
  11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  *  GNU General Public License for more details.
  14  *
  15  *  You should have received a copy of the GNU General Public License
  16  *  along with GRUB.  If not, see <http://www.gnu.org/licenses/>.
  17  */
  18
  19 #include <grub/serial.h>
  20 #include <grub/usbserial.h>
  21 #include <grub/dl.h>
  22
  23 GRUB_MOD_LICENSE ("GPLv3+");
  24
  25 void
  26 grub_usbserial_fini (struct grub_serial_port *port)
  27 {
  28   port->usbdev->config[port->configno].interf[port->interfno].detach_hook = 0;
  29   port->usbdev->config[port->configno].interf[port->interfno].attached = 0;
  30 }
  31
  32 void
  33 grub_usbserial_detach (grub_usb_device_t usbdev, int configno, int interfno)
  34 {
  35   static struct grub_serial_port *port;
  36   port = usbdev->config[configno].interf[interfno].detach_data;
  37
  38   grub_serial_unregister (port);
  39 }
  40
  41 static int usbnum = 0;
  42
  43 int
  44 grub_usbserial_attach (grub_usb_device_t usbdev, int configno, int interfno,
  45                        struct grub_serial_driver *driver)
  46 {
  47   struct grub_serial_port *port;
  48   int j;
  49   struct grub_usb_desc_if *interf;
  50   grub_usb_err_t err = GRUB_USB_ERR_NONE;
  51
  52   interf = usbdev->config[configno].interf[interfno].descif;
  53
  54   port = grub_malloc (sizeof (*port));
  55   if (!port)
  56     {
  57       grub_print_error ();
  58       return 0;
  59     }
  60
  61   port->name = grub_xasprintf ("usb%d", usbnum++);
  62   if (!port->name)
  63     {
  64       grub_free (port);
  65       grub_print_error ();
  66       return 0;
  67     }
  68
  69   port->usbdev = usbdev;
  70   port->driver = driver;
  71   for (j = 0; j < interf->endpointcnt; j++)
  72     {
  73       struct grub_usb_desc_endp *endp;
  74       endp = &usbdev->config[0].interf[interfno].descendp[j];
  75
  76       if ((endp->endp_addr & 128) && (endp->attrib & 3) == 2)
  77         {
  78           /* Bulk IN endpoint.  */
  79           port->in_endp = endp;
  80         }
  81       else if (!(endp->endp_addr & 128) && (endp->attrib & 3) == 2)
  82         {
  83           /* Bulk OUT endpoint.  */
  84           port->out_endp = endp;
  85         }
  86     }
  87
  88   /* Configure device */
  89   if (port->out_endp && port->in_endp)
  90     err = grub_usb_set_configuration (usbdev, configno + 1);
  91
  92   if (!port->out_endp || !port->in_endp || err)
  93     {
  94       grub_free (port->name);
  95       grub_free (port);
  96       return 0;
  97     }
  98
  99   port->configno = configno;
 100   port->interfno = interfno;
 101
 102   grub_serial_config_defaults (port);
 103   grub_serial_register (port);
 104
 105   port->usbdev->config[port->configno].interf[port->interfno].detach_hook
 106     = grub_usbserial_detach;
 107   port->usbdev->config[port->configno].interf[port->interfno].detach_data
 108     = port;
 109
 110   return 1;
 111 }
 112
 113 int
 114 grub_usbserial_fetch (struct grub_serial_port *port, grub_size_t header_size)
 115 {
 116   grub_usb_err_t err;
 117   grub_size_t actual;
 118
 119   if (port->bufstart < port->bufend)
 120     return port->buf[port->bufstart++];
 121
 122   err = grub_usb_bulk_read_extended (port->usbdev, port->in_endp->endp_addr,
 123                                      sizeof (port->buf), port->buf, 10,
 124                                      &actual);
 125   if (err != GRUB_USB_ERR_NONE)
 126     return -1;
 127
 128   port->bufstart = header_size;
 129   port->bufend = actual;
 130   if (port->bufstart >= port->bufend)
 131     return -1;
 132
 133   return port->buf[port->bufstart++];
 134 }