Hendrik Vincent / Mbed 2 deprecated Weerstation

Leest de waarde van een sensor binnen een maakt deze beschikbaar via internet

Dependencies:   NTPClient_NetServices mbed

NetServices/drv/usb/UsbEndpoint.cpp@0:05ccbd4f84f1, 2013-12-02 (annotated)

Committer:
hendrikvincent
Date:
Mon Dec 02 09:01:23 2013 +0000
Revision:
0:05ccbd4f84f1
eerste programma;

Who changed what in which revision?

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