USB device stack, with KL25Z fixes for USB 3.0 hosts and sleep/resume interrupt handling

Dependents:   frdm_Slider_Keyboard idd_hw2_figlax_PanType idd_hw2_appachu_finger_chording idd_hw3_AngieWangAntonioDeLimaFernandesDanielLim_BladeSymphony ... more

Fork of USBDevice by mbed official

This is an overhauled version of the standard mbed USB device-side driver library, with bug fixes for KL25Z devices. It greatly improves reliability and stability of USB on the KL25Z, especially with devices using multiple endpoints concurrently.

I've had some nagging problems with the base mbed implementation for a long time, manifesting as occasional random disconnects that required rebooting the device. Recently (late 2015), I started implementing a USB device on the KL25Z that used multiple endpoints, and suddenly the nagging, occasional problems turned into frequent and predictable crashes. This forced me to delve into the USB stack and figure out what was really going on. Happily, the frequent crashes made it possible to track down and fix the problems. This new version is working very reliably in my testing - the random disconnects seem completely eradicated, even under very stressful conditions for the device.

Summary

  • Overall stability improvements
  • USB 3.0 host support
  • Stalled endpoint fixes
  • Sleep/resume notifications
  • Smaller memory footprint
  • General code cleanup

Update - 2/15/2016

My recent fixes introduced a new problem that made the initial connection fail most of the time on certain hosts. It's not clear if the common thread was a particular type of motherboard or USB chip set, or a specific version of Windows, or what, but several people ran into it. We tracked the problem down to the "stall" fixes in the earlier updates, which we now know weren't quite the right fixes after all. The latest update (2/15/2016) fixes this. It has new and improved "unstall" handling that so far works well with diverse hosts.

Race conditions and overall stability

The base mbed KL25Z implementation has a lot of problems with "race conditions" - timing problems that can happen when hardware interrupts occur at inopportune moments. The library shares a bunch of static variable data between interrupt handler context and regular application context. This isn't automatically a bad thing, but it does require careful coordination to make sure that the interrupt handler doesn't corrupt data that the other code was in the middle of updating when an interrupt occurs. The base mbed code, though, doesn't do any of the necessary coordination. This makes it kind of amazing that the base code worked at all for anyone, but I guess the interrupt rate is low enough in most applications that the glitch rate was below anyone's threshold to seriously investigate.

This overhaul adds the necessary coordination for the interrupt handlers to protect against these data corruptions. I think it's very solid now, and hopefully entirely free of the numerous race conditions in the old code. It's always hard to be certain that you've fixed every possible bug like this because they strike (effectively) at random, but I'm pretty confident: my test application was reliably able to trigger glitches in the base code in a matter of minutes, but the same application (with the overhauled library) now runs for days on end without dropping the connection.

Stalled endpoint fixes

USB has a standard way of handling communications errors called a "stall", which basically puts the connection into an error mode to let both sides know that they need to reset their internal states and sync up again. The original mbed version of the USB device library doesn't seem to have the necessary code to recover from this condition properly. The KL25Z hardware does some of the work, but it also seems to require the software to take some steps to "un-stall" the connection. (I keep saying "seems to" because the hardware reference material is very sketchy about all of this. Most of what I've figured out is from observing the device in action with a Windows host.) This new version adds code to do the necessary re-syncing and get the connection going again, automatically, and transparently to the user.

USB 3.0 Hosts

The original mbed code sometimes didn't work when connecting to hosts with USB 3.0 ports. This didn't affect every host, but it affected many of them. The common element seemed to be the Intel Haswell chip set on the host, but there may be other chip sets affected as well. In any case, the problem affected many PCs from the Windows 7 and 8 generation, as well as many Macs. It was possible to work around the problem by avoiding USB 3.0 ports - you could use a USB 2 port on the host, or plug a USB 2 hub between the host and device. But I wanted to just fix the problem and eliminate the need for such workarounds. This modified version of the library has such a fix, which so far has worked for everyone who's tried.

Sleep/resume notifications

This modified version also contains an innocuous change to the KL25Z USB HAL code to handle sleep and resume interrupts with calls to suspendStateChanged(). The original KL25Z code omitted these calls (and in fact didn't even enable the interrupts), but I think this was an unintentional oversight - the notifier function is part of the generic API, and other supported boards all implement it. I use this feature in my own application so that I can distinguish sleep mode from actual disconnects and handle the two conditions correctly.

Smaller memory footprint

The base mbed version of the code allocates twice as much memory for USB buffers as it really needed to. It looks like the original developers intended to implement the KL25Z USB hardware's built-in double-buffering mechanism, but they ultimately abandoned that effort. But they left in the double memory allocation. This version removes that and allocates only what's actually needed. The USB buffers aren't that big (128 bytes per endpoint), so this doesn't save a ton of memory, but even a little memory is pretty precious on this machine given that it only has 16K.

(I did look into adding the double-buffering support that the original developers abandoned, but after some experimentation I decided they were right to skip it. It just doesn't seem to mesh well with the design of the rest of the mbed USB code. I think it would take a major rewrite to make it work, and it doesn't seem worth the effort given that most applications don't need it - it would only benefit applications that are moving so much data through USB that they're pushing the limits of the CPU. And even for those, I think it would be a lot simpler to build a purely software-based buffer rotation mechanism.)

General code cleanup

The KL25Z HAL code in this version has greatly expanded commentary and a lot of general cleanup. Some of the hardware constants were given the wrong symbolic names (e.g., EVEN and ODD were reversed), and many were just missing (written as hard-coded numbers without explanation). I fixed the misnomers and added symbolic names for formerly anonymous numbers. Hopefully the next person who has to overhaul this code will at least have an easier time understanding what I thought I was doing!

Committer:
mjr
Date:
Fri Mar 17 22:01:47 2017 +0000
Revision:
54:2e181d51495a
Parent:
25:7c72828865f3
Comments

Who changed what in which revision?

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