status_t Hub::_DebouncePort(uint8 index) { uint32 timeout = 0; uint32 stableTime = 0; while (timeout < USB_DEBOUNCE_TIMEOUT) { snooze(USB_DEBOUNCE_CHECK_INTERVAL); timeout += USB_DEBOUNCE_CHECK_INTERVAL; status_t result = UpdatePortStatus(index); if (result != B_OK) return result; if ((fPortStatus[index].change & PORT_STATUS_CONNECTION) == 0) { stableTime += USB_DEBOUNCE_CHECK_INTERVAL; if (stableTime >= USB_DEBOUNCE_STABLE_TIME) return B_OK; continue; } // clear the connection change and reset stable time result = DefaultPipe()->SendRequest(USB_REQTYPE_CLASS | USB_REQTYPE_OTHER_OUT, USB_REQUEST_CLEAR_FEATURE, C_PORT_CONNECTION, index + 1, 0, NULL, 0, NULL); if (result != B_OK) return result; TRACE("got connection change during debounce, resetting stable time\n"); stableTime = 0; } return B_TIMED_OUT; }
status_t Hub::ResetPort(uint8 index) { status_t result = DefaultPipe()->SendRequest(USB_REQTYPE_CLASS | USB_REQTYPE_OTHER_OUT, USB_REQUEST_SET_FEATURE, PORT_RESET, index + 1, 0, NULL, 0, NULL); if (result < B_OK) return result; for (int32 i = 0; i < 10; i++) { snooze(USB_DELAY_PORT_RESET); result = UpdatePortStatus(index); if (result < B_OK) return result; if ((fPortStatus[index].change & PORT_STATUS_RESET) != 0 || (fPortStatus[index].status & PORT_STATUS_RESET) == 0) { // reset is done break; } } if ((fPortStatus[index].change & PORT_STATUS_RESET) == 0 && (fPortStatus[index].status & PORT_STATUS_RESET) != 0) { TRACE_ERROR("port %d won't reset (%#x, %#x)\n", index, fPortStatus[index].change, fPortStatus[index].status); return B_ERROR; } // clear the reset change result = DefaultPipe()->SendRequest(USB_REQTYPE_CLASS | USB_REQTYPE_OTHER_OUT, USB_REQUEST_CLEAR_FEATURE, C_PORT_RESET, index + 1, 0, NULL, 0, NULL); if (result < B_OK) return result; // wait for reset recovery snooze(USB_DELAY_PORT_RESET_RECOVERY); TRACE("port %d was reset successfully\n", index); return B_OK; }
void Hub::Explore(change_item **changeList) { for (int32 i = 0; i < fHubDescriptor.num_ports; i++) { status_t result = UpdatePortStatus(i); if (result < B_OK) continue; #ifdef TRACE_USB if (fPortStatus[i].change) { TRACE("port %" B_PRId32 ": status: 0x%04x; change: 0x%04x\n", i, fPortStatus[i].status, fPortStatus[i].change); TRACE("device at port %" B_PRId32 ": %p (%" B_PRId32 ")\n", i, fChildren[i], fChildren[i] != NULL ? fChildren[i]->USBID() : 0); } #endif if (fPortStatus[i].change & PORT_STATUS_CONNECTION) { // clear status change DefaultPipe()->SendRequest(USB_REQTYPE_CLASS | USB_REQTYPE_OTHER_OUT, USB_REQUEST_CLEAR_FEATURE, C_PORT_CONNECTION, i + 1, 0, NULL, 0, NULL); if (fPortStatus[i].status & PORT_STATUS_CONNECTION) { // new device attached! TRACE_ALWAYS("port %" B_PRId32 ": new device connected\n", i); int32 retry = 2; while (retry--) { // wait for stable device power result = _DebouncePort(i); if (result != B_OK) { TRACE_ERROR("debouncing port %" B_PRId32 " failed: %s\n", i, strerror(result)); break; } // reset the port, this will also enable it result = ResetPort(i); if (result < B_OK) { TRACE_ERROR("resetting port %" B_PRId32 " failed\n", i); break; } result = UpdatePortStatus(i); if (result < B_OK) break; if ((fPortStatus[i].status & PORT_STATUS_CONNECTION) == 0) { // device has vanished after reset, ignore TRACE("device disappeared on reset\n"); break; } if (fChildren[i] != NULL) { TRACE_ERROR("new device on a port that is already in " "use\n"); fChildren[i]->Changed(changeList, false); fChildren[i] = NULL; } usb_speed speed = USB_SPEED_FULLSPEED; if (fDeviceDescriptor.usb_version == 0x300) speed = USB_SPEED_SUPER; else if (fPortStatus[i].status & PORT_STATUS_LOW_SPEED) speed = USB_SPEED_LOWSPEED; else if (fPortStatus[i].status & PORT_STATUS_HIGH_SPEED) speed = USB_SPEED_HIGHSPEED; // either let the device inherit our addresses (if we are // already potentially using a transaction translator) or // set ourselfs as the hub when we might become the // transaction translator for the device. int8 hubAddress = HubAddress(); uint8 hubPort = HubPort(); if (Speed() == USB_SPEED_HIGHSPEED || fDeviceDescriptor.usb_version == 0x300) { hubAddress = DeviceAddress(); hubPort = i + 1; } Device *newDevice = GetBusManager()->AllocateDevice(this, hubAddress, hubPort, speed); if (newDevice) { newDevice->Changed(changeList, true); fChildren[i] = newDevice; break; } else { // the device failed to setup correctly, disable the // port so that the device doesn't get in the way of // future addressing. DisablePort(i); } } } else { // Device removed... TRACE_ALWAYS("port %" B_PRId32 ": device removed\n", i); if (fChildren[i] != NULL) { TRACE("removing device %p\n", fChildren[i]); fChildren[i]->Changed(changeList, false); fChildren[i] = NULL; } } } // other port changes we do not really handle, report and clear them if (fPortStatus[i].change & PORT_STATUS_ENABLE) { TRACE_ALWAYS("port %" B_PRId32 " %sabled\n", i, (fPortStatus[i].status & PORT_STATUS_ENABLE) ? "en" : "dis"); DefaultPipe()->SendRequest(USB_REQTYPE_CLASS | USB_REQTYPE_OTHER_OUT, USB_REQUEST_CLEAR_FEATURE, C_PORT_ENABLE, i + 1, 0, NULL, 0, NULL); } if (fPortStatus[i].change & PORT_STATUS_SUSPEND) { TRACE_ALWAYS("port %" B_PRId32 " is %ssuspended\n", i, (fPortStatus[i].status & PORT_STATUS_SUSPEND) ? "" : "not "); DefaultPipe()->SendRequest(USB_REQTYPE_CLASS | USB_REQTYPE_OTHER_OUT, USB_REQUEST_CLEAR_FEATURE, C_PORT_SUSPEND, i + 1, 0, NULL, 0, NULL); } if (fPortStatus[i].change & PORT_STATUS_OVER_CURRENT) { TRACE_ALWAYS("port %" B_PRId32 " is %sin an over current state\n", i, (fPortStatus[i].status & PORT_STATUS_OVER_CURRENT) ? "" : "not "); DefaultPipe()->SendRequest(USB_REQTYPE_CLASS | USB_REQTYPE_OTHER_OUT, USB_REQUEST_CLEAR_FEATURE, C_PORT_OVER_CURRENT, i + 1, 0, NULL, 0, NULL); } if (fPortStatus[i].change & PORT_STATUS_RESET) { TRACE_ALWAYS("port %" B_PRId32 "was reset\n", i); DefaultPipe()->SendRequest(USB_REQTYPE_CLASS | USB_REQTYPE_OTHER_OUT, USB_REQUEST_CLEAR_FEATURE, C_PORT_RESET, i + 1, 0, NULL, 0, NULL); } } // explore down the tree if we have hubs connected for (int32 i = 0; i < fHubDescriptor.num_ports; i++) { if (!fChildren[i] || (fChildren[i]->Type() & USB_OBJECT_HUB) == 0) continue; ((Hub *)fChildren[i])->Explore(changeList); } }