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 (endpoint)
334 i = setup.wIndex & 0x7F;
335 if ( i > NUM_ENDPOINTS || setup.wValue != 0 )
340 (*(uint8_t *)(&USB0_ENDPT0 + setup.wIndex * 4)) &= ~0x02;
341 // TODO: do we need to clear the data toggle here?
344 case 0x0300: // SET_FEATURE (device)
345 case 0x0301: // SET_FEATURE (interface)
346 // TODO: Currently ignoring, perhaps useful? -HaaTa
347 warn_print("SET_FEATURE - Device/Interface");
351 case 0x0302: // SET_FEATURE (endpoint)
352 i = setup.wIndex & 0x7F;
353 if ( i > NUM_ENDPOINTS || setup.wValue != 0 )
355 // TODO: do we need to handle IN vs OUT here?
359 (*(uint8_t *)(&USB0_ENDPT0 + setup.wIndex * 4)) |= 0x02;
360 // TODO: do we need to clear the data toggle here?
363 case 0x0680: // GET_DESCRIPTOR
367 printHex( setup.wValue );
370 for ( list = usb_descriptor_list; 1; list++ )
372 if ( list->addr == NULL )
374 if ( setup.wValue == list->wValue && setup.wIndex == list->wIndex )
377 if ( (setup.wValue >> 8) == 3 )
379 // for string descriptors, use the descriptor's
380 // length field, allowing runtime configured
382 datalen = *(list->addr);
386 datalen = list->length;
389 print("Desc found, ");
390 printHex32( (uint32_t)data );
394 printHex_op( data[0], 2 );
395 printHex_op( data[1], 2 );
396 printHex_op( data[2], 2 );
397 printHex_op( data[3], 2 );
398 printHex_op( data[4], 2 );
399 printHex_op( data[5], 2 );
406 print( "desc: not found" NL );
411 case 0x2221: // CDC_SET_CONTROL_LINE_STATE
412 usb_cdc_line_rtsdtr = setup.wValue;
413 //serial_print("set control line state\n");
416 case 0x21A1: // CDC_GET_LINE_CODING
417 data = (uint8_t*)usb_cdc_line_coding;
418 datalen = sizeof( usb_cdc_line_coding );
421 case 0x2021: // CDC_SET_LINE_CODING
423 //serial_print("set coding, waiting...\n");
426 case 0x0921: // HID SET_REPORT
428 switch ( setup.wIndex & 0xFF )
430 // Keyboard Interface
431 case KEYBOARD_INTERFACE:
433 // NKRO Keyboard Interface
434 case NKRO_KEYBOARD_INTERFACE:
437 warn_msg("Unknown interface - ");
438 printHex( setup.wIndex );
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);
622 printHex32(setup.word1);
624 printHex32(setup.word2);
627 // actually "do" the setup request
629 // unfreeze the USB, now that we're ready
630 USB0_CTL = USB_CTL_USBENSOFEN; // clear TXSUSPENDTOKENBUSY bit
633 case 0x01: // OUT transaction received from host
635 #ifdef UART_DEBUG_UNKNOWN
636 print("PID=OUT wRequestAndType:");
637 printHex(setup.wRequestAndType);
639 printHex(setup.wValue);
641 printHex(setup.wIndex);
643 printHex(setup.wLength);
645 printHex32(setup.word1);
647 printHex32(setup.word2);
652 if ( setup.wRequestAndType == 0x2021 /*CDC_SET_LINE_CODING*/ )
655 uint8_t *dst = (uint8_t *)usb_cdc_line_coding;
656 //serial_print("set line coding ");
657 for ( i = 0; i < 7; i++ )
662 //serial_phex32(usb_cdc_line_coding[0]);
663 //serial_print("\n");
664 if ( usb_cdc_line_coding[0] == 134 )
665 usb_reboot_timer = 15;
666 endpoint0_transmit( NULL, 0 );
669 // Keyboard SET_REPORT
670 if ( setup.wRequestAndType == 0x921 && setup.wValue & 0x200 )
673 switch ( setup.wIndex & 0xFF )
675 // Keyboard Interface
676 case KEYBOARD_INTERFACE:
677 USBKeys_LEDs = buf[0];
678 endpoint0_transmit( NULL, 0 );
680 // NKRO Keyboard Interface
681 case NKRO_KEYBOARD_INTERFACE:
682 // Only use 2nd byte, first byte is the report id
683 USBKeys_LEDs = buf[1];
684 endpoint0_transmit( NULL, 0 );
687 warn_msg("Unknown interface - ");
688 printHex( setup.wIndex );
694 for ( size_t len = 0; len < setup.wLength; len++ )
696 printHex( buf[ len ] );
703 // give the buffer back
704 b->desc = BDT_DESC( EP0_SIZE, DATA1 );
707 case 0x09: // IN transaction completed to host
714 // send remaining data, if any...
719 if (size > EP0_SIZE) size = EP0_SIZE;
720 endpoint0_transmit(data, size);
723 ep0_tx_ptr = (ep0_tx_len > 0 || size == EP0_SIZE) ? data : NULL;
726 if ( setup.bRequest == 5 && setup.bmRequestType == 0 )
730 print("set address: ");
731 printHex(setup.wValue);
734 USB0_ADDR = setup.wValue;
741 print("PID=unknown:");
747 USB0_CTL = USB_CTL_USBENSOFEN; // clear TXSUSPENDTOKENBUSY bit
750 usb_packet_t *usb_rx( uint32_t endpoint )
755 if ( endpoint >= NUM_ENDPOINTS )
758 ret = rx_first[endpoint];
760 rx_first[ endpoint ] = ret->next;
761 usb_rx_byte_count_data[ endpoint ] -= ret->len;
763 //serial_print("rx, epidx=");
764 //serial_phex(endpoint);
765 //serial_print(", packet=");
766 //serial_phex32(ret);
767 //serial_print("\n");
771 static uint32_t usb_queue_byte_count( const usb_packet_t *p )
776 for ( ; p; p = p->next )
784 uint32_t usb_tx_byte_count( uint32_t endpoint )
787 if ( endpoint >= NUM_ENDPOINTS )
789 return usb_queue_byte_count( tx_first[ endpoint ] );
792 uint32_t usb_tx_packet_count( uint32_t endpoint )
794 const usb_packet_t *p;
798 if ( endpoint >= NUM_ENDPOINTS )
801 for ( p = tx_first[ endpoint ]; p; p = p->next )
808 // Called from usb_free, but only when usb_rx_memory_needed > 0, indicating
809 // receive endpoints are starving for memory. The intention is to give
810 // endpoints needing receive memory priority over the user's code, which is
811 // likely calling usb_malloc to obtain memory for transmitting. When the
812 // user is creating data very quickly, their consumption could starve reception
813 // without this prioritization. The packet buffer (input) is assigned to the
814 // first endpoint needing memory.
816 void usb_rx_memory( usb_packet_t *packet )
818 //print("USB RX MEMORY");
822 cfg = usb_endpoint_config_table;
823 //serial_print("rx_mem:");
825 for ( i = 1; i <= NUM_ENDPOINTS; i++ )
827 if ( *cfg++ & USB_ENDPT_EPRXEN )
829 if ( table[ index( i, RX, EVEN ) ].desc == 0 )
831 table[ index( i, RX, EVEN ) ].addr = packet->buf;
832 table[ index( i, RX, EVEN ) ].desc = BDT_DESC( 64, 0 );
833 usb_rx_memory_needed--;
836 //serial_print(",even\n");
839 if ( table[ index( i, RX, ODD ) ].desc == 0 )
841 table[ index( i, RX, ODD ) ].addr = packet->buf;
842 table[ index( i, RX, ODD ) ].desc = BDT_DESC( 64, 1 );
843 usb_rx_memory_needed--;
846 //serial_print(",odd\n");
852 // we should never reach this point. If we get here, it means
853 // usb_rx_memory_needed was set greater than zero, but no memory
854 // was actually needed.
855 usb_rx_memory_needed = 0;
860 //#define index(endpoint, tx, odd) (((endpoint) << 2) | ((tx) << 1) | (odd))
861 //#define stat2bufferdescriptor(stat) (table + ((stat) >> 2))
863 void usb_tx( uint32_t endpoint, usb_packet_t *packet )
865 bdt_t *b = &table[ index( endpoint, TX, EVEN ) ];
869 if ( endpoint >= NUM_ENDPOINTS )
872 //serial_print("txstate=");
873 //serial_phex(tx_state[ endpoint ]);
874 //serial_print("\n");
875 switch ( tx_state[ endpoint ] )
877 case TX_STATE_BOTH_FREE_EVEN_FIRST:
878 next = TX_STATE_ODD_FREE;
880 case TX_STATE_BOTH_FREE_ODD_FIRST:
882 next = TX_STATE_EVEN_FREE;
884 case TX_STATE_EVEN_FREE:
885 next = TX_STATE_NONE_FREE_ODD_FIRST;
887 case TX_STATE_ODD_FREE:
889 next = TX_STATE_NONE_FREE_EVEN_FIRST;
892 if (tx_first[ endpoint ] == NULL)
894 tx_first[ endpoint ] = packet;
898 tx_last[ endpoint ]->next = packet;
900 tx_last[ endpoint ] = packet;
905 tx_state[ endpoint ] = next;
906 b->addr = packet->buf;
907 b->desc = BDT_DESC( packet->len, ((uint32_t)b & 8) ? DATA1 : DATA0 );
912 void usb_device_reload()
914 if ( flashModeEnabled_define == 0 )
917 warn_print("flashModeEnabled not set, cancelling firmware reload...");
918 info_msg("Set flashModeEnabled to 1 in your kll configuration.");
923 #if defined(_mk20dx128vlf5_)
925 // MCHCK Kiibohd Variant
926 // Check to see if PTA3 (has a pull-up) is connected to GND (usually via jumper)
927 // Only allow reload if the jumper is present (security)
928 GPIOA_PDDR &= ~(1<<3); // Input
929 PORTA_PCR3 = PORT_PCR_PFE | PORT_PCR_MUX(1); // Internal pull-up
932 if ( GPIOA_PDIR & (1<<3) && flashModeEnabled_define != 0 )
935 warn_print("Security jumper not present, cancelling firmware reload...");
936 info_msg("Replace jumper on middle 2 pins, or manually press the firmware reload button.");
940 // Copies variable into the VBAT register, must be identical to the variable in the bootloader to jump to the bootloader flash mode
941 for ( int pos = 0; pos < sizeof(sys_reset_to_loader_magic); pos++ )
942 (&VBAT)[ pos ] = sys_reset_to_loader_magic[ pos ];
946 // Kiibohd mk20dx256vlh7
947 #elif defined(_mk20dx256vlh7_)
948 // Copies variable into the VBAT register, must be identical to the variable in the bootloader to jump to the bootloader flash mode
949 for ( int pos = 0; pos < sizeof(sys_reset_to_loader_magic); pos++ )
950 (&VBAT)[ pos ] = sys_reset_to_loader_magic[ pos ];
953 // Teensy 3.0 and 3.1
955 asm volatile("bkpt");
962 uint8_t status, stat, t;
964 //serial_print("isr");
965 //status = USB0_ISTAT;
966 //serial_phex(status);
967 //serial_print("\n");
971 print("USB ISR STATUS: ");
976 if ( (status & USB_INTEN_SOFTOKEN /* 04 */ ) )
978 if ( usb_configuration )
980 t = usb_reboot_timer;
983 usb_reboot_timer = --t;
989 t = usb_cdc_transmit_flush_timer;
992 usb_cdc_transmit_flush_timer = --t;
994 usb_serial_flush_callback();
998 USB0_ISTAT = USB_INTEN_SOFTOKEN;
1001 if ( (status & USB_ISTAT_TOKDNE /* 08 */ ) )
1005 //serial_print("token: ep=");
1006 //serial_phex(stat >> 4);
1007 //serial_print(stat & 0x08 ? ",tx" : ",rx");
1008 //serial_print(stat & 0x04 ? ",odd\n" : ",even\n");
1009 endpoint = stat >> 4;
1010 if ( endpoint == 0 )
1012 usb_control( stat );
1016 bdt_t *b = stat2bufferdescriptor(stat);
1017 usb_packet_t *packet = (usb_packet_t *)((uint8_t *)(b->addr) - 8);
1019 serial_print("ep:");
1020 serial_phex(endpoint);
1021 serial_print(", pid:");
1022 serial_phex(BDT_PID(b->desc));
1023 serial_print(((uint32_t)b & 8) ? ", odd" : ", even");
1024 serial_print(", count:");
1025 serial_phex(b->desc >> 16);
1028 endpoint--; // endpoint is index to zero-based arrays
1033 packet = tx_first[ endpoint ];
1036 //serial_print("tx packet\n");
1037 tx_first[endpoint] = packet->next;
1038 b->addr = packet->buf;
1039 switch ( tx_state[ endpoint ] )
1041 case TX_STATE_BOTH_FREE_EVEN_FIRST:
1042 tx_state[ endpoint ] = TX_STATE_ODD_FREE;
1044 case TX_STATE_BOTH_FREE_ODD_FIRST:
1045 tx_state[ endpoint ] = TX_STATE_EVEN_FREE;
1047 case TX_STATE_EVEN_FREE:
1048 tx_state[ endpoint ] = TX_STATE_NONE_FREE_ODD_FIRST;
1050 case TX_STATE_ODD_FREE:
1051 tx_state[ endpoint ] = TX_STATE_NONE_FREE_EVEN_FIRST;
1056 b->desc = BDT_DESC( packet->len, ((uint32_t)b & 8) ? DATA1 : DATA0 );
1058 //serial_print("tx no packet\n");
1059 switch ( tx_state[ endpoint ] )
1061 case TX_STATE_BOTH_FREE_EVEN_FIRST:
1062 case TX_STATE_BOTH_FREE_ODD_FIRST:
1064 case TX_STATE_EVEN_FREE:
1065 tx_state[ endpoint ] = TX_STATE_BOTH_FREE_EVEN_FIRST;
1067 case TX_STATE_ODD_FREE:
1068 tx_state[ endpoint ] = TX_STATE_BOTH_FREE_ODD_FIRST;
1071 tx_state[ endpoint ] = ((uint32_t)b & 8)
1073 : TX_STATE_EVEN_FREE;
1080 packet->len = b->desc >> 16;
1081 if ( packet->len > 0 )
1084 packet->next = NULL;
1085 if ( rx_first[ endpoint ] == NULL )
1087 //serial_print("rx 1st, epidx=");
1088 //serial_phex(endpoint);
1089 //serial_print(", packet=");
1090 //serial_phex32((uint32_t)packet);
1091 //serial_print("\n");
1092 rx_first[ endpoint ] = packet;
1096 //serial_print("rx Nth, epidx=");
1097 //serial_phex(endpoint);
1098 //serial_print(", packet=");
1099 //serial_phex32((uint32_t)packet);
1100 //serial_print("\n");
1101 rx_last[ endpoint ]->next = packet;
1103 rx_last[ endpoint ] = packet;
1104 usb_rx_byte_count_data[ endpoint ] += packet->len;
1105 // TODO: implement a per-endpoint maximum # of allocated packets
1106 // so a flood of incoming data on 1 endpoint doesn't starve
1107 // the others if the user isn't reading it regularly
1108 packet = usb_malloc();
1111 b->addr = packet->buf;
1112 b->desc = BDT_DESC( 64, ((uint32_t)b & 8) ? DATA1 : DATA0 );
1116 //serial_print("starving ");
1117 //serial_phex(endpoint + 1);
1118 //serial_print(((uint32_t)b & 8) ? ",odd\n" : ",even\n");
1120 usb_rx_memory_needed++;
1125 b->desc = BDT_DESC( 64, ((uint32_t)b & 8) ? DATA1 : DATA0 );
1133 USB0_ISTAT = USB_ISTAT_TOKDNE;
1138 if ( status & USB_ISTAT_USBRST /* 01 */ )
1140 //serial_print("reset\n");
1142 // initialize BDT toggle bits
1143 USB0_CTL = USB_CTL_ODDRST;
1144 ep0_tx_bdt_bank = 0;
1146 // set up buffers to receive Setup and OUT packets
1147 table[index( 0, RX, EVEN ) ].desc = BDT_DESC( EP0_SIZE, 0 );
1148 table[index( 0, RX, EVEN ) ].addr = ep0_rx0_buf;
1149 table[index( 0, RX, ODD ) ].desc = BDT_DESC( EP0_SIZE, 0 );
1150 table[index( 0, RX, ODD ) ].addr = ep0_rx1_buf;
1151 table[index( 0, TX, EVEN ) ].desc = 0;
1152 table[index( 0, TX, ODD ) ].desc = 0;
1154 // activate endpoint 0
1155 USB0_ENDPT0 = USB_ENDPT_EPRXEN | USB_ENDPT_EPTXEN | USB_ENDPT_EPHSHK;
1157 // clear all ending interrupts
1158 USB0_ERRSTAT = 0xFF;
1161 // set the address to zero during enumeration
1164 // enable other interrupts
1166 USB0_INTEN = USB_INTEN_TOKDNEEN |
1167 USB_INTEN_SOFTOKEN |
1170 USB_INTEN_USBRSTEN |
1173 // is this necessary?
1174 USB0_CTL = USB_CTL_USBENSOFEN;
1179 if ( (status & USB_ISTAT_STALL /* 80 */ ) )
1181 //serial_print("stall:\n");
1182 USB0_ENDPT0 = USB_ENDPT_EPRXEN | USB_ENDPT_EPTXEN | USB_ENDPT_EPHSHK;
1183 USB0_ISTAT = USB_ISTAT_STALL;
1185 if ( (status & USB_ISTAT_ERROR /* 02 */ ) )
1187 uint8_t err = USB0_ERRSTAT;
1189 //serial_print("err:");
1191 //serial_print("\n");
1192 USB0_ISTAT = USB_ISTAT_ERROR;
1195 if ( (status & USB_ISTAT_SLEEP /* 10 */ ) )
1197 //serial_print("sleep\n");
1198 USB0_ISTAT = USB_ISTAT_SLEEP;
1207 print("USB INIT"NL);
1210 // Clear out endpoints table
1211 for ( int i = 0; i <= NUM_ENDPOINTS * 4; i++ )
1217 // this basically follows the flowchart in the Kinetis
1218 // Quick Reference User Guide, Rev. 1, 03/2012, page 141
1220 // assume 48 MHz clock already running
1221 // SIM - enable clock
1222 SIM_SCGC4 |= SIM_SCGC4_USBOTG;
1225 USB0_USBTRC0 = USB_USBTRC_USBRESET;
1226 while ( (USB0_USBTRC0 & USB_USBTRC_USBRESET) != 0 ); // wait for reset to end
1228 // set desc table base addr
1229 USB0_BDTPAGE1 = ((uint32_t)table) >> 8;
1230 USB0_BDTPAGE2 = ((uint32_t)table) >> 16;
1231 USB0_BDTPAGE3 = ((uint32_t)table) >> 24;
1233 // clear all ISR flags
1235 USB0_ERRSTAT = 0xFF;
1236 USB0_OTGISTAT = 0xFF;
1238 USB0_USBTRC0 |= 0x40; // undocumented bit
1241 USB0_CTL = USB_CTL_USBENSOFEN;
1244 // enable reset interrupt
1245 USB0_INTEN = USB_INTEN_USBRSTEN;
1247 // enable interrupt in NVIC...
1248 NVIC_SET_PRIORITY( IRQ_USBOTG, 112 );
1249 NVIC_ENABLE_IRQ( IRQ_USBOTG );
1252 USB0_CONTROL = USB_CONTROL_DPPULLUPNONOTG;
1257 // return 0 if the USB is not configured, or the configuration
1258 // number selected by the HOST
1259 uint8_t usb_configured()
1261 return usb_configuration;