NetServices Stack source

Dependents:   HelloWorld ServoInterfaceBoardExample1 4180_Lab4

Committer:
donatien
Date:
Fri Jun 18 09:22:54 2010 +0000
Revision:
2:a4f97773c90f
Parent:
0:632c9925f013

        

Who changed what in which revision?

UserRevisionLine numberNew contents of line
donatien 0:632c9925f013 1
donatien 0:632c9925f013 2 /*
donatien 0:632c9925f013 3 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
donatien 0:632c9925f013 4
donatien 0:632c9925f013 5 Permission is hereby granted, free of charge, to any person obtaining a copy
donatien 0:632c9925f013 6 of this software and associated documentation files (the "Software"), to deal
donatien 0:632c9925f013 7 in the Software without restriction, including without limitation the rights
donatien 0:632c9925f013 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
donatien 0:632c9925f013 9 copies of the Software, and to permit persons to whom the Software is
donatien 0:632c9925f013 10 furnished to do so, subject to the following conditions:
donatien 0:632c9925f013 11
donatien 0:632c9925f013 12 The above copyright notice and this permission notice shall be included in
donatien 0:632c9925f013 13 all copies or substantial portions of the Software.
donatien 0:632c9925f013 14
donatien 0:632c9925f013 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
donatien 0:632c9925f013 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
donatien 0:632c9925f013 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
donatien 0:632c9925f013 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
donatien 0:632c9925f013 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
donatien 0:632c9925f013 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
donatien 0:632c9925f013 21 THE SOFTWARE.
donatien 0:632c9925f013 22 */
donatien 0:632c9925f013 23
donatien 0:632c9925f013 24 /*
donatien 0:632c9925f013 25 USB-Serial device driver
donatien 0:632c9925f013 26 Donatien Garnier 2010
donatien 0:632c9925f013 27 */
donatien 0:632c9925f013 28
donatien 0:632c9925f013 29 #include "usbserialif.h"
donatien 0:632c9925f013 30 #include "drv/usb/UsbEndpoint.h"
donatien 0:632c9925f013 31
donatien 0:632c9925f013 32 #include "netCfg.h"
donatien 0:632c9925f013 33 #if NET_USB_SERIAL
donatien 0:632c9925f013 34
donatien 0:632c9925f013 35 UsbEndpoint* pEpIn;
donatien 0:632c9925f013 36 UsbEndpoint* pEpOut;
donatien 0:632c9925f013 37
donatien 2:a4f97773c90f 38 #define DONGLE_STATE_UNKNOWN 0
donatien 2:a4f97773c90f 39 #define DONGLE_STATE_CDFS 1
donatien 2:a4f97773c90f 40 #define DONGLE_STATE_SERIAL 2
donatien 2:a4f97773c90f 41
donatien 2:a4f97773c90f 42 USB_INT08U dongleState;
donatien 2:a4f97773c90f 43
donatien 0:632c9925f013 44 USB_INT32S SerialInit()
donatien 0:632c9925f013 45 {
donatien 2:a4f97773c90f 46 dongleState = DONGLE_STATE_UNKNOWN;
donatien 0:632c9925f013 47 Host_Init(); // Initialize the host controller
donatien 0:632c9925f013 48 USB_INT32S rc = Host_EnumDev(); // Enumerate the device connected
donatien 0:632c9925f013 49 if (rc != OK)
donatien 0:632c9925f013 50 {
donatien 0:632c9925f013 51 fprintf(stderr, "Could not enumerate device: %d\n", rc);
donatien 0:632c9925f013 52 return rc;
donatien 0:632c9925f013 53 }
donatien 0:632c9925f013 54 return OK;
donatien 0:632c9925f013 55 }
donatien 0:632c9925f013 56
donatien 0:632c9925f013 57 bool SerialHasToSwitch()
donatien 0:632c9925f013 58 {
donatien 2:a4f97773c90f 59 return (dongleState == DONGLE_STATE_CDFS);
donatien 0:632c9925f013 60 }
donatien 0:632c9925f013 61
donatien 0:632c9925f013 62 uint16_t m_vid;
donatien 0:632c9925f013 63 uint16_t m_pid;
donatien 0:632c9925f013 64
donatien 0:632c9925f013 65 USB_INT32S SerialSendMagic()
donatien 0:632c9925f013 66 {
donatien 0:632c9925f013 67 bool scsi = false;
donatien 0:632c9925f013 68 //Size 31
donatien 0:632c9925f013 69 const unsigned char magicHuawei[] = { 0x55, 0x53, 0x42, 0x43, 0x12, 0x34, 0x56, 0x78, 0, 0, 0, 0, 0, 0, 0, 0x11, 0x6, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
donatien 2:a4f97773c90f 70 const unsigned char magicVoda[] = { 0x55, 0x53, 0x42, 0x43, 0x78, 0x56, 0x34, 0x12, 0x01, 0, 0, 0, 0x80, 0, 0x06, 0x01, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
donatien 0:632c9925f013 71 char* magic;
donatien 0:632c9925f013 72 USB_INT32S rc;
donatien 0:632c9925f013 73 if((m_vid == 0x12d1) && (m_pid == 0x1446))
donatien 0:632c9925f013 74 {
donatien 0:632c9925f013 75 PRINT_Log("\r\nHuawei magic packet sent.\r\n");
donatien 0:632c9925f013 76 magic = (char*) magicHuawei;
donatien 0:632c9925f013 77 scsi = true;
donatien 0:632c9925f013 78 }
donatien 0:632c9925f013 79 else if((m_vid == 0x12d1) && (m_pid == 0x1003))
donatien 0:632c9925f013 80 {
donatien 0:632c9925f013 81 PRINT_Log("\r\nHuawei magic control packet sent.\r\n");
donatien 0:632c9925f013 82 rc = Host_CtrlSend( 0 /*USB_TYPE_STANDARD | USB_RECIP_DEVICE*/, 0x03 /*USB_REQ_SET_FEATURE*/, 00000001, 0, 0, NULL);
donatien 0:632c9925f013 83 }
donatien 0:632c9925f013 84 else if(m_vid == 0x0af0)
donatien 0:632c9925f013 85 {
donatien 0:632c9925f013 86 PRINT_Log("\r\nVoda magic packet sent.\r\n");
donatien 0:632c9925f013 87 magic = (char*) magicVoda;
donatien 0:632c9925f013 88 scsi = true;
donatien 0:632c9925f013 89 }
donatien 0:632c9925f013 90 else
donatien 0:632c9925f013 91 {
donatien 0:632c9925f013 92 return -1;
donatien 0:632c9925f013 93 }
donatien 0:632c9925f013 94
donatien 0:632c9925f013 95 if(scsi)
donatien 0:632c9925f013 96 {
donatien 0:632c9925f013 97 rc = pEpOut->transfer((volatile USB_INT08U*)magic, 31);
donatien 0:632c9925f013 98 while(rc == PROCESSING)
donatien 0:632c9925f013 99 {
donatien 0:632c9925f013 100 rc = pEpOut->status();
donatien 2:a4f97773c90f 101 }
donatien 0:632c9925f013 102 }
donatien 2:a4f97773c90f 103
donatien 0:632c9925f013 104 delete pEpOut;
donatien 0:632c9925f013 105 pEpOut = NULL;
donatien 0:632c9925f013 106 return rc;
donatien 0:632c9925f013 107 }
donatien 0:632c9925f013 108
donatien 0:632c9925f013 109 USB_INT32S SerialCheckVidPid()
donatien 0:632c9925f013 110 {
donatien 0:632c9925f013 111 volatile USB_INT08U *desc_ptr;
donatien 0:632c9925f013 112 desc_ptr = TDBuffer;
donatien 0:632c9925f013 113
donatien 0:632c9925f013 114 ser_int_found = 0;
donatien 0:632c9925f013 115
donatien 0:632c9925f013 116 m_vid = *((USB_INT16U*)&desc_ptr[8]);
donatien 0:632c9925f013 117 m_pid = *((USB_INT16U*)&desc_ptr[10]);
donatien 0:632c9925f013 118
donatien 0:632c9925f013 119 if (desc_ptr[1] != USB_DESCRIPTOR_TYPE_DEVICE) {
donatien 0:632c9925f013 120 PRINT_Log("\r\nLen = %02x\r\n",desc_ptr[0]);
donatien 0:632c9925f013 121 PRINT_Log("\r\nDesc code %02x\r\n",desc_ptr[1]);
donatien 0:632c9925f013 122 return (ERR_BAD_CONFIGURATION);
donatien 0:632c9925f013 123 }
donatien 0:632c9925f013 124
donatien 0:632c9925f013 125 if( m_vid == 0x12d1 &&//Huawei : Change
donatien 0:632c9925f013 126 m_pid == 0x1446 )
donatien 0:632c9925f013 127 {
donatien 0:632c9925f013 128 PRINT_Log("\r\nHuawei device found in CDFS mode\r\n");
donatien 2:a4f97773c90f 129 dongleState = DONGLE_STATE_CDFS;
donatien 0:632c9925f013 130 }
donatien 0:632c9925f013 131 else if( m_vid == 0x12d1 &&//Huawei : Change
donatien 0:632c9925f013 132 m_pid == 0x1001 )
donatien 0:632c9925f013 133 {
donatien 0:632c9925f013 134 PRINT_Log("\r\nHuawei device found in Serial mode\r\n");
donatien 2:a4f97773c90f 135 dongleState = DONGLE_STATE_SERIAL;
donatien 0:632c9925f013 136 }
donatien 0:632c9925f013 137 else if( m_vid == 0x0af0 &&//Voda?Qualcomm? : Change
donatien 0:632c9925f013 138 m_pid == 0x7501 )
donatien 0:632c9925f013 139 {
donatien 0:632c9925f013 140 PRINT_Log("\r\nVodafone K3760 found, checking mode...\r\n");
donatien 2:a4f97773c90f 141 dongleState = DONGLE_STATE_UNKNOWN;
donatien 0:632c9925f013 142 }
donatien 0:632c9925f013 143 else if( m_vid == 0x12d1 &&//Voda?Qualcomm? : Change
donatien 0:632c9925f013 144 m_pid == 0x1003 )
donatien 0:632c9925f013 145 {
donatien 0:632c9925f013 146 PRINT_Log("\r\nHuawei device found, checking mode...\r\n");
donatien 2:a4f97773c90f 147 dongleState = DONGLE_STATE_UNKNOWN;
donatien 0:632c9925f013 148 }
donatien 0:632c9925f013 149 else
donatien 0:632c9925f013 150 {
donatien 0:632c9925f013 151 PRINT_Log("\r\nDevice %04x : %04x found.\r\n",m_vid,m_pid);
donatien 0:632c9925f013 152 }
donatien 0:632c9925f013 153 return OK;
donatien 0:632c9925f013 154 }
donatien 0:632c9925f013 155
donatien 0:632c9925f013 156 USB_INT32S SerialParseConfig()
donatien 0:632c9925f013 157 {
donatien 0:632c9925f013 158 volatile USB_INT08U *desc_ptr;
donatien 0:632c9925f013 159
donatien 0:632c9925f013 160 desc_ptr = TDBuffer;
donatien 0:632c9925f013 161
donatien 0:632c9925f013 162 if (desc_ptr[1] != USB_DESCRIPTOR_TYPE_CONFIGURATION) {
donatien 0:632c9925f013 163 return (ERR_BAD_CONFIGURATION);
donatien 0:632c9925f013 164 }
donatien 0:632c9925f013 165 desc_ptr += desc_ptr[0];
donatien 0:632c9925f013 166
donatien 0:632c9925f013 167 int epOut = 0;
donatien 0:632c9925f013 168 int epIn = 0;
donatien 0:632c9925f013 169
donatien 0:632c9925f013 170 pEpOut = NULL;
donatien 0:632c9925f013 171 pEpIn = NULL;
donatien 0:632c9925f013 172 while (desc_ptr != TDBuffer + ReadLE16U(&TDBuffer[2])) {
donatien 0:632c9925f013 173
donatien 0:632c9925f013 174 switch (desc_ptr[1]) {
donatien 0:632c9925f013 175 case USB_DESCRIPTOR_TYPE_INTERFACE:
donatien 0:632c9925f013 176 PRINT_Log("\r\nIf %02x:%02x:%02x.\r\n",desc_ptr[5],desc_ptr[6],desc_ptr[7]);
donatien 0:632c9925f013 177 if (desc_ptr[5] == 0xFF &&
donatien 0:632c9925f013 178 desc_ptr[6] == 0xFF &&
donatien 0:632c9925f013 179 desc_ptr[7] == 0xFF ) {
donatien 2:a4f97773c90f 180 dongleState = DONGLE_STATE_SERIAL;
donatien 2:a4f97773c90f 181 }
donatien 2:a4f97773c90f 182 else
donatien 2:a4f97773c90f 183 if (desc_ptr[5] == 0xFF &&
donatien 2:a4f97773c90f 184 desc_ptr[6] == 0xFF &&
donatien 2:a4f97773c90f 185 desc_ptr[7] == 0xFF ) {
donatien 2:a4f97773c90f 186 dongleState = DONGLE_STATE_CDFS;
donatien 0:632c9925f013 187 }
donatien 0:632c9925f013 188 desc_ptr += desc_ptr[0]; /* Move to next descriptor start */
donatien 0:632c9925f013 189 break;
donatien 0:632c9925f013 190
donatien 0:632c9925f013 191 case USB_DESCRIPTOR_TYPE_ENDPOINT: /* If it is an endpoint descriptor */
donatien 0:632c9925f013 192 PRINT_Log("\r\nEp %02x of size %d.\r\n", desc_ptr[2], (ReadLE16U(&desc_ptr[4]) ));
donatien 0:632c9925f013 193 if ( SerialHasToSwitch() )
donatien 0:632c9925f013 194 {
donatien 2:a4f97773c90f 195 if( (dongleState == DONGLE_STATE_CDFS) && (pEpOut == NULL) /*desc_ptr[2] == 1*/) //EP 1
donatien 0:632c9925f013 196 {
donatien 0:632c9925f013 197 pEpOut = new UsbEndpoint((desc_ptr[2] & 0x7F), false, ReadLE16U(&desc_ptr[4]));
donatien 0:632c9925f013 198 }
donatien 2:a4f97773c90f 199 /* Move to next descriptor start */
donatien 0:632c9925f013 200 }
donatien 2:a4f97773c90f 201 desc_ptr += desc_ptr[0];
donatien 0:632c9925f013 202 break;
donatien 0:632c9925f013 203
donatien 0:632c9925f013 204 default: /* If the descriptor is neither interface nor endpoint */
donatien 0:632c9925f013 205 desc_ptr += desc_ptr[0]; /* Move to next descriptor start */
donatien 0:632c9925f013 206 break;
donatien 0:632c9925f013 207 }
donatien 0:632c9925f013 208 }
donatien 2:a4f97773c90f 209 if (dongleState == DONGLE_STATE_SERIAL) {
donatien 2:a4f97773c90f 210 PRINT_Log("Virtual Serial Port device %04x:%04x connected, vid=%d, pid=%d\n", m_vid, m_pid);
donatien 0:632c9925f013 211 if(m_vid==0x0af0) //Voda
donatien 0:632c9925f013 212 {
donatien 0:632c9925f013 213 pEpOut = new UsbEndpoint((0x0a & 0x7F), false, 64);
donatien 0:632c9925f013 214 pEpIn = new UsbEndpoint((0x8b & 0x7F), true, 64);
donatien 0:632c9925f013 215 PRINT_Log("Voda K3760\r\n");
donatien 0:632c9925f013 216 }
donatien 0:632c9925f013 217 else //if ( ( m_vid == 0x12d1 ) && ( m_pid == 0x1003 ) )
donatien 0:632c9925f013 218 /*{*/
donatien 0:632c9925f013 219 if ( ( m_vid == 0x12d1 ) && ( m_pid == 0x1003 ) )
donatien 0:632c9925f013 220 {
donatien 0:632c9925f013 221 pEpOut = new UsbEndpoint((0x02 & 0x7F), false, 64);
donatien 0:632c9925f013 222 pEpIn = new UsbEndpoint((0x82 & 0x7F), true, 64);
donatien 0:632c9925f013 223 PRINT_Log("Huawei E220\r\n");
donatien 0:632c9925f013 224 }
donatien 0:632c9925f013 225 else /*if ( m_vid == 0x12d1 &&
donatien 0:632c9925f013 226 m_pid == 0x1001 )*/
donatien 0:632c9925f013 227 {
donatien 0:632c9925f013 228 pEpOut = new UsbEndpoint((0x01 & 0x7F), false, 64);
donatien 0:632c9925f013 229 pEpIn = new UsbEndpoint((0x82 & 0x7F), true, 64);
donatien 0:632c9925f013 230 PRINT_Log("Huawei E1550\r\n");
donatien 0:632c9925f013 231 }
donatien 0:632c9925f013 232
donatien 0:632c9925f013 233 PRINT_Log("Virtual Serial Port device %04x:%04x connected\n", m_vid, m_pid);
donatien 0:632c9925f013 234 return (OK);
donatien 0:632c9925f013 235 }
donatien 2:a4f97773c90f 236 else if (dongleState == DONGLE_STATE_CDFS) {
donatien 0:632c9925f013 237 PRINT_Log("CDFS dongle connected, reset\n");
donatien 0:632c9925f013 238 return (OK);
donatien 0:632c9925f013 239 } else {
donatien 0:632c9925f013 240 PRINT_Log("Not a Virtual Serial Port device\n");
donatien 0:632c9925f013 241 return (ERR_NO_MS_INTERFACE);
donatien 0:632c9925f013 242 }
donatien 0:632c9925f013 243 }
donatien 0:632c9925f013 244
donatien 0:632c9925f013 245
donatien 0:632c9925f013 246 USB_INT32S SerialRx( volatile USB_INT08U* buf, USB_INT32U len )
donatien 0:632c9925f013 247 {
donatien 0:632c9925f013 248 USB_INT32S rc;
donatien 0:632c9925f013 249 rc = pEpIn->transfer(buf, len);
donatien 0:632c9925f013 250 return rc;
donatien 0:632c9925f013 251 }
donatien 0:632c9925f013 252
donatien 0:632c9925f013 253 USB_INT32S SerialReceived()
donatien 0:632c9925f013 254 {
donatien 0:632c9925f013 255 return pEpIn->status();
donatien 0:632c9925f013 256 }
donatien 0:632c9925f013 257
donatien 0:632c9925f013 258 USB_INT32S SerialTx( volatile USB_INT08U* buf, USB_INT32U len )
donatien 0:632c9925f013 259 {
donatien 0:632c9925f013 260 USB_INT32S rc;
donatien 0:632c9925f013 261 rc = pEpOut->transfer(buf, len);
donatien 0:632c9925f013 262 // PRINT_Log("\r\nOut rc = %d\r\n",len);
donatien 0:632c9925f013 263 return rc;
donatien 0:632c9925f013 264 }
donatien 0:632c9925f013 265
donatien 0:632c9925f013 266 USB_INT32S SerialTransmitted()
donatien 0:632c9925f013 267 {
donatien 0:632c9925f013 268 USB_INT32S rc = pEpOut->status();
donatien 0:632c9925f013 269 /* if(rc>=0)
donatien 0:632c9925f013 270 {
donatien 0:632c9925f013 271 PRINT_Log("\r\nTransmitted %d\r\n",rc);
donatien 0:632c9925f013 272 }*/
donatien 0:632c9925f013 273 return rc;
donatien 0:632c9925f013 274 }
donatien 0:632c9925f013 275
donatien 0:632c9925f013 276 USB_INT32S SerialReg(USB_INT16U vid, USB_INT16U pid) {return 0;}
donatien 0:632c9925f013 277
donatien 0:632c9925f013 278 #endif