Diff: BaseUsbHostIsoEp.cpp

Revision:

0:b7d6879637a8

Child:

1:3b7bc4f87a61

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/BaseUsbHostIsoEp.cpp	Tue Dec 04 13:29:41 2012 +0000
@@ -0,0 +1,134 @@
+// BaseUsbHostIsoEp.cpp 2012/12/4
+#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 = 8;
+    m_itd_queue_count = 0;
+    reset();
+    HCITD* itd = new_HCITD();
+    TEST_ASSERT(itd);
+    m_pED->TailTd = reinterpret_cast<HCTD*>(itd);
+    m_pED->HeadTd = reinterpret_cast<HCTD*>(itd); 
+
+    HCCA* hcca = reinterpret_cast<HCCA*>(LPC_USB->HcHCCA);
+    TEST_ASSERT(hcca);
+    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()
+{
+    m_FrameNumber = LPC_USB->HcFmNumber + 100; // 100msec
+}
+
+void IsochronousEp::irqWdhHandler(HCTD* td)
+{
+    osStatus st = m_queue.put(td);
+    if (st != osOK) {
+        //led4_error = 1;
+    }
+    //led2 = !led2;
+}
+
+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::read()
+{
+    TEST_ASSERT(m_itd_queue_count >= 0);
+    while(m_itd_queue_count < HCTD_QUEUE_SIZE) {
+        HCITD* itd = reinterpret_cast<HCITD*>(m_pED->TailTd);
+        TEST_ASSERT(itd);
+        //DBG_ITD(itd);
+        HCITD* blank_itd = new_HCITD();
+        TEST_ASSERT(blank_itd);
+        itd->Next = reinterpret_cast<uint32_t>(blank_itd);
+        m_pED->TailTd = reinterpret_cast<HCTD*>(blank_itd);
+        m_itd_queue_count++;
+        //DBG_IED(m_pED);
+        LPC_USB->HcControl |= OR_CONTROL_PLE; // Enable Periodic
+    }
+    
+    HCITD* itd = get_queue_HCITD(1);
+    if (itd) {
+        m_itd_queue_count--;
+    }
+    return itd;
+}
+
+HCITD* IsochronousEp::get_queue_HCITD(uint32_t 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);
+            //led3 = !led3;
+            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;
+}
+