|
- #include "usb_dev.h"
- #define USB_DESC_LIST_DEFINE
- #include "usb_desc.h"
- #include "usb_serial.h"
- #include "core_pins.h"
- #include <string.h>
- #include "debug/printf.h"
-
-
-
-
-
-
-
-
- typedef struct endpoint_struct endpoint_t;
-
- struct endpoint_struct {
- uint32_t config;
- uint32_t current;
- uint32_t next;
- uint32_t status;
- uint32_t pointer0;
- uint32_t pointer1;
- uint32_t pointer2;
- uint32_t pointer3;
- uint32_t pointer4;
- uint32_t reserved;
- uint32_t setup0;
- uint32_t setup1;
- transfer_t *first_transfer;
- transfer_t *last_transfer;
- void (*callback_function)(transfer_t *completed_transfer);
- uint32_t unused1;
- };
-
-
-
- endpoint_t endpoint_queue_head[(NUM_ENDPOINTS+1)*2] __attribute__ ((used, aligned(4096)));
-
- transfer_t endpoint0_transfer_data __attribute__ ((used, aligned(32)));
- transfer_t endpoint0_transfer_ack __attribute__ ((used, aligned(32)));
-
-
- typedef union {
- struct {
- union {
- struct {
- uint8_t bmRequestType;
- uint8_t bRequest;
- };
- uint16_t wRequestAndType;
- };
- uint16_t wValue;
- uint16_t wIndex;
- uint16_t wLength;
- };
- struct {
- uint32_t word1;
- uint32_t word2;
- };
- uint64_t bothwords;
- } setup_t;
-
- static setup_t endpoint0_setupdata;
- static uint32_t endpoint0_notify_mask=0;
- static uint32_t endpointN_notify_mask=0;
-
- volatile uint8_t usb_configuration = 0;
- volatile uint8_t usb_high_speed = 0;
- static uint8_t endpoint0_buffer[8];
- static uint8_t usb_reboot_timer = 0;
-
- extern uint8_t usb_descriptor_buffer[];
- extern const uint8_t usb_config_descriptor_480[];
- extern const uint8_t usb_config_descriptor_12[];
-
- void (*usb_timer0_callback)(void) = NULL;
- void (*usb_timer1_callback)(void) = NULL;
-
- static void isr(void);
- static void endpoint0_setup(uint64_t setupdata);
- static void endpoint0_transmit(const void *data, uint32_t len, int notify);
- static void endpoint0_receive(void *data, uint32_t len, int notify);
- static void endpoint0_complete(void);
-
-
- static void run_callbacks(endpoint_t *ep);
-
-
- __attribute__((section(".progmem")))
- void usb_init(void)
- {
-
-
-
- PMU_REG_3P0 = PMU_REG_3P0_OUTPUT_TRG(0x0F) | PMU_REG_3P0_BO_OFFSET(6)
- | PMU_REG_3P0_ENABLE_LINREG;
-
- usb_init_serialnumber();
-
-
-
- CCM_CCGR6 |= CCM_CCGR6_USBOH3(CCM_CCGR_ON);
-
- printf("BURSTSIZE=%08lX\n", USB1_BURSTSIZE);
-
- USB1_BURSTSIZE = 0x0404;
- printf("BURSTSIZE=%08lX\n", USB1_BURSTSIZE);
- printf("USB1_TXFILLTUNING=%08lX\n", USB1_TXFILLTUNING);
-
-
-
-
-
-
-
-
-
-
-
-
- #if 1
- if ((USBPHY1_PWD & (USBPHY_PWD_RXPWDRX | USBPHY_PWD_RXPWDDIFF | USBPHY_PWD_RXPWD1PT1
- | USBPHY_PWD_RXPWDENV | USBPHY_PWD_TXPWDV2I | USBPHY_PWD_TXPWDIBIAS
- | USBPHY_PWD_TXPWDFS)) || (USB1_USBMODE & USB_USBMODE_CM_MASK)) {
-
-
- USBPHY1_CTRL_SET = USBPHY_CTRL_SFTRST;
- USB1_USBCMD |= USB_USBCMD_RST;
- int count=0;
- while (USB1_USBCMD & USB_USBCMD_RST) count++;
- NVIC_CLEAR_PENDING(IRQ_USB1);
- USBPHY1_CTRL_CLR = USBPHY_CTRL_SFTRST;
-
- printf("USB reset took %d loops\n", count);
-
-
-
-
-
-
-
- delay(25);
- }
- #endif
-
-
-
-
-
-
-
-
-
-
-
-
-
-
- USBPHY1_CTRL_CLR = USBPHY_CTRL_CLKGATE;
- USBPHY1_PWD = 0;
-
-
-
- USB1_USBMODE = USB_USBMODE_CM(2) | USB_USBMODE_SLOM;
- memset(endpoint_queue_head, 0, sizeof(endpoint_queue_head));
- endpoint_queue_head[0].config = (64 << 16) | (1 << 15);
- endpoint_queue_head[1].config = (64 << 16);
- USB1_ENDPOINTLISTADDR = (uint32_t)&endpoint_queue_head;
-
-
- USB1_USBINTR = USB_USBINTR_UE | USB_USBINTR_UEE |
- USB_USBINTR_URE | USB_USBINTR_SLE;
-
- attachInterruptVector(IRQ_USB1, &isr);
- NVIC_ENABLE_IRQ(IRQ_USB1);
-
-
-
-
- USB1_USBCMD = USB_USBCMD_RS;
-
-
- }
-
-
- static void isr(void)
- {
-
-
-
-
- uint32_t status = USB1_USBSTS;
- USB1_USBSTS = status;
-
-
-
-
-
- if (status & USB_USBSTS_UI) {
-
- uint32_t setupstatus = USB1_ENDPTSETUPSTAT;
-
- while (setupstatus) {
- USB1_ENDPTSETUPSTAT = setupstatus;
- setup_t s;
- do {
- USB1_USBCMD |= USB_USBCMD_SUTW;
- s.word1 = endpoint_queue_head[0].setup0;
- s.word2 = endpoint_queue_head[0].setup1;
- } while (!(USB1_USBCMD & USB_USBCMD_SUTW));
- USB1_USBCMD &= ~USB_USBCMD_SUTW;
-
- USB1_ENDPTFLUSH = (1<<16) | (1<<0);
- while (USB1_ENDPTFLUSH & ((1<<16) | (1<<0))) ;
- endpoint0_notify_mask = 0;
- endpoint0_setup(s.bothwords);
- setupstatus = USB1_ENDPTSETUPSTAT;
- }
- uint32_t completestatus = USB1_ENDPTCOMPLETE;
- if (completestatus) {
- USB1_ENDPTCOMPLETE = completestatus;
-
- if (completestatus & endpoint0_notify_mask) {
- endpoint0_notify_mask = 0;
- endpoint0_complete();
- }
- completestatus &= endpointN_notify_mask;
- if (completestatus) {
- int i;
- for (i=2; i <= NUM_ENDPOINTS; i++) {
- if (completestatus & (1 << i)) {
- run_callbacks(endpoint_queue_head + i * 2);
- }
- if (completestatus & (1 << (i + 16))) {
- run_callbacks(endpoint_queue_head + i * 2 + 1);
- }
- }
- }
- }
- }
- if (status & USB_USBSTS_URI) {
- USB1_ENDPTSETUPSTAT = USB1_ENDPTSETUPSTAT;
- USB1_ENDPTCOMPLETE = USB1_ENDPTCOMPLETE;
- while (USB1_ENDPTPRIME != 0) ;
- USB1_ENDPTFLUSH = 0xFFFFFFFF;
- if ((USB1_PORTSC1 & USB_PORTSC1_PR)) {
-
- } else {
-
-
-
- }
- #if defined(CDC_STATUS_INTERFACE) && defined(CDC_DATA_INTERFACE)
- usb_serial_reset();
- #endif
- endpointN_notify_mask = 0;
-
-
-
-
-
-
- }
- if (status & USB_USBSTS_TI0) {
- if (usb_timer0_callback != NULL) usb_timer0_callback();
- }
- if (status & USB_USBSTS_TI1) {
- if (usb_timer1_callback != NULL) usb_timer1_callback();
- }
- if (status & USB_USBSTS_PCI) {
- if (USB1_PORTSC1 & USB_PORTSC1_HSP) {
-
- usb_high_speed = 1;
- } else {
-
- usb_high_speed = 0;
- }
- }
- if (status & USB_USBSTS_SLI) {
-
- }
- if (status & USB_USBSTS_UEI) {
-
- }
- if ((USB1_USBINTR & USB_USBINTR_SRE) && (status & USB_USBSTS_SRI)) {
- printf("sof %d\n", usb_reboot_timer);
- if (usb_reboot_timer) {
- if (--usb_reboot_timer == 0) {
- asm("bkpt #251");
- }
- } else {
-
- USB1_USBINTR &= ~USB_USBINTR_SRE;
- }
- }
- }
-
-
-
-
- static uint8_t reply_buffer[8];
-
- static void endpoint0_setup(uint64_t setupdata)
- {
- setup_t setup;
- uint32_t endpoint, dir, ctrl;
- const usb_descriptor_list_t *list;
-
- setup.bothwords = setupdata;
- switch (setup.wRequestAndType) {
- case 0x0500:
- endpoint0_receive(NULL, 0, 0);
- USB1_DEVICEADDR = USB_DEVICEADDR_USBADR(setup.wValue) | USB_DEVICEADDR_USBADRA;
- return;
- case 0x0900:
- usb_configuration = setup.wValue;
-
- #if defined(ENDPOINT2_CONFIG)
- USB1_ENDPTCTRL2 = ENDPOINT2_CONFIG;
- #endif
- #if defined(ENDPOINT3_CONFIG)
- USB1_ENDPTCTRL3 = ENDPOINT3_CONFIG;
- #endif
- #if defined(ENDPOINT4_CONFIG)
- USB1_ENDPTCTRL4 = ENDPOINT4_CONFIG;
- #endif
- #if defined(ENDPOINT5_CONFIG)
- USB1_ENDPTCTRL5 = ENDPOINT5_CONFIG;
- #endif
- #if defined(ENDPOINT6_CONFIG)
- USB1_ENDPTCTRL6 = ENDPOINT6_CONFIG;
- #endif
- #if defined(ENDPOINT7_CONFIG)
- USB1_ENDPTCTRL7 = ENDPOINT7_CONFIG;
- #endif
- #if defined(CDC_STATUS_INTERFACE) && defined(CDC_DATA_INTERFACE)
- usb_serial_configure();
- #endif
- #if defined(RAWHID_INTERFACE)
- usb_rawhid_configure();
- #endif
- endpoint0_receive(NULL, 0, 0);
- return;
- case 0x0880:
- reply_buffer[0] = usb_configuration;
- endpoint0_transmit(reply_buffer, 1, 0);
- return;
- case 0x0080:
- reply_buffer[0] = 0;
- reply_buffer[1] = 0;
- endpoint0_transmit(reply_buffer, 2, 0);
- return;
- case 0x0082:
- endpoint = setup.wIndex & 0x7F;
- if (endpoint > 7) break;
- dir = setup.wIndex & 0x80;
- ctrl = *((uint32_t *)&USB1_ENDPTCTRL0 + endpoint);
- reply_buffer[0] = 0;
- reply_buffer[1] = 0;
- if ((dir && (ctrl & USB_ENDPTCTRL_TXS)) || (!dir && (ctrl & USB_ENDPTCTRL_RXS))) {
- reply_buffer[0] = 1;
- }
- endpoint0_transmit(reply_buffer, 2, 0);
- return;
- case 0x0302:
- endpoint = setup.wIndex & 0x7F;
- if (endpoint > 7) break;
- dir = setup.wIndex & 0x80;
- if (dir) {
- *((volatile uint32_t *)&USB1_ENDPTCTRL0 + endpoint) |= USB_ENDPTCTRL_TXS;
- } else {
- *((volatile uint32_t *)&USB1_ENDPTCTRL0 + endpoint) |= USB_ENDPTCTRL_RXS;
- }
- endpoint0_receive(NULL, 0, 0);
- return;
- case 0x0102:
- endpoint = setup.wIndex & 0x7F;
- if (endpoint > 7) break;
- dir = setup.wIndex & 0x80;
- if (dir) {
- *((volatile uint32_t *)&USB1_ENDPTCTRL0 + endpoint) &= ~USB_ENDPTCTRL_TXS;
- } else {
- *((volatile uint32_t *)&USB1_ENDPTCTRL0 + endpoint) &= ~USB_ENDPTCTRL_RXS;
- }
- endpoint0_receive(NULL, 0, 0);
- return;
- case 0x0680:
- case 0x0681:
- for (list = usb_descriptor_list; list->addr != NULL; list++) {
- if (setup.wValue == list->wValue && setup.wIndex == list->wIndex) {
- uint32_t datalen;
- if ((setup.wValue >> 8) == 3) {
-
-
- datalen = *(list->addr);
- } else {
- datalen = list->length;
- }
- if (datalen > setup.wLength) datalen = setup.wLength;
-
-
- if (setup.wValue == 0x200) {
-
- const uint8_t *src = usb_config_descriptor_12;
- if (usb_high_speed) src = usb_config_descriptor_480;
- memcpy(usb_descriptor_buffer, src, datalen);
- } else if (setup.wValue == 0x700) {
-
- const uint8_t *src = usb_config_descriptor_480;
- if (usb_high_speed) src = usb_config_descriptor_12;
- memcpy(usb_descriptor_buffer, src, datalen);
- usb_descriptor_buffer[1] = 7;
- } else {
- memcpy(usb_descriptor_buffer, list->addr, datalen);
- }
-
- arm_dcache_flush_delete(usb_descriptor_buffer, datalen);
- endpoint0_transmit(usb_descriptor_buffer, datalen, 0);
- return;
- }
- }
- break;
- #if defined(CDC_STATUS_INTERFACE)
- case 0x2221:
- usb_cdc_line_rtsdtr_millis = systick_millis_count;
- usb_cdc_line_rtsdtr = setup.wValue;
- case 0x2321:
- endpoint0_receive(NULL, 0, 0);
- return;
- case 0x2021:
- if (setup.wLength != 7) break;
- endpoint0_setupdata.bothwords = setupdata;
- endpoint0_receive(endpoint0_buffer, 7, 1);
- return;
- #endif
- #if defined(SEREMU_INTERFACE) || defined(KEYBOARD_INTERFACE)
- case 0x0921:
- if (setup.wLength <= sizeof(endpoint0_buffer)) {
-
- endpoint0_setupdata.bothwords = setup.bothwords;
- endpoint0_buffer[0] = 0xE9;
- endpoint0_receive(endpoint0_buffer, setup.wLength, 1);
- return;
- }
- break;
- #endif
- }
- USB1_ENDPTCTRL0 = 0x000010001;
- }
-
- static void endpoint0_transmit(const void *data, uint32_t len, int notify)
- {
-
- if (len > 0) {
-
- endpoint0_transfer_data.next = 1;
- endpoint0_transfer_data.status = (len << 16) | (1<<7);
- uint32_t addr = (uint32_t)data;
- endpoint0_transfer_data.pointer0 = addr;
- endpoint0_transfer_data.pointer1 = addr + 4096;
- endpoint0_transfer_data.pointer2 = addr + 8192;
- endpoint0_transfer_data.pointer3 = addr + 12288;
- endpoint0_transfer_data.pointer4 = addr + 16384;
-
- endpoint_queue_head[1].next = (uint32_t)&endpoint0_transfer_data;
- endpoint_queue_head[1].status = 0;
- USB1_ENDPTPRIME |= (1<<16);
- while (USB1_ENDPTPRIME) ;
- }
- endpoint0_transfer_ack.next = 1;
- endpoint0_transfer_ack.status = (1<<7) | (notify ? (1 << 15) : 0);
- endpoint0_transfer_ack.pointer0 = 0;
- endpoint_queue_head[0].next = (uint32_t)&endpoint0_transfer_ack;
- endpoint_queue_head[0].status = 0;
- USB1_ENDPTCOMPLETE |= (1<<0) | (1<<16);
- USB1_ENDPTPRIME |= (1<<0);
- endpoint0_notify_mask = (notify ? (1 << 0) : 0);
- while (USB1_ENDPTPRIME) ;
- }
-
- static void endpoint0_receive(void *data, uint32_t len, int notify)
- {
-
- if (len > 0) {
-
- endpoint0_transfer_data.next = 1;
- endpoint0_transfer_data.status = (len << 16) | (1<<7);
- uint32_t addr = (uint32_t)data;
- endpoint0_transfer_data.pointer0 = addr;
- endpoint0_transfer_data.pointer1 = addr + 4096;
- endpoint0_transfer_data.pointer2 = addr + 8192;
- endpoint0_transfer_data.pointer3 = addr + 12288;
- endpoint0_transfer_data.pointer4 = addr + 16384;
-
- endpoint_queue_head[0].next = (uint32_t)&endpoint0_transfer_data;
- endpoint_queue_head[0].status = 0;
- USB1_ENDPTPRIME |= (1<<0);
- while (USB1_ENDPTPRIME) ;
- }
- endpoint0_transfer_ack.next = 1;
- endpoint0_transfer_ack.status = (1<<7) | (notify ? (1 << 15) : 0);
- endpoint0_transfer_ack.pointer0 = 0;
- endpoint_queue_head[1].next = (uint32_t)&endpoint0_transfer_ack;
- endpoint_queue_head[1].status = 0;
- USB1_ENDPTCOMPLETE |= (1<<0) | (1<<16);
- USB1_ENDPTPRIME |= (1<<16);
- endpoint0_notify_mask = (notify ? (1 << 16) : 0);
- while (USB1_ENDPTPRIME) ;
- }
-
-
-
-
- static void endpoint0_complete(void)
- {
- setup_t setup;
-
- setup.bothwords = endpoint0_setupdata.bothwords;
-
- #ifdef CDC_STATUS_INTERFACE
- if (setup.wRequestAndType == 0x2021 ) {
- memcpy(usb_cdc_line_coding, endpoint0_buffer, 7);
- printf("usb_cdc_line_coding, baud=%u\n", usb_cdc_line_coding[0]);
- if (usb_cdc_line_coding[0] == 134) {
- USB1_USBINTR |= USB_USBINTR_SRE;
- usb_reboot_timer = 80;
- }
- }
- #endif
- #ifdef SEREMU_INTERFACE
- if (setup.word1 == 0x03000921 && setup.word2 == ((4<<16)|SEREMU_INTERFACE)
- && endpoint0_buffer[0] == 0xA9 && endpoint0_buffer[1] == 0x45
- && endpoint0_buffer[2] == 0xC2 && endpoint0_buffer[3] == 0x6B) {
- printf("seremu reboot request\n");
- USB1_USBINTR |= USB_USBINTR_SRE;
- usb_reboot_timer = 80;
- }
- #endif
- }
-
- static void usb_endpoint_config(endpoint_t *qh, uint32_t config, void (*callback)(transfer_t *))
- {
- memset(qh, 0, sizeof(endpoint_t));
- qh->config = config;
- qh->next = 1;
- qh->callback_function = callback;
- }
-
- void usb_config_rx(uint32_t ep, uint32_t packet_size, int do_zlp, void (*cb)(transfer_t *))
- {
- uint32_t config = (packet_size << 16) | (do_zlp ? 0 : (1 << 29));
- if (ep < 2 || ep > NUM_ENDPOINTS) return;
- usb_endpoint_config(endpoint_queue_head + ep * 2, config, cb);
- if (cb) endpointN_notify_mask |= (1 << ep);
- }
-
- void usb_config_tx(uint32_t ep, uint32_t packet_size, int do_zlp, void (*cb)(transfer_t *))
- {
- uint32_t config = (packet_size << 16) | (do_zlp ? 0 : (1 << 29));
- if (ep < 2 || ep > NUM_ENDPOINTS) return;
- usb_endpoint_config(endpoint_queue_head + ep * 2 + 1, config, cb);
- if (cb) endpointN_notify_mask |= (1 << (ep + 16));
- }
-
-
-
- void usb_prepare_transfer(transfer_t *transfer, const void *data, uint32_t len, uint32_t param)
- {
- transfer->next = 1;
- transfer->status = (len << 16) | (1<<7);
- uint32_t addr = (uint32_t)data;
- transfer->pointer0 = addr;
- transfer->pointer1 = addr + 4096;
- transfer->pointer2 = addr + 8192;
- transfer->pointer3 = addr + 12288;
- transfer->pointer4 = addr + 16384;
- transfer->callback_param = param;
- }
-
- #if 0
- void usb_print_transfer_log(void)
- {
- uint32_t i, count;
- printf("log %d transfers\n", transfer_log_count);
- count = transfer_log_count;
- if (count > LOG_SIZE) count = LOG_SIZE;
-
- for (i=0; i < count; i++) {
- if (transfer_log_head == 0) transfer_log_head = LOG_SIZE;
- transfer_log_head--;
- uint32_t log = transfer_log[transfer_log_head];
- printf(" %c %X\n", log >> 8, (int)(log & 255));
- }
- }
- #endif
-
- static void schedule_transfer(endpoint_t *endpoint, uint32_t epmask, transfer_t *transfer)
- {
-
-
-
-
- if (endpoint->callback_function) {
- transfer->status |= (1<<15);
- }
- __disable_irq();
-
-
- transfer_t *last = endpoint->last_transfer;
- if (last) {
- last->next = (uint32_t)transfer;
- if (USB1_ENDPTPRIME & epmask) goto end;
-
-
- uint32_t status;
- do {
- USB1_USBCMD |= USB_USBCMD_ATDTW;
- status = USB1_ENDPTSTATUS;
- } while (!(USB1_USBCMD & USB_USBCMD_ATDTW));
-
- if (status & epmask) goto end;
-
- }
-
- endpoint->next = (uint32_t)transfer;
- endpoint->status = 0;
- USB1_ENDPTPRIME |= epmask;
- endpoint->first_transfer = transfer;
- end:
- endpoint->last_transfer = transfer;
- __enable_irq();
-
-
-
-
-
-
-
- }
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
- static void run_callbacks(endpoint_t *ep)
- {
- transfer_t *t, *next;
-
-
- t = ep->first_transfer;
- while (t && (uint32_t)t != 1) {
- if (!(t->status & (1<<7))) {
-
- next = (transfer_t *)t->next;
- ep->callback_function(t);
- } else {
-
- ep->first_transfer = t;
- return;
- }
- if (next == ep->last_transfer) break;
- t = next;
- }
-
- ep->first_transfer = NULL;
- ep->last_transfer = NULL;
- }
-
- void usb_transmit(int endpoint_number, transfer_t *transfer)
- {
- if (endpoint_number < 2 || endpoint_number > NUM_ENDPOINTS) return;
- endpoint_t *endpoint = endpoint_queue_head + endpoint_number * 2 + 1;
- uint32_t mask = 1 << (endpoint_number + 16);
- schedule_transfer(endpoint, mask, transfer);
- }
-
- void usb_receive(int endpoint_number, transfer_t *transfer)
- {
- if (endpoint_number < 2 || endpoint_number > NUM_ENDPOINTS) return;
- endpoint_t *endpoint = endpoint_queue_head + endpoint_number * 2;
- uint32_t mask = 1 << endpoint_number;
- schedule_transfer(endpoint, mask, transfer);
- }
-
- uint32_t usb_transfer_status(const transfer_t *transfer)
- {
- uint32_t status, cmd;
-
- cmd = USB1_USBCMD;
- while (1) {
- __disable_irq();
- USB1_USBCMD = cmd | USB_USBCMD_ATDTW;
- status = transfer->status;
- cmd = USB1_USBCMD;
- __enable_irq();
- if (cmd & USB_USBCMD_ATDTW) return status;
-
-
-
- }
- }
-
|