|
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961 |
-
-
-
- #include "usb_common.h"
- #include "usb_private.h"
-
-
-
-
-
-
- static const uint8_t PROGMEM endpoint_config_table[] = {
- EP_TYPE_INTERRUPT_IN, EP_SIZE(DEBUG_TX_SIZE) | DEBUG_TX_BUFFER,
- EP_TYPE_INTERRUPT_OUT, EP_SIZE(DEBUG_RX_SIZE) | DEBUG_RX_BUFFER,
- EP_TYPE_INTERRUPT_IN, EP_SIZE(KEYBOARD_SIZE) | KEYBOARD_BUFFER,
- EP_TYPE_INTERRUPT_IN, EP_SIZE(MOUSE_SIZE) | MOUSE_BUFFER,
- EP_TYPE_INTERRUPT_IN, EP_SIZE(JOYSTICK_SIZE) | JOYSTICK_BUFFER,
- EP_TYPE_INTERRUPT_IN, EP_SIZE(KEYMEDIA_SIZE) | KEYMEDIA_BUFFER,
- };
-
-
-
-
-
-
-
-
-
-
- static const uint8_t PROGMEM device_descriptor[] = {
- 18,
- 1,
- 0x00, 0x02,
- 0,
- 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
- 0x05, 0x01,
- #endif
- 0,
- 1,
- 0,
- 1
- };
-
-
- static const uint8_t PROGMEM keyboard_hid_report_desc[] = {
- 0x05, 0x01,
- 0x09, 0x06,
- 0xA1, 0x01,
- 0x75, 0x01,
- 0x95, 0x08,
- 0x05, 0x07,
- 0x19, 0xE0,
- 0x29, 0xE7,
- 0x15, 0x00,
- 0x25, 0x01,
- 0x81, 0x02,
- 0x95, 0x01,
- 0x75, 0x08,
- 0x81, 0x03,
- 0x95, 0x05,
- 0x75, 0x01,
- 0x05, 0x08,
- 0x19, 0x01,
- 0x29, 0x05,
- 0x91, 0x02,
- 0x95, 0x01,
- 0x75, 0x03,
- 0x91, 0x03,
- 0x95, 0x06,
- 0x75, 0x08,
- 0x15, 0x00,
- 0x25, 0x7F,
- 0x05, 0x07,
- 0x19, 0x00,
- 0x29, 0x7F,
- 0x81, 0x00,
- 0xc0
- };
-
- static const uint8_t PROGMEM keymedia_hid_report_desc[] = {
- 0x05, 0x0C,
- 0x09, 0x01,
- 0xA1, 0x01,
- 0x75, 0x0A,
- 0x95, 0x04,
- 0x19, 0x00,
- 0x2A, 0x9C, 0x02,
- 0x15, 0x00,
- 0x26, 0x9C, 0x02,
- 0x81, 0x00,
- 0x05, 0x01,
- 0x75, 0x08,
- 0x95, 0x03,
- 0x19, 0x00,
- 0x29, 0xB7,
- 0x15, 0x00,
- 0x26, 0xB7, 0x00,
- 0x81, 0x00,
- 0xC0
- };
-
-
- static const uint8_t PROGMEM mouse_hid_report_desc[] = {
- 0x05, 0x01,
- 0x09, 0x02,
- 0xA1, 0x01,
- 0x05, 0x09,
- 0x19, 0x01,
- 0x29, 0x08,
- 0x15, 0x00,
- 0x25, 0x01,
- 0x95, 0x08,
- 0x75, 0x01,
- 0x81, 0x02,
- 0x05, 0x01,
- 0x09, 0x30,
- 0x09, 0x31,
- 0x09, 0x38,
- 0x15, 0x81,
- 0x25, 0x7F,
- 0x75, 0x08,
- 0x95, 0x03,
- 0x81, 0x06,
- 0x05, 0x0C,
- 0x0A, 0x38, 0x02,
- 0x15, 0x81,
- 0x25, 0x7F,
- 0x75, 0x08,
- 0x95, 0x01,
- 0x81, 0x06,
- 0xC0
- };
-
- #ifdef JOYSTICK_INTERFACE
- static const uint8_t PROGMEM joystick_hid_report_desc[] = {
- 0x05, 0x01,
- 0x09, 0x04,
- 0xA1, 0x01,
- 0x15, 0x00,
- 0x25, 0x01,
- 0x75, 0x01,
- 0x95, 0x20,
- 0x05, 0x09,
- 0x19, 0x01,
- 0x29, 0x20,
- 0x81, 0x02,
- 0x15, 0x00,
- 0x25, 0x07,
- 0x35, 0x00,
- 0x46, 0x3B, 0x01,
- 0x75, 0x04,
- 0x95, 0x01,
- 0x65, 0x14,
- 0x05, 0x01,
- 0x09, 0x39,
- 0x81, 0x42,
- 0x05, 0x01,
- 0x09, 0x01,
- 0xA1, 0x00,
- 0x15, 0x00,
- 0x26, 0xFF, 0x03,
- 0x75, 0x0A,
- 0x95, 0x04,
- 0x09, 0x30,
- 0x09, 0x31,
- 0x09, 0x32,
- 0x09, 0x35,
- 0x81, 0x02,
- 0xC0,
- 0x15, 0x00,
- 0x26, 0xFF, 0x03,
- 0x75, 0x0A,
- 0x95, 0x02,
- 0x09, 0x36,
- 0x09, 0x36,
- 0x81, 0x02,
- 0xC0
- };
- #endif
-
-
-
-
-
-
-
- static const uint8_t PROGMEM debug_hid_report_desc[] = {
- 0x06, 0xC9, 0xFF,
- 0x09, 0x04,
- 0xA1, 0x5C,
- 0x75, 0x08,
- 0x15, 0x00,
- 0x26, 0xFF, 0x00,
- 0x95, DEBUG_TX_SIZE,
- 0x09, 0x75,
- 0x81, 0x02,
- 0x95, DEBUG_RX_SIZE,
- 0x09, 0x76,
- 0x91, 0x02,
- 0x95, 0x04,
- 0x09, 0x76,
- 0xB1, 0x02,
- 0xC0
- };
-
-
-
- #define KEYBOARD_HID_DESC_OFFSET ( 9 + 9 )
- #define MOUSE_HID_DESC_OFFSET ( 9 + 9+9+7 + 9 )
- #define DEBUG_HID_DESC_OFFSET ( 9 + 9+9+7 + 9+9+7 + 9 )
- #define JOYSTICK_HID_DESC_OFFSET ( 9 + 9+9+7 + 9+9+7 + 9+9+7+7 + 9 )
- #define KEYMEDIA_HID_DESC_OFFSET ( 9 + 9+9+7 + 9+9+7 + 9+9+7+7 + 9+9+7 + 9 )
- #define CONFIG1_DESC_SIZE ( 9 + 9+9+7 + 9+9+7 + 9+9+7+7 + 9+9+7 + 9+9+7 )
-
- static const uint8_t PROGMEM config1_descriptor[CONFIG1_DESC_SIZE] = {
-
- 9,
- 2,
- LSB(CONFIG1_DESC_SIZE),
- MSB(CONFIG1_DESC_SIZE),
- NUM_INTERFACE,
- 1,
- 0,
- 0xC0,
- 50,
-
-
- 9,
- 4,
- KEYBOARD_INTERFACE,
- 0,
- 1,
- 0x03,
- 0x01,
- 0x01,
- 0,
-
- 9,
- 0x21,
- 0x11, 0x01,
- 0,
- 1,
- 0x22,
- sizeof(keyboard_hid_report_desc),
- 0,
-
- 7,
- 5,
- KEYBOARD_ENDPOINT | 0x80,
- 0x03,
- KEYBOARD_SIZE, 0,
- KEYBOARD_INTERVAL,
-
-
- 9,
- 4,
- MOUSE_INTERFACE,
- 0,
- 1,
- 0x03,
- 0x01,
- 0x02,
- 0,
-
- 9,
- 0x21,
- 0x11, 0x01,
- 0,
- 1,
- 0x22,
- sizeof(mouse_hid_report_desc),
- 0,
-
- 7,
- 5,
- MOUSE_ENDPOINT | 0x80,
- 0x03,
- MOUSE_SIZE, 0,
- MOUSE_INTERVAL,
-
-
- 9,
- 4,
- DEBUG_INTERFACE,
- 0,
- 2,
- 0x03,
- 0x00,
- 0x00,
- 0,
-
- 9,
- 0x21,
- 0x11, 0x01,
- 0,
- 1,
- 0x22,
- sizeof(debug_hid_report_desc),
- 0,
-
- 7,
- 5,
- DEBUG_TX_ENDPOINT | 0x80,
- 0x03,
- DEBUG_TX_SIZE, 0,
- DEBUG_TX_INTERVAL,
-
- 7,
- 5,
- DEBUG_RX_ENDPOINT,
- 0x03,
- DEBUG_RX_SIZE, 0,
- DEBUG_RX_INTERVAL,
-
-
- 9,
- 4,
- JOYSTICK_INTERFACE,
- 0,
- 1,
- 0x03,
- 0x00,
- 0x00,
- 0,
-
- 9,
- 0x21,
- 0x11, 0x01,
- 0,
- 1,
- 0x22,
- sizeof(joystick_hid_report_desc),
- 0,
-
- 7,
- 5,
- JOYSTICK_ENDPOINT | 0x80,
- 0x03,
- 12, 0,
- JOYSTICK_INTERVAL,
-
-
- 9,
- 4,
- KEYMEDIA_INTERFACE,
- 0,
- 1,
- 0x03,
- 0x00,
- 0x00,
- 0,
-
- 9,
- 0x21,
- 0x11, 0x01,
- 0,
- 1,
- 0x22,
- LSB(sizeof(keymedia_hid_report_desc)),
- MSB(sizeof(keymedia_hid_report_desc)),
-
- 7,
- 5,
- KEYMEDIA_ENDPOINT | 0x80,
- 0x03,
- KEYMEDIA_SIZE, 0,
- KEYMEDIA_INTERVAL,
- };
-
-
-
-
- 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_PRODUCT),
- 3,
- STR_PRODUCT
- };
-
-
-
- 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)},
- {0x2200, KEYBOARD_INTERFACE, keyboard_hid_report_desc, sizeof(keyboard_hid_report_desc)},
- {0x2100, KEYBOARD_INTERFACE, config1_descriptor+KEYBOARD_HID_DESC_OFFSET, 9},
- {0x2200, MOUSE_INTERFACE, mouse_hid_report_desc, sizeof(mouse_hid_report_desc)},
- {0x2100, MOUSE_INTERFACE, config1_descriptor+MOUSE_HID_DESC_OFFSET, 9},
- {0x2200, DEBUG_INTERFACE, debug_hid_report_desc, sizeof(debug_hid_report_desc)},
- {0x2100, DEBUG_INTERFACE, config1_descriptor+DEBUG_HID_DESC_OFFSET, 9},
- {0x2200, JOYSTICK_INTERFACE, joystick_hid_report_desc, sizeof(joystick_hid_report_desc)},
- {0x2100, JOYSTICK_INTERFACE, config1_descriptor+JOYSTICK_HID_DESC_OFFSET, 9},
- {0x2200, KEYMEDIA_INTERFACE, keymedia_hid_report_desc, sizeof(keymedia_hid_report_desc)},
- {0x2100, KEYMEDIA_INTERFACE, config1_descriptor+KEYMEDIA_HID_DESC_OFFSET, 9},
- {0x0300, 0x0000, (const uint8_t *)&string0, 4},
- {0x0301, 0x0409, (const uint8_t *)&string1, sizeof(STR_PRODUCT)},
- };
- #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 debug_flush_timer USBSTATE;
-
-
-
-
-
-
- uint8_t keyboard_report_data[8] USBSTATE;
-
-
-
-
- static uint8_t keyboard_protocol USBSTATE;
-
-
-
- static uint8_t keyboard_idle_config USBSTATE;
-
-
- uint8_t keyboard_idle_count USBSTATE;
-
-
- volatile uint8_t keyboard_leds USBSTATE;
-
-
- uint8_t mouse_buttons USBSTATE;
-
-
-
-
- static uint8_t mouse_protocol USBSTATE;
-
-
- uint8_t joystick_report_data[12] USBSTATE;
-
-
- uint8_t keymedia_report_data[8] USBSTATE;
- uint16_t keymedia_consumer_keys[4] USBSTATE;
- uint8_t keymedia_system_keys[3] 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;
- debug_flush_timer = 0;
- keyboard_report_data[0] = 0;
- keyboard_report_data[1] = 0;
- keyboard_report_data[2] = 0;
- keyboard_report_data[3] = 0;
- keyboard_report_data[4] = 0;
- keyboard_report_data[5] = 0;
- keyboard_report_data[6] = 0;
- keyboard_report_data[7] = 0;
- keyboard_protocol = 1;
- keyboard_idle_config = 125;
- keyboard_idle_count = 0;
- keyboard_leds = 0;
- mouse_buttons = 0;
- mouse_protocol = 1;
- joystick_report_data[0] = 0;
- joystick_report_data[1] = 0;
- joystick_report_data[2] = 0;
- joystick_report_data[3] = 0;
- joystick_report_data[4] = 0x0F;
- joystick_report_data[5] = 0x20;
- joystick_report_data[6] = 0x80;
- joystick_report_data[7] = 0x00;
- joystick_report_data[8] = 0x02;
- joystick_report_data[9] = 0x08;
- joystick_report_data[10] = 0x20;
- joystick_report_data[11] = 0x80;
- keymedia_report_data[0] = 0;
- keymedia_report_data[1] = 0;
- keymedia_report_data[2] = 0;
- keymedia_report_data[3] = 0;
- keymedia_report_data[4] = 0;
- keymedia_report_data[5] = 0;
- keymedia_report_data[6] = 0;
- keymedia_report_data[7] = 0;
- keymedia_consumer_keys[0] = 0;
- keymedia_consumer_keys[1] = 0;
- keymedia_consumer_keys[2] = 0;
- keymedia_consumer_keys[3] = 0;
- keymedia_system_keys[0] = 0;
- keymedia_system_keys[1] = 0;
- keymedia_system_keys[2] = 0;
- UDINT = 0;
- UDIEN = (1<<EORSTE)|(1<<SOFE);
-
- }
-
- 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, i;
- static uint8_t div4=0;
-
- 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;
- }
- if ((intbits & (1<<SOFI)) && usb_configuration) {
- t = debug_flush_timer;
- if (t) {
- debug_flush_timer = -- t;
- if (!t) {
- UENUM = DEBUG_TX_ENDPOINT;
- while ((UEINTX & (1<<RWAL))) {
- UEDATX = 0;
- }
- UEINTX = 0x3A;
- }
- }
- if (keyboard_idle_config && (++div4 & 3) == 0) {
- UENUM = KEYBOARD_ENDPOINT;
- if (UEINTX & (1<<RWAL)) {
- keyboard_idle_count++;
- if (keyboard_idle_count == keyboard_idle_config) {
- keyboard_idle_count = 0;
-
- for (i=0; i < 8; i++) {
- UEDATX = keyboard_report_data[i];
- }
- UEINTX = 0x3A;
- }
- }
- }
- }
- 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;
- uint8_t bmRequestType;
- uint8_t bRequest;
- uint16_t wValue;
- uint16_t wIndex;
- uint16_t wLength;
- uint16_t desc_val;
- 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;
- debug_flush_timer = 0;
- usb_send_in();
- cfg = endpoint_config_table;
- for (i=1; i<7; i++) {
- UENUM = i;
- UECONX = 1;
- 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 == 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 <= NUM_ENDPOINTS) {
- 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;
- }
- }
- if (wIndex == KEYBOARD_INTERFACE) {
- if (bmRequestType == 0xA1) {
- if (bRequest == HID_GET_REPORT) {
- usb_wait_in_ready();
-
- for (i=0; i < 8; i++) {
- UEDATX = keyboard_report_data[i];
- }
- usb_send_in();
- return;
- }
- if (bRequest == HID_GET_IDLE) {
- usb_wait_in_ready();
- UEDATX = keyboard_idle_config;
- usb_send_in();
- return;
- }
- if (bRequest == HID_GET_PROTOCOL) {
- usb_wait_in_ready();
- UEDATX = keyboard_protocol;
- usb_send_in();
- return;
- }
- }
- if (bmRequestType == 0x21) {
- if (bRequest == HID_SET_REPORT) {
- usb_wait_receive_out();
- keyboard_leds = UEDATX;
- usb_ack_out();
- usb_send_in();
- return;
- }
- if (bRequest == HID_SET_IDLE) {
- keyboard_idle_config = (wValue >> 8);
- keyboard_idle_count = 0;
-
- usb_send_in();
- return;
- }
- if (bRequest == HID_SET_PROTOCOL) {
- keyboard_protocol = wValue;
-
- usb_send_in();
- return;
- }
- }
- }
- if (wIndex == MOUSE_INTERFACE) {
- if (bmRequestType == 0xA1) {
- if (bRequest == HID_GET_REPORT) {
- usb_wait_in_ready();
- UEDATX = mouse_buttons;
- UEDATX = 0;
- UEDATX = 0;
- UEDATX = 0;
- UEDATX = 0;
- usb_send_in();
- return;
- }
- if (bRequest == HID_GET_PROTOCOL) {
- usb_wait_in_ready();
- UEDATX = mouse_protocol;
- usb_send_in();
- return;
- }
- }
- if (bmRequestType == 0x21) {
- if (bRequest == HID_SET_PROTOCOL) {
- mouse_protocol = wValue;
- usb_send_in();
- return;
- }
- }
- }
- if (wIndex == JOYSTICK_INTERFACE) {
- if (bmRequestType == 0xA1) {
- if (bRequest == HID_GET_REPORT) {
- usb_wait_in_ready();
- for (i=0; i<12; i++) {
- UEDATX = joystick_report_data[i];
- }
- usb_send_in();
- return;
- }
- }
- }
- if (wIndex == KEYMEDIA_INTERFACE) {
- if (bmRequestType == 0xA1) {
- if (bRequest == HID_GET_REPORT) {
- usb_wait_in_ready();
- for (i=0; i<8; i++) {
- UEDATX = keymedia_report_data[i];
- }
- usb_send_in();
- return;
- }
- }
- }
- if (wIndex == DEBUG_INTERFACE) {
- if (bRequest == HID_GET_REPORT && bmRequestType == 0xA1) {
- len = wLength;
- 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--) {
- UEDATX = 0;
- }
- len -= n;
- usb_send_in();
- } while (len || n == ENDPOINT0_SIZE);
- return;
- }
- if (bRequest == HID_SET_REPORT && bmRequestType == 0x21) {
- if (wValue == 0x0300 && wLength == 0x0004) {
- uint8_t b1, b2, b3, b4;
- usb_wait_receive_out();
- b1 = UEDATX;
- b2 = UEDATX;
- b3 = UEDATX;
- b4 = UEDATX;
- usb_ack_out();
- usb_send_in();
- if (b1 == 0xA9 && b2 == 0x45 && b3 == 0xC2 && b4 == 0x6B)
- _reboot_Teensyduino_();
- if (b1 == 0x8B && b2 == 0xC5 && b3 == 0x1D && b4 == 0x70)
- _restart_Teensyduino_();
- }
- }
- }
- if (bRequest == 0xC9 && bmRequestType == 0x40) {
- usb_send_in();
- usb_wait_in_ready();
- _restart_Teensyduino_();
- }
- }
- UECONX = (1<<STALLRQ) | (1<<EPEN);
- }
-
-
|