1 /* Teensyduino Core Library
2 * http://www.pjrc.com/teensy/
3 * Copyright (c) 2013 PJRC.COM, LLC.
4 * Modifications by Jacob Alexander (2013-2015)
6 * Permission is hereby granted, free of charge, to any person obtaining
7 * a copy of this software and associated documentation files (the
8 * "Software"), to deal in the Software without restriction, including
9 * without limitation the rights to use, copy, modify, merge, publish,
10 * distribute, sublicense, and/or sell copies of the Software, and to
11 * permit persons to whom the Software is furnished to do so, subject to
12 * the following conditions:
14 * 1. The above copyright notice and this permission notice shall be
15 * included in all copies or substantial portions of the Software.
17 * 2. If the Software is incorporated into a build system that allows
18 * selection among a list of target devices, then similar target
19 * devices manufactured by PJRC.COM must be included in the list of
20 * target devices and selectable in the same manner.
22 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
23 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
24 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
25 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
26 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
27 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
28 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
32 // ----- Includes -----
35 #include <Lib/OutputLib.h>
45 // ----- Defines -----
48 // XXX - Only use when using usbMuxUart Module
49 // Delay causes issues initializing more than 1 hid device (i.e. NKRO keyboard)
50 //#define UART_DEBUG 1
51 // Debug Unknown USB requests, usually what you want to debug USB issues
52 //#define UART_DEBUG_UNKNOWN 1
55 #define TX_STATE_BOTH_FREE_EVEN_FIRST 0
56 #define TX_STATE_BOTH_FREE_ODD_FIRST 1
57 #define TX_STATE_EVEN_FREE 2
58 #define TX_STATE_ODD_FREE 3
59 #define TX_STATE_NONE_FREE_EVEN_FIRST 4
60 #define TX_STATE_NONE_FREE_ODD_FIRST 5
63 #define BDT_DATA1 0x40
64 #define BDT_DATA0 0x00
66 #define BDT_STALL 0x04
77 #define CLEAR_FEATURE 1
80 #define GET_DESCRIPTOR 6
81 #define SET_DESCRIPTOR 7
82 #define GET_CONFIGURATION 8
83 #define SET_CONFIGURATION 9
84 #define GET_INTERFACE 10
85 #define SET_INTERFACE 11
86 #define SYNCH_FRAME 12
88 #define TX_STATE_BOTH_FREE_EVEN_FIRST 0
89 #define TX_STATE_BOTH_FREE_ODD_FIRST 1
90 #define TX_STATE_EVEN_FREE 2
91 #define TX_STATE_ODD_FREE 3
92 #define TX_STATE_NONE_FREE 4
100 #define BDT_PID(n) (((n) >> 2) & 15)
102 #define BDT_DESC(count, data) (BDT_OWN | BDT_DTS \
103 | ((data) ? BDT_DATA1 : BDT_DATA0) \
106 #define index(endpoint, tx, odd) (((endpoint) << 2) | ((tx) << 1) | (odd))
107 #define stat2bufferdescriptor(stat) (table + ((stat) >> 2))
111 // ----- Structs -----
113 // buffer descriptor table
124 uint8_t bmRequestType;
127 uint16_t wRequestAndType;
141 // ----- Variables -----
143 __attribute__ ((section(".usbdescriptortable"), used))
144 static bdt_t table[ (NUM_ENDPOINTS + 1) * 4 ];
146 static usb_packet_t *rx_first [ NUM_ENDPOINTS ];
147 static usb_packet_t *rx_last [ NUM_ENDPOINTS ];
148 static usb_packet_t *tx_first [ NUM_ENDPOINTS ];
149 static usb_packet_t *tx_last [ NUM_ENDPOINTS ];
150 uint16_t usb_rx_byte_count_data[ NUM_ENDPOINTS ];
152 static uint8_t tx_state[NUM_ENDPOINTS];
154 // SETUP always uses a DATA0 PID for the data field of the SETUP transaction.
155 // transactions in the data phase start with DATA1 and toggle (figure 8-12, USB1.1)
156 // Status stage uses a DATA1 PID.
158 static uint8_t ep0_rx0_buf[EP0_SIZE] __attribute__ ((aligned (4)));
159 static uint8_t ep0_rx1_buf[EP0_SIZE] __attribute__ ((aligned (4)));
160 static const uint8_t *ep0_tx_ptr = NULL;
161 static uint16_t ep0_tx_len;
162 static uint8_t ep0_tx_bdt_bank = 0;
163 static uint8_t ep0_tx_data_toggle = 0;
164 uint8_t usb_rx_memory_needed = 0;
166 volatile uint8_t usb_configuration = 0;
167 volatile uint8_t usb_reboot_timer = 0;
169 static uint8_t reply_buffer[8];
173 // ----- Functions -----
175 static void endpoint0_stall()
177 #ifdef UART_DEBUG_UNKNOWN
180 USB0_ENDPT0 = USB_ENDPT_EPSTALL | USB_ENDPT_EPRXEN | USB_ENDPT_EPTXEN | USB_ENDPT_EPHSHK;
183 static void endpoint0_transmit( const void *data, uint32_t len )
185 table[index(0, TX, ep0_tx_bdt_bank)].addr = (void *)data;
186 table[index(0, TX, ep0_tx_bdt_bank)].desc = BDT_DESC(len, ep0_tx_data_toggle);
187 ep0_tx_data_toggle ^= 1;
188 ep0_tx_bdt_bank ^= 1;
191 static void usb_setup()
193 const uint8_t *data = NULL;
194 uint32_t datalen = 0;
195 const usb_descriptor_list_t *list;
197 volatile uint8_t *reg;
202 switch ( setup.wRequestAndType )
204 case 0x0500: // SET_ADDRESS
207 case 0x0900: // SET_CONFIGURATION
209 print("CONFIGURE - ");
211 usb_configuration = setup.wValue;
212 Output_Available = usb_configuration;
214 cfg = usb_endpoint_config_table;
215 // clear all BDT entries, free any allocated memory...
216 for ( i = 4; i < ( NUM_ENDPOINTS + 1) * 4; i++ )
218 if ( table[i].desc & BDT_OWN )
220 usb_free( (usb_packet_t *)((uint8_t *)(table[ i ].addr) - 8) );
223 // free all queued packets
224 for ( i = 0; i < NUM_ENDPOINTS; i++ )
234 rx_first[ i ] = NULL;
243 tx_first[ i ] = NULL;
245 usb_rx_byte_count_data[i] = 0;
247 switch ( tx_state[ i ] )
249 case TX_STATE_EVEN_FREE:
250 case TX_STATE_NONE_FREE_EVEN_FIRST:
251 tx_state[ i ] = TX_STATE_BOTH_FREE_EVEN_FIRST;
253 case TX_STATE_ODD_FREE:
254 case TX_STATE_NONE_FREE_ODD_FIRST:
255 tx_state[ i ] = TX_STATE_BOTH_FREE_ODD_FIRST;
261 usb_rx_memory_needed = 0;
262 for ( i = 1; i <= NUM_ENDPOINTS; i++ )
267 if ( epconf & USB_ENDPT_EPRXEN )
273 table[ index( i, RX, EVEN ) ].addr = p->buf;
274 table[ index( i, RX, EVEN ) ].desc = BDT_DESC( 64, 0 );
278 table[ index( i, RX, EVEN ) ].desc = 0;
279 usb_rx_memory_needed++;
284 table[ index( i, RX, ODD ) ].addr = p->buf;
285 table[ index( i, RX, ODD ) ].desc = BDT_DESC( 64, 1 );
289 table[ index( i, RX, ODD ) ].desc = 0;
290 usb_rx_memory_needed++;
293 table[ index( i, TX, EVEN ) ].desc = 0;
294 table[ index( i, TX, ODD ) ].desc = 0;
298 case 0x0880: // GET_CONFIGURATION
299 reply_buffer[0] = usb_configuration;
304 case 0x0080: // GET_STATUS (device)
311 case 0x0082: // GET_STATUS (endpoint)
312 if ( setup.wIndex > NUM_ENDPOINTS )
314 // TODO: do we need to handle IN vs OUT here?
320 if ( *(uint8_t *)(&USB0_ENDPT0 + setup.wIndex * 4) & 0x02 )
326 case 0x0100: // CLEAR_FEATURE (device)
327 case 0x0101: // CLEAR_FEATURE (interface)
328 // TODO: Currently ignoring, perhaps useful? -HaaTa
329 warn_print("CLEAR_FEATURE - Device/Interface");
333 case 0x0102: // CLEAR_FEATURE (interface)
334 i = setup.wIndex & 0x7F;
335 if ( i > NUM_ENDPOINTS || setup.wValue != 0 )
340 warn_print("CLEAR_FEATURE - Interface");
341 //(*(uint8_t *)(&USB0_ENDPT0 + setup.wIndex * 4)) &= ~0x02;
342 // TODO: do we need to clear the data toggle here?
345 // FIXME: Clearing causes keyboard to freeze, likely an invalid clear
346 // XXX: Ignoring seems to work, though this may not be the ideal behaviour -HaaTa
350 case 0x0300: // SET_FEATURE (device)
351 case 0x0301: // SET_FEATURE (interface)
352 // TODO: Currently ignoring, perhaps useful? -HaaTa
353 warn_print("SET_FEATURE");
357 case 0x0302: // SET_FEATURE (endpoint)
358 i = setup.wIndex & 0x7F;
359 if ( i > NUM_ENDPOINTS || setup.wValue != 0 )
361 // TODO: do we need to handle IN vs OUT here?
365 (*(uint8_t *)(&USB0_ENDPT0 + setup.wIndex * 4)) |= 0x02;
366 // TODO: do we need to clear the data toggle here?
369 case 0x0680: // GET_DESCRIPTOR
373 printHex( setup.wValue );
376 for ( list = usb_descriptor_list; 1; list++ )
378 if ( list->addr == NULL )
380 if ( setup.wValue == list->wValue && setup.wIndex == list->wIndex )
383 if ( (setup.wValue >> 8) == 3 )
385 // for string descriptors, use the descriptor's
386 // length field, allowing runtime configured
388 datalen = *(list->addr);
392 datalen = list->length;
395 print("Desc found, ");
396 printHex32( (uint32_t)data );
400 printHex_op( data[0], 2 );
401 printHex_op( data[1], 2 );
402 printHex_op( data[2], 2 );
403 printHex_op( data[3], 2 );
404 printHex_op( data[4], 2 );
405 printHex_op( data[5], 2 );
412 print( "desc: not found" NL );
417 case 0x2221: // CDC_SET_CONTROL_LINE_STATE
418 usb_cdc_line_rtsdtr = setup.wValue;
419 //serial_print("set control line state\n");
422 case 0x21A1: // CDC_GET_LINE_CODING
423 data = (uint8_t*)usb_cdc_line_coding;
424 datalen = sizeof( usb_cdc_line_coding );
427 case 0x2021: // CDC_SET_LINE_CODING
429 //serial_print("set coding, waiting...\n");
432 case 0x0921: // HID SET_REPORT
434 warn_msg("SET_REPORT - ");
435 printHex( setup.wValue );
437 printHex( setup.wValue & 0xFF );
440 USBKeys_LEDs = setup.wValue & 0xFF;
442 // Must be stall for some reason... -HaaTa
446 case 0x01A1: // HID GET_REPORT
448 print("GET_REPORT - ");
449 printHex( setup.wIndex );
452 // Search through descriptors returning necessary info
453 for ( list = usb_descriptor_list; 1; list++ )
455 if ( list->addr == NULL )
457 if ( list->wValue != 0x2200 )
459 if ( setup.wIndex == list->wIndex )
462 datalen = list->length;
469 case 0x0A21: // HID SET_IDLE
471 print("SET_IDLE - ");
472 printHex( setup.wValue );
475 USBKeys_Idle_Config = (setup.wValue >> 8);
476 USBKeys_Idle_Count = 0;
479 case 0x0B21: // HID SET_PROTOCOL
481 print("SET_PROTOCOL - ");
482 printHex( setup.wValue );
484 printHex( setup.wValue & 0xFF );
487 USBKeys_Protocol = setup.wValue & 0xFF; // 0 - Boot Mode, 1 - NKRO Mode
492 #ifdef UART_DEBUG_UNKNOWN
501 print("setup send ");
502 printHex32( (uint32_t)data );
504 for ( uint8_t c = 0; c < datalen; c++ )
514 if ( datalen > setup.wLength )
515 datalen = setup.wLength;
518 if ( size > EP0_SIZE )
521 endpoint0_transmit(data, size);
525 // See if transmit has finished
526 if ( datalen == 0 && size < EP0_SIZE )
530 if ( size > EP0_SIZE )
532 endpoint0_transmit(data, size);
536 // See if transmit has finished
537 if ( datalen == 0 && size < EP0_SIZE )
540 // Save rest of transfer for later? XXX
542 ep0_tx_len = datalen;
546 //A bulk endpoint's toggle sequence is initialized to DATA0 when the endpoint
547 //experiences any configuration event (configuration events are explained in
548 //Sections 9.1.1.5 and 9.4.5).
550 //Configuring a device or changing an alternate setting causes all of the status
551 //and configuration values associated with endpoints in the affected interfaces
552 //to be set to their default values. This includes setting the data toggle of
553 //any endpoint using data toggles to the value DATA0.
555 //For endpoints using data toggle, regardless of whether an endpoint has the
556 //Halt feature set, a ClearFeature(ENDPOINT_HALT) request always results in the
557 //data toggle being reinitialized to DATA0.
559 static void usb_control( uint32_t stat )
569 b = stat2bufferdescriptor( stat );
570 pid = BDT_PID( b->desc );
582 case 0x0D: // Setup received from host
583 //serial_print("PID=Setup\n");
584 //if (count != 8) ; // panic?
585 // grab the 8 byte setup info
586 setup.word1 = *(uint32_t *)(buf);
587 setup.word2 = *(uint32_t *)(buf + 4);
589 // give the buffer back
590 b->desc = BDT_DESC( EP0_SIZE, DATA1 );
591 //table[index(0, RX, EVEN)].desc = BDT_DESC(EP0_SIZE, 1);
592 //table[index(0, RX, ODD)].desc = BDT_DESC(EP0_SIZE, 1);
594 // clear any leftover pending IN transactions
596 if ( ep0_tx_data_toggle )
599 //if (table[index(0, TX, EVEN)].desc & 0x80) {
600 //serial_print("leftover tx even\n");
602 //if (table[index(0, TX, ODD)].desc & 0x80) {
603 //serial_print("leftover tx odd\n");
605 table[index(0, TX, EVEN)].desc = 0;
606 table[index(0, TX, ODD)].desc = 0;
607 // first IN after Setup is always DATA1
608 ep0_tx_data_toggle = 1;
610 #ifdef UART_DEBUG_UNKNOWN
611 print("bmRequestType:");
612 printHex(setup.bmRequestType);
613 print(", bRequest:");
614 printHex(setup.bRequest);
616 printHex(setup.wValue);
618 printHex(setup.wIndex);
620 printHex(setup.wLength);
623 // actually "do" the setup request
625 // unfreeze the USB, now that we're ready
626 USB0_CTL = USB_CTL_USBENSOFEN; // clear TXSUSPENDTOKENBUSY bit
629 case 0x01: // OUT transaction received from host
635 if ( setup.wRequestAndType == 0x2021 /*CDC_SET_LINE_CODING*/ )
638 uint8_t *dst = (uint8_t *)usb_cdc_line_coding;
639 //serial_print("set line coding ");
640 for ( i = 0; i < 7; i++ )
645 //serial_phex32(usb_cdc_line_coding[0]);
646 //serial_print("\n");
647 if ( usb_cdc_line_coding[0] == 134 )
648 usb_reboot_timer = 15;
649 endpoint0_transmit( NULL, 0 );
652 // Keyboard Interface
653 if ( setup.word1 == 0x02000921 && setup.word2 == ( (1<<16) | KEYBOARD_INTERFACE ) )
655 USBKeys_LEDs = buf[0];
656 endpoint0_transmit( NULL, 0 );
658 // NKRO Keyboard Interface
659 if ( setup.word1 == 0x02000921 && setup.word2 == ( (1<<16) | NKRO_KEYBOARD_INTERFACE ) )
661 USBKeys_LEDs = buf[0];
662 endpoint0_transmit( NULL, 0 );
665 // give the buffer back
666 b->desc = BDT_DESC( EP0_SIZE, DATA1 );
669 case 0x09: // IN transaction completed to host
676 // send remaining data, if any...
681 if (size > EP0_SIZE) size = EP0_SIZE;
682 endpoint0_transmit(data, size);
685 ep0_tx_ptr = (ep0_tx_len > 0 || size == EP0_SIZE) ? data : NULL;
688 if ( setup.bRequest == 5 && setup.bmRequestType == 0 )
692 print("set address: ");
693 printHex(setup.wValue);
696 USB0_ADDR = setup.wValue;
703 print("PID=unknown:");
709 USB0_CTL = USB_CTL_USBENSOFEN; // clear TXSUSPENDTOKENBUSY bit
712 usb_packet_t *usb_rx( uint32_t endpoint )
717 if ( endpoint >= NUM_ENDPOINTS )
720 ret = rx_first[endpoint];
722 rx_first[ endpoint ] = ret->next;
723 usb_rx_byte_count_data[ endpoint ] -= ret->len;
725 //serial_print("rx, epidx=");
726 //serial_phex(endpoint);
727 //serial_print(", packet=");
728 //serial_phex32(ret);
729 //serial_print("\n");
733 static uint32_t usb_queue_byte_count( const usb_packet_t *p )
738 for ( ; p; p = p->next )
746 uint32_t usb_tx_byte_count( uint32_t endpoint )
749 if ( endpoint >= NUM_ENDPOINTS )
751 return usb_queue_byte_count( tx_first[ endpoint ] );
754 uint32_t usb_tx_packet_count( uint32_t endpoint )
756 const usb_packet_t *p;
760 if ( endpoint >= NUM_ENDPOINTS )
763 for ( p = tx_first[ endpoint ]; p; p = p->next )
770 // Called from usb_free, but only when usb_rx_memory_needed > 0, indicating
771 // receive endpoints are starving for memory. The intention is to give
772 // endpoints needing receive memory priority over the user's code, which is
773 // likely calling usb_malloc to obtain memory for transmitting. When the
774 // user is creating data very quickly, their consumption could starve reception
775 // without this prioritization. The packet buffer (input) is assigned to the
776 // first endpoint needing memory.
778 void usb_rx_memory( usb_packet_t *packet )
780 //print("USB RX MEMORY");
784 cfg = usb_endpoint_config_table;
785 //serial_print("rx_mem:");
787 for ( i = 1; i <= NUM_ENDPOINTS; i++ )
789 if ( *cfg++ & USB_ENDPT_EPRXEN )
791 if ( table[ index( i, RX, EVEN ) ].desc == 0 )
793 table[ index( i, RX, EVEN ) ].addr = packet->buf;
794 table[ index( i, RX, EVEN ) ].desc = BDT_DESC( 64, 0 );
795 usb_rx_memory_needed--;
798 //serial_print(",even\n");
801 if ( table[ index( i, RX, ODD ) ].desc == 0 )
803 table[ index( i, RX, ODD ) ].addr = packet->buf;
804 table[ index( i, RX, ODD ) ].desc = BDT_DESC( 64, 1 );
805 usb_rx_memory_needed--;
808 //serial_print(",odd\n");
814 // we should never reach this point. If we get here, it means
815 // usb_rx_memory_needed was set greater than zero, but no memory
816 // was actually needed.
817 usb_rx_memory_needed = 0;
822 //#define index(endpoint, tx, odd) (((endpoint) << 2) | ((tx) << 1) | (odd))
823 //#define stat2bufferdescriptor(stat) (table + ((stat) >> 2))
825 void usb_tx( uint32_t endpoint, usb_packet_t *packet )
827 bdt_t *b = &table[ index( endpoint, TX, EVEN ) ];
831 if ( endpoint >= NUM_ENDPOINTS )
834 //serial_print("txstate=");
835 //serial_phex(tx_state[ endpoint ]);
836 //serial_print("\n");
837 switch ( tx_state[ endpoint ] )
839 case TX_STATE_BOTH_FREE_EVEN_FIRST:
840 next = TX_STATE_ODD_FREE;
842 case TX_STATE_BOTH_FREE_ODD_FIRST:
844 next = TX_STATE_EVEN_FREE;
846 case TX_STATE_EVEN_FREE:
847 next = TX_STATE_NONE_FREE_ODD_FIRST;
849 case TX_STATE_ODD_FREE:
851 next = TX_STATE_NONE_FREE_EVEN_FIRST;
854 if (tx_first[ endpoint ] == NULL)
856 tx_first[ endpoint ] = packet;
860 tx_last[ endpoint ]->next = packet;
862 tx_last[ endpoint ] = packet;
867 tx_state[ endpoint ] = next;
868 b->addr = packet->buf;
869 b->desc = BDT_DESC( packet->len, ((uint32_t)b & 8) ? DATA1 : DATA0 );
874 void usb_device_reload()
876 if ( flashModeEnabled_define == 0 )
879 warn_print("flashModeEnabled not set, cancelling firmware reload...");
880 info_msg("Set flashModeEnabled to 1 in your kll configuration.");
885 #if defined(_mk20dx128vlf5_)
887 // MCHCK Kiibohd Variant
888 // Check to see if PTA3 (has a pull-up) is connected to GND (usually via jumper)
889 // Only allow reload if the jumper is present (security)
890 GPIOA_PDDR &= ~(1<<3); // Input
891 PORTA_PCR3 = PORT_PCR_PFE | PORT_PCR_MUX(1); // Internal pull-up
894 if ( GPIOA_PDIR & (1<<3) && flashModeEnabled_define != 0 )
897 warn_print("Security jumper not present, cancelling firmware reload...");
898 info_msg("Replace jumper on middle 2 pins, or manually press the firmware reload button.");
902 // Copies variable into the VBAT register, must be identical to the variable in the bootloader to jump to the bootloader flash mode
903 for ( int pos = 0; pos < sizeof(sys_reset_to_loader_magic); pos++ )
904 (&VBAT)[ pos ] = sys_reset_to_loader_magic[ pos ];
908 // Kiibohd mk20dx256vlh7
909 #elif defined(_mk20dx256vlh7_)
910 // Copies variable into the VBAT register, must be identical to the variable in the bootloader to jump to the bootloader flash mode
911 for ( int pos = 0; pos < sizeof(sys_reset_to_loader_magic); pos++ )
912 (&VBAT)[ pos ] = sys_reset_to_loader_magic[ pos ];
915 // Teensy 3.0 and 3.1
917 asm volatile("bkpt");
924 uint8_t status, stat, t;
926 //serial_print("isr");
927 //status = USB0_ISTAT;
928 //serial_phex(status);
929 //serial_print("\n");
933 print("USB ISR STATUS: ");
938 if ( (status & USB_INTEN_SOFTOKEN /* 04 */ ) )
940 if ( usb_configuration )
942 t = usb_reboot_timer;
945 usb_reboot_timer = --t;
951 t = usb_cdc_transmit_flush_timer;
954 usb_cdc_transmit_flush_timer = --t;
956 usb_serial_flush_callback();
960 USB0_ISTAT = USB_INTEN_SOFTOKEN;
963 if ( (status & USB_ISTAT_TOKDNE /* 08 */ ) )
967 //serial_print("token: ep=");
968 //serial_phex(stat >> 4);
969 //serial_print(stat & 0x08 ? ",tx" : ",rx");
970 //serial_print(stat & 0x04 ? ",odd\n" : ",even\n");
971 endpoint = stat >> 4;
978 bdt_t *b = stat2bufferdescriptor(stat);
979 usb_packet_t *packet = (usb_packet_t *)((uint8_t *)(b->addr) - 8);
982 serial_phex(endpoint);
983 serial_print(", pid:");
984 serial_phex(BDT_PID(b->desc));
985 serial_print(((uint32_t)b & 8) ? ", odd" : ", even");
986 serial_print(", count:");
987 serial_phex(b->desc >> 16);
990 endpoint--; // endpoint is index to zero-based arrays
995 packet = tx_first[ endpoint ];
998 //serial_print("tx packet\n");
999 tx_first[endpoint] = packet->next;
1000 b->addr = packet->buf;
1001 switch ( tx_state[ endpoint ] )
1003 case TX_STATE_BOTH_FREE_EVEN_FIRST:
1004 tx_state[ endpoint ] = TX_STATE_ODD_FREE;
1006 case TX_STATE_BOTH_FREE_ODD_FIRST:
1007 tx_state[ endpoint ] = TX_STATE_EVEN_FREE;
1009 case TX_STATE_EVEN_FREE:
1010 tx_state[ endpoint ] = TX_STATE_NONE_FREE_ODD_FIRST;
1012 case TX_STATE_ODD_FREE:
1013 tx_state[ endpoint ] = TX_STATE_NONE_FREE_EVEN_FIRST;
1018 b->desc = BDT_DESC( packet->len, ((uint32_t)b & 8) ? DATA1 : DATA0 );
1020 //serial_print("tx no packet\n");
1021 switch ( tx_state[ endpoint ] )
1023 case TX_STATE_BOTH_FREE_EVEN_FIRST:
1024 case TX_STATE_BOTH_FREE_ODD_FIRST:
1026 case TX_STATE_EVEN_FREE:
1027 tx_state[ endpoint ] = TX_STATE_BOTH_FREE_EVEN_FIRST;
1029 case TX_STATE_ODD_FREE:
1030 tx_state[ endpoint ] = TX_STATE_BOTH_FREE_ODD_FIRST;
1033 tx_state[ endpoint ] = ((uint32_t)b & 8)
1035 : TX_STATE_EVEN_FREE;
1042 packet->len = b->desc >> 16;
1043 if ( packet->len > 0 )
1046 packet->next = NULL;
1047 if ( rx_first[ endpoint ] == NULL )
1049 //serial_print("rx 1st, epidx=");
1050 //serial_phex(endpoint);
1051 //serial_print(", packet=");
1052 //serial_phex32((uint32_t)packet);
1053 //serial_print("\n");
1054 rx_first[ endpoint ] = packet;
1058 //serial_print("rx Nth, epidx=");
1059 //serial_phex(endpoint);
1060 //serial_print(", packet=");
1061 //serial_phex32((uint32_t)packet);
1062 //serial_print("\n");
1063 rx_last[ endpoint ]->next = packet;
1065 rx_last[ endpoint ] = packet;
1066 usb_rx_byte_count_data[ endpoint ] += packet->len;
1067 // TODO: implement a per-endpoint maximum # of allocated packets
1068 // so a flood of incoming data on 1 endpoint doesn't starve
1069 // the others if the user isn't reading it regularly
1070 packet = usb_malloc();
1073 b->addr = packet->buf;
1074 b->desc = BDT_DESC( 64, ((uint32_t)b & 8) ? DATA1 : DATA0 );
1078 //serial_print("starving ");
1079 //serial_phex(endpoint + 1);
1080 //serial_print(((uint32_t)b & 8) ? ",odd\n" : ",even\n");
1082 usb_rx_memory_needed++;
1087 b->desc = BDT_DESC( 64, ((uint32_t)b & 8) ? DATA1 : DATA0 );
1095 USB0_ISTAT = USB_ISTAT_TOKDNE;
1100 if ( status & USB_ISTAT_USBRST /* 01 */ )
1102 //serial_print("reset\n");
1104 // initialize BDT toggle bits
1105 USB0_CTL = USB_CTL_ODDRST;
1106 ep0_tx_bdt_bank = 0;
1108 // set up buffers to receive Setup and OUT packets
1109 table[index( 0, RX, EVEN ) ].desc = BDT_DESC( EP0_SIZE, 0 );
1110 table[index( 0, RX, EVEN ) ].addr = ep0_rx0_buf;
1111 table[index( 0, RX, ODD ) ].desc = BDT_DESC( EP0_SIZE, 0 );
1112 table[index( 0, RX, ODD ) ].addr = ep0_rx1_buf;
1113 table[index( 0, TX, EVEN ) ].desc = 0;
1114 table[index( 0, TX, ODD ) ].desc = 0;
1116 // activate endpoint 0
1117 USB0_ENDPT0 = USB_ENDPT_EPRXEN | USB_ENDPT_EPTXEN | USB_ENDPT_EPHSHK;
1119 // clear all ending interrupts
1120 USB0_ERRSTAT = 0xFF;
1123 // set the address to zero during enumeration
1126 // enable other interrupts
1128 USB0_INTEN = USB_INTEN_TOKDNEEN |
1129 USB_INTEN_SOFTOKEN |
1132 USB_INTEN_USBRSTEN |
1135 // is this necessary?
1136 USB0_CTL = USB_CTL_USBENSOFEN;
1141 if ( (status & USB_ISTAT_STALL /* 80 */ ) )
1143 //serial_print("stall:\n");
1144 USB0_ENDPT0 = USB_ENDPT_EPRXEN | USB_ENDPT_EPTXEN | USB_ENDPT_EPHSHK;
1145 USB0_ISTAT = USB_ISTAT_STALL;
1147 if ( (status & USB_ISTAT_ERROR /* 02 */ ) )
1149 uint8_t err = USB0_ERRSTAT;
1151 //serial_print("err:");
1153 //serial_print("\n");
1154 USB0_ISTAT = USB_ISTAT_ERROR;
1157 if ( (status & USB_ISTAT_SLEEP /* 10 */ ) )
1159 //serial_print("sleep\n");
1160 USB0_ISTAT = USB_ISTAT_SLEEP;
1169 print("USB INIT"NL);
1172 // Clear out endpoints table
1173 for ( int i = 0; i <= NUM_ENDPOINTS * 4; i++ )
1179 // this basically follows the flowchart in the Kinetis
1180 // Quick Reference User Guide, Rev. 1, 03/2012, page 141
1182 // assume 48 MHz clock already running
1183 // SIM - enable clock
1184 SIM_SCGC4 |= SIM_SCGC4_USBOTG;
1187 USB0_USBTRC0 = USB_USBTRC_USBRESET;
1188 while ( (USB0_USBTRC0 & USB_USBTRC_USBRESET) != 0 ); // wait for reset to end
1190 // set desc table base addr
1191 USB0_BDTPAGE1 = ((uint32_t)table) >> 8;
1192 USB0_BDTPAGE2 = ((uint32_t)table) >> 16;
1193 USB0_BDTPAGE3 = ((uint32_t)table) >> 24;
1195 // clear all ISR flags
1197 USB0_ERRSTAT = 0xFF;
1198 USB0_OTGISTAT = 0xFF;
1200 USB0_USBTRC0 |= 0x40; // undocumented bit
1203 USB0_CTL = USB_CTL_USBENSOFEN;
1206 // enable reset interrupt
1207 USB0_INTEN = USB_INTEN_USBRSTEN;
1209 // enable interrupt in NVIC...
1210 NVIC_SET_PRIORITY( IRQ_USBOTG, 112 );
1211 NVIC_ENABLE_IRQ( IRQ_USBOTG );
1214 USB0_CONTROL = USB_CONTROL_DPPULLUPNONOTG;
1219 // return 0 if the USB is not configured, or the configuration
1220 // number selected by the HOST
1221 uint8_t usb_configured()
1223 return usb_configuration;