drivers/serial/usbtty.c

   1 /*
   2  * (C) Copyright 2003
   3  * Gerry Hamel, geh@ti.com, Texas Instruments
   4  *
   5  * (C) Copyright 2006
   6  * Bryan O'Donoghue, bodonoghue@codehermit.ie
   7  *
   8  * SPDX-License-Identifier:     GPL-2.0+
   9  */
  10
  11 #include <common.h>
  12 #include <config.h>
  13 #include <circbuf.h>
  14 #include <stdio_dev.h>
  15 #include <asm/unaligned.h>
  16 #include "usbtty.h"
  17 #include "usb_cdc_acm.h"
  18 #include "usbdescriptors.h"
  19
  20 #ifdef DEBUG
  21 #define TTYDBG(fmt,args...)\
  22         serial_printf("[%s] %s %d: "fmt, __FILE__,__FUNCTION__,__LINE__,##args)
  23 #else
  24 #define TTYDBG(fmt,args...) do{}while(0)
  25 #endif
  26
  27 #if 1
  28 #define TTYERR(fmt,args...)\
  29         serial_printf("ERROR![%s] %s %d: "fmt, __FILE__,__FUNCTION__,\
  30         __LINE__,##args)
  31 #else
  32 #define TTYERR(fmt,args...) do{}while(0)
  33 #endif
  34
  35 /*
  36  * Defines
  37  */
  38 #define NUM_CONFIGS    1
  39 #define MAX_INTERFACES 2
  40 #define NUM_ENDPOINTS  3
  41 #define ACM_TX_ENDPOINT 3
  42 #define ACM_RX_ENDPOINT 2
  43 #define GSERIAL_TX_ENDPOINT 2
  44 #define GSERIAL_RX_ENDPOINT 1
  45 #define NUM_ACM_INTERFACES 2
  46 #define NUM_GSERIAL_INTERFACES 1
  47 #define CONFIG_USBD_DATA_INTERFACE_STR "Bulk Data Interface"
  48 #define CONFIG_USBD_CTRL_INTERFACE_STR "Control Interface"
  49
  50 /*
  51  * Buffers to hold input and output data
  52  */
  53 #define USBTTY_BUFFER_SIZE 2048
  54 static circbuf_t usbtty_input;
  55 static circbuf_t usbtty_output;
  56
  57
  58 /*
  59  * Instance variables
  60  */
  61 static struct stdio_dev usbttydev;
  62 static struct usb_device_instance device_instance[1];
  63 static struct usb_bus_instance bus_instance[1];
  64 static struct usb_configuration_instance config_instance[NUM_CONFIGS];
  65 static struct usb_interface_instance interface_instance[MAX_INTERFACES];
  66 static struct usb_alternate_instance alternate_instance[MAX_INTERFACES];
  67 /* one extra for control endpoint */
  68 static struct usb_endpoint_instance endpoint_instance[NUM_ENDPOINTS+1];
  69
  70 /*
  71  * Global flag
  72  */
  73 int usbtty_configured_flag = 0;
  74
  75 /*
  76  * Serial number
  77  */
  78 static char serial_number[16];
  79
  80
  81 /*
  82  * Descriptors, Strings, Local variables.
  83  */
  84
  85 /* defined and used by gadget/ep0.c */
  86 extern struct usb_string_descriptor **usb_strings;
  87
  88 /* Indicies, References */
  89 static unsigned short rx_endpoint = 0;
  90 static unsigned short tx_endpoint = 0;
  91 static unsigned short interface_count = 0;
  92 static struct usb_string_descriptor *usbtty_string_table[STR_COUNT];
  93
  94 /* USB Descriptor Strings */
  95 static u8 wstrLang[4] = {4,USB_DT_STRING,0x9,0x4};
  96 static u8 wstrManufacturer[2 + 2*(sizeof(CONFIG_USBD_MANUFACTURER)-1)];
  97 static u8 wstrProduct[2 + 2*(sizeof(CONFIG_USBD_PRODUCT_NAME)-1)];
  98 static u8 wstrSerial[2 + 2*(sizeof(serial_number) - 1)];
  99 static u8 wstrConfiguration[2 + 2*(sizeof(CONFIG_USBD_CONFIGURATION_STR)-1)];
 100 static u8 wstrDataInterface[2 + 2*(sizeof(CONFIG_USBD_DATA_INTERFACE_STR)-1)];
 101 static u8 wstrCtrlInterface[2 + 2*(sizeof(CONFIG_USBD_DATA_INTERFACE_STR)-1)];
 102
 103 /* Standard USB Data Structures */
 104 static struct usb_interface_descriptor interface_descriptors[MAX_INTERFACES];
 105 static struct usb_endpoint_descriptor *ep_descriptor_ptrs[NUM_ENDPOINTS];
 106 static struct usb_configuration_descriptor      *configuration_descriptor = 0;
 107 static struct usb_device_descriptor device_descriptor = {
 108         .bLength = sizeof(struct usb_device_descriptor),
 109         .bDescriptorType =      USB_DT_DEVICE,
 110         .bcdUSB =               cpu_to_le16(USB_BCD_VERSION),
 111         .bDeviceSubClass =      0x00,
 112         .bDeviceProtocol =      0x00,
 113         .bMaxPacketSize0 =      EP0_MAX_PACKET_SIZE,
 114         .idVendor =             cpu_to_le16(CONFIG_USBD_VENDORID),
 115         .bcdDevice =            cpu_to_le16(USBTTY_BCD_DEVICE),
 116         .iManufacturer =        STR_MANUFACTURER,
 117         .iProduct =             STR_PRODUCT,
 118         .iSerialNumber =        STR_SERIAL,
 119         .bNumConfigurations =   NUM_CONFIGS
 120 };
 121
 122
 123 #if defined(CONFIG_USBD_HS)
 124 static struct usb_qualifier_descriptor qualifier_descriptor = {
 125         .bLength = sizeof(struct usb_qualifier_descriptor),
 126         .bDescriptorType =      USB_DT_QUAL,
 127         .bcdUSB =               cpu_to_le16(USB_BCD_VERSION),
 128         .bDeviceClass =         COMMUNICATIONS_DEVICE_CLASS,
 129         .bDeviceSubClass =      0x00,
 130         .bDeviceProtocol =      0x00,
 131         .bMaxPacketSize0 =      EP0_MAX_PACKET_SIZE,
 132         .bNumConfigurations =   NUM_CONFIGS
 133 };
 134 #endif
 135
 136 /*
 137  * Static CDC ACM specific descriptors
 138  */
 139
 140 struct acm_config_desc {
 141         struct usb_configuration_descriptor configuration_desc;
 142
 143         /* Master Interface */
 144         struct usb_interface_descriptor interface_desc;
 145
 146         struct usb_class_header_function_descriptor usb_class_header;
 147         struct usb_class_call_management_descriptor usb_class_call_mgt;
 148         struct usb_class_abstract_control_descriptor usb_class_acm;
 149         struct usb_class_union_function_descriptor usb_class_union;
 150         struct usb_endpoint_descriptor notification_endpoint;
 151
 152         /* Slave Interface */
 153         struct usb_interface_descriptor data_class_interface;
 154         struct usb_endpoint_descriptor data_endpoints[NUM_ENDPOINTS-1];
 155 } __attribute__((packed));
 156
 157 static struct acm_config_desc acm_configuration_descriptors[NUM_CONFIGS] = {
 158         {
 159                 .configuration_desc ={
 160                         .bLength =
 161                                 sizeof(struct usb_configuration_descriptor),
 162                         .bDescriptorType = USB_DT_CONFIG,
 163                         .wTotalLength =
 164                                 cpu_to_le16(sizeof(struct acm_config_desc)),
 165                         .bNumInterfaces = NUM_ACM_INTERFACES,
 166                         .bConfigurationValue = 1,
 167                         .iConfiguration = STR_CONFIG,
 168                         .bmAttributes =
 169                                 BMATTRIBUTE_SELF_POWERED|BMATTRIBUTE_RESERVED,
 170                         .bMaxPower = USBTTY_MAXPOWER
 171                 },
 172                 /* Interface 1 */
 173                 .interface_desc = {
 174                         .bLength  = sizeof(struct usb_interface_descriptor),
 175                         .bDescriptorType = USB_DT_INTERFACE,
 176                         .bInterfaceNumber = 0,
 177                         .bAlternateSetting = 0,
 178                         .bNumEndpoints = 0x01,
 179                         .bInterfaceClass =
 180                                 COMMUNICATIONS_INTERFACE_CLASS_CONTROL,
 181                         .bInterfaceSubClass = COMMUNICATIONS_ACM_SUBCLASS,
 182                         .bInterfaceProtocol = COMMUNICATIONS_V25TER_PROTOCOL,
 183                         .iInterface = STR_CTRL_INTERFACE,
 184                 },
 185                 .usb_class_header = {
 186                         .bFunctionLength        =
 187                                 sizeof(struct usb_class_header_function_descriptor),
 188                         .bDescriptorType        = CS_INTERFACE,
 189                         .bDescriptorSubtype     = USB_ST_HEADER,
 190                         .bcdCDC = cpu_to_le16(110),
 191                 },
 192                 .usb_class_call_mgt = {
 193                         .bFunctionLength        =
 194                                 sizeof(struct usb_class_call_management_descriptor),
 195                         .bDescriptorType        = CS_INTERFACE,
 196                         .bDescriptorSubtype     = USB_ST_CMF,
 197                         .bmCapabilities         = 0x00,
 198                         .bDataInterface         = 0x01,
 199                 },
 200                 .usb_class_acm = {
 201                         .bFunctionLength        =
 202                                 sizeof(struct usb_class_abstract_control_descriptor),
 203                         .bDescriptorType        = CS_INTERFACE,
 204                         .bDescriptorSubtype     = USB_ST_ACMF,
 205                         .bmCapabilities         = 0x00,
 206                 },
 207                 .usb_class_union = {
 208                         .bFunctionLength        =
 209                                 sizeof(struct usb_class_union_function_descriptor),
 210                         .bDescriptorType        = CS_INTERFACE,
 211                         .bDescriptorSubtype     = USB_ST_UF,
 212                         .bMasterInterface       = 0x00,
 213                         .bSlaveInterface0       = 0x01,
 214                 },
 215                 .notification_endpoint = {
 216                         .bLength =
 217                                 sizeof(struct usb_endpoint_descriptor),
 218                         .bDescriptorType        = USB_DT_ENDPOINT,
 219                         .bEndpointAddress       = UDC_INT_ENDPOINT | USB_DIR_IN,
 220                         .bmAttributes           = USB_ENDPOINT_XFER_INT,
 221                         .wMaxPacketSize
 222                                 = cpu_to_le16(CONFIG_USBD_SERIAL_INT_PKTSIZE),
 223                         .bInterval              = 0xFF,
 224                 },
 225
 226                 /* Interface 2 */
 227                 .data_class_interface = {
 228                         .bLength                =
 229                                 sizeof(struct usb_interface_descriptor),
 230                         .bDescriptorType        = USB_DT_INTERFACE,
 231                         .bInterfaceNumber       = 0x01,
 232                         .bAlternateSetting      = 0x00,
 233                         .bNumEndpoints          = 0x02,
 234                         .bInterfaceClass        =
 235                                 COMMUNICATIONS_INTERFACE_CLASS_DATA,
 236                         .bInterfaceSubClass     = DATA_INTERFACE_SUBCLASS_NONE,
 237                         .bInterfaceProtocol     = DATA_INTERFACE_PROTOCOL_NONE,
 238                         .iInterface             = STR_DATA_INTERFACE,
 239                 },
 240                 .data_endpoints = {
 241                         {
 242                                 .bLength                =
 243                                         sizeof(struct usb_endpoint_descriptor),
 244                                 .bDescriptorType        = USB_DT_ENDPOINT,
 245                                 .bEndpointAddress       = UDC_OUT_ENDPOINT | USB_DIR_OUT,
 246                                 .bmAttributes           =
 247                                         USB_ENDPOINT_XFER_BULK,
 248                                 .wMaxPacketSize         =
 249                                         cpu_to_le16(CONFIG_USBD_SERIAL_BULK_PKTSIZE),
 250                                 .bInterval              = 0xFF,
 251                         },
 252                         {
 253                                 .bLength                =
 254                                         sizeof(struct usb_endpoint_descriptor),
 255                                 .bDescriptorType        = USB_DT_ENDPOINT,
 256                                 .bEndpointAddress       = UDC_IN_ENDPOINT | USB_DIR_IN,
 257                                 .bmAttributes           =
 258                                         USB_ENDPOINT_XFER_BULK,
 259                                 .wMaxPacketSize         =
 260                                         cpu_to_le16(CONFIG_USBD_SERIAL_BULK_PKTSIZE),
 261                                 .bInterval              = 0xFF,
 262                         },
 263                 },
 264         },
 265 };
 266
 267 static struct rs232_emu rs232_desc={
 268                 .dter           =       115200,
 269                 .stop_bits      =       0x00,
 270                 .parity         =       0x00,
 271                 .data_bits      =       0x08
 272 };
 273
 274
 275 /*
 276  * Static Generic Serial specific data
 277  */
 278
 279
 280 struct gserial_config_desc {
 281
 282         struct usb_configuration_descriptor configuration_desc;
 283         struct usb_interface_descriptor interface_desc[NUM_GSERIAL_INTERFACES];
 284         struct usb_endpoint_descriptor data_endpoints[NUM_ENDPOINTS];
 285
 286 } __attribute__((packed));
 287
 288 static struct gserial_config_desc
 289 gserial_configuration_descriptors[NUM_CONFIGS] ={
 290         {
 291                 .configuration_desc ={
 292                         .bLength = sizeof(struct usb_configuration_descriptor),
 293                         .bDescriptorType = USB_DT_CONFIG,
 294                         .wTotalLength =
 295                                 cpu_to_le16(sizeof(struct gserial_config_desc)),
 296                         .bNumInterfaces = NUM_GSERIAL_INTERFACES,
 297                         .bConfigurationValue = 1,
 298                         .iConfiguration = STR_CONFIG,
 299                         .bmAttributes =
 300                                 BMATTRIBUTE_SELF_POWERED|BMATTRIBUTE_RESERVED,
 301                         .bMaxPower = USBTTY_MAXPOWER
 302                 },
 303                 .interface_desc = {
 304                         {
 305                                 .bLength  =
 306                                         sizeof(struct usb_interface_descriptor),
 307                                 .bDescriptorType = USB_DT_INTERFACE,
 308                                 .bInterfaceNumber = 0,
 309                                 .bAlternateSetting = 0,
 310                                 .bNumEndpoints = NUM_ENDPOINTS,
 311                                 .bInterfaceClass =
 312                                         COMMUNICATIONS_INTERFACE_CLASS_VENDOR,
 313                                 .bInterfaceSubClass =
 314                                         COMMUNICATIONS_NO_SUBCLASS,
 315                                 .bInterfaceProtocol =
 316                                         COMMUNICATIONS_NO_PROTOCOL,
 317                                 .iInterface = STR_DATA_INTERFACE
 318                         },
 319                 },
 320                 .data_endpoints  = {
 321                         {
 322                                 .bLength =
 323                                         sizeof(struct usb_endpoint_descriptor),
 324                                 .bDescriptorType =      USB_DT_ENDPOINT,
 325                                 .bEndpointAddress =     UDC_OUT_ENDPOINT | USB_DIR_OUT,
 326                                 .bmAttributes =         USB_ENDPOINT_XFER_BULK,
 327                                 .wMaxPacketSize =
 328                                         cpu_to_le16(CONFIG_USBD_SERIAL_OUT_PKTSIZE),
 329                                 .bInterval=             0xFF,
 330                         },
 331                         {
 332                                 .bLength =
 333                                         sizeof(struct usb_endpoint_descriptor),
 334                                 .bDescriptorType =      USB_DT_ENDPOINT,
 335                                 .bEndpointAddress =     UDC_IN_ENDPOINT | USB_DIR_IN,
 336                                 .bmAttributes =         USB_ENDPOINT_XFER_BULK,
 337                                 .wMaxPacketSize =
 338                                         cpu_to_le16(CONFIG_USBD_SERIAL_IN_PKTSIZE),
 339                                 .bInterval =            0xFF,
 340                         },
 341                         {
 342                                 .bLength =
 343                                         sizeof(struct usb_endpoint_descriptor),
 344                                 .bDescriptorType =      USB_DT_ENDPOINT,
 345                                 .bEndpointAddress =     UDC_INT_ENDPOINT | USB_DIR_IN,
 346                                 .bmAttributes =         USB_ENDPOINT_XFER_INT,
 347                                 .wMaxPacketSize =
 348                                         cpu_to_le16(CONFIG_USBD_SERIAL_INT_PKTSIZE),
 349                                 .bInterval =            0xFF,
 350                         },
 351                 },
 352         },
 353 };
 354
 355 /*
 356  * Static Function Prototypes
 357  */
 358
 359 static void usbtty_init_strings (void);
 360 static void usbtty_init_instances (void);
 361 static void usbtty_init_endpoints (void);
 362 static void usbtty_init_terminal_type(short type);
 363 static void usbtty_event_handler (struct usb_device_instance *device,
 364                                 usb_device_event_t event, int data);
 365 static int usbtty_cdc_setup(struct usb_device_request *request,
 366                                 struct urb *urb);
 367 static int usbtty_configured (void);
 368 static int write_buffer (circbuf_t * buf);
 369 static int fill_buffer (circbuf_t * buf);
 370
 371 void usbtty_poll (void);
 372
 373 /* utility function for converting char* to wide string used by USB */
 374 static void str2wide (char *str, u16 * wide)
 375 {
 376         int i;
 377         for (i = 0; i < strlen (str) && str[i]; i++){
 378                 #if defined(__LITTLE_ENDIAN)
 379                         wide[i] = (u16) str[i];
 380                 #elif defined(__BIG_ENDIAN)
 381                         wide[i] = ((u16)(str[i])<<8);
 382                 #else
 383                         #error "__LITTLE_ENDIAN or __BIG_ENDIAN undefined"
 384                 #endif
 385         }
 386 }
 387
 388 /*
 389  * Test whether a character is in the RX buffer
 390  */
 391
 392 int usbtty_tstc(struct stdio_dev *dev)
 393 {
 394         struct usb_endpoint_instance *endpoint =
 395                 &endpoint_instance[rx_endpoint];
 396
 397         /* If no input data exists, allow more RX to be accepted */
 398         if(usbtty_input.size <= 0){
 399                 udc_unset_nak(endpoint->endpoint_address&0x03);
 400         }
 401
 402         usbtty_poll ();
 403         return (usbtty_input.size > 0);
 404 }
 405
 406 /*
 407  * Read a single byte from the usb client port. Returns 1 on success, 0
 408  * otherwise. When the function is succesfull, the character read is
 409  * written into its argument c.
 410  */
 411
 412 int usbtty_getc(struct stdio_dev *dev)
 413 {
 414         char c;
 415         struct usb_endpoint_instance *endpoint =
 416                 &endpoint_instance[rx_endpoint];
 417
 418         while (usbtty_input.size <= 0) {
 419                 udc_unset_nak(endpoint->endpoint_address&0x03);
 420                 usbtty_poll ();
 421         }
 422
 423         buf_pop (&usbtty_input, &c, 1);
 424         udc_set_nak(endpoint->endpoint_address&0x03);
 425
 426         return c;
 427 }
 428
 429 /*
 430  * Output a single byte to the usb client port.
 431  */
 432 void usbtty_putc(struct stdio_dev *dev, const char c)
 433 {
 434         if (!usbtty_configured ())
 435                 return;
 436
 437         /* If \n, also do \r */
 438         if (c == '\n')
 439                 buf_push (&usbtty_output, "\r", 1);
 440
 441         buf_push(&usbtty_output, &c, 1);
 442
 443         /* Poll at end to handle new data... */
 444         if ((usbtty_output.size + 2) >= usbtty_output.totalsize) {
 445                 usbtty_poll ();
 446         }
 447 }
 448
 449 /* usbtty_puts() helper function for finding the next '\n' in a string */
 450 static int next_nl_pos (const char *s)
 451 {
 452         int i;
 453
 454         for (i = 0; s[i] != '\0'; i++) {
 455                 if (s[i] == '\n')
 456                         return i;
 457         }
 458         return i;
 459 }
 460
 461 /*
 462  * Output a string to the usb client port - implementing flow control
 463  */
 464
 465 static void __usbtty_puts (const char *str, int len)
 466 {
 467         int maxlen = usbtty_output.totalsize;
 468         int space, n;
 469
 470         /* break str into chunks < buffer size, if needed */
 471         while (len > 0) {
 472                 usbtty_poll ();
 473
 474                 space = maxlen - usbtty_output.size;
 475                 /* Empty buffer here, if needed, to ensure space... */
 476                 if (space) {
 477                         write_buffer (&usbtty_output);
 478
 479                         n = min(space, min(len, maxlen));
 480                         buf_push (&usbtty_output, str, n);
 481
 482                         str += n;
 483                         len -= n;
 484                 }
 485         }
 486 }
 487
 488 void usbtty_puts(struct stdio_dev *dev, const char *str)
 489 {
 490         int n;
 491         int len;
 492
 493         if (!usbtty_configured ())
 494                 return;
 495
 496         len = strlen (str);
 497         /* add '\r' for each '\n' */
 498         while (len > 0) {
 499                 n = next_nl_pos (str);
 500
 501                 if (str[n] == '\n') {
 502                         __usbtty_puts("\r", 1);
 503                         __usbtty_puts(str, n + 1);
 504                         str += (n + 1);
 505                         len -= (n + 1);
 506                 } else {
 507                         /* No \n found.  All done. */
 508                         __usbtty_puts (str, n);
 509                         break;
 510                 }
 511         }
 512
 513         /* Poll at end to handle new data... */
 514         usbtty_poll ();
 515 }
 516
 517 /*
 518  * Initialize the usb client port.
 519  *
 520  */
 521 int drv_usbtty_init (void)
 522 {
 523         int rc;
 524         char * sn;
 525         char * tt;
 526         int snlen;
 527
 528         /* Ger seiral number */
 529         if (!(sn = getenv("serial#"))) {
 530                 sn = "000000000000";
 531         }
 532         snlen = strlen(sn);
 533         if (snlen > sizeof(serial_number) - 1) {
 534                 printf ("Warning: serial number %s is too long (%d > %lu)\n",
 535                         sn, snlen, (ulong)(sizeof(serial_number) - 1));
 536                 snlen = sizeof(serial_number) - 1;
 537         }
 538         memcpy (serial_number, sn, snlen);
 539         serial_number[snlen] = '\0';
 540
 541         /* Decide on which type of UDC device to be.
 542          */
 543
 544         if(!(tt = getenv("usbtty"))) {
 545                 tt = "generic";
 546         }
 547         usbtty_init_terminal_type(strcmp(tt,"cdc_acm"));
 548
 549         /* prepare buffers... */
 550         buf_init (&usbtty_input, USBTTY_BUFFER_SIZE);
 551         buf_init (&usbtty_output, USBTTY_BUFFER_SIZE);
 552
 553         /* Now, set up USB controller and infrastructure */
 554         udc_init ();            /* Basic USB initialization */
 555
 556         usbtty_init_strings ();
 557         usbtty_init_instances ();
 558
 559         usbtty_init_endpoints ();
 560
 561         udc_startup_events (device_instance);/* Enable dev, init udc pointers */
 562         udc_connect ();         /* Enable pullup for host detection */
 563
 564         /* Device initialization */
 565         memset (&usbttydev, 0, sizeof (usbttydev));
 566
 567         strcpy (usbttydev.name, "usbtty");
 568         usbttydev.ext = 0;      /* No extensions */
 569         usbttydev.flags = DEV_FLAGS_INPUT | DEV_FLAGS_OUTPUT;
 570         usbttydev.tstc = usbtty_tstc;   /* 'tstc' function */
 571         usbttydev.getc = usbtty_getc;   /* 'getc' function */
 572         usbttydev.putc = usbtty_putc;   /* 'putc' function */
 573         usbttydev.puts = usbtty_puts;   /* 'puts' function */
 574
 575         rc = stdio_register (&usbttydev);
 576
 577         return (rc == 0) ? 1 : rc;
 578 }
 579
 580 static void usbtty_init_strings (void)
 581 {
 582         struct usb_string_descriptor *string;
 583
 584         usbtty_string_table[STR_LANG] =
 585                 (struct usb_string_descriptor*)wstrLang;
 586
 587         string = (struct usb_string_descriptor *) wstrManufacturer;
 588         string->bLength = sizeof(wstrManufacturer);
 589         string->bDescriptorType = USB_DT_STRING;
 590         str2wide (CONFIG_USBD_MANUFACTURER, string->wData);
 591         usbtty_string_table[STR_MANUFACTURER]=string;
 592
 593
 594         string = (struct usb_string_descriptor *) wstrProduct;
 595         string->bLength = sizeof(wstrProduct);
 596         string->bDescriptorType = USB_DT_STRING;
 597         str2wide (CONFIG_USBD_PRODUCT_NAME, string->wData);
 598         usbtty_string_table[STR_PRODUCT]=string;
 599
 600
 601         string = (struct usb_string_descriptor *) wstrSerial;
 602         string->bLength = sizeof(serial_number);
 603         string->bDescriptorType = USB_DT_STRING;
 604         str2wide (serial_number, string->wData);
 605         usbtty_string_table[STR_SERIAL]=string;
 606
 607
 608         string = (struct usb_string_descriptor *) wstrConfiguration;
 609         string->bLength = sizeof(wstrConfiguration);
 610         string->bDescriptorType = USB_DT_STRING;
 611         str2wide (CONFIG_USBD_CONFIGURATION_STR, string->wData);
 612         usbtty_string_table[STR_CONFIG]=string;
 613
 614
 615         string = (struct usb_string_descriptor *) wstrDataInterface;
 616         string->bLength = sizeof(wstrDataInterface);
 617         string->bDescriptorType = USB_DT_STRING;
 618         str2wide (CONFIG_USBD_DATA_INTERFACE_STR, string->wData);
 619         usbtty_string_table[STR_DATA_INTERFACE]=string;
 620
 621         string = (struct usb_string_descriptor *) wstrCtrlInterface;
 622         string->bLength = sizeof(wstrCtrlInterface);
 623         string->bDescriptorType = USB_DT_STRING;
 624         str2wide (CONFIG_USBD_CTRL_INTERFACE_STR, string->wData);
 625         usbtty_string_table[STR_CTRL_INTERFACE]=string;
 626
 627         /* Now, initialize the string table for ep0 handling */
 628         usb_strings = usbtty_string_table;
 629 }
 630
 631 #define init_wMaxPacketSize(x)  le16_to_cpu(get_unaligned(\
 632                         &ep_descriptor_ptrs[(x) - 1]->wMaxPacketSize));
 633
 634 static void usbtty_init_instances (void)
 635 {
 636         int i;
 637
 638         /* initialize device instance */
 639         memset (device_instance, 0, sizeof (struct usb_device_instance));
 640         device_instance->device_state = STATE_INIT;
 641         device_instance->device_descriptor = &device_descriptor;
 642 #if defined(CONFIG_USBD_HS)
 643         device_instance->qualifier_descriptor = &qualifier_descriptor;
 644 #endif
 645         device_instance->event = usbtty_event_handler;
 646         device_instance->cdc_recv_setup = usbtty_cdc_setup;
 647         device_instance->bus = bus_instance;
 648         device_instance->configurations = NUM_CONFIGS;
 649         device_instance->configuration_instance_array = config_instance;
 650
 651         /* initialize bus instance */
 652         memset (bus_instance, 0, sizeof (struct usb_bus_instance));
 653         bus_instance->device = device_instance;
 654         bus_instance->endpoint_array = endpoint_instance;
 655         bus_instance->max_endpoints = 1;
 656         bus_instance->maxpacketsize = 64;
 657         bus_instance->serial_number_str = serial_number;
 658
 659         /* configuration instance */
 660         memset (config_instance, 0,
 661                 sizeof (struct usb_configuration_instance));
 662         config_instance->interfaces = interface_count;
 663         config_instance->configuration_descriptor = configuration_descriptor;
 664         config_instance->interface_instance_array = interface_instance;
 665
 666         /* interface instance */
 667         memset (interface_instance, 0,
 668                 sizeof (struct usb_interface_instance));
 669         interface_instance->alternates = 1;
 670         interface_instance->alternates_instance_array = alternate_instance;
 671
 672         /* alternates instance */
 673         memset (alternate_instance, 0,
 674                 sizeof (struct usb_alternate_instance));
 675         alternate_instance->interface_descriptor = interface_descriptors;
 676         alternate_instance->endpoints = NUM_ENDPOINTS;
 677         alternate_instance->endpoints_descriptor_array = ep_descriptor_ptrs;
 678
 679         /* endpoint instances */
 680         memset (&endpoint_instance[0], 0,
 681                 sizeof (struct usb_endpoint_instance));
 682         endpoint_instance[0].endpoint_address = 0;
 683         endpoint_instance[0].rcv_packetSize = EP0_MAX_PACKET_SIZE;
 684         endpoint_instance[0].rcv_attributes = USB_ENDPOINT_XFER_CONTROL;
 685         endpoint_instance[0].tx_packetSize = EP0_MAX_PACKET_SIZE;
 686         endpoint_instance[0].tx_attributes = USB_ENDPOINT_XFER_CONTROL;
 687         udc_setup_ep (device_instance, 0, &endpoint_instance[0]);
 688
 689         for (i = 1; i <= NUM_ENDPOINTS; i++) {
 690                 memset (&endpoint_instance[i], 0,
 691                         sizeof (struct usb_endpoint_instance));
 692
 693                 endpoint_instance[i].endpoint_address =
 694                         ep_descriptor_ptrs[i - 1]->bEndpointAddress;
 695
 696                 endpoint_instance[i].rcv_attributes =
 697                         ep_descriptor_ptrs[i - 1]->bmAttributes;
 698
 699                 endpoint_instance[i].rcv_packetSize = init_wMaxPacketSize(i);
 700
 701                 endpoint_instance[i].tx_attributes =
 702                         ep_descriptor_ptrs[i - 1]->bmAttributes;
 703
 704                 endpoint_instance[i].tx_packetSize = init_wMaxPacketSize(i);
 705
 706                 endpoint_instance[i].tx_attributes =
 707                         ep_descriptor_ptrs[i - 1]->bmAttributes;
 708
 709                 urb_link_init (&endpoint_instance[i].rcv);
 710                 urb_link_init (&endpoint_instance[i].rdy);
 711                 urb_link_init (&endpoint_instance[i].tx);
 712                 urb_link_init (&endpoint_instance[i].done);
 713
 714                 if (endpoint_instance[i].endpoint_address & USB_DIR_IN)
 715                         endpoint_instance[i].tx_urb =
 716                                 usbd_alloc_urb (device_instance,
 717                                                 &endpoint_instance[i]);
 718                 else
 719                         endpoint_instance[i].rcv_urb =
 720                                 usbd_alloc_urb (device_instance,
 721                                                 &endpoint_instance[i]);
 722         }
 723 }
 724
 725 static void usbtty_init_endpoints (void)
 726 {
 727         int i;
 728
 729         bus_instance->max_endpoints = NUM_ENDPOINTS + 1;
 730         for (i = 1; i <= NUM_ENDPOINTS; i++) {
 731                 udc_setup_ep (device_instance, i, &endpoint_instance[i]);
 732         }
 733 }
 734
 735 /* usbtty_init_terminal_type
 736  *
 737  * Do some late binding for our device type.
 738  */
 739 static void usbtty_init_terminal_type(short type)
 740 {
 741         switch(type){
 742                 /* CDC ACM */
 743                 case 0:
 744                         /* Assign endpoint descriptors */
 745                         ep_descriptor_ptrs[0] =
 746                                 &acm_configuration_descriptors[0].notification_endpoint;
 747                         ep_descriptor_ptrs[1] =
 748                                 &acm_configuration_descriptors[0].data_endpoints[0];
 749                         ep_descriptor_ptrs[2] =
 750                                 &acm_configuration_descriptors[0].data_endpoints[1];
 751
 752                         /* Enumerate Device Descriptor */
 753                         device_descriptor.bDeviceClass =
 754                                 COMMUNICATIONS_DEVICE_CLASS;
 755                         device_descriptor.idProduct =
 756                                 cpu_to_le16(CONFIG_USBD_PRODUCTID_CDCACM);
 757
 758 #if defined(CONFIG_USBD_HS)
 759                         qualifier_descriptor.bDeviceClass =
 760                                 COMMUNICATIONS_DEVICE_CLASS;
 761 #endif
 762                         /* Assign endpoint indices */
 763                         tx_endpoint = ACM_TX_ENDPOINT;
 764                         rx_endpoint = ACM_RX_ENDPOINT;
 765
 766                         /* Configuration Descriptor */
 767                         configuration_descriptor =
 768                                 (struct usb_configuration_descriptor*)
 769                                 &acm_configuration_descriptors;
 770
 771                         /* Interface count */
 772                         interface_count = NUM_ACM_INTERFACES;
 773                 break;
 774
 775                 /* BULK IN/OUT & Default */
 776                 case 1:
 777                 default:
 778                         /* Assign endpoint descriptors */
 779                         ep_descriptor_ptrs[0] =
 780                                 &gserial_configuration_descriptors[0].data_endpoints[0];
 781                         ep_descriptor_ptrs[1] =
 782                                 &gserial_configuration_descriptors[0].data_endpoints[1];
 783                         ep_descriptor_ptrs[2] =
 784                                 &gserial_configuration_descriptors[0].data_endpoints[2];
 785
 786                         /* Enumerate Device Descriptor */
 787                         device_descriptor.bDeviceClass = 0xFF;
 788                         device_descriptor.idProduct =
 789                                 cpu_to_le16(CONFIG_USBD_PRODUCTID_GSERIAL);
 790 #if defined(CONFIG_USBD_HS)
 791                         qualifier_descriptor.bDeviceClass = 0xFF;
 792 #endif
 793                         /* Assign endpoint indices */
 794                         tx_endpoint = GSERIAL_TX_ENDPOINT;
 795                         rx_endpoint = GSERIAL_RX_ENDPOINT;
 796
 797                         /* Configuration Descriptor */
 798                         configuration_descriptor =
 799                                 (struct usb_configuration_descriptor*)
 800                                 &gserial_configuration_descriptors;
 801
 802                         /* Interface count */
 803                         interface_count = NUM_GSERIAL_INTERFACES;
 804                 break;
 805         }
 806 }
 807
 808 /******************************************************************************/
 809
 810 static struct urb *next_urb (struct usb_device_instance *device,
 811                              struct usb_endpoint_instance *endpoint)
 812 {
 813         struct urb *current_urb = NULL;
 814         int space;
 815
 816         /* If there's a queue, then we should add to the last urb */
 817         if (!endpoint->tx_queue) {
 818                 current_urb = endpoint->tx_urb;
 819         } else {
 820                 /* Last urb from tx chain */
 821                 current_urb =
 822                         p2surround (struct urb, link, endpoint->tx.prev);
 823         }
 824
 825         /* Make sure this one has enough room */
 826         space = current_urb->buffer_length - current_urb->actual_length;
 827         if (space > 0) {
 828                 return current_urb;
 829         } else {                /* No space here */
 830                 /* First look at done list */
 831                 current_urb = first_urb_detached (&endpoint->done);
 832                 if (!current_urb) {
 833                         current_urb = usbd_alloc_urb (device, endpoint);
 834                 }
 835
 836                 urb_append (&endpoint->tx, current_urb);
 837                 endpoint->tx_queue++;
 838         }
 839         return current_urb;
 840 }
 841
 842 static int write_buffer (circbuf_t * buf)
 843 {
 844         if (!usbtty_configured ()) {
 845                 return 0;
 846         }
 847
 848         struct usb_endpoint_instance *endpoint =
 849                         &endpoint_instance[tx_endpoint];
 850         struct urb *current_urb = NULL;
 851
 852         current_urb = next_urb (device_instance, endpoint);
 853
 854         if (!current_urb) {
 855                 TTYERR ("current_urb is NULL, buf->size %d\n",
 856                 buf->size);
 857                 return 0;
 858         }
 859
 860         /* TX data still exists - send it now
 861          */
 862         if(endpoint->sent < current_urb->actual_length){
 863                 if(udc_endpoint_write (endpoint)){
 864                         /* Write pre-empted by RX */
 865                         return -1;
 866                 }
 867         }
 868
 869         if (buf->size) {
 870                 char *dest;
 871
 872                 int space_avail;
 873                 int popnum, popped;
 874                 int total = 0;
 875
 876                 /* Break buffer into urb sized pieces,
 877                  * and link each to the endpoint
 878                  */
 879                 while (buf->size > 0) {
 880
 881                         dest = (char*)current_urb->buffer +
 882                                 current_urb->actual_length;
 883
 884                         space_avail =
 885                                 current_urb->buffer_length -
 886                                 current_urb->actual_length;
 887                         popnum = min(space_avail, (int)buf->size);
 888                         if (popnum == 0)
 889                                 break;
 890
 891                         popped = buf_pop (buf, dest, popnum);
 892                         if (popped == 0)
 893                                 break;
 894                         current_urb->actual_length += popped;
 895                         total += popped;
 896
 897                         /* If endpoint->last == 0, then transfers have
 898                          * not started on this endpoint
 899                          */
 900                         if (endpoint->last == 0) {
 901                                 if(udc_endpoint_write (endpoint)){
 902                                         /* Write pre-empted by RX */
 903                                         return -1;
 904                                 }
 905                         }
 906
 907                 }/* end while */
 908                 return total;
 909         }
 910
 911         return 0;
 912 }
 913
 914 static int fill_buffer (circbuf_t * buf)
 915 {
 916         struct usb_endpoint_instance *endpoint =
 917                 &endpoint_instance[rx_endpoint];
 918
 919         if (endpoint->rcv_urb && endpoint->rcv_urb->actual_length) {
 920                 unsigned int nb = 0;
 921                 char *src = (char *) endpoint->rcv_urb->buffer;
 922                 unsigned int rx_avail = buf->totalsize - buf->size;
 923
 924                 if(rx_avail >= endpoint->rcv_urb->actual_length){
 925
 926                         nb = endpoint->rcv_urb->actual_length;
 927                         buf_push (buf, src, nb);
 928                         endpoint->rcv_urb->actual_length = 0;
 929
 930                 }
 931                 return nb;
 932         }
 933         return 0;
 934 }
 935
 936 static int usbtty_configured (void)
 937 {
 938         return usbtty_configured_flag;
 939 }
 940
 941 /******************************************************************************/
 942
 943 static void usbtty_event_handler (struct usb_device_instance *device,
 944                                   usb_device_event_t event, int data)
 945 {
 946 #if defined(CONFIG_USBD_HS)
 947         int i;
 948 #endif
 949         switch (event) {
 950         case DEVICE_RESET:
 951         case DEVICE_BUS_INACTIVE:
 952                 usbtty_configured_flag = 0;
 953                 break;
 954         case DEVICE_CONFIGURED:
 955                 usbtty_configured_flag = 1;
 956                 break;
 957
 958         case DEVICE_ADDRESS_ASSIGNED:
 959 #if defined(CONFIG_USBD_HS)
 960                 /*
 961                  * is_usbd_high_speed routine needs to be defined by
 962                  * specific gadget driver
 963                  * It returns true if device enumerates at High speed
 964                  * Retuns false otherwise
 965                  */
 966                 for (i = 0; i < NUM_ENDPOINTS; i++) {
 967                         if (((ep_descriptor_ptrs[i]->bmAttributes &
 968                               USB_ENDPOINT_XFERTYPE_MASK) ==
 969                               USB_ENDPOINT_XFER_BULK)
 970                             && is_usbd_high_speed()) {
 971
 972                                 ep_descriptor_ptrs[i]->wMaxPacketSize =
 973                                         CONFIG_USBD_SERIAL_BULK_HS_PKTSIZE;
 974                         }
 975
 976                         endpoint_instance[i + 1].tx_packetSize =
 977                                 ep_descriptor_ptrs[i]->wMaxPacketSize;
 978                         endpoint_instance[i + 1].rcv_packetSize =
 979                                 ep_descriptor_ptrs[i]->wMaxPacketSize;
 980                 }
 981 #endif
 982                 usbtty_init_endpoints ();
 983
 984         default:
 985                 break;
 986         }
 987 }
 988
 989 /******************************************************************************/
 990
 991 int usbtty_cdc_setup(struct usb_device_request *request, struct urb *urb)
 992 {
 993         switch (request->bRequest){
 994
 995                 case ACM_SET_CONTROL_LINE_STATE:        /* Implies DTE ready */
 996                         break;
 997                 case ACM_SEND_ENCAPSULATED_COMMAND :    /* Required */
 998                         break;
 999                 case ACM_SET_LINE_ENCODING :            /* DTE stop/parity bits
1000                                                          * per character */
1001                         break;
1002                 case ACM_GET_ENCAPSULATED_RESPONSE :    /* request response */
1003                         break;
1004                 case ACM_GET_LINE_ENCODING :            /* request DTE rate,
1005                                                          * stop/parity bits */
1006                         memcpy (urb->buffer , &rs232_desc, sizeof(rs232_desc));
1007                         urb->actual_length = sizeof(rs232_desc);
1008
1009                         break;
1010                 default:
1011                         return 1;
1012         }
1013         return 0;
1014 }
1015
1016 /******************************************************************************/
1017
1018 /*
1019  * Since interrupt handling has not yet been implemented, we use this function
1020  * to handle polling.  This is called by the tstc,getc,putc,puts routines to
1021  * update the USB state.
1022  */
1023 void usbtty_poll (void)
1024 {
1025         /* New interrupts? */
1026         udc_irq();
1027
1028         /* Write any output data to host buffer
1029          * (do this before checking interrupts to avoid missing one)
1030          */
1031         if (usbtty_configured ()) {
1032                 write_buffer (&usbtty_output);
1033         }
1034
1035         /* New interrupts? */
1036         udc_irq();
1037
1038         /* Check for new data from host..
1039          * (do this after checking interrupts to get latest data)
1040          */
1041         if (usbtty_configured ()) {
1042                 fill_buffer (&usbtty_input);
1043         }
1044
1045         /* New interrupts? */
1046         udc_irq();
1047
1048 }