Lorcan Smith / Mbed 2 deprecated Enet_SPI

SNMP agent attached to SPI slave

Dependencies:   mbed

drv/usb/UsbEndpoint.cpp@0:2a53a4c3238c, 2012-08-13 (annotated)

Committer:
lorcansmith
Date:
Mon Aug 13 15:07:40 2012 +0000
Revision:
0:2a53a4c3238c
v1.1 release includes ioAlarm traps

Who changed what in which revision?

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