modify for C210 webcam and Startboard Orange.
Dependencies: TextLCD USBHost mbed
Fork of USBHostC270_example by
Norimasa Okamoto さんの http://mbed.org/users/va009039/code/USBHostC270_example/ を C210 webcam と StarBoard Orange での SD カード保存用に変更。
Diff: USBHostC270/BaseUvc.cpp
- Revision:
- 9:fecabade834a
- Child:
- 10:387c49b2fc7e
diff -r 758190c6c455 -r fecabade834a USBHostC270/BaseUvc.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/USBHostC270/BaseUvc.cpp Sat Mar 16 13:07:55 2013 +0000 @@ -0,0 +1,195 @@ +#include "USBHostConf.h" +#include "USBHost.h" + +#include "USBHostC270.h" +#include "BaseUvc.h" + +#define TEST_ASSERT(A) while(!(A)){fprintf(stderr,"\n\n%s@%d %s ASSERT!\n\n",__PRETTY_FUNCTION__,__LINE__,#A);exit(1);}; + +void BaseUvc::poll(int millisec) +{ + HCITD* itd = m_isoEp->isochronousReveive(millisec); + if (itd) { + uint8_t cc = itd->ConditionCode(); + report_cc_count[cc]++; + if (cc == 0) { + uint16_t frame = itd->StartingFrame(); + int fc = itd->FrameCount(); + uint8_t* buf = const_cast<uint8_t*>(itd->buf); + int mps = m_isoEp->m_PacketSize; + for(int i = 0; i < fc; i++) { + uint16_t psw = itd->OffsetPSW[i]; + cc = psw>>12; + if (cc == 0 || cc == 9) { + int len = psw & 0x7ff; + onResult(frame, buf, len); + } + report_ps_cc_count[cc]++; + buf += mps; + frame++; + } + } + delete itd; + } +} + +void BaseUvc::onResult(uint16_t frame, uint8_t* buf, int len) +{ + if(m_pCbItem && m_pCbMeth) + (m_pCbItem->*m_pCbMeth)(frame, buf, len); + else if(m_pCb) + m_pCb(frame, buf, len); +} + +void BaseUvc::setOnResult( void (*pMethod)(uint16_t, uint8_t*, int) ) +{ + m_pCb = pMethod; + m_pCbItem = NULL; + m_pCbMeth = NULL; +} + +void BaseUvc::clearOnResult() +{ + m_pCb = NULL; + m_pCbItem = NULL; + m_pCbMeth = NULL; +} + + +HCITD::HCITD(BaseEp* obj, uint16_t FrameNumber, int FrameCount, uint16_t PacketSize) { + Control = 0xe0000000 | // CC ConditionCode NOT ACCESSED + ((FrameCount-1) << 24)| // FC FrameCount + TD_DELAY_INT(0) | // DI DelayInterrupt + FrameNumber; // SF StartingFrame + BufferPage0 = const_cast<uint8_t*>(buf); + BufferEnd = const_cast<uint8_t*>(buf) + PacketSize * FrameCount - 1; + Next = NULL; + ep = obj; + uint32_t addr = reinterpret_cast<uint32_t>(buf); + for(int i = 0; i < FrameCount; i++) { + uint16_t offset = addr & 0x0fff; + if ((addr&0xfffff000) == (reinterpret_cast<uint32_t>(BufferEnd)&0xfffff000)) { + offset |= 0x1000; + } + OffsetPSW[i] = 0xe000|offset; + addr += PacketSize; + } +} + +IsochronousEp::IsochronousEp(int addr, uint8_t ep, uint16_t size):BaseEp(addr, ep, size) +{ + C270_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(this); + 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] == NULL) { + hcca->InterruptTable[i] = m_pED; + } else { + _HCED* nextEd = hcca->InterruptTable[i]; + while(nextEd->Next && nextEd->Next != m_pED) { + nextEd = nextEd->Next; + } + nextEd->Next = m_pED; + } + } + //DBG_ED(m_pED); +} + +void IsochronousEp::reset(int delay_ms) +{ + m_FrameNumber = LPC_USB->HcFmNumber + delay_ms; +} + +HCITD* IsochronousEp::new_HCITD(BaseEp* obj) +{ + HCITD* itd = new(m_PacketSize*m_FrameCount)HCITD(obj, m_FrameNumber, m_FrameCount, m_PacketSize); + if (itd == NULL) { + return NULL; + } + 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(this); + TEST_ASSERT(blank_itd); + if (blank_itd == NULL) { + return NULL; + } + itd->Next = 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); + 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; +} + +BaseEp::BaseEp(int addr, uint8_t ep, uint16_t size, int lowSpeed):m_td_queue_count(0) +{ + C270_DBG("%p FA=%d EN=%02x MPS=%d S=%d\n", this, addr, ep, size, lowSpeed); + TEST_ASSERT(size >= 8 && size <= 1023); + TEST_ASSERT(lowSpeed == 0 || lowSpeed == 1); + m_pED = new _HCED(addr, ep, size, lowSpeed); + TEST_ASSERT(m_pED); +} +