Ken Todotani / Mbed 2 deprecated BTstackLE

BLE demo for mbed Ported RunningElectronics's SBDBT firmware for BLE. It can communicate with iOS

Dependencies:   FatFileSystem mbed

Fork of BTstack by Norimasa Okamoto

usb/UsbEndpoint.cpp@0:1ed23ab1345f, 2012-06-26 (annotated)

Committer:
va009039
Date:
Tue Jun 26 14:27:45 2012 +0000
Revision:
0:1ed23ab1345f
fix overflow spp_service_buffer

Who changed what in which revision?

UserRevisionLine numberNew contents of line
va009039 0:1ed23ab1345f 1
va009039 0:1ed23ab1345f 2 /*
va009039 0:1ed23ab1345f 3 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
va009039 0:1ed23ab1345f 4
va009039 0:1ed23ab1345f 5 Permission is hereby granted, free of charge, to any person obtaining a copy
va009039 0:1ed23ab1345f 6 of this software and associated documentation files (the "Software"), to deal
va009039 0:1ed23ab1345f 7 in the Software without restriction, including without limitation the rights
va009039 0:1ed23ab1345f 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
va009039 0:1ed23ab1345f 9 copies of the Software, and to permit persons to whom the Software is
va009039 0:1ed23ab1345f 10 furnished to do so, subject to the following conditions:
va009039 0:1ed23ab1345f 11
va009039 0:1ed23ab1345f 12 The above copyright notice and this permission notice shall be included in
va009039 0:1ed23ab1345f 13 all copies or substantial portions of the Software.
va009039 0:1ed23ab1345f 14
va009039 0:1ed23ab1345f 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
va009039 0:1ed23ab1345f 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
va009039 0:1ed23ab1345f 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
va009039 0:1ed23ab1345f 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
va009039 0:1ed23ab1345f 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
va009039 0:1ed23ab1345f 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
va009039 0:1ed23ab1345f 21 THE SOFTWARE.
va009039 0:1ed23ab1345f 22 */
va009039 0:1ed23ab1345f 23
va009039 0:1ed23ab1345f 24 #include "UsbEndpoint.h"
va009039 0:1ed23ab1345f 25 #include "UsbDevice.h"
va009039 0:1ed23ab1345f 26 #include "usb_mem.h"
va009039 0:1ed23ab1345f 27 #include "Usb_td.h"
va009039 0:1ed23ab1345f 28 #include "netCfg.h"
va009039 0:1ed23ab1345f 29 #if NET_USB
va009039 0:1ed23ab1345f 30
va009039 0:1ed23ab1345f 31 //#define __DEBUG
va009039 0:1ed23ab1345f 32 //#define __DEBUG3
va009039 0:1ed23ab1345f 33 //#include "dbg/dbg.h"
va009039 0:1ed23ab1345f 34 #include "mydbg.h"
va009039 0:1ed23ab1345f 35
va009039 0:1ed23ab1345f 36 UsbEndpoint::UsbEndpoint( UsbDevice* pDevice, uint8_t ep, bool dir, UsbEndpointType type, uint16_t size, int addr /*= -1*/ )
va009039 0:1ed23ab1345f 37 : m_pDevice(pDevice), m_result(true), m_status((int)USBERR_OK), m_len(0), m_pBufStartPtr(NULL),
va009039 0:1ed23ab1345f 38 m_pCbItem(NULL), m_pCbMeth(NULL)
va009039 0:1ed23ab1345f 39 {
va009039 0:1ed23ab1345f 40 if (type == USB_ISO) {
va009039 0:1ed23ab1345f 41 UsbEndpoint_iso(pDevice, ep, dir, type, size, addr);
va009039 0:1ed23ab1345f 42 return;
va009039 0:1ed23ab1345f 43 }
va009039 0:1ed23ab1345f 44
va009039 0:1ed23ab1345f 45 m_pEd = (volatile HCED*)usb_get_ed();
va009039 0:1ed23ab1345f 46 DBG_ASSERT(m_pEd);
va009039 0:1ed23ab1345f 47 memset((void*)m_pEd, 0, sizeof(HCED));
va009039 0:1ed23ab1345f 48
va009039 0:1ed23ab1345f 49 m_pTdHead = (volatile HCTD*)usb_get_td((uint32_t)this);
va009039 0:1ed23ab1345f 50 DBG_ASSERT(m_pTdHead);
va009039 0:1ed23ab1345f 51 m_pTdTail = (volatile HCTD*)usb_get_td((uint32_t)this);
va009039 0:1ed23ab1345f 52 DBG_ASSERT(m_pTdTail);
va009039 0:1ed23ab1345f 53 DBG("m_pEd =%p\n", m_pEd);
va009039 0:1ed23ab1345f 54 DBG("m_pTdHead=%p\n", m_pTdHead);
va009039 0:1ed23ab1345f 55 DBG("m_pTdTail=%p\n", m_pTdTail);
va009039 0:1ed23ab1345f 56
va009039 0:1ed23ab1345f 57 if(addr == -1)
va009039 0:1ed23ab1345f 58 addr = pDevice->m_addr;
va009039 0:1ed23ab1345f 59
va009039 0:1ed23ab1345f 60 //Setup Ed
va009039 0:1ed23ab1345f 61 //printf("\r\n--Ep Setup--\r\n");
va009039 0:1ed23ab1345f 62 m_pEd->Control = addr | /* USB address */
va009039 0:1ed23ab1345f 63 ((ep & 0x7F) << 7) | /* Endpoint address */
va009039 0:1ed23ab1345f 64 (type!=USB_CONTROL?((dir?2:1) << 11):0) | /* direction : Out = 1, 2 = In */
va009039 0:1ed23ab1345f 65 (size << 16); /* MaxPkt Size */
va009039 0:1ed23ab1345f 66 DBG3("m_pEd->Control=%08X\n", m_pEd->Control);
va009039 0:1ed23ab1345f 67 m_dir = dir;
va009039 0:1ed23ab1345f 68 m_setup = false;
va009039 0:1ed23ab1345f 69 m_type = type;
va009039 0:1ed23ab1345f 70
va009039 0:1ed23ab1345f 71 m_pEd->TailTd = m_pEd->HeadTd = (uint32_t) m_pTdTail; //Empty TD list
va009039 0:1ed23ab1345f 72
va009039 0:1ed23ab1345f 73 DBG("Before link\n");
va009039 0:1ed23ab1345f 74
va009039 0:1ed23ab1345f 75 //printf("\r\n--Ep Reg--\r\n");
va009039 0:1ed23ab1345f 76 //Append Ed to Ed list
va009039 0:1ed23ab1345f 77 HCCA* hcca;
va009039 0:1ed23ab1345f 78 //volatile HCED* nextEd;
va009039 0:1ed23ab1345f 79 DBG("m_type=%d\n", m_type);
va009039 0:1ed23ab1345f 80 switch( m_type )
va009039 0:1ed23ab1345f 81 {
va009039 0:1ed23ab1345f 82 case USB_CONTROL:
va009039 0:1ed23ab1345f 83 m_pEd->Next = LPC_USB->HcControlHeadED;
va009039 0:1ed23ab1345f 84 LPC_USB->HcControlHeadED = (uint32_t)m_pEd;
va009039 0:1ed23ab1345f 85 return;
va009039 0:1ed23ab1345f 86
va009039 0:1ed23ab1345f 87 case USB_BULK:
va009039 0:1ed23ab1345f 88 m_pEd->Next = LPC_USB->HcBulkHeadED;
va009039 0:1ed23ab1345f 89 LPC_USB->HcBulkHeadED = (uint32_t)m_pEd;
va009039 0:1ed23ab1345f 90 return;
va009039 0:1ed23ab1345f 91
va009039 0:1ed23ab1345f 92 case USB_INT:
va009039 0:1ed23ab1345f 93 hcca = (HCCA*)usb_get_hcca();
va009039 0:1ed23ab1345f 94 m_pEd->Next = hcca->IntTable[0];
va009039 0:1ed23ab1345f 95 hcca->IntTable[0] = (uint32_t)m_pEd;
va009039 0:1ed23ab1345f 96 return;
va009039 0:1ed23ab1345f 97
va009039 0:1ed23ab1345f 98 default:
va009039 0:1ed23ab1345f 99 DBG_ASSERT(0);
va009039 0:1ed23ab1345f 100 }
va009039 0:1ed23ab1345f 101 }
va009039 0:1ed23ab1345f 102
va009039 0:1ed23ab1345f 103
va009039 0:1ed23ab1345f 104 UsbEndpoint::~UsbEndpoint()
va009039 0:1ed23ab1345f 105 {
va009039 0:1ed23ab1345f 106 DBG_ASSERT(0);
va009039 0:1ed23ab1345f 107
va009039 0:1ed23ab1345f 108 m_pEd->Control |= ED_SKIP; //Skip this Ep in queue
va009039 0:1ed23ab1345f 109
va009039 0:1ed23ab1345f 110 //Remove from queue
va009039 0:1ed23ab1345f 111 volatile HCED* prevEd;
va009039 0:1ed23ab1345f 112 HCCA* hcca;
va009039 0:1ed23ab1345f 113 switch( m_type )
va009039 0:1ed23ab1345f 114 {
va009039 0:1ed23ab1345f 115 case USB_CONTROL:
va009039 0:1ed23ab1345f 116 prevEd = (volatile HCED*) LPC_USB->HcControlHeadED;
va009039 0:1ed23ab1345f 117 break;
va009039 0:1ed23ab1345f 118 case USB_BULK:
va009039 0:1ed23ab1345f 119 prevEd = (volatile HCED*) LPC_USB->HcBulkHeadED;
va009039 0:1ed23ab1345f 120 break;
va009039 0:1ed23ab1345f 121 case USB_INT:
va009039 0:1ed23ab1345f 122 hcca = (HCCA*)usb_get_hcca();
va009039 0:1ed23ab1345f 123 prevEd = (volatile HCED*)hcca->IntTable[0];
va009039 0:1ed23ab1345f 124 break;
va009039 0:1ed23ab1345f 125 default:
va009039 0:1ed23ab1345f 126 DBG_ASSERT(0);
va009039 0:1ed23ab1345f 127 }
va009039 0:1ed23ab1345f 128 if( m_pEd == prevEd )
va009039 0:1ed23ab1345f 129 {
va009039 0:1ed23ab1345f 130 switch( m_type )
va009039 0:1ed23ab1345f 131 {
va009039 0:1ed23ab1345f 132 case USB_CONTROL:
va009039 0:1ed23ab1345f 133 LPC_USB->HcControlHeadED = m_pEd->Next;
va009039 0:1ed23ab1345f 134 break;
va009039 0:1ed23ab1345f 135 case USB_BULK:
va009039 0:1ed23ab1345f 136 LPC_USB->HcBulkHeadED = m_pEd->Next;
va009039 0:1ed23ab1345f 137 break;
va009039 0:1ed23ab1345f 138 case USB_INT:
va009039 0:1ed23ab1345f 139 hcca = (HCCA*)usb_get_hcca();
va009039 0:1ed23ab1345f 140 hcca->IntTable[0] = m_pEd->Next;
va009039 0:1ed23ab1345f 141 break;
va009039 0:1ed23ab1345f 142 default:
va009039 0:1ed23ab1345f 143 DBG_ASSERT(0);
va009039 0:1ed23ab1345f 144 }
va009039 0:1ed23ab1345f 145 LPC_USB->HcBulkHeadED = m_pEd->Next;
va009039 0:1ed23ab1345f 146 }
va009039 0:1ed23ab1345f 147 else
va009039 0:1ed23ab1345f 148 {
va009039 0:1ed23ab1345f 149 while( prevEd->Next != (uint32_t) m_pEd )
va009039 0:1ed23ab1345f 150 {
va009039 0:1ed23ab1345f 151 prevEd = (volatile HCED*) prevEd->Next;
va009039 0:1ed23ab1345f 152 }
va009039 0:1ed23ab1345f 153 prevEd->Next = m_pEd->Next;
va009039 0:1ed23ab1345f 154 }
va009039 0:1ed23ab1345f 155
va009039 0:1ed23ab1345f 156 //
va009039 0:1ed23ab1345f 157 usb_free_ed((volatile byte*)m_pEd);
va009039 0:1ed23ab1345f 158
va009039 0:1ed23ab1345f 159 usb_free_td((volatile byte*)m_pTdHead);
va009039 0:1ed23ab1345f 160 usb_free_td((volatile byte*)m_pTdTail);
va009039 0:1ed23ab1345f 161 }
va009039 0:1ed23ab1345f 162
va009039 0:1ed23ab1345f 163 void UsbEndpoint::setNextToken(uint32_t token) //Only for control Eps
va009039 0:1ed23ab1345f 164 {
va009039 0:1ed23ab1345f 165 switch(token)
va009039 0:1ed23ab1345f 166 {
va009039 0:1ed23ab1345f 167 case TD_SETUP:
va009039 0:1ed23ab1345f 168 m_dir = false;
va009039 0:1ed23ab1345f 169 m_setup = true;
va009039 0:1ed23ab1345f 170 break;
va009039 0:1ed23ab1345f 171 case TD_IN:
va009039 0:1ed23ab1345f 172 m_dir = true;
va009039 0:1ed23ab1345f 173 m_setup = false;
va009039 0:1ed23ab1345f 174 break;
va009039 0:1ed23ab1345f 175 case TD_OUT:
va009039 0:1ed23ab1345f 176 m_dir = false;
va009039 0:1ed23ab1345f 177 m_setup = false;
va009039 0:1ed23ab1345f 178 break;
va009039 0:1ed23ab1345f 179 }
va009039 0:1ed23ab1345f 180 }
va009039 0:1ed23ab1345f 181
va009039 0:1ed23ab1345f 182 UsbErr UsbEndpoint::transfer(volatile uint8_t* buf, uint32_t len)
va009039 0:1ed23ab1345f 183 {
va009039 0:1ed23ab1345f 184 DBG("buf=%p\n", buf);
va009039 0:1ed23ab1345f 185 if(!m_result)
va009039 0:1ed23ab1345f 186 return USBERR_BUSY; //The previous trasnfer is not completed
va009039 0:1ed23ab1345f 187 //FIXME: We should be able to queue the next transfer, still needs to be implemented
va009039 0:1ed23ab1345f 188
va009039 0:1ed23ab1345f 189 if( !m_pDevice->connected() )
va009039 0:1ed23ab1345f 190 return USBERR_DISCONNECTED;
va009039 0:1ed23ab1345f 191
va009039 0:1ed23ab1345f 192 m_result = false;
va009039 0:1ed23ab1345f 193
va009039 0:1ed23ab1345f 194 volatile uint32_t token = (m_setup?TD_SETUP:(m_dir?TD_IN:TD_OUT));
va009039 0:1ed23ab1345f 195
va009039 0:1ed23ab1345f 196 volatile uint32_t td_toggle;
va009039 0:1ed23ab1345f 197 if (m_type == USB_CONTROL)
va009039 0:1ed23ab1345f 198 {
va009039 0:1ed23ab1345f 199 if (m_setup)
va009039 0:1ed23ab1345f 200 {
va009039 0:1ed23ab1345f 201 td_toggle = TD_TOGGLE_0;
va009039 0:1ed23ab1345f 202 }
va009039 0:1ed23ab1345f 203 else
va009039 0:1ed23ab1345f 204 {
va009039 0:1ed23ab1345f 205 td_toggle = TD_TOGGLE_1;
va009039 0:1ed23ab1345f 206 }
va009039 0:1ed23ab1345f 207 }
va009039 0:1ed23ab1345f 208 else
va009039 0:1ed23ab1345f 209 {
va009039 0:1ed23ab1345f 210 td_toggle = 0;
va009039 0:1ed23ab1345f 211 }
va009039 0:1ed23ab1345f 212
va009039 0:1ed23ab1345f 213 //Swap Tds
va009039 0:1ed23ab1345f 214 volatile HCTD* pTdSwap;
va009039 0:1ed23ab1345f 215 pTdSwap = m_pTdTail;
va009039 0:1ed23ab1345f 216 m_pTdTail = m_pTdHead;
va009039 0:1ed23ab1345f 217 m_pTdHead = pTdSwap;
va009039 0:1ed23ab1345f 218
va009039 0:1ed23ab1345f 219 m_pTdHead->Control = (TD_ROUNDING |
va009039 0:1ed23ab1345f 220 token |
va009039 0:1ed23ab1345f 221 TD_DELAY_INT(0) |//7
va009039 0:1ed23ab1345f 222 td_toggle |
va009039 0:1ed23ab1345f 223 TD_CC);
va009039 0:1ed23ab1345f 224
va009039 0:1ed23ab1345f 225 m_pTdTail->Control = 0;
va009039 0:1ed23ab1345f 226 m_pTdHead->CurrBufPtr = (uint32_t) buf;
va009039 0:1ed23ab1345f 227 m_pBufStartPtr = buf;
va009039 0:1ed23ab1345f 228 m_pTdTail->CurrBufPtr = 0;
va009039 0:1ed23ab1345f 229 m_pTdHead->Next = (uint32_t) m_pTdTail;
va009039 0:1ed23ab1345f 230 m_pTdTail->Next = 0;
va009039 0:1ed23ab1345f 231 m_pTdHead->BufEnd = (uint32_t)(buf + (len - 1));
va009039 0:1ed23ab1345f 232 m_pTdTail->BufEnd = 0;
va009039 0:1ed23ab1345f 233
va009039 0:1ed23ab1345f 234 m_pEd->HeadTd = (uint32_t)m_pTdHead | ((m_pEd->HeadTd) & 0x00000002); //Carry bit
va009039 0:1ed23ab1345f 235 m_pEd->TailTd = (uint32_t)m_pTdTail;
va009039 0:1ed23ab1345f 236
va009039 0:1ed23ab1345f 237 //DBG("m_pEd->HeadTd = %08x\n", m_pEd->HeadTd);
va009039 0:1ed23ab1345f 238
va009039 0:1ed23ab1345f 239 if(m_type == USB_CONTROL) {
va009039 0:1ed23ab1345f 240 LPC_USB->HcCommandStatus = LPC_USB->HcCommandStatus | OR_CMD_STATUS_CLF;
va009039 0:1ed23ab1345f 241 LPC_USB->HcControl = LPC_USB->HcControl | OR_CONTROL_CLE; //Enable control list
va009039 0:1ed23ab1345f 242 } else if (m_type == USB_BULK) { //USB_BULK
va009039 0:1ed23ab1345f 243 LPC_USB->HcCommandStatus = LPC_USB->HcCommandStatus | OR_CMD_STATUS_BLF;
va009039 0:1ed23ab1345f 244 LPC_USB->HcControl = LPC_USB->HcControl | OR_CONTROL_BLE; //Enable bulk list
va009039 0:1ed23ab1345f 245 } else if (m_type == USB_INT) { // USB_INT
va009039 0:1ed23ab1345f 246 LPC_USB->HcControl = LPC_USB->HcControl | OR_CONTROL_PLE; //Enable Periodic
va009039 0:1ed23ab1345f 247 } else { // USB_ISO
va009039 0:1ed23ab1345f 248 DBG_ASSERT(0);
va009039 0:1ed23ab1345f 249 }
va009039 0:1ed23ab1345f 250
va009039 0:1ed23ab1345f 251 //m_done = false;
va009039 0:1ed23ab1345f 252 m_len = len;
va009039 0:1ed23ab1345f 253
va009039 0:1ed23ab1345f 254 return USBERR_PROCESSING;
va009039 0:1ed23ab1345f 255
va009039 0:1ed23ab1345f 256 }
va009039 0:1ed23ab1345f 257
va009039 0:1ed23ab1345f 258 int UsbEndpoint::status()
va009039 0:1ed23ab1345f 259 {
va009039 0:1ed23ab1345f 260 if( !m_pDevice->connected() )
va009039 0:1ed23ab1345f 261 {
va009039 0:1ed23ab1345f 262 if(!m_result)
va009039 0:1ed23ab1345f 263 onCompletion();
va009039 0:1ed23ab1345f 264 m_result = true;
va009039 0:1ed23ab1345f 265 return (int)USBERR_DISCONNECTED;
va009039 0:1ed23ab1345f 266 }
va009039 0:1ed23ab1345f 267 else if( !m_result )
va009039 0:1ed23ab1345f 268 {
va009039 0:1ed23ab1345f 269 return (int)USBERR_PROCESSING;
va009039 0:1ed23ab1345f 270 }
va009039 0:1ed23ab1345f 271 /*else if( m_done )
va009039 0:1ed23ab1345f 272 {
va009039 0:1ed23ab1345f 273 return (int)USBERR_OK;
va009039 0:1ed23ab1345f 274 }*/
va009039 0:1ed23ab1345f 275 else
va009039 0:1ed23ab1345f 276 {
va009039 0:1ed23ab1345f 277 return m_status;
va009039 0:1ed23ab1345f 278 }
va009039 0:1ed23ab1345f 279 }
va009039 0:1ed23ab1345f 280
va009039 0:1ed23ab1345f 281 void UsbEndpoint::updateAddr(int addr)
va009039 0:1ed23ab1345f 282 {
va009039 0:1ed23ab1345f 283 DBG("m_pEd->Control = %08x\n", m_pEd->Control);
va009039 0:1ed23ab1345f 284 m_pEd->Control &= ~0x7F;
va009039 0:1ed23ab1345f 285 m_pEd->Control |= addr;
va009039 0:1ed23ab1345f 286 DBG("m_pEd->Control = %08x\n", m_pEd->Control);
va009039 0:1ed23ab1345f 287 }
va009039 0:1ed23ab1345f 288
va009039 0:1ed23ab1345f 289 void UsbEndpoint::updateSize(uint16_t size)
va009039 0:1ed23ab1345f 290 {
va009039 0:1ed23ab1345f 291 DBG("m_pEd->Control = %08x\n", m_pEd->Control);
va009039 0:1ed23ab1345f 292 m_pEd->Control &= ~0x3FF0000;
va009039 0:1ed23ab1345f 293 m_pEd->Control |= (size << 16);
va009039 0:1ed23ab1345f 294 DBG("m_pEd->Control = %08x\n", m_pEd->Control);
va009039 0:1ed23ab1345f 295 }
va009039 0:1ed23ab1345f 296
va009039 0:1ed23ab1345f 297 #if 0 //For doc only
va009039 0:1ed23ab1345f 298 template <class T>
va009039 0:1ed23ab1345f 299 void UsbEndpoint::setOnCompletion( T* pCbItem, void (T::*pCbMeth)() )
va009039 0:1ed23ab1345f 300 {
va009039 0:1ed23ab1345f 301 m_pCbItem = (CDummy*) pCbItem;
va009039 0:1ed23ab1345f 302 m_pCbMeth = (void (CDummy::*)()) pCbMeth;
va009039 0:1ed23ab1345f 303 }
va009039 0:1ed23ab1345f 304 #endif
va009039 0:1ed23ab1345f 305
va009039 0:1ed23ab1345f 306 void UsbEndpoint::onCompletion()
va009039 0:1ed23ab1345f 307 {
va009039 0:1ed23ab1345f 308 DBG_ASSERT(m_type != USB_ISO);
va009039 0:1ed23ab1345f 309 DBG_ASSERT(m_pTdHead);
va009039 0:1ed23ab1345f 310 //DBG("Transfer completed\n");
va009039 0:1ed23ab1345f 311 if( m_pTdHead->Control >> 28 )
va009039 0:1ed23ab1345f 312 {
va009039 0:1ed23ab1345f 313 DBG("TD Failed with condition code %01x\n", m_pTdHead->Control >> 28 );
va009039 0:1ed23ab1345f 314 m_status = (int)USBERR_TDFAIL;
va009039 0:1ed23ab1345f 315 }
va009039 0:1ed23ab1345f 316 else if( m_pEd->HeadTd & 0x1 )
va009039 0:1ed23ab1345f 317 {
va009039 0:1ed23ab1345f 318 m_pEd->HeadTd = m_pEd->HeadTd & ~0x1;
va009039 0:1ed23ab1345f 319 DBG("\r\nHALTED!!\r\n");
va009039 0:1ed23ab1345f 320 m_status = (int)USBERR_HALTED;
va009039 0:1ed23ab1345f 321 }
va009039 0:1ed23ab1345f 322 else if( (m_pEd->HeadTd & ~0xF) == (uint32_t) m_pTdTail )
va009039 0:1ed23ab1345f 323 {
va009039 0:1ed23ab1345f 324 //Done
va009039 0:1ed23ab1345f 325 int len;
va009039 0:1ed23ab1345f 326 DBG("m_pEp=%p\n", m_pEd);
va009039 0:1ed23ab1345f 327 DBG("m_pTdHead->CurrBufPtr=%08x\n", (uint32_t)m_pTdHead->CurrBufPtr);
va009039 0:1ed23ab1345f 328 DBG("m_pBufStartPtr=%08x\n", (uint32_t) m_pBufStartPtr);
va009039 0:1ed23ab1345f 329 if(m_pTdHead->CurrBufPtr)
va009039 0:1ed23ab1345f 330 len = m_pTdHead->CurrBufPtr - (uint32_t) m_pBufStartPtr;
va009039 0:1ed23ab1345f 331 else
va009039 0:1ed23ab1345f 332 len = m_len;
va009039 0:1ed23ab1345f 333 /*if(len == 0) //Packet transfered completely
va009039 0:1ed23ab1345f 334 len = m_len;*/
va009039 0:1ed23ab1345f 335 //m_done = true;
va009039 0:1ed23ab1345f 336 DBG("Transfered %d bytes\n", len);
va009039 0:1ed23ab1345f 337 m_status = len;
va009039 0:1ed23ab1345f 338 }
va009039 0:1ed23ab1345f 339 else
va009039 0:1ed23ab1345f 340 {
va009039 0:1ed23ab1345f 341 DBG("Unknown error...\n");
va009039 0:1ed23ab1345f 342 m_status = (int)USBERR_ERROR;
va009039 0:1ed23ab1345f 343 }
va009039 0:1ed23ab1345f 344 m_result = true;
va009039 0:1ed23ab1345f 345 if(m_pCbItem && m_pCbMeth)
va009039 0:1ed23ab1345f 346 (m_pCbItem->*m_pCbMeth)();
va009039 0:1ed23ab1345f 347 }
va009039 0:1ed23ab1345f 348
va009039 0:1ed23ab1345f 349
va009039 0:1ed23ab1345f 350
va009039 0:1ed23ab1345f 351 void UsbEndpoint::sOnCompletion(uint32_t pTd)
va009039 0:1ed23ab1345f 352 {
va009039 0:1ed23ab1345f 353 HCTD* td = td_reverse((HCTD*)pTd);
va009039 0:1ed23ab1345f 354 while(td) {
va009039 0:1ed23ab1345f 355 HCTD* next = (HCTD*)td->Next;
va009039 0:1ed23ab1345f 356 HCUTD* utd = (HCUTD*)td;
va009039 0:1ed23ab1345f 357 UsbEndpoint* pEp = (UsbEndpoint*)utd->UsbEndpoint;
va009039 0:1ed23ab1345f 358 DBG_ASSERT(pEp);
va009039 0:1ed23ab1345f 359 if (usb_is_itd((byte*)td)) {
va009039 0:1ed23ab1345f 360 HCITD* itd = (HCITD*)td;
va009039 0:1ed23ab1345f 361 DBG_ASSERT(pEp->m_type == USB_ISO);
va009039 0:1ed23ab1345f 362 pEp->queue_done_itd.push(itd);
va009039 0:1ed23ab1345f 363 } else {
va009039 0:1ed23ab1345f 364 DBG_ASSERT(pEp->m_pTdHead == td);
va009039 0:1ed23ab1345f 365 if(pEp->m_pTdHead == td) { // found?
va009039 0:1ed23ab1345f 366 pEp->onCompletion();
va009039 0:1ed23ab1345f 367 }
va009039 0:1ed23ab1345f 368 }
va009039 0:1ed23ab1345f 369 td = next;
va009039 0:1ed23ab1345f 370 }
va009039 0:1ed23ab1345f 371 }
va009039 0:1ed23ab1345f 372
va009039 0:1ed23ab1345f 373 #endif