Diff: LPC4088-USBHost/USBHost/BaseUsbHostHub.cpp

Revision:

0:11152e69fc05

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/LPC4088-USBHost/USBHost/BaseUsbHostHub.cpp	Tue Apr 22 10:54:52 2014 +0000
@@ -0,0 +1,157 @@
+// BaseUsbHostHub.cpp 2014/4/21
+#include "USBHost.h"
+//#define DEBUG
+#include "BaseUsbHostDebug.h"
+#define TEST
+#include "BaseUsbHostTest.h"
+
+#define PORT_CONNECTION   0
+#define PORT_ENABLE       1
+#define PORT_SUSPEND      2
+#define PORT_OVER_CURRENT 3
+#define PORT_RESET        4
+#define PORT_POWER        8
+#define PORT_LOW_SPEED    9
+
+#define C_PORT_CONNECTION   16
+#define C_PORT_ENABLE       17
+#define C_PORT_SUSPEND      18
+#define C_PORT_OVER_CURRENT 19
+#define C_PORT_RESET        20
+
+UsbHub::UsbHub(ControlEp* ctlEp)
+{
+    if (ctlEp == NULL) {
+        DBG_OHCI(LPC_USB->HcRhPortStatus1);
+        int lowSpeed = 0;
+        if (LPC_USB->HcRhPortStatus1 & 0x200) {
+            lowSpeed = 1;
+        }
+        m_ctlEp = new ControlEp(lowSpeed);
+        TEST_ASSERT_TRUE(m_ctlEp);
+    } else {
+        m_ctlEp = ctlEp;
+    }
+    CTASSERT(sizeof(DeviceDescriptor) == 18);
+    DeviceDescriptor devdesc;
+    USB_TYPE rc = m_ctlEp->GetDescriptor(1, 0, reinterpret_cast<uint8_t*>(&devdesc), sizeof(DeviceDescriptor));
+    TEST_ASSERT(rc == USB_TYPE_OK);
+    if (rc != USB_TYPE_OK) {
+        return;
+    }
+    TEST_ASSERT_TRUE(devdesc.bLength == 0x12);
+    TEST_ASSERT_TRUE(devdesc.bDescriptorType == 0x01);
+    TEST_ASSERT_TRUE(devdesc.bDeviceClass == 0x09); // hub
+    if (devdesc.bDeviceClass != 0x09) { // hub ?
+        return;
+    }
+    CTASSERT(sizeof(HubDescriptor) == 9);
+    TEST_ASSERT(sizeof(HubDescriptor) == 9);
+    HubDescriptor hubdesc;
+    rc = m_ctlEp->controlReceive(0xa0, 6, 0x29<<8, 0, reinterpret_cast<uint8_t*>(&hubdesc), sizeof(HubDescriptor));
+    TEST_ASSERT(rc == USB_TYPE_OK);
+    if (rc != USB_TYPE_OK) {
+        return;
+    }
+    TEST_ASSERT(hubdesc.bDescLength == 9); // length
+    TEST_ASSERT(hubdesc.bDescriptorType == 0x29); // hub
+    TEST_ASSERT(hubdesc.bNbrPorts >= 1);
+    TEST_ASSERT(hubdesc.bNbrPorts <= 16);
+
+    rc = m_ctlEp->SetConfiguration(1);
+    TEST_ASSERT(rc == USB_TYPE_OK);
+    
+    uint32_t status;
+    rc = m_ctlEp->controlReceive(0xa0, 0, 0, 0, reinterpret_cast<uint8_t*>(&status), 4);
+    TEST_ASSERT(rc == USB_TYPE_OK);
+    if (rc != USB_TYPE_OK) {
+        return;
+    }
+    DBG("HUB STATUS: %08X\n", status);
+
+    for(int i = 1; i <= hubdesc.bNbrPorts; i++) {
+        SetPortPower(i); // power on
+        wait_ms(hubdesc.bPwrOn2PwrGood*2);
+        uint32_t status;
+        GetPortStatus(i, &status);
+        DBG("port: %d status: %08X\n", i, status);
+        if (status & 0x010000) { // Connect Status Change, has changed
+            TEST_ASSERT(status & 0x000001);
+            ClearPortFeature(C_PORT_CONNECTION, i);
+            int lowSpeed = 0;
+            if (status & 0x0200) {
+                lowSpeed = 1;
+            }
+            PortReset(i);
+            ControlEp* ctlEp = new ControlEp(lowSpeed);
+            PortEp.push_back(ctlEp);
+        } else {
+            ClearPortPower(i); // power off
+        }
+    }
+}
+
+bool UsbHub::check(ControlEp* ctlEp)
+{
+    if (ctlEp == NULL) {
+        return false;
+    }
+    DeviceDescriptor desc;
+    USB_TYPE rc = ctlEp->GetDescriptor(DEVICE_DESCRIPTOR, 0, reinterpret_cast<uint8_t*>(&desc), sizeof(DeviceDescriptor));
+    if (rc != USB_TYPE_OK) {
+        return false;
+    }
+    if (desc.bDeviceClass == 9) { // hub?
+        return true;
+    }
+    return false;
+}
+
+USB_TYPE UsbHub::SetPortPower(int port)
+{
+    return SetPortFeature(PORT_POWER, port);
+}
+
+USB_TYPE UsbHub::ClearPortPower(int port)
+{
+    return ClearPortFeature(PORT_POWER, port);
+}
+
+USB_TYPE UsbHub::SetPortFeature(int feature, int index)
+{
+    return m_ctlEp->controlSend(0x23, SET_FEATURE,feature,index,0,0);
+}
+
+USB_TYPE UsbHub::ClearPortFeature(int feature, int index)
+{
+    return m_ctlEp->controlSend(0x23, CLEAR_FEATURE,feature,index,0,0);
+}
+
+USB_TYPE UsbHub::SetPortReset(int port)
+{
+    return SetPortFeature(PORT_RESET, port);
+}
+
+USB_TYPE UsbHub::GetPortStatus(int port, uint32_t* status)
+{
+    return m_ctlEp->controlReceive(0xa3, GET_STATUS, 0, port, (uint8_t*)status, 4);
+}
+
+USB_TYPE UsbHub::PortReset(int port)
+{
+    DBG("%p port=%d\n", this, port);
+    TEST_ASSERT(port >= 1);
+    SetPortReset(port);
+    // wait reset
+    for(int i = 0; i < 100; i++) {
+        uint32_t status;    
+        GetPortStatus(port, &status);
+        DBG("RESET port: %d status: %08X\n", port, status);
+        if (status & 0x100000) { // Reset change , Reset complete
+            return USB_TYPE_OK;
+        }
+        wait_ms(5);
+     }
+     return USB_TYPE_ERROR;
+}
+