Rod Coleman / NetServices

Netservices modded to read fragmented HTTP respsonse/payload from special purpose server - 180 bytes only

drv/umtsstick/UMTSStick.cpp@0:8f5825f330b0, 2011-09-08 (annotated)

Committer:
RodColeman
Date:
Thu Sep 08 10:41:36 2011 +0000
Revision:
0:8f5825f330b0
setDataLen hacked to 180bytes

Who changed what in which revision?

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