Michael Spencer / Mbed 2 deprecated LaOS

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

NetServices/drv/umtsstick/UMTSStick.cpp@1:f5ac63519541, 2014-03-05 (annotated)

Committer:
Michael J. Spencer
Date:
Wed Mar 05 06:14:02 2014 -0800
Revision:
1:f5ac63519541
Initial commit.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Michael J. Spencer 1:f5ac63519541 1
Michael J. Spencer 1:f5ac63519541 2 /*
Michael J. Spencer 1:f5ac63519541 3 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
Michael J. Spencer 1:f5ac63519541 4
Michael J. Spencer 1:f5ac63519541 5 Permission is hereby granted, free of charge, to any person obtaining a copy
Michael J. Spencer 1:f5ac63519541 6 of this software and associated documentation files (the "Software"), to deal
Michael J. Spencer 1:f5ac63519541 7 in the Software without restriction, including without limitation the rights
Michael J. Spencer 1:f5ac63519541 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
Michael J. Spencer 1:f5ac63519541 9 copies of the Software, and to permit persons to whom the Software is
Michael J. Spencer 1:f5ac63519541 10 furnished to do so, subject to the following conditions:
Michael J. Spencer 1:f5ac63519541 11
Michael J. Spencer 1:f5ac63519541 12 The above copyright notice and this permission notice shall be included in
Michael J. Spencer 1:f5ac63519541 13 all copies or substantial portions of the Software.
Michael J. Spencer 1:f5ac63519541 14
Michael J. Spencer 1:f5ac63519541 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
Michael J. Spencer 1:f5ac63519541 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
Michael J. Spencer 1:f5ac63519541 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
Michael J. Spencer 1:f5ac63519541 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
Michael J. Spencer 1:f5ac63519541 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
Michael J. Spencer 1:f5ac63519541 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
Michael J. Spencer 1:f5ac63519541 21 THE SOFTWARE.
Michael J. Spencer 1:f5ac63519541 22 */
Michael J. Spencer 1:f5ac63519541 23
Michael J. Spencer 1:f5ac63519541 24 #include "netCfg.h"
Michael J. Spencer 1:f5ac63519541 25 #if NET_UMTS
Michael J. Spencer 1:f5ac63519541 26
Michael J. Spencer 1:f5ac63519541 27 #include "UMTSStick.h"
Michael J. Spencer 1:f5ac63519541 28
Michael J. Spencer 1:f5ac63519541 29 #define __DEBUG
Michael J. Spencer 1:f5ac63519541 30 #include "dbg/dbg.h"
Michael J. Spencer 1:f5ac63519541 31
Michael J. Spencer 1:f5ac63519541 32 UMTSStick::UMTSStick() : m_host(), m_pDev(NULL)
Michael J. Spencer 1:f5ac63519541 33 {
Michael J. Spencer 1:f5ac63519541 34
Michael J. Spencer 1:f5ac63519541 35 }
Michael J. Spencer 1:f5ac63519541 36
Michael J. Spencer 1:f5ac63519541 37 UMTSStick::~UMTSStick()
Michael J. Spencer 1:f5ac63519541 38 {
Michael J. Spencer 1:f5ac63519541 39
Michael J. Spencer 1:f5ac63519541 40 }
Michael J. Spencer 1:f5ac63519541 41
Michael J. Spencer 1:f5ac63519541 42
Michael J. Spencer 1:f5ac63519541 43 UMTSStickErr UMTSStick::getSerial(UsbSerial** ppUsbSerial)
Michael J. Spencer 1:f5ac63519541 44 {
Michael J. Spencer 1:f5ac63519541 45 m_host.init();
Michael J. Spencer 1:f5ac63519541 46
Michael J. Spencer 1:f5ac63519541 47 UMTSStickErr rc;
Michael J. Spencer 1:f5ac63519541 48
Michael J. Spencer 1:f5ac63519541 49 rc = waitForDevice();
Michael J. Spencer 1:f5ac63519541 50 if(rc)
Michael J. Spencer 1:f5ac63519541 51 return rc;
Michael J. Spencer 1:f5ac63519541 52
Michael J. Spencer 1:f5ac63519541 53 //Device is now enumerated, read table
Michael J. Spencer 1:f5ac63519541 54
Michael J. Spencer 1:f5ac63519541 55 uint16_t vid = m_pDev->getVid();
Michael J. Spencer 1:f5ac63519541 56 uint16_t pid = m_pDev->getPid();
Michael J. Spencer 1:f5ac63519541 57
Michael J. Spencer 1:f5ac63519541 58 DBG("Configuration set: vid:%04x pid:%04x\n", vid, pid);
Michael J. Spencer 1:f5ac63519541 59
Michael J. Spencer 1:f5ac63519541 60 bool handled = false;
Michael J. Spencer 1:f5ac63519541 61 bool cdfs = false;
Michael J. Spencer 1:f5ac63519541 62 const UMTSSwitchingInfo* pInfo;
Michael J. Spencer 1:f5ac63519541 63 for(int i = 0; i < UMTS_SWITCHING_COUNT; i++)
Michael J. Spencer 1:f5ac63519541 64 {
Michael J. Spencer 1:f5ac63519541 65 pInfo = &UMTSwitchingTable[i];
Michael J. Spencer 1:f5ac63519541 66 if( !checkDeviceState(pInfo, &cdfs) )
Michael J. Spencer 1:f5ac63519541 67 {
Michael J. Spencer 1:f5ac63519541 68 handled = true;
Michael J. Spencer 1:f5ac63519541 69 break;
Michael J. Spencer 1:f5ac63519541 70 }
Michael J. Spencer 1:f5ac63519541 71
Michael J. Spencer 1:f5ac63519541 72 } //for(int i = 0; i < UMTS_SWITCHING_COUNT; i++)
Michael J. Spencer 1:f5ac63519541 73
Michael J. Spencer 1:f5ac63519541 74 if(!handled)
Michael J. Spencer 1:f5ac63519541 75 {
Michael J. Spencer 1:f5ac63519541 76 DBG("Don't know this device!\n");
Michael J. Spencer 1:f5ac63519541 77 return UMTSERR_NOTIMPLEMENTED;
Michael J. Spencer 1:f5ac63519541 78 }
Michael J. Spencer 1:f5ac63519541 79
Michael J. Spencer 1:f5ac63519541 80 //Check if the device is in CDFS mode, in this case switch
Michael J. Spencer 1:f5ac63519541 81 if(cdfs)
Michael J. Spencer 1:f5ac63519541 82 {
Michael J. Spencer 1:f5ac63519541 83 DBG("Switching the device by sending a magic packet\n");
Michael J. Spencer 1:f5ac63519541 84
Michael J. Spencer 1:f5ac63519541 85 rc = switchMode(pInfo);
Michael J. Spencer 1:f5ac63519541 86 if(rc)
Michael J. Spencer 1:f5ac63519541 87 return rc;
Michael J. Spencer 1:f5ac63519541 88
Michael J. Spencer 1:f5ac63519541 89 DBG("Now wait for device to reconnect\n");
Michael J. Spencer 1:f5ac63519541 90
Michael J. Spencer 1:f5ac63519541 91 m_host.releaseDevice(m_pDev);
Michael J. Spencer 1:f5ac63519541 92
Michael J. Spencer 1:f5ac63519541 93 //Wait for device to reconnect
Michael J. Spencer 1:f5ac63519541 94 wait(3);
Michael J. Spencer 1:f5ac63519541 95 rc = waitForDevice();
Michael J. Spencer 1:f5ac63519541 96 if(rc)
Michael J. Spencer 1:f5ac63519541 97 return rc;
Michael J. Spencer 1:f5ac63519541 98 }
Michael J. Spencer 1:f5ac63519541 99
Michael J. Spencer 1:f5ac63519541 100 rc = findSerial(ppUsbSerial);
Michael J. Spencer 1:f5ac63519541 101 if(rc)
Michael J. Spencer 1:f5ac63519541 102 return rc;
Michael J. Spencer 1:f5ac63519541 103
Michael J. Spencer 1:f5ac63519541 104 return UMTSERR_OK;
Michael J. Spencer 1:f5ac63519541 105 }
Michael J. Spencer 1:f5ac63519541 106
Michael J. Spencer 1:f5ac63519541 107 UMTSStickErr UMTSStick::waitForDevice()
Michael J. Spencer 1:f5ac63519541 108 {
Michael J. Spencer 1:f5ac63519541 109 bool ready = false;
Michael J. Spencer 1:f5ac63519541 110 while(!ready)
Michael J. Spencer 1:f5ac63519541 111 {
Michael J. Spencer 1:f5ac63519541 112 while(!m_host.devicesCount())
Michael J. Spencer 1:f5ac63519541 113 {}
Michael J. Spencer 1:f5ac63519541 114 wait(1);
Michael J. Spencer 1:f5ac63519541 115 if(m_host.devicesCount())
Michael J. Spencer 1:f5ac63519541 116 ready = true;
Michael J. Spencer 1:f5ac63519541 117 }
Michael J. Spencer 1:f5ac63519541 118
Michael J. Spencer 1:f5ac63519541 119 wait(2); //Wait for device to be initialized
Michael J. Spencer 1:f5ac63519541 120
Michael J. Spencer 1:f5ac63519541 121 if(!m_host.devicesCount())
Michael J. Spencer 1:f5ac63519541 122 return UMTSERR_DISCONNECTED;
Michael J. Spencer 1:f5ac63519541 123
Michael J. Spencer 1:f5ac63519541 124 m_pDev = m_host.getDevice(0);
Michael J. Spencer 1:f5ac63519541 125
Michael J. Spencer 1:f5ac63519541 126 while(!m_pDev->enumerated())
Michael J. Spencer 1:f5ac63519541 127 {
Michael J. Spencer 1:f5ac63519541 128 m_host.poll();
Michael J. Spencer 1:f5ac63519541 129 if(!m_host.devicesCount())
Michael J. Spencer 1:f5ac63519541 130 return UMTSERR_DISCONNECTED;
Michael J. Spencer 1:f5ac63519541 131 }
Michael J. Spencer 1:f5ac63519541 132
Michael J. Spencer 1:f5ac63519541 133 return UMTSERR_OK;
Michael J. Spencer 1:f5ac63519541 134 }
Michael J. Spencer 1:f5ac63519541 135
Michael J. Spencer 1:f5ac63519541 136 UMTSStickErr UMTSStick::checkDeviceState(const UMTSSwitchingInfo* pInfo, bool* pCdfs)
Michael J. Spencer 1:f5ac63519541 137 {
Michael J. Spencer 1:f5ac63519541 138 uint16_t vid = m_pDev->getVid();
Michael J. Spencer 1:f5ac63519541 139 uint16_t pid = m_pDev->getPid();
Michael J. Spencer 1:f5ac63519541 140 bool handled = false;
Michael J. Spencer 1:f5ac63519541 141 if( (vid == pInfo->cdfsVid) && (pid == pInfo->cdfsPid) )
Michael J. Spencer 1:f5ac63519541 142 {
Michael J. Spencer 1:f5ac63519541 143 DBG("Match on dongles list\n");
Michael J. Spencer 1:f5ac63519541 144 if( !pInfo->targetClass ) //No specific interface to check, vid/pid couple is specific to CDFS mode
Michael J. Spencer 1:f5ac63519541 145 {
Michael J. Spencer 1:f5ac63519541 146 DBG("Found device in CDFS mode\n");
Michael J. Spencer 1:f5ac63519541 147 handled = true;
Michael J. Spencer 1:f5ac63519541 148 *pCdfs = true;
Michael J. Spencer 1:f5ac63519541 149 }
Michael J. Spencer 1:f5ac63519541 150 else //if( !pInfo->targetClass )
Michael J. Spencer 1:f5ac63519541 151 {
Michael J. Spencer 1:f5ac63519541 152 //Has to check if there is an interface of class targetClass
Michael J. Spencer 1:f5ac63519541 153 byte* desc = NULL;
Michael J. Spencer 1:f5ac63519541 154 int c = 0;
Michael J. Spencer 1:f5ac63519541 155
Michael J. Spencer 1:f5ac63519541 156 while( !m_pDev->getInterfaceDescriptor(1, c++, &desc) )
Michael J. Spencer 1:f5ac63519541 157 {
Michael J. Spencer 1:f5ac63519541 158 if( desc[5] == pInfo->targetClass )
Michael J. Spencer 1:f5ac63519541 159 {
Michael J. Spencer 1:f5ac63519541 160 DBG("Found device in Serial mode\n");
Michael J. Spencer 1:f5ac63519541 161 handled = true;
Michael J. Spencer 1:f5ac63519541 162 *pCdfs = false;
Michael J. Spencer 1:f5ac63519541 163 break;
Michael J. Spencer 1:f5ac63519541 164 }
Michael J. Spencer 1:f5ac63519541 165 }
Michael J. Spencer 1:f5ac63519541 166
Michael J. Spencer 1:f5ac63519541 167 if(!handled)
Michael J. Spencer 1:f5ac63519541 168 {
Michael J. Spencer 1:f5ac63519541 169 //All interfaces were tried, so we are in CDFS mode
Michael J. Spencer 1:f5ac63519541 170 DBG("Found device in CDFS mode\n");
Michael J. Spencer 1:f5ac63519541 171 handled = true;
Michael J. Spencer 1:f5ac63519541 172 *pCdfs = true;
Michael J. Spencer 1:f5ac63519541 173 }
Michael J. Spencer 1:f5ac63519541 174 } //if( !pInfo->targetClass )
Michael J. Spencer 1:f5ac63519541 175 } //if( (vid == pInfo->cdfsVid) && (pid == pInfo->cdfsPid) )
Michael J. Spencer 1:f5ac63519541 176 else
Michael J. Spencer 1:f5ac63519541 177 {
Michael J. Spencer 1:f5ac63519541 178 //Try every vid/pid couple of the serial list
Michael J. Spencer 1:f5ac63519541 179 for( int i = 0; i < 16 ; i++)
Michael J. Spencer 1:f5ac63519541 180 {
Michael J. Spencer 1:f5ac63519541 181 if(!pInfo->serialPidList[i])
Michael J. Spencer 1:f5ac63519541 182 break;
Michael J. Spencer 1:f5ac63519541 183 if( (pInfo->serialVid == vid) && (pInfo->serialPidList[i] == pid) )
Michael J. Spencer 1:f5ac63519541 184 {
Michael J. Spencer 1:f5ac63519541 185 DBG("Found device in Serial mode\n");
Michael J. Spencer 1:f5ac63519541 186 handled = true;
Michael J. Spencer 1:f5ac63519541 187 *pCdfs = false;
Michael J. Spencer 1:f5ac63519541 188 break;
Michael J. Spencer 1:f5ac63519541 189 }
Michael J. Spencer 1:f5ac63519541 190 }
Michael J. Spencer 1:f5ac63519541 191 } //if( (vid == pInfo->cdfsVid) && (pid == pInfo->cdfsPid) )
Michael J. Spencer 1:f5ac63519541 192
Michael J. Spencer 1:f5ac63519541 193 if(!handled)
Michael J. Spencer 1:f5ac63519541 194 return UMTSERR_NOTFOUND;
Michael J. Spencer 1:f5ac63519541 195
Michael J. Spencer 1:f5ac63519541 196 return UMTSERR_OK;
Michael J. Spencer 1:f5ac63519541 197 }
Michael J. Spencer 1:f5ac63519541 198
Michael J. Spencer 1:f5ac63519541 199 UMTSStickErr UMTSStick::switchMode(const UMTSSwitchingInfo* pInfo)
Michael J. Spencer 1:f5ac63519541 200 {
Michael J. Spencer 1:f5ac63519541 201 if(!pInfo->huaweiPacket) //Send SCSI packet on first bulk ep
Michael J. Spencer 1:f5ac63519541 202 {
Michael J. Spencer 1:f5ac63519541 203 //Find first bulk ep
Michael J. Spencer 1:f5ac63519541 204 byte* desc = NULL;
Michael J. Spencer 1:f5ac63519541 205 int c = 0;
Michael J. Spencer 1:f5ac63519541 206
Michael J. Spencer 1:f5ac63519541 207 UsbEndpoint *pEpOut = NULL;
Michael J. Spencer 1:f5ac63519541 208
Michael J. Spencer 1:f5ac63519541 209 while( !m_pDev->getInterfaceDescriptor(1, c++, &desc) )
Michael J. Spencer 1:f5ac63519541 210 {
Michael J. Spencer 1:f5ac63519541 211 byte* p = desc;
Michael J. Spencer 1:f5ac63519541 212 int epNum = 0;
Michael J. Spencer 1:f5ac63519541 213 p = p + p[0]; //Move to next descriptor (which should be an ep descriptor)
Michael J. Spencer 1:f5ac63519541 214 while (epNum < desc[4]) //Eps count in this if
Michael J. Spencer 1:f5ac63519541 215 {
Michael J. Spencer 1:f5ac63519541 216 if (p[1] != USB_DESCRIPTOR_TYPE_ENDPOINT)
Michael J. Spencer 1:f5ac63519541 217 break;
Michael J. Spencer 1:f5ac63519541 218
Michael J. Spencer 1:f5ac63519541 219 if( (p[3] == 0x02) && !(p[2] & 0x80) ) //Bulk endpoint, out
Michael J. Spencer 1:f5ac63519541 220 {
Michael J. Spencer 1:f5ac63519541 221 DBG("Found bulk ep %02x\n", p[2]);
Michael J. Spencer 1:f5ac63519541 222 pEpOut = new UsbEndpoint( m_pDev, p[2], false, USB_BULK, *((uint16_t*)&p[4]) );
Michael J. Spencer 1:f5ac63519541 223 break;
Michael J. Spencer 1:f5ac63519541 224 }
Michael J. Spencer 1:f5ac63519541 225
Michael J. Spencer 1:f5ac63519541 226 p = p + p[0]; //Move to next ep desc
Michael J. Spencer 1:f5ac63519541 227 epNum++;
Michael J. Spencer 1:f5ac63519541 228 }
Michael J. Spencer 1:f5ac63519541 229 if(pEpOut)
Michael J. Spencer 1:f5ac63519541 230 break;
Michael J. Spencer 1:f5ac63519541 231 }
Michael J. Spencer 1:f5ac63519541 232
Michael J. Spencer 1:f5ac63519541 233 if(!pEpOut)
Michael J. Spencer 1:f5ac63519541 234 return UMTSERR_NOTFOUND;
Michael J. Spencer 1:f5ac63519541 235
Michael J. Spencer 1:f5ac63519541 236 //Send SCSI packet
Michael J. Spencer 1:f5ac63519541 237
Michael J. Spencer 1:f5ac63519541 238 DBG("Sending SCSI Packet to switch\n");
Michael J. Spencer 1:f5ac63519541 239 byte ramCdfsBuf[31];
Michael J. Spencer 1:f5ac63519541 240 memcpy(ramCdfsBuf, pInfo->cdfsPacket, 31);
Michael J. Spencer 1:f5ac63519541 241 pEpOut->transfer((volatile byte*)ramCdfsBuf, 31);
Michael J. Spencer 1:f5ac63519541 242 while(pEpOut->status() == USBERR_PROCESSING);
Michael J. Spencer 1:f5ac63519541 243 int ret = pEpOut->status();
Michael J. Spencer 1:f5ac63519541 244 if((ret < 0) && (ret !=USBERR_DISCONNECTED)) //Packet was not transfered
Michael J. Spencer 1:f5ac63519541 245 {
Michael J. Spencer 1:f5ac63519541 246 DBG("Usb error %d\n", ret);
Michael J. Spencer 1:f5ac63519541 247 delete pEpOut;
Michael J. Spencer 1:f5ac63519541 248 return UMTSERR_USBERR;
Michael J. Spencer 1:f5ac63519541 249 }
Michael J. Spencer 1:f5ac63519541 250
Michael J. Spencer 1:f5ac63519541 251 delete pEpOut;
Michael J. Spencer 1:f5ac63519541 252 }
Michael J. Spencer 1:f5ac63519541 253 else
Michael J. Spencer 1:f5ac63519541 254 {
Michael J. Spencer 1:f5ac63519541 255 UsbErr usbErr;
Michael J. Spencer 1:f5ac63519541 256 //Send the Huawei-specific control packet
Michael J. Spencer 1:f5ac63519541 257 usbErr = m_pDev->controlSend(0, 0x03, 1, 0, NULL, 0);
Michael J. Spencer 1:f5ac63519541 258 if(usbErr && (usbErr != USBERR_DISCONNECTED))
Michael J. Spencer 1:f5ac63519541 259 return UMTSERR_USBERR;
Michael J. Spencer 1:f5ac63519541 260 }
Michael J. Spencer 1:f5ac63519541 261
Michael J. Spencer 1:f5ac63519541 262 DBG("The stick should be switching in serial mode now\n");
Michael J. Spencer 1:f5ac63519541 263
Michael J. Spencer 1:f5ac63519541 264 return UMTSERR_OK;
Michael J. Spencer 1:f5ac63519541 265 }
Michael J. Spencer 1:f5ac63519541 266
Michael J. Spencer 1:f5ac63519541 267 UMTSStickErr UMTSStick::findSerial(UsbSerial** ppUsbSerial)
Michael J. Spencer 1:f5ac63519541 268 {
Michael J. Spencer 1:f5ac63519541 269 byte* desc = NULL;
Michael J. Spencer 1:f5ac63519541 270 int c = 0;
Michael J. Spencer 1:f5ac63519541 271
Michael J. Spencer 1:f5ac63519541 272 int epOut = 0;
Michael J. Spencer 1:f5ac63519541 273 int epIn = 0;
Michael J. Spencer 1:f5ac63519541 274
Michael J. Spencer 1:f5ac63519541 275 while( !m_pDev->getInterfaceDescriptor(1, c++, &desc) )
Michael J. Spencer 1:f5ac63519541 276 {
Michael J. Spencer 1:f5ac63519541 277 byte* p = desc;
Michael J. Spencer 1:f5ac63519541 278 int epNum = 0;
Michael J. Spencer 1:f5ac63519541 279
Michael J. Spencer 1:f5ac63519541 280 DBG("Interface of type %02x\n", desc[5]);
Michael J. Spencer 1:f5ac63519541 281
Michael J. Spencer 1:f5ac63519541 282 if(desc[5] != 0xFF) //Not a serial-like if
Michael J. Spencer 1:f5ac63519541 283 continue;
Michael J. Spencer 1:f5ac63519541 284
Michael J. Spencer 1:f5ac63519541 285 p = p + p[0]; //Move to next descriptor (which should be an ep descriptor)
Michael J. Spencer 1:f5ac63519541 286 while (epNum < desc[4]) //Eps count in this if
Michael J. Spencer 1:f5ac63519541 287 {
Michael J. Spencer 1:f5ac63519541 288 if (p[1] == USB_DESCRIPTOR_TYPE_ENDPOINT)
Michael J. Spencer 1:f5ac63519541 289 {
Michael J. Spencer 1:f5ac63519541 290 if( (p[3] == 0x02) && !(p[2] & 0x80) && !epOut ) //Bulk endpoint, out
Michael J. Spencer 1:f5ac63519541 291 {
Michael J. Spencer 1:f5ac63519541 292 DBG("Found bulk out ep %02x of payload size %04x\n", p[2], *((uint16_t*)&p[4]));
Michael J. Spencer 1:f5ac63519541 293 epOut = p[2] & 0x7F;
Michael J. Spencer 1:f5ac63519541 294 }
Michael J. Spencer 1:f5ac63519541 295
Michael J. Spencer 1:f5ac63519541 296 if( (p[3] == 0x02) && (p[2] & 0x80) && !epIn ) //Bulk endpoint, in
Michael J. Spencer 1:f5ac63519541 297 {
Michael J. Spencer 1:f5ac63519541 298 DBG("Found bulk in ep %02x of payload size %04x\n", p[2], *((uint16_t*)&p[4]));
Michael J. Spencer 1:f5ac63519541 299 epIn = p[2] & 0x7F;
Michael J. Spencer 1:f5ac63519541 300 }
Michael J. Spencer 1:f5ac63519541 301
Michael J. Spencer 1:f5ac63519541 302 if(epOut && epIn)
Michael J. Spencer 1:f5ac63519541 303 break;
Michael J. Spencer 1:f5ac63519541 304 }
Michael J. Spencer 1:f5ac63519541 305
Michael J. Spencer 1:f5ac63519541 306 p = p + p[0]; //Move to next ep desc
Michael J. Spencer 1:f5ac63519541 307 epNum++;
Michael J. Spencer 1:f5ac63519541 308 }
Michael J. Spencer 1:f5ac63519541 309
Michael J. Spencer 1:f5ac63519541 310 if(epOut && epIn)
Michael J. Spencer 1:f5ac63519541 311 break;
Michael J. Spencer 1:f5ac63519541 312 }
Michael J. Spencer 1:f5ac63519541 313
Michael J. Spencer 1:f5ac63519541 314 if(!epOut || !epIn)
Michael J. Spencer 1:f5ac63519541 315 return UMTSERR_NOTFOUND;
Michael J. Spencer 1:f5ac63519541 316
Michael J. Spencer 1:f5ac63519541 317 DBG("Endpoints found, create serial object\n");
Michael J. Spencer 1:f5ac63519541 318
Michael J. Spencer 1:f5ac63519541 319 *ppUsbSerial = new UsbSerial(m_pDev, epIn, epOut);
Michael J. Spencer 1:f5ac63519541 320
Michael J. Spencer 1:f5ac63519541 321 DBG("UsbSerial object created\n");
Michael J. Spencer 1:f5ac63519541 322
Michael J. Spencer 1:f5ac63519541 323 return UMTSERR_OK;
Michael J. Spencer 1:f5ac63519541 324 }
Michael J. Spencer 1:f5ac63519541 325
Michael J. Spencer 1:f5ac63519541 326 #endif