1
2
3
4
5
6
7
8
9
10#include <common.h>
11#include <config.h>
12#include <circbuf.h>
13#include <env.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
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
52
53#define USBTTY_BUFFER_SIZE 2048
54static circbuf_t usbtty_input;
55static circbuf_t usbtty_output;
56
57
58
59
60
61static struct stdio_dev usbttydev;
62static struct usb_device_instance device_instance[1];
63static struct usb_bus_instance bus_instance[1];
64static struct usb_configuration_instance config_instance[NUM_CONFIGS];
65static struct usb_interface_instance interface_instance[MAX_INTERFACES];
66static struct usb_alternate_instance alternate_instance[MAX_INTERFACES];
67
68static struct usb_endpoint_instance endpoint_instance[NUM_ENDPOINTS+1];
69
70
71
72
73int usbtty_configured_flag = 0;
74
75
76
77
78static char serial_number[16];
79
80
81
82
83
84
85
86extern struct usb_string_descriptor **usb_strings;
87
88
89static unsigned short rx_endpoint = 0;
90static unsigned short tx_endpoint = 0;
91static unsigned short interface_count = 0;
92static struct usb_string_descriptor *usbtty_string_table[STR_COUNT];
93
94
95static u8 wstrLang[4] = {4,USB_DT_STRING,0x9,0x4};
96static u8 wstrManufacturer[2 + 2*(sizeof(CONFIG_USBD_MANUFACTURER)-1)];
97static u8 wstrProduct[2 + 2*(sizeof(CONFIG_USBD_PRODUCT_NAME)-1)];
98static u8 wstrSerial[2 + 2*(sizeof(serial_number) - 1)];
99static u8 wstrConfiguration[2 + 2*(sizeof(CONFIG_USBD_CONFIGURATION_STR)-1)];
100static u8 wstrDataInterface[2 + 2*(sizeof(CONFIG_USBD_DATA_INTERFACE_STR)-1)];
101static u8 wstrCtrlInterface[2 + 2*(sizeof(CONFIG_USBD_DATA_INTERFACE_STR)-1)];
102
103
104static struct usb_interface_descriptor interface_descriptors[MAX_INTERFACES];
105static struct usb_endpoint_descriptor *ep_descriptor_ptrs[NUM_ENDPOINTS];
106static struct usb_configuration_descriptor *configuration_descriptor = 0;
107static 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)
124static 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
138
139
140struct acm_config_desc {
141 struct usb_configuration_descriptor configuration_desc;
142
143
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
153 struct usb_interface_descriptor data_class_interface;
154 struct usb_endpoint_descriptor data_endpoints[NUM_ENDPOINTS-1];
155} __attribute__((packed));
156
157static 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
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
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
267static struct rs232_emu rs232_desc={
268 .dter = 115200,
269 .stop_bits = 0x00,
270 .parity = 0x00,
271 .data_bits = 0x08
272};
273
274
275
276
277
278
279
280struct 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
288static struct gserial_config_desc
289gserial_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
357
358
359static void usbtty_init_strings (void);
360static void usbtty_init_instances (void);
361static void usbtty_init_endpoints (void);
362static void usbtty_init_terminal_type(short type);
363static void usbtty_event_handler (struct usb_device_instance *device,
364 usb_device_event_t event, int data);
365static int usbtty_cdc_setup(struct usb_device_request *request,
366 struct urb *urb);
367static int usbtty_configured (void);
368static int write_buffer (circbuf_t * buf);
369static int fill_buffer (circbuf_t * buf);
370
371void usbtty_poll (void);
372
373
374static 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
390
391
392int usbtty_tstc(struct stdio_dev *dev)
393{
394 struct usb_endpoint_instance *endpoint =
395 &endpoint_instance[rx_endpoint];
396
397
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
408
409
410
411
412int 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
431
432void usbtty_putc(struct stdio_dev *dev, const char c)
433{
434 if (!usbtty_configured ())
435 return;
436
437
438 if (c == '\n')
439 buf_push (&usbtty_output, "\r", 1);
440
441 buf_push(&usbtty_output, &c, 1);
442
443
444 if ((usbtty_output.size + 2) >= usbtty_output.totalsize) {
445 usbtty_poll ();
446 }
447}
448
449
450static 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
463
464
465static void __usbtty_puts (const char *str, int len)
466{
467 int maxlen = usbtty_output.totalsize;
468 int space, n;
469
470
471 while (len > 0) {
472 usbtty_poll ();
473
474 space = maxlen - usbtty_output.size;
475
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
488void 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
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
508 __usbtty_puts (str, n);
509 break;
510 }
511 }
512
513
514 usbtty_poll ();
515}
516
517
518
519
520
521int drv_usbtty_init (void)
522{
523 int rc;
524 char * sn;
525 char * tt;
526 int snlen;
527
528
529 sn = env_get("serial#");
530 if (!sn)
531 sn = "000000000000";
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
542
543 tt = env_get("usbtty");
544 if (!tt)
545 tt = "generic";
546 usbtty_init_terminal_type(strcmp(tt,"cdc_acm"));
547
548
549 buf_init (&usbtty_input, USBTTY_BUFFER_SIZE);
550 buf_init (&usbtty_output, USBTTY_BUFFER_SIZE);
551
552
553 udc_init ();
554
555 usbtty_init_strings ();
556 usbtty_init_instances ();
557
558 usbtty_init_endpoints ();
559
560 udc_startup_events (device_instance);
561 udc_connect ();
562
563
564 memset (&usbttydev, 0, sizeof (usbttydev));
565
566 strcpy (usbttydev.name, "usbtty");
567 usbttydev.ext = 0;
568 usbttydev.flags = DEV_FLAGS_INPUT | DEV_FLAGS_OUTPUT;
569 usbttydev.tstc = usbtty_tstc;
570 usbttydev.getc = usbtty_getc;
571 usbttydev.putc = usbtty_putc;
572 usbttydev.puts = usbtty_puts;
573
574 rc = stdio_register (&usbttydev);
575
576 return (rc == 0) ? 1 : rc;
577}
578
579static void usbtty_init_strings (void)
580{
581 struct usb_string_descriptor *string;
582
583 usbtty_string_table[STR_LANG] =
584 (struct usb_string_descriptor*)wstrLang;
585
586 string = (struct usb_string_descriptor *) wstrManufacturer;
587 string->bLength = sizeof(wstrManufacturer);
588 string->bDescriptorType = USB_DT_STRING;
589 str2wide (CONFIG_USBD_MANUFACTURER, string->wData);
590 usbtty_string_table[STR_MANUFACTURER]=string;
591
592
593 string = (struct usb_string_descriptor *) wstrProduct;
594 string->bLength = sizeof(wstrProduct);
595 string->bDescriptorType = USB_DT_STRING;
596 str2wide (CONFIG_USBD_PRODUCT_NAME, string->wData);
597 usbtty_string_table[STR_PRODUCT]=string;
598
599
600 string = (struct usb_string_descriptor *) wstrSerial;
601 string->bLength = sizeof(serial_number);
602 string->bDescriptorType = USB_DT_STRING;
603 str2wide (serial_number, string->wData);
604 usbtty_string_table[STR_SERIAL]=string;
605
606
607 string = (struct usb_string_descriptor *) wstrConfiguration;
608 string->bLength = sizeof(wstrConfiguration);
609 string->bDescriptorType = USB_DT_STRING;
610 str2wide (CONFIG_USBD_CONFIGURATION_STR, string->wData);
611 usbtty_string_table[STR_CONFIG]=string;
612
613
614 string = (struct usb_string_descriptor *) wstrDataInterface;
615 string->bLength = sizeof(wstrDataInterface);
616 string->bDescriptorType = USB_DT_STRING;
617 str2wide (CONFIG_USBD_DATA_INTERFACE_STR, string->wData);
618 usbtty_string_table[STR_DATA_INTERFACE]=string;
619
620 string = (struct usb_string_descriptor *) wstrCtrlInterface;
621 string->bLength = sizeof(wstrCtrlInterface);
622 string->bDescriptorType = USB_DT_STRING;
623 str2wide (CONFIG_USBD_CTRL_INTERFACE_STR, string->wData);
624 usbtty_string_table[STR_CTRL_INTERFACE]=string;
625
626
627 usb_strings = usbtty_string_table;
628}
629
630#define init_wMaxPacketSize(x) le16_to_cpu(get_unaligned(\
631 &ep_descriptor_ptrs[(x) - 1]->wMaxPacketSize));
632
633static void usbtty_init_instances (void)
634{
635 int i;
636
637
638 memset (device_instance, 0, sizeof (struct usb_device_instance));
639 device_instance->device_state = STATE_INIT;
640 device_instance->device_descriptor = &device_descriptor;
641#if defined(CONFIG_USBD_HS)
642 device_instance->qualifier_descriptor = &qualifier_descriptor;
643#endif
644 device_instance->event = usbtty_event_handler;
645 device_instance->cdc_recv_setup = usbtty_cdc_setup;
646 device_instance->bus = bus_instance;
647 device_instance->configurations = NUM_CONFIGS;
648 device_instance->configuration_instance_array = config_instance;
649
650
651 memset (bus_instance, 0, sizeof (struct usb_bus_instance));
652 bus_instance->device = device_instance;
653 bus_instance->endpoint_array = endpoint_instance;
654 bus_instance->max_endpoints = 1;
655 bus_instance->maxpacketsize = 64;
656 bus_instance->serial_number_str = serial_number;
657
658
659 memset (config_instance, 0,
660 sizeof (struct usb_configuration_instance));
661 config_instance->interfaces = interface_count;
662 config_instance->configuration_descriptor = configuration_descriptor;
663 config_instance->interface_instance_array = interface_instance;
664
665
666 memset (interface_instance, 0,
667 sizeof (struct usb_interface_instance));
668 interface_instance->alternates = 1;
669 interface_instance->alternates_instance_array = alternate_instance;
670
671
672 memset (alternate_instance, 0,
673 sizeof (struct usb_alternate_instance));
674 alternate_instance->interface_descriptor = interface_descriptors;
675 alternate_instance->endpoints = NUM_ENDPOINTS;
676 alternate_instance->endpoints_descriptor_array = ep_descriptor_ptrs;
677
678
679 memset (&endpoint_instance[0], 0,
680 sizeof (struct usb_endpoint_instance));
681 endpoint_instance[0].endpoint_address = 0;
682 endpoint_instance[0].rcv_packetSize = EP0_MAX_PACKET_SIZE;
683 endpoint_instance[0].rcv_attributes = USB_ENDPOINT_XFER_CONTROL;
684 endpoint_instance[0].tx_packetSize = EP0_MAX_PACKET_SIZE;
685 endpoint_instance[0].tx_attributes = USB_ENDPOINT_XFER_CONTROL;
686 udc_setup_ep (device_instance, 0, &endpoint_instance[0]);
687
688 for (i = 1; i <= NUM_ENDPOINTS; i++) {
689 memset (&endpoint_instance[i], 0,
690 sizeof (struct usb_endpoint_instance));
691
692 endpoint_instance[i].endpoint_address =
693 ep_descriptor_ptrs[i - 1]->bEndpointAddress;
694
695 endpoint_instance[i].rcv_attributes =
696 ep_descriptor_ptrs[i - 1]->bmAttributes;
697
698 endpoint_instance[i].rcv_packetSize = init_wMaxPacketSize(i);
699
700 endpoint_instance[i].tx_attributes =
701 ep_descriptor_ptrs[i - 1]->bmAttributes;
702
703 endpoint_instance[i].tx_packetSize = init_wMaxPacketSize(i);
704
705 endpoint_instance[i].tx_attributes =
706 ep_descriptor_ptrs[i - 1]->bmAttributes;
707
708 urb_link_init (&endpoint_instance[i].rcv);
709 urb_link_init (&endpoint_instance[i].rdy);
710 urb_link_init (&endpoint_instance[i].tx);
711 urb_link_init (&endpoint_instance[i].done);
712
713 if (endpoint_instance[i].endpoint_address & USB_DIR_IN)
714 endpoint_instance[i].tx_urb =
715 usbd_alloc_urb (device_instance,
716 &endpoint_instance[i]);
717 else
718 endpoint_instance[i].rcv_urb =
719 usbd_alloc_urb (device_instance,
720 &endpoint_instance[i]);
721 }
722}
723
724static void usbtty_init_endpoints (void)
725{
726 int i;
727
728 bus_instance->max_endpoints = NUM_ENDPOINTS + 1;
729 for (i = 1; i <= NUM_ENDPOINTS; i++) {
730 udc_setup_ep (device_instance, i, &endpoint_instance[i]);
731 }
732}
733
734
735
736
737
738static void usbtty_init_terminal_type(short type)
739{
740 switch(type){
741
742 case 0:
743
744 ep_descriptor_ptrs[0] =
745 &acm_configuration_descriptors[0].notification_endpoint;
746 ep_descriptor_ptrs[1] =
747 &acm_configuration_descriptors[0].data_endpoints[0];
748 ep_descriptor_ptrs[2] =
749 &acm_configuration_descriptors[0].data_endpoints[1];
750
751
752 device_descriptor.bDeviceClass =
753 COMMUNICATIONS_DEVICE_CLASS;
754 device_descriptor.idProduct =
755 cpu_to_le16(CONFIG_USBD_PRODUCTID_CDCACM);
756
757#if defined(CONFIG_USBD_HS)
758 qualifier_descriptor.bDeviceClass =
759 COMMUNICATIONS_DEVICE_CLASS;
760#endif
761
762 tx_endpoint = ACM_TX_ENDPOINT;
763 rx_endpoint = ACM_RX_ENDPOINT;
764
765
766 configuration_descriptor =
767 (struct usb_configuration_descriptor*)
768 &acm_configuration_descriptors;
769
770
771 interface_count = NUM_ACM_INTERFACES;
772 break;
773
774
775 case 1:
776 default:
777
778 ep_descriptor_ptrs[0] =
779 &gserial_configuration_descriptors[0].data_endpoints[0];
780 ep_descriptor_ptrs[1] =
781 &gserial_configuration_descriptors[0].data_endpoints[1];
782 ep_descriptor_ptrs[2] =
783 &gserial_configuration_descriptors[0].data_endpoints[2];
784
785
786 device_descriptor.bDeviceClass = 0xFF;
787 device_descriptor.idProduct =
788 cpu_to_le16(CONFIG_USBD_PRODUCTID_GSERIAL);
789#if defined(CONFIG_USBD_HS)
790 qualifier_descriptor.bDeviceClass = 0xFF;
791#endif
792
793 tx_endpoint = GSERIAL_TX_ENDPOINT;
794 rx_endpoint = GSERIAL_RX_ENDPOINT;
795
796
797 configuration_descriptor =
798 (struct usb_configuration_descriptor*)
799 &gserial_configuration_descriptors;
800
801
802 interface_count = NUM_GSERIAL_INTERFACES;
803 break;
804 }
805}
806
807
808
809static struct urb *next_urb (struct usb_device_instance *device,
810 struct usb_endpoint_instance *endpoint)
811{
812 struct urb *current_urb = NULL;
813 int space;
814
815
816 if (!endpoint->tx_queue) {
817 current_urb = endpoint->tx_urb;
818 } else {
819
820 current_urb =
821 p2surround (struct urb, link, endpoint->tx.prev);
822 }
823
824
825 space = current_urb->buffer_length - current_urb->actual_length;
826 if (space > 0) {
827 return current_urb;
828 } else {
829
830 current_urb = first_urb_detached (&endpoint->done);
831 if (!current_urb) {
832 current_urb = usbd_alloc_urb (device, endpoint);
833 }
834
835 urb_append (&endpoint->tx, current_urb);
836 endpoint->tx_queue++;
837 }
838 return current_urb;
839}
840
841static int write_buffer (circbuf_t * buf)
842{
843 if (!usbtty_configured ()) {
844 return 0;
845 }
846
847 struct usb_endpoint_instance *endpoint =
848 &endpoint_instance[tx_endpoint];
849 struct urb *current_urb = NULL;
850
851 current_urb = next_urb (device_instance, endpoint);
852
853 if (!current_urb) {
854 TTYERR ("current_urb is NULL, buf->size %d\n",
855 buf->size);
856 return 0;
857 }
858
859
860
861 if(endpoint->sent < current_urb->actual_length){
862 if(udc_endpoint_write (endpoint)){
863
864 return -1;
865 }
866 }
867
868 if (buf->size) {
869 char *dest;
870
871 int space_avail;
872 int popnum, popped;
873 int total = 0;
874
875
876
877
878 while (buf->size > 0) {
879
880 dest = (char*)current_urb->buffer +
881 current_urb->actual_length;
882
883 space_avail =
884 current_urb->buffer_length -
885 current_urb->actual_length;
886 popnum = min(space_avail, (int)buf->size);
887 if (popnum == 0)
888 break;
889
890 popped = buf_pop (buf, dest, popnum);
891 if (popped == 0)
892 break;
893 current_urb->actual_length += popped;
894 total += popped;
895
896
897
898
899 if (endpoint->last == 0) {
900 if(udc_endpoint_write (endpoint)){
901
902 return -1;
903 }
904 }
905
906 }
907 return total;
908 }
909
910 return 0;
911}
912
913static int fill_buffer (circbuf_t * buf)
914{
915 struct usb_endpoint_instance *endpoint =
916 &endpoint_instance[rx_endpoint];
917
918 if (endpoint->rcv_urb && endpoint->rcv_urb->actual_length) {
919 unsigned int nb = 0;
920 char *src = (char *) endpoint->rcv_urb->buffer;
921 unsigned int rx_avail = buf->totalsize - buf->size;
922
923 if(rx_avail >= endpoint->rcv_urb->actual_length){
924
925 nb = endpoint->rcv_urb->actual_length;
926 buf_push (buf, src, nb);
927 endpoint->rcv_urb->actual_length = 0;
928
929 }
930 return nb;
931 }
932 return 0;
933}
934
935static int usbtty_configured (void)
936{
937 return usbtty_configured_flag;
938}
939
940
941
942static void usbtty_event_handler (struct usb_device_instance *device,
943 usb_device_event_t event, int data)
944{
945#if defined(CONFIG_USBD_HS)
946 int i;
947#endif
948 switch (event) {
949 case DEVICE_RESET:
950 case DEVICE_BUS_INACTIVE:
951 usbtty_configured_flag = 0;
952 break;
953 case DEVICE_CONFIGURED:
954 usbtty_configured_flag = 1;
955 break;
956
957 case DEVICE_ADDRESS_ASSIGNED:
958#if defined(CONFIG_USBD_HS)
959
960
961
962
963
964
965 for (i = 0; i < NUM_ENDPOINTS; i++) {
966 if (((ep_descriptor_ptrs[i]->bmAttributes &
967 USB_ENDPOINT_XFERTYPE_MASK) ==
968 USB_ENDPOINT_XFER_BULK)
969 && is_usbd_high_speed()) {
970
971 ep_descriptor_ptrs[i]->wMaxPacketSize =
972 CONFIG_USBD_SERIAL_BULK_HS_PKTSIZE;
973 }
974
975 endpoint_instance[i + 1].tx_packetSize =
976 ep_descriptor_ptrs[i]->wMaxPacketSize;
977 endpoint_instance[i + 1].rcv_packetSize =
978 ep_descriptor_ptrs[i]->wMaxPacketSize;
979 }
980#endif
981 usbtty_init_endpoints ();
982
983 default:
984 break;
985 }
986}
987
988
989
990int usbtty_cdc_setup(struct usb_device_request *request, struct urb *urb)
991{
992 switch (request->bRequest){
993
994 case ACM_SET_CONTROL_LINE_STATE:
995 break;
996 case ACM_SEND_ENCAPSULATED_COMMAND :
997 break;
998 case ACM_SET_LINE_ENCODING :
999
1000 break;
1001 case ACM_GET_ENCAPSULATED_RESPONSE :
1002 break;
1003 case ACM_GET_LINE_ENCODING :
1004
1005 memcpy (urb->buffer , &rs232_desc, sizeof(rs232_desc));
1006 urb->actual_length = sizeof(rs232_desc);
1007
1008 break;
1009 default:
1010 return 1;
1011 }
1012 return 0;
1013}
1014
1015
1016
1017
1018
1019
1020
1021
1022void usbtty_poll (void)
1023{
1024
1025 udc_irq();
1026
1027
1028
1029
1030 if (usbtty_configured ()) {
1031 write_buffer (&usbtty_output);
1032 }
1033
1034
1035 udc_irq();
1036
1037
1038
1039
1040 if (usbtty_configured ()) {
1041 fill_buffer (&usbtty_input);
1042 }
1043
1044
1045 udc_irq();
1046
1047}
1048
