Marco Mayer / Mbed OS Queue
Committer:
demayer
Date:
Sat Mar 28 15:28:19 2020 +0000
Revision:
0:6bf0743ece18
IMU Thread with an event-queue running parallel to handle tasks like a 5 times blinking LED. Button with interrupt detected.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
demayer 0:6bf0743ece18 1 /* mbed USBHost Library
demayer 0:6bf0743ece18 2 * Copyright (c) 2006-2013 ARM Limited
demayer 0:6bf0743ece18 3 *
demayer 0:6bf0743ece18 4 * Licensed under the Apache License, Version 2.0 (the "License");
demayer 0:6bf0743ece18 5 * you may not use this file except in compliance with the License.
demayer 0:6bf0743ece18 6 * You may obtain a copy of the License at
demayer 0:6bf0743ece18 7 *
demayer 0:6bf0743ece18 8 * http://www.apache.org/licenses/LICENSE-2.0
demayer 0:6bf0743ece18 9 *
demayer 0:6bf0743ece18 10 * Unless required by applicable law or agreed to in writing, software
demayer 0:6bf0743ece18 11 * distributed under the License is distributed on an "AS IS" BASIS,
demayer 0:6bf0743ece18 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
demayer 0:6bf0743ece18 13 * See the License for the specific language governing permissions and
demayer 0:6bf0743ece18 14 * limitations under the License.
demayer 0:6bf0743ece18 15 */
demayer 0:6bf0743ece18 16
demayer 0:6bf0743ece18 17 #include "USBHostHub.h"
demayer 0:6bf0743ece18 18
demayer 0:6bf0743ece18 19 #if MAX_HUB_NB
demayer 0:6bf0743ece18 20
demayer 0:6bf0743ece18 21 #include "USBHost.h"
demayer 0:6bf0743ece18 22 #include "dbg.h"
demayer 0:6bf0743ece18 23
demayer 0:6bf0743ece18 24 #define GET_STATUS 0x00
demayer 0:6bf0743ece18 25 #define CLEAR_FEATURE 0x01
demayer 0:6bf0743ece18 26 #define GET_STATE 0x02
demayer 0:6bf0743ece18 27 #define SET_FEATURE 0x03
demayer 0:6bf0743ece18 28 #define GET_DESCRIPTOR 0x06
demayer 0:6bf0743ece18 29
demayer 0:6bf0743ece18 30 #define PORT_CONNECTION_FEATURE (0x00)
demayer 0:6bf0743ece18 31 #define PORT_ENABLE_FEATURE (0x01)
demayer 0:6bf0743ece18 32 #define PORT_RESET_FEATURE (0x04)
demayer 0:6bf0743ece18 33 #define PORT_POWER_FEATURE (0x08)
demayer 0:6bf0743ece18 34
demayer 0:6bf0743ece18 35 #define C_PORT_CONNECTION_FEATURE (16)
demayer 0:6bf0743ece18 36 #define C_PORT_ENABLE_FEATURE (17)
demayer 0:6bf0743ece18 37 #define C_PORT_RESET_FEATURE (20)
demayer 0:6bf0743ece18 38
demayer 0:6bf0743ece18 39 #define PORT_CONNECTION (1 << 0)
demayer 0:6bf0743ece18 40 #define PORT_ENABLE (1 << 1)
demayer 0:6bf0743ece18 41 #define PORT_SUSPEND (1 << 2)
demayer 0:6bf0743ece18 42 #define PORT_OVER_CURRENT (1 << 3)
demayer 0:6bf0743ece18 43 #define PORT_RESET (1 << 4)
demayer 0:6bf0743ece18 44 #define PORT_POWER (1 << 8)
demayer 0:6bf0743ece18 45 #define PORT_LOW_SPEED (1 << 9)
demayer 0:6bf0743ece18 46
demayer 0:6bf0743ece18 47 #define C_PORT_CONNECTION (1 << 16)
demayer 0:6bf0743ece18 48 #define C_PORT_ENABLE (1 << 17)
demayer 0:6bf0743ece18 49 #define C_PORT_SUSPEND (1 << 18)
demayer 0:6bf0743ece18 50 #define C_PORT_OVER_CURRENT (1 << 19)
demayer 0:6bf0743ece18 51 #define C_PORT_RESET (1 << 20)
demayer 0:6bf0743ece18 52
demayer 0:6bf0743ece18 53 USBHostHub::USBHostHub()
demayer 0:6bf0743ece18 54 {
demayer 0:6bf0743ece18 55 host = NULL;
demayer 0:6bf0743ece18 56 init();
demayer 0:6bf0743ece18 57 }
demayer 0:6bf0743ece18 58
demayer 0:6bf0743ece18 59 void USBHostHub::init()
demayer 0:6bf0743ece18 60 {
demayer 0:6bf0743ece18 61 dev_connected = false;
demayer 0:6bf0743ece18 62 dev = NULL;
demayer 0:6bf0743ece18 63 int_in = NULL;
demayer 0:6bf0743ece18 64 dev_connected = false;
demayer 0:6bf0743ece18 65 hub_intf = -1;
demayer 0:6bf0743ece18 66 hub_device_found = false;
demayer 0:6bf0743ece18 67 nb_port = 0;
demayer 0:6bf0743ece18 68 hub_characteristics = 0;
demayer 0:6bf0743ece18 69
demayer 0:6bf0743ece18 70 for (int i = 0; i < MAX_HUB_PORT; i++) {
demayer 0:6bf0743ece18 71 device_children[i] = NULL;
demayer 0:6bf0743ece18 72 }
demayer 0:6bf0743ece18 73 }
demayer 0:6bf0743ece18 74
demayer 0:6bf0743ece18 75 void USBHostHub::setHost(USBHost * host_)
demayer 0:6bf0743ece18 76 {
demayer 0:6bf0743ece18 77 host = host_;
demayer 0:6bf0743ece18 78 }
demayer 0:6bf0743ece18 79
demayer 0:6bf0743ece18 80 bool USBHostHub::connected()
demayer 0:6bf0743ece18 81 {
demayer 0:6bf0743ece18 82 return dev_connected;
demayer 0:6bf0743ece18 83 }
demayer 0:6bf0743ece18 84
demayer 0:6bf0743ece18 85 bool USBHostHub::connect(USBDeviceConnected * dev)
demayer 0:6bf0743ece18 86 {
demayer 0:6bf0743ece18 87 if (dev_connected) {
demayer 0:6bf0743ece18 88 return true;
demayer 0:6bf0743ece18 89 }
demayer 0:6bf0743ece18 90
demayer 0:6bf0743ece18 91 if(host->enumerate(dev, this)) {
demayer 0:6bf0743ece18 92 init();
demayer 0:6bf0743ece18 93 return false;
demayer 0:6bf0743ece18 94 }
demayer 0:6bf0743ece18 95
demayer 0:6bf0743ece18 96 if (hub_device_found) {
demayer 0:6bf0743ece18 97 this->dev = dev;
demayer 0:6bf0743ece18 98
demayer 0:6bf0743ece18 99 int_in = dev->getEndpoint(hub_intf, INTERRUPT_ENDPOINT, IN);
demayer 0:6bf0743ece18 100
demayer 0:6bf0743ece18 101 if (!int_in) {
demayer 0:6bf0743ece18 102 init();
demayer 0:6bf0743ece18 103 return false;
demayer 0:6bf0743ece18 104 }
demayer 0:6bf0743ece18 105
demayer 0:6bf0743ece18 106 USB_INFO("New HUB: VID:%04x PID:%04x [dev: %p - intf: %d]", dev->getVid(), dev->getPid(), dev, hub_intf);
demayer 0:6bf0743ece18 107 dev->setName("Hub", hub_intf);
demayer 0:6bf0743ece18 108 host->registerDriver(dev, hub_intf, this, &USBHostHub::disconnect);
demayer 0:6bf0743ece18 109
demayer 0:6bf0743ece18 110 int_in->attach(this, &USBHostHub::rxHandler);
demayer 0:6bf0743ece18 111
demayer 0:6bf0743ece18 112 // get HUB descriptor
demayer 0:6bf0743ece18 113 host->controlRead( dev,
demayer 0:6bf0743ece18 114 USB_DEVICE_TO_HOST | USB_REQUEST_TYPE_CLASS,
demayer 0:6bf0743ece18 115 GET_DESCRIPTOR,
demayer 0:6bf0743ece18 116 0x29 << 8, 0, buf, sizeof(HubDescriptor));
demayer 0:6bf0743ece18 117 nb_port = buf[2];
demayer 0:6bf0743ece18 118 hub_characteristics = buf[3];
demayer 0:6bf0743ece18 119
demayer 0:6bf0743ece18 120 USB_DBG("Hub has %d port", nb_port);
demayer 0:6bf0743ece18 121
demayer 0:6bf0743ece18 122 for (uint8_t j = 1; j <= nb_port; j++) {
demayer 0:6bf0743ece18 123 setPortFeature(PORT_POWER_FEATURE, j);
demayer 0:6bf0743ece18 124 }
demayer 0:6bf0743ece18 125 wait_ms(buf[5]*2);
demayer 0:6bf0743ece18 126
demayer 0:6bf0743ece18 127 host->interruptRead(dev, int_in, buf, 1, false);
demayer 0:6bf0743ece18 128 dev_connected = true;
demayer 0:6bf0743ece18 129 return true;
demayer 0:6bf0743ece18 130 }
demayer 0:6bf0743ece18 131
demayer 0:6bf0743ece18 132 return false;
demayer 0:6bf0743ece18 133 }
demayer 0:6bf0743ece18 134
demayer 0:6bf0743ece18 135 void USBHostHub::disconnect()
demayer 0:6bf0743ece18 136 {
demayer 0:6bf0743ece18 137 init();
demayer 0:6bf0743ece18 138 }
demayer 0:6bf0743ece18 139
demayer 0:6bf0743ece18 140 /*virtual*/ void USBHostHub::setVidPid(uint16_t vid, uint16_t pid)
demayer 0:6bf0743ece18 141 {
demayer 0:6bf0743ece18 142 // we don't check VID/PID for MSD driver
demayer 0:6bf0743ece18 143 }
demayer 0:6bf0743ece18 144
demayer 0:6bf0743ece18 145 /*virtual*/ bool USBHostHub::parseInterface(uint8_t intf_nb, uint8_t intf_class, uint8_t intf_subclass, uint8_t intf_protocol) //Must return true if the interface should be parsed
demayer 0:6bf0743ece18 146 {
demayer 0:6bf0743ece18 147 if ((hub_intf == -1) &&
demayer 0:6bf0743ece18 148 (intf_class == HUB_CLASS) &&
demayer 0:6bf0743ece18 149 (intf_subclass == 0) &&
demayer 0:6bf0743ece18 150 (intf_protocol == 0)) {
demayer 0:6bf0743ece18 151 hub_intf = intf_nb;
demayer 0:6bf0743ece18 152 return true;
demayer 0:6bf0743ece18 153 }
demayer 0:6bf0743ece18 154 return false;
demayer 0:6bf0743ece18 155 }
demayer 0:6bf0743ece18 156
demayer 0:6bf0743ece18 157 /*virtual*/ bool USBHostHub::useEndpoint(uint8_t intf_nb, ENDPOINT_TYPE type, ENDPOINT_DIRECTION dir) //Must return true if the endpoint will be used
demayer 0:6bf0743ece18 158 {
demayer 0:6bf0743ece18 159 if (intf_nb == hub_intf) {
demayer 0:6bf0743ece18 160 if ((type == INTERRUPT_ENDPOINT) && (dir == IN)) {
demayer 0:6bf0743ece18 161 hub_device_found = true;
demayer 0:6bf0743ece18 162 return true;
demayer 0:6bf0743ece18 163 }
demayer 0:6bf0743ece18 164 }
demayer 0:6bf0743ece18 165 return false;
demayer 0:6bf0743ece18 166 }
demayer 0:6bf0743ece18 167
demayer 0:6bf0743ece18 168 void USBHostHub::deviceConnected(USBDeviceConnected * dev)
demayer 0:6bf0743ece18 169 {
demayer 0:6bf0743ece18 170 device_children[dev->getPort() - 1] = dev;
demayer 0:6bf0743ece18 171 }
demayer 0:6bf0743ece18 172
demayer 0:6bf0743ece18 173 void USBHostHub::deviceDisconnected(USBDeviceConnected * dev)
demayer 0:6bf0743ece18 174 {
demayer 0:6bf0743ece18 175 device_children[dev->getPort() - 1] = NULL;
demayer 0:6bf0743ece18 176 }
demayer 0:6bf0743ece18 177
demayer 0:6bf0743ece18 178 void USBHostHub::hubDisconnected()
demayer 0:6bf0743ece18 179 {
demayer 0:6bf0743ece18 180 for (uint8_t i = 0; i < MAX_HUB_PORT; i++) {
demayer 0:6bf0743ece18 181 if (device_children[i] != NULL) {
demayer 0:6bf0743ece18 182 host->freeDevice(device_children[i]);
demayer 0:6bf0743ece18 183 }
demayer 0:6bf0743ece18 184 }
demayer 0:6bf0743ece18 185 }
demayer 0:6bf0743ece18 186
demayer 0:6bf0743ece18 187 void USBHostHub::rxHandler()
demayer 0:6bf0743ece18 188 {
demayer 0:6bf0743ece18 189 uint32_t status;
demayer 0:6bf0743ece18 190 if (int_in) {
demayer 0:6bf0743ece18 191 if ((int_in->getLengthTransferred())&&(int_in->getState() == USB_TYPE_IDLE)) {
demayer 0:6bf0743ece18 192 for (int port = 1; port <= nb_port; port++) {
demayer 0:6bf0743ece18 193 status = getPortStatus(port);
demayer 0:6bf0743ece18 194 USB_DBG("[hub handler hub: %d] status port %d [hub: %p]: 0x%X", dev->getHub(), port, dev, status);
demayer 0:6bf0743ece18 195
demayer 0:6bf0743ece18 196 // if connection status has changed
demayer 0:6bf0743ece18 197 if (status & C_PORT_CONNECTION) {
demayer 0:6bf0743ece18 198 if (status & PORT_CONNECTION) {
demayer 0:6bf0743ece18 199 USB_DBG("[hub handler hub: %d - port: %d] new device connected", dev->getHub(), port);
demayer 0:6bf0743ece18 200 host->deviceConnected(dev->getHub() + 1, port, status & PORT_LOW_SPEED, this);
demayer 0:6bf0743ece18 201 } else {
demayer 0:6bf0743ece18 202 USB_DBG("[hub handler hub: %d - port: %d] device disconnected", dev->getHub(), port);
demayer 0:6bf0743ece18 203 host->deviceDisconnected(dev->getHub() + 1, port, this, 0);
demayer 0:6bf0743ece18 204 }
demayer 0:6bf0743ece18 205
demayer 0:6bf0743ece18 206 clearPortFeature(C_PORT_CONNECTION_FEATURE, port);
demayer 0:6bf0743ece18 207 }
demayer 0:6bf0743ece18 208
demayer 0:6bf0743ece18 209 if (status & C_PORT_RESET) {
demayer 0:6bf0743ece18 210 clearPortFeature(C_PORT_RESET_FEATURE, port);
demayer 0:6bf0743ece18 211 }
demayer 0:6bf0743ece18 212
demayer 0:6bf0743ece18 213 if (status & C_PORT_ENABLE) {
demayer 0:6bf0743ece18 214 clearPortFeature(C_PORT_ENABLE_FEATURE, port);
demayer 0:6bf0743ece18 215 }
demayer 0:6bf0743ece18 216
demayer 0:6bf0743ece18 217 if ((status & PORT_OVER_CURRENT)) {
demayer 0:6bf0743ece18 218 USB_ERR("OVER CURRENT DETECTED\r\n");
demayer 0:6bf0743ece18 219 clearPortFeature(PORT_OVER_CURRENT, port);
demayer 0:6bf0743ece18 220 host->deviceDisconnected(dev->getHub() + 1, port, this, 0);
demayer 0:6bf0743ece18 221 }
demayer 0:6bf0743ece18 222 }
demayer 0:6bf0743ece18 223 }
demayer 0:6bf0743ece18 224 host->interruptRead(dev, int_in, buf, 1, false);
demayer 0:6bf0743ece18 225 }
demayer 0:6bf0743ece18 226 }
demayer 0:6bf0743ece18 227
demayer 0:6bf0743ece18 228 void USBHostHub::portReset(uint8_t port)
demayer 0:6bf0743ece18 229 {
demayer 0:6bf0743ece18 230 // reset port
demayer 0:6bf0743ece18 231 uint32_t status;
demayer 0:6bf0743ece18 232 USB_DBG("reset port %d on hub: %p [this: %p]", port, dev, this)
demayer 0:6bf0743ece18 233 setPortFeature(PORT_RESET_FEATURE, port);
demayer 0:6bf0743ece18 234 #if defined(TARGET_RZ_A1H)
demayer 0:6bf0743ece18 235 Thread::wait(50); // Reset release waiting for Hi-Speed check.
demayer 0:6bf0743ece18 236 #endif
demayer 0:6bf0743ece18 237 while(1) {
demayer 0:6bf0743ece18 238 status = getPortStatus(port);
demayer 0:6bf0743ece18 239 /* disconnection since reset request */
demayer 0:6bf0743ece18 240 if (!(status & PORT_CONNECTION)) {
demayer 0:6bf0743ece18 241 break;
demayer 0:6bf0743ece18 242 }
demayer 0:6bf0743ece18 243 if (status & (PORT_ENABLE | PORT_RESET)) {
demayer 0:6bf0743ece18 244 break;
demayer 0:6bf0743ece18 245 }
demayer 0:6bf0743ece18 246 if (status & PORT_OVER_CURRENT) {
demayer 0:6bf0743ece18 247 USB_ERR("OVER CURRENT DETECTED\r\n");
demayer 0:6bf0743ece18 248 clearPortFeature(PORT_OVER_CURRENT, port);
demayer 0:6bf0743ece18 249 host->deviceDisconnected(dev->getHub() + 1, port, this, 0);
demayer 0:6bf0743ece18 250 break;
demayer 0:6bf0743ece18 251 }
demayer 0:6bf0743ece18 252 Thread::wait(10);
demayer 0:6bf0743ece18 253 }
demayer 0:6bf0743ece18 254 }
demayer 0:6bf0743ece18 255
demayer 0:6bf0743ece18 256 void USBHostHub::setPortFeature(uint32_t feature, uint8_t port)
demayer 0:6bf0743ece18 257 {
demayer 0:6bf0743ece18 258 host->controlWrite( dev,
demayer 0:6bf0743ece18 259 USB_HOST_TO_DEVICE | USB_REQUEST_TYPE_CLASS | USB_RECIPIENT_INTERFACE | USB_RECIPIENT_ENDPOINT,
demayer 0:6bf0743ece18 260 SET_FEATURE,
demayer 0:6bf0743ece18 261 feature,
demayer 0:6bf0743ece18 262 port,
demayer 0:6bf0743ece18 263 NULL,
demayer 0:6bf0743ece18 264 0);
demayer 0:6bf0743ece18 265 }
demayer 0:6bf0743ece18 266
demayer 0:6bf0743ece18 267 void USBHostHub::clearPortFeature(uint32_t feature, uint8_t port)
demayer 0:6bf0743ece18 268 {
demayer 0:6bf0743ece18 269 host->controlWrite( dev,
demayer 0:6bf0743ece18 270 USB_HOST_TO_DEVICE | USB_REQUEST_TYPE_CLASS | USB_RECIPIENT_INTERFACE | USB_RECIPIENT_ENDPOINT,
demayer 0:6bf0743ece18 271 CLEAR_FEATURE,
demayer 0:6bf0743ece18 272 feature,
demayer 0:6bf0743ece18 273 port,
demayer 0:6bf0743ece18 274 NULL,
demayer 0:6bf0743ece18 275 0);
demayer 0:6bf0743ece18 276 }
demayer 0:6bf0743ece18 277
demayer 0:6bf0743ece18 278 uint32_t USBHostHub::getPortStatus(uint8_t port)
demayer 0:6bf0743ece18 279 {
demayer 0:6bf0743ece18 280 uint32_t st;
demayer 0:6bf0743ece18 281 host->controlRead( dev,
demayer 0:6bf0743ece18 282 USB_DEVICE_TO_HOST | USB_REQUEST_TYPE_CLASS | USB_RECIPIENT_INTERFACE | USB_RECIPIENT_ENDPOINT,
demayer 0:6bf0743ece18 283 GET_STATUS,
demayer 0:6bf0743ece18 284 0,
demayer 0:6bf0743ece18 285 port,
demayer 0:6bf0743ece18 286 (uint8_t *)&st,
demayer 0:6bf0743ece18 287 4);
demayer 0:6bf0743ece18 288 return st;
demayer 0:6bf0743ece18 289 }
demayer 0:6bf0743ece18 290
demayer 0:6bf0743ece18 291 #endif