Simple USBHost MSD(USB flash drive) for EA LPC4088 QSB test program

Dependencies:   LPC4088-USBHost mbed

EA LPC4088をUSBホストにしてUSBフラッシュメモリ(USB flash drive)を読み書きするテストプログラムです。
/media/uploads/va009039/lpc4088-msd-1.jpg
/media/uploads/va009039/lpc4088-msd-2.png

https://bitbucket.org/va009039/lpc4088_usbhost

LPC4088-USBHost/USBHost/BaseUsbHostHub.cpp

Committer:
va009039
Date:
2014-04-22
Revision:
0:11152e69fc05

File content as of revision 0:11152e69fc05:

// 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;
}