| /* |
| * (C) Copyright 2003 |
| * Gerry Hamel, geh@ti.com, Texas Instruments |
| * |
| * (C) Copyright 2006 |
| * Bryan O'Donoghue, bodonoghue@codehermit.ie |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| * |
| */ |
| |
| #include <common.h> |
| |
| #ifdef CONFIG_USB_TTY |
| |
| #include <circbuf.h> |
| #include <devices.h> |
| #include "usbtty.h" |
| #include "usb_cdc_acm.h" |
| #include "usbdescriptors.h" |
| #include <config.h> /* If defined, override Linux identifiers with |
| * vendor specific ones */ |
| |
| #if 0 |
| #define TTYDBG(fmt,args...)\ |
| serial_printf("[%s] %s %d: "fmt, __FILE__,__FUNCTION__,__LINE__,##args) |
| #else |
| #define TTYDBG(fmt,args...) do{}while(0) |
| #endif |
| |
| #if 1 |
| #define TTYERR(fmt,args...)\ |
| serial_printf("ERROR![%s] %s %d: "fmt, __FILE__,__FUNCTION__,\ |
| __LINE__,##args) |
| #else |
| #define TTYERR(fmt,args...) do{}while(0) |
| #endif |
| |
| /* |
| * Defines |
| */ |
| #define NUM_CONFIGS 1 |
| #define MAX_INTERFACES 2 |
| #define NUM_ENDPOINTS 3 |
| #define ACM_TX_ENDPOINT 3 |
| #define ACM_RX_ENDPOINT 2 |
| #define GSERIAL_TX_ENDPOINT 2 |
| #define GSERIAL_RX_ENDPOINT 1 |
| #define NUM_ACM_INTERFACES 2 |
| #define NUM_GSERIAL_INTERFACES 1 |
| #define CONFIG_USBD_DATA_INTERFACE_STR "Bulk Data Interface" |
| #define CONFIG_USBD_CTRL_INTERFACE_STR "Control Interface" |
| |
| /* |
| * Buffers to hold input and output data |
| */ |
| #define USBTTY_BUFFER_SIZE 256 |
| static circbuf_t usbtty_input; |
| static circbuf_t usbtty_output; |
| |
| |
| /* |
| * Instance variables |
| */ |
| static device_t usbttydev; |
| static struct usb_device_instance device_instance[1]; |
| static struct usb_bus_instance bus_instance[1]; |
| static struct usb_configuration_instance config_instance[NUM_CONFIGS]; |
| static struct usb_interface_instance interface_instance[MAX_INTERFACES]; |
| static struct usb_alternate_instance alternate_instance[MAX_INTERFACES]; |
| /* one extra for control endpoint */ |
| static struct usb_endpoint_instance endpoint_instance[NUM_ENDPOINTS+1]; |
| |
| /* |
| * Global flag |
| */ |
| int usbtty_configured_flag = 0; |
| |
| /* |
| * Serial number |
| */ |
| static char serial_number[16]; |
| |
| |
| /* |
| * Descriptors, Strings, Local variables. |
| */ |
| |
| /* defined and used by usbdcore_ep0.c */ |
| extern struct usb_string_descriptor **usb_strings; |
| |
| /* Indicies, References */ |
| static unsigned short rx_endpoint = 0; |
| static unsigned short tx_endpoint = 0; |
| static unsigned short interface_count = 0; |
| static struct usb_string_descriptor *usbtty_string_table[STR_COUNT]; |
| |
| /* USB Descriptor Strings */ |
| static u8 wstrLang[4] = {4,USB_DT_STRING,0x9,0x4}; |
| static u8 wstrManufacturer[2 + 2*(sizeof(CONFIG_USBD_MANUFACTURER)-1)]; |
| static u8 wstrProduct[2 + 2*(sizeof(CONFIG_USBD_PRODUCT_NAME)-1)]; |
| static u8 wstrSerial[2 + 2*(sizeof(serial_number) - 1)]; |
| static u8 wstrConfiguration[2 + 2*(sizeof(CONFIG_USBD_CONFIGURATION_STR)-1)]; |
| static u8 wstrDataInterface[2 + 2*(sizeof(CONFIG_USBD_DATA_INTERFACE_STR)-1)]; |
| static u8 wstrCtrlInterface[2 + 2*(sizeof(CONFIG_USBD_DATA_INTERFACE_STR)-1)]; |
| |
| /* Standard USB Data Structures */ |
| static struct usb_interface_descriptor interface_descriptors[MAX_INTERFACES]; |
| static struct usb_endpoint_descriptor *ep_descriptor_ptrs[NUM_ENDPOINTS]; |
| static struct usb_configuration_descriptor *configuration_descriptor = 0; |
| static struct usb_device_descriptor device_descriptor = { |
| .bLength = sizeof(struct usb_device_descriptor), |
| .bDescriptorType = USB_DT_DEVICE, |
| .bcdUSB = cpu_to_le16(USB_BCD_VERSION), |
| .bDeviceSubClass = 0x00, |
| .bDeviceProtocol = 0x00, |
| .bMaxPacketSize0 = EP0_MAX_PACKET_SIZE, |
| .idVendor = cpu_to_le16(CONFIG_USBD_VENDORID), |
| .bcdDevice = cpu_to_le16(USBTTY_BCD_DEVICE), |
| .iManufacturer = STR_MANUFACTURER, |
| .iProduct = STR_PRODUCT, |
| .iSerialNumber = STR_SERIAL, |
| .bNumConfigurations = NUM_CONFIGS |
| }; |
| |
| |
| /* |
| * Static CDC ACM specific descriptors |
| */ |
| |
| struct acm_config_desc { |
| struct usb_configuration_descriptor configuration_desc; |
| |
| /* Master Interface */ |
| struct usb_interface_descriptor interface_desc; |
| |
| struct usb_class_header_function_descriptor usb_class_header; |
| struct usb_class_call_management_descriptor usb_class_call_mgt; |
| struct usb_class_abstract_control_descriptor usb_class_acm; |
| struct usb_class_union_function_descriptor usb_class_union; |
| struct usb_endpoint_descriptor notification_endpoint; |
| |
| /* Slave Interface */ |
| struct usb_interface_descriptor data_class_interface; |
| struct usb_endpoint_descriptor |
| data_endpoints[NUM_ENDPOINTS-1] __attribute__((packed)); |
| } __attribute__((packed)); |
| |
| static struct acm_config_desc acm_configuration_descriptors[NUM_CONFIGS] = { |
| { |
| .configuration_desc ={ |
| .bLength = |
| sizeof(struct usb_configuration_descriptor), |
| .bDescriptorType = USB_DT_CONFIG, |
| .wTotalLength = |
| cpu_to_le16(sizeof(struct acm_config_desc)), |
| .bNumInterfaces = NUM_ACM_INTERFACES, |
| .bConfigurationValue = 1, |
| .iConfiguration = STR_CONFIG, |
| .bmAttributes = |
| BMATTRIBUTE_SELF_POWERED|BMATTRIBUTE_RESERVED, |
| .bMaxPower = USBTTY_MAXPOWER |
| }, |
| /* Interface 1 */ |
| .interface_desc = { |
| .bLength = sizeof(struct usb_interface_descriptor), |
| .bDescriptorType = USB_DT_INTERFACE, |
| .bInterfaceNumber = 0, |
| .bAlternateSetting = 0, |
| .bNumEndpoints = 0x01, |
| .bInterfaceClass = |
| COMMUNICATIONS_INTERFACE_CLASS_CONTROL, |
| .bInterfaceSubClass = COMMUNICATIONS_ACM_SUBCLASS, |
| .bInterfaceProtocol = COMMUNICATIONS_V25TER_PROTOCOL, |
| .iInterface = STR_CTRL_INTERFACE, |
| }, |
| .usb_class_header = { |
| .bFunctionLength = |
| sizeof(struct usb_class_header_function_descriptor), |
| .bDescriptorType = CS_INTERFACE, |
| .bDescriptorSubtype = USB_ST_HEADER, |
| .bcdCDC = cpu_to_le16(110), |
| }, |
| .usb_class_call_mgt = { |
| .bFunctionLength = |
| sizeof(struct usb_class_call_management_descriptor), |
| .bDescriptorType = CS_INTERFACE, |
| .bDescriptorSubtype = USB_ST_CMF, |
| .bmCapabilities = 0x00, |
| .bDataInterface = 0x01, |
| }, |
| .usb_class_acm = { |
| .bFunctionLength = |
| sizeof(struct usb_class_abstract_control_descriptor), |
| .bDescriptorType = CS_INTERFACE, |
| .bDescriptorSubtype = USB_ST_ACMF, |
| .bmCapabilities = 0x00, |
| }, |
| .usb_class_union = { |
| .bFunctionLength = |
| sizeof(struct usb_class_union_function_descriptor), |
| .bDescriptorType = CS_INTERFACE, |
| .bDescriptorSubtype = USB_ST_UF, |
| .bMasterInterface = 0x00, |
| .bSlaveInterface0 = 0x01, |
| }, |
| .notification_endpoint = { |
| .bLength = |
| sizeof(struct usb_endpoint_descriptor), |
| .bDescriptorType = USB_DT_ENDPOINT, |
| .bEndpointAddress = 0x01 | USB_DIR_IN, |
| .bmAttributes = USB_ENDPOINT_XFER_INT, |
| .wMaxPacketSize |
| = cpu_to_le16(CONFIG_USBD_SERIAL_INT_PKTSIZE), |
| .bInterval = 0xFF, |
| }, |
| |
| /* Interface 2 */ |
| .data_class_interface = { |
| .bLength = |
| sizeof(struct usb_interface_descriptor), |
| .bDescriptorType = USB_DT_INTERFACE, |
| .bInterfaceNumber = 0x01, |
| .bAlternateSetting = 0x00, |
| .bNumEndpoints = 0x02, |
| .bInterfaceClass = |
| COMMUNICATIONS_INTERFACE_CLASS_DATA, |
| .bInterfaceSubClass = DATA_INTERFACE_SUBCLASS_NONE, |
| .bInterfaceProtocol = DATA_INTERFACE_PROTOCOL_NONE, |
| .iInterface = STR_DATA_INTERFACE, |
| }, |
| .data_endpoints = { |
| { |
| .bLength = |
| sizeof(struct usb_endpoint_descriptor), |
| .bDescriptorType = USB_DT_ENDPOINT, |
| .bEndpointAddress = 0x02 | USB_DIR_OUT, |
| .bmAttributes = |
| USB_ENDPOINT_XFER_BULK, |
| .wMaxPacketSize = |
| cpu_to_le16(CONFIG_USBD_SERIAL_BULK_PKTSIZE), |
| .bInterval = 0xFF, |
| }, |
| { |
| .bLength = |
| sizeof(struct usb_endpoint_descriptor), |
| .bDescriptorType = USB_DT_ENDPOINT, |
| .bEndpointAddress = 0x03 | USB_DIR_IN, |
| .bmAttributes = |
| USB_ENDPOINT_XFER_BULK, |
| .wMaxPacketSize = |
| cpu_to_le16(CONFIG_USBD_SERIAL_BULK_PKTSIZE), |
| .bInterval = 0xFF, |
| }, |
| }, |
| }, |
| }; |
| |
| static struct rs232_emu rs232_desc={ |
| .dter = 115200, |
| .stop_bits = 0x00, |
| .parity = 0x00, |
| .data_bits = 0x08 |
| }; |
| |
| |
| /* |
| * Static Generic Serial specific data |
| */ |
| |
| |
| struct gserial_config_desc { |
| |
| struct usb_configuration_descriptor configuration_desc; |
| struct usb_interface_descriptor |
| interface_desc[NUM_GSERIAL_INTERFACES] __attribute__((packed)); |
| struct usb_endpoint_descriptor |
| data_endpoints[NUM_ENDPOINTS] __attribute__((packed)); |
| |
| } __attribute__((packed)); |
| |
| static struct gserial_config_desc |
| gserial_configuration_descriptors[NUM_CONFIGS] ={ |
| { |
| .configuration_desc ={ |
| .bLength = sizeof(struct usb_configuration_descriptor), |
| .bDescriptorType = USB_DT_CONFIG, |
| .wTotalLength = |
| cpu_to_le16(sizeof(struct gserial_config_desc)), |
| .bNumInterfaces = NUM_GSERIAL_INTERFACES, |
| .bConfigurationValue = 1, |
| .iConfiguration = STR_CONFIG, |
| .bmAttributes = |
| BMATTRIBUTE_SELF_POWERED|BMATTRIBUTE_RESERVED, |
| .bMaxPower = USBTTY_MAXPOWER |
| }, |
| .interface_desc = { |
| { |
| .bLength = |
| sizeof(struct usb_interface_descriptor), |
| .bDescriptorType = USB_DT_INTERFACE, |
| .bInterfaceNumber = 0, |
| .bAlternateSetting = 0, |
| .bNumEndpoints = NUM_ENDPOINTS, |
| .bInterfaceClass = |
| COMMUNICATIONS_INTERFACE_CLASS_VENDOR, |
| .bInterfaceSubClass = |
| COMMUNICATIONS_NO_SUBCLASS, |
| .bInterfaceProtocol = |
| COMMUNICATIONS_NO_PROTOCOL, |
| .iInterface = STR_DATA_INTERFACE |
| }, |
| }, |
| .data_endpoints = { |
| { |
| .bLength = |
| sizeof(struct usb_endpoint_descriptor), |
| .bDescriptorType = USB_DT_ENDPOINT, |
| .bEndpointAddress = 0x01 | USB_DIR_OUT, |
| .bmAttributes = USB_ENDPOINT_XFER_BULK, |
| .wMaxPacketSize = |
| cpu_to_le16(CONFIG_USBD_SERIAL_OUT_PKTSIZE), |
| .bInterval= 0xFF, |
| }, |
| { |
| .bLength = |
| sizeof(struct usb_endpoint_descriptor), |
| .bDescriptorType = USB_DT_ENDPOINT, |
| .bEndpointAddress = 0x02 | USB_DIR_IN, |
| .bmAttributes = USB_ENDPOINT_XFER_BULK, |
| .wMaxPacketSize = |
| cpu_to_le16(CONFIG_USBD_SERIAL_IN_PKTSIZE), |
| .bInterval = 0xFF, |
| }, |
| { |
| .bLength = |
| sizeof(struct usb_endpoint_descriptor), |
| .bDescriptorType = USB_DT_ENDPOINT, |
| .bEndpointAddress = 0x03 | USB_DIR_IN, |
| .bmAttributes = USB_ENDPOINT_XFER_INT, |
| .wMaxPacketSize = |
| cpu_to_le16(CONFIG_USBD_SERIAL_INT_PKTSIZE), |
| .bInterval = 0xFF, |
| }, |
| }, |
| }, |
| }; |
| |
| /* |
| * Static Function Prototypes |
| */ |
| |
| static void usbtty_init_strings (void); |
| static void usbtty_init_instances (void); |
| static void usbtty_init_endpoints (void); |
| static void usbtty_init_terminal_type(short type); |
| static void usbtty_event_handler (struct usb_device_instance *device, |
| usb_device_event_t event, int data); |
| static int usbtty_cdc_setup(struct usb_device_request *request, |
| struct urb *urb); |
| static int usbtty_configured (void); |
| static int write_buffer (circbuf_t * buf); |
| static int fill_buffer (circbuf_t * buf); |
| |
| void usbtty_poll (void); |
| |
| /* utility function for converting char* to wide string used by USB */ |
| static void str2wide (char *str, u16 * wide) |
| { |
| int i; |
| for (i = 0; i < strlen (str) && str[i]; i++){ |
| #if defined(__LITTLE_ENDIAN__) |
| wide[i] = (u16) str[i]; |
| #elif defined(__BIG_ENDIAN__) |
| wide[i] = ((u16)(str[i])<<8); |
| #else |
| #error "__LITTLE_ENDIAN__ or __BIG_ENDIAN__ undefined" |
| #endif |
| } |
| } |
| |
| /* |
| * Test whether a character is in the RX buffer |
| */ |
| |
| int usbtty_tstc (void) |
| { |
| struct usb_endpoint_instance *endpoint = |
| &endpoint_instance[rx_endpoint]; |
| |
| /* If no input data exists, allow more RX to be accepted */ |
| if(usbtty_input.size <= 0){ |
| udc_unset_nak(endpoint->endpoint_address&0x03); |
| } |
| |
| usbtty_poll (); |
| return (usbtty_input.size > 0); |
| } |
| |
| /* |
| * Read a single byte from the usb client port. Returns 1 on success, 0 |
| * otherwise. When the function is succesfull, the character read is |
| * written into its argument c. |
| */ |
| |
| int usbtty_getc (void) |
| { |
| char c; |
| struct usb_endpoint_instance *endpoint = |
| &endpoint_instance[rx_endpoint]; |
| |
| while (usbtty_input.size <= 0) { |
| udc_unset_nak(endpoint->endpoint_address&0x03); |
| usbtty_poll (); |
| } |
| |
| buf_pop (&usbtty_input, &c, 1); |
| udc_set_nak(endpoint->endpoint_address&0x03); |
| |
| return c; |
| } |
| |
| /* |
| * Output a single byte to the usb client port. |
| */ |
| void usbtty_putc (const char c) |
| { |
| buf_push (&usbtty_output, &c, 1); |
| /* If \n, also do \r */ |
| if (c == '\n') |
| buf_push (&usbtty_output, "\r", 1); |
| |
| /* Poll at end to handle new data... */ |
| if ((usbtty_output.size + 2) >= usbtty_output.totalsize) { |
| usbtty_poll (); |
| } |
| } |
| |
| /* usbtty_puts() helper function for finding the next '\n' in a string */ |
| static int next_nl_pos (const char *s) |
| { |
| int i; |
| |
| for (i = 0; s[i] != '\0'; i++) { |
| if (s[i] == '\n') |
| return i; |
| } |
| return i; |
| } |
| |
| /* |
| * Output a string to the usb client port - implementing flow control |
| */ |
| |
| static void __usbtty_puts (const char *str, int len) |
| { |
| int maxlen = usbtty_output.totalsize; |
| int space, n; |
| |
| /* break str into chunks < buffer size, if needed */ |
| while (len > 0) { |
| usbtty_poll (); |
| |
| space = maxlen - usbtty_output.size; |
| /* Empty buffer here, if needed, to ensure space... */ |
| if (space) { |
| write_buffer (&usbtty_output); |
| |
| n = MIN (space, MIN (len, maxlen)); |
| buf_push (&usbtty_output, str, n); |
| |
| str += n; |
| len -= n; |
| } |
| } |
| } |
| |
| void usbtty_puts (const char *str) |
| { |
| int n; |
| int len = strlen (str); |
| |
| /* add '\r' for each '\n' */ |
| while (len > 0) { |
| n = next_nl_pos (str); |
| |
| if (str[n] == '\n') { |
| __usbtty_puts (str, n + 1); |
| __usbtty_puts ("\r", 1); |
| str += (n + 1); |
| len -= (n + 1); |
| } else { |
| /* No \n found. All done. */ |
| __usbtty_puts (str, n); |
| break; |
| } |
| } |
| |
| /* Poll at end to handle new data... */ |
| usbtty_poll (); |
| } |
| |
| /* |
| * Initialize the usb client port. |
| * |
| */ |
| int drv_usbtty_init (void) |
| { |
| int rc; |
| char * sn; |
| char * tt; |
| int snlen; |
| |
| /* Ger seiral number */ |
| if (!(sn = getenv("serial#"))) { |
| sn = "000000000000"; |
| } |
| snlen = strlen(sn); |
| if (snlen > sizeof(serial_number) - 1) { |
| printf ("Warning: serial number %s is too long (%d > %d)\n", |
| sn, snlen, sizeof(serial_number) - 1); |
| snlen = sizeof(serial_number) - 1; |
| } |
| memcpy (serial_number, sn, snlen); |
| serial_number[snlen] = '\0'; |
| |
| /* Decide on which type of UDC device to be. |
| */ |
| |
| if(!(tt = getenv("usbtty"))) { |
| tt = "generic"; |
| } |
| usbtty_init_terminal_type(strcmp(tt,"cdc_acm")); |
| |
| /* prepare buffers... */ |
| buf_init (&usbtty_input, USBTTY_BUFFER_SIZE); |
| buf_init (&usbtty_output, USBTTY_BUFFER_SIZE); |
| |
| /* Now, set up USB controller and infrastructure */ |
| udc_init (); /* Basic USB initialization */ |
| |
| usbtty_init_strings (); |
| usbtty_init_instances (); |
| |
| udc_startup_events (device_instance);/* Enable dev, init udc pointers */ |
| udc_connect (); /* Enable pullup for host detection */ |
| |
| usbtty_init_endpoints (); |
| |
| /* Device initialization */ |
| memset (&usbttydev, 0, sizeof (usbttydev)); |
| |
| strcpy (usbttydev.name, "usbtty"); |
| usbttydev.ext = 0; /* No extensions */ |
| usbttydev.flags = DEV_FLAGS_INPUT | DEV_FLAGS_OUTPUT; |
| usbttydev.tstc = usbtty_tstc; /* 'tstc' function */ |
| usbttydev.getc = usbtty_getc; /* 'getc' function */ |
| usbttydev.putc = usbtty_putc; /* 'putc' function */ |
| usbttydev.puts = usbtty_puts; /* 'puts' function */ |
| |
| rc = device_register (&usbttydev); |
| |
| return (rc == 0) ? 1 : rc; |
| } |
| |
| static void usbtty_init_strings (void) |
| { |
| struct usb_string_descriptor *string; |
| |
| usbtty_string_table[STR_LANG] = |
| (struct usb_string_descriptor*)wstrLang; |
| |
| string = (struct usb_string_descriptor *) wstrManufacturer; |
| string->bLength = sizeof(wstrManufacturer); |
| string->bDescriptorType = USB_DT_STRING; |
| str2wide (CONFIG_USBD_MANUFACTURER, string->wData); |
| usbtty_string_table[STR_MANUFACTURER]=string; |
| |
| |
| string = (struct usb_string_descriptor *) wstrProduct; |
| string->bLength = sizeof(wstrProduct); |
| string->bDescriptorType = USB_DT_STRING; |
| str2wide (CONFIG_USBD_PRODUCT_NAME, string->wData); |
| usbtty_string_table[STR_PRODUCT]=string; |
| |
| |
| string = (struct usb_string_descriptor *) wstrSerial; |
| string->bLength = sizeof(serial_number); |
| string->bDescriptorType = USB_DT_STRING; |
| str2wide (serial_number, string->wData); |
| usbtty_string_table[STR_SERIAL]=string; |
| |
| |
| string = (struct usb_string_descriptor *) wstrConfiguration; |
| string->bLength = sizeof(wstrConfiguration); |
| string->bDescriptorType = USB_DT_STRING; |
| str2wide (CONFIG_USBD_CONFIGURATION_STR, string->wData); |
| usbtty_string_table[STR_CONFIG]=string; |
| |
| |
| string = (struct usb_string_descriptor *) wstrDataInterface; |
| string->bLength = sizeof(wstrDataInterface); |
| string->bDescriptorType = USB_DT_STRING; |
| str2wide (CONFIG_USBD_DATA_INTERFACE_STR, string->wData); |
| usbtty_string_table[STR_DATA_INTERFACE]=string; |
| |
| string = (struct usb_string_descriptor *) wstrCtrlInterface; |
| string->bLength = sizeof(wstrCtrlInterface); |
| string->bDescriptorType = USB_DT_STRING; |
| str2wide (CONFIG_USBD_CTRL_INTERFACE_STR, string->wData); |
| usbtty_string_table[STR_CTRL_INTERFACE]=string; |
| |
| /* Now, initialize the string table for ep0 handling */ |
| usb_strings = usbtty_string_table; |
| } |
| |
| static void usbtty_init_instances (void) |
| { |
| int i; |
| |
| /* initialize device instance */ |
| memset (device_instance, 0, sizeof (struct usb_device_instance)); |
| device_instance->device_state = STATE_INIT; |
| device_instance->device_descriptor = &device_descriptor; |
| device_instance->event = usbtty_event_handler; |
| device_instance->cdc_recv_setup = usbtty_cdc_setup; |
| device_instance->bus = bus_instance; |
| device_instance->configurations = NUM_CONFIGS; |
| device_instance->configuration_instance_array = config_instance; |
| |
| /* initialize bus instance */ |
| memset (bus_instance, 0, sizeof (struct usb_bus_instance)); |
| bus_instance->device = device_instance; |
| bus_instance->endpoint_array = endpoint_instance; |
| bus_instance->max_endpoints = 1; |
| bus_instance->maxpacketsize = 64; |
| bus_instance->serial_number_str = serial_number; |
| |
| /* configuration instance */ |
| memset (config_instance, 0, |
| sizeof (struct usb_configuration_instance)); |
| config_instance->interfaces = interface_count; |
| config_instance->configuration_descriptor = configuration_descriptor; |
| config_instance->interface_instance_array = interface_instance; |
| |
| /* interface instance */ |
| memset (interface_instance, 0, |
| sizeof (struct usb_interface_instance)); |
| interface_instance->alternates = 1; |
| interface_instance->alternates_instance_array = alternate_instance; |
| |
| /* alternates instance */ |
| memset (alternate_instance, 0, |
| sizeof (struct usb_alternate_instance)); |
| alternate_instance->interface_descriptor = interface_descriptors; |
| alternate_instance->endpoints = NUM_ENDPOINTS; |
| alternate_instance->endpoints_descriptor_array = ep_descriptor_ptrs; |
| |
| /* endpoint instances */ |
| memset (&endpoint_instance[0], 0, |
| sizeof (struct usb_endpoint_instance)); |
| endpoint_instance[0].endpoint_address = 0; |
| endpoint_instance[0].rcv_packetSize = EP0_MAX_PACKET_SIZE; |
| endpoint_instance[0].rcv_attributes = USB_ENDPOINT_XFER_CONTROL; |
| endpoint_instance[0].tx_packetSize = EP0_MAX_PACKET_SIZE; |
| endpoint_instance[0].tx_attributes = USB_ENDPOINT_XFER_CONTROL; |
| udc_setup_ep (device_instance, 0, &endpoint_instance[0]); |
| |
| for (i = 1; i <= NUM_ENDPOINTS; i++) { |
| memset (&endpoint_instance[i], 0, |
| sizeof (struct usb_endpoint_instance)); |
| |
| endpoint_instance[i].endpoint_address = |
| ep_descriptor_ptrs[i - 1]->bEndpointAddress; |
| |
| endpoint_instance[i].rcv_attributes = |
| ep_descriptor_ptrs[i - 1]->bmAttributes; |
| |
| endpoint_instance[i].rcv_packetSize = |
| le16_to_cpu(ep_descriptor_ptrs[i - 1]->wMaxPacketSize); |
| |
| endpoint_instance[i].tx_attributes = |
| ep_descriptor_ptrs[i - 1]->bmAttributes; |
| |
| endpoint_instance[i].tx_packetSize = |
| le16_to_cpu(ep_descriptor_ptrs[i - 1]->wMaxPacketSize); |
| |
| endpoint_instance[i].tx_attributes = |
| ep_descriptor_ptrs[i - 1]->bmAttributes; |
| |
| urb_link_init (&endpoint_instance[i].rcv); |
| urb_link_init (&endpoint_instance[i].rdy); |
| urb_link_init (&endpoint_instance[i].tx); |
| urb_link_init (&endpoint_instance[i].done); |
| |
| if (endpoint_instance[i].endpoint_address & USB_DIR_IN) |
| endpoint_instance[i].tx_urb = |
| usbd_alloc_urb (device_instance, |
| &endpoint_instance[i]); |
| else |
| endpoint_instance[i].rcv_urb = |
| usbd_alloc_urb (device_instance, |
| &endpoint_instance[i]); |
| } |
| } |
| |
| static void usbtty_init_endpoints (void) |
| { |
| int i; |
| |
| bus_instance->max_endpoints = NUM_ENDPOINTS + 1; |
| for (i = 1; i <= NUM_ENDPOINTS; i++) { |
| udc_setup_ep (device_instance, i, &endpoint_instance[i]); |
| } |
| } |
| |
| /* usbtty_init_terminal_type |
| * |
| * Do some late binding for our device type. |
| */ |
| static void usbtty_init_terminal_type(short type) |
| { |
| switch(type){ |
| /* CDC ACM */ |
| case 0: |
| /* Assign endpoint descriptors */ |
| ep_descriptor_ptrs[0] = |
| &acm_configuration_descriptors[0].notification_endpoint; |
| ep_descriptor_ptrs[1] = |
| &acm_configuration_descriptors[0].data_endpoints[0]; |
| ep_descriptor_ptrs[2] = |
| &acm_configuration_descriptors[0].data_endpoints[1]; |
| |
| /* Enumerate Device Descriptor */ |
| device_descriptor.bDeviceClass = |
| COMMUNICATIONS_DEVICE_CLASS; |
| device_descriptor.idProduct = |
| cpu_to_le16(CONFIG_USBD_PRODUCTID_CDCACM); |
| |
| /* Assign endpoint indices */ |
| tx_endpoint = ACM_TX_ENDPOINT; |
| rx_endpoint = ACM_RX_ENDPOINT; |
| |
| /* Configuration Descriptor */ |
| configuration_descriptor = |
| (struct usb_configuration_descriptor*) |
| &acm_configuration_descriptors; |
| |
| /* Interface count */ |
| interface_count = NUM_ACM_INTERFACES; |
| break; |
| |
| /* BULK IN/OUT & Default */ |
| case 1: |
| default: |
| /* Assign endpoint descriptors */ |
| ep_descriptor_ptrs[0] = |
| &gserial_configuration_descriptors[0].data_endpoints[0]; |
| ep_descriptor_ptrs[1] = |
| &gserial_configuration_descriptors[0].data_endpoints[1]; |
| ep_descriptor_ptrs[2] = |
| &gserial_configuration_descriptors[0].data_endpoints[2]; |
| |
| /* Enumerate Device Descriptor */ |
| device_descriptor.bDeviceClass = 0xFF; |
| device_descriptor.idProduct = |
| cpu_to_le16(CONFIG_USBD_PRODUCTID_GSERIAL); |
| |
| /* Assign endpoint indices */ |
| tx_endpoint = GSERIAL_TX_ENDPOINT; |
| rx_endpoint = GSERIAL_RX_ENDPOINT; |
| |
| /* Configuration Descriptor */ |
| configuration_descriptor = |
| (struct usb_configuration_descriptor*) |
| &gserial_configuration_descriptors; |
| |
| /* Interface count */ |
| interface_count = NUM_GSERIAL_INTERFACES; |
| break; |
| } |
| } |
| |
| /******************************************************************************/ |
| |
| static struct urb *next_urb (struct usb_device_instance *device, |
| struct usb_endpoint_instance *endpoint) |
| { |
| struct urb *current_urb = NULL; |
| int space; |
| |
| /* If there's a queue, then we should add to the last urb */ |
| if (!endpoint->tx_queue) { |
| current_urb = endpoint->tx_urb; |
| } else { |
| /* Last urb from tx chain */ |
| current_urb = |
| p2surround (struct urb, link, endpoint->tx.prev); |
| } |
| |
| /* Make sure this one has enough room */ |
| space = current_urb->buffer_length - current_urb->actual_length; |
| if (space > 0) { |
| return current_urb; |
| } else { /* No space here */ |
| /* First look at done list */ |
| current_urb = first_urb_detached (&endpoint->done); |
| if (!current_urb) { |
| current_urb = usbd_alloc_urb (device, endpoint); |
| } |
| |
| urb_append (&endpoint->tx, current_urb); |
| endpoint->tx_queue++; |
| } |
| return current_urb; |
| } |
| |
| static int write_buffer (circbuf_t * buf) |
| { |
| if (!usbtty_configured ()) { |
| return 0; |
| } |
| |
| struct usb_endpoint_instance *endpoint = |
| &endpoint_instance[tx_endpoint]; |
| struct urb *current_urb = NULL; |
| |
| current_urb = next_urb (device_instance, endpoint); |
| /* TX data still exists - send it now |
| */ |
| if(endpoint->sent < current_urb->actual_length){ |
| if(udc_endpoint_write (endpoint)){ |
| /* Write pre-empted by RX */ |
| return -1; |
| } |
| } |
| |
| if (buf->size) { |
| char *dest; |
| |
| int space_avail; |
| int popnum, popped; |
| int total = 0; |
| |
| /* Break buffer into urb sized pieces, |
| * and link each to the endpoint |
| */ |
| while (buf->size > 0) { |
| |
| if (!current_urb) { |
| TTYERR ("current_urb is NULL, buf->size %d\n", |
| buf->size); |
| return total; |
| } |
| |
| dest = (char*)current_urb->buffer + |
| current_urb->actual_length; |
| |
| space_avail = |
| current_urb->buffer_length - |
| current_urb->actual_length; |
| popnum = MIN (space_avail, buf->size); |
| if (popnum == 0) |
| break; |
| |
| popped = buf_pop (buf, dest, popnum); |
| if (popped == 0) |
| break; |
| current_urb->actual_length += popped; |
| total += popped; |
| |
| /* If endpoint->last == 0, then transfers have |
| * not started on this endpoint |
| */ |
| if (endpoint->last == 0) { |
| if(udc_endpoint_write (endpoint)){ |
| /* Write pre-empted by RX */ |
| return -1; |
| } |
| } |
| |
| }/* end while */ |
| return total; |
| } |
| |
| return 0; |
| } |
| |
| static int fill_buffer (circbuf_t * buf) |
| { |
| struct usb_endpoint_instance *endpoint = |
| &endpoint_instance[rx_endpoint]; |
| |
| if (endpoint->rcv_urb && endpoint->rcv_urb->actual_length) { |
| unsigned int nb = 0; |
| char *src = (char *) endpoint->rcv_urb->buffer; |
| unsigned int rx_avail = buf->totalsize - buf->size; |
| |
| if(rx_avail >= endpoint->rcv_urb->actual_length){ |
| |
| nb = endpoint->rcv_urb->actual_length; |
| buf_push (buf, src, nb); |
| endpoint->rcv_urb->actual_length = 0; |
| |
| } |
| return nb; |
| } |
| return 0; |
| } |
| |
| static int usbtty_configured (void) |
| { |
| return usbtty_configured_flag; |
| } |
| |
| /******************************************************************************/ |
| |
| static void usbtty_event_handler (struct usb_device_instance *device, |
| usb_device_event_t event, int data) |
| { |
| switch (event) { |
| case DEVICE_RESET: |
| case DEVICE_BUS_INACTIVE: |
| usbtty_configured_flag = 0; |
| break; |
| case DEVICE_CONFIGURED: |
| usbtty_configured_flag = 1; |
| break; |
| |
| case DEVICE_ADDRESS_ASSIGNED: |
| usbtty_init_endpoints (); |
| |
| default: |
| break; |
| } |
| } |
| |
| /******************************************************************************/ |
| |
| int usbtty_cdc_setup(struct usb_device_request *request, struct urb *urb) |
| { |
| switch (request->bRequest){ |
| |
| case ACM_SET_CONTROL_LINE_STATE: /* Implies DTE ready */ |
| break; |
| case ACM_SEND_ENCAPSULATED_COMMAND : /* Required */ |
| break; |
| case ACM_SET_LINE_ENCODING : /* DTE stop/parity bits |
| * per character */ |
| break; |
| case ACM_GET_ENCAPSULATED_RESPONSE : /* request response */ |
| break; |
| case ACM_GET_LINE_ENCODING : /* request DTE rate, |
| * stop/parity bits */ |
| memcpy (urb->buffer , &rs232_desc, sizeof(rs232_desc)); |
| urb->actual_length = sizeof(rs232_desc); |
| |
| break; |
| default: |
| return 1; |
| } |
| return 0; |
| } |
| |
| /******************************************************************************/ |
| |
| /* |
| * Since interrupt handling has not yet been implemented, we use this function |
| * to handle polling. This is called by the tstc,getc,putc,puts routines to |
| * update the USB state. |
| */ |
| void usbtty_poll (void) |
| { |
| /* New interrupts? */ |
| udc_irq(); |
| |
| /* Write any output data to host buffer |
| * (do this before checking interrupts to avoid missing one) |
| */ |
| if (usbtty_configured ()) { |
| write_buffer (&usbtty_output); |
| } |
| |
| /* New interrupts? */ |
| udc_irq(); |
| |
| /* Check for new data from host.. |
| * (do this after checking interrupts to get latest data) |
| */ |
| if (usbtty_configured ()) { |
| fill_buffer (&usbtty_input); |
| } |
| |
| /* New interrupts? */ |
| udc_irq(); |
| |
| } |
| |
| |
| #endif |