File content as of revision 3:ae77d63a1eda:

// BaseUsbHostIsoEp.cpp 2012/12/31
#include "mbed.h"
#include "rtos.h"
#include "BaseUsbHost.h"
#define DEBUG
#include "BaseUsbHostDebug.h"
#define TEST
#include "BaseUsbHostTest.h"

IsochronousEp::IsochronousEp(int addr, uint8_t ep, uint16_t size):BaseEp(addr, ep, size)
{
    DBG("%p FA:%d EP:%02X MPS:%d\n", this, addr, ep, size);
    TEST_ASSERT(m_pED);
    
    m_pED->Control |= (1 << 15); // F Format ITD

    TEST_ASSERT(size >= 128 && size <= 1023);
    m_PacketSize = size;
    m_FrameCount = 4; // 1-8
    TEST_ASSERT(m_FrameCount >= 1 && m_FrameCount <= 8);
    m_itd_queue_count = 0;
    reset();
    HCITD* itd = new_HCITD();
    m_pED->TailTd = reinterpret_cast<HCTD*>(itd);
    m_pED->HeadTd = reinterpret_cast<HCTD*>(itd); 
    TEST_ASSERT(itd);
    if (itd == NULL) {
        return;
    }
    HCCA* hcca = reinterpret_cast<HCCA*>(LPC_USB->HcHCCA);
    TEST_ASSERT(hcca);
    if (hcca == NULL) {
        return;
    }
    for(int i = 0; i < 32; i++) {
        if (hcca->InterruptTable[i] == 0) {
            hcca->InterruptTable[i] = reinterpret_cast<uint32_t>(m_pED);
        } else {
            HCED* nextEd = reinterpret_cast<HCED*>(hcca->InterruptTable[i]);
            while(nextEd->Next && nextEd->Next != reinterpret_cast<uint32_t>(m_pED)) {
                nextEd = reinterpret_cast<HCED*>(nextEd->Next);
            }
            nextEd->Next = reinterpret_cast<uint32_t>(m_pED);
        }
    }
    DBG_ED(m_pED);
}

void IsochronousEp::reset(int delay_ms)
{
    m_FrameNumber = LPC_USB->HcFmNumber + delay_ms;
}

HCITD* IsochronousEp::new_HCITD()
{
    HCITD* itd;
    int r = posix_memalign(reinterpret_cast<void**>(&itd), 32, sizeof(HCITD)+m_PacketSize*m_FrameCount);
    if (r != 0) {
        return NULL;
    } 
    int di = 0; //DelayInterrupt
    itd->Control = 0xe0000000            | // CC ConditionCode NOT ACCESSED
                 ((m_FrameCount-1) << 24)| // FC FrameCount
                       TD_DELAY_INT(di)  | // DI DelayInterrupt
                     m_FrameNumber;        // SF StartingFrame
    itd->BufferPage0 = const_cast<uint8_t*>(itd->buf);
    itd->BufferEnd = const_cast<uint8_t*>(itd->buf) + m_PacketSize * m_FrameCount - 1;
    itd->Next = NULL; 
    itd->ep = this;
    uint32_t addr = reinterpret_cast<uint32_t>(itd->buf);
    for(int i = 0; i < m_FrameCount; i++) {
        uint16_t offset = addr & 0x0fff;
        if ((addr&0xfffff000) == (reinterpret_cast<uint32_t>(itd->BufferEnd)&0xfffff000)) {
            offset |= 0x1000;
        }
        itd->OffsetPSW[i] = 0xe000|offset;
        addr += m_PacketSize;
    }
    m_FrameNumber += m_FrameCount;
    return itd;
}

HCITD* IsochronousEp::isochronousReveive(int millisec)
{
    TEST_ASSERT(m_itd_queue_count >= 0);
    while(m_itd_queue_count < 3 && m_itd_queue_count < HCTD_QUEUE_SIZE) {
        HCITD* itd = reinterpret_cast<HCITD*>(m_pED->TailTd);
        TEST_ASSERT(itd);
        if (itd == NULL) {
            return NULL;
        }
        HCITD* blank_itd = new_HCITD();
        TEST_ASSERT(blank_itd);
        if (blank_itd == NULL) {
            return NULL;
        }
        itd->Next = reinterpret_cast<uint32_t>(blank_itd);
        m_pED->TailTd = reinterpret_cast<HCTD*>(blank_itd);
        m_itd_queue_count++;
        //DBG_IED(m_pED);
        enable(); // Enable Periodic
    }
    
    HCITD* itd = get_queue_HCITD(millisec);
    if (itd) {
        m_itd_queue_count--;
    }
    return itd;
}

HCITD* IsochronousEp::get_queue_HCITD(int millisec)
{
    for(int i = 0; i < 16; i++) {
        osEvent evt = m_queue.get(millisec);
        if (evt.status == osEventMessage) {
            HCITD* itd = reinterpret_cast<HCITD*>(evt.value.p);
            TEST_ASSERT(itd);
            if (itd == NULL) {
                return NULL;
            }
            uint8_t cc = itd->Control>>28;
            if (cc != 0) {
                m_ConditionCode = cc;
            }
            return itd;
        } else if (evt.status == osOK) {
            continue;
        } else if (evt.status == osEventTimeout) {
            return NULL;
        } else {
            DBG("evt.status: %02x\n", evt.status);
            TEST_ASSERT(evt.status == osEventMessage);
            return NULL;
        }
    }
    return NULL;
}

void IsochronousEp::enable()
{
    LPC_USB->HcControl |= OR_CONTROL_PLE;
}