NetServices - NetTribute library with debug turned on in FShand…

Users » hexley » Code » NetServices

NetTribute library with debug turned on in FShandler Donatien Garner -> Segundo Equipo -> this version

drv/umtsstick/UMTSStick.cpp@0:281d6ff68967, 2010-11-19 (annotated)

Committer:: hexley
Date:: Fri Nov 19 01:54:45 2010 +0000
Revision:: 0:281d6ff68967

Who changed what in which revision?

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

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	19 Nov 2010
Imports:	44
Forks:	0
Commits:	1
Dependents:	0
Dependencies:	0
Followers:	1

drv/umtsstick/UMTSStick.cpp@0:281d6ff68967, 2010-11-19 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning