Hendrik Vincent / Mbed 2 deprecated Weerstation

Leest de waarde van een sensor binnen een maakt deze beschikbaar via internet

Dependencies:   NTPClient_NetServices mbed

NetServices/drv/usb/UsbDevice.cpp@0:05ccbd4f84f1, 2013-12-02 (annotated)

Committer:
hendrikvincent
Date:
Mon Dec 02 09:01:23 2013 +0000
Revision:
0:05ccbd4f84f1
eerste programma;

Who changed what in which revision?

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