Norimasa Okamoto / uvchost

UVC host library

Dependents:   LifeCam WebcamServer

usb/usb_mem.cpp@3:3eb41d749f9a, 2012-08-15 (annotated)

Committer:
va009039
Date:
Wed Aug 15 13:52:53 2012 +0000
Revision:
3:3eb41d749f9a
Parent:
1:ee74af6365b8 
add USB_USE_MALLOC

Who changed what in which revision?

UserRevisionLine numberNew contents of line
va009039 0:b0f04c137829 1
va009039 0:b0f04c137829 2 /*
va009039 0:b0f04c137829 3 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
va009039 0:b0f04c137829 4
va009039 0:b0f04c137829 5 Permission is hereby granted, free of charge, to any person obtaining a copy
va009039 0:b0f04c137829 6 of this software and associated documentation files (the "Software"), to deal
va009039 0:b0f04c137829 7 in the Software without restriction, including without limitation the rights
va009039 0:b0f04c137829 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
va009039 0:b0f04c137829 9 copies of the Software, and to permit persons to whom the Software is
va009039 0:b0f04c137829 10 furnished to do so, subject to the following conditions:
va009039 0:b0f04c137829 11
va009039 0:b0f04c137829 12 The above copyright notice and this permission notice shall be included in
va009039 0:b0f04c137829 13 all copies or substantial portions of the Software.
va009039 0:b0f04c137829 14
va009039 0:b0f04c137829 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
va009039 0:b0f04c137829 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
va009039 0:b0f04c137829 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
va009039 0:b0f04c137829 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
va009039 0:b0f04c137829 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
va009039 0:b0f04c137829 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
va009039 0:b0f04c137829 21 THE SOFTWARE.
va009039 0:b0f04c137829 22 */
va009039 3:3eb41d749f9a 23 #include "usbconfig.h"
va009039 3:3eb41d749f9a 24 #ifndef USB_USE_MALLOC
va009039 0:b0f04c137829 25 #include "mbed.h"
va009039 0:b0f04c137829 26 #define __DEBUG
va009039 0:b0f04c137829 27 #include "mydbg.h"
va009039 0:b0f04c137829 28 #include "usb_mem.h"
va009039 0:b0f04c137829 29 #include "string.h" //For memcpy, memmove, memset
va009039 0:b0f04c137829 30 #include "UsbInc.h"
va009039 0:b0f04c137829 31
va009039 0:b0f04c137829 32 #define EDS_COUNT 16
va009039 0:b0f04c137829 33 #define TDS_COUNT 0
va009039 0:b0f04c137829 34 #define ITDS_COUNT 0
va009039 0:b0f04c137829 35 #define UTDS_COUNT 32
va009039 0:b0f04c137829 36 #define BPS_COUNT 9
va009039 0:b0f04c137829 37
va009039 0:b0f04c137829 38 #define HCCA_SIZE 0x100
va009039 0:b0f04c137829 39 #define ED_SIZE 0x10
va009039 0:b0f04c137829 40 #define TD_SIZE 0x10
va009039 0:b0f04c137829 41 #define ITD_SIZE 0x20
va009039 0:b0f04c137829 42 #define UTD_SIZE (32+16)
va009039 0:b0f04c137829 43 #define BP_SIZE (128*8)
va009039 0:b0f04c137829 44
va009039 0:b0f04c137829 45 #define TOTAL_SIZE (HCCA_SIZE + (EDS_COUNT*ED_SIZE) + (TDS_COUNT*TD_SIZE) + (ITDS_COUNT*ITD_SIZE))
va009039 0:b0f04c137829 46
va009039 0:b0f04c137829 47 static volatile __align(256) byte usb_buf[TOTAL_SIZE] __attribute((section("AHBSRAM0"),aligned)); //256 bytes aligned!
va009039 0:b0f04c137829 48 static volatile __align(32) uint8_t usb_utdBuf[UTDS_COUNT*UTD_SIZE] __attribute((section("AHBSRAM0"),aligned));
va009039 0:b0f04c137829 49
va009039 0:b0f04c137829 50 static volatile byte* usb_hcca; //256 bytes aligned!
va009039 0:b0f04c137829 51
va009039 0:b0f04c137829 52 static volatile byte* usb_edBuf; //4 bytes aligned!
va009039 0:b0f04c137829 53
va009039 0:b0f04c137829 54 static byte usb_edBufAlloc[EDS_COUNT] __attribute((section("AHBSRAM0"),aligned));
va009039 0:b0f04c137829 55 static uint8_t usb_utdBufAlloc[UTDS_COUNT] __attribute((section("AHBSRAM0"),aligned));
va009039 0:b0f04c137829 56 static uint8_t usb_bpBufAlloc[BPS_COUNT] __attribute((section("AHBSRAM0"),aligned));
va009039 0:b0f04c137829 57 static uint8_t usb_bpBuf[BP_SIZE*BPS_COUNT] __attribute((section("AHBSRAM0"),aligned));
va009039 0:b0f04c137829 58
va009039 0:b0f04c137829 59 static void utd_init()
va009039 0:b0f04c137829 60 {
va009039 0:b0f04c137829 61 DBG_ASSERT(sizeof(HCTD) == 16);
va009039 0:b0f04c137829 62 DBG_ASSERT(sizeof(HCITD) == 32);
va009039 0:b0f04c137829 63 DBG_ASSERT(sizeof(HCUTD) == 48);
va009039 0:b0f04c137829 64
va009039 0:b0f04c137829 65 DBG_ASSERT(((uint32_t)usb_utdBuf % 16) == 0);
va009039 0:b0f04c137829 66 DBG_ASSERT(((uint32_t)usb_utdBuf % 32) == 0);
va009039 0:b0f04c137829 67
va009039 0:b0f04c137829 68 DBG_ASSERT((uint32_t)usb_utdBufAlloc >= 0x2007c000);
va009039 0:b0f04c137829 69 DBG_ASSERT((uint32_t)&usb_utdBufAlloc[UTDS_COUNT] <= 0x2007ffff);
va009039 0:b0f04c137829 70
va009039 0:b0f04c137829 71 DBG_ASSERT((uint32_t)usb_utdBuf >= 0x2007c000);
va009039 0:b0f04c137829 72 DBG_ASSERT((uint32_t)&usb_utdBuf[UTD_SIZE*UTDS_COUNT] <= 0x2007cfff);
va009039 0:b0f04c137829 73
va009039 0:b0f04c137829 74 memset(usb_utdBufAlloc, 0x00, UTDS_COUNT);
va009039 0:b0f04c137829 75 }
va009039 0:b0f04c137829 76
va009039 0:b0f04c137829 77 static void pb_init()
va009039 0:b0f04c137829 78 {
va009039 0:b0f04c137829 79 memset(usb_bpBufAlloc, 0x00, BPS_COUNT);
va009039 0:b0f04c137829 80
va009039 0:b0f04c137829 81 DBG_ASSERT((uint32_t)usb_bpBufAlloc >= 0x2007c000);
va009039 0:b0f04c137829 82 DBG_ASSERT((uint32_t)&usb_bpBufAlloc[BPS_COUNT] <= 0x2007ffff);
va009039 0:b0f04c137829 83 DBG_ASSERT((uint32_t)usb_bpBuf >= 0x2007c000);
va009039 0:b0f04c137829 84 DBG_ASSERT((uint32_t)(&usb_bpBuf[BP_SIZE*BPS_COUNT]) <= 0x2007ffff);
va009039 0:b0f04c137829 85 }
va009039 0:b0f04c137829 86
va009039 0:b0f04c137829 87 void usb_mem_init()
va009039 0:b0f04c137829 88 {
va009039 0:b0f04c137829 89 usb_hcca = usb_buf;
va009039 0:b0f04c137829 90 usb_edBuf = usb_buf + HCCA_SIZE;
va009039 0:b0f04c137829 91 memset(usb_edBufAlloc, 0, EDS_COUNT);
va009039 0:b0f04c137829 92
va009039 0:b0f04c137829 93 utd_init();
va009039 0:b0f04c137829 94 pb_init();
va009039 0:b0f04c137829 95
va009039 0:b0f04c137829 96 DBG("--- Memory Map --- \n");
va009039 0:b0f04c137829 97 DBG("usb_hcca =%p\n", usb_hcca);
va009039 0:b0f04c137829 98 DBG("usb_edBuf =%p\n", usb_edBuf);
va009039 0:b0f04c137829 99 DBG("usb_utdBuf =%p\n", usb_utdBuf);
va009039 0:b0f04c137829 100 DBG("usb_edBufAlloc =%p\n", usb_edBufAlloc);
va009039 0:b0f04c137829 101 DBG("usb_utdBufAlloc=%p\n", usb_utdBufAlloc);
va009039 0:b0f04c137829 102 DBG("usb_bpBuf =%p\n", usb_bpBuf);
va009039 0:b0f04c137829 103 DBG(" =%p\n", &usb_bpBuf[BP_SIZE*BPS_COUNT]);
va009039 0:b0f04c137829 104 DBG_ASSERT(((uint32_t)usb_hcca % 256) == 0);
va009039 0:b0f04c137829 105 DBG_ASSERT(((uint32_t)usb_edBuf % 16) == 0);
va009039 0:b0f04c137829 106 DBG_ASSERT(((uint32_t)usb_utdBuf % 32) == 0);
va009039 0:b0f04c137829 107 }
va009039 0:b0f04c137829 108
va009039 0:b0f04c137829 109 volatile byte* usb_get_hcca()
va009039 0:b0f04c137829 110 {
va009039 0:b0f04c137829 111 return usb_hcca;
va009039 0:b0f04c137829 112 }
va009039 0:b0f04c137829 113
va009039 0:b0f04c137829 114 volatile byte* usb_get_ed()
va009039 0:b0f04c137829 115 {
va009039 0:b0f04c137829 116 int i;
va009039 0:b0f04c137829 117 for(i = 0; i < EDS_COUNT; i++)
va009039 0:b0f04c137829 118 {
va009039 0:b0f04c137829 119 if( !usb_edBufAlloc[i] )
va009039 0:b0f04c137829 120 {
va009039 0:b0f04c137829 121 usb_edBufAlloc[i] = 1;
va009039 0:b0f04c137829 122 return usb_edBuf + i*ED_SIZE;
va009039 0:b0f04c137829 123 }
va009039 0:b0f04c137829 124 }
va009039 0:b0f04c137829 125 return NULL; //Could not alloc ED
va009039 0:b0f04c137829 126 }
va009039 0:b0f04c137829 127
va009039 0:b0f04c137829 128 static uint8_t* usb_get_utd(int al)
va009039 0:b0f04c137829 129 {
va009039 0:b0f04c137829 130 DBG_ASSERT(al == 16 || al == 32); // GTD or ITD
va009039 0:b0f04c137829 131 if (al == 16) {
va009039 0:b0f04c137829 132 for(int i = 1; i < UTDS_COUNT; i += 2) {
va009039 0:b0f04c137829 133 if (usb_utdBufAlloc[i] == 0) {
va009039 0:b0f04c137829 134 uint32_t p = (uint32_t)usb_utdBuf + i * UTD_SIZE;
va009039 0:b0f04c137829 135 if ((p % al) == 0) {
va009039 0:b0f04c137829 136 usb_utdBufAlloc[i] = 1;
va009039 0:b0f04c137829 137 DBG_ASSERT((p % al) == 0);
va009039 0:b0f04c137829 138 return (uint8_t*)p;
va009039 0:b0f04c137829 139 }
va009039 0:b0f04c137829 140 }
va009039 0:b0f04c137829 141 }
va009039 0:b0f04c137829 142 }
va009039 0:b0f04c137829 143 for(int i = 0; i < UTDS_COUNT; i++) {
va009039 0:b0f04c137829 144 if (usb_utdBufAlloc[i] == 0) {
va009039 0:b0f04c137829 145 uint32_t p = (uint32_t)usb_utdBuf + i * UTD_SIZE;
va009039 0:b0f04c137829 146 if ((p % al) == 0) {
va009039 0:b0f04c137829 147 usb_utdBufAlloc[i] = 1;
va009039 0:b0f04c137829 148 DBG_ASSERT((p % al) == 0);
va009039 0:b0f04c137829 149 return (uint8_t*)p;
va009039 0:b0f04c137829 150 }
va009039 0:b0f04c137829 151 }
va009039 0:b0f04c137829 152 }
va009039 0:b0f04c137829 153 return NULL;
va009039 0:b0f04c137829 154 }
va009039 0:b0f04c137829 155
va009039 0:b0f04c137829 156 volatile byte* usb_get_td(uint32_t endpoint)
va009039 0:b0f04c137829 157 {
va009039 0:b0f04c137829 158 DBG_ASSERT(endpoint);
va009039 0:b0f04c137829 159 uint8_t* td = usb_get_utd(16);
va009039 0:b0f04c137829 160 if (td) {
va009039 0:b0f04c137829 161 HCUTD* utd = (HCUTD*)td;
va009039 0:b0f04c137829 162 memset(utd, 0x00, sizeof(HCTD));
va009039 0:b0f04c137829 163 utd->type = 1;
va009039 0:b0f04c137829 164 utd->UsbEndpoint = endpoint;
va009039 0:b0f04c137829 165 }
va009039 0:b0f04c137829 166 return td;
va009039 0:b0f04c137829 167 }
va009039 0:b0f04c137829 168
va009039 0:b0f04c137829 169 volatile byte* usb_get_itd(uint32_t endpoint)
va009039 0:b0f04c137829 170 {
va009039 0:b0f04c137829 171 DBG_ASSERT(endpoint);
va009039 0:b0f04c137829 172 uint8_t* itd = usb_get_utd(32);
va009039 0:b0f04c137829 173 if (itd) {
va009039 0:b0f04c137829 174 HCUTD* utd = (HCUTD*)itd;
va009039 0:b0f04c137829 175 memset(utd, 0x00, sizeof(HCITD));
va009039 0:b0f04c137829 176 utd->type = 2;
va009039 0:b0f04c137829 177 utd->UsbEndpoint = endpoint;
va009039 0:b0f04c137829 178 }
va009039 0:b0f04c137829 179 return itd;
va009039 0:b0f04c137829 180 }
va009039 0:b0f04c137829 181
va009039 0:b0f04c137829 182 volatile byte* usb_get_bp(int size)
va009039 0:b0f04c137829 183 {
va009039 0:b0f04c137829 184 DBG_ASSERT(size >= 128 && size <= BP_SIZE);
va009039 0:b0f04c137829 185 if (size > BP_SIZE)
va009039 0:b0f04c137829 186 return NULL;
va009039 0:b0f04c137829 187
va009039 0:b0f04c137829 188 for(int i = 0; i < BPS_COUNT; i++)
va009039 0:b0f04c137829 189 {
va009039 0:b0f04c137829 190 if( !usb_bpBufAlloc[i] )
va009039 0:b0f04c137829 191 {
va009039 0:b0f04c137829 192 usb_bpBufAlloc[i] = 1;
va009039 0:b0f04c137829 193 return usb_bpBuf + i*BP_SIZE;
va009039 0:b0f04c137829 194 }
va009039 0:b0f04c137829 195 }
va009039 0:b0f04c137829 196 return NULL; //Could not alloc Buffer Page
va009039 0:b0f04c137829 197 }
va009039 0:b0f04c137829 198
va009039 0:b0f04c137829 199 int usb_bp_size()
va009039 0:b0f04c137829 200 {
va009039 0:b0f04c137829 201 return BP_SIZE;
va009039 0:b0f04c137829 202 }
va009039 0:b0f04c137829 203
va009039 0:b0f04c137829 204 void usb_free_ed(volatile byte* ed)
va009039 0:b0f04c137829 205 {
va009039 0:b0f04c137829 206 int i;
va009039 0:b0f04c137829 207 i = (ed - usb_edBuf) / ED_SIZE;
va009039 0:b0f04c137829 208 usb_edBufAlloc[i] = 0;
va009039 0:b0f04c137829 209 }
va009039 0:b0f04c137829 210
va009039 0:b0f04c137829 211 static void usb_free_utd(volatile uint8_t* utd)
va009039 0:b0f04c137829 212 {
va009039 0:b0f04c137829 213 DBG_ASSERT(utd >= usb_utdBuf);
va009039 0:b0f04c137829 214 DBG_ASSERT(utd <= (usb_utdBuf+UTD_SIZE*(UTDS_COUNT-1)));
va009039 0:b0f04c137829 215 DBG_ASSERT(((uint32_t)utd % 16) == 0);
va009039 0:b0f04c137829 216 int i = (utd - usb_utdBuf) / UTD_SIZE;
va009039 0:b0f04c137829 217 DBG_ASSERT(usb_utdBufAlloc[i] == 1);
va009039 0:b0f04c137829 218 usb_utdBufAlloc[i] = 0;
va009039 0:b0f04c137829 219 }
va009039 0:b0f04c137829 220
va009039 0:b0f04c137829 221 void usb_free_td(volatile byte* td)
va009039 0:b0f04c137829 222 {
va009039 0:b0f04c137829 223 usb_free_utd(td);
va009039 0:b0f04c137829 224 return;
va009039 0:b0f04c137829 225 }
va009039 0:b0f04c137829 226
va009039 0:b0f04c137829 227 void usb_free_itd(volatile byte* itd)
va009039 0:b0f04c137829 228 {
va009039 0:b0f04c137829 229 usb_free_utd(itd);
va009039 0:b0f04c137829 230 return;
va009039 0:b0f04c137829 231 }
va009039 0:b0f04c137829 232
va009039 0:b0f04c137829 233 void usb_free_bp(volatile byte* bp)
va009039 0:b0f04c137829 234 {
va009039 0:b0f04c137829 235 DBG_ASSERT(bp >= usb_bpBuf);
va009039 0:b0f04c137829 236 int i;
va009039 0:b0f04c137829 237 i = (bp - usb_bpBuf) / BP_SIZE;
va009039 0:b0f04c137829 238 DBG_ASSERT(usb_bpBufAlloc[i] == 1);
va009039 0:b0f04c137829 239 usb_bpBufAlloc[i] = 0;
va009039 0:b0f04c137829 240 }
va009039 0:b0f04c137829 241
va009039 0:b0f04c137829 242 bool usb_is_td(volatile byte* td)
va009039 0:b0f04c137829 243 {
va009039 0:b0f04c137829 244 DBG_ASSERT(td);
va009039 0:b0f04c137829 245 HCUTD* utd = (HCUTD*)td;
va009039 0:b0f04c137829 246 DBG_ASSERT(utd->type != 0);
va009039 0:b0f04c137829 247 return utd->type == 1;
va009039 0:b0f04c137829 248 }
va009039 0:b0f04c137829 249
va009039 0:b0f04c137829 250 bool usb_is_itd(volatile byte* itd)
va009039 0:b0f04c137829 251 {
va009039 0:b0f04c137829 252 DBG_ASSERT(itd);
va009039 0:b0f04c137829 253 HCUTD* utd = (HCUTD*)itd;
va009039 0:b0f04c137829 254 DBG_ASSERT(utd->type != 0);
va009039 0:b0f04c137829 255 return utd->type == 2;
va009039 0:b0f04c137829 256 }
va009039 3:3eb41d749f9a 257 #endif // USB_USE_MALLOC