Rahol Rajan / NetServices-Traffic

Used in Live Traffic Update Nokia LCD Display Project

Fork of NetServices by Segundo Equipo

drv/usb/UsbDevice.cpp@8:92b57208ab99, 2013-03-06 (annotated)

Committer:
rrajan8
Date:
Wed Mar 06 19:07:23 2013 +0000
Revision:
8:92b57208ab99
Parent:
0:ac1725ba162c 
This project utilizes mbed's networking features to display live traffic updates on the Nokia LCD using the MapQuest API's Traffic Web Service.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
segundo 0:ac1725ba162c 1
segundo 0:ac1725ba162c 2 /*
segundo 0:ac1725ba162c 3 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
segundo 0:ac1725ba162c 4
segundo 0:ac1725ba162c 5 Permission is hereby granted, free of charge, to any person obtaining a copy
segundo 0:ac1725ba162c 6 of this software and associated documentation files (the "Software"), to deal
segundo 0:ac1725ba162c 7 in the Software without restriction, including without limitation the rights
segundo 0:ac1725ba162c 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
segundo 0:ac1725ba162c 9 copies of the Software, and to permit persons to whom the Software is
segundo 0:ac1725ba162c 10 furnished to do so, subject to the following conditions:
segundo 0:ac1725ba162c 11
segundo 0:ac1725ba162c 12 The above copyright notice and this permission notice shall be included in
segundo 0:ac1725ba162c 13 all copies or substantial portions of the Software.
segundo 0:ac1725ba162c 14
segundo 0:ac1725ba162c 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
segundo 0:ac1725ba162c 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
segundo 0:ac1725ba162c 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
segundo 0:ac1725ba162c 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
segundo 0:ac1725ba162c 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
segundo 0:ac1725ba162c 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
segundo 0:ac1725ba162c 21 THE SOFTWARE.
segundo 0:ac1725ba162c 22 */
segundo 0:ac1725ba162c 23
segundo 0:ac1725ba162c 24 #include "UsbDevice.h"
segundo 0:ac1725ba162c 25
segundo 0:ac1725ba162c 26 #include "netCfg.h"
segundo 0:ac1725ba162c 27 #if NET_USB
segundo 0:ac1725ba162c 28
segundo 0:ac1725ba162c 29 //#define __DEBUG
segundo 0:ac1725ba162c 30 #include "dbg/dbg.h"
segundo 0:ac1725ba162c 31
segundo 0:ac1725ba162c 32 UsbDevice::UsbDevice( UsbHostMgr* pMgr, int hub, int port, int addr ) : m_pControlEp(NULL), /*m_controlEp( this, 0x00, false, USB_CONTROL, 8 ),*/
segundo 0:ac1725ba162c 33 m_pMgr(pMgr), m_connected(false), m_enumerated(false), m_hub(hub), m_port(port), m_addr(addr), m_refs(0),
segundo 0:ac1725ba162c 34 m_vid(0), m_pid(0)
segundo 0:ac1725ba162c 35 {
segundo 0:ac1725ba162c 36
segundo 0:ac1725ba162c 37 }
segundo 0:ac1725ba162c 38
segundo 0:ac1725ba162c 39 UsbDevice::~UsbDevice()
segundo 0:ac1725ba162c 40 {
segundo 0:ac1725ba162c 41 if(m_pControlEp)
segundo 0:ac1725ba162c 42 delete m_pControlEp;
segundo 0:ac1725ba162c 43 }
segundo 0:ac1725ba162c 44
segundo 0:ac1725ba162c 45 UsbErr UsbDevice::enumerate()
segundo 0:ac1725ba162c 46 {
segundo 0:ac1725ba162c 47 // USB_INT32S rc;
segundo 0:ac1725ba162c 48
segundo 0:ac1725ba162c 49 UsbErr rc;
segundo 0:ac1725ba162c 50
segundo 0:ac1725ba162c 51 DBG("Starting enumeration (m_pMgr = %p)\n", m_pMgr);
segundo 0:ac1725ba162c 52
segundo 0:ac1725ba162c 53 #if 1
segundo 0:ac1725ba162c 54 m_pMgr->resetPort(m_hub, m_port);
segundo 0:ac1725ba162c 55 #else
segundo 0:ac1725ba162c 56 wait_ms(100); /* USB 2.0 spec says atleast 50ms delay beore port reset */
segundo 0:ac1725ba162c 57 LPC_USB->HcRhPortStatus1 = OR_RH_PORT_PRS; // Initiate port reset
segundo 0:ac1725ba162c 58 while (LPC_USB->HcRhPortStatus1 & OR_RH_PORT_PRS)
segundo 0:ac1725ba162c 59 __WFI(); // Wait for port reset to complete...
segundo 0:ac1725ba162c 60 LPC_USB->HcRhPortStatus1 = OR_RH_PORT_PRSC; // ...and clear port reset signal
segundo 0:ac1725ba162c 61 wait_ms(200); /* Wait for 100 MS after port reset */
segundo 0:ac1725ba162c 62 #endif
segundo 0:ac1725ba162c 63
segundo 0:ac1725ba162c 64 DBG("Port reset\n");
segundo 0:ac1725ba162c 65
segundo 0:ac1725ba162c 66 wait_ms(200);
segundo 0:ac1725ba162c 67
segundo 0:ac1725ba162c 68 m_pControlEp = new UsbEndpoint( this, 0x00, false, USB_CONTROL, 8, 0 );
segundo 0:ac1725ba162c 69
segundo 0:ac1725ba162c 70 //EDCtrl->Control = 8 << 16;/* Put max pkt size = 8 */
segundo 0:ac1725ba162c 71 /* Read first 8 bytes of device desc */
segundo 0:ac1725ba162c 72 rc = controlReceive(USB_DEVICE_TO_HOST | USB_RECIPIENT_DEVICE, GET_DESCRIPTOR, (USB_DESCRIPTOR_TYPE_DEVICE << 8)|(0), 0, m_controlDataBuf, 8);
segundo 0:ac1725ba162c 73 if (rc)
segundo 0:ac1725ba162c 74 {
segundo 0:ac1725ba162c 75 DBG("RC=%d",rc);
segundo 0:ac1725ba162c 76 return (rc);
segundo 0:ac1725ba162c 77 }
segundo 0:ac1725ba162c 78
segundo 0:ac1725ba162c 79 DBG("Got descriptor, max ep size is %d\n", m_controlDataBuf[7]);
segundo 0:ac1725ba162c 80
segundo 0:ac1725ba162c 81 m_pControlEp->updateSize(m_controlDataBuf[7]); /* Get max pkt size of endpoint 0 */
segundo 0:ac1725ba162c 82 rc = controlSend(USB_HOST_TO_DEVICE | USB_RECIPIENT_DEVICE, SET_ADDRESS, m_addr, 0, NULL, 0); /* Set the device address to m_addr */
segundo 0:ac1725ba162c 83 if (rc)
segundo 0:ac1725ba162c 84 {
segundo 0:ac1725ba162c 85 // PRINT_Err(rc);
segundo 0:ac1725ba162c 86 return (rc);
segundo 0:ac1725ba162c 87 }
segundo 0:ac1725ba162c 88 wait_ms(2);
segundo 0:ac1725ba162c 89 //EDCtrl->Control = (EDCtrl->Control) | 1; /* Modify control pipe with address 1 */
segundo 0:ac1725ba162c 90
segundo 0:ac1725ba162c 91 //Update address
segundo 0:ac1725ba162c 92 m_pControlEp->updateAddr(m_addr);
segundo 0:ac1725ba162c 93 DBG("Ep addr is now %d", m_addr);
segundo 0:ac1725ba162c 94 /**/
segundo 0:ac1725ba162c 95
segundo 0:ac1725ba162c 96 //rc = HOST_GET_DESCRIPTOR(USB_DESCRIPTOR_TYPE_DEVICE, 0, TDBuffer, 17); //Read full device descriptor
segundo 0:ac1725ba162c 97 rc = controlReceive(USB_DEVICE_TO_HOST | USB_RECIPIENT_DEVICE, GET_DESCRIPTOR, (USB_DESCRIPTOR_TYPE_DEVICE << 8)|(0), 0, m_controlDataBuf, 17);
segundo 0:ac1725ba162c 98 if (rc)
segundo 0:ac1725ba162c 99 {
segundo 0:ac1725ba162c 100 //PRINT_Err(rc);
segundo 0:ac1725ba162c 101 return (rc);
segundo 0:ac1725ba162c 102 }
segundo 0:ac1725ba162c 103 /*
segundo 0:ac1725ba162c 104 rc = SerialCheckVidPid();
segundo 0:ac1725ba162c 105 if (rc != OK) {
segundo 0:ac1725ba162c 106 PRINT_Err(rc);
segundo 0:ac1725ba162c 107 return (rc);
segundo 0:ac1725ba162c 108 }
segundo 0:ac1725ba162c 109 */
segundo 0:ac1725ba162c 110 /**/
segundo 0:ac1725ba162c 111
segundo 0:ac1725ba162c 112 m_vid = *((uint16_t*)&m_controlDataBuf[8]);
segundo 0:ac1725ba162c 113 m_pid = *((uint16_t*)&m_controlDataBuf[10]);
segundo 0:ac1725ba162c 114
segundo 0:ac1725ba162c 115 DBG("VID: %02x, PID: %02x\n", m_vid, m_pid);
segundo 0:ac1725ba162c 116 /* Get the configuration descriptor */
segundo 0:ac1725ba162c 117 //rc = HOST_GET_DESCRIPTOR(USB_DESCRIPTOR_TYPE_CONFIGURATION, 0, TDBuffer, 9);
segundo 0:ac1725ba162c 118 rc = controlReceive(USB_DEVICE_TO_HOST | USB_RECIPIENT_DEVICE, GET_DESCRIPTOR, (USB_DESCRIPTOR_TYPE_CONFIGURATION << 8)|(0), 0, m_controlDataBuf, 9);
segundo 0:ac1725ba162c 119 if (rc)
segundo 0:ac1725ba162c 120 {
segundo 0:ac1725ba162c 121 //PRINT_Err(rc);
segundo 0:ac1725ba162c 122 return (rc);
segundo 0:ac1725ba162c 123 }
segundo 0:ac1725ba162c 124 /* Get the first configuration data */
segundo 0:ac1725ba162c 125 //rc = HOST_GET_DESCRIPTOR(USB_DESCRIPTOR_TYPE_CONFIGURATION, 0, TDBuffer, *((uint16_t*)&TDBuffer[2]));
segundo 0:ac1725ba162c 126 rc = controlReceive(USB_DEVICE_TO_HOST | USB_RECIPIENT_DEVICE, GET_DESCRIPTOR, (USB_DESCRIPTOR_TYPE_CONFIGURATION << 8)|(0), 0, m_controlDataBuf, *((uint16_t*)&m_controlDataBuf[2]));
segundo 0:ac1725ba162c 127 if (rc)
segundo 0:ac1725ba162c 128 {
segundo 0:ac1725ba162c 129 //PRINT_Err(rc);
segundo 0:ac1725ba162c 130 return (rc);
segundo 0:ac1725ba162c 131 }
segundo 0:ac1725ba162c 132
segundo 0:ac1725ba162c 133 DBG("Desc len is %d\n", *((uint16_t*)&m_controlDataBuf[2]));
segundo 0:ac1725ba162c 134
segundo 0:ac1725ba162c 135 DBG("Set configuration\n");
segundo 0:ac1725ba162c 136
segundo 0:ac1725ba162c 137 //rc = USBH_SET_CONFIGURATION(1);/* Select device configuration 1 */
segundo 0:ac1725ba162c 138 rc = controlSend(USB_HOST_TO_DEVICE | USB_RECIPIENT_DEVICE, SET_CONFIGURATION, 1, 0, NULL, 0);
segundo 0:ac1725ba162c 139 if (rc)
segundo 0:ac1725ba162c 140 {
segundo 0:ac1725ba162c 141 // PRINT_Err(rc);
segundo 0:ac1725ba162c 142 return rc;
segundo 0:ac1725ba162c 143 }
segundo 0:ac1725ba162c 144 wait_ms(100);/* Some devices may require this delay */
segundo 0:ac1725ba162c 145
segundo 0:ac1725ba162c 146 m_enumerated = true;
segundo 0:ac1725ba162c 147 return USBERR_OK;
segundo 0:ac1725ba162c 148 }
segundo 0:ac1725ba162c 149
segundo 0:ac1725ba162c 150 bool UsbDevice::connected()
segundo 0:ac1725ba162c 151 {
segundo 0:ac1725ba162c 152 return m_connected;
segundo 0:ac1725ba162c 153 }
segundo 0:ac1725ba162c 154
segundo 0:ac1725ba162c 155 bool UsbDevice::enumerated()
segundo 0:ac1725ba162c 156 {
segundo 0:ac1725ba162c 157 return m_enumerated;
segundo 0:ac1725ba162c 158 }
segundo 0:ac1725ba162c 159
segundo 0:ac1725ba162c 160 int UsbDevice::getPid()
segundo 0:ac1725ba162c 161 {
segundo 0:ac1725ba162c 162 return m_pid;
segundo 0:ac1725ba162c 163 }
segundo 0:ac1725ba162c 164
segundo 0:ac1725ba162c 165 int UsbDevice::getVid()
segundo 0:ac1725ba162c 166 {
segundo 0:ac1725ba162c 167 return m_vid;
segundo 0:ac1725ba162c 168 }
segundo 0:ac1725ba162c 169
segundo 0:ac1725ba162c 170 UsbErr UsbDevice::getConfigurationDescriptor(int config, uint8_t** pBuf)
segundo 0:ac1725ba162c 171 {
segundo 0:ac1725ba162c 172 //For now olny one config
segundo 0:ac1725ba162c 173 *pBuf = m_controlDataBuf;
segundo 0:ac1725ba162c 174 return USBERR_OK;
segundo 0:ac1725ba162c 175 }
segundo 0:ac1725ba162c 176
segundo 0:ac1725ba162c 177 UsbErr UsbDevice::getInterfaceDescriptor(int config, int item, uint8_t** pBuf)
segundo 0:ac1725ba162c 178 {
segundo 0:ac1725ba162c 179 byte* desc_ptr = m_controlDataBuf;
segundo 0:ac1725ba162c 180
segundo 0:ac1725ba162c 181 /* if (desc_ptr[1] != USB_DESCRIPTOR_TYPE_CONFIGURATION)
segundo 0:ac1725ba162c 182 {
segundo 0:ac1725ba162c 183 return USBERR_BADCONFIG;
segundo 0:ac1725ba162c 184 }*/
segundo 0:ac1725ba162c 185
segundo 0:ac1725ba162c 186 if(item>=m_controlDataBuf[4])//Interfaces count
segundo 0:ac1725ba162c 187 return USBERR_NOTFOUND;
segundo 0:ac1725ba162c 188
segundo 0:ac1725ba162c 189 desc_ptr += desc_ptr[0];
segundo 0:ac1725ba162c 190
segundo 0:ac1725ba162c 191 *pBuf = NULL;
segundo 0:ac1725ba162c 192
segundo 0:ac1725ba162c 193 while (desc_ptr < m_controlDataBuf + *((uint16_t*)&m_controlDataBuf[2]))
segundo 0:ac1725ba162c 194 {
segundo 0:ac1725ba162c 195
segundo 0:ac1725ba162c 196 switch (desc_ptr[1]) {
segundo 0:ac1725ba162c 197 case USB_DESCRIPTOR_TYPE_INTERFACE:
segundo 0:ac1725ba162c 198 if(desc_ptr[2] == item)
segundo 0:ac1725ba162c 199 {
segundo 0:ac1725ba162c 200 *pBuf = desc_ptr;
segundo 0:ac1725ba162c 201 return USBERR_OK;
segundo 0:ac1725ba162c 202 }
segundo 0:ac1725ba162c 203 desc_ptr += desc_ptr[0]; // Move to next descriptor start
segundo 0:ac1725ba162c 204 break;
segundo 0:ac1725ba162c 205 }
segundo 0:ac1725ba162c 206
segundo 0:ac1725ba162c 207 }
segundo 0:ac1725ba162c 208
segundo 0:ac1725ba162c 209 if(*pBuf == NULL)
segundo 0:ac1725ba162c 210 return USBERR_NOTFOUND;
segundo 0:ac1725ba162c 211
segundo 0:ac1725ba162c 212 return USBERR_OK;
segundo 0:ac1725ba162c 213 }
segundo 0:ac1725ba162c 214
segundo 0:ac1725ba162c 215
segundo 0:ac1725ba162c 216 UsbErr UsbDevice::setConfiguration(int config)
segundo 0:ac1725ba162c 217 {
segundo 0:ac1725ba162c 218 return USBERR_OK;
segundo 0:ac1725ba162c 219 }
segundo 0:ac1725ba162c 220
segundo 0:ac1725ba162c 221 UsbErr UsbDevice::controlSend(byte requestType, byte request, word value, word index, const byte* buf, int len)
segundo 0:ac1725ba162c 222 {
segundo 0:ac1725ba162c 223 UsbErr rc;
segundo 0:ac1725ba162c 224 fillControlBuf(requestType, request, value, index, len);
segundo 0:ac1725ba162c 225 m_pControlEp->setNextToken(TD_SETUP);
segundo 0:ac1725ba162c 226 rc = m_pControlEp->transfer(m_controlBuf, 8);
segundo 0:ac1725ba162c 227 while(m_pControlEp->status() == USBERR_PROCESSING);
segundo 0:ac1725ba162c 228 rc = (UsbErr) MIN(0, m_pControlEp->status());
segundo 0:ac1725ba162c 229 if(rc)
segundo 0:ac1725ba162c 230 return rc;
segundo 0:ac1725ba162c 231 if(len)
segundo 0:ac1725ba162c 232 {
segundo 0:ac1725ba162c 233 m_pControlEp->setNextToken(TD_OUT);
segundo 0:ac1725ba162c 234 rc = m_pControlEp->transfer((byte*)buf, len);
segundo 0:ac1725ba162c 235 while(m_pControlEp->status() == USBERR_PROCESSING);
segundo 0:ac1725ba162c 236 rc = (UsbErr) MIN(0, m_pControlEp->status());
segundo 0:ac1725ba162c 237 if(rc)
segundo 0:ac1725ba162c 238 return rc;
segundo 0:ac1725ba162c 239 }
segundo 0:ac1725ba162c 240 m_pControlEp->setNextToken(TD_IN);
segundo 0:ac1725ba162c 241 rc = m_pControlEp->transfer(NULL, 0);
segundo 0:ac1725ba162c 242 while(m_pControlEp->status() == USBERR_PROCESSING);
segundo 0:ac1725ba162c 243 rc = (UsbErr) MIN(0, m_pControlEp->status());
segundo 0:ac1725ba162c 244 if(rc)
segundo 0:ac1725ba162c 245 return rc;
segundo 0:ac1725ba162c 246 return USBERR_OK;
segundo 0:ac1725ba162c 247 }
segundo 0:ac1725ba162c 248
segundo 0:ac1725ba162c 249 UsbErr UsbDevice::controlReceive(byte requestType, byte request, word value, word index, const byte* buf, int len)
segundo 0:ac1725ba162c 250 {
segundo 0:ac1725ba162c 251 UsbErr rc;
segundo 0:ac1725ba162c 252 fillControlBuf(requestType, request, value, index, len);
segundo 0:ac1725ba162c 253 m_pControlEp->setNextToken(TD_SETUP);
segundo 0:ac1725ba162c 254 rc = m_pControlEp->transfer(m_controlBuf, 8);
segundo 0:ac1725ba162c 255 while(m_pControlEp->status() == USBERR_PROCESSING);
segundo 0:ac1725ba162c 256 rc = (UsbErr) MIN(0, m_pControlEp->status());
segundo 0:ac1725ba162c 257 if(rc)
segundo 0:ac1725ba162c 258 return rc;
segundo 0:ac1725ba162c 259 if(len)
segundo 0:ac1725ba162c 260 {
segundo 0:ac1725ba162c 261 m_pControlEp->setNextToken(TD_IN);
segundo 0:ac1725ba162c 262 rc = m_pControlEp->transfer( (byte*) buf, len);
segundo 0:ac1725ba162c 263 while(m_pControlEp->status() == USBERR_PROCESSING);
segundo 0:ac1725ba162c 264 rc = (UsbErr) MIN(0, m_pControlEp->status());
segundo 0:ac1725ba162c 265 if(rc)
segundo 0:ac1725ba162c 266 return rc;
segundo 0:ac1725ba162c 267 }
segundo 0:ac1725ba162c 268 m_pControlEp->setNextToken(TD_OUT);
segundo 0:ac1725ba162c 269 rc = m_pControlEp->transfer(NULL, 0);
segundo 0:ac1725ba162c 270 while(m_pControlEp->status() == USBERR_PROCESSING);
segundo 0:ac1725ba162c 271 rc = (UsbErr) MIN(0, m_pControlEp->status());
segundo 0:ac1725ba162c 272 if(rc)
segundo 0:ac1725ba162c 273 return rc;
segundo 0:ac1725ba162c 274 return USBERR_OK;
segundo 0:ac1725ba162c 275 }
segundo 0:ac1725ba162c 276
segundo 0:ac1725ba162c 277 void UsbDevice::fillControlBuf(byte requestType, byte request, word value, word index, int len)
segundo 0:ac1725ba162c 278 {
segundo 0:ac1725ba162c 279 #ifdef __BIG_ENDIAN
segundo 0:ac1725ba162c 280 #error "Must implement BE to LE conv here"
segundo 0:ac1725ba162c 281 #endif
segundo 0:ac1725ba162c 282 m_controlBuf[0] = requestType;
segundo 0:ac1725ba162c 283 m_controlBuf[1] = request;
segundo 0:ac1725ba162c 284 //We are in LE so it's fine
segundo 0:ac1725ba162c 285 *((word*)&m_controlBuf[2]) = value;
segundo 0:ac1725ba162c 286 *((word*)&m_controlBuf[4]) = index;
segundo 0:ac1725ba162c 287 *((word*)&m_controlBuf[6]) = (word) len;
segundo 0:ac1725ba162c 288 }
segundo 0:ac1725ba162c 289
segundo 0:ac1725ba162c 290
segundo 0:ac1725ba162c 291 #endif