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