UVC host library

Dependents:   LifeCam WebcamServer

Committer:
va009039
Date:
Wed Aug 15 13:52:53 2012 +0000
Revision:
3:3eb41d749f9a
Parent:
0:b0f04c137829
add USB_USE_MALLOC

Who changed what in which revision?

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