J&W / Mbed 2 deprecated Rejestrator

Dependencies:   mbed Rejestrator

Dependents:   Rejestrator

Committer:
Waldek
Date:
Sat Apr 18 17:01:57 2015 +0000
Revision:
0:fa31f8461c63
working version, stop

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Waldek 0:fa31f8461c63 1 #include "USBHost.h"
Waldek 0:fa31f8461c63 2
Waldek 0:fa31f8461c63 3 #define PORT_CONNECTION 0
Waldek 0:fa31f8461c63 4 #define PORT_ENABLE 1
Waldek 0:fa31f8461c63 5 #define PORT_SUSPEND 2
Waldek 0:fa31f8461c63 6 #define PORT_OVER_CURRENT 3
Waldek 0:fa31f8461c63 7 #define PORT_RESET 4
Waldek 0:fa31f8461c63 8 #define PORT_POWER 8
Waldek 0:fa31f8461c63 9 #define PORT_LOW_SPEED 9
Waldek 0:fa31f8461c63 10
Waldek 0:fa31f8461c63 11 #define C_PORT_CONNECTION 16
Waldek 0:fa31f8461c63 12 #define C_PORT_ENABLE 17
Waldek 0:fa31f8461c63 13 #define C_PORT_SUSPEND 18
Waldek 0:fa31f8461c63 14 #define C_PORT_OVER_CURRENT 19
Waldek 0:fa31f8461c63 15 #define C_PORT_RESET 20
Waldek 0:fa31f8461c63 16
Waldek 0:fa31f8461c63 17 bool USBHost::Hub(USBDeviceConnected* dev) {
Waldek 0:fa31f8461c63 18 USB_INFO("New HUB: VID:%04x PID:%04x [dev: %p]", dev->getVid(), dev->getPid(), dev);
Waldek 0:fa31f8461c63 19 HubDescriptor hubdesc;
Waldek 0:fa31f8461c63 20 // get HUB descriptor
Waldek 0:fa31f8461c63 21 int rc = controlRead(dev,
Waldek 0:fa31f8461c63 22 USB_DEVICE_TO_HOST | USB_REQUEST_TYPE_CLASS,
Waldek 0:fa31f8461c63 23 GET_DESCRIPTOR,
Waldek 0:fa31f8461c63 24 0x29 << 8, 0, reinterpret_cast<uint8_t*>(&hubdesc),
Waldek 0:fa31f8461c63 25 sizeof(HubDescriptor));
Waldek 0:fa31f8461c63 26 USB_TEST_ASSERT(rc == USB_TYPE_OK);
Waldek 0:fa31f8461c63 27 if (rc != USB_TYPE_OK) {
Waldek 0:fa31f8461c63 28 return false;
Waldek 0:fa31f8461c63 29 }
Waldek 0:fa31f8461c63 30 USB_DBG_HEX((uint8_t*)&hubdesc, sizeof(hubdesc));
Waldek 0:fa31f8461c63 31
Waldek 0:fa31f8461c63 32 uint32_t status;
Waldek 0:fa31f8461c63 33 rc = controlRead( dev,
Waldek 0:fa31f8461c63 34 0xa0, 0, 0, 0, reinterpret_cast<uint8_t*>(&status), 4);
Waldek 0:fa31f8461c63 35 USB_TEST_ASSERT(rc == USB_TYPE_OK);
Waldek 0:fa31f8461c63 36 if (rc != USB_TYPE_OK) {
Waldek 0:fa31f8461c63 37 return false;
Waldek 0:fa31f8461c63 38 }
Waldek 0:fa31f8461c63 39 USB_DBG("HUB STATUS: %08X\n", status);
Waldek 0:fa31f8461c63 40
Waldek 0:fa31f8461c63 41 for(int i = 1; i <= hubdesc.bNbrPorts; i++) {
Waldek 0:fa31f8461c63 42 SetPortPower(dev, i); // power on
Waldek 0:fa31f8461c63 43 wait_ms(hubdesc.bPwrOn2PwrGood*2);
Waldek 0:fa31f8461c63 44 uint32_t status;
Waldek 0:fa31f8461c63 45 GetPortStatus(dev, i, &status);
Waldek 0:fa31f8461c63 46 USB_DBG("port: %d status: %08X\n", i, status);
Waldek 0:fa31f8461c63 47 if (status & 0x010000) { // Connect Status Change, has changed
Waldek 0:fa31f8461c63 48 USB_TEST_ASSERT(status & 0x000001);
Waldek 0:fa31f8461c63 49 ClearPortFeature(dev, C_PORT_CONNECTION, i);
Waldek 0:fa31f8461c63 50 int lowSpeed = 0;
Waldek 0:fa31f8461c63 51 if (status & 0x0200) {
Waldek 0:fa31f8461c63 52 lowSpeed = 1;
Waldek 0:fa31f8461c63 53 }
Waldek 0:fa31f8461c63 54 PortReset(dev, i);
Waldek 0:fa31f8461c63 55 if (!addDevice(dev, i, lowSpeed)) {
Waldek 0:fa31f8461c63 56 ClearPortPower(dev, i); // power off
Waldek 0:fa31f8461c63 57 }
Waldek 0:fa31f8461c63 58 } else {
Waldek 0:fa31f8461c63 59 ClearPortPower(dev, i); // power off
Waldek 0:fa31f8461c63 60 }
Waldek 0:fa31f8461c63 61 }
Waldek 0:fa31f8461c63 62 return false;
Waldek 0:fa31f8461c63 63 }
Waldek 0:fa31f8461c63 64
Waldek 0:fa31f8461c63 65
Waldek 0:fa31f8461c63 66 int USBHost::SetPortPower(USBDeviceConnected* dev, int port)
Waldek 0:fa31f8461c63 67 {
Waldek 0:fa31f8461c63 68 return SetPortFeature(dev, PORT_POWER, port);
Waldek 0:fa31f8461c63 69 }
Waldek 0:fa31f8461c63 70
Waldek 0:fa31f8461c63 71 int USBHost::ClearPortPower(USBDeviceConnected* dev, int port)
Waldek 0:fa31f8461c63 72 {
Waldek 0:fa31f8461c63 73 return ClearPortFeature(dev, PORT_POWER, port);
Waldek 0:fa31f8461c63 74 }
Waldek 0:fa31f8461c63 75
Waldek 0:fa31f8461c63 76 int USBHost::SetPortFeature(USBDeviceConnected* dev, int feature, int index)
Waldek 0:fa31f8461c63 77 {
Waldek 0:fa31f8461c63 78 return controlWrite(dev, 0x23, SET_FEATURE,feature,index,0,0);
Waldek 0:fa31f8461c63 79 }
Waldek 0:fa31f8461c63 80
Waldek 0:fa31f8461c63 81 int USBHost::ClearPortFeature(USBDeviceConnected* dev, int feature, int index)
Waldek 0:fa31f8461c63 82 {
Waldek 0:fa31f8461c63 83 return controlWrite(dev, 0x23, CLEAR_FEATURE,feature,index,0,0);
Waldek 0:fa31f8461c63 84 }
Waldek 0:fa31f8461c63 85
Waldek 0:fa31f8461c63 86 int USBHost::SetPortReset(USBDeviceConnected* dev, int port)
Waldek 0:fa31f8461c63 87 {
Waldek 0:fa31f8461c63 88 return SetPortFeature(dev, PORT_RESET, port);
Waldek 0:fa31f8461c63 89 }
Waldek 0:fa31f8461c63 90
Waldek 0:fa31f8461c63 91 int USBHost::GetPortStatus(USBDeviceConnected* dev, int port, uint32_t* status)
Waldek 0:fa31f8461c63 92 {
Waldek 0:fa31f8461c63 93 return controlRead(dev, 0xa3, GET_STATUS, 0, port, (uint8_t*)status, 4);
Waldek 0:fa31f8461c63 94 }
Waldek 0:fa31f8461c63 95
Waldek 0:fa31f8461c63 96 int USBHost::PortReset(USBDeviceConnected* dev, int port)
Waldek 0:fa31f8461c63 97 {
Waldek 0:fa31f8461c63 98 USB_DBG("%p port=%d\n", this, port);
Waldek 0:fa31f8461c63 99 USB_TEST_ASSERT(port >= 1);
Waldek 0:fa31f8461c63 100 SetPortReset(dev, port);
Waldek 0:fa31f8461c63 101 // wait reset
Waldek 0:fa31f8461c63 102 for(int i = 0; i < 100; i++) {
Waldek 0:fa31f8461c63 103 uint32_t status;
Waldek 0:fa31f8461c63 104 GetPortStatus(dev, port, &status);
Waldek 0:fa31f8461c63 105 USB_DBG("RESET port: %d status: %08X\n", port, status);
Waldek 0:fa31f8461c63 106 if (status & 0x100000) { // Reset change , Reset complete
Waldek 0:fa31f8461c63 107 return USB_TYPE_OK;
Waldek 0:fa31f8461c63 108 }
Waldek 0:fa31f8461c63 109 wait_ms(5);
Waldek 0:fa31f8461c63 110 }
Waldek 0:fa31f8461c63 111 return USB_TYPE_ERROR;
Waldek 0:fa31f8461c63 112 }