StrippedDownNetServices - This library is stripped down version of NetServi…

Users » idinor » Code » StrippedDownNetServices

idinor Launcher / StrippedDownNetServices

This library is stripped down version of NetServices library. HTTP server and client function is NOT supported.

drv/umtsstick/UMTSStick.cpp@0:dcf3c92487ca, 2011-07-20 (annotated)

Committer:: idinor
Date:: Wed Jul 20 11:45:39 2011 +0000
Revision:: 0:dcf3c92487ca

Who changed what in which revision?

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

Repository toolbox

Export to desktop IDE

Repository details

Type:	Library
Created:	20 Jul 2011
Imports:	35
Forks:	0
Commits:	1
Dependents:	1
Dependencies:	0
Followers:	1

drv/umtsstick/UMTSStick.cpp@0:dcf3c92487ca, 2011-07-20 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning