M H / Mbed 2 deprecated prijimac-final

final

Dependencies:   mbed FATFileSystem

Fork of KL46Z-USBHostMSD_HelloWorld by Norimasa Okamoto

F401RE-USBHost/USBHost/USBHALHost_KL46Z.cpp@4:77d6450f34d7, 2015-04-04 (annotated)

Committer:
homzovam
Date:
Sat Apr 04 20:16:39 2015 +0000
Revision:
4:77d6450f34d7
prijimac-funkcni final

Who changed what in which revision?

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