|
-
-
-
- #include "usb_common.h"
- #include "usb_private.h"
-
-
-
-
-
- static const uint8_t PROGMEM endpoint_config_table[] = {
- 0,
- 1, EP_TYPE_INTERRUPT_IN, EP_SIZE(CDC_ACM_SIZE) | CDC_ACM_BUFFER,
- 1, EP_TYPE_BULK_OUT, EP_SIZE(CDC_RX_SIZE) | CDC_RX_BUFFER,
- 1, EP_TYPE_BULK_IN, EP_SIZE(CDC_TX_SIZE) | CDC_TX_BUFFER
- };
-
-
-
-
-
-
-
-
-
-
- static const uint8_t PROGMEM device_descriptor[] = {
- 18,
- 1,
- 0x00, 0x02,
- 2,
- 0,
- 0,
- ENDPOINT0_SIZE,
- LSB(VENDOR_ID), MSB(VENDOR_ID),
- LSB(PRODUCT_ID), MSB(PRODUCT_ID),
- #if defined(__AVR_ATmega32U4__)
- 0x71, 0x02,
- #elif defined(__AVR_AT90USB1286__)
- 0x72, 0x02,
- #else
- 0x00, 0x01,
- #endif
- 1,
- 2,
- 3,
- 1
- };
-
- #define CONFIG1_DESC_SIZE (9+9+5+5+4+5+7+9+7+7)
- static const uint8_t PROGMEM config1_descriptor[CONFIG1_DESC_SIZE] = {
-
- 9,
- 2,
- LSB(CONFIG1_DESC_SIZE),
- MSB(CONFIG1_DESC_SIZE),
- 2,
- 1,
- 0,
- 0xC0,
- 50,
-
- 9,
- 4,
- 0,
- 0,
- 1,
- 0x02,
- 0x02,
- 0x01,
- 0,
-
- 5,
- 0x24,
- 0x00,
- 0x10, 0x01,
-
- 5,
- 0x24,
- 0x01,
- 0x00,
- 1,
-
- 4,
- 0x24,
- 0x02,
- 0x06,
-
- 5,
- 0x24,
- 0x06,
- 0,
- 1,
-
- 7,
- 5,
- CDC_ACM_ENDPOINT | 0x80,
- 0x03,
- CDC_ACM_SIZE, 0,
- 64,
-
- 9,
- 4,
- 1,
- 0,
- 2,
- 0x0A,
- 0x00,
- 0x00,
- 0,
-
- 7,
- 5,
- CDC_RX_ENDPOINT,
- 0x02,
- CDC_RX_SIZE, 0,
- 0,
-
- 7,
- 5,
- CDC_TX_ENDPOINT | 0x80,
- 0x02,
- CDC_TX_SIZE, 0,
- 0
- };
-
-
-
-
- struct usb_string_descriptor_struct {
- uint8_t bLength;
- uint8_t bDescriptorType;
- int16_t wString[];
- };
- static const struct usb_string_descriptor_struct PROGMEM string0 = {
- 4,
- 3,
- {0x0409}
- };
- static const struct usb_string_descriptor_struct PROGMEM string1 = {
- sizeof(STR_MANUFACTURER),
- 3,
- STR_MANUFACTURER
- };
- static const struct usb_string_descriptor_struct PROGMEM string2 = {
- sizeof(STR_PRODUCT),
- 3,
- STR_PRODUCT
- };
- static const struct usb_string_descriptor_struct PROGMEM string3 = {
- sizeof(STR_SERIAL_NUMBER),
- 3,
- STR_SERIAL_NUMBER
- };
-
-
-
- static const struct descriptor_list_struct {
- uint16_t wValue;
- uint16_t wIndex;
- const uint8_t *addr;
- uint8_t length;
- } PROGMEM descriptor_list[] = {
- {0x0100, 0x0000, device_descriptor, sizeof(device_descriptor)},
- {0x0200, 0x0000, config1_descriptor, sizeof(config1_descriptor)},
- {0x0300, 0x0000, (const uint8_t *)&string0, 4},
- {0x0301, 0x0409, (const uint8_t *)&string1, sizeof(STR_MANUFACTURER)},
- {0x0302, 0x0409, (const uint8_t *)&string2, sizeof(STR_PRODUCT)},
- {0x0303, 0x0409, (const uint8_t *)&string3, sizeof(STR_SERIAL_NUMBER)}
- };
- #define NUM_DESC_LIST (sizeof(descriptor_list)/sizeof(struct descriptor_list_struct))
-
-
-
-
-
- volatile uint8_t usb_configuration USBSTATE;
- volatile uint8_t usb_suspended USBSTATE;
-
-
-
- volatile uint8_t transmit_flush_timer=0;
- volatile uint8_t reboot_timer=0;
- uint8_t transmit_previous_timeout=0;
-
-
-
-
- volatile uint8_t cdc_line_coding[7]={0x00, 0xE1, 0x00, 0x00, 0x00, 0x00, 0x08};
- volatile uint8_t cdc_line_rtsdtr USBSTATE;
-
-
-
-
-
-
- void usb_init(void)
- {
- uint8_t u;
-
- u = USBCON;
- if ((u & (1<<USBE)) && !(u & (1<<FRZCLK))) return;
- HW_CONFIG();
- USB_FREEZE();
- PLL_CONFIG();
- while (!(PLLCSR & (1<<PLOCK))) ;
- USB_CONFIG();
- UDCON = 0;
- usb_configuration = 0;
- usb_suspended = 0;
- cdc_line_rtsdtr = 0;
- UDINT = 0;
- UDIEN = (1<<EORSTE)|(1<<SOFE)|(1<<SUSPE);
- }
-
-
- void usb_shutdown(void)
- {
- UDIEN = 0;
- UDCON = 1;
- USBCON = 0;
- PLLCSR = 0;
- usb_configuration = 0;
- usb_suspended = 1;
- }
-
-
-
-
-
-
-
-
-
-
- ISR(USB_GEN_vect)
- {
- uint8_t intbits, t;
-
- intbits = UDINT;
- UDINT = 0;
- if (intbits & (1<<EORSTI)) {
-
- UENUM = 0;
- UECONX = 1;
- UECFG0X = EP_TYPE_CONTROL;
- UECFG1X = EP_SIZE(ENDPOINT0_SIZE) | EP_SINGLE_BUFFER;
- UEIENX = (1<<RXSTPE);
- usb_configuration = 0;
- cdc_line_rtsdtr = 0;
- }
- if (intbits & (1<<SOFI)) {
-
- if (usb_configuration) {
- t = transmit_flush_timer;
- if (t) {
- transmit_flush_timer = --t;
- if (!t) {
- UENUM = CDC_TX_ENDPOINT;
- UEINTX = 0x3A;
- }
- }
- t = reboot_timer;
- if (t) {
- reboot_timer = --t;
- if (!t) _reboot_Teensyduino_();
- }
- }
- }
-
- if (intbits & (1<<SUSPI)) {
-
- UDIEN = (1<<WAKEUPE);
- usb_configuration = 0;
- usb_suspended = 1;
- #if (F_CPU >= 8000000L)
-
-
-
- USB_FREEZE();
- PLLCSR = 0;
- #endif
-
-
-
-
- }
- if (usb_suspended && (intbits & (1<<WAKEUPI))) {
-
- #if (F_CPU >= 8000000L)
- PLL_CONFIG();
- while (!(PLLCSR & (1<<PLOCK))) ;
- USB_CONFIG();
- #endif
- UDIEN = (1<<EORSTE)|(1<<SOFE)|(1<<SUSPE);
- usb_suspended = 0;
- return;
- }
- }
-
-
-
- static inline void usb_wait_in_ready(void)
- {
- while (!(UEINTX & (1<<TXINI))) ;
- }
- static inline void usb_send_in(void)
- {
- UEINTX = ~(1<<TXINI);
- }
- static inline void usb_wait_receive_out(void)
- {
- while (!(UEINTX & (1<<RXOUTI))) ;
- }
- static inline void usb_ack_out(void)
- {
- UEINTX = ~(1<<RXOUTI);
- }
-
-
-
-
-
-
-
- ISR(USB_COM_vect)
- {
- uint8_t intbits;
- const uint8_t *list;
- const uint8_t *cfg;
- uint8_t i, n, len, en;
- volatile uint8_t *p;
- uint8_t bmRequestType;
- uint8_t bRequest;
- uint16_t wValue;
- uint16_t wIndex;
- uint16_t wLength;
- uint16_t desc_val;
- uint32_t baud;
- const uint8_t *desc_addr;
- uint8_t desc_length;
-
- UENUM = 0;
- intbits = UEINTX;
- if (intbits & (1<<RXSTPI)) {
- bmRequestType = UEDATX;
- bRequest = UEDATX;
-
-
- read_word_lsbfirst(wValue, UEDATX);
-
-
- read_word_lsbfirst(wIndex, UEDATX);
-
-
- read_word_lsbfirst(wLength, UEDATX);
- UEINTX = ~((1<<RXSTPI) | (1<<RXOUTI) | (1<<TXINI));
- if (bRequest == GET_DESCRIPTOR) {
- list = (const uint8_t *)descriptor_list;
- for (i=0; ; i++) {
- if (i >= NUM_DESC_LIST) {
- UECONX = (1<<STALLRQ)|(1<<EPEN);
- return;
- }
-
-
- pgm_read_word_postinc(desc_val, list);
- if (desc_val != wValue) {
- list += sizeof(struct descriptor_list_struct)-2;
- continue;
- }
-
-
- pgm_read_word_postinc(desc_val, list);
- if (desc_val != wIndex) {
- list += sizeof(struct descriptor_list_struct)-4;
- continue;
- }
-
-
- pgm_read_word_postinc(desc_addr, list);
- desc_length = pgm_read_byte(list);
- break;
- }
- len = (wLength < 256) ? wLength : 255;
- if (len > desc_length) len = desc_length;
- list = desc_addr;
- do {
-
- do {
- i = UEINTX;
- } while (!(i & ((1<<TXINI)|(1<<RXOUTI))));
- if (i & (1<<RXOUTI)) return;
-
- n = len < ENDPOINT0_SIZE ? len : ENDPOINT0_SIZE;
- for (i = n; i; i--) {
-
-
- pgm_read_byte_postinc(UEDATX, list);
- }
- len -= n;
- usb_send_in();
- } while (len || n == ENDPOINT0_SIZE);
- return;
- }
- if (bRequest == SET_ADDRESS) {
- usb_send_in();
- usb_wait_in_ready();
- UDADDR = wValue | (1<<ADDEN);
- return;
- }
- if (bRequest == SET_CONFIGURATION && bmRequestType == 0) {
- usb_configuration = wValue;
- cdc_line_rtsdtr = 0;
- transmit_flush_timer = 0;
- usb_send_in();
- cfg = endpoint_config_table;
- for (i=1; i<5; i++) {
- UENUM = i;
-
- pgm_read_byte_postinc(en, cfg);
- UECONX = en;
- if (en) {
-
-
- pgm_read_byte_postinc(UECFG0X, cfg);
- pgm_read_byte_postinc(UECFG1X, cfg);
- }
- }
- UERST = 0x1E;
- UERST = 0;
- return;
- }
- if (bRequest == GET_CONFIGURATION && bmRequestType == 0x80) {
- usb_wait_in_ready();
- UEDATX = usb_configuration;
- usb_send_in();
- return;
- }
- if (bRequest == CDC_GET_LINE_CODING && bmRequestType == 0xA1) {
- usb_wait_in_ready();
- p = cdc_line_coding;
- for (i=0; i<7; i++) {
- UEDATX = *p++;
- }
- usb_send_in();
- return;
- }
- if (bRequest == CDC_SET_LINE_CODING && bmRequestType == 0x21) {
- usb_wait_receive_out();
- p = cdc_line_coding;
- for (i=0; i<7; i++) {
- *p++ = UEDATX;
- }
- usb_ack_out();
- usb_send_in();
- baud = (uint32_t)cdc_line_coding[0]
- | ((uint32_t)cdc_line_coding[1] << 8)
- | ((uint32_t)cdc_line_coding[2] << 16)
- | ((uint32_t)cdc_line_coding[3] << 24);
- if (baud == 134UL) reboot_timer = 15;
- if (baud == 150UL) {
- UENUM = CDC_TX_ENDPOINT;
- while (UESTA0X & 0x03) {
- UEINTX = 0xFF;
- while (UEINTX & 0x04) ;
- }
- _restart_Teensyduino_();
- }
- return;
- }
- if (bRequest == CDC_SET_CONTROL_LINE_STATE && bmRequestType == 0x21) {
- cdc_line_rtsdtr = wValue;
- usb_wait_in_ready();
- usb_send_in();
- return;
- }
- if (bRequest == CDC_SEND_BREAK && bmRequestType == 0x21) {
- usb_wait_in_ready();
- usb_send_in();
- return;
- }
- if (bRequest == GET_STATUS) {
- usb_wait_in_ready();
- i = 0;
- if (bmRequestType == 0x82) {
- UENUM = wIndex;
- if (UECONX & (1<<STALLRQ)) i = 1;
- UENUM = 0;
- }
- UEDATX = i;
- UEDATX = 0;
- usb_send_in();
- return;
- }
- if ((bRequest == CLEAR_FEATURE || bRequest == SET_FEATURE)
- && bmRequestType == 0x02 && wValue == 0) {
- i = wIndex & 0x7F;
- if (i >= 1 && i <= MAX_ENDPOINT) {
- usb_send_in();
- UENUM = i;
- if (bRequest == SET_FEATURE) {
- UECONX = (1<<STALLRQ)|(1<<EPEN);
- } else {
- UECONX = (1<<STALLRQC)|(1<<RSTDT)|(1<<EPEN);
- UERST = (1 << i);
- UERST = 0;
- }
- return;
- }
- }
- }
- UECONX = (1<<STALLRQ) | (1<<EPEN);
- }
-
|