Nino Der Kinderen / Mbed 2 deprecated InetTest

Embedded C project:18/12/2014

Dependencies:   DS1307 TextLCD mbed

NetServices/drv/usb/UsbEndpoint.cpp@0:8d87bc453349, 2014-12-18 (annotated)

Committer:
ninoderkinderen
Date:
Thu Dec 18 09:35:49 2014 +0000
Revision:
0:8d87bc453349
Programma embedded C

Who changed what in which revision?

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