FBI FRATER / Mbed 2 deprecated InetTest

Library for Bert van Dam's book "ARM MICROCONTROLLERS" For all chapters with internet.

Dependencies:   mbed

NetServices/drv/usb/UsbEndpoint.cpp@0:4edb816d21e1, 2015-10-16 (annotated)

Committer:
ICTFBI
Date:
Fri Oct 16 14:28:26 2015 +0000
Revision:
0:4edb816d21e1
Pre-update 16-10-15

Who changed what in which revision?

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