First step: AutoIP compiled in and working

Dependencies:   mbed

Committer:
darran
Date:
Fri Jun 18 09:11:35 2010 +0000
Revision:
0:55a05330f8cc
Child:
1:4218cacaf696

        

Who changed what in which revision?

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