sys/dev/usb/usbroothub_subr.c

   1 /* $NetBSD$ */
   2
   3 /*
   4  * Copyright (c) 2008
   5  *      Matthias Drochner.  All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  17  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  18  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  19  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  20  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  21  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  22  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  23  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  24  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  25  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  26  *
  27  */
  28
  29 #include <dev/usb/usb.h>
  30 #include <dev/usb/usbroothub_subr.h>
  31
  32 /* helper functions for USB root hub emulation */
  33
  34 int
  35 usb_makestrdesc(usb_string_descriptor_t *p, int l, const char *s)
  36 {
  37         int i;
  38
  39         if (l == 0)
  40                 return (0);
  41         p->bLength = 2 * strlen(s) + 2;
  42         if (l == 1)
  43                 return (1);
  44         p->bDescriptorType = UDESC_STRING;
  45         l -= 2;
  46         /* poor man's utf-16le conversion */
  47         for (i = 0; s[i] && l > 1; i++, l -= 2)
  48                 USETW2(p->bString[i], 0, s[i]);
  49         return (2 * i + 2);
  50 }
  51
  52 int
  53 usb_makelangtbl(usb_string_descriptor_t *p, int l)
  54 {
  55
  56         if (l == 0)
  57                 return (0);
  58         p->bLength = 4;
  59         if (l == 1)
  60                 return (1);
  61         p->bDescriptorType = UDESC_STRING;
  62         if (l <  4)
  63                 return (2);
  64         USETW(p->bString[0], 0x0409); /* english/US */
  65         return (4);
  66 }