Norimasa Okamoto / F401RE-USBHost

Simple USBHost ｌibrary for Nucleo F446RE/F411RE/F401RE FRDM-KL46Z/KL25Z/F64F LPC4088/LPC1768

Dependencies:   FATFileSystem

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 morphoUSB
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/USBHALHost_F401RE.cpp@16:981c3104f6c0, 2014-06-23 (annotated)

Committer:
va009039
Date:
Mon Jun 23 20:30:04 2014 +0900
Revision:
16:981c3104f6c0
Parent:
14:b167f2b97cb7
Child:
18:61554f238584
add FRDM-K64F.(not tested)

Who changed what in which revision?

UserRevisionLine numberNew contents of line
va009039 11:61843badd06e 1 // Simple USBHost for Nucleo F401RE
va009039 11:61843badd06e 2 #if defined(TARGET_NUCLEO_F401RE)
va009039 11:61843badd06e 3 #include "USBHALHost_F401RE.h"
va009039 16:981c3104f6c0 4 #include <algorithm>
va009039 11:61843badd06e 5
va009039 11:61843badd06e 6 template <bool>struct CtAssert;
va009039 11:61843badd06e 7 template <>struct CtAssert<true> {};
va009039 11:61843badd06e 8 #define CTASSERT(A) CtAssert<A>();
va009039 11:61843badd06e 9
va009039 11:61843badd06e 10
va009039 11:61843badd06e 11 #ifdef _USB_DBG
va009039 11:61843badd06e 12 extern RawSerial pc;
va009039 16:981c3104f6c0 13 //RawSerial pc(USBTX,USBRX);
va009039 11:61843badd06e 14 #include "mydebug.h"
va009039 11:61843badd06e 15 #define USB_DBG(...) do{pc.printf("[%s@%d] ",__PRETTY_FUNCTION__,__LINE__);pc.printf(__VA_ARGS__);pc.puts("\n");} while(0);
va009039 11:61843badd06e 16 #define USB_DBG_HEX(A,B) debug_hex<RawSerial>(pc,A,B)
va009039 11:61843badd06e 17
va009039 11:61843badd06e 18 #else
va009039 11:61843badd06e 19 #define USB_DBG(...) while(0)
va009039 11:61843badd06e 20 #define USB_DBG_HEX(A,B) while(0)
va009039 11:61843badd06e 21 #endif
va009039 11:61843badd06e 22
va009039 11:61843badd06e 23 #ifdef _USB_TEST
va009039 11:61843badd06e 24 #define USB_TEST_ASSERT(A) while(!(A)){fprintf(stderr,"\n\n%s@%d %s ASSERT!\n\n",__PRETTY_FUNCTION__,__LINE__,#A);exit(1);};
va009039 11:61843badd06e 25 #define USB_TEST_ASSERT_FALSE(A) USB_TEST_ASSERT(!(A))
va009039 11:61843badd06e 26 #else
va009039 11:61843badd06e 27 #define USB_TEST_ASSERT(A) while(0)
va009039 11:61843badd06e 28 #define USB_TEST_ASSERT_FALSE(A) while(0)
va009039 11:61843badd06e 29 #endif
va009039 11:61843badd06e 30
va009039 11:61843badd06e 31 #ifdef _USB_TRACE
va009039 11:61843badd06e 32 #define USB_TRACE() while(0)
va009039 11:61843badd06e 33 #define USB_TRACE1(A) while(0)
va009039 11:61843badd06e 34 #define USB_TRACE_VIEW() while(0)
va009039 11:61843badd06e 35 #define USB_TRACE_CLEAR() while(0)
va009039 11:61843badd06e 36 #else
va009039 11:61843badd06e 37 #define USB_TRACE() while(0)
va009039 11:61843badd06e 38 #define USB_TRACE1(A) while(0)
va009039 11:61843badd06e 39 #define USB_TRACE_VIEW() while(0)
va009039 11:61843badd06e 40 #define USB_TRACE_CLEAR() while(0)
va009039 11:61843badd06e 41 #endif
va009039 11:61843badd06e 42
va009039 11:61843badd06e 43 #define USB_INFO(...) do{fprintf(stderr,__VA_ARGS__);fprintf(stderr,"\n");}while(0);
va009039 11:61843badd06e 44
va009039 11:61843badd06e 45 __IO bool attach_done = false;
va009039 11:61843badd06e 46
va009039 11:61843badd06e 47 void delay_ms(uint32_t t)
va009039 11:61843badd06e 48 {
va009039 11:61843badd06e 49 HAL_Delay(t);
va009039 11:61843badd06e 50 }
va009039 11:61843badd06e 51
va009039 16:981c3104f6c0 52 // usbh_conf.c
va009039 11:61843badd06e 53 extern HCD_HandleTypeDef hhcd_USB_OTG_FS;
va009039 11:61843badd06e 54
va009039 11:61843badd06e 55 void HAL_HCD_MspInit(HCD_HandleTypeDef* hhcd)
va009039 11:61843badd06e 56 {
va009039 11:61843badd06e 57 GPIO_InitTypeDef GPIO_InitStruct;
va009039 11:61843badd06e 58 if(hhcd->Instance==USB_OTG_FS)
va009039 11:61843badd06e 59 {
va009039 11:61843badd06e 60 /* Peripheral clock enable */
va009039 11:61843badd06e 61 __USB_OTG_FS_CLK_ENABLE();
va009039 11:61843badd06e 62
va009039 11:61843badd06e 63 /**USB_OTG_FS GPIO Configuration
va009039 11:61843badd06e 64 PA11 ------> USB_OTG_FS_DM
va009039 11:61843badd06e 65 PA12 ------> USB_OTG_FS_DP
va009039 11:61843badd06e 66 */
va009039 11:61843badd06e 67 GPIO_InitStruct.Pin = GPIO_PIN_11|GPIO_PIN_12;
va009039 11:61843badd06e 68 GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
va009039 11:61843badd06e 69 GPIO_InitStruct.Pull = GPIO_NOPULL;
va009039 11:61843badd06e 70 GPIO_InitStruct.Speed = GPIO_SPEED_LOW;
va009039 11:61843badd06e 71 GPIO_InitStruct.Alternate = GPIO_AF10_OTG_FS;
va009039 11:61843badd06e 72 HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
va009039 11:61843badd06e 73
va009039 11:61843badd06e 74 /* Peripheral interrupt init*/
va009039 11:61843badd06e 75 /* Sets the priority grouping field */
va009039 11:61843badd06e 76 HAL_NVIC_SetPriorityGrouping(NVIC_PRIORITYGROUP_0);
va009039 11:61843badd06e 77 HAL_NVIC_SetPriority(OTG_FS_IRQn, 0, 0);
va009039 11:61843badd06e 78 HAL_NVIC_EnableIRQ(OTG_FS_IRQn);
va009039 11:61843badd06e 79 }
va009039 11:61843badd06e 80 }
va009039 11:61843badd06e 81
va009039 16:981c3104f6c0 82 // stm32f4xx_it.c
va009039 11:61843badd06e 83 extern "C" {
va009039 11:61843badd06e 84 void HAL_HCD_Connect_Callback(HCD_HandleTypeDef *hhcd)
va009039 11:61843badd06e 85 {
va009039 11:61843badd06e 86 USB_TRACE();
va009039 11:61843badd06e 87 attach_done = true;
va009039 11:61843badd06e 88 }
va009039 11:61843badd06e 89
va009039 11:61843badd06e 90 } // extern "C"
va009039 11:61843badd06e 91
va009039 11:61843badd06e 92 USBHALHost* USBHALHost::instHost;
va009039 11:61843badd06e 93
va009039 11:61843badd06e 94 USBHALHost::USBHALHost() {
va009039 11:61843badd06e 95 instHost = this;
va009039 11:61843badd06e 96 }
va009039 11:61843badd06e 97
va009039 11:61843badd06e 98 void USBHALHost::init() {
va009039 11:61843badd06e 99 hhcd_USB_OTG_FS.Instance = USB_OTG_FS;
va009039 11:61843badd06e 100 hhcd_USB_OTG_FS.Init.Host_channels = 8;
va009039 11:61843badd06e 101 hhcd_USB_OTG_FS.Init.speed = HCD_SPEED_FULL;
va009039 11:61843badd06e 102 hhcd_USB_OTG_FS.Init.dma_enable = DISABLE;
va009039 11:61843badd06e 103 hhcd_USB_OTG_FS.Init.phy_itface = HCD_PHY_EMBEDDED;
va009039 11:61843badd06e 104 hhcd_USB_OTG_FS.Init.Sof_enable = DISABLE;
va009039 11:61843badd06e 105 hhcd_USB_OTG_FS.Init.low_power_enable = ENABLE;
va009039 11:61843badd06e 106 hhcd_USB_OTG_FS.Init.vbus_sensing_enable = DISABLE;
va009039 11:61843badd06e 107 hhcd_USB_OTG_FS.Init.use_external_vbus = DISABLE;
va009039 11:61843badd06e 108
va009039 11:61843badd06e 109 HAL_HCD_Init(&hhcd_USB_OTG_FS);
va009039 11:61843badd06e 110 HAL_HCD_Start(&hhcd_USB_OTG_FS);
va009039 11:61843badd06e 111
va009039 11:61843badd06e 112 bool lowSpeed = wait_attach();
va009039 11:61843badd06e 113 delay_ms(200);
va009039 11:61843badd06e 114 HAL_HCD_ResetPort(&hhcd_USB_OTG_FS);
va009039 11:61843badd06e 115 delay_ms(100); // Wait for 100 ms after Reset
va009039 11:61843badd06e 116 addDevice(NULL, 0, lowSpeed);
va009039 11:61843badd06e 117 }
va009039 11:61843badd06e 118
va009039 11:61843badd06e 119 bool USBHALHost::wait_attach() {
va009039 11:61843badd06e 120 Timer t;
va009039 11:61843badd06e 121 t.reset();
va009039 11:61843badd06e 122 t.start();
va009039 11:61843badd06e 123 while(!attach_done) {
va009039 11:61843badd06e 124 if (t.read_ms() > 5*1000) {
va009039 11:61843badd06e 125 t.reset();
va009039 11:61843badd06e 126 USB_INFO("Please attach USB device.");
va009039 11:61843badd06e 127 }
va009039 11:61843badd06e 128 }
va009039 11:61843badd06e 129 wait_ms(100);
va009039 11:61843badd06e 130 return HAL_HCD_GetCurrentSpeed(&hhcd_USB_OTG_FS) == USB_OTG_SPEED_LOW;
va009039 11:61843badd06e 131 }
va009039 11:61843badd06e 132
va009039 11:61843badd06e 133 int USBHALHost::token_setup(USBEndpoint* ep, SETUP_PACKET* setup, uint16_t wLength) {
va009039 16:981c3104f6c0 134 const uint8_t ep_addr = 0x00;
va009039 16:981c3104f6c0 135 HC hc;
va009039 11:61843badd06e 136 USBDeviceConnected* dev = ep->getDevice();
va009039 16:981c3104f6c0 137 hc.Init(ep_addr,
va009039 11:61843badd06e 138 dev->getAddress(),
va009039 11:61843badd06e 139 dev->getSpeed() ? HCD_SPEED_LOW : HCD_SPEED_FULL,
va009039 11:61843badd06e 140 EP_TYPE_CTRL, ep->getSize());
va009039 11:61843badd06e 141
va009039 11:61843badd06e 142 setup->wLength = wLength;
va009039 16:981c3104f6c0 143 hc.SubmitRequest((uint8_t*)setup, 8, true); // PID_SETUP
va009039 16:981c3104f6c0 144 while(hc.GetURBState() == URB_IDLE);
va009039 11:61843badd06e 145
va009039 16:981c3104f6c0 146 switch(hc.GetURBState()) {
va009039 11:61843badd06e 147 case URB_DONE:
va009039 11:61843badd06e 148 LastStatus = ACK;
va009039 11:61843badd06e 149 break;
va009039 11:61843badd06e 150 default:
va009039 11:61843badd06e 151 LastStatus = 0xff;
va009039 11:61843badd06e 152 break;
va009039 11:61843badd06e 153 }
va009039 11:61843badd06e 154 ep->setData01(DATA1);
va009039 16:981c3104f6c0 155 return 8;
va009039 11:61843badd06e 156 }
va009039 11:61843badd06e 157
va009039 11:61843badd06e 158 int USBHALHost::token_in(USBEndpoint* ep, uint8_t* data, int size, int retryLimit) {
va009039 11:61843badd06e 159 switch(ep->getType()) {
va009039 11:61843badd06e 160 case CONTROL_ENDPOINT:
va009039 11:61843badd06e 161 return token_ctl_in(ep, data, size, retryLimit);
va009039 11:61843badd06e 162 case INTERRUPT_ENDPOINT:
va009039 11:61843badd06e 163 return token_int_in(ep, data, size);
va009039 11:61843badd06e 164 case BULK_ENDPOINT:
va009039 11:61843badd06e 165 return token_blk_in(ep, data, size, retryLimit);
va009039 11:61843badd06e 166 }
va009039 11:61843badd06e 167 return -1;
va009039 11:61843badd06e 168 }
va009039 11:61843badd06e 169
va009039 11:61843badd06e 170 int USBHALHost::token_ctl_in(USBEndpoint* ep, uint8_t* data, int size, int retryLimit) {
va009039 16:981c3104f6c0 171 const uint8_t ep_addr = 0x80;
va009039 16:981c3104f6c0 172 HC hc;
va009039 11:61843badd06e 173 USBDeviceConnected* dev = ep->getDevice();
va009039 16:981c3104f6c0 174 hc.Init(ep_addr,
va009039 11:61843badd06e 175 dev->getAddress(),
va009039 11:61843badd06e 176 dev->getSpeed() ? HCD_SPEED_LOW : HCD_SPEED_FULL,
va009039 11:61843badd06e 177 EP_TYPE_CTRL, ep->getSize());
va009039 16:981c3104f6c0 178
va009039 16:981c3104f6c0 179 hc.SetToggle((ep->getData01() == DATA0) ? 0 : 1);
va009039 11:61843badd06e 180
va009039 16:981c3104f6c0 181 hc.SubmitRequest(data, size);
va009039 16:981c3104f6c0 182 while(hc.GetURBState() == URB_IDLE);
va009039 11:61843badd06e 183
va009039 16:981c3104f6c0 184 switch(hc.GetURBState()) {
va009039 11:61843badd06e 185 case URB_DONE:
va009039 11:61843badd06e 186 LastStatus = ACK;
va009039 11:61843badd06e 187 break;
va009039 11:61843badd06e 188 default:
va009039 11:61843badd06e 189 LastStatus = 0xff;
va009039 11:61843badd06e 190 return -1;
va009039 11:61843badd06e 191 }
va009039 11:61843badd06e 192 ep->toggleData01();
va009039 16:981c3104f6c0 193 return hc.GetXferCount();
va009039 11:61843badd06e 194 }
va009039 11:61843badd06e 195
va009039 11:61843badd06e 196 int USBHALHost::token_int_in(USBEndpoint* ep, uint8_t* data, int size) {
va009039 16:981c3104f6c0 197 HC hc;
va009039 11:61843badd06e 198 USBDeviceConnected* dev = ep->getDevice();
va009039 16:981c3104f6c0 199 hc.Init(
va009039 11:61843badd06e 200 ep->getAddress(),
va009039 11:61843badd06e 201 dev->getAddress(),
va009039 11:61843badd06e 202 dev->getSpeed() ? HCD_SPEED_LOW : HCD_SPEED_FULL,
va009039 11:61843badd06e 203 EP_TYPE_INTR, ep->getSize());
va009039 16:981c3104f6c0 204
va009039 16:981c3104f6c0 205 hc.SetToggle((ep->getData01() == DATA0) ? 0 : 1);
va009039 11:61843badd06e 206
va009039 16:981c3104f6c0 207 hc.SubmitRequest(data, size);
va009039 16:981c3104f6c0 208 while(hc.GetURBState() == URB_IDLE);
va009039 16:981c3104f6c0 209 switch(hc.GetURBState()) {
va009039 11:61843badd06e 210 case URB_DONE:
va009039 16:981c3104f6c0 211 switch(hc.GetState()) {
va009039 11:61843badd06e 212 case HC_XFRC:
va009039 11:61843badd06e 213 LastStatus = ep->getData01();
va009039 11:61843badd06e 214 ep->toggleData01();
va009039 16:981c3104f6c0 215 return hc.GetXferCount();
va009039 11:61843badd06e 216 case HC_NAK:
va009039 11:61843badd06e 217 LastStatus = NAK;
va009039 11:61843badd06e 218 return -1;
va009039 11:61843badd06e 219 }
va009039 11:61843badd06e 220 break;
va009039 11:61843badd06e 221 }
va009039 11:61843badd06e 222 LastStatus = STALL;
va009039 11:61843badd06e 223 return -1;
va009039 11:61843badd06e 224 }
va009039 11:61843badd06e 225
va009039 11:61843badd06e 226 int USBHALHost::token_blk_in(USBEndpoint* ep, uint8_t* data, int size, int retryLimit) {
va009039 16:981c3104f6c0 227 HC hc;
va009039 11:61843badd06e 228 USBDeviceConnected* dev = ep->getDevice();
va009039 16:981c3104f6c0 229 hc.Init(
va009039 16:981c3104f6c0 230 ep->getAddress(),
va009039 16:981c3104f6c0 231 dev->getAddress(),
va009039 16:981c3104f6c0 232 HCD_SPEED_FULL,
va009039 16:981c3104f6c0 233 EP_TYPE_BULK, ep->getSize());
va009039 16:981c3104f6c0 234
va009039 16:981c3104f6c0 235 hc.SetToggle((ep->getData01() == DATA0) ? 0 : 1);
va009039 16:981c3104f6c0 236
va009039 11:61843badd06e 237 int retry = 0;
va009039 11:61843badd06e 238 do {
va009039 16:981c3104f6c0 239 hc.SubmitRequest(data, size);
va009039 16:981c3104f6c0 240 while(hc.GetURBState() == URB_IDLE);
va009039 11:61843badd06e 241
va009039 16:981c3104f6c0 242 switch(hc.GetURBState()) {
va009039 11:61843badd06e 243 case URB_DONE:
va009039 16:981c3104f6c0 244 switch(hc.GetState()) {
va009039 11:61843badd06e 245 case HC_XFRC:
va009039 11:61843badd06e 246 LastStatus = ep->getData01();
va009039 11:61843badd06e 247 ep->toggleData01();
va009039 16:981c3104f6c0 248 return hc.GetXferCount();
va009039 11:61843badd06e 249 case HC_NAK:
va009039 11:61843badd06e 250 LastStatus = NAK;
va009039 11:61843badd06e 251 if (retryLimit > 0) {
va009039 11:61843badd06e 252 delay_ms(1 + 10 * retry);
va009039 11:61843badd06e 253 }
va009039 11:61843badd06e 254 break;
va009039 11:61843badd06e 255 default:
va009039 11:61843badd06e 256 break;
va009039 11:61843badd06e 257 }
va009039 11:61843badd06e 258 break;
va009039 11:61843badd06e 259 case URB_STALL:
va009039 11:61843badd06e 260 LastStatus = STALL;
va009039 11:61843badd06e 261 return -1;
va009039 11:61843badd06e 262 default:
va009039 11:61843badd06e 263 LastStatus = STALL;
va009039 11:61843badd06e 264 delay_ms(500 + 100 * retry);
va009039 11:61843badd06e 265 break;
va009039 11:61843badd06e 266 }
va009039 11:61843badd06e 267 }while(retry++ < retryLimit);
va009039 11:61843badd06e 268 return -1;
va009039 11:61843badd06e 269 }
va009039 11:61843badd06e 270
va009039 11:61843badd06e 271 int USBHALHost::token_out(USBEndpoint* ep, const uint8_t* data, int size, int retryLimit) {
va009039 11:61843badd06e 272 switch(ep->getType()) {
va009039 11:61843badd06e 273 case CONTROL_ENDPOINT:
va009039 11:61843badd06e 274 return token_ctl_out(ep, data, size, retryLimit);
va009039 11:61843badd06e 275 case INTERRUPT_ENDPOINT:
va009039 11:61843badd06e 276 return token_int_out(ep, data, size);
va009039 11:61843badd06e 277 case BULK_ENDPOINT:
va009039 11:61843badd06e 278 return token_blk_out(ep, data, size, retryLimit);
va009039 11:61843badd06e 279 }
va009039 11:61843badd06e 280 return -1;
va009039 11:61843badd06e 281 }
va009039 11:61843badd06e 282
va009039 11:61843badd06e 283 int USBHALHost::token_ctl_out(USBEndpoint* ep, const uint8_t* data, int size, int retryLimit) {
va009039 16:981c3104f6c0 284 const uint8_t ep_addr = 0x00;
va009039 16:981c3104f6c0 285 HC hc;
va009039 11:61843badd06e 286 USBDeviceConnected* dev = ep->getDevice();
va009039 16:981c3104f6c0 287 hc.Init(ep_addr,
va009039 16:981c3104f6c0 288 dev->getAddress(),
va009039 16:981c3104f6c0 289 dev->getSpeed() ? HCD_SPEED_LOW : HCD_SPEED_FULL,
va009039 16:981c3104f6c0 290 EP_TYPE_CTRL, ep->getSize());
va009039 16:981c3104f6c0 291
va009039 16:981c3104f6c0 292 hc.SetToggle((ep->getData01() == DATA0) ? 0 : 1);
va009039 11:61843badd06e 293
va009039 11:61843badd06e 294 do {
va009039 16:981c3104f6c0 295 hc.SubmitRequest((uint8_t*)data, size);
va009039 16:981c3104f6c0 296 while(hc.GetURBState() == URB_IDLE);
va009039 11:61843badd06e 297
va009039 16:981c3104f6c0 298 switch(hc.GetURBState()) {
va009039 11:61843badd06e 299 case URB_DONE:
va009039 11:61843badd06e 300 LastStatus = ACK;
va009039 11:61843badd06e 301 ep->toggleData01();
va009039 14:b167f2b97cb7 302 return size;
va009039 11:61843badd06e 303
va009039 11:61843badd06e 304 default:
va009039 11:61843badd06e 305 break;
va009039 11:61843badd06e 306 }
va009039 11:61843badd06e 307 delay_ms(1);
va009039 11:61843badd06e 308 }while(retryLimit-- > 0);
va009039 11:61843badd06e 309 return -1;
va009039 11:61843badd06e 310 }
va009039 11:61843badd06e 311
va009039 11:61843badd06e 312 int USBHALHost::token_int_out(USBEndpoint* ep, const uint8_t* data, int size) {
va009039 16:981c3104f6c0 313 HC hc;
va009039 11:61843badd06e 314 USBDeviceConnected* dev = ep->getDevice();
va009039 16:981c3104f6c0 315 hc.Init(
va009039 11:61843badd06e 316 ep->getAddress(),
va009039 11:61843badd06e 317 dev->getAddress(),
va009039 11:61843badd06e 318 dev->getSpeed() ? HCD_SPEED_LOW : HCD_SPEED_FULL,
va009039 11:61843badd06e 319 EP_TYPE_INTR, ep->getSize());
va009039 16:981c3104f6c0 320
va009039 16:981c3104f6c0 321 hc.SetToggle((ep->getData01() == DATA0) ? 0 : 1);
va009039 11:61843badd06e 322
va009039 16:981c3104f6c0 323 hc.SubmitRequest((uint8_t*)data, size);
va009039 16:981c3104f6c0 324 while(hc.GetURBState() == URB_IDLE);
va009039 16:981c3104f6c0 325 if (hc.GetURBState() != URB_DONE) {
va009039 11:61843badd06e 326 return -1;
va009039 11:61843badd06e 327 }
va009039 11:61843badd06e 328 ep->toggleData01();
va009039 14:b167f2b97cb7 329 return size;
va009039 11:61843badd06e 330 }
va009039 11:61843badd06e 331
va009039 11:61843badd06e 332 int USBHALHost::token_blk_out(USBEndpoint* ep, const uint8_t* data, int size, int retryLimit) {
va009039 16:981c3104f6c0 333 HC hc;
va009039 11:61843badd06e 334 USBDeviceConnected* dev = ep->getDevice();
va009039 16:981c3104f6c0 335 hc.Init(
va009039 16:981c3104f6c0 336 ep->getAddress(), dev->getAddress(),
va009039 16:981c3104f6c0 337 HCD_SPEED_FULL, EP_TYPE_BULK, ep->getSize());
va009039 16:981c3104f6c0 338
va009039 16:981c3104f6c0 339 hc.SetToggle((ep->getData01() == DATA0) ? 0 : 1);
va009039 16:981c3104f6c0 340
va009039 11:61843badd06e 341 int retry = 0;
va009039 11:61843badd06e 342 do {
va009039 16:981c3104f6c0 343 hc.SubmitRequest((uint8_t*)data, size);
va009039 16:981c3104f6c0 344 while(hc.GetURBState() == URB_IDLE);
va009039 11:61843badd06e 345
va009039 16:981c3104f6c0 346 switch(hc.GetURBState()) {
va009039 11:61843badd06e 347 case URB_DONE:
va009039 16:981c3104f6c0 348 switch(hc.GetState()) {
va009039 11:61843badd06e 349 case HC_XFRC: // ACK
va009039 11:61843badd06e 350 LastStatus = ep->getData01();
va009039 11:61843badd06e 351 ep->toggleData01();
va009039 14:b167f2b97cb7 352 return size;
va009039 11:61843badd06e 353 default:
va009039 11:61843badd06e 354 break;
va009039 11:61843badd06e 355 }
va009039 11:61843badd06e 356 break;
va009039 11:61843badd06e 357 case URB_NOTREADY: // HC_NAK
va009039 11:61843badd06e 358 LastStatus = NAK;
va009039 11:61843badd06e 359 delay_ms(100 * retry);
va009039 11:61843badd06e 360 break;
va009039 11:61843badd06e 361 default:
va009039 11:61843badd06e 362 LastStatus = STALL;
va009039 11:61843badd06e 363 return -1;
va009039 11:61843badd06e 364 }
va009039 11:61843badd06e 365 } while(retry++ < retryLimit);
va009039 11:61843badd06e 366 return -1;
va009039 11:61843badd06e 367 }
va009039 11:61843badd06e 368
va009039 11:61843badd06e 369 int USBHALHost::token_iso_in(USBEndpoint* ep, uint8_t* data, int size) {
va009039 16:981c3104f6c0 370 HC* hc = ep->getHALData<HC*>();
va009039 16:981c3104f6c0 371 if (hc == NULL) {
va009039 16:981c3104f6c0 372 hc = new HC;
va009039 16:981c3104f6c0 373 ep->setHALData<HC*>(hc);
va009039 13:8774c07f12a5 374 USBDeviceConnected* dev = ep->getDevice();
va009039 16:981c3104f6c0 375 hc->Init(
va009039 13:8774c07f12a5 376 ep->getAddress(), dev->getAddress(),
va009039 13:8774c07f12a5 377 HCD_SPEED_FULL, EP_TYPE_ISOC, ep->getSize());
va009039 13:8774c07f12a5 378 }
va009039 16:981c3104f6c0 379 hc->SubmitRequest(data, size);
va009039 16:981c3104f6c0 380 while(hc->GetURBState() == URB_IDLE);
va009039 16:981c3104f6c0 381 return hc->GetXferCount();
va009039 16:981c3104f6c0 382 }
va009039 16:981c3104f6c0 383
va009039 16:981c3104f6c0 384 int USBHALHost::multi_token_in(USBEndpoint* ep, uint8_t* data, size_t total, bool block) {
va009039 16:981c3104f6c0 385 if (total == 0) {
va009039 16:981c3104f6c0 386 return token_in(ep);
va009039 16:981c3104f6c0 387 }
va009039 16:981c3104f6c0 388 int retryLimit = block ? 10 : 0;
va009039 16:981c3104f6c0 389 int read_len = 0;
va009039 16:981c3104f6c0 390 for(int n = 0; read_len < total; n++) {
va009039 16:981c3104f6c0 391 int size = std::min((int)total-read_len, ep->getSize());
va009039 16:981c3104f6c0 392 int result = token_in(ep, data+read_len, size, retryLimit);
va009039 16:981c3104f6c0 393 if (result < 0) {
va009039 16:981c3104f6c0 394 if (block) {
va009039 16:981c3104f6c0 395 return -1;
va009039 16:981c3104f6c0 396 }
va009039 16:981c3104f6c0 397 if (LastStatus == NAK) {
va009039 16:981c3104f6c0 398 if (n == 0) {
va009039 16:981c3104f6c0 399 return -1;
va009039 16:981c3104f6c0 400 }
va009039 16:981c3104f6c0 401 break;
va009039 16:981c3104f6c0 402 }
va009039 16:981c3104f6c0 403 return result;
va009039 16:981c3104f6c0 404 }
va009039 16:981c3104f6c0 405 read_len += result;
va009039 16:981c3104f6c0 406 if (result < ep->getSize()) {
va009039 16:981c3104f6c0 407 break;
va009039 16:981c3104f6c0 408 }
va009039 16:981c3104f6c0 409 }
va009039 16:981c3104f6c0 410 return read_len;
va009039 16:981c3104f6c0 411 }
va009039 16:981c3104f6c0 412
va009039 16:981c3104f6c0 413 int USBHALHost::multi_token_out(USBEndpoint* ep, const uint8_t* data, size_t total, bool block) {
va009039 16:981c3104f6c0 414 if (total == 0) {
va009039 16:981c3104f6c0 415 return token_out(ep);
va009039 16:981c3104f6c0 416 }
va009039 16:981c3104f6c0 417 int write_len = 0;
va009039 16:981c3104f6c0 418 for(int n = 0; write_len < total; n++) {
va009039 16:981c3104f6c0 419 int size = std::min((int)total-write_len, ep->getSize());
va009039 16:981c3104f6c0 420 int result = token_out(ep, data+write_len, size);
va009039 16:981c3104f6c0 421 if (result < 0) {
va009039 16:981c3104f6c0 422 if (LastStatus == NAK) {
va009039 16:981c3104f6c0 423 if (n == 0) {
va009039 16:981c3104f6c0 424 return -1;
va009039 16:981c3104f6c0 425 }
va009039 16:981c3104f6c0 426 break;
va009039 16:981c3104f6c0 427 }
va009039 16:981c3104f6c0 428 USB_DBG("token_out result=%d %02x", result, LastStatus);
va009039 16:981c3104f6c0 429 return result;
va009039 16:981c3104f6c0 430 }
va009039 16:981c3104f6c0 431 write_len += result;
va009039 16:981c3104f6c0 432 if (result < ep->getSize()) {
va009039 16:981c3104f6c0 433 break;
va009039 16:981c3104f6c0 434 }
va009039 16:981c3104f6c0 435 }
va009039 16:981c3104f6c0 436 return write_len;
va009039 16:981c3104f6c0 437 }
va009039 16:981c3104f6c0 438
va009039 16:981c3104f6c0 439 uint8_t HC::slot = 0x00;
va009039 16:981c3104f6c0 440
va009039 16:981c3104f6c0 441 HC::HC() {
va009039 16:981c3104f6c0 442 uint8_t mask = 0x01;
va009039 16:981c3104f6c0 443 for(int i = 1; i < 8; i++, mask <<= 1) {
va009039 16:981c3104f6c0 444 if (!(slot & mask)) {
va009039 16:981c3104f6c0 445 slot |= mask;
va009039 16:981c3104f6c0 446 _ch = i;
va009039 16:981c3104f6c0 447 return;
va009039 16:981c3104f6c0 448 }
va009039 16:981c3104f6c0 449 }
va009039 16:981c3104f6c0 450 _ch = 0; // ERROR!!!
va009039 16:981c3104f6c0 451 }
va009039 16:981c3104f6c0 452
va009039 16:981c3104f6c0 453 HC::HC(int ch) {
va009039 16:981c3104f6c0 454 _ch = ch;
va009039 16:981c3104f6c0 455 slot |= (1<<_ch);
va009039 16:981c3104f6c0 456 }
va009039 16:981c3104f6c0 457
va009039 16:981c3104f6c0 458 HC::~HC() {
va009039 16:981c3104f6c0 459 slot &= ~(1<<_ch);
va009039 16:981c3104f6c0 460 }
va009039 16:981c3104f6c0 461
va009039 16:981c3104f6c0 462 HAL_StatusTypeDef HC::Init(uint8_t epnum, uint8_t dev_address, uint8_t speed, uint8_t ep_type, uint16_t mps) {
va009039 16:981c3104f6c0 463 _ep_addr = epnum;
va009039 16:981c3104f6c0 464 _ep_type = ep_type;
va009039 16:981c3104f6c0 465 return HAL_HCD_HC_Init(&hhcd_USB_OTG_FS, _ch,
va009039 16:981c3104f6c0 466 epnum, dev_address, speed, ep_type, mps);
va009039 16:981c3104f6c0 467 }
va009039 16:981c3104f6c0 468
va009039 16:981c3104f6c0 469 HAL_StatusTypeDef HC::SubmitRequest(uint8_t* pbuff, uint16_t length, bool setup) {
va009039 16:981c3104f6c0 470 uint8_t direction = (_ep_addr & 0x80) ? DIR_IN : DIR_OUT;
va009039 16:981c3104f6c0 471 if (_ep_type == EP_TYPE_CTRL) {
va009039 16:981c3104f6c0 472 HCD_HCTypeDef* hc = &hhcd_USB_OTG_FS.hc[_ch];
va009039 16:981c3104f6c0 473 if (setup) {
va009039 16:981c3104f6c0 474 hc->data_pid = HC_PID_SETUP;
va009039 16:981c3104f6c0 475 hc->toggle_out = 0;
va009039 16:981c3104f6c0 476 } else {
va009039 16:981c3104f6c0 477 if (direction == DIR_IN) {
va009039 16:981c3104f6c0 478 if (hc->toggle_in == 0) {
va009039 16:981c3104f6c0 479 hc->data_pid = HC_PID_DATA0;
va009039 16:981c3104f6c0 480 } else {
va009039 16:981c3104f6c0 481 hc->data_pid = HC_PID_DATA1;
va009039 16:981c3104f6c0 482 }
va009039 16:981c3104f6c0 483 } else { // OUT
va009039 16:981c3104f6c0 484 if (hc->toggle_out == 0) {
va009039 16:981c3104f6c0 485 hc->data_pid = HC_PID_DATA0;
va009039 16:981c3104f6c0 486 } else {
va009039 16:981c3104f6c0 487 hc->data_pid = HC_PID_DATA1;
va009039 16:981c3104f6c0 488 }
va009039 16:981c3104f6c0 489 }
va009039 16:981c3104f6c0 490 }
va009039 16:981c3104f6c0 491 hc->xfer_buff = pbuff;
va009039 16:981c3104f6c0 492 hc->xfer_len = length;
va009039 16:981c3104f6c0 493 hc->urb_state = URB_IDLE;
va009039 16:981c3104f6c0 494 hc->xfer_count = 0;
va009039 16:981c3104f6c0 495 hc->ch_num = _ch;
va009039 16:981c3104f6c0 496 hc->state = HC_IDLE;
va009039 16:981c3104f6c0 497
va009039 16:981c3104f6c0 498 return USB_HC_StartXfer(hhcd_USB_OTG_FS.Instance, hc, 0);
va009039 16:981c3104f6c0 499 }
va009039 16:981c3104f6c0 500 return HAL_HCD_HC_SubmitRequest(&hhcd_USB_OTG_FS, _ch,
va009039 16:981c3104f6c0 501 direction, _ep_type, 0, pbuff, length, 0);
va009039 16:981c3104f6c0 502 }
va009039 16:981c3104f6c0 503
va009039 16:981c3104f6c0 504 HCD_URBStateTypeDef HC::GetURBState() {
va009039 16:981c3104f6c0 505 return HAL_HCD_HC_GetURBState(&hhcd_USB_OTG_FS, _ch);
va009039 16:981c3104f6c0 506 }
va009039 16:981c3104f6c0 507
va009039 16:981c3104f6c0 508 HCD_HCStateTypeDef HC::GetState() {
va009039 16:981c3104f6c0 509 return HAL_HCD_HC_GetState(&hhcd_USB_OTG_FS, _ch);
va009039 16:981c3104f6c0 510 }
va009039 16:981c3104f6c0 511
va009039 16:981c3104f6c0 512 uint32_t HC::GetXferCount() {
va009039 16:981c3104f6c0 513 return HAL_HCD_HC_GetXferCount(&hhcd_USB_OTG_FS, _ch);
va009039 16:981c3104f6c0 514 }
va009039 16:981c3104f6c0 515
va009039 16:981c3104f6c0 516 void HC::SetToggle(uint8_t toggle) {
va009039 16:981c3104f6c0 517 if (_ep_addr & 0x80) { // IN
va009039 16:981c3104f6c0 518 hhcd_USB_OTG_FS.hc[_ch].toggle_in = toggle;
va009039 16:981c3104f6c0 519 } else { // OUT
va009039 16:981c3104f6c0 520 hhcd_USB_OTG_FS.hc[_ch].toggle_out = toggle;
va009039 16:981c3104f6c0 521 }
va009039 11:61843badd06e 522 }
va009039 11:61843badd06e 523
va009039 11:61843badd06e 524 #endif
va009039 11:61843badd06e 525
va009039 11:61843badd06e 526