Norimasa Okamoto
Simple USBHost ｌibrary for Nucleo F446RE/F411RE/F401RE FRDM-KL46Z/KL25Z/F64F LPC4088/LPC1768
Dependents: F401RE-BTstack_example F401RE-USBHostMSD_HelloWorld
Fork of
KL46Z-USBHost
by 
Norimasa Okamoto
簡易USBホストライブラリです。
official-USBHostの下位互換で対応プログラムを僅かな修正で動かすことが出来ます。
Platforms
- Nucleo F446RE
- Nucleo F411RE
- Nucleo F401RE
- FRDM-K64F
- FRDM-KL46Z
- FRDM-KL25Z
- LPC4088
- LPC1768
Nucleo F446RE/F411RE/F401REのUSB接続方法
| ST morpho | USB |
|---|---|
| U5V (CN10-8) | VBUS (1 RED) |
| PA11 (CN10-14) | DM (2 WHITE) |
| PA12 (CN10-12) | DP (3 GREEN) |
| GND (CN10-20) | GND (4 BLACK) |
Examples
Import programF446RE-USBHostMouse_HelloWorld
USBHostMouse Hello World for ST-Nucleo-F446RE
Last commit 01 May 2016 by Norimasa Okamoto
Import programF401RE-USBHostMSD_HelloWorld
Simple USBHost MSD(USB flash drive) for Nucleo F401RE/FRDM-KL46Z test program
Last commit 13 Jun 2014 by Norimasa Okamoto
Import programF401RE-USBHostC270_example
Simple USBHost WebCam test program
Last commit 01 May 2016 by Norimasa Okamoto
Import programK64F_USBHostC270_example
Simple USBHost C270 example
Last commit 08 Aug 2014 by 
FRDM-K64F Code Share
Import programF401RE-BTstack_example
BTstack for Nucleo F401RE/FRDM-KL46Z example program
Last commit 09 Jun 2014 by Norimasa Okamoto
Import programUSBHostRSSI_example
Bluetooth device discovery example program.
Last commit 10 Jul 2014 by Norimasa Okamoto
Import programKL46Z-USBHostGPS_HelloWorld
Simple USBHost GPS Dongle Receiver for FRDM-KL46Z test program
Last commit 05 Feb 2014 by Norimasa Okamoto
USBHost.cpp@1:c072d9e580b0, 2014-01-21 (annotated)
- Committer:
- va009039
- Date:
- Tue Jan 21 08:59:28 2014 +0000
- Revision:
- 1:c072d9e580b0
- Parent:
- 0:5160ee0c522d
- Child:
- 2:0cdac6bcc534
add USBHostMSD
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| va009039 | 0:5160ee0c522d | 1 | // Simple USBHost for FRDM-KL46Z |
| va009039 | 0:5160ee0c522d | 2 | #include "USBHost.h" |
| va009039 | 0:5160ee0c522d | 3 | #include <algorithm> |
| va009039 | 0:5160ee0c522d | 4 | |
| va009039 | 0:5160ee0c522d | 5 | template <bool>struct CtAssert; |
| va009039 | 0:5160ee0c522d | 6 | template <>struct CtAssert<true> {}; |
| va009039 | 0:5160ee0c522d | 7 | #define CTASSERT(A) CtAssert<A>(); |
| va009039 | 0:5160ee0c522d | 8 | |
| va009039 | 1:c072d9e580b0 | 9 | |
| va009039 | 1:c072d9e580b0 | 10 | #ifdef _USB_DBG |
| va009039 | 1:c072d9e580b0 | 11 | #define USB_DBG(...) do{fprintf(stderr,"[%s@%d] ",__PRETTY_FUNCTION__,__LINE__);fprintf(stderr,__VA_ARGS__);fprintf(stderr,"\n");} while(0); |
| va009039 | 1:c072d9e580b0 | 12 | #define USB_DBG_HEX(A,B) debug_hex(A,B) |
| va009039 | 0:5160ee0c522d | 13 | void debug_hex(uint8_t* buf, int size); |
| va009039 | 1:c072d9e580b0 | 14 | #else |
| va009039 | 1:c072d9e580b0 | 15 | #define USB_DBG(...) while(0) |
| va009039 | 1:c072d9e580b0 | 16 | #define USB_DBG_HEX(A,B) while(0) |
| va009039 | 1:c072d9e580b0 | 17 | #endif |
| va009039 | 1:c072d9e580b0 | 18 | |
| va009039 | 0:5160ee0c522d | 19 | #define USB_TEST_ASSERT(A) while(!(A)){fprintf(stderr,"\n\n%s@%d %s ASSERT!\n\n",__PRETTY_FUNCTION__,__LINE__,#A);exit(1);}; |
| va009039 | 0:5160ee0c522d | 20 | #define USB_TEST_ASSERT_FALSE(A) USB_TEST_ASSERT(!(A)) |
| va009039 | 0:5160ee0c522d | 21 | |
| va009039 | 0:5160ee0c522d | 22 | #define BD_OWN_MASK (1<<7) |
| va009039 | 0:5160ee0c522d | 23 | #define BD_DATA01_MASK (1<<6) |
| va009039 | 0:5160ee0c522d | 24 | #define BD_KEEP_MASK (1<<5) |
| va009039 | 0:5160ee0c522d | 25 | #define BD_NINC_MASK (1<<4) |
| va009039 | 0:5160ee0c522d | 26 | #define BD_DTS_MASK (1<<3) |
| va009039 | 0:5160ee0c522d | 27 | #define BD_STALL_MASK (1<<2) |
| va009039 | 0:5160ee0c522d | 28 | |
| va009039 | 0:5160ee0c522d | 29 | #define TX 1 |
| va009039 | 0:5160ee0c522d | 30 | #define RX 0 |
| va009039 | 0:5160ee0c522d | 31 | |
| va009039 | 0:5160ee0c522d | 32 | #define EP0_BDT_IDX(dir, odd) (((2 * dir) + (1 * odd))) |
| va009039 | 0:5160ee0c522d | 33 | |
| va009039 | 0:5160ee0c522d | 34 | #define SETUP_TOKEN 0x0D |
| va009039 | 0:5160ee0c522d | 35 | #define IN_TOKEN 0x09 |
| va009039 | 0:5160ee0c522d | 36 | #define OUT_TOKEN 0x01 |
| va009039 | 0:5160ee0c522d | 37 | |
| va009039 | 0:5160ee0c522d | 38 | // for each endpt: 8 bytes |
| va009039 | 0:5160ee0c522d | 39 | struct BDT { |
| va009039 | 0:5160ee0c522d | 40 | uint8_t info; // BD[0:7] |
| va009039 | 0:5160ee0c522d | 41 | uint8_t dummy; // RSVD: BD[8:15] |
| va009039 | 0:5160ee0c522d | 42 | uint16_t byte_count; // BD[16:32] |
| va009039 | 0:5160ee0c522d | 43 | uint32_t address; // Addr |
| va009039 | 0:5160ee0c522d | 44 | void setBuffer(uint8_t* buf, int size) { |
| va009039 | 0:5160ee0c522d | 45 | address = (uint32_t)buf; |
| va009039 | 0:5160ee0c522d | 46 | byte_count = size; |
| va009039 | 0:5160ee0c522d | 47 | } |
| va009039 | 1:c072d9e580b0 | 48 | uint8_t getStatus() { |
| va009039 | 1:c072d9e580b0 | 49 | return (info>>2)&0x0f; |
| va009039 | 1:c072d9e580b0 | 50 | } |
| va009039 | 0:5160ee0c522d | 51 | }; |
| va009039 | 0:5160ee0c522d | 52 | |
| va009039 | 0:5160ee0c522d | 53 | __attribute__((__aligned__(512))) BDT bdt[64]; |
| va009039 | 0:5160ee0c522d | 54 | |
| va009039 | 0:5160ee0c522d | 55 | USBHost* USBHost::inst = NULL; |
| va009039 | 0:5160ee0c522d | 56 | |
| va009039 | 0:5160ee0c522d | 57 | USBHost* USBHost::getHostInst() |
| va009039 | 0:5160ee0c522d | 58 | { |
| va009039 | 0:5160ee0c522d | 59 | if (inst == NULL) { |
| va009039 | 0:5160ee0c522d | 60 | inst = new USBHost(); |
| va009039 | 0:5160ee0c522d | 61 | inst->init(); |
| va009039 | 0:5160ee0c522d | 62 | } |
| va009039 | 0:5160ee0c522d | 63 | return inst; |
| va009039 | 0:5160ee0c522d | 64 | } |
| va009039 | 0:5160ee0c522d | 65 | |
| va009039 | 0:5160ee0c522d | 66 | USBHost::USBHost() { |
| va009039 | 0:5160ee0c522d | 67 | inst = this; |
| va009039 | 1:c072d9e580b0 | 68 | memset(rx_data01, DATA1, sizeof(rx_data01)); |
| va009039 | 1:c072d9e580b0 | 69 | memset(tx_data01, DATA1, sizeof(tx_data01)); |
| va009039 | 0:5160ee0c522d | 70 | } |
| va009039 | 0:5160ee0c522d | 71 | |
| va009039 | 0:5160ee0c522d | 72 | void USBHost::init() { |
| va009039 | 0:5160ee0c522d | 73 | // Disable IRQ |
| va009039 | 0:5160ee0c522d | 74 | NVIC_DisableIRQ(USB0_IRQn); |
| va009039 | 0:5160ee0c522d | 75 | |
| va009039 | 0:5160ee0c522d | 76 | // choose usb src as PLL |
| va009039 | 0:5160ee0c522d | 77 | SIM->SOPT2 |= (SIM_SOPT2_USBSRC_MASK | SIM_SOPT2_PLLFLLSEL_MASK); |
| va009039 | 0:5160ee0c522d | 78 | |
| va009039 | 0:5160ee0c522d | 79 | // enable OTG clock |
| va009039 | 0:5160ee0c522d | 80 | SIM->SCGC4 |= SIM_SCGC4_USBOTG_MASK; |
| va009039 | 0:5160ee0c522d | 81 | |
| va009039 | 0:5160ee0c522d | 82 | // USB Module Configuration |
| va009039 | 0:5160ee0c522d | 83 | // Reset USB Module |
| va009039 | 0:5160ee0c522d | 84 | USB0->USBTRC0 |= USB_USBTRC0_USBRESET_MASK; |
| va009039 | 0:5160ee0c522d | 85 | while(USB0->USBTRC0 & USB_USBTRC0_USBRESET_MASK); |
| va009039 | 0:5160ee0c522d | 86 | |
| va009039 | 0:5160ee0c522d | 87 | // Clear interrupt flag |
| va009039 | 0:5160ee0c522d | 88 | USB0->ISTAT = 0xff; |
| va009039 | 0:5160ee0c522d | 89 | |
| va009039 | 0:5160ee0c522d | 90 | // Set BDT Base Register |
| va009039 | 0:5160ee0c522d | 91 | USB0->BDTPAGE1=(uint8_t)((uint32_t)bdt>>8); |
| va009039 | 0:5160ee0c522d | 92 | USB0->BDTPAGE2=(uint8_t)((uint32_t)bdt>>16); |
| va009039 | 0:5160ee0c522d | 93 | USB0->BDTPAGE3=(uint8_t)((uint32_t)bdt>>24); |
| va009039 | 0:5160ee0c522d | 94 | |
| va009039 | 0:5160ee0c522d | 95 | // Set SOF threshold |
| va009039 | 0:5160ee0c522d | 96 | USB0->SOFTHLD = USB_SOFTHLD_CNT(1); |
| va009039 | 0:5160ee0c522d | 97 | |
| va009039 | 0:5160ee0c522d | 98 | // pulldown D+ and D- |
| va009039 | 0:5160ee0c522d | 99 | USB0->USBCTRL = USB_USBCTRL_PDE_MASK; |
| va009039 | 0:5160ee0c522d | 100 | |
| va009039 | 1:c072d9e580b0 | 101 | USB0->USBTRC0 |= 0x40; |
| va009039 | 1:c072d9e580b0 | 102 | |
| va009039 | 0:5160ee0c522d | 103 | // Host mode |
| va009039 | 0:5160ee0c522d | 104 | USB0->CTL |= USB_CTL_HOSTMODEEN_MASK; |
| va009039 | 0:5160ee0c522d | 105 | // Desable SOF packet generation |
| va009039 | 0:5160ee0c522d | 106 | USB0->CTL &= ~USB_CTL_USBENSOFEN_MASK; |
| va009039 | 0:5160ee0c522d | 107 | |
| va009039 | 0:5160ee0c522d | 108 | NVIC_SetVector(USB0_IRQn, (uint32_t)_usbisr); |
| va009039 | 0:5160ee0c522d | 109 | NVIC_EnableIRQ(USB0_IRQn); |
| va009039 | 0:5160ee0c522d | 110 | |
| va009039 | 0:5160ee0c522d | 111 | wait_attach(); |
| va009039 | 0:5160ee0c522d | 112 | |
| va009039 | 1:c072d9e580b0 | 113 | for(int retry = 2; retry > 0; retry--) { |
| va009039 | 1:c072d9e580b0 | 114 | // Enable RESET |
| va009039 | 1:c072d9e580b0 | 115 | USB0->CTL |= USB_CTL_RESET_MASK; |
| va009039 | 1:c072d9e580b0 | 116 | wait_ms(500); |
| va009039 | 1:c072d9e580b0 | 117 | USB0->CTL &= ~USB_CTL_RESET_MASK; |
| va009039 | 0:5160ee0c522d | 118 | |
| va009039 | 1:c072d9e580b0 | 119 | // Enable SOF |
| va009039 | 1:c072d9e580b0 | 120 | USB0->CTL |= USB_CTL_USBENSOFEN_MASK; |
| va009039 | 1:c072d9e580b0 | 121 | wait_ms(100); |
| va009039 | 0:5160ee0c522d | 122 | |
| va009039 | 1:c072d9e580b0 | 123 | // token transfer initialize |
| va009039 | 1:c072d9e580b0 | 124 | tx_ptr = ODD; |
| va009039 | 1:c072d9e580b0 | 125 | rx_ptr = ODD; |
| va009039 | 1:c072d9e580b0 | 126 | USB0->INTEN |= USB_INTEN_TOKDNEEN_MASK; |
| va009039 | 0:5160ee0c522d | 127 | |
| va009039 | 1:c072d9e580b0 | 128 | if (enumeration()) { |
| va009039 | 1:c072d9e580b0 | 129 | break; |
| va009039 | 1:c072d9e580b0 | 130 | } |
| va009039 | 1:c072d9e580b0 | 131 | USB_DBG("retry=%d", retry); |
| va009039 | 1:c072d9e580b0 | 132 | USB_TEST_ASSERT(retry > 1); |
| va009039 | 1:c072d9e580b0 | 133 | } |
| va009039 | 0:5160ee0c522d | 134 | } |
| va009039 | 0:5160ee0c522d | 135 | |
| va009039 | 0:5160ee0c522d | 136 | void USBHost::wait_attach() { |
| va009039 | 0:5160ee0c522d | 137 | attach_done = false; |
| va009039 | 0:5160ee0c522d | 138 | USB0->INTEN = USB_INTEN_ATTACHEN_MASK; |
| va009039 | 0:5160ee0c522d | 139 | while(!attach_done); |
| va009039 | 0:5160ee0c522d | 140 | wait_ms(100); |
| va009039 | 0:5160ee0c522d | 141 | USB_TEST_ASSERT_FALSE(USB0->CTL & USB_CTL_SE0_MASK); |
| va009039 | 1:c072d9e580b0 | 142 | lowSpeed = (USB0->CTL & USB_CTL_JSTATE_MASK) ? false : true; |
| va009039 | 1:c072d9e580b0 | 143 | if (lowSpeed) { // low speed |
| va009039 | 1:c072d9e580b0 | 144 | USB0->ENDPOINT[0].ENDPT |= USB_ENDPT_HOSTWOHUB_MASK; |
| va009039 | 0:5160ee0c522d | 145 | } |
| va009039 | 1:c072d9e580b0 | 146 | USB_DBG("lowSpeed=%d", lowSpeed); |
| va009039 | 0:5160ee0c522d | 147 | } |
| va009039 | 0:5160ee0c522d | 148 | |
| va009039 | 1:c072d9e580b0 | 149 | bool USBHost::enumeration() { |
| va009039 | 1:c072d9e580b0 | 150 | uint8_t desc[64]; |
| va009039 | 0:5160ee0c522d | 151 | MaxPacketSize0 = 8; |
| va009039 | 1:c072d9e580b0 | 152 | dev_addr = 0; |
| va009039 | 1:c072d9e580b0 | 153 | USB0->ADDR = (lowSpeed ? USB_ADDR_LSEN_MASK : 0x00) | USB_ADDR_ADDR(dev_addr); |
| va009039 | 1:c072d9e580b0 | 154 | wait_ms(100); |
| va009039 | 0:5160ee0c522d | 155 | SETUP_PACKET setup_get_descriptor = {0x80, GET_DESCRIPTOR, 1<<8, 0, 0}; |
| va009039 | 0:5160ee0c522d | 156 | int result = ControlRead(&setup_get_descriptor, desc, 8); |
| va009039 | 1:c072d9e580b0 | 157 | if (result < 8) { |
| va009039 | 1:c072d9e580b0 | 158 | USB_DBG("result=%d %02x", result, LastStatus); |
| va009039 | 1:c072d9e580b0 | 159 | return false; |
| va009039 | 1:c072d9e580b0 | 160 | } |
| va009039 | 0:5160ee0c522d | 161 | USB_DBG_HEX(desc, result); |
| va009039 | 0:5160ee0c522d | 162 | MaxPacketSize0 = desc[7]; |
| va009039 | 0:5160ee0c522d | 163 | |
| va009039 | 1:c072d9e580b0 | 164 | dev_addr = 1; |
| va009039 | 1:c072d9e580b0 | 165 | SETUP_PACKET setup_set_address = {0x00, SET_ADDRESS, 1, 0, 0}; |
| va009039 | 1:c072d9e580b0 | 166 | result = ControlWrite(&setup_set_address); |
| va009039 | 1:c072d9e580b0 | 167 | if (result < 0) { |
| va009039 | 1:c072d9e580b0 | 168 | USB_DBG("result=%d %02x", result, LastStatus); |
| va009039 | 1:c072d9e580b0 | 169 | return false; |
| va009039 | 1:c072d9e580b0 | 170 | } |
| va009039 | 1:c072d9e580b0 | 171 | USB0->ADDR = (lowSpeed ? USB_ADDR_LSEN_MASK : 0x00) | USB_ADDR_ADDR(dev_addr); |
| va009039 | 1:c072d9e580b0 | 172 | wait_ms(100); |
| va009039 | 1:c072d9e580b0 | 173 | |
| va009039 | 0:5160ee0c522d | 174 | result = ControlRead(&setup_get_descriptor, desc, sizeof(desc)); |
| va009039 | 1:c072d9e580b0 | 175 | if (result < 8) { |
| va009039 | 1:c072d9e580b0 | 176 | USB_DBG("result=%d", result); |
| va009039 | 1:c072d9e580b0 | 177 | return false; |
| va009039 | 1:c072d9e580b0 | 178 | } |
| va009039 | 1:c072d9e580b0 | 179 | USB_DBG_HEX(desc, result); |
| va009039 | 0:5160ee0c522d | 180 | |
| va009039 | 0:5160ee0c522d | 181 | setup_get_descriptor.wValue = 2<<8; // config descriptor |
| va009039 | 0:5160ee0c522d | 182 | result = ControlRead(&setup_get_descriptor, desc, 4); |
| va009039 | 1:c072d9e580b0 | 183 | if (result != 4) { |
| va009039 | 1:c072d9e580b0 | 184 | USB_DBG("result=%d", result); |
| va009039 | 1:c072d9e580b0 | 185 | return false; |
| va009039 | 1:c072d9e580b0 | 186 | } |
| va009039 | 0:5160ee0c522d | 187 | USB_DBG_HEX(desc, 4); |
| va009039 | 0:5160ee0c522d | 188 | |
| va009039 | 0:5160ee0c522d | 189 | int TotalLength = desc[2]|desc[3]<<8; |
| va009039 | 0:5160ee0c522d | 190 | uint8_t* buf = new uint8_t[TotalLength]; |
| va009039 | 0:5160ee0c522d | 191 | result = ControlRead(&setup_get_descriptor, buf, TotalLength); |
| va009039 | 1:c072d9e580b0 | 192 | if (result != TotalLength) { |
| va009039 | 1:c072d9e580b0 | 193 | USB_DBG("result=%d TotalLength=%d %02x", result, TotalLength, LastStatus); |
| va009039 | 1:c072d9e580b0 | 194 | return false; |
| va009039 | 1:c072d9e580b0 | 195 | } |
| va009039 | 0:5160ee0c522d | 196 | USB_DBG_HEX(buf, TotalLength); |
| va009039 | 0:5160ee0c522d | 197 | |
| va009039 | 0:5160ee0c522d | 198 | for(int i = 0; i < TotalLength; ) { |
| va009039 | 0:5160ee0c522d | 199 | int Length = buf[i]; |
| va009039 | 0:5160ee0c522d | 200 | uint8_t DescriptorType = buf[i+1]; |
| va009039 | 0:5160ee0c522d | 201 | if (DescriptorType == 0x05) { // endpoint |
| va009039 | 0:5160ee0c522d | 202 | uint8_t EndpointAddress = buf[i+2]; |
| va009039 | 0:5160ee0c522d | 203 | uint8_t Attributes = buf[i+3]; |
| va009039 | 0:5160ee0c522d | 204 | if (Attributes == 0x03) { // interrupt |
| va009039 | 0:5160ee0c522d | 205 | if (EndpointAddress & 0x80) { |
| va009039 | 0:5160ee0c522d | 206 | ep_int_in = EndpointAddress; |
| va009039 | 0:5160ee0c522d | 207 | } |
| va009039 | 0:5160ee0c522d | 208 | } else if (Attributes == 0x02) { // bulk |
| va009039 | 0:5160ee0c522d | 209 | if (EndpointAddress & 0x80) { |
| va009039 | 0:5160ee0c522d | 210 | ep_bulk_in = EndpointAddress; |
| va009039 | 0:5160ee0c522d | 211 | } else { |
| va009039 | 0:5160ee0c522d | 212 | ep_bulk_out = EndpointAddress; |
| va009039 | 0:5160ee0c522d | 213 | } |
| va009039 | 0:5160ee0c522d | 214 | } |
| va009039 | 0:5160ee0c522d | 215 | } |
| va009039 | 0:5160ee0c522d | 216 | USB_DBG_HEX(buf+i, Length); |
| va009039 | 0:5160ee0c522d | 217 | i += Length; |
| va009039 | 0:5160ee0c522d | 218 | } |
| va009039 | 0:5160ee0c522d | 219 | delete[] buf; |
| va009039 | 0:5160ee0c522d | 220 | |
| va009039 | 1:c072d9e580b0 | 221 | // config = 1 |
| va009039 | 1:c072d9e580b0 | 222 | SETUP_PACKET setup_set_config = {0x00, SET_CONFIGURATION, 1, 0, 0}; |
| va009039 | 1:c072d9e580b0 | 223 | result = ControlWrite(&setup_set_config); |
| va009039 | 1:c072d9e580b0 | 224 | if (result < 0) { |
| va009039 | 1:c072d9e580b0 | 225 | USB_DBG("set config: %02x", LastStatus); |
| va009039 | 1:c072d9e580b0 | 226 | if (lowSpeed && LastStatus == STALL) { // TODO: |
| va009039 | 1:c072d9e580b0 | 227 | wait_ms(100); |
| va009039 | 1:c072d9e580b0 | 228 | return true; |
| va009039 | 1:c072d9e580b0 | 229 | } |
| va009039 | 1:c072d9e580b0 | 230 | return false; |
| va009039 | 1:c072d9e580b0 | 231 | } |
| va009039 | 1:c072d9e580b0 | 232 | wait_ms(100); |
| va009039 | 1:c072d9e580b0 | 233 | return true; |
| va009039 | 0:5160ee0c522d | 234 | } |
| va009039 | 0:5160ee0c522d | 235 | |
| va009039 | 0:5160ee0c522d | 236 | int USBHost::ControlRead(SETUP_PACKET* setup, uint8_t* data, int size) { |
| va009039 | 0:5160ee0c522d | 237 | token_setup(setup, size); // setup stage |
| va009039 | 1:c072d9e580b0 | 238 | USB_DBG("setup %02x", LastStatus); |
| va009039 | 1:c072d9e580b0 | 239 | if (LastStatus != ACK && lowSpeed == false) { |
| va009039 | 1:c072d9e580b0 | 240 | return -1; |
| va009039 | 1:c072d9e580b0 | 241 | } |
| va009039 | 1:c072d9e580b0 | 242 | rx_data01[0] = DATA1; |
| va009039 | 0:5160ee0c522d | 243 | int read_len = 0; |
| va009039 | 0:5160ee0c522d | 244 | while(read_len < size) { |
| va009039 | 0:5160ee0c522d | 245 | int size2 = std::min(size-read_len, MaxPacketSize0); |
| va009039 | 0:5160ee0c522d | 246 | int result = token_in(0, data+read_len, size2); |
| va009039 | 1:c072d9e580b0 | 247 | USB_DBG("token_in result=%d %02x", result, LastStatus); |
| va009039 | 1:c072d9e580b0 | 248 | if (result < 0) { |
| va009039 | 1:c072d9e580b0 | 249 | if (LastStatus == NAK || LastStatus == Bus_Timeout) { |
| va009039 | 1:c072d9e580b0 | 250 | break; |
| va009039 | 1:c072d9e580b0 | 251 | } |
| va009039 | 1:c072d9e580b0 | 252 | return result; |
| va009039 | 1:c072d9e580b0 | 253 | } |
| va009039 | 0:5160ee0c522d | 254 | read_len += result; |
| va009039 | 0:5160ee0c522d | 255 | if (result < MaxPacketSize0) { |
| va009039 | 0:5160ee0c522d | 256 | break; |
| va009039 | 0:5160ee0c522d | 257 | } |
| va009039 | 0:5160ee0c522d | 258 | } |
| va009039 | 1:c072d9e580b0 | 259 | tx_data01[0] = rx_data01[0]; |
| va009039 | 1:c072d9e580b0 | 260 | int result = token_out(0); // status stage |
| va009039 | 1:c072d9e580b0 | 261 | if (result < 0) { |
| va009039 | 1:c072d9e580b0 | 262 | USB_DBG("status token_out %02x", LastStatus); |
| va009039 | 1:c072d9e580b0 | 263 | if (LastStatus == STALL) { |
| va009039 | 1:c072d9e580b0 | 264 | return read_len; |
| va009039 | 1:c072d9e580b0 | 265 | } |
| va009039 | 1:c072d9e580b0 | 266 | return result; |
| va009039 | 1:c072d9e580b0 | 267 | } |
| va009039 | 0:5160ee0c522d | 268 | return read_len; |
| va009039 | 0:5160ee0c522d | 269 | } |
| va009039 | 0:5160ee0c522d | 270 | |
| va009039 | 0:5160ee0c522d | 271 | int USBHost::ControlWrite(SETUP_PACKET* setup, uint8_t* data, int size) { |
| va009039 | 1:c072d9e580b0 | 272 | if (token_setup(setup, size) != ACK) { // setup stage |
| va009039 | 1:c072d9e580b0 | 273 | return -1; |
| va009039 | 1:c072d9e580b0 | 274 | } |
| va009039 | 1:c072d9e580b0 | 275 | tx_data01[0] = DATA1; |
| va009039 | 1:c072d9e580b0 | 276 | int write_len = 0; |
| va009039 | 0:5160ee0c522d | 277 | if (data != NULL) { |
| va009039 | 1:c072d9e580b0 | 278 | write_len = token_out(0, data, size); |
| va009039 | 1:c072d9e580b0 | 279 | if (write_len < 0) { |
| va009039 | 1:c072d9e580b0 | 280 | return -1; |
| va009039 | 1:c072d9e580b0 | 281 | } |
| va009039 | 0:5160ee0c522d | 282 | } |
| va009039 | 1:c072d9e580b0 | 283 | rx_data01[0] = tx_data01[0]; |
| va009039 | 1:c072d9e580b0 | 284 | int result = token_in(0); // status stage |
| va009039 | 1:c072d9e580b0 | 285 | if (result < 0) { |
| va009039 | 1:c072d9e580b0 | 286 | return result; |
| va009039 | 1:c072d9e580b0 | 287 | } |
| va009039 | 1:c072d9e580b0 | 288 | return write_len; |
| va009039 | 0:5160ee0c522d | 289 | } |
| va009039 | 0:5160ee0c522d | 290 | |
| va009039 | 0:5160ee0c522d | 291 | int USBHost::InterruptRead(uint8_t* data, int size) { |
| va009039 | 0:5160ee0c522d | 292 | USB0->ISTAT = 0xff; |
| va009039 | 1:c072d9e580b0 | 293 | USB0->ENDPOINT[0].ENDPT = (lowSpeed ? USB_ENDPT_HOSTWOHUB_MASK : 0x00) | |
| va009039 | 1:c072d9e580b0 | 294 | USB_ENDPT_EPCTLDIS_MASK| |
| va009039 | 1:c072d9e580b0 | 295 | USB_ENDPT_EPRXEN_MASK| |
| va009039 | 1:c072d9e580b0 | 296 | USB_ENDPT_EPHSHK_MASK; |
| va009039 | 0:5160ee0c522d | 297 | return token_in(ep_int_in & 0x7f, data, size); |
| va009039 | 0:5160ee0c522d | 298 | } |
| va009039 | 0:5160ee0c522d | 299 | |
| va009039 | 0:5160ee0c522d | 300 | int USBHost::BulkRead(uint8_t* data, int size) { |
| va009039 | 1:c072d9e580b0 | 301 | token_ready(); |
| va009039 | 1:c072d9e580b0 | 302 | USB0->ENDPOINT[0].ENDPT = USB_ENDPT_EPCTLDIS_MASK| |
| va009039 | 1:c072d9e580b0 | 303 | USB_ENDPT_EPRXEN_MASK| |
| va009039 | 1:c072d9e580b0 | 304 | USB_ENDPT_EPHSHK_MASK; |
| va009039 | 1:c072d9e580b0 | 305 | const int max_packet_size = 64; |
| va009039 | 1:c072d9e580b0 | 306 | int read_len = 0; |
| va009039 | 1:c072d9e580b0 | 307 | while(read_len < size) { |
| va009039 | 1:c072d9e580b0 | 308 | int size2 = std::min(size-read_len, max_packet_size); |
| va009039 | 1:c072d9e580b0 | 309 | int result = token_in(ep_bulk_in & 0x7f, data+read_len, size2); |
| va009039 | 1:c072d9e580b0 | 310 | if (result < 0) { |
| va009039 | 1:c072d9e580b0 | 311 | //USB_DBG("token_in result=%d %02x", result, LastStatus); |
| va009039 | 1:c072d9e580b0 | 312 | return result; |
| va009039 | 1:c072d9e580b0 | 313 | } |
| va009039 | 1:c072d9e580b0 | 314 | read_len += result; |
| va009039 | 1:c072d9e580b0 | 315 | if (result < max_packet_size) { |
| va009039 | 1:c072d9e580b0 | 316 | break; |
| va009039 | 1:c072d9e580b0 | 317 | } |
| va009039 | 1:c072d9e580b0 | 318 | } |
| va009039 | 1:c072d9e580b0 | 319 | return read_len; |
| va009039 | 0:5160ee0c522d | 320 | } |
| va009039 | 0:5160ee0c522d | 321 | |
| va009039 | 0:5160ee0c522d | 322 | int USBHost::BulkWrite(const uint8_t* data, int size) { |
| va009039 | 1:c072d9e580b0 | 323 | token_ready(); |
| va009039 | 1:c072d9e580b0 | 324 | USB0->ENDPOINT[0].ENDPT = USB_ENDPT_EPCTLDIS_MASK| |
| va009039 | 1:c072d9e580b0 | 325 | USB_ENDPT_EPTXEN_MASK| |
| va009039 | 1:c072d9e580b0 | 326 | USB_ENDPT_EPHSHK_MASK; |
| va009039 | 1:c072d9e580b0 | 327 | const int max_packet_size = 64; |
| va009039 | 1:c072d9e580b0 | 328 | int write_len = 0; |
| va009039 | 1:c072d9e580b0 | 329 | while(write_len < size) { |
| va009039 | 1:c072d9e580b0 | 330 | int size2 = std::min(size-write_len, max_packet_size); |
| va009039 | 1:c072d9e580b0 | 331 | int result = token_out(ep_bulk_out, data+write_len, size2); |
| va009039 | 1:c072d9e580b0 | 332 | if (result < 0) { |
| va009039 | 1:c072d9e580b0 | 333 | //USB_DBG("token_in result=%d %02x", result, LastStatus); |
| va009039 | 1:c072d9e580b0 | 334 | return result; |
| va009039 | 1:c072d9e580b0 | 335 | } |
| va009039 | 1:c072d9e580b0 | 336 | write_len += result; |
| va009039 | 1:c072d9e580b0 | 337 | if (result < max_packet_size) { |
| va009039 | 1:c072d9e580b0 | 338 | break; |
| va009039 | 1:c072d9e580b0 | 339 | } |
| va009039 | 1:c072d9e580b0 | 340 | } |
| va009039 | 1:c072d9e580b0 | 341 | return write_len; |
| va009039 | 0:5160ee0c522d | 342 | } |
| va009039 | 0:5160ee0c522d | 343 | |
| va009039 | 0:5160ee0c522d | 344 | int USBHost::token_setup(SETUP_PACKET* setup, uint16_t wLength) { |
| va009039 | 1:c072d9e580b0 | 345 | token_ready(); |
| va009039 | 1:c072d9e580b0 | 346 | USB0->ENDPOINT[0].ENDPT = (lowSpeed ? USB_ENDPT_HOSTWOHUB_MASK : 0x00) | |
| va009039 | 1:c072d9e580b0 | 347 | USB_ENDPT_EPRXEN_MASK| |
| va009039 | 1:c072d9e580b0 | 348 | USB_ENDPT_EPTXEN_MASK| |
| va009039 | 1:c072d9e580b0 | 349 | USB_ENDPT_EPHSHK_MASK; |
| va009039 | 0:5160ee0c522d | 350 | int idx = EP0_BDT_IDX(TX, tx_ptr); |
| va009039 | 1:c072d9e580b0 | 351 | bdt[idx].info = BD_OWN_MASK | |
| va009039 | 1:c072d9e580b0 | 352 | BD_DTS_MASK; // always data0 |
| va009039 | 0:5160ee0c522d | 353 | setup->wLength = wLength; |
| va009039 | 0:5160ee0c522d | 354 | bdt[idx].setBuffer((uint8_t*)setup, sizeof(SETUP_PACKET)); |
| va009039 | 0:5160ee0c522d | 355 | CTASSERT(sizeof(SETUP_PACKET) == 8); |
| va009039 | 0:5160ee0c522d | 356 | token_done = false; |
| va009039 | 0:5160ee0c522d | 357 | USB0->TOKEN = USB_TOKEN_TOKENPID(SETUP_TOKEN)|USB_TOKEN_TOKENENDPT(0); |
| va009039 | 0:5160ee0c522d | 358 | while(!token_done); |
| va009039 | 1:c072d9e580b0 | 359 | LastStatus = bdt[idx].getStatus(); |
| va009039 | 1:c072d9e580b0 | 360 | return LastStatus; |
| va009039 | 0:5160ee0c522d | 361 | } |
| va009039 | 0:5160ee0c522d | 362 | |
| va009039 | 0:5160ee0c522d | 363 | int USBHost::token_in(uint8_t ep, uint8_t* data, int size) { |
| va009039 | 1:c072d9e580b0 | 364 | USB_TEST_ASSERT(ep < sizeof(rx_data01)); |
| va009039 | 1:c072d9e580b0 | 365 | token_ready(); |
| va009039 | 0:5160ee0c522d | 366 | int idx = EP0_BDT_IDX(RX, rx_ptr); |
| va009039 | 1:c072d9e580b0 | 367 | bdt[idx].info = BD_OWN_MASK| |
| va009039 | 1:c072d9e580b0 | 368 | BD_DTS_MASK| |
| va009039 | 1:c072d9e580b0 | 369 | ((rx_data01[ep] == DATA1) ? BD_DATA01_MASK : 0); |
| va009039 | 0:5160ee0c522d | 370 | bdt[idx].setBuffer(data, size); |
| va009039 | 0:5160ee0c522d | 371 | token_done = false; |
| va009039 | 0:5160ee0c522d | 372 | USB0->TOKEN = USB_TOKEN_TOKENPID(IN_TOKEN)|USB_TOKEN_TOKENENDPT(ep); |
| va009039 | 0:5160ee0c522d | 373 | while(!token_done); |
| va009039 | 1:c072d9e580b0 | 374 | LastStatus = bdt[idx].getStatus(); |
| va009039 | 1:c072d9e580b0 | 375 | if (LastStatus == DATA0) { |
| va009039 | 1:c072d9e580b0 | 376 | rx_data01[ep] = DATA1; |
| va009039 | 1:c072d9e580b0 | 377 | } else if (LastStatus == DATA1) { |
| va009039 | 1:c072d9e580b0 | 378 | rx_data01[ep] = DATA0; |
| va009039 | 1:c072d9e580b0 | 379 | } else { |
| va009039 | 1:c072d9e580b0 | 380 | return -1; |
| va009039 | 1:c072d9e580b0 | 381 | } |
| va009039 | 0:5160ee0c522d | 382 | return bdt[idx].byte_count; |
| va009039 | 0:5160ee0c522d | 383 | } |
| va009039 | 0:5160ee0c522d | 384 | |
| va009039 | 0:5160ee0c522d | 385 | int USBHost::token_out(uint8_t ep, const uint8_t* data, int size) { |
| va009039 | 1:c072d9e580b0 | 386 | USB_TEST_ASSERT(ep < sizeof(tx_data01)); |
| va009039 | 1:c072d9e580b0 | 387 | token_ready(); |
| va009039 | 0:5160ee0c522d | 388 | int idx = EP0_BDT_IDX(TX, tx_ptr); |
| va009039 | 1:c072d9e580b0 | 389 | bdt[idx].info = BD_OWN_MASK| |
| va009039 | 1:c072d9e580b0 | 390 | BD_DTS_MASK| |
| va009039 | 1:c072d9e580b0 | 391 | ((tx_data01[ep] == DATA1) ? BD_DATA01_MASK : 0); |
| va009039 | 0:5160ee0c522d | 392 | bdt[idx].setBuffer((uint8_t*)data, size); |
| va009039 | 0:5160ee0c522d | 393 | token_done = false; |
| va009039 | 0:5160ee0c522d | 394 | USB0->TOKEN = USB_TOKEN_TOKENPID(OUT_TOKEN)|USB_TOKEN_TOKENENDPT(ep); |
| va009039 | 0:5160ee0c522d | 395 | while(!token_done); |
| va009039 | 1:c072d9e580b0 | 396 | LastStatus = bdt[idx].getStatus(); |
| va009039 | 1:c072d9e580b0 | 397 | if (LastStatus == ACK) { |
| va009039 | 1:c072d9e580b0 | 398 | tx_data01[ep] = (tx_data01[ep] == DATA0) ? DATA1 : DATA0; |
| va009039 | 1:c072d9e580b0 | 399 | return bdt[idx].byte_count; |
| va009039 | 1:c072d9e580b0 | 400 | } |
| va009039 | 1:c072d9e580b0 | 401 | return -1; |
| va009039 | 1:c072d9e580b0 | 402 | } |
| va009039 | 1:c072d9e580b0 | 403 | |
| va009039 | 1:c072d9e580b0 | 404 | void USBHost::token_ready() { |
| va009039 | 1:c072d9e580b0 | 405 | while(USB0->CTL & USB_CTL_TXSUSPENDTOKENBUSY_MASK) { // TOKEN_BUSY ? |
| va009039 | 1:c072d9e580b0 | 406 | wait_ms(1); |
| va009039 | 1:c072d9e580b0 | 407 | } |
| va009039 | 1:c072d9e580b0 | 408 | USB0->ISTAT |= USB_ISTAT_SOFTOK_MASK; // Clear SOF |
| va009039 | 1:c072d9e580b0 | 409 | while (!(USB0->ISTAT & USB_ISTAT_SOFTOK_MASK)); |
| va009039 | 1:c072d9e580b0 | 410 | USB0->SOFTHLD = 0; // this is needed as without this you can get errors |
| va009039 | 1:c072d9e580b0 | 411 | USB0->ISTAT |= USB_ISTAT_SOFTOK_MASK; // clear SOF |
| va009039 | 0:5160ee0c522d | 412 | } |
| va009039 | 0:5160ee0c522d | 413 | |
| va009039 | 0:5160ee0c522d | 414 | void USBHost::_usbisr(void) { |
| va009039 | 0:5160ee0c522d | 415 | if (inst) { |
| va009039 | 0:5160ee0c522d | 416 | inst->UsbIrqhandler(); |
| va009039 | 0:5160ee0c522d | 417 | } |
| va009039 | 0:5160ee0c522d | 418 | } |
| va009039 | 0:5160ee0c522d | 419 | |
| va009039 | 0:5160ee0c522d | 420 | void USBHost::UsbIrqhandler() { |
| va009039 | 0:5160ee0c522d | 421 | uint8_t istat = USB0->ISTAT; |
| va009039 | 0:5160ee0c522d | 422 | if (istat & USB_ISTAT_TOKDNE_MASK) { |
| va009039 | 0:5160ee0c522d | 423 | uint8_t stat = USB0->STAT; |
| va009039 | 1:c072d9e580b0 | 424 | ODD_EVEN next_ptr = (stat & USB_STAT_ODD_MASK) ? ODD : EVEN; |
| va009039 | 0:5160ee0c522d | 425 | if (stat & USB_STAT_TX_MASK) { |
| va009039 | 1:c072d9e580b0 | 426 | tx_ptr = next_ptr; |
| va009039 | 0:5160ee0c522d | 427 | } else { |
| va009039 | 1:c072d9e580b0 | 428 | rx_ptr = next_ptr; |
| va009039 | 0:5160ee0c522d | 429 | } |
| va009039 | 0:5160ee0c522d | 430 | token_done = true; |
| va009039 | 0:5160ee0c522d | 431 | } |
| va009039 | 0:5160ee0c522d | 432 | if (istat & USB_ISTAT_ATTACH_MASK) { |
| va009039 | 0:5160ee0c522d | 433 | USB0->INTEN &= ~USB_INTEN_ATTACHEN_MASK; |
| va009039 | 0:5160ee0c522d | 434 | attach_done = true; |
| va009039 | 0:5160ee0c522d | 435 | } |
| va009039 | 0:5160ee0c522d | 436 | USB0->ISTAT = istat; // clear |
| va009039 | 0:5160ee0c522d | 437 | } |
| va009039 | 0:5160ee0c522d | 438 | |
| va009039 | 0:5160ee0c522d | 439 | void debug_hex(uint8_t* buf, int size) { |
| va009039 | 0:5160ee0c522d | 440 | for(int i = 0; i < size; i++) { |
| va009039 | 0:5160ee0c522d | 441 | fprintf(stderr, "%02x ", buf[i]); |
| va009039 | 0:5160ee0c522d | 442 | if (i%16 == 15) { |
| va009039 | 0:5160ee0c522d | 443 | fprintf(stderr, "\r\n"); |
| va009039 | 0:5160ee0c522d | 444 | } |
| va009039 | 0:5160ee0c522d | 445 | } |
| va009039 | 0:5160ee0c522d | 446 | fprintf(stderr, "\r\n"); |
| va009039 | 0:5160ee0c522d | 447 | } |
| va009039 | 0:5160ee0c522d | 448 |