usbd_user_msc.c

00001 #include <rl_usb.h>
00002 
00003 // from USBMSD_Ram.cpp http://mbed.org/users/samux/code/RAM_DISK/
00004 //5 sectors
00005 const uint8_t disk_image_0[] = {
00006     //sector 0: boot sector
00007     0xEB,0x3C,0x90,0x4D,0x53,0x44,0x4F,0x53,0x35,0x2E,0x30,    0x00,0x02,/*bytes per sector: 512*/   0x08, /*sectors per cluster*/ 0x01,0x00,/*number of reserved sector*/
00008     0x01, /* number of FATs*/ 0x10,0x00, /*Maximum number of root directory entries: 16*/ 0x20,0x00, /*Total sector count: 32*/ 0xF0,  0x02,0x00,/*sectors per FAT: 2*/  0x01,0x00,/*Sectors per track*/  0x01,0x00, /*Number of heads*/  0x00,0x00,0x00,0x00,
00009     0x00,0x01,0x00,0x00,0x00,0x00,  0x29, /*boot signature*/ 0x74,0x19,0x02,0x27, /*volume ID*/ 'M','b','e','d',' ',
00010     'U','S','B',' ',' ',' ', /*volume label: Mbed USB*/     0x46,0x41,0x54,0x31,0x32,0x20,0x20,0x20,0x33,0xC9,
00011     0x8E,0xD1,0xBC,0xF0,0x7B,0x8E,0xD9,0xB8,0x00,0x20,0x8E,0xC0,0xFC,0xBD,0x00,0x7C,
00012     0x38,0x4E,0x24,0x7D,0x24,0x8B,0xC1,0x99,0xE8,0x3C,0x01,0x72,0x1C,0x83,0xEB,0x3A,
00013     0x66,0xA1,0x1C,0x7C,0x26,0x66,0x3B,0x07,0x26,0x8A,0x57,0xFC,0x75,0x06,0x80,0xCA,
00014     0x02,0x88,0x56,0x02,0x80,0xC3,0x10,0x73,0xEB,0x33,0xC9,0x8A,0x46,0x10,0x98,0xF7,
00015     0x66,0x16,0x03,0x46,0x1C,0x13,0x56,0x1E,0x03,0x46,0x0E,0x13,0xD1,0x8B,0x76,0x11,
00016     0x60,0x89,0x46,0xFC,0x89,0x56,0xFE,0xB8,0x20,0x00,0xF7,0xE6,0x8B,0x5E,0x0B,0x03,
00017     0xC3,0x48,0xF7,0xF3,0x01,0x46,0xFC,0x11,0x4E,0xFE,0x61,0xBF,0x00,0x00,0xE8,0xE6,
00018     0x00,0x72,0x39,0x26,0x38,0x2D,0x74,0x17,0x60,0xB1,0x0B,0xBE,0xA1,0x7D,0xF3,0xA6,
00019     0x61,0x74,0x32,0x4E,0x74,0x09,0x83,0xC7,0x20,0x3B,0xFB,0x72,0xE6,0xEB,0xDC,0xA0,
00020     0xFB,0x7D,0xB4,0x7D,0x8B,0xF0,0xAC,0x98,0x40,0x74,0x0C,0x48,0x74,0x13,0xB4,0x0E,
00021     0xBB,0x07,0x00,0xCD,0x10,0xEB,0xEF,0xA0,0xFD,0x7D,0xEB,0xE6,0xA0,0xFC,0x7D,0xEB,
00022     0xE1,0xCD,0x16,0xCD,0x19,0x26,0x8B,0x55,0x1A,0x52,0xB0,0x01,0xBB,0x00,0x00,0xE8,
00023     0x3B,0x00,0x72,0xE8,0x5B,0x8A,0x56,0x24,0xBE,0x0B,0x7C,0x8B,0xFC,0xC7,0x46,0xF0,
00024     0x3D,0x7D,0xC7,0x46,0xF4,0x29,0x7D,0x8C,0xD9,0x89,0x4E,0xF2,0x89,0x4E,0xF6,0xC6,
00025     0x06,0x96,0x7D,0xCB,0xEA,0x03,0x00,0x00,0x20,0x0F,0xB6,0xC8,0x66,0x8B,0x46,0xF8,
00026     0x66,0x03,0x46,0x1C,0x66,0x8B,0xD0,0x66,0xC1,0xEA,0x10,0xEB,0x5E,0x0F,0xB6,0xC8,
00027     0x4A,0x4A,0x8A,0x46,0x0D,0x32,0xE4,0xF7,0xE2,0x03,0x46,0xFC,0x13,0x56,0xFE,0xEB,
00028     0x4A,0x52,0x50,0x06,0x53,0x6A,0x01,0x6A,0x10,0x91,0x8B,0x46,0x18,0x96,0x92,0x33,
00029     0xD2,0xF7,0xF6,0x91,0xF7,0xF6,0x42,0x87,0xCA,0xF7,0x76,0x1A,0x8A,0xF2,0x8A,0xE8,
00030     0xC0,0xCC,0x02,0x0A,0xCC,0xB8,0x01,0x02,0x80,0x7E,0x02,0x0E,0x75,0x04,0xB4,0x42,
00031     0x8B,0xF4,0x8A,0x56,0x24,0xCD,0x13,0x61,0x61,0x72,0x0B,0x40,0x75,0x01,0x42,0x03,
00032     0x5E,0x0B,0x49,0x75,0x06,0xF8,0xC3,0x41,0xBB,0x00,0x00,0x60,0x66,0x6A,0x00,0xEB,
00033     0xB0,0x4E,0x54,0x4C,0x44,0x52,0x20,0x20,0x20,0x20,0x20,0x20,0x0D,0x0A,0x52,0x65,
00034     0x6D,0x6F,0x76,0x65,0x20,0x64,0x69,0x73,0x6B,0x73,0x20,0x6F,0x72,0x20,0x6F,0x74,
00035     0x68,0x65,0x72,0x20,0x6D,0x65,0x64,0x69,0x61,0x2E,0xFF,0x0D,0x0A,0x44,0x69,0x73,
00036     0x6B,0x20,0x65,0x72,0x72,0x6F,0x72,0xFF,0x0D,0x0A,0x50,0x72,0x65,0x73,0x73,0x20,
00037     0x61,0x6E,0x79,0x20,0x6B,0x65,0x79,0x20,0x74,0x6F,0x20,0x72,0x65,0x73,0x74,0x61,
00038     0x72,0x74,0x0D,0x0A,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xAC,0xCB,0xD8,0x55,0xAA,
00039 };
00040 
00041 const uint8_t disk_image_1[] = {
00042     //sector 1: FAT 1
00043     0xF8,0xFF,0xFF,0xFF,0xFF,0xFF,0xFF,0x0F,
00044 };
00045 
00046 const uint8_t disk_image_2[] = {    
00047     //sector 2: FAT1: two sectors per FAT
00048 };
00049 
00050 const uint8_t disk_image_3[] = {     
00051     //sector 3: root directory
00052     //entry 1
00053     'M','b','e','d',' ','U','S','B',' ',' ',' ',   0x28,0x00,0x00,0x00,0x00,
00054     0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
00055     //entry 2
00056     0x52,0x45,0x41,0x44,0x4D,0x45,0x20,0x20,0x54,0x58,0x54, /*readme.txt*/ 0x20,0x00,0x00,0x00,0x00,
00057     0x21,0x00,0xBB,0x32,0x00,0x00,   0xDC,0x83,/*hour/min/doublesec*/  0x6A,0x3F,/*year/month/day*/  0x02,0x00, /*starting cluster*/ 0x1e,0x00,0x00,0x00, /*size*/
00058 };
00059     
00060 const uint8_t disk_image_4[] = {    
00061     //sector 4: data
00062     'H','e','l','l','o',' ','f','r','o','m',' ','M','b','e','d','!',
00063     '\r','\n','U','S','B',' ','M','S','D',' ','d','e','m','o',
00064 };
00065 
00066 #define SLOT_SIZE 48
00067 static int slot[SLOT_SIZE];
00068 static uint8_t image[SLOT_SIZE][512];
00069 
00070 static int index_block(int block) {
00071     int i;
00072     for(i = 0; i < SLOT_SIZE; i++) {
00073         if (slot[i] == block) {
00074             return i;
00075         }
00076     }
00077     return -1;
00078 }
00079 
00080 static int block_len(uint8_t* buf) {
00081     int i;
00082     for(i = 512-1; i >= 0; i--) {
00083         if (buf[i] != 0x00) {
00084             return i+1;
00085         }
00086     }
00087     return 0;
00088 }
00089 
00090 static void mem_cpy(uint8_t* dst, const uint8_t* src, int size)
00091 {
00092     while(size-- > 0) {
00093         *dst++ = *src++;
00094     }
00095 }
00096 
00097 static void mem_set(uint8_t* dst, uint8_t dat, int size)
00098 {
00099     while(size-- > 0) {
00100         *dst++ = dat;
00101     }
00102 }
00103    
00104 void usbd_msc_read_sect(uint32_t block, uint8_t *buf, uint32_t num_of_blocks)
00105 {
00106     int i;
00107     i = index_block(block);
00108     if (i != (-1)) {
00109         mem_cpy(buf, image[i], 512);
00110     } else {
00111         mem_set(buf, 0x00, 512);
00112     }
00113 }
00114 
00115 void usbd_msc_write_sect(uint32_t block, uint8_t *buf, uint32_t num_of_blocks)
00116 {
00117     int i, len;
00118     len = block_len(buf);
00119     i = index_block(block);
00120     if (i != -1) {
00121         if (len == 0) {
00122             slot[i] = -1;
00123         } else {
00124             mem_cpy(image[i], buf, 512);
00125         }
00126     } else {
00127         if (len != 0) {
00128             for(i = 0; i < SLOT_SIZE; i++) {
00129                 if (slot[i] == (-1)) {
00130                     slot[i] = block;
00131                     mem_cpy(image[i], buf, 512);
00132                     break;
00133                 }
00134             }
00135         }
00136     }
00137 }
00138 
00139 void usbd_msc_init () {
00140     int i;
00141     for(i = 0; i < SLOT_SIZE; i++) {
00142         slot[i] = -1;
00143         mem_set(image[i], 0, 512);
00144     }
00145     for(i = 0; i < 5; i++) {
00146         slot[i] = i;
00147     }
00148     mem_cpy(image[0], disk_image_0, sizeof(disk_image_0));
00149     mem_cpy(image[1], disk_image_1, sizeof(disk_image_1));
00150     mem_cpy(image[2], disk_image_2, sizeof(disk_image_2));
00151     mem_cpy(image[3], disk_image_3, sizeof(disk_image_3));
00152     mem_cpy(image[4], disk_image_4, sizeof(disk_image_4));
00153     
00154     USBD_MSC_MemorySize = 65536;
00155     USBD_MSC_BlockSize  = 512;
00156     USBD_MSC_BlockGroup = 1;
00157     USBD_MSC_BlockCount = USBD_MSC_MemorySize / USBD_MSC_BlockSize;
00158     //USBD_MSC_BlockBuf   = (uint8_t *)usb_buffer;
00159     //USBD_MSC_MediaReady = __TRUE;
00160 }