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/umtsstick/UMTSStick.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 "netCfg.h"
hendrikvincent 0:05ccbd4f84f1 25 #if NET_UMTS
hendrikvincent 0:05ccbd4f84f1 26
hendrikvincent 0:05ccbd4f84f1 27 #include "UMTSStick.h"
hendrikvincent 0:05ccbd4f84f1 28
hendrikvincent 0:05ccbd4f84f1 29 #define __DEBUG
hendrikvincent 0:05ccbd4f84f1 30 #include "dbg/dbg.h"
hendrikvincent 0:05ccbd4f84f1 31
hendrikvincent 0:05ccbd4f84f1 32 UMTSStick::UMTSStick() : m_host(), m_pDev(NULL)
hendrikvincent 0:05ccbd4f84f1 33 {
hendrikvincent 0:05ccbd4f84f1 34
hendrikvincent 0:05ccbd4f84f1 35 }
hendrikvincent 0:05ccbd4f84f1 36
hendrikvincent 0:05ccbd4f84f1 37 UMTSStick::~UMTSStick()
hendrikvincent 0:05ccbd4f84f1 38 {
hendrikvincent 0:05ccbd4f84f1 39
hendrikvincent 0:05ccbd4f84f1 40 }
hendrikvincent 0:05ccbd4f84f1 41
hendrikvincent 0:05ccbd4f84f1 42
hendrikvincent 0:05ccbd4f84f1 43 UMTSStickErr UMTSStick::getSerial(UsbSerial** ppUsbSerial)
hendrikvincent 0:05ccbd4f84f1 44 {
hendrikvincent 0:05ccbd4f84f1 45 m_host.init();
hendrikvincent 0:05ccbd4f84f1 46
hendrikvincent 0:05ccbd4f84f1 47 UMTSStickErr rc;
hendrikvincent 0:05ccbd4f84f1 48
hendrikvincent 0:05ccbd4f84f1 49 rc = waitForDevice();
hendrikvincent 0:05ccbd4f84f1 50 if(rc)
hendrikvincent 0:05ccbd4f84f1 51 return rc;
hendrikvincent 0:05ccbd4f84f1 52
hendrikvincent 0:05ccbd4f84f1 53 //Device is now enumerated, read table
hendrikvincent 0:05ccbd4f84f1 54
hendrikvincent 0:05ccbd4f84f1 55 uint16_t vid = m_pDev->getVid();
hendrikvincent 0:05ccbd4f84f1 56 uint16_t pid = m_pDev->getPid();
hendrikvincent 0:05ccbd4f84f1 57
hendrikvincent 0:05ccbd4f84f1 58 DBG("Configuration set: vid:%04x pid:%04x\n", vid, pid);
hendrikvincent 0:05ccbd4f84f1 59
hendrikvincent 0:05ccbd4f84f1 60 bool handled = false;
hendrikvincent 0:05ccbd4f84f1 61 bool cdfs = false;
hendrikvincent 0:05ccbd4f84f1 62 const UMTSSwitchingInfo* pInfo;
hendrikvincent 0:05ccbd4f84f1 63 for(int i = 0; i < UMTS_SWITCHING_COUNT; i++)
hendrikvincent 0:05ccbd4f84f1 64 {
hendrikvincent 0:05ccbd4f84f1 65 pInfo = &UMTSwitchingTable[i];
hendrikvincent 0:05ccbd4f84f1 66 if( !checkDeviceState(pInfo, &cdfs) )
hendrikvincent 0:05ccbd4f84f1 67 {
hendrikvincent 0:05ccbd4f84f1 68 handled = true;
hendrikvincent 0:05ccbd4f84f1 69 break;
hendrikvincent 0:05ccbd4f84f1 70 }
hendrikvincent 0:05ccbd4f84f1 71
hendrikvincent 0:05ccbd4f84f1 72 } //for(int i = 0; i < UMTS_SWITCHING_COUNT; i++)
hendrikvincent 0:05ccbd4f84f1 73
hendrikvincent 0:05ccbd4f84f1 74 if(!handled)
hendrikvincent 0:05ccbd4f84f1 75 {
hendrikvincent 0:05ccbd4f84f1 76 DBG("Don't know this device!\n");
hendrikvincent 0:05ccbd4f84f1 77 return UMTSERR_NOTIMPLEMENTED;
hendrikvincent 0:05ccbd4f84f1 78 }
hendrikvincent 0:05ccbd4f84f1 79
hendrikvincent 0:05ccbd4f84f1 80 //Check if the device is in CDFS mode, in this case switch
hendrikvincent 0:05ccbd4f84f1 81 if(cdfs)
hendrikvincent 0:05ccbd4f84f1 82 {
hendrikvincent 0:05ccbd4f84f1 83 DBG("Switching the device by sending a magic packet\n");
hendrikvincent 0:05ccbd4f84f1 84
hendrikvincent 0:05ccbd4f84f1 85 rc = switchMode(pInfo);
hendrikvincent 0:05ccbd4f84f1 86 if(rc)
hendrikvincent 0:05ccbd4f84f1 87 return rc;
hendrikvincent 0:05ccbd4f84f1 88
hendrikvincent 0:05ccbd4f84f1 89 DBG("Now wait for device to reconnect\n");
hendrikvincent 0:05ccbd4f84f1 90
hendrikvincent 0:05ccbd4f84f1 91 m_host.releaseDevice(m_pDev);
hendrikvincent 0:05ccbd4f84f1 92
hendrikvincent 0:05ccbd4f84f1 93 //Wait for device to reconnect
hendrikvincent 0:05ccbd4f84f1 94 wait(3);
hendrikvincent 0:05ccbd4f84f1 95 rc = waitForDevice();
hendrikvincent 0:05ccbd4f84f1 96 if(rc)
hendrikvincent 0:05ccbd4f84f1 97 return rc;
hendrikvincent 0:05ccbd4f84f1 98 }
hendrikvincent 0:05ccbd4f84f1 99
hendrikvincent 0:05ccbd4f84f1 100 rc = findSerial(ppUsbSerial);
hendrikvincent 0:05ccbd4f84f1 101 if(rc)
hendrikvincent 0:05ccbd4f84f1 102 return rc;
hendrikvincent 0:05ccbd4f84f1 103
hendrikvincent 0:05ccbd4f84f1 104 return UMTSERR_OK;
hendrikvincent 0:05ccbd4f84f1 105 }
hendrikvincent 0:05ccbd4f84f1 106
hendrikvincent 0:05ccbd4f84f1 107 UMTSStickErr UMTSStick::waitForDevice()
hendrikvincent 0:05ccbd4f84f1 108 {
hendrikvincent 0:05ccbd4f84f1 109 bool ready = false;
hendrikvincent 0:05ccbd4f84f1 110 while(!ready)
hendrikvincent 0:05ccbd4f84f1 111 {
hendrikvincent 0:05ccbd4f84f1 112 while(!m_host.devicesCount())
hendrikvincent 0:05ccbd4f84f1 113 {}
hendrikvincent 0:05ccbd4f84f1 114 wait(1);
hendrikvincent 0:05ccbd4f84f1 115 if(m_host.devicesCount())
hendrikvincent 0:05ccbd4f84f1 116 ready = true;
hendrikvincent 0:05ccbd4f84f1 117 }
hendrikvincent 0:05ccbd4f84f1 118
hendrikvincent 0:05ccbd4f84f1 119 wait(2); //Wait for device to be initialized
hendrikvincent 0:05ccbd4f84f1 120
hendrikvincent 0:05ccbd4f84f1 121 if(!m_host.devicesCount())
hendrikvincent 0:05ccbd4f84f1 122 return UMTSERR_DISCONNECTED;
hendrikvincent 0:05ccbd4f84f1 123
hendrikvincent 0:05ccbd4f84f1 124 m_pDev = m_host.getDevice(0);
hendrikvincent 0:05ccbd4f84f1 125
hendrikvincent 0:05ccbd4f84f1 126 while(!m_pDev->enumerated())
hendrikvincent 0:05ccbd4f84f1 127 {
hendrikvincent 0:05ccbd4f84f1 128 m_host.poll();
hendrikvincent 0:05ccbd4f84f1 129 if(!m_host.devicesCount())
hendrikvincent 0:05ccbd4f84f1 130 return UMTSERR_DISCONNECTED;
hendrikvincent 0:05ccbd4f84f1 131 }
hendrikvincent 0:05ccbd4f84f1 132
hendrikvincent 0:05ccbd4f84f1 133 return UMTSERR_OK;
hendrikvincent 0:05ccbd4f84f1 134 }
hendrikvincent 0:05ccbd4f84f1 135
hendrikvincent 0:05ccbd4f84f1 136 UMTSStickErr UMTSStick::checkDeviceState(const UMTSSwitchingInfo* pInfo, bool* pCdfs)
hendrikvincent 0:05ccbd4f84f1 137 {
hendrikvincent 0:05ccbd4f84f1 138 uint16_t vid = m_pDev->getVid();
hendrikvincent 0:05ccbd4f84f1 139 uint16_t pid = m_pDev->getPid();
hendrikvincent 0:05ccbd4f84f1 140 bool handled = false;
hendrikvincent 0:05ccbd4f84f1 141 if( (vid == pInfo->cdfsVid) && (pid == pInfo->cdfsPid) )
hendrikvincent 0:05ccbd4f84f1 142 {
hendrikvincent 0:05ccbd4f84f1 143 DBG("Match on dongles list\n");
hendrikvincent 0:05ccbd4f84f1 144 if( !pInfo->targetClass ) //No specific interface to check, vid/pid couple is specific to CDFS mode
hendrikvincent 0:05ccbd4f84f1 145 {
hendrikvincent 0:05ccbd4f84f1 146 DBG("Found device in CDFS mode\n");
hendrikvincent 0:05ccbd4f84f1 147 handled = true;
hendrikvincent 0:05ccbd4f84f1 148 *pCdfs = true;
hendrikvincent 0:05ccbd4f84f1 149 }
hendrikvincent 0:05ccbd4f84f1 150 else //if( !pInfo->targetClass )
hendrikvincent 0:05ccbd4f84f1 151 {
hendrikvincent 0:05ccbd4f84f1 152 //Has to check if there is an interface of class targetClass
hendrikvincent 0:05ccbd4f84f1 153 byte* desc = NULL;
hendrikvincent 0:05ccbd4f84f1 154 int c = 0;
hendrikvincent 0:05ccbd4f84f1 155
hendrikvincent 0:05ccbd4f84f1 156 while( !m_pDev->getInterfaceDescriptor(1, c++, &desc) )
hendrikvincent 0:05ccbd4f84f1 157 {
hendrikvincent 0:05ccbd4f84f1 158 if( desc[5] == pInfo->targetClass )
hendrikvincent 0:05ccbd4f84f1 159 {
hendrikvincent 0:05ccbd4f84f1 160 DBG("Found device in Serial mode\n");
hendrikvincent 0:05ccbd4f84f1 161 handled = true;
hendrikvincent 0:05ccbd4f84f1 162 *pCdfs = false;
hendrikvincent 0:05ccbd4f84f1 163 break;
hendrikvincent 0:05ccbd4f84f1 164 }
hendrikvincent 0:05ccbd4f84f1 165 }
hendrikvincent 0:05ccbd4f84f1 166
hendrikvincent 0:05ccbd4f84f1 167 if(!handled)
hendrikvincent 0:05ccbd4f84f1 168 {
hendrikvincent 0:05ccbd4f84f1 169 //All interfaces were tried, so we are in CDFS mode
hendrikvincent 0:05ccbd4f84f1 170 DBG("Found device in CDFS mode\n");
hendrikvincent 0:05ccbd4f84f1 171 handled = true;
hendrikvincent 0:05ccbd4f84f1 172 *pCdfs = true;
hendrikvincent 0:05ccbd4f84f1 173 }
hendrikvincent 0:05ccbd4f84f1 174 } //if( !pInfo->targetClass )
hendrikvincent 0:05ccbd4f84f1 175 } //if( (vid == pInfo->cdfsVid) && (pid == pInfo->cdfsPid) )
hendrikvincent 0:05ccbd4f84f1 176 else
hendrikvincent 0:05ccbd4f84f1 177 {
hendrikvincent 0:05ccbd4f84f1 178 //Try every vid/pid couple of the serial list
hendrikvincent 0:05ccbd4f84f1 179 for( int i = 0; i < 16 ; i++)
hendrikvincent 0:05ccbd4f84f1 180 {
hendrikvincent 0:05ccbd4f84f1 181 if(!pInfo->serialPidList[i])
hendrikvincent 0:05ccbd4f84f1 182 break;
hendrikvincent 0:05ccbd4f84f1 183 if( (pInfo->serialVid == vid) && (pInfo->serialPidList[i] == pid) )
hendrikvincent 0:05ccbd4f84f1 184 {
hendrikvincent 0:05ccbd4f84f1 185 DBG("Found device in Serial mode\n");
hendrikvincent 0:05ccbd4f84f1 186 handled = true;
hendrikvincent 0:05ccbd4f84f1 187 *pCdfs = false;
hendrikvincent 0:05ccbd4f84f1 188 break;
hendrikvincent 0:05ccbd4f84f1 189 }
hendrikvincent 0:05ccbd4f84f1 190 }
hendrikvincent 0:05ccbd4f84f1 191 } //if( (vid == pInfo->cdfsVid) && (pid == pInfo->cdfsPid) )
hendrikvincent 0:05ccbd4f84f1 192
hendrikvincent 0:05ccbd4f84f1 193 if(!handled)
hendrikvincent 0:05ccbd4f84f1 194 return UMTSERR_NOTFOUND;
hendrikvincent 0:05ccbd4f84f1 195
hendrikvincent 0:05ccbd4f84f1 196 return UMTSERR_OK;
hendrikvincent 0:05ccbd4f84f1 197 }
hendrikvincent 0:05ccbd4f84f1 198
hendrikvincent 0:05ccbd4f84f1 199 UMTSStickErr UMTSStick::switchMode(const UMTSSwitchingInfo* pInfo)
hendrikvincent 0:05ccbd4f84f1 200 {
hendrikvincent 0:05ccbd4f84f1 201 if(!pInfo->huaweiPacket) //Send SCSI packet on first bulk ep
hendrikvincent 0:05ccbd4f84f1 202 {
hendrikvincent 0:05ccbd4f84f1 203 //Find first bulk ep
hendrikvincent 0:05ccbd4f84f1 204 byte* desc = NULL;
hendrikvincent 0:05ccbd4f84f1 205 int c = 0;
hendrikvincent 0:05ccbd4f84f1 206
hendrikvincent 0:05ccbd4f84f1 207 UsbEndpoint *pEpOut = NULL;
hendrikvincent 0:05ccbd4f84f1 208
hendrikvincent 0:05ccbd4f84f1 209 while( !m_pDev->getInterfaceDescriptor(1, c++, &desc) )
hendrikvincent 0:05ccbd4f84f1 210 {
hendrikvincent 0:05ccbd4f84f1 211 byte* p = desc;
hendrikvincent 0:05ccbd4f84f1 212 int epNum = 0;
hendrikvincent 0:05ccbd4f84f1 213 p = p + p[0]; //Move to next descriptor (which should be an ep descriptor)
hendrikvincent 0:05ccbd4f84f1 214 while (epNum < desc[4]) //Eps count in this if
hendrikvincent 0:05ccbd4f84f1 215 {
hendrikvincent 0:05ccbd4f84f1 216 if (p[1] != USB_DESCRIPTOR_TYPE_ENDPOINT)
hendrikvincent 0:05ccbd4f84f1 217 break;
hendrikvincent 0:05ccbd4f84f1 218
hendrikvincent 0:05ccbd4f84f1 219 if( (p[3] == 0x02) && !(p[2] & 0x80) ) //Bulk endpoint, out
hendrikvincent 0:05ccbd4f84f1 220 {
hendrikvincent 0:05ccbd4f84f1 221 DBG("Found bulk ep %02x\n", p[2]);
hendrikvincent 0:05ccbd4f84f1 222 pEpOut = new UsbEndpoint( m_pDev, p[2], false, USB_BULK, *((uint16_t*)&p[4]) );
hendrikvincent 0:05ccbd4f84f1 223 break;
hendrikvincent 0:05ccbd4f84f1 224 }
hendrikvincent 0:05ccbd4f84f1 225
hendrikvincent 0:05ccbd4f84f1 226 p = p + p[0]; //Move to next ep desc
hendrikvincent 0:05ccbd4f84f1 227 epNum++;
hendrikvincent 0:05ccbd4f84f1 228 }
hendrikvincent 0:05ccbd4f84f1 229 if(pEpOut)
hendrikvincent 0:05ccbd4f84f1 230 break;
hendrikvincent 0:05ccbd4f84f1 231 }
hendrikvincent 0:05ccbd4f84f1 232
hendrikvincent 0:05ccbd4f84f1 233 if(!pEpOut)
hendrikvincent 0:05ccbd4f84f1 234 return UMTSERR_NOTFOUND;
hendrikvincent 0:05ccbd4f84f1 235
hendrikvincent 0:05ccbd4f84f1 236 //Send SCSI packet
hendrikvincent 0:05ccbd4f84f1 237
hendrikvincent 0:05ccbd4f84f1 238 DBG("Sending SCSI Packet to switch\n");
hendrikvincent 0:05ccbd4f84f1 239 byte ramCdfsBuf[31];
hendrikvincent 0:05ccbd4f84f1 240 memcpy(ramCdfsBuf, pInfo->cdfsPacket, 31);
hendrikvincent 0:05ccbd4f84f1 241 pEpOut->transfer((volatile byte*)ramCdfsBuf, 31);
hendrikvincent 0:05ccbd4f84f1 242 while(pEpOut->status() == USBERR_PROCESSING);
hendrikvincent 0:05ccbd4f84f1 243 int ret = pEpOut->status();
hendrikvincent 0:05ccbd4f84f1 244 if((ret < 0) && (ret !=USBERR_DISCONNECTED)) //Packet was not transfered
hendrikvincent 0:05ccbd4f84f1 245 {
hendrikvincent 0:05ccbd4f84f1 246 DBG("Usb error %d\n", ret);
hendrikvincent 0:05ccbd4f84f1 247 delete pEpOut;
hendrikvincent 0:05ccbd4f84f1 248 return UMTSERR_USBERR;
hendrikvincent 0:05ccbd4f84f1 249 }
hendrikvincent 0:05ccbd4f84f1 250
hendrikvincent 0:05ccbd4f84f1 251 delete pEpOut;
hendrikvincent 0:05ccbd4f84f1 252 }
hendrikvincent 0:05ccbd4f84f1 253 else
hendrikvincent 0:05ccbd4f84f1 254 {
hendrikvincent 0:05ccbd4f84f1 255 UsbErr usbErr;
hendrikvincent 0:05ccbd4f84f1 256 //Send the Huawei-specific control packet
hendrikvincent 0:05ccbd4f84f1 257 usbErr = m_pDev->controlSend(0, 0x03, 1, 0, NULL, 0);
hendrikvincent 0:05ccbd4f84f1 258 if(usbErr && (usbErr != USBERR_DISCONNECTED))
hendrikvincent 0:05ccbd4f84f1 259 return UMTSERR_USBERR;
hendrikvincent 0:05ccbd4f84f1 260 }
hendrikvincent 0:05ccbd4f84f1 261
hendrikvincent 0:05ccbd4f84f1 262 DBG("The stick should be switching in serial mode now\n");
hendrikvincent 0:05ccbd4f84f1 263
hendrikvincent 0:05ccbd4f84f1 264 return UMTSERR_OK;
hendrikvincent 0:05ccbd4f84f1 265 }
hendrikvincent 0:05ccbd4f84f1 266
hendrikvincent 0:05ccbd4f84f1 267 UMTSStickErr UMTSStick::findSerial(UsbSerial** ppUsbSerial)
hendrikvincent 0:05ccbd4f84f1 268 {
hendrikvincent 0:05ccbd4f84f1 269 byte* desc = NULL;
hendrikvincent 0:05ccbd4f84f1 270 int c = 0;
hendrikvincent 0:05ccbd4f84f1 271
hendrikvincent 0:05ccbd4f84f1 272 int epOut = 0;
hendrikvincent 0:05ccbd4f84f1 273 int epIn = 0;
hendrikvincent 0:05ccbd4f84f1 274
hendrikvincent 0:05ccbd4f84f1 275 while( !m_pDev->getInterfaceDescriptor(1, c++, &desc) )
hendrikvincent 0:05ccbd4f84f1 276 {
hendrikvincent 0:05ccbd4f84f1 277 byte* p = desc;
hendrikvincent 0:05ccbd4f84f1 278 int epNum = 0;
hendrikvincent 0:05ccbd4f84f1 279
hendrikvincent 0:05ccbd4f84f1 280 DBG("Interface of type %02x\n", desc[5]);
hendrikvincent 0:05ccbd4f84f1 281
hendrikvincent 0:05ccbd4f84f1 282 if(desc[5] != 0xFF) //Not a serial-like if
hendrikvincent 0:05ccbd4f84f1 283 continue;
hendrikvincent 0:05ccbd4f84f1 284
hendrikvincent 0:05ccbd4f84f1 285 p = p + p[0]; //Move to next descriptor (which should be an ep descriptor)
hendrikvincent 0:05ccbd4f84f1 286 while (epNum < desc[4]) //Eps count in this if
hendrikvincent 0:05ccbd4f84f1 287 {
hendrikvincent 0:05ccbd4f84f1 288 if (p[1] == USB_DESCRIPTOR_TYPE_ENDPOINT)
hendrikvincent 0:05ccbd4f84f1 289 {
hendrikvincent 0:05ccbd4f84f1 290 if( (p[3] == 0x02) && !(p[2] & 0x80) && !epOut ) //Bulk endpoint, out
hendrikvincent 0:05ccbd4f84f1 291 {
hendrikvincent 0:05ccbd4f84f1 292 DBG("Found bulk out ep %02x of payload size %04x\n", p[2], *((uint16_t*)&p[4]));
hendrikvincent 0:05ccbd4f84f1 293 epOut = p[2] & 0x7F;
hendrikvincent 0:05ccbd4f84f1 294 }
hendrikvincent 0:05ccbd4f84f1 295
hendrikvincent 0:05ccbd4f84f1 296 if( (p[3] == 0x02) && (p[2] & 0x80) && !epIn ) //Bulk endpoint, in
hendrikvincent 0:05ccbd4f84f1 297 {
hendrikvincent 0:05ccbd4f84f1 298 DBG("Found bulk in ep %02x of payload size %04x\n", p[2], *((uint16_t*)&p[4]));
hendrikvincent 0:05ccbd4f84f1 299 epIn = p[2] & 0x7F;
hendrikvincent 0:05ccbd4f84f1 300 }
hendrikvincent 0:05ccbd4f84f1 301
hendrikvincent 0:05ccbd4f84f1 302 if(epOut && epIn)
hendrikvincent 0:05ccbd4f84f1 303 break;
hendrikvincent 0:05ccbd4f84f1 304 }
hendrikvincent 0:05ccbd4f84f1 305
hendrikvincent 0:05ccbd4f84f1 306 p = p + p[0]; //Move to next ep desc
hendrikvincent 0:05ccbd4f84f1 307 epNum++;
hendrikvincent 0:05ccbd4f84f1 308 }
hendrikvincent 0:05ccbd4f84f1 309
hendrikvincent 0:05ccbd4f84f1 310 if(epOut && epIn)
hendrikvincent 0:05ccbd4f84f1 311 break;
hendrikvincent 0:05ccbd4f84f1 312 }
hendrikvincent 0:05ccbd4f84f1 313
hendrikvincent 0:05ccbd4f84f1 314 if(!epOut || !epIn)
hendrikvincent 0:05ccbd4f84f1 315 return UMTSERR_NOTFOUND;
hendrikvincent 0:05ccbd4f84f1 316
hendrikvincent 0:05ccbd4f84f1 317 DBG("Endpoints found, create serial object\n");
hendrikvincent 0:05ccbd4f84f1 318
hendrikvincent 0:05ccbd4f84f1 319 *ppUsbSerial = new UsbSerial(m_pDev, epIn, epOut);
hendrikvincent 0:05ccbd4f84f1 320
hendrikvincent 0:05ccbd4f84f1 321 DBG("UsbSerial object created\n");
hendrikvincent 0:05ccbd4f84f1 322
hendrikvincent 0:05ccbd4f84f1 323 return UMTSERR_OK;
hendrikvincent 0:05ccbd4f84f1 324 }
hendrikvincent 0:05ccbd4f84f1 325
hendrikvincent 0:05ccbd4f84f1 326 #endif