Ken Todotani / Mbed 2 deprecated BTstackLE

BLE demo for mbed Ported RunningElectronics's SBDBT firmware for BLE. It can communicate with iOS

Dependencies:   FatFileSystem mbed

Fork of BTstack by Norimasa Okamoto

usb/usb_mem.c@6:cf06ba884429, 2013-02-20 (annotated)

Committer:
todotani
Date:
Wed Feb 20 14:18:38 2013 +0000
Revision:
6:cf06ba884429
Parent:
0:1ed23ab1345f 
Change tick timer to 1ms. Change attribute 0xFFF1 as read of DigitalIn p5

Who changed what in which revision?

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