Michael Spencer / Mbed 2 deprecated LaOS

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:   mbed

NetServices/drv/usb/UsbEndpoint.cpp@1:f5ac63519541, 2014-03-05 (annotated)

Committer:
Michael J. Spencer
Date:
Wed Mar 05 06:14:02 2014 -0800
Revision:
1:f5ac63519541
Initial commit.

Who changed what in which revision?

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