Justin S / F401RE-USBHost2

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   FATFileSystem2

Dependents:   N64_Output_KB

Fork of F401RE-USBHost by Norimasa Okamoto

USBHost/USBHALHost.cpp@8:6463cd1964c0, 2014-01-31 (annotated)

Committer:
va009039
Date:
Fri Jan 31 13:45:07 2014 +0000
Revision:
8:6463cd1964c0
Parent:
7:9a20482c9a7a
Child:
9:7f9f64cf5ded
USB hub support.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
va009039 7:9a20482c9a7a 1 // Simple USBHost for FRDM-KL46Z
va009039 7:9a20482c9a7a 2 #include "USBHALHost.h"
va009039 7:9a20482c9a7a 3
va009039 7:9a20482c9a7a 4 template <bool>struct CtAssert;
va009039 7:9a20482c9a7a 5 template <>struct CtAssert<true> {};
va009039 7:9a20482c9a7a 6 #define CTASSERT(A) CtAssert<A>();
va009039 7:9a20482c9a7a 7
va009039 7:9a20482c9a7a 8
va009039 7:9a20482c9a7a 9 #ifdef _USB_DBG
va009039 7:9a20482c9a7a 10 #define USB_DBG(...) do{fprintf(stderr,"[%s@%d] ",__PRETTY_FUNCTION__,__LINE__);fprintf(stderr,__VA_ARGS__);fprintf(stderr,"\n");} while(0);
va009039 7:9a20482c9a7a 11 #define USB_DBG_HEX(A,B) debug_hex(A,B)
va009039 7:9a20482c9a7a 12 void debug_hex(uint8_t* buf, int size);
va009039 7:9a20482c9a7a 13 #else
va009039 7:9a20482c9a7a 14 #define USB_DBG(...) while(0)
va009039 7:9a20482c9a7a 15 #define USB_DBG_HEX(A,B) while(0)
va009039 7:9a20482c9a7a 16 #endif
va009039 7:9a20482c9a7a 17
va009039 8:6463cd1964c0 18 #ifdef _USB_TEST
va009039 7:9a20482c9a7a 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 7:9a20482c9a7a 20 #define USB_TEST_ASSERT_FALSE(A) USB_TEST_ASSERT(!(A))
va009039 8:6463cd1964c0 21 #else
va009039 8:6463cd1964c0 22 #define USB_TEST_ASSERT(A) while(0)
va009039 8:6463cd1964c0 23 #define USB_TEST_ASSERT_FALSE(A) while(0)
va009039 8:6463cd1964c0 24 #endif
va009039 7:9a20482c9a7a 25
va009039 7:9a20482c9a7a 26 #define BD_OWN_MASK (1<<7)
va009039 7:9a20482c9a7a 27 #define BD_DATA01_MASK (1<<6)
va009039 7:9a20482c9a7a 28 #define BD_KEEP_MASK (1<<5)
va009039 7:9a20482c9a7a 29 #define BD_NINC_MASK (1<<4)
va009039 7:9a20482c9a7a 30 #define BD_DTS_MASK (1<<3)
va009039 7:9a20482c9a7a 31 #define BD_STALL_MASK (1<<2)
va009039 7:9a20482c9a7a 32
va009039 7:9a20482c9a7a 33 #define TX 1
va009039 7:9a20482c9a7a 34 #define RX 0
va009039 7:9a20482c9a7a 35
va009039 7:9a20482c9a7a 36 #define EP0_BDT_IDX(dir, odd) (((2 * dir) + (1 * odd)))
va009039 7:9a20482c9a7a 37
va009039 7:9a20482c9a7a 38 #define SETUP_TOKEN 0x0D
va009039 7:9a20482c9a7a 39 #define IN_TOKEN 0x09
va009039 7:9a20482c9a7a 40 #define OUT_TOKEN 0x01
va009039 7:9a20482c9a7a 41
va009039 7:9a20482c9a7a 42 // for each endpt: 8 bytes
va009039 7:9a20482c9a7a 43 struct BDT {
va009039 7:9a20482c9a7a 44 uint8_t info; // BD[0:7]
va009039 7:9a20482c9a7a 45 uint8_t dummy; // RSVD: BD[8:15]
va009039 7:9a20482c9a7a 46 uint16_t byte_count; // BD[16:32]
va009039 7:9a20482c9a7a 47 uint32_t address; // Addr
va009039 7:9a20482c9a7a 48 void setBuffer(uint8_t* buf, int size) {
va009039 7:9a20482c9a7a 49 address = (uint32_t)buf;
va009039 7:9a20482c9a7a 50 byte_count = size;
va009039 7:9a20482c9a7a 51 }
va009039 7:9a20482c9a7a 52 uint8_t getStatus() {
va009039 7:9a20482c9a7a 53 return (info>>2)&0x0f;
va009039 7:9a20482c9a7a 54 }
va009039 7:9a20482c9a7a 55 };
va009039 7:9a20482c9a7a 56
va009039 7:9a20482c9a7a 57 __attribute__((__aligned__(512))) BDT bdt[64];
va009039 7:9a20482c9a7a 58
va009039 7:9a20482c9a7a 59 USBHALHost* USBHALHost::instHost;
va009039 7:9a20482c9a7a 60
va009039 7:9a20482c9a7a 61 USBHALHost::USBHALHost() {
va009039 7:9a20482c9a7a 62 instHost = this;
va009039 7:9a20482c9a7a 63 report.clear();
va009039 7:9a20482c9a7a 64 }
va009039 7:9a20482c9a7a 65
va009039 7:9a20482c9a7a 66 void USBHALHost::init() {
va009039 7:9a20482c9a7a 67 // Disable IRQ
va009039 7:9a20482c9a7a 68 NVIC_DisableIRQ(USB0_IRQn);
va009039 7:9a20482c9a7a 69
va009039 7:9a20482c9a7a 70 // choose usb src as PLL
va009039 7:9a20482c9a7a 71 SIM->SOPT2 |= (SIM_SOPT2_USBSRC_MASK | SIM_SOPT2_PLLFLLSEL_MASK);
va009039 7:9a20482c9a7a 72
va009039 7:9a20482c9a7a 73 // enable OTG clock
va009039 7:9a20482c9a7a 74 SIM->SCGC4 |= SIM_SCGC4_USBOTG_MASK;
va009039 7:9a20482c9a7a 75
va009039 7:9a20482c9a7a 76 // USB Module Configuration
va009039 7:9a20482c9a7a 77 // Reset USB Module
va009039 7:9a20482c9a7a 78 USB0->USBTRC0 |= USB_USBTRC0_USBRESET_MASK;
va009039 7:9a20482c9a7a 79 while(USB0->USBTRC0 & USB_USBTRC0_USBRESET_MASK);
va009039 7:9a20482c9a7a 80
va009039 7:9a20482c9a7a 81 // Clear interrupt flag
va009039 7:9a20482c9a7a 82 USB0->ISTAT = 0xff;
va009039 7:9a20482c9a7a 83
va009039 7:9a20482c9a7a 84 // Set BDT Base Register
va009039 7:9a20482c9a7a 85 USB0->BDTPAGE1=(uint8_t)((uint32_t)bdt>>8);
va009039 7:9a20482c9a7a 86 USB0->BDTPAGE2=(uint8_t)((uint32_t)bdt>>16);
va009039 7:9a20482c9a7a 87 USB0->BDTPAGE3=(uint8_t)((uint32_t)bdt>>24);
va009039 7:9a20482c9a7a 88
va009039 7:9a20482c9a7a 89 // Set SOF threshold
va009039 7:9a20482c9a7a 90 USB0->SOFTHLD = USB_SOFTHLD_CNT(1);
va009039 7:9a20482c9a7a 91
va009039 7:9a20482c9a7a 92 // pulldown D+ and D-
va009039 7:9a20482c9a7a 93 USB0->USBCTRL = USB_USBCTRL_PDE_MASK;
va009039 7:9a20482c9a7a 94
va009039 7:9a20482c9a7a 95 USB0->USBTRC0 |= 0x40;
va009039 7:9a20482c9a7a 96
va009039 7:9a20482c9a7a 97 // Host mode
va009039 7:9a20482c9a7a 98 USB0->CTL |= USB_CTL_HOSTMODEEN_MASK;
va009039 7:9a20482c9a7a 99 // Desable SOF packet generation
va009039 7:9a20482c9a7a 100 USB0->CTL &= ~USB_CTL_USBENSOFEN_MASK;
va009039 7:9a20482c9a7a 101
va009039 7:9a20482c9a7a 102 NVIC_SetVector(USB0_IRQn, (uint32_t)_usbisr);
va009039 7:9a20482c9a7a 103 NVIC_EnableIRQ(USB0_IRQn);
va009039 7:9a20482c9a7a 104
va009039 8:6463cd1964c0 105 bool lowSpeed = wait_attach();
va009039 7:9a20482c9a7a 106
va009039 7:9a20482c9a7a 107 for(int retry = 2; retry > 0; retry--) {
va009039 7:9a20482c9a7a 108 // Enable RESET
va009039 7:9a20482c9a7a 109 USB0->CTL |= USB_CTL_RESET_MASK;
va009039 7:9a20482c9a7a 110 wait_ms(500);
va009039 7:9a20482c9a7a 111 USB0->CTL &= ~USB_CTL_RESET_MASK;
va009039 7:9a20482c9a7a 112
va009039 7:9a20482c9a7a 113 // Enable SOF
va009039 7:9a20482c9a7a 114 USB0->CTL |= USB_CTL_USBENSOFEN_MASK;
va009039 7:9a20482c9a7a 115 wait_ms(100);
va009039 7:9a20482c9a7a 116
va009039 7:9a20482c9a7a 117 // token transfer initialize
va009039 7:9a20482c9a7a 118 token_transfer_init();
va009039 7:9a20482c9a7a 119
va009039 7:9a20482c9a7a 120 USB0->INTEN |= USB_INTEN_TOKDNEEN_MASK|
va009039 7:9a20482c9a7a 121 USB_INTEN_ERROREN_MASK;
va009039 7:9a20482c9a7a 122 USB0->ERREN |= USB_ERREN_PIDERREN_MASK|
va009039 7:9a20482c9a7a 123 USB_ERREN_CRC5EOFEN_MASK|
va009039 7:9a20482c9a7a 124 USB_ERREN_CRC16EN_MASK|
va009039 7:9a20482c9a7a 125 USB_ERREN_DFN8EN_MASK|
va009039 7:9a20482c9a7a 126 USB_ERREN_BTOERREN_MASK|
va009039 7:9a20482c9a7a 127 USB_ERREN_DMAERREN_MASK|
va009039 7:9a20482c9a7a 128 USB_ERREN_BTSERREN_MASK;
va009039 7:9a20482c9a7a 129
va009039 8:6463cd1964c0 130 if (addDevice(0, 0, lowSpeed)) {
va009039 7:9a20482c9a7a 131 break;
va009039 7:9a20482c9a7a 132 }
va009039 7:9a20482c9a7a 133 USB_DBG("retry=%d", retry);
va009039 7:9a20482c9a7a 134 USB_TEST_ASSERT(retry > 1);
va009039 7:9a20482c9a7a 135 }
va009039 7:9a20482c9a7a 136 }
va009039 7:9a20482c9a7a 137
va009039 8:6463cd1964c0 138 bool USBHALHost::wait_attach() {
va009039 7:9a20482c9a7a 139 attach_done = false;
va009039 7:9a20482c9a7a 140 USB0->INTEN = USB_INTEN_ATTACHEN_MASK;
va009039 7:9a20482c9a7a 141 while(!attach_done);
va009039 7:9a20482c9a7a 142 wait_ms(100);
va009039 7:9a20482c9a7a 143 USB_TEST_ASSERT_FALSE(USB0->CTL & USB_CTL_SE0_MASK);
va009039 8:6463cd1964c0 144 root_lowSpeed = (USB0->CTL & USB_CTL_JSTATE_MASK) ? false : true;
va009039 8:6463cd1964c0 145 return root_lowSpeed;
va009039 7:9a20482c9a7a 146 }
va009039 7:9a20482c9a7a 147
va009039 8:6463cd1964c0 148 void USBHALHost::setAddr(int _addr, bool _lowSpeed) {
va009039 8:6463cd1964c0 149 USB0->ADDR = (_lowSpeed ? USB_ADDR_LSEN_MASK : 0x00) | USB_ADDR_ADDR(_addr);
va009039 7:9a20482c9a7a 150 }
va009039 7:9a20482c9a7a 151
va009039 8:6463cd1964c0 152 void USBHALHost::setEndpoint() {
va009039 8:6463cd1964c0 153 USB0->ENDPOINT[0].ENDPT = (root_lowSpeed ? USB_ENDPT_HOSTWOHUB_MASK : 0x00)|
va009039 8:6463cd1964c0 154 USB_ENDPT_RETRYDIS_MASK|
va009039 7:9a20482c9a7a 155 USB_ENDPT_EPCTLDIS_MASK|
va009039 7:9a20482c9a7a 156 USB_ENDPT_EPRXEN_MASK|
va009039 7:9a20482c9a7a 157 USB_ENDPT_EPTXEN_MASK|
va009039 7:9a20482c9a7a 158 USB_ENDPT_EPHSHK_MASK;
va009039 7:9a20482c9a7a 159 }
va009039 7:9a20482c9a7a 160
va009039 7:9a20482c9a7a 161 void USBHALHost::token_transfer_init() {
va009039 7:9a20482c9a7a 162 tx_ptr = ODD;
va009039 7:9a20482c9a7a 163 rx_ptr = ODD;
va009039 7:9a20482c9a7a 164 }
va009039 7:9a20482c9a7a 165
va009039 7:9a20482c9a7a 166 int USBHALHost::token_setup(USBEndpoint* ep, SETUP_PACKET* setup, uint16_t wLength) {
va009039 8:6463cd1964c0 167 USBDeviceConnected* dev = ep->getDevice();
va009039 7:9a20482c9a7a 168 for(int retry = 0;; retry++) {
va009039 7:9a20482c9a7a 169 token_ready();
va009039 8:6463cd1964c0 170 USB0->ENDPOINT[0].ENDPT = (root_lowSpeed ? USB_ENDPT_HOSTWOHUB_MASK : 0x00) |
va009039 7:9a20482c9a7a 171 USB_ENDPT_RETRYDIS_MASK|
va009039 7:9a20482c9a7a 172 USB_ENDPT_EPRXEN_MASK|
va009039 7:9a20482c9a7a 173 USB_ENDPT_EPTXEN_MASK|
va009039 7:9a20482c9a7a 174 USB_ENDPT_EPHSHK_MASK;
va009039 7:9a20482c9a7a 175 CTASSERT(sizeof(SETUP_PACKET) == 8);
va009039 7:9a20482c9a7a 176 setup->wLength = wLength;
va009039 7:9a20482c9a7a 177 int idx = EP0_BDT_IDX(TX, tx_ptr);
va009039 7:9a20482c9a7a 178 bdt[idx].setBuffer((uint8_t*)setup, sizeof(SETUP_PACKET));
va009039 7:9a20482c9a7a 179 bdt[idx].info = BD_OWN_MASK |
va009039 7:9a20482c9a7a 180 BD_DTS_MASK; // always data0
va009039 7:9a20482c9a7a 181 token_done = false;
va009039 7:9a20482c9a7a 182 USB0->TOKEN = USB_TOKEN_TOKENPID(SETUP_TOKEN)|
va009039 7:9a20482c9a7a 183 USB_TOKEN_TOKENENDPT(ep->getAddress() & 0x7f);
va009039 7:9a20482c9a7a 184 while(!token_done);
va009039 7:9a20482c9a7a 185 LastStatus = bdt[idx].getStatus();
va009039 7:9a20482c9a7a 186 if (LastStatus == ACK) {
va009039 7:9a20482c9a7a 187 if (retry > 0) {
va009039 7:9a20482c9a7a 188 USB_DBG("retry=%d %02x", retry, prev_LastStatus);
va009039 7:9a20482c9a7a 189 }
va009039 7:9a20482c9a7a 190 break;
va009039 7:9a20482c9a7a 191 } else if (LastStatus == STALL) {
va009039 7:9a20482c9a7a 192 report.stall++;
va009039 7:9a20482c9a7a 193 return STALL;
va009039 7:9a20482c9a7a 194 }
va009039 7:9a20482c9a7a 195 if (retry > 10) {
va009039 7:9a20482c9a7a 196 USB_DBG("retry=%d", retry);
va009039 7:9a20482c9a7a 197 break;
va009039 7:9a20482c9a7a 198 }
va009039 7:9a20482c9a7a 199 prev_LastStatus = LastStatus;
va009039 7:9a20482c9a7a 200 wait_ms(100 * retry);
va009039 7:9a20482c9a7a 201 }
va009039 7:9a20482c9a7a 202 ep->setData01(DATA1); // next toggle
va009039 7:9a20482c9a7a 203 return LastStatus;
va009039 7:9a20482c9a7a 204 }
va009039 7:9a20482c9a7a 205
va009039 7:9a20482c9a7a 206 int USBHALHost::token_in(USBEndpoint* ep, uint8_t* data, int size, int retryLimit) {
va009039 7:9a20482c9a7a 207 for(int retry = 0;; retry++) {
va009039 7:9a20482c9a7a 208 token_ready();
va009039 7:9a20482c9a7a 209 int idx = EP0_BDT_IDX(RX, rx_ptr);
va009039 7:9a20482c9a7a 210 bdt[idx].setBuffer(data, size);
va009039 7:9a20482c9a7a 211 bdt[idx].info = BD_OWN_MASK|
va009039 7:9a20482c9a7a 212 BD_DTS_MASK|
va009039 7:9a20482c9a7a 213 (ep->getData01() == DATA1 ? BD_DATA01_MASK : 0);
va009039 7:9a20482c9a7a 214 token_done = false;
va009039 7:9a20482c9a7a 215 USB0->TOKEN = USB_TOKEN_TOKENPID(IN_TOKEN)|
va009039 7:9a20482c9a7a 216 USB_TOKEN_TOKENENDPT(ep->getAddress()&0x7f);
va009039 7:9a20482c9a7a 217 while(!token_done);
va009039 7:9a20482c9a7a 218 LastStatus = bdt[idx].getStatus();
va009039 7:9a20482c9a7a 219 int len = bdt[idx].byte_count;
va009039 7:9a20482c9a7a 220 if (LastStatus == DATA0 || LastStatus == DATA1) {
va009039 7:9a20482c9a7a 221 USB_TEST_ASSERT(ep->getData01() == LastStatus);
va009039 7:9a20482c9a7a 222 ep->setData01(LastStatus == DATA0 ? DATA1 : DATA0);
va009039 7:9a20482c9a7a 223 if (retry > 0) {
va009039 8:6463cd1964c0 224 //USB_DBG("len=%d retry=%d %02x", len, retry, prev_LastStatus);
va009039 7:9a20482c9a7a 225 }
va009039 7:9a20482c9a7a 226 return len;
va009039 7:9a20482c9a7a 227 } else if (LastStatus == STALL) {
va009039 7:9a20482c9a7a 228 report.stall++;
va009039 7:9a20482c9a7a 229 return -1;
va009039 7:9a20482c9a7a 230 } else if (LastStatus == NAK) {
va009039 7:9a20482c9a7a 231 report.nak++;
va009039 7:9a20482c9a7a 232 if (retry >= retryLimit) {
va009039 7:9a20482c9a7a 233 if (retryLimit > 0) {
va009039 7:9a20482c9a7a 234 USB_DBG("retry=%d retryLimit=%d", retry, retryLimit);
va009039 7:9a20482c9a7a 235 }
va009039 7:9a20482c9a7a 236 return -1;
va009039 7:9a20482c9a7a 237 }
va009039 7:9a20482c9a7a 238 wait_ms(100 * retry);
va009039 7:9a20482c9a7a 239 } else if (LastStatus == Bus_Timeout) {
va009039 7:9a20482c9a7a 240 if (retry >= retryLimit) {
va009039 7:9a20482c9a7a 241 if (retryLimit > 0) {
va009039 7:9a20482c9a7a 242 USB_DBG("Bus_Timeout retry=%d retryLimit=%d", retry, retryLimit);
va009039 7:9a20482c9a7a 243 }
va009039 7:9a20482c9a7a 244 return -1;
va009039 7:9a20482c9a7a 245 }
va009039 7:9a20482c9a7a 246 wait_ms(500 + 100 * retry);
va009039 7:9a20482c9a7a 247 } else {
va009039 7:9a20482c9a7a 248 return -1;
va009039 7:9a20482c9a7a 249 }
va009039 7:9a20482c9a7a 250 prev_LastStatus = LastStatus;
va009039 7:9a20482c9a7a 251 }
va009039 7:9a20482c9a7a 252 }
va009039 7:9a20482c9a7a 253
va009039 7:9a20482c9a7a 254 int USBHALHost::token_out(USBEndpoint* ep, const uint8_t* data, int size, int retryLimit) {
va009039 7:9a20482c9a7a 255 for(int retry = 0;; retry++) {
va009039 7:9a20482c9a7a 256 token_ready();
va009039 7:9a20482c9a7a 257 int idx = EP0_BDT_IDX(TX, tx_ptr);
va009039 7:9a20482c9a7a 258 bdt[idx].setBuffer((uint8_t*)data, size);
va009039 7:9a20482c9a7a 259 bdt[idx].info = BD_OWN_MASK|
va009039 7:9a20482c9a7a 260 BD_DTS_MASK|
va009039 7:9a20482c9a7a 261 (ep->getData01() == DATA1 ? BD_DATA01_MASK : 0);
va009039 7:9a20482c9a7a 262 token_done = false;
va009039 7:9a20482c9a7a 263 USB0->TOKEN = USB_TOKEN_TOKENPID(OUT_TOKEN)|
va009039 7:9a20482c9a7a 264 USB_TOKEN_TOKENENDPT(ep->getAddress()&0x7f);
va009039 7:9a20482c9a7a 265 while(!token_done);
va009039 7:9a20482c9a7a 266 LastStatus = bdt[idx].getStatus();
va009039 7:9a20482c9a7a 267 int len = bdt[idx].byte_count;
va009039 7:9a20482c9a7a 268 //USB_DBG("len=%d %02x", len, LastStatus);
va009039 7:9a20482c9a7a 269 if (LastStatus == ACK) {
va009039 7:9a20482c9a7a 270 ep->toggleData01();
va009039 7:9a20482c9a7a 271 if (retry > 0) {
va009039 7:9a20482c9a7a 272 USB_DBG("len=%d retry=%d %02x", len, retry, prev_LastStatus);
va009039 7:9a20482c9a7a 273 }
va009039 7:9a20482c9a7a 274 return len;
va009039 7:9a20482c9a7a 275 } else if (LastStatus == STALL) {
va009039 7:9a20482c9a7a 276 report.stall++;
va009039 7:9a20482c9a7a 277 return -1;
va009039 7:9a20482c9a7a 278 } else if (LastStatus == NAK) {
va009039 7:9a20482c9a7a 279 report.nak++;
va009039 7:9a20482c9a7a 280 if (retry > retryLimit) {
va009039 7:9a20482c9a7a 281 USB_DBG("retry=%d retryLimit=%d", retry, retryLimit);
va009039 7:9a20482c9a7a 282 return -1;
va009039 7:9a20482c9a7a 283 }
va009039 7:9a20482c9a7a 284 wait_ms(100 * retry);
va009039 7:9a20482c9a7a 285 } else {
va009039 7:9a20482c9a7a 286 return -1;
va009039 7:9a20482c9a7a 287 }
va009039 7:9a20482c9a7a 288 prev_LastStatus = LastStatus;
va009039 7:9a20482c9a7a 289 }
va009039 7:9a20482c9a7a 290 }
va009039 7:9a20482c9a7a 291
va009039 7:9a20482c9a7a 292 int USBHALHost::token_iso_in(USBEndpoint* ep, uint8_t* data, int size) {
va009039 7:9a20482c9a7a 293 while(USB0->CTL & USB_CTL_TXSUSPENDTOKENBUSY_MASK); // TOKEN_BUSY ?
va009039 7:9a20482c9a7a 294 USB0->ISTAT |= USB_ISTAT_SOFTOK_MASK; // Clear SOF
va009039 7:9a20482c9a7a 295 while (!(USB0->ISTAT & USB_ISTAT_SOFTOK_MASK));
va009039 7:9a20482c9a7a 296 USB0->SOFTHLD = 0; // this is needed as without this you can get errors
va009039 7:9a20482c9a7a 297 USB0->ISTAT |= USB_ISTAT_SOFTOK_MASK; // clear SOF
va009039 7:9a20482c9a7a 298
va009039 7:9a20482c9a7a 299 USB0->ENDPOINT[0].ENDPT = USB_ENDPT_EPCTLDIS_MASK|
va009039 7:9a20482c9a7a 300 USB_ENDPT_RETRYDIS_MASK|
va009039 7:9a20482c9a7a 301 USB_ENDPT_EPRXEN_MASK|
va009039 7:9a20482c9a7a 302 USB_ENDPT_EPTXEN_MASK;
va009039 7:9a20482c9a7a 303 int idx = EP0_BDT_IDX(RX, rx_ptr);
va009039 7:9a20482c9a7a 304 bdt[idx].setBuffer(data, size);
va009039 7:9a20482c9a7a 305 bdt[idx].info = BD_OWN_MASK|
va009039 7:9a20482c9a7a 306 BD_DTS_MASK; // always DATA0
va009039 7:9a20482c9a7a 307 token_done = false;
va009039 7:9a20482c9a7a 308 USB0->TOKEN = USB_TOKEN_TOKENPID(IN_TOKEN)|
va009039 7:9a20482c9a7a 309 USB_TOKEN_TOKENENDPT(ep->getAddress()&0x7f);
va009039 7:9a20482c9a7a 310 while(!token_done);
va009039 7:9a20482c9a7a 311 LastStatus = bdt[idx].getStatus();
va009039 7:9a20482c9a7a 312 int len = bdt[idx].byte_count;
va009039 7:9a20482c9a7a 313 if (LastStatus == DATA0) {
va009039 7:9a20482c9a7a 314 return len;
va009039 7:9a20482c9a7a 315 }
va009039 7:9a20482c9a7a 316 return -1;
va009039 7:9a20482c9a7a 317 }
va009039 7:9a20482c9a7a 318
va009039 7:9a20482c9a7a 319 void USBHALHost::token_ready() {
va009039 7:9a20482c9a7a 320 while(USB0->CTL & USB_CTL_TXSUSPENDTOKENBUSY_MASK) { // TOKEN_BUSY ?
va009039 7:9a20482c9a7a 321 wait_ms(1);
va009039 7:9a20482c9a7a 322 }
va009039 7:9a20482c9a7a 323 USB0->ISTAT |= USB_ISTAT_SOFTOK_MASK; // Clear SOF
va009039 7:9a20482c9a7a 324 while (!(USB0->ISTAT & USB_ISTAT_SOFTOK_MASK));
va009039 7:9a20482c9a7a 325 USB0->SOFTHLD = 0; // this is needed as without this you can get errors
va009039 7:9a20482c9a7a 326 USB0->ISTAT |= USB_ISTAT_SOFTOK_MASK; // clear SOF
va009039 7:9a20482c9a7a 327 }
va009039 7:9a20482c9a7a 328
va009039 7:9a20482c9a7a 329 void USBHALHost::_usbisr(void) {
va009039 7:9a20482c9a7a 330 if (instHost) {
va009039 7:9a20482c9a7a 331 instHost->UsbIrqhandler();
va009039 7:9a20482c9a7a 332 }
va009039 7:9a20482c9a7a 333 }
va009039 7:9a20482c9a7a 334
va009039 7:9a20482c9a7a 335 void USBHALHost::UsbIrqhandler() {
va009039 7:9a20482c9a7a 336 if (USB0->ISTAT & USB_ISTAT_TOKDNE_MASK) {
va009039 7:9a20482c9a7a 337 uint8_t stat = USB0->STAT;
va009039 7:9a20482c9a7a 338 ODD_EVEN next_ptr = (stat & USB_STAT_ODD_MASK) ? ODD : EVEN;
va009039 7:9a20482c9a7a 339 if (stat & USB_STAT_TX_MASK) {
va009039 7:9a20482c9a7a 340 tx_ptr = next_ptr;
va009039 7:9a20482c9a7a 341 } else {
va009039 7:9a20482c9a7a 342 rx_ptr = next_ptr;
va009039 7:9a20482c9a7a 343 }
va009039 7:9a20482c9a7a 344 USB0->ISTAT = USB_ISTAT_TOKDNE_MASK;
va009039 7:9a20482c9a7a 345 token_done = true;
va009039 7:9a20482c9a7a 346 }
va009039 7:9a20482c9a7a 347 if (USB0->ISTAT & USB_ISTAT_ATTACH_MASK) {
va009039 7:9a20482c9a7a 348 USB0->INTEN &= ~USB_INTEN_ATTACHEN_MASK;
va009039 7:9a20482c9a7a 349 USB0->ISTAT = USB_ISTAT_ATTACH_MASK;
va009039 7:9a20482c9a7a 350 attach_done = true;
va009039 7:9a20482c9a7a 351 }
va009039 7:9a20482c9a7a 352 if (USB0->ISTAT & USB_ISTAT_ERROR_MASK) {
va009039 7:9a20482c9a7a 353 uint8_t errstat = USB0->ERRSTAT;
va009039 7:9a20482c9a7a 354 if (errstat & USB_ERRSTAT_PIDERR_MASK) {
va009039 7:9a20482c9a7a 355 report.errstat_piderr++;
va009039 7:9a20482c9a7a 356 }
va009039 7:9a20482c9a7a 357 if (errstat & USB_ERRSTAT_CRC5EOF_MASK) {
va009039 7:9a20482c9a7a 358 report.errstat_crc5eof++;
va009039 7:9a20482c9a7a 359 }
va009039 7:9a20482c9a7a 360 if (errstat & USB_ERRSTAT_CRC16_MASK) {
va009039 7:9a20482c9a7a 361 report.errstat_crc16++;
va009039 7:9a20482c9a7a 362 }
va009039 7:9a20482c9a7a 363 if (errstat & USB_ERRSTAT_DFN8_MASK) {
va009039 7:9a20482c9a7a 364 report.errstat_dfn8++;
va009039 7:9a20482c9a7a 365 }
va009039 7:9a20482c9a7a 366 if (errstat & USB_ERRSTAT_BTOERR_MASK) {
va009039 7:9a20482c9a7a 367 report.errstat_btoerr++;
va009039 7:9a20482c9a7a 368 }
va009039 7:9a20482c9a7a 369 if (errstat & USB_ERRSTAT_DMAERR_MASK) {
va009039 7:9a20482c9a7a 370 report.errstat_dmaerr++;
va009039 7:9a20482c9a7a 371 }
va009039 7:9a20482c9a7a 372 if (errstat & USB_ERRSTAT_BTSERR_MASK) {
va009039 7:9a20482c9a7a 373 report.errstat_btoerr++;
va009039 7:9a20482c9a7a 374 }
va009039 7:9a20482c9a7a 375 USB0->ERRSTAT = errstat;
va009039 7:9a20482c9a7a 376 USB0->ISTAT = USB_ISTAT_ERROR_MASK;
va009039 7:9a20482c9a7a 377 }
va009039 7:9a20482c9a7a 378 }
va009039 7:9a20482c9a7a 379
va009039 7:9a20482c9a7a 380 void Report::clear() {
va009039 7:9a20482c9a7a 381 errstat_piderr = 0;
va009039 7:9a20482c9a7a 382 errstat_crc5eof = 0;
va009039 7:9a20482c9a7a 383 errstat_crc16 = 0;
va009039 7:9a20482c9a7a 384 errstat_dfn8 = 0;
va009039 7:9a20482c9a7a 385 errstat_btoerr = 0;
va009039 7:9a20482c9a7a 386 errstat_dmaerr = 0;
va009039 7:9a20482c9a7a 387 errstat_bsterr = 0;
va009039 7:9a20482c9a7a 388 //
va009039 7:9a20482c9a7a 389 nak = 0;
va009039 7:9a20482c9a7a 390 }
va009039 7:9a20482c9a7a 391
va009039 7:9a20482c9a7a 392 void Report::print_errstat() {
va009039 7:9a20482c9a7a 393 printf("ERRSTAT PID: %d, CRC5EOF: %d, CRC16: %d, DFN8: %d, BTO: %d, DMA: %d, BST: %d\n",
va009039 7:9a20482c9a7a 394 errstat_piderr, errstat_crc5eof,
va009039 7:9a20482c9a7a 395 errstat_crc16, errstat_dfn8,
va009039 7:9a20482c9a7a 396 errstat_btoerr, errstat_dmaerr, errstat_bsterr);
va009039 7:9a20482c9a7a 397 }
va009039 7:9a20482c9a7a 398
va009039 7:9a20482c9a7a 399 void debug_hex(uint8_t* buf, int size) {
va009039 8:6463cd1964c0 400 int n = 0;
va009039 7:9a20482c9a7a 401 for(int i = 0; i < size; i++) {
va009039 7:9a20482c9a7a 402 fprintf(stderr, "%02x ", buf[i]);
va009039 8:6463cd1964c0 403 if (++n >= 16) {
va009039 8:6463cd1964c0 404 fprintf(stderr, "\n");
va009039 8:6463cd1964c0 405 n = 0;
va009039 7:9a20482c9a7a 406 }
va009039 7:9a20482c9a7a 407 }
va009039 8:6463cd1964c0 408 if (n > 0) {
va009039 8:6463cd1964c0 409 fprintf(stderr, "\n");
va009039 8:6463cd1964c0 410 }
va009039 7:9a20482c9a7a 411 }
va009039 7:9a20482c9a7a 412