BA / SerialCom

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Fork of OmniWheels by Gustav Atmel

mbed-os/features/unsupported/USBHost/USBHostHub/USBHostHub.cpp@1:9c5af431a1f1, 2018-05-01 (annotated)

Committer:
gustavatmel
Date:
Tue May 01 15:47:08 2018 +0000
Revision:
1:9c5af431a1f1
sdf

Who changed what in which revision?

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