Rahol Rajan / NetServices-Traffic

Used in Live Traffic Update Nokia LCD Display Project

Fork of NetServices by Segundo Equipo

drv/usb/UsbDevice.cpp@0:ac1725ba162c, 2010-11-09 (annotated)

Committer:
segundo
Date:
Tue Nov 09 20:54:15 2010 +0000
Revision:
0:ac1725ba162c

        

        
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