NetServices Stack source
Dependents: HelloWorld ServoInterfaceBoardExample1 4180_Lab4
drv/serial/usb/usbserialif.cpp@2:a4f97773c90f, 2010-06-18 (annotated)
- Committer:
- donatien
- Date:
- Fri Jun 18 09:22:54 2010 +0000
- Revision:
- 2:a4f97773c90f
- Parent:
- 0:632c9925f013
Who changed what in which revision?
User | Revision | Line number | New 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 |