nikos chalikias / Mbed 2 deprecated n-bed-USBHostC270_example

testing n-Bed with a Logitech C270 camera

Dependencies:   USBHost mbed

Fork of USBHostC270_example by Norimasa Okamoto

USBHostC270/USBisochronous/USBIsochronous.h@14:449f809d07eb, 2015-05-21 (annotated)

Committer:
chalikias
Date:
Thu May 21 11:59:47 2015 +0000
Revision:
14:449f809d07eb
Parent:
12:ea4badc78215 
camera resolution reduced to 160x120, else memory overflow issues...

Who changed what in which revision?

UserRevisionLine numberNew contents of line
va009039 12:ea4badc78215 1 // USBIsochronous.h
va009039 12:ea4badc78215 2 #pragma once
va009039 12:ea4badc78215 3
va009039 12:ea4badc78215 4 class IsochronousEp;
va009039 12:ea4badc78215 5 struct HCITD { // HostController Isochronous Transfer Descriptor
va009039 12:ea4badc78215 6 __IO uint32_t Control; // +0 Transfer descriptor control
va009039 12:ea4badc78215 7 uint8_t* BufferPage0; // +4 Buffer Page 0
va009039 12:ea4badc78215 8 HCITD* Next; // +8 Physical pointer to next Isochronous Transfer Descriptor
va009039 12:ea4badc78215 9 uint8_t* BufferEnd; // +12 buffer End
va009039 12:ea4badc78215 10 __IO uint16_t OffsetPSW[8]; // +16 Offset/PSW
va009039 12:ea4badc78215 11 IsochronousEp* ep; // +32 endpoint object
va009039 12:ea4badc78215 12 __IO uint8_t buf[0]; // +36 buffer
va009039 12:ea4badc78215 13 // +36
va009039 12:ea4badc78215 14 HCITD(IsochronousEp* obj, uint16_t FrameNumber, int FrameCount, uint16_t PacketSize);
va009039 12:ea4badc78215 15 inline void* operator new(size_t size, int buf_size) {
va009039 12:ea4badc78215 16 void* p;
va009039 12:ea4badc78215 17 if (posix_memalign(&p, 32, size+buf_size) == 0) {
va009039 12:ea4badc78215 18 return p;
va009039 12:ea4badc78215 19 }
va009039 12:ea4badc78215 20 return NULL;
va009039 12:ea4badc78215 21 }
va009039 12:ea4badc78215 22
va009039 12:ea4badc78215 23 inline void operator delete(void* p) {
va009039 12:ea4badc78215 24 free(p);
va009039 12:ea4badc78215 25 }
va009039 12:ea4badc78215 26
va009039 12:ea4badc78215 27 inline uint16_t StartingFrame() {
va009039 12:ea4badc78215 28 return Control & 0xffff;
va009039 12:ea4badc78215 29 }
va009039 12:ea4badc78215 30
va009039 12:ea4badc78215 31 inline uint8_t FrameCount() {
va009039 12:ea4badc78215 32 return ((Control>>24)&7)+1;
va009039 12:ea4badc78215 33 }
va009039 12:ea4badc78215 34
va009039 12:ea4badc78215 35 inline uint8_t ConditionCode() {
va009039 12:ea4badc78215 36 return Control>>28;
va009039 12:ea4badc78215 37 }
va009039 12:ea4badc78215 38 };
va009039 12:ea4badc78215 39
va009039 12:ea4badc78215 40 struct _HCED { // HostController EndPoint Descriptor
va009039 12:ea4badc78215 41 __IO uint32_t Control; // +0 Endpoint descriptor control
va009039 12:ea4badc78215 42 HCTD* TailTd; // +4 Physical address of tail in Transfer descriptor list
va009039 12:ea4badc78215 43 __IO HCTD* HeadTd; // +8 Physcial address of head in Transfer descriptor list
va009039 12:ea4badc78215 44 _HCED* Next; // +12 Physical address of next Endpoint descriptor
va009039 12:ea4badc78215 45 // +16
va009039 12:ea4badc78215 46 _HCED(int addr, uint8_t ep, uint16_t size, int lowSpeed = 0) {
va009039 12:ea4badc78215 47 Control = addr | /* USB address */
va009039 12:ea4badc78215 48 ((ep & 0x7F) << 7) | /* Endpoint address */
va009039 12:ea4badc78215 49 (ep!=0?(((ep&0x80)?2:1) << 11):0)| /* direction : Out = 1, 2 = In */
va009039 12:ea4badc78215 50 ((lowSpeed?1:0) << 13) | /* speed full=0 low=1 */
va009039 12:ea4badc78215 51 (size << 16); /* MaxPkt Size */
va009039 12:ea4badc78215 52 Next = NULL;
va009039 12:ea4badc78215 53 }
va009039 12:ea4badc78215 54
va009039 12:ea4badc78215 55 inline void* operator new(size_t size) {
va009039 12:ea4badc78215 56 void* p;
va009039 12:ea4badc78215 57 if (posix_memalign(&p, 16, size) == 0) {
va009039 12:ea4badc78215 58 return p;
va009039 12:ea4badc78215 59 }
va009039 12:ea4badc78215 60 return NULL;
va009039 12:ea4badc78215 61 }
va009039 12:ea4badc78215 62
va009039 12:ea4badc78215 63 inline void operator delete(void* p) {
va009039 12:ea4badc78215 64 free(p);
va009039 12:ea4badc78215 65 }
va009039 12:ea4badc78215 66
va009039 12:ea4badc78215 67 inline uint8_t FunctionAddress() {
va009039 12:ea4badc78215 68 return Control & 0x7f;
va009039 12:ea4badc78215 69 }
va009039 12:ea4badc78215 70
va009039 12:ea4badc78215 71 inline int Speed() {
va009039 12:ea4badc78215 72 return (Control>>13)&1;
va009039 12:ea4badc78215 73 }
va009039 12:ea4badc78215 74
va009039 12:ea4badc78215 75 inline void setFunctionAddress(int addr) {
va009039 12:ea4badc78215 76 Control &= ~0x7f;
va009039 12:ea4badc78215 77 Control |= addr;
va009039 12:ea4badc78215 78 }
va009039 12:ea4badc78215 79
va009039 12:ea4badc78215 80 inline void setMaxPacketSize(uint16_t size) {
va009039 12:ea4badc78215 81 Control &= ~0xffff0000;
va009039 12:ea4badc78215 82 Control |= size<<16;
va009039 12:ea4badc78215 83 }
va009039 12:ea4badc78215 84
va009039 12:ea4badc78215 85 int Skip() {
va009039 12:ea4badc78215 86 return (Control>>14) & 1;
va009039 12:ea4badc78215 87 }
va009039 12:ea4badc78215 88
va009039 12:ea4badc78215 89 void setSkip() {
va009039 12:ea4badc78215 90 Control |= (1<<14);
va009039 12:ea4badc78215 91 }
va009039 12:ea4badc78215 92
va009039 12:ea4badc78215 93 void setFormat() {
va009039 12:ea4badc78215 94 Control |= (1<<15);
va009039 12:ea4badc78215 95 }
va009039 12:ea4badc78215 96
va009039 12:ea4badc78215 97 template<typename T>
va009039 12:ea4badc78215 98 inline bool enqueue(T* td) {
va009039 12:ea4badc78215 99 if (td) {
va009039 12:ea4badc78215 100 T* tail = reinterpret_cast<T*>(TailTd);
va009039 12:ea4badc78215 101 if (tail) {
va009039 12:ea4badc78215 102 tail->Next = td;
va009039 12:ea4badc78215 103 TailTd = reinterpret_cast<HCTD*>(td);
va009039 12:ea4badc78215 104 return true;
va009039 12:ea4badc78215 105 }
va009039 12:ea4badc78215 106 }
va009039 12:ea4badc78215 107 return false;
va009039 12:ea4badc78215 108 }
va009039 12:ea4badc78215 109
va009039 12:ea4badc78215 110 template<typename T>
va009039 12:ea4badc78215 111 inline T* dequeue() {
va009039 12:ea4badc78215 112 T* head = reinterpret_cast<T*>(reinterpret_cast<uint32_t>(HeadTd)&~3); // delete Halted and Toggle Carry bit
va009039 12:ea4badc78215 113 T* tail = reinterpret_cast<T*>(TailTd);
va009039 12:ea4badc78215 114 if (head == NULL || tail == NULL || head == tail) {
va009039 12:ea4badc78215 115 return NULL;
va009039 12:ea4badc78215 116 }
va009039 12:ea4badc78215 117 HeadTd = reinterpret_cast<HCTD*>(head->Next);
va009039 12:ea4badc78215 118 return head;
va009039 12:ea4badc78215 119 }
va009039 12:ea4badc78215 120 template<typename T>
va009039 12:ea4badc78215 121 void init_queue(T* td) {
va009039 12:ea4badc78215 122 TailTd = reinterpret_cast<HCTD*>(td);
va009039 12:ea4badc78215 123 HeadTd = reinterpret_cast<HCTD*>(td);
va009039 12:ea4badc78215 124 }
va009039 12:ea4badc78215 125 };
va009039 12:ea4badc78215 126
va009039 12:ea4badc78215 127 struct _HCCA { // Host Controller Communication Area
va009039 12:ea4badc78215 128 _HCED* InterruptTable[32]; // +0 Interrupt Table
va009039 12:ea4badc78215 129 __IO uint16_t FrameNumber;// +128 Frame Number
va009039 12:ea4badc78215 130 __IO uint16_t Pad1; // +130
va009039 12:ea4badc78215 131 __IO HCTD* DoneHead; // +132 Done Head
va009039 12:ea4badc78215 132 uint8_t Reserved[116]; // +136 Reserved for future use
va009039 12:ea4badc78215 133 uint8_t Unknown[4]; // +252 Unused
va009039 12:ea4badc78215 134 // +256
va009039 12:ea4badc78215 135 inline void* operator new(size_t size) {
va009039 12:ea4badc78215 136 void* p;
va009039 12:ea4badc78215 137 if (posix_memalign(&p, 256, size) == 0) {
va009039 12:ea4badc78215 138 return p;
va009039 12:ea4badc78215 139 }
va009039 12:ea4badc78215 140 return NULL;
va009039 12:ea4badc78215 141 }
va009039 12:ea4badc78215 142
va009039 12:ea4badc78215 143 inline void operator delete(void* p) {
va009039 12:ea4badc78215 144 free(p);
va009039 12:ea4badc78215 145 }
va009039 12:ea4badc78215 146
va009039 12:ea4badc78215 147 inline void enqueue(_HCED* ed) {
va009039 12:ea4badc78215 148 for(int i = 0; i < 32; i++) {
va009039 12:ea4badc78215 149 if (InterruptTable[i] == NULL) {
va009039 12:ea4badc78215 150 InterruptTable[i] = ed;
va009039 12:ea4badc78215 151 } else {
va009039 12:ea4badc78215 152 _HCED* nextEd = InterruptTable[i];
va009039 12:ea4badc78215 153 while(nextEd->Next && nextEd->Next != ed) {
va009039 12:ea4badc78215 154 nextEd = nextEd->Next;
va009039 12:ea4badc78215 155 }
va009039 12:ea4badc78215 156 nextEd->Next = ed;
va009039 12:ea4badc78215 157 }
va009039 12:ea4badc78215 158 }
va009039 12:ea4badc78215 159 }
va009039 12:ea4badc78215 160
va009039 12:ea4badc78215 161 inline void dequeue(_HCED* ed) {
va009039 12:ea4badc78215 162 for(int i = 0; i < 32; i++) {
va009039 12:ea4badc78215 163 if (InterruptTable[i] == ed) {
va009039 12:ea4badc78215 164 InterruptTable[i] = ed->Next;
va009039 12:ea4badc78215 165 } else if (InterruptTable[i]) {
va009039 12:ea4badc78215 166 _HCED* nextEd = InterruptTable[i];
va009039 12:ea4badc78215 167 while(nextEd) {
va009039 12:ea4badc78215 168 if (nextEd->Next == ed) {
va009039 12:ea4badc78215 169 nextEd->Next = ed->Next;
va009039 12:ea4badc78215 170 break;
va009039 12:ea4badc78215 171 }
va009039 12:ea4badc78215 172 nextEd = nextEd->Next;
va009039 12:ea4badc78215 173 }
va009039 12:ea4badc78215 174 }
va009039 12:ea4badc78215 175 }
va009039 12:ea4badc78215 176 }
va009039 12:ea4badc78215 177 };
va009039 12:ea4badc78215 178
va009039 12:ea4badc78215 179 #define HCITD_QUEUE_SIZE 3
va009039 12:ea4badc78215 180
va009039 12:ea4badc78215 181 class IsochronousEp {
va009039 12:ea4badc78215 182 public:
va009039 12:ea4badc78215 183 void init(int addr, uint8_t ep, uint16_t size, uint8_t frameCount = 4, uint8_t queueLimit = HCITD_QUEUE_SIZE);
va009039 12:ea4badc78215 184 void reset(int delay_ms = 100);
va009039 12:ea4badc78215 185 HCITD* isochronousReceive(int timeout_ms);
va009039 12:ea4badc78215 186 int isochronousSend(uint8_t* buf, int len, int timeout_ms);
va009039 12:ea4badc78215 187 HCITD* get_queue_HCITD(int timeout_ms);
va009039 12:ea4badc78215 188 uint16_t m_PacketSize;
va009039 12:ea4badc78215 189 void disconnect();
va009039 12:ea4badc78215 190 void irqWdhHandler(HCITD* itd) {m_queue.put(itd);} // WDH
va009039 12:ea4badc78215 191 private:
va009039 12:ea4badc78215 192 HCITD* new_HCITD(IsochronousEp* obj);
va009039 12:ea4badc78215 193 Queue<HCITD, HCITD_QUEUE_SIZE> m_queue; // ITD done queue
va009039 12:ea4badc78215 194 int m_itd_queue_count;
va009039 12:ea4badc78215 195 int m_itd_queue_limit;
va009039 12:ea4badc78215 196 uint16_t m_FrameNumber;
va009039 12:ea4badc78215 197 int m_FrameCount; // 1-8
va009039 12:ea4badc78215 198 void enable();
va009039 12:ea4badc78215 199 _HCED* m_pED;
va009039 12:ea4badc78215 200 };