Norimasa Okamoto / Mbed 2 deprecated WebcamServer

Webcam Server.

Dependencies:   uvchost FatFileSystem mbed HTTPServer NetServicesMin

usb/usb_mem.c@0:2b4ea8a138e5, 2012-06-06 (annotated)

Committer:
va009039
Date:
Wed Jun 06 11:47:06 2012 +0000
Revision:
0:2b4ea8a138e5

        

        
Who changed what in which revision?

        

            
                
UserRevisionLine numberNew contents of line

            
            


va009039

0:2b4ea8a138e5


     1







va009039

0:2b4ea8a138e5


     2

/*





va009039

0:2b4ea8a138e5


     3

Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)





va009039

0:2b4ea8a138e5


     4

 





va009039

0:2b4ea8a138e5


     5

Permission is hereby granted, free of charge, to any person obtaining a copy





va009039

0:2b4ea8a138e5


     6

of this software and associated documentation files (the "Software"), to deal





va009039

0:2b4ea8a138e5


     7

in the Software without restriction, including without limitation the rights





va009039

0:2b4ea8a138e5


     8

to use, copy, modify, merge, publish, distribute, sublicense, and/or sell





va009039

0:2b4ea8a138e5


     9

copies of the Software, and to permit persons to whom the Software is





va009039

0:2b4ea8a138e5


    10

furnished to do so, subject to the following conditions:





va009039

0:2b4ea8a138e5


    11

 





va009039

0:2b4ea8a138e5


    12

The above copyright notice and this permission notice shall be included in





va009039

0:2b4ea8a138e5


    13

all copies or substantial portions of the Software.





va009039

0:2b4ea8a138e5


    14

 





va009039

0:2b4ea8a138e5


    15

THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR





va009039

0:2b4ea8a138e5


    16

IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,





va009039

0:2b4ea8a138e5


    17

FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE





va009039

0:2b4ea8a138e5


    18

AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER





va009039

0:2b4ea8a138e5


    19

LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,





va009039

0:2b4ea8a138e5


    20

OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN





va009039

0:2b4ea8a138e5


    21

THE SOFTWARE.





va009039

0:2b4ea8a138e5


    22

*/





va009039

0:2b4ea8a138e5


    23

#include "mbed.h"





va009039

0:2b4ea8a138e5


    24

//#define __DEBUG





va009039

0:2b4ea8a138e5


    25

#include "mydbg.h"





va009039

0:2b4ea8a138e5


    26

#include "usb_mem.h"





va009039

0:2b4ea8a138e5


    27

#include "string.h" //For memcpy, memmove, memset





va009039

0:2b4ea8a138e5


    28

//#include "netCfg.h"





va009039

0:2b4ea8a138e5


    29

#include "UsbInc.h"





va009039

0:2b4ea8a138e5


    30







va009039

0:2b4ea8a138e5


    31

//#if NET_USB





va009039

0:2b4ea8a138e5


    32







va009039

0:2b4ea8a138e5


    33

#define EDS_COUNT 16





va009039

0:2b4ea8a138e5


    34

#define TDS_COUNT  0





va009039

0:2b4ea8a138e5


    35

#define ITDS_COUNT 0





va009039

0:2b4ea8a138e5


    36

#define UTDS_COUNT 32





va009039

0:2b4ea8a138e5


    37

#define BPS_COUNT 8





va009039

0:2b4ea8a138e5


    38







va009039

0:2b4ea8a138e5


    39

#define HCCA_SIZE 0x100





va009039

0:2b4ea8a138e5


    40

#define ED_SIZE 0x10





va009039

0:2b4ea8a138e5


    41

#define TD_SIZE 0x10





va009039

0:2b4ea8a138e5


    42

#define ITD_SIZE 0x20





va009039

0:2b4ea8a138e5


    43

#define UTD_SIZE (32+16)





va009039

0:2b4ea8a138e5


    44

#define BP_SIZE  (128*8)





va009039

0:2b4ea8a138e5


    45







va009039

0:2b4ea8a138e5


    46

#define TOTAL_SIZE (HCCA_SIZE + (EDS_COUNT*ED_SIZE) + (TDS_COUNT*TD_SIZE) + (ITDS_COUNT*ITD_SIZE))





va009039

0:2b4ea8a138e5


    47







va009039

0:2b4ea8a138e5


    48

static volatile __align(256) byte usb_buf[TOTAL_SIZE] __attribute((section("AHBSRAM0"),aligned));  //256 bytes aligned!





va009039

0:2b4ea8a138e5


    49

static volatile __align(32) uint8_t usb_utdBuf[UTDS_COUNT*UTD_SIZE] __attribute((section("AHBSRAM0"),aligned));





va009039

0:2b4ea8a138e5


    50







va009039

0:2b4ea8a138e5


    51

static volatile byte* usb_hcca;  //256 bytes aligned!





va009039

0:2b4ea8a138e5


    52







va009039

0:2b4ea8a138e5


    53

static volatile byte* usb_edBuf;  //4 bytes aligned!





va009039

0:2b4ea8a138e5


    54







va009039

0:2b4ea8a138e5


    55

static byte usb_edBufAlloc[EDS_COUNT] __attribute((section("AHBSRAM0"),aligned));





va009039

0:2b4ea8a138e5


    56

static uint8_t usb_utdBufAlloc[UTDS_COUNT] __attribute((section("AHBSRAM0"),aligned));





va009039

0:2b4ea8a138e5


    57

static uint8_t usb_bpBufAlloc[BPS_COUNT] __attribute((section("AHBSRAM0"),aligned));





va009039

0:2b4ea8a138e5


    58

static uint8_t usb_bpBuf[BP_SIZE*BPS_COUNT] __attribute((section("AHBSRAM0"),aligned));





va009039

0:2b4ea8a138e5


    59







va009039

0:2b4ea8a138e5


    60

static void utd_init()





va009039

0:2b4ea8a138e5


    61

{





va009039

0:2b4ea8a138e5


    62

    DBG_ASSERT(sizeof(HCTD) == 16);





va009039

0:2b4ea8a138e5


    63

    DBG_ASSERT(sizeof(HCITD) == 32);





va009039

0:2b4ea8a138e5


    64

    DBG_ASSERT(sizeof(HCUTD) == 48);





va009039

0:2b4ea8a138e5


    65







va009039

0:2b4ea8a138e5


    66

    DBG_ASSERT(((uint32_t)usb_utdBuf % 16) == 0);





va009039

0:2b4ea8a138e5


    67

    DBG_ASSERT(((uint32_t)usb_utdBuf % 32) == 0);





va009039

0:2b4ea8a138e5


    68







va009039

0:2b4ea8a138e5


    69

    DBG_ASSERT((uint32_t)usb_utdBufAlloc >= 0x2007c000);





va009039

0:2b4ea8a138e5


    70

    DBG_ASSERT((uint32_t)&usb_utdBufAlloc[UTDS_COUNT] <= 0x2007ffff);





va009039

0:2b4ea8a138e5


    71







va009039

0:2b4ea8a138e5


    72

    DBG_ASSERT((uint32_t)usb_utdBuf >= 0x2007c000);





va009039

0:2b4ea8a138e5


    73

    DBG_ASSERT((uint32_t)&usb_utdBuf[UTD_SIZE*UTDS_COUNT] <= 0x2007cfff);





va009039

0:2b4ea8a138e5


    74







va009039

0:2b4ea8a138e5


    75

    memset(usb_utdBufAlloc, 0x00, UTDS_COUNT);





va009039

0:2b4ea8a138e5


    76

}





va009039

0:2b4ea8a138e5


    77







va009039

0:2b4ea8a138e5


    78

static void pb_init()





va009039

0:2b4ea8a138e5


    79

{





va009039

0:2b4ea8a138e5


    80

    memset(usb_bpBufAlloc, 0x00, BPS_COUNT);





va009039

0:2b4ea8a138e5


    81







va009039

0:2b4ea8a138e5


    82

    DBG_ASSERT((uint32_t)usb_bpBufAlloc >= 0x2007c000);





va009039

0:2b4ea8a138e5


    83

    DBG_ASSERT((uint32_t)&usb_bpBufAlloc[BPS_COUNT] <= 0x2007ffff);





va009039

0:2b4ea8a138e5


    84

    DBG_ASSERT((uint32_t)usb_bpBuf >= 0x2007c000);





va009039

0:2b4ea8a138e5


    85

    DBG_ASSERT((uint32_t)(&usb_bpBuf[BP_SIZE*BPS_COUNT]) <= 0x2007ffff);





va009039

0:2b4ea8a138e5


    86

}





va009039

0:2b4ea8a138e5


    87







va009039

0:2b4ea8a138e5


    88

void usb_mem_init()





va009039

0:2b4ea8a138e5


    89

{





va009039

0:2b4ea8a138e5


    90

  usb_hcca = usb_buf;





va009039

0:2b4ea8a138e5


    91

  usb_edBuf = usb_buf + HCCA_SIZE;





va009039

0:2b4ea8a138e5


    92

  memset(usb_edBufAlloc, 0, EDS_COUNT);





va009039

0:2b4ea8a138e5


    93







va009039

0:2b4ea8a138e5


    94

  utd_init();





va009039

0:2b4ea8a138e5


    95

  pb_init();





va009039

0:2b4ea8a138e5


    96







va009039

0:2b4ea8a138e5


    97

  DBG("--- Memory Map --- \n");





va009039

0:2b4ea8a138e5


    98

  DBG("usb_hcca       =%p\n", usb_hcca);





va009039

0:2b4ea8a138e5


    99

  DBG("usb_edBuf      =%p\n", usb_edBuf);





va009039

0:2b4ea8a138e5


   100

  DBG("usb_utdBuf     =%p\n", usb_utdBuf);





va009039

0:2b4ea8a138e5


   101

  DBG("usb_edBufAlloc =%p\n", usb_edBufAlloc);





va009039

0:2b4ea8a138e5


   102

  DBG("usb_utdBufAlloc=%p\n", usb_utdBufAlloc);





va009039

0:2b4ea8a138e5


   103

  DBG("usb_bpBufAlloc =%p\n", usb_bpBufAlloc);





va009039

0:2b4ea8a138e5


   104

  DBG("usb_bpBuf      =%p\n", usb_bpBuf);





va009039

0:2b4ea8a138e5


   105

  DBG("               =%p\n", &usb_bpBuf[BP_SIZE*BPS_COUNT]);





va009039

0:2b4ea8a138e5


   106

  DBG_ASSERT(((uint32_t)usb_hcca % 256) == 0);





va009039

0:2b4ea8a138e5


   107

  DBG_ASSERT(((uint32_t)usb_edBuf % 16) == 0);





va009039

0:2b4ea8a138e5


   108

  DBG_ASSERT(((uint32_t)usb_utdBuf % 32) == 0);





va009039

0:2b4ea8a138e5


   109

}





va009039

0:2b4ea8a138e5


   110







va009039

0:2b4ea8a138e5


   111

volatile byte* usb_get_hcca()





va009039

0:2b4ea8a138e5


   112

{





va009039

0:2b4ea8a138e5


   113

  return usb_hcca;





va009039

0:2b4ea8a138e5


   114

}





va009039

0:2b4ea8a138e5


   115







va009039

0:2b4ea8a138e5


   116

volatile byte* usb_get_ed()





va009039

0:2b4ea8a138e5


   117

{





va009039

0:2b4ea8a138e5


   118

  int i;





va009039

0:2b4ea8a138e5


   119

  for(i = 0; i < EDS_COUNT; i++)





va009039

0:2b4ea8a138e5


   120

  {





va009039

0:2b4ea8a138e5


   121

    if( !usb_edBufAlloc[i] )





va009039

0:2b4ea8a138e5


   122

    {





va009039

0:2b4ea8a138e5


   123

      usb_edBufAlloc[i] = 1;





va009039

0:2b4ea8a138e5


   124

      return usb_edBuf + i*ED_SIZE;





va009039

0:2b4ea8a138e5


   125

    }





va009039

0:2b4ea8a138e5


   126

  }





va009039

0:2b4ea8a138e5


   127

  return NULL; //Could not alloc ED





va009039

0:2b4ea8a138e5


   128

}





va009039

0:2b4ea8a138e5


   129







va009039

0:2b4ea8a138e5


   130

static uint8_t* usb_get_utd(int al)





va009039

0:2b4ea8a138e5


   131

{





va009039

0:2b4ea8a138e5


   132

    DBG_ASSERT(al == 16 || al == 32); // GTD or ITD





va009039

0:2b4ea8a138e5


   133

    if (al == 16) {





va009039

0:2b4ea8a138e5


   134

        for(int i = 1; i < UTDS_COUNT; i += 2) {





va009039

0:2b4ea8a138e5


   135

            if (usb_utdBufAlloc[i] == 0) {





va009039

0:2b4ea8a138e5


   136

                uint32_t p = (uint32_t)usb_utdBuf + i * UTD_SIZE;





va009039

0:2b4ea8a138e5


   137

                if ((p % al) == 0) {





va009039

0:2b4ea8a138e5


   138

                    usb_utdBufAlloc[i] = 1;





va009039

0:2b4ea8a138e5


   139

                    DBG_ASSERT((p % al) == 0);





va009039

0:2b4ea8a138e5


   140

                    return (uint8_t*)p;





va009039

0:2b4ea8a138e5


   141

                }





va009039

0:2b4ea8a138e5


   142

            }





va009039

0:2b4ea8a138e5


   143

        }





va009039

0:2b4ea8a138e5


   144

    }





va009039

0:2b4ea8a138e5


   145

    for(int i = 0; i < UTDS_COUNT; i++) {





va009039

0:2b4ea8a138e5


   146

        if (usb_utdBufAlloc[i] == 0) {





va009039

0:2b4ea8a138e5


   147

            uint32_t p = (uint32_t)usb_utdBuf + i * UTD_SIZE;





va009039

0:2b4ea8a138e5


   148

            if ((p % al) == 0) {





va009039

0:2b4ea8a138e5


   149

                usb_utdBufAlloc[i] = 1;





va009039

0:2b4ea8a138e5


   150

                DBG_ASSERT((p % al) == 0);





va009039

0:2b4ea8a138e5


   151

                return (uint8_t*)p;





va009039

0:2b4ea8a138e5


   152

            }





va009039

0:2b4ea8a138e5


   153

        }





va009039

0:2b4ea8a138e5


   154

    }





va009039

0:2b4ea8a138e5


   155

    return NULL;





va009039

0:2b4ea8a138e5


   156

}





va009039

0:2b4ea8a138e5


   157







va009039

0:2b4ea8a138e5


   158

volatile byte* usb_get_td(uint32_t endpoint)





va009039

0:2b4ea8a138e5


   159

{





va009039

0:2b4ea8a138e5


   160

    DBG_ASSERT(endpoint);





va009039

0:2b4ea8a138e5


   161

    uint8_t* td = usb_get_utd(16);





va009039

0:2b4ea8a138e5


   162

    if (td) {





va009039

0:2b4ea8a138e5


   163

        HCUTD* utd = (HCUTD*)td;





va009039

0:2b4ea8a138e5


   164

        memset(utd, 0x00, sizeof(HCTD));





va009039

0:2b4ea8a138e5


   165

        utd->type = 1;





va009039

0:2b4ea8a138e5


   166

        utd->UsbEndpoint = endpoint;





va009039

0:2b4ea8a138e5


   167

    }





va009039

0:2b4ea8a138e5


   168

    return td;





va009039

0:2b4ea8a138e5


   169

}





va009039

0:2b4ea8a138e5


   170







va009039

0:2b4ea8a138e5


   171

volatile byte* usb_get_itd(uint32_t endpoint)





va009039

0:2b4ea8a138e5


   172

{





va009039

0:2b4ea8a138e5


   173

    DBG_ASSERT(endpoint);





va009039

0:2b4ea8a138e5


   174

    uint8_t* itd = usb_get_utd(32);





va009039

0:2b4ea8a138e5


   175

    if (itd) {





va009039

0:2b4ea8a138e5


   176

        HCUTD* utd = (HCUTD*)itd;





va009039

0:2b4ea8a138e5


   177

        memset(utd, 0x00, sizeof(HCITD));





va009039

0:2b4ea8a138e5


   178

        utd->type = 2;





va009039

0:2b4ea8a138e5


   179

        utd->UsbEndpoint = endpoint;





va009039

0:2b4ea8a138e5


   180

    }





va009039

0:2b4ea8a138e5


   181

    return itd;





va009039

0:2b4ea8a138e5


   182

}





va009039

0:2b4ea8a138e5


   183







va009039

0:2b4ea8a138e5


   184

volatile byte* usb_get_bp(int size)





va009039

0:2b4ea8a138e5


   185

{





va009039

0:2b4ea8a138e5


   186

  DBG_ASSERT(size >= 128 && size <= BP_SIZE);





va009039

0:2b4ea8a138e5


   187

  if (size > BP_SIZE) {





va009039

0:2b4ea8a138e5


   188

      return NULL;





va009039

0:2b4ea8a138e5


   189

  }    





va009039

0:2b4ea8a138e5


   190

  for(int i = 0; i < BPS_COUNT; i++)





va009039

0:2b4ea8a138e5


   191

  {





va009039

0:2b4ea8a138e5


   192

    if( !usb_bpBufAlloc[i] )





va009039

0:2b4ea8a138e5


   193

    {





va009039

0:2b4ea8a138e5


   194

      usb_bpBufAlloc[i] = 1;





va009039

0:2b4ea8a138e5


   195

      return usb_bpBuf + i*BP_SIZE;





va009039

0:2b4ea8a138e5


   196

    }





va009039

0:2b4ea8a138e5


   197

  }





va009039

0:2b4ea8a138e5


   198

  return NULL; //Could not alloc Buffer Page





va009039

0:2b4ea8a138e5


   199

}





va009039

0:2b4ea8a138e5


   200







va009039

0:2b4ea8a138e5


   201

int usb_bp_size()





va009039

0:2b4ea8a138e5


   202

{





va009039

0:2b4ea8a138e5


   203

    return BP_SIZE; 





va009039

0:2b4ea8a138e5


   204

}





va009039

0:2b4ea8a138e5


   205







va009039

0:2b4ea8a138e5


   206

void usb_free_ed(volatile byte* ed)





va009039

0:2b4ea8a138e5


   207

{





va009039

0:2b4ea8a138e5


   208

  int i;





va009039

0:2b4ea8a138e5


   209

  i = (ed - usb_edBuf) / ED_SIZE;





va009039

0:2b4ea8a138e5


   210

  usb_edBufAlloc[i] = 0;





va009039

0:2b4ea8a138e5


   211

}





va009039

0:2b4ea8a138e5


   212







va009039

0:2b4ea8a138e5


   213

static void usb_free_utd(volatile uint8_t* utd)





va009039

0:2b4ea8a138e5


   214

{





va009039

0:2b4ea8a138e5


   215

  DBG_ASSERT(utd >= usb_utdBuf);





va009039

0:2b4ea8a138e5


   216

  DBG_ASSERT(utd <= (usb_utdBuf+UTD_SIZE*(UTDS_COUNT-1)));





va009039

0:2b4ea8a138e5


   217

  DBG_ASSERT(((uint32_t)utd % 16) == 0);





va009039

0:2b4ea8a138e5


   218

  int i = (utd - usb_utdBuf) / UTD_SIZE;





va009039

0:2b4ea8a138e5


   219

  DBG_ASSERT(usb_utdBufAlloc[i] == 1);





va009039

0:2b4ea8a138e5


   220

  usb_utdBufAlloc[i] = 0;





va009039

0:2b4ea8a138e5


   221

}





va009039

0:2b4ea8a138e5


   222







va009039

0:2b4ea8a138e5


   223

void usb_free_td(volatile byte* td)





va009039

0:2b4ea8a138e5


   224

{





va009039

0:2b4ea8a138e5


   225

    usb_free_utd(td);





va009039

0:2b4ea8a138e5


   226

    return;





va009039

0:2b4ea8a138e5


   227

}





va009039

0:2b4ea8a138e5


   228







va009039

0:2b4ea8a138e5


   229

void usb_free_itd(volatile byte* itd)





va009039

0:2b4ea8a138e5


   230

{





va009039

0:2b4ea8a138e5


   231

    usb_free_utd(itd);





va009039

0:2b4ea8a138e5


   232

    return;





va009039

0:2b4ea8a138e5


   233

}





va009039

0:2b4ea8a138e5


   234







va009039

0:2b4ea8a138e5


   235

void usb_free_bp(volatile byte* bp)





va009039

0:2b4ea8a138e5


   236

{





va009039

0:2b4ea8a138e5


   237

  DBG_ASSERT(bp >= usb_bpBuf);





va009039

0:2b4ea8a138e5


   238

  int i;





va009039

0:2b4ea8a138e5


   239

  i = (bp - usb_bpBuf) / BP_SIZE;





va009039

0:2b4ea8a138e5


   240

  DBG_ASSERT(usb_bpBufAlloc[i] == 1);





va009039

0:2b4ea8a138e5


   241

  usb_bpBufAlloc[i] = 0;





va009039

0:2b4ea8a138e5


   242

}





va009039

0:2b4ea8a138e5


   243







va009039

0:2b4ea8a138e5


   244

bool usb_is_td(volatile byte* td)





va009039

0:2b4ea8a138e5


   245

{





va009039

0:2b4ea8a138e5


   246

    DBG_ASSERT(td);





va009039

0:2b4ea8a138e5


   247

    HCUTD* utd = (HCUTD*)td;





va009039

0:2b4ea8a138e5


   248

    DBG_ASSERT(utd->type != 0);





va009039

0:2b4ea8a138e5


   249

    return utd->type == 1;





va009039

0:2b4ea8a138e5


   250

}





va009039

0:2b4ea8a138e5


   251







va009039

0:2b4ea8a138e5


   252

bool usb_is_itd(volatile byte* itd)





va009039

0:2b4ea8a138e5


   253

{





va009039

0:2b4ea8a138e5


   254

    DBG_ASSERT(itd);





va009039

0:2b4ea8a138e5


   255

    HCUTD* utd = (HCUTD*)itd;





va009039

0:2b4ea8a138e5


   256

    DBG_ASSERT(utd->type != 0);





va009039

0:2b4ea8a138e5


   257

    return utd->type == 2;





va009039

0:2b4ea8a138e5


   258

}





va009039

0:2b4ea8a138e5


   259







va009039

0:2b4ea8a138e5


   260

//#endif