ON Semiconductor / mbed-os

Dependents:   mbed-TFT-example-NCS36510 mbed-Accelerometer-example-NCS36510 mbed-Accelerometer-example-NCS36510

Committer:
group-onsemi
Date:
Wed Jan 25 20:34:15 2017 +0000
Revision:
0:098463de4c5d
Initial commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
group-onsemi 0:098463de4c5d 1 /* Copyright (c) 2010-2011 mbed.org, MIT License
group-onsemi 0:098463de4c5d 2 *
group-onsemi 0:098463de4c5d 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
group-onsemi 0:098463de4c5d 4 * and associated documentation files (the "Software"), to deal in the Software without
group-onsemi 0:098463de4c5d 5 * restriction, including without limitation the rights to use, copy, modify, merge, publish,
group-onsemi 0:098463de4c5d 6 * distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the
group-onsemi 0:098463de4c5d 7 * Software is furnished to do so, subject to the following conditions:
group-onsemi 0:098463de4c5d 8 *
group-onsemi 0:098463de4c5d 9 * The above copyright notice and this permission notice shall be included in all copies or
group-onsemi 0:098463de4c5d 10 * substantial portions of the Software.
group-onsemi 0:098463de4c5d 11 *
group-onsemi 0:098463de4c5d 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
group-onsemi 0:098463de4c5d 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
group-onsemi 0:098463de4c5d 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
group-onsemi 0:098463de4c5d 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
group-onsemi 0:098463de4c5d 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
group-onsemi 0:098463de4c5d 17 */
group-onsemi 0:098463de4c5d 18
group-onsemi 0:098463de4c5d 19 #if defined(TARGET_LPC1768) || defined(TARGET_LPC2368) || defined(TARGET_LPC2460)
group-onsemi 0:098463de4c5d 20
group-onsemi 0:098463de4c5d 21 #include "USBHAL.h"
group-onsemi 0:098463de4c5d 22
group-onsemi 0:098463de4c5d 23
group-onsemi 0:098463de4c5d 24 // Get endpoint direction
group-onsemi 0:098463de4c5d 25 #define IN_EP(endpoint) ((endpoint) & 1U ? true : false)
group-onsemi 0:098463de4c5d 26 #define OUT_EP(endpoint) ((endpoint) & 1U ? false : true)
group-onsemi 0:098463de4c5d 27
group-onsemi 0:098463de4c5d 28 // Convert physical endpoint number to register bit
group-onsemi 0:098463de4c5d 29 #define EP(endpoint) (1UL<<endpoint)
group-onsemi 0:098463de4c5d 30
group-onsemi 0:098463de4c5d 31 // Power Control for Peripherals register
group-onsemi 0:098463de4c5d 32 #define PCUSB (1UL<<31)
group-onsemi 0:098463de4c5d 33
group-onsemi 0:098463de4c5d 34 // USB Clock Control register
group-onsemi 0:098463de4c5d 35 #define DEV_CLK_EN (1UL<<1)
group-onsemi 0:098463de4c5d 36 #define AHB_CLK_EN (1UL<<4)
group-onsemi 0:098463de4c5d 37
group-onsemi 0:098463de4c5d 38 // USB Clock Status register
group-onsemi 0:098463de4c5d 39 #define DEV_CLK_ON (1UL<<1)
group-onsemi 0:098463de4c5d 40 #define AHB_CLK_ON (1UL<<4)
group-onsemi 0:098463de4c5d 41
group-onsemi 0:098463de4c5d 42 // USB Device Interupt registers
group-onsemi 0:098463de4c5d 43 #define FRAME (1UL<<0)
group-onsemi 0:098463de4c5d 44 #define EP_FAST (1UL<<1)
group-onsemi 0:098463de4c5d 45 #define EP_SLOW (1UL<<2)
group-onsemi 0:098463de4c5d 46 #define DEV_STAT (1UL<<3)
group-onsemi 0:098463de4c5d 47 #define CCEMPTY (1UL<<4)
group-onsemi 0:098463de4c5d 48 #define CDFULL (1UL<<5)
group-onsemi 0:098463de4c5d 49 #define RxENDPKT (1UL<<6)
group-onsemi 0:098463de4c5d 50 #define TxENDPKT (1UL<<7)
group-onsemi 0:098463de4c5d 51 #define EP_RLZED (1UL<<8)
group-onsemi 0:098463de4c5d 52 #define ERR_INT (1UL<<9)
group-onsemi 0:098463de4c5d 53
group-onsemi 0:098463de4c5d 54 // USB Control register
group-onsemi 0:098463de4c5d 55 #define RD_EN (1<<0)
group-onsemi 0:098463de4c5d 56 #define WR_EN (1<<1)
group-onsemi 0:098463de4c5d 57 #define LOG_ENDPOINT(endpoint) ((endpoint>>1)<<2)
group-onsemi 0:098463de4c5d 58
group-onsemi 0:098463de4c5d 59 // USB Receive Packet Length register
group-onsemi 0:098463de4c5d 60 #define DV (1UL<<10)
group-onsemi 0:098463de4c5d 61 #define PKT_RDY (1UL<<11)
group-onsemi 0:098463de4c5d 62 #define PKT_LNGTH_MASK (0x3ff)
group-onsemi 0:098463de4c5d 63
group-onsemi 0:098463de4c5d 64 // Serial Interface Engine (SIE)
group-onsemi 0:098463de4c5d 65 #define SIE_WRITE (0x01)
group-onsemi 0:098463de4c5d 66 #define SIE_READ (0x02)
group-onsemi 0:098463de4c5d 67 #define SIE_COMMAND (0x05)
group-onsemi 0:098463de4c5d 68 #define SIE_CMD_CODE(phase, data) ((phase<<8)|(data<<16))
group-onsemi 0:098463de4c5d 69
group-onsemi 0:098463de4c5d 70 // SIE Command codes
group-onsemi 0:098463de4c5d 71 #define SIE_CMD_SET_ADDRESS (0xD0)
group-onsemi 0:098463de4c5d 72 #define SIE_CMD_CONFIGURE_DEVICE (0xD8)
group-onsemi 0:098463de4c5d 73 #define SIE_CMD_SET_MODE (0xF3)
group-onsemi 0:098463de4c5d 74 #define SIE_CMD_READ_FRAME_NUMBER (0xF5)
group-onsemi 0:098463de4c5d 75 #define SIE_CMD_READ_TEST_REGISTER (0xFD)
group-onsemi 0:098463de4c5d 76 #define SIE_CMD_SET_DEVICE_STATUS (0xFE)
group-onsemi 0:098463de4c5d 77 #define SIE_CMD_GET_DEVICE_STATUS (0xFE)
group-onsemi 0:098463de4c5d 78 #define SIE_CMD_GET_ERROR_CODE (0xFF)
group-onsemi 0:098463de4c5d 79 #define SIE_CMD_READ_ERROR_STATUS (0xFB)
group-onsemi 0:098463de4c5d 80
group-onsemi 0:098463de4c5d 81 #define SIE_CMD_SELECT_ENDPOINT(endpoint) (0x00+endpoint)
group-onsemi 0:098463de4c5d 82 #define SIE_CMD_SELECT_ENDPOINT_CLEAR_INTERRUPT(endpoint) (0x40+endpoint)
group-onsemi 0:098463de4c5d 83 #define SIE_CMD_SET_ENDPOINT_STATUS(endpoint) (0x40+endpoint)
group-onsemi 0:098463de4c5d 84
group-onsemi 0:098463de4c5d 85 #define SIE_CMD_CLEAR_BUFFER (0xF2)
group-onsemi 0:098463de4c5d 86 #define SIE_CMD_VALIDATE_BUFFER (0xFA)
group-onsemi 0:098463de4c5d 87
group-onsemi 0:098463de4c5d 88 // SIE Device Status register
group-onsemi 0:098463de4c5d 89 #define SIE_DS_CON (1<<0)
group-onsemi 0:098463de4c5d 90 #define SIE_DS_CON_CH (1<<1)
group-onsemi 0:098463de4c5d 91 #define SIE_DS_SUS (1<<2)
group-onsemi 0:098463de4c5d 92 #define SIE_DS_SUS_CH (1<<3)
group-onsemi 0:098463de4c5d 93 #define SIE_DS_RST (1<<4)
group-onsemi 0:098463de4c5d 94
group-onsemi 0:098463de4c5d 95 // SIE Device Set Address register
group-onsemi 0:098463de4c5d 96 #define SIE_DSA_DEV_EN (1<<7)
group-onsemi 0:098463de4c5d 97
group-onsemi 0:098463de4c5d 98 // SIE Configue Device register
group-onsemi 0:098463de4c5d 99 #define SIE_CONF_DEVICE (1<<0)
group-onsemi 0:098463de4c5d 100
group-onsemi 0:098463de4c5d 101 // Select Endpoint register
group-onsemi 0:098463de4c5d 102 #define SIE_SE_FE (1<<0)
group-onsemi 0:098463de4c5d 103 #define SIE_SE_ST (1<<1)
group-onsemi 0:098463de4c5d 104 #define SIE_SE_STP (1<<2)
group-onsemi 0:098463de4c5d 105 #define SIE_SE_PO (1<<3)
group-onsemi 0:098463de4c5d 106 #define SIE_SE_EPN (1<<4)
group-onsemi 0:098463de4c5d 107 #define SIE_SE_B_1_FULL (1<<5)
group-onsemi 0:098463de4c5d 108 #define SIE_SE_B_2_FULL (1<<6)
group-onsemi 0:098463de4c5d 109
group-onsemi 0:098463de4c5d 110 // Set Endpoint Status command
group-onsemi 0:098463de4c5d 111 #define SIE_SES_ST (1<<0)
group-onsemi 0:098463de4c5d 112 #define SIE_SES_DA (1<<5)
group-onsemi 0:098463de4c5d 113 #define SIE_SES_RF_MO (1<<6)
group-onsemi 0:098463de4c5d 114 #define SIE_SES_CND_ST (1<<7)
group-onsemi 0:098463de4c5d 115
group-onsemi 0:098463de4c5d 116
group-onsemi 0:098463de4c5d 117 USBHAL * USBHAL::instance;
group-onsemi 0:098463de4c5d 118
group-onsemi 0:098463de4c5d 119 static volatile int epComplete;
group-onsemi 0:098463de4c5d 120 static uint32_t endpointStallState;
group-onsemi 0:098463de4c5d 121
group-onsemi 0:098463de4c5d 122 static void SIECommand(uint32_t command) {
group-onsemi 0:098463de4c5d 123 // The command phase of a SIE transaction
group-onsemi 0:098463de4c5d 124 LPC_USB->USBDevIntClr = CCEMPTY;
group-onsemi 0:098463de4c5d 125 LPC_USB->USBCmdCode = SIE_CMD_CODE(SIE_COMMAND, command);
group-onsemi 0:098463de4c5d 126 while (!(LPC_USB->USBDevIntSt & CCEMPTY));
group-onsemi 0:098463de4c5d 127 }
group-onsemi 0:098463de4c5d 128
group-onsemi 0:098463de4c5d 129 static void SIEWriteData(uint8_t data) {
group-onsemi 0:098463de4c5d 130 // The data write phase of a SIE transaction
group-onsemi 0:098463de4c5d 131 LPC_USB->USBDevIntClr = CCEMPTY;
group-onsemi 0:098463de4c5d 132 LPC_USB->USBCmdCode = SIE_CMD_CODE(SIE_WRITE, data);
group-onsemi 0:098463de4c5d 133 while (!(LPC_USB->USBDevIntSt & CCEMPTY));
group-onsemi 0:098463de4c5d 134 }
group-onsemi 0:098463de4c5d 135
group-onsemi 0:098463de4c5d 136 static uint8_t SIEReadData(uint32_t command) {
group-onsemi 0:098463de4c5d 137 // The data read phase of a SIE transaction
group-onsemi 0:098463de4c5d 138 LPC_USB->USBDevIntClr = CDFULL;
group-onsemi 0:098463de4c5d 139 LPC_USB->USBCmdCode = SIE_CMD_CODE(SIE_READ, command);
group-onsemi 0:098463de4c5d 140 while (!(LPC_USB->USBDevIntSt & CDFULL));
group-onsemi 0:098463de4c5d 141 return (uint8_t)LPC_USB->USBCmdData;
group-onsemi 0:098463de4c5d 142 }
group-onsemi 0:098463de4c5d 143
group-onsemi 0:098463de4c5d 144 static void SIEsetDeviceStatus(uint8_t status) {
group-onsemi 0:098463de4c5d 145 // Write SIE device status register
group-onsemi 0:098463de4c5d 146 SIECommand(SIE_CMD_SET_DEVICE_STATUS);
group-onsemi 0:098463de4c5d 147 SIEWriteData(status);
group-onsemi 0:098463de4c5d 148 }
group-onsemi 0:098463de4c5d 149
group-onsemi 0:098463de4c5d 150 static uint8_t SIEgetDeviceStatus(void) {
group-onsemi 0:098463de4c5d 151 // Read SIE device status register
group-onsemi 0:098463de4c5d 152 SIECommand(SIE_CMD_GET_DEVICE_STATUS);
group-onsemi 0:098463de4c5d 153 return SIEReadData(SIE_CMD_GET_DEVICE_STATUS);
group-onsemi 0:098463de4c5d 154 }
group-onsemi 0:098463de4c5d 155
group-onsemi 0:098463de4c5d 156 void SIEsetAddress(uint8_t address) {
group-onsemi 0:098463de4c5d 157 // Write SIE device address register
group-onsemi 0:098463de4c5d 158 SIECommand(SIE_CMD_SET_ADDRESS);
group-onsemi 0:098463de4c5d 159 SIEWriteData((address & 0x7f) | SIE_DSA_DEV_EN);
group-onsemi 0:098463de4c5d 160 }
group-onsemi 0:098463de4c5d 161
group-onsemi 0:098463de4c5d 162 static uint8_t SIEselectEndpoint(uint8_t endpoint) {
group-onsemi 0:098463de4c5d 163 // SIE select endpoint command
group-onsemi 0:098463de4c5d 164 SIECommand(SIE_CMD_SELECT_ENDPOINT(endpoint));
group-onsemi 0:098463de4c5d 165 return SIEReadData(SIE_CMD_SELECT_ENDPOINT(endpoint));
group-onsemi 0:098463de4c5d 166 }
group-onsemi 0:098463de4c5d 167
group-onsemi 0:098463de4c5d 168 static uint8_t SIEclearBuffer(void) {
group-onsemi 0:098463de4c5d 169 // SIE clear buffer command
group-onsemi 0:098463de4c5d 170 SIECommand(SIE_CMD_CLEAR_BUFFER);
group-onsemi 0:098463de4c5d 171 return SIEReadData(SIE_CMD_CLEAR_BUFFER);
group-onsemi 0:098463de4c5d 172 }
group-onsemi 0:098463de4c5d 173
group-onsemi 0:098463de4c5d 174 static void SIEvalidateBuffer(void) {
group-onsemi 0:098463de4c5d 175 // SIE validate buffer command
group-onsemi 0:098463de4c5d 176 SIECommand(SIE_CMD_VALIDATE_BUFFER);
group-onsemi 0:098463de4c5d 177 }
group-onsemi 0:098463de4c5d 178
group-onsemi 0:098463de4c5d 179 static void SIEsetEndpointStatus(uint8_t endpoint, uint8_t status) {
group-onsemi 0:098463de4c5d 180 // SIE set endpoint status command
group-onsemi 0:098463de4c5d 181 SIECommand(SIE_CMD_SET_ENDPOINT_STATUS(endpoint));
group-onsemi 0:098463de4c5d 182 SIEWriteData(status);
group-onsemi 0:098463de4c5d 183 }
group-onsemi 0:098463de4c5d 184
group-onsemi 0:098463de4c5d 185 static uint16_t SIEgetFrameNumber(void) __attribute__ ((unused));
group-onsemi 0:098463de4c5d 186 static uint16_t SIEgetFrameNumber(void) {
group-onsemi 0:098463de4c5d 187 // Read current frame number
group-onsemi 0:098463de4c5d 188 uint16_t lowByte;
group-onsemi 0:098463de4c5d 189 uint16_t highByte;
group-onsemi 0:098463de4c5d 190
group-onsemi 0:098463de4c5d 191 SIECommand(SIE_CMD_READ_FRAME_NUMBER);
group-onsemi 0:098463de4c5d 192 lowByte = SIEReadData(SIE_CMD_READ_FRAME_NUMBER);
group-onsemi 0:098463de4c5d 193 highByte = SIEReadData(SIE_CMD_READ_FRAME_NUMBER);
group-onsemi 0:098463de4c5d 194
group-onsemi 0:098463de4c5d 195 return (highByte << 8) | lowByte;
group-onsemi 0:098463de4c5d 196 }
group-onsemi 0:098463de4c5d 197
group-onsemi 0:098463de4c5d 198 static void SIEconfigureDevice(void) {
group-onsemi 0:098463de4c5d 199 // SIE Configure device command
group-onsemi 0:098463de4c5d 200 SIECommand(SIE_CMD_CONFIGURE_DEVICE);
group-onsemi 0:098463de4c5d 201 SIEWriteData(SIE_CONF_DEVICE);
group-onsemi 0:098463de4c5d 202 }
group-onsemi 0:098463de4c5d 203
group-onsemi 0:098463de4c5d 204 static void SIEunconfigureDevice(void) {
group-onsemi 0:098463de4c5d 205 // SIE Configure device command
group-onsemi 0:098463de4c5d 206 SIECommand(SIE_CMD_CONFIGURE_DEVICE);
group-onsemi 0:098463de4c5d 207 SIEWriteData(0);
group-onsemi 0:098463de4c5d 208 }
group-onsemi 0:098463de4c5d 209
group-onsemi 0:098463de4c5d 210 static void SIEconnect(void) {
group-onsemi 0:098463de4c5d 211 // Connect USB device
group-onsemi 0:098463de4c5d 212 uint8_t status = SIEgetDeviceStatus();
group-onsemi 0:098463de4c5d 213 SIEsetDeviceStatus(status | SIE_DS_CON);
group-onsemi 0:098463de4c5d 214 }
group-onsemi 0:098463de4c5d 215
group-onsemi 0:098463de4c5d 216
group-onsemi 0:098463de4c5d 217 static void SIEdisconnect(void) {
group-onsemi 0:098463de4c5d 218 // Disconnect USB device
group-onsemi 0:098463de4c5d 219 uint8_t status = SIEgetDeviceStatus();
group-onsemi 0:098463de4c5d 220 SIEsetDeviceStatus(status & ~SIE_DS_CON);
group-onsemi 0:098463de4c5d 221 }
group-onsemi 0:098463de4c5d 222
group-onsemi 0:098463de4c5d 223
group-onsemi 0:098463de4c5d 224 static uint8_t selectEndpointClearInterrupt(uint8_t endpoint) {
group-onsemi 0:098463de4c5d 225 // Implemented using using EP_INT_CLR.
group-onsemi 0:098463de4c5d 226 LPC_USB->USBEpIntClr = EP(endpoint);
group-onsemi 0:098463de4c5d 227 while (!(LPC_USB->USBDevIntSt & CDFULL));
group-onsemi 0:098463de4c5d 228 return (uint8_t)LPC_USB->USBCmdData;
group-onsemi 0:098463de4c5d 229 }
group-onsemi 0:098463de4c5d 230
group-onsemi 0:098463de4c5d 231
group-onsemi 0:098463de4c5d 232 static void enableEndpointEvent(uint8_t endpoint) {
group-onsemi 0:098463de4c5d 233 // Enable an endpoint interrupt
group-onsemi 0:098463de4c5d 234 LPC_USB->USBEpIntEn |= EP(endpoint);
group-onsemi 0:098463de4c5d 235 }
group-onsemi 0:098463de4c5d 236
group-onsemi 0:098463de4c5d 237 static void disableEndpointEvent(uint8_t endpoint) __attribute__ ((unused));
group-onsemi 0:098463de4c5d 238 static void disableEndpointEvent(uint8_t endpoint) {
group-onsemi 0:098463de4c5d 239 // Disable an endpoint interrupt
group-onsemi 0:098463de4c5d 240 LPC_USB->USBEpIntEn &= ~EP(endpoint);
group-onsemi 0:098463de4c5d 241 }
group-onsemi 0:098463de4c5d 242
group-onsemi 0:098463de4c5d 243 static volatile uint32_t __attribute__((used)) dummyRead;
group-onsemi 0:098463de4c5d 244 uint32_t USBHAL::endpointReadcore(uint8_t endpoint, uint8_t *buffer) {
group-onsemi 0:098463de4c5d 245 // Read from an OUT endpoint
group-onsemi 0:098463de4c5d 246 uint32_t size;
group-onsemi 0:098463de4c5d 247 uint32_t i;
group-onsemi 0:098463de4c5d 248 uint32_t data = 0;
group-onsemi 0:098463de4c5d 249 uint8_t offset;
group-onsemi 0:098463de4c5d 250
group-onsemi 0:098463de4c5d 251 LPC_USB->USBCtrl = LOG_ENDPOINT(endpoint) | RD_EN;
group-onsemi 0:098463de4c5d 252 while (!(LPC_USB->USBRxPLen & PKT_RDY));
group-onsemi 0:098463de4c5d 253
group-onsemi 0:098463de4c5d 254 size = LPC_USB->USBRxPLen & PKT_LNGTH_MASK;
group-onsemi 0:098463de4c5d 255
group-onsemi 0:098463de4c5d 256 offset = 0;
group-onsemi 0:098463de4c5d 257
group-onsemi 0:098463de4c5d 258 if (size > 0) {
group-onsemi 0:098463de4c5d 259 for (i=0; i<size; i++) {
group-onsemi 0:098463de4c5d 260 if (offset==0) {
group-onsemi 0:098463de4c5d 261 // Fetch up to four bytes of data as a word
group-onsemi 0:098463de4c5d 262 data = LPC_USB->USBRxData;
group-onsemi 0:098463de4c5d 263 }
group-onsemi 0:098463de4c5d 264
group-onsemi 0:098463de4c5d 265 // extract a byte
group-onsemi 0:098463de4c5d 266 *buffer = (data>>offset) & 0xff;
group-onsemi 0:098463de4c5d 267 buffer++;
group-onsemi 0:098463de4c5d 268
group-onsemi 0:098463de4c5d 269 // move on to the next byte
group-onsemi 0:098463de4c5d 270 offset = (offset + 8) % 32;
group-onsemi 0:098463de4c5d 271 }
group-onsemi 0:098463de4c5d 272 } else {
group-onsemi 0:098463de4c5d 273 dummyRead = LPC_USB->USBRxData;
group-onsemi 0:098463de4c5d 274 }
group-onsemi 0:098463de4c5d 275
group-onsemi 0:098463de4c5d 276 LPC_USB->USBCtrl = 0;
group-onsemi 0:098463de4c5d 277
group-onsemi 0:098463de4c5d 278 if ((endpoint >> 1) % 3 || (endpoint >> 1) == 0) {
group-onsemi 0:098463de4c5d 279 SIEselectEndpoint(endpoint);
group-onsemi 0:098463de4c5d 280 SIEclearBuffer();
group-onsemi 0:098463de4c5d 281 }
group-onsemi 0:098463de4c5d 282
group-onsemi 0:098463de4c5d 283 return size;
group-onsemi 0:098463de4c5d 284 }
group-onsemi 0:098463de4c5d 285
group-onsemi 0:098463de4c5d 286 static void endpointWritecore(uint8_t endpoint, uint8_t *buffer, uint32_t size) {
group-onsemi 0:098463de4c5d 287 // Write to an IN endpoint
group-onsemi 0:098463de4c5d 288 uint32_t temp, data;
group-onsemi 0:098463de4c5d 289 uint8_t offset;
group-onsemi 0:098463de4c5d 290
group-onsemi 0:098463de4c5d 291 LPC_USB->USBCtrl = LOG_ENDPOINT(endpoint) | WR_EN;
group-onsemi 0:098463de4c5d 292
group-onsemi 0:098463de4c5d 293 LPC_USB->USBTxPLen = size;
group-onsemi 0:098463de4c5d 294 offset = 0;
group-onsemi 0:098463de4c5d 295 data = 0;
group-onsemi 0:098463de4c5d 296
group-onsemi 0:098463de4c5d 297 if (size>0) {
group-onsemi 0:098463de4c5d 298 do {
group-onsemi 0:098463de4c5d 299 // Fetch next data byte into a word-sized temporary variable
group-onsemi 0:098463de4c5d 300 temp = *buffer++;
group-onsemi 0:098463de4c5d 301
group-onsemi 0:098463de4c5d 302 // Add to current data word
group-onsemi 0:098463de4c5d 303 temp = temp << offset;
group-onsemi 0:098463de4c5d 304 data = data | temp;
group-onsemi 0:098463de4c5d 305
group-onsemi 0:098463de4c5d 306 // move on to the next byte
group-onsemi 0:098463de4c5d 307 offset = (offset + 8) % 32;
group-onsemi 0:098463de4c5d 308 size--;
group-onsemi 0:098463de4c5d 309
group-onsemi 0:098463de4c5d 310 if ((offset==0) || (size==0)) {
group-onsemi 0:098463de4c5d 311 // Write the word to the endpoint
group-onsemi 0:098463de4c5d 312 LPC_USB->USBTxData = data;
group-onsemi 0:098463de4c5d 313 data = 0;
group-onsemi 0:098463de4c5d 314 }
group-onsemi 0:098463de4c5d 315 } while (size>0);
group-onsemi 0:098463de4c5d 316 } else {
group-onsemi 0:098463de4c5d 317 LPC_USB->USBTxData = 0;
group-onsemi 0:098463de4c5d 318 }
group-onsemi 0:098463de4c5d 319
group-onsemi 0:098463de4c5d 320 // Clear WR_EN to cover zero length packet case
group-onsemi 0:098463de4c5d 321 LPC_USB->USBCtrl=0;
group-onsemi 0:098463de4c5d 322
group-onsemi 0:098463de4c5d 323 SIEselectEndpoint(endpoint);
group-onsemi 0:098463de4c5d 324 SIEvalidateBuffer();
group-onsemi 0:098463de4c5d 325 }
group-onsemi 0:098463de4c5d 326
group-onsemi 0:098463de4c5d 327 USBHAL::USBHAL(void) {
group-onsemi 0:098463de4c5d 328 // Disable IRQ
group-onsemi 0:098463de4c5d 329 NVIC_DisableIRQ(USB_IRQn);
group-onsemi 0:098463de4c5d 330
group-onsemi 0:098463de4c5d 331 // fill in callback array
group-onsemi 0:098463de4c5d 332 epCallback[0] = &USBHAL::EP1_OUT_callback;
group-onsemi 0:098463de4c5d 333 epCallback[1] = &USBHAL::EP1_IN_callback;
group-onsemi 0:098463de4c5d 334 epCallback[2] = &USBHAL::EP2_OUT_callback;
group-onsemi 0:098463de4c5d 335 epCallback[3] = &USBHAL::EP2_IN_callback;
group-onsemi 0:098463de4c5d 336 epCallback[4] = &USBHAL::EP3_OUT_callback;
group-onsemi 0:098463de4c5d 337 epCallback[5] = &USBHAL::EP3_IN_callback;
group-onsemi 0:098463de4c5d 338 epCallback[6] = &USBHAL::EP4_OUT_callback;
group-onsemi 0:098463de4c5d 339 epCallback[7] = &USBHAL::EP4_IN_callback;
group-onsemi 0:098463de4c5d 340 epCallback[8] = &USBHAL::EP5_OUT_callback;
group-onsemi 0:098463de4c5d 341 epCallback[9] = &USBHAL::EP5_IN_callback;
group-onsemi 0:098463de4c5d 342 epCallback[10] = &USBHAL::EP6_OUT_callback;
group-onsemi 0:098463de4c5d 343 epCallback[11] = &USBHAL::EP6_IN_callback;
group-onsemi 0:098463de4c5d 344 epCallback[12] = &USBHAL::EP7_OUT_callback;
group-onsemi 0:098463de4c5d 345 epCallback[13] = &USBHAL::EP7_IN_callback;
group-onsemi 0:098463de4c5d 346 epCallback[14] = &USBHAL::EP8_OUT_callback;
group-onsemi 0:098463de4c5d 347 epCallback[15] = &USBHAL::EP8_IN_callback;
group-onsemi 0:098463de4c5d 348 epCallback[16] = &USBHAL::EP9_OUT_callback;
group-onsemi 0:098463de4c5d 349 epCallback[17] = &USBHAL::EP9_IN_callback;
group-onsemi 0:098463de4c5d 350 epCallback[18] = &USBHAL::EP10_OUT_callback;
group-onsemi 0:098463de4c5d 351 epCallback[19] = &USBHAL::EP10_IN_callback;
group-onsemi 0:098463de4c5d 352 epCallback[20] = &USBHAL::EP11_OUT_callback;
group-onsemi 0:098463de4c5d 353 epCallback[21] = &USBHAL::EP11_IN_callback;
group-onsemi 0:098463de4c5d 354 epCallback[22] = &USBHAL::EP12_OUT_callback;
group-onsemi 0:098463de4c5d 355 epCallback[23] = &USBHAL::EP12_IN_callback;
group-onsemi 0:098463de4c5d 356 epCallback[24] = &USBHAL::EP13_OUT_callback;
group-onsemi 0:098463de4c5d 357 epCallback[25] = &USBHAL::EP13_IN_callback;
group-onsemi 0:098463de4c5d 358 epCallback[26] = &USBHAL::EP14_OUT_callback;
group-onsemi 0:098463de4c5d 359 epCallback[27] = &USBHAL::EP14_IN_callback;
group-onsemi 0:098463de4c5d 360 epCallback[28] = &USBHAL::EP15_OUT_callback;
group-onsemi 0:098463de4c5d 361 epCallback[29] = &USBHAL::EP15_IN_callback;
group-onsemi 0:098463de4c5d 362
group-onsemi 0:098463de4c5d 363 // Enable power to USB device controller
group-onsemi 0:098463de4c5d 364 LPC_SC->PCONP |= PCUSB;
group-onsemi 0:098463de4c5d 365
group-onsemi 0:098463de4c5d 366 // Enable USB clocks
group-onsemi 0:098463de4c5d 367 LPC_USB->USBClkCtrl |= DEV_CLK_EN | AHB_CLK_EN;
group-onsemi 0:098463de4c5d 368 while (LPC_USB->USBClkSt != (DEV_CLK_ON | AHB_CLK_ON));
group-onsemi 0:098463de4c5d 369
group-onsemi 0:098463de4c5d 370 // Configure pins P0.29 and P0.30 to be USB D+ and USB D-
group-onsemi 0:098463de4c5d 371 LPC_PINCON->PINSEL1 &= 0xc3ffffff;
group-onsemi 0:098463de4c5d 372 LPC_PINCON->PINSEL1 |= 0x14000000;
group-onsemi 0:098463de4c5d 373
group-onsemi 0:098463de4c5d 374 // Disconnect USB device
group-onsemi 0:098463de4c5d 375 SIEdisconnect();
group-onsemi 0:098463de4c5d 376
group-onsemi 0:098463de4c5d 377 // Configure pin P2.9 to be Connect
group-onsemi 0:098463de4c5d 378 LPC_PINCON->PINSEL4 &= 0xfffcffff;
group-onsemi 0:098463de4c5d 379 LPC_PINCON->PINSEL4 |= 0x00040000;
group-onsemi 0:098463de4c5d 380
group-onsemi 0:098463de4c5d 381 // Connect must be low for at least 2.5uS
group-onsemi 0:098463de4c5d 382 wait(0.3);
group-onsemi 0:098463de4c5d 383
group-onsemi 0:098463de4c5d 384 // Set the maximum packet size for the control endpoints
group-onsemi 0:098463de4c5d 385 realiseEndpoint(EP0IN, MAX_PACKET_SIZE_EP0, 0);
group-onsemi 0:098463de4c5d 386 realiseEndpoint(EP0OUT, MAX_PACKET_SIZE_EP0, 0);
group-onsemi 0:098463de4c5d 387
group-onsemi 0:098463de4c5d 388 // Attach IRQ
group-onsemi 0:098463de4c5d 389 instance = this;
group-onsemi 0:098463de4c5d 390 NVIC_SetVector(USB_IRQn, (uint32_t)&_usbisr);
group-onsemi 0:098463de4c5d 391
group-onsemi 0:098463de4c5d 392 // Enable interrupts for device events and EP0
group-onsemi 0:098463de4c5d 393 LPC_USB->USBDevIntEn = EP_SLOW | DEV_STAT | FRAME;
group-onsemi 0:098463de4c5d 394 enableEndpointEvent(EP0IN);
group-onsemi 0:098463de4c5d 395 enableEndpointEvent(EP0OUT);
group-onsemi 0:098463de4c5d 396 }
group-onsemi 0:098463de4c5d 397
group-onsemi 0:098463de4c5d 398 USBHAL::~USBHAL(void) {
group-onsemi 0:098463de4c5d 399 // Ensure device disconnected
group-onsemi 0:098463de4c5d 400 SIEdisconnect();
group-onsemi 0:098463de4c5d 401 // Disable USB interrupts
group-onsemi 0:098463de4c5d 402 NVIC_DisableIRQ(USB_IRQn);
group-onsemi 0:098463de4c5d 403 }
group-onsemi 0:098463de4c5d 404
group-onsemi 0:098463de4c5d 405 void USBHAL::connect(void) {
group-onsemi 0:098463de4c5d 406 NVIC_EnableIRQ(USB_IRQn);
group-onsemi 0:098463de4c5d 407 // Connect USB device
group-onsemi 0:098463de4c5d 408 SIEconnect();
group-onsemi 0:098463de4c5d 409 }
group-onsemi 0:098463de4c5d 410
group-onsemi 0:098463de4c5d 411 void USBHAL::disconnect(void) {
group-onsemi 0:098463de4c5d 412 NVIC_DisableIRQ(USB_IRQn);
group-onsemi 0:098463de4c5d 413 // Disconnect USB device
group-onsemi 0:098463de4c5d 414 SIEdisconnect();
group-onsemi 0:098463de4c5d 415 }
group-onsemi 0:098463de4c5d 416
group-onsemi 0:098463de4c5d 417 void USBHAL::configureDevice(void) {
group-onsemi 0:098463de4c5d 418 SIEconfigureDevice();
group-onsemi 0:098463de4c5d 419 }
group-onsemi 0:098463de4c5d 420
group-onsemi 0:098463de4c5d 421 void USBHAL::unconfigureDevice(void) {
group-onsemi 0:098463de4c5d 422 SIEunconfigureDevice();
group-onsemi 0:098463de4c5d 423 }
group-onsemi 0:098463de4c5d 424
group-onsemi 0:098463de4c5d 425 void USBHAL::setAddress(uint8_t address) {
group-onsemi 0:098463de4c5d 426 SIEsetAddress(address);
group-onsemi 0:098463de4c5d 427 }
group-onsemi 0:098463de4c5d 428
group-onsemi 0:098463de4c5d 429 void USBHAL::EP0setup(uint8_t *buffer) {
group-onsemi 0:098463de4c5d 430 endpointReadcore(EP0OUT, buffer);
group-onsemi 0:098463de4c5d 431 }
group-onsemi 0:098463de4c5d 432
group-onsemi 0:098463de4c5d 433 void USBHAL::EP0read(void) {
group-onsemi 0:098463de4c5d 434 // Not required
group-onsemi 0:098463de4c5d 435 }
group-onsemi 0:098463de4c5d 436
group-onsemi 0:098463de4c5d 437 void USBHAL::EP0readStage(void) {
group-onsemi 0:098463de4c5d 438 // Not required
group-onsemi 0:098463de4c5d 439 }
group-onsemi 0:098463de4c5d 440
group-onsemi 0:098463de4c5d 441 uint32_t USBHAL::EP0getReadResult(uint8_t *buffer) {
group-onsemi 0:098463de4c5d 442 return endpointReadcore(EP0OUT, buffer);
group-onsemi 0:098463de4c5d 443 }
group-onsemi 0:098463de4c5d 444
group-onsemi 0:098463de4c5d 445 void USBHAL::EP0write(uint8_t *buffer, uint32_t size) {
group-onsemi 0:098463de4c5d 446 endpointWritecore(EP0IN, buffer, size);
group-onsemi 0:098463de4c5d 447 }
group-onsemi 0:098463de4c5d 448
group-onsemi 0:098463de4c5d 449 void USBHAL::EP0getWriteResult(void) {
group-onsemi 0:098463de4c5d 450 // Not required
group-onsemi 0:098463de4c5d 451 }
group-onsemi 0:098463de4c5d 452
group-onsemi 0:098463de4c5d 453 void USBHAL::EP0stall(void) {
group-onsemi 0:098463de4c5d 454 // This will stall both control endpoints
group-onsemi 0:098463de4c5d 455 stallEndpoint(EP0OUT);
group-onsemi 0:098463de4c5d 456 }
group-onsemi 0:098463de4c5d 457
group-onsemi 0:098463de4c5d 458 EP_STATUS USBHAL::endpointRead(uint8_t endpoint, uint32_t maximumSize) {
group-onsemi 0:098463de4c5d 459 return EP_PENDING;
group-onsemi 0:098463de4c5d 460 }
group-onsemi 0:098463de4c5d 461
group-onsemi 0:098463de4c5d 462 EP_STATUS USBHAL::endpointReadResult(uint8_t endpoint, uint8_t * buffer, uint32_t *bytesRead) {
group-onsemi 0:098463de4c5d 463
group-onsemi 0:098463de4c5d 464 //for isochronous endpoint, we don't wait an interrupt
group-onsemi 0:098463de4c5d 465 if ((endpoint >> 1) % 3 || (endpoint >> 1) == 0) {
group-onsemi 0:098463de4c5d 466 if (!(epComplete & EP(endpoint)))
group-onsemi 0:098463de4c5d 467 return EP_PENDING;
group-onsemi 0:098463de4c5d 468 }
group-onsemi 0:098463de4c5d 469
group-onsemi 0:098463de4c5d 470 *bytesRead = endpointReadcore(endpoint, buffer);
group-onsemi 0:098463de4c5d 471 epComplete &= ~EP(endpoint);
group-onsemi 0:098463de4c5d 472 return EP_COMPLETED;
group-onsemi 0:098463de4c5d 473 }
group-onsemi 0:098463de4c5d 474
group-onsemi 0:098463de4c5d 475 EP_STATUS USBHAL::endpointWrite(uint8_t endpoint, uint8_t *data, uint32_t size) {
group-onsemi 0:098463de4c5d 476 if (getEndpointStallState(endpoint)) {
group-onsemi 0:098463de4c5d 477 return EP_STALLED;
group-onsemi 0:098463de4c5d 478 }
group-onsemi 0:098463de4c5d 479
group-onsemi 0:098463de4c5d 480 epComplete &= ~EP(endpoint);
group-onsemi 0:098463de4c5d 481
group-onsemi 0:098463de4c5d 482 endpointWritecore(endpoint, data, size);
group-onsemi 0:098463de4c5d 483 return EP_PENDING;
group-onsemi 0:098463de4c5d 484 }
group-onsemi 0:098463de4c5d 485
group-onsemi 0:098463de4c5d 486 EP_STATUS USBHAL::endpointWriteResult(uint8_t endpoint) {
group-onsemi 0:098463de4c5d 487 if (epComplete & EP(endpoint)) {
group-onsemi 0:098463de4c5d 488 epComplete &= ~EP(endpoint);
group-onsemi 0:098463de4c5d 489 return EP_COMPLETED;
group-onsemi 0:098463de4c5d 490 }
group-onsemi 0:098463de4c5d 491
group-onsemi 0:098463de4c5d 492 return EP_PENDING;
group-onsemi 0:098463de4c5d 493 }
group-onsemi 0:098463de4c5d 494
group-onsemi 0:098463de4c5d 495 bool USBHAL::realiseEndpoint(uint8_t endpoint, uint32_t maxPacket, uint32_t flags) {
group-onsemi 0:098463de4c5d 496 // Realise an endpoint
group-onsemi 0:098463de4c5d 497 LPC_USB->USBDevIntClr = EP_RLZED;
group-onsemi 0:098463de4c5d 498 LPC_USB->USBReEp |= EP(endpoint);
group-onsemi 0:098463de4c5d 499 LPC_USB->USBEpInd = endpoint;
group-onsemi 0:098463de4c5d 500 LPC_USB->USBMaxPSize = maxPacket;
group-onsemi 0:098463de4c5d 501
group-onsemi 0:098463de4c5d 502 while (!(LPC_USB->USBDevIntSt & EP_RLZED));
group-onsemi 0:098463de4c5d 503 LPC_USB->USBDevIntClr = EP_RLZED;
group-onsemi 0:098463de4c5d 504
group-onsemi 0:098463de4c5d 505 // Clear stall state
group-onsemi 0:098463de4c5d 506 endpointStallState &= ~EP(endpoint);
group-onsemi 0:098463de4c5d 507
group-onsemi 0:098463de4c5d 508 enableEndpointEvent(endpoint);
group-onsemi 0:098463de4c5d 509 return true;
group-onsemi 0:098463de4c5d 510 }
group-onsemi 0:098463de4c5d 511
group-onsemi 0:098463de4c5d 512 void USBHAL::stallEndpoint(uint8_t endpoint) {
group-onsemi 0:098463de4c5d 513 // Stall an endpoint
group-onsemi 0:098463de4c5d 514 if ( (endpoint==EP0IN) || (endpoint==EP0OUT) ) {
group-onsemi 0:098463de4c5d 515 // Conditionally stall both control endpoints
group-onsemi 0:098463de4c5d 516 SIEsetEndpointStatus(EP0OUT, SIE_SES_CND_ST);
group-onsemi 0:098463de4c5d 517 } else {
group-onsemi 0:098463de4c5d 518 SIEsetEndpointStatus(endpoint, SIE_SES_ST);
group-onsemi 0:098463de4c5d 519
group-onsemi 0:098463de4c5d 520 // Update stall state
group-onsemi 0:098463de4c5d 521 endpointStallState |= EP(endpoint);
group-onsemi 0:098463de4c5d 522 }
group-onsemi 0:098463de4c5d 523 }
group-onsemi 0:098463de4c5d 524
group-onsemi 0:098463de4c5d 525 void USBHAL::unstallEndpoint(uint8_t endpoint) {
group-onsemi 0:098463de4c5d 526 // Unstall an endpoint. The endpoint will also be reinitialised
group-onsemi 0:098463de4c5d 527 SIEsetEndpointStatus(endpoint, 0);
group-onsemi 0:098463de4c5d 528
group-onsemi 0:098463de4c5d 529 // Update stall state
group-onsemi 0:098463de4c5d 530 endpointStallState &= ~EP(endpoint);
group-onsemi 0:098463de4c5d 531 }
group-onsemi 0:098463de4c5d 532
group-onsemi 0:098463de4c5d 533 bool USBHAL::getEndpointStallState(uint8_t endpoint) {
group-onsemi 0:098463de4c5d 534 // Returns true if endpoint stalled
group-onsemi 0:098463de4c5d 535 return endpointStallState & EP(endpoint);
group-onsemi 0:098463de4c5d 536 }
group-onsemi 0:098463de4c5d 537
group-onsemi 0:098463de4c5d 538 void USBHAL::remoteWakeup(void) {
group-onsemi 0:098463de4c5d 539 // Remote wakeup
group-onsemi 0:098463de4c5d 540 uint8_t status;
group-onsemi 0:098463de4c5d 541
group-onsemi 0:098463de4c5d 542 // Enable USB clocks
group-onsemi 0:098463de4c5d 543 LPC_USB->USBClkCtrl |= DEV_CLK_EN | AHB_CLK_EN;
group-onsemi 0:098463de4c5d 544 while (LPC_USB->USBClkSt != (DEV_CLK_ON | AHB_CLK_ON));
group-onsemi 0:098463de4c5d 545
group-onsemi 0:098463de4c5d 546 status = SIEgetDeviceStatus();
group-onsemi 0:098463de4c5d 547 SIEsetDeviceStatus(status & ~SIE_DS_SUS);
group-onsemi 0:098463de4c5d 548 }
group-onsemi 0:098463de4c5d 549
group-onsemi 0:098463de4c5d 550 void USBHAL::_usbisr(void) {
group-onsemi 0:098463de4c5d 551 instance->usbisr();
group-onsemi 0:098463de4c5d 552 }
group-onsemi 0:098463de4c5d 553
group-onsemi 0:098463de4c5d 554
group-onsemi 0:098463de4c5d 555 void USBHAL::usbisr(void) {
group-onsemi 0:098463de4c5d 556 uint8_t devStat;
group-onsemi 0:098463de4c5d 557
group-onsemi 0:098463de4c5d 558 if (LPC_USB->USBDevIntSt & FRAME) {
group-onsemi 0:098463de4c5d 559 // Start of frame event
group-onsemi 0:098463de4c5d 560 SOF(SIEgetFrameNumber());
group-onsemi 0:098463de4c5d 561 // Clear interrupt status flag
group-onsemi 0:098463de4c5d 562 LPC_USB->USBDevIntClr = FRAME;
group-onsemi 0:098463de4c5d 563 }
group-onsemi 0:098463de4c5d 564
group-onsemi 0:098463de4c5d 565 if (LPC_USB->USBDevIntSt & DEV_STAT) {
group-onsemi 0:098463de4c5d 566 // Device Status interrupt
group-onsemi 0:098463de4c5d 567 // Must clear the interrupt status flag before reading the device status from the SIE
group-onsemi 0:098463de4c5d 568 LPC_USB->USBDevIntClr = DEV_STAT;
group-onsemi 0:098463de4c5d 569
group-onsemi 0:098463de4c5d 570 // Read device status from SIE
group-onsemi 0:098463de4c5d 571 devStat = SIEgetDeviceStatus();
group-onsemi 0:098463de4c5d 572 //printf("devStat: %d\r\n", devStat);
group-onsemi 0:098463de4c5d 573
group-onsemi 0:098463de4c5d 574 if (devStat & SIE_DS_SUS_CH) {
group-onsemi 0:098463de4c5d 575 // Suspend status changed
group-onsemi 0:098463de4c5d 576 if((devStat & SIE_DS_SUS) != 0) {
group-onsemi 0:098463de4c5d 577 suspendStateChanged(0);
group-onsemi 0:098463de4c5d 578 }
group-onsemi 0:098463de4c5d 579 }
group-onsemi 0:098463de4c5d 580
group-onsemi 0:098463de4c5d 581 if (devStat & SIE_DS_RST) {
group-onsemi 0:098463de4c5d 582 // Bus reset
group-onsemi 0:098463de4c5d 583 if((devStat & SIE_DS_SUS) == 0) {
group-onsemi 0:098463de4c5d 584 suspendStateChanged(1);
group-onsemi 0:098463de4c5d 585 }
group-onsemi 0:098463de4c5d 586 busReset();
group-onsemi 0:098463de4c5d 587 }
group-onsemi 0:098463de4c5d 588 }
group-onsemi 0:098463de4c5d 589
group-onsemi 0:098463de4c5d 590 if (LPC_USB->USBDevIntSt & EP_SLOW) {
group-onsemi 0:098463de4c5d 591 // (Slow) Endpoint Interrupt
group-onsemi 0:098463de4c5d 592
group-onsemi 0:098463de4c5d 593 // Process each endpoint interrupt
group-onsemi 0:098463de4c5d 594 if (LPC_USB->USBEpIntSt & EP(EP0OUT)) {
group-onsemi 0:098463de4c5d 595 if (selectEndpointClearInterrupt(EP0OUT) & SIE_SE_STP) {
group-onsemi 0:098463de4c5d 596 // this is a setup packet
group-onsemi 0:098463de4c5d 597 EP0setupCallback();
group-onsemi 0:098463de4c5d 598 } else {
group-onsemi 0:098463de4c5d 599 EP0out();
group-onsemi 0:098463de4c5d 600 }
group-onsemi 0:098463de4c5d 601 LPC_USB->USBDevIntClr = EP_SLOW;
group-onsemi 0:098463de4c5d 602 }
group-onsemi 0:098463de4c5d 603
group-onsemi 0:098463de4c5d 604 if (LPC_USB->USBEpIntSt & EP(EP0IN)) {
group-onsemi 0:098463de4c5d 605 selectEndpointClearInterrupt(EP0IN);
group-onsemi 0:098463de4c5d 606 LPC_USB->USBDevIntClr = EP_SLOW;
group-onsemi 0:098463de4c5d 607 EP0in();
group-onsemi 0:098463de4c5d 608 }
group-onsemi 0:098463de4c5d 609
group-onsemi 0:098463de4c5d 610 for (uint8_t num = 2; num < 16*2; num++) {
group-onsemi 0:098463de4c5d 611 if (LPC_USB->USBEpIntSt & EP(num)) {
group-onsemi 0:098463de4c5d 612 selectEndpointClearInterrupt(num);
group-onsemi 0:098463de4c5d 613 epComplete |= EP(num);
group-onsemi 0:098463de4c5d 614 LPC_USB->USBDevIntClr = EP_SLOW;
group-onsemi 0:098463de4c5d 615 if ((instance->*(epCallback[num - 2]))()) {
group-onsemi 0:098463de4c5d 616 epComplete &= ~EP(num);
group-onsemi 0:098463de4c5d 617 }
group-onsemi 0:098463de4c5d 618 }
group-onsemi 0:098463de4c5d 619 }
group-onsemi 0:098463de4c5d 620 }
group-onsemi 0:098463de4c5d 621 }
group-onsemi 0:098463de4c5d 622
group-onsemi 0:098463de4c5d 623 #endif