USB Device ROM Stack API example program

Dependencies:   mbed

LPC1549のROM APIを使ったRAMディスクです。PCからはUSBメモリとして見えます。

参考:
http://docs.lpcware.com/usbromlib/v1.0/

usbd_user_msc.c

Committer:
va009039
Date:
2014-03-14
Revision:
0:ef2c0c52abc4

File content as of revision 0:ef2c0c52abc4:

#include <rl_usb.h>

// from USBMSD_Ram.cpp http://mbed.org/users/samux/code/RAM_DISK/
//5 sectors
const uint8_t disk_image_0[] = {
    //sector 0: boot sector
    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*/
    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,
    0x00,0x01,0x00,0x00,0x00,0x00,  0x29, /*boot signature*/ 0x74,0x19,0x02,0x27, /*volume ID*/ 'M','b','e','d',' ',
    'U','S','B',' ',' ',' ', /*volume label: Mbed USB*/     0x46,0x41,0x54,0x31,0x32,0x20,0x20,0x20,0x33,0xC9,
    0x8E,0xD1,0xBC,0xF0,0x7B,0x8E,0xD9,0xB8,0x00,0x20,0x8E,0xC0,0xFC,0xBD,0x00,0x7C,
    0x38,0x4E,0x24,0x7D,0x24,0x8B,0xC1,0x99,0xE8,0x3C,0x01,0x72,0x1C,0x83,0xEB,0x3A,
    0x66,0xA1,0x1C,0x7C,0x26,0x66,0x3B,0x07,0x26,0x8A,0x57,0xFC,0x75,0x06,0x80,0xCA,
    0x02,0x88,0x56,0x02,0x80,0xC3,0x10,0x73,0xEB,0x33,0xC9,0x8A,0x46,0x10,0x98,0xF7,
    0x66,0x16,0x03,0x46,0x1C,0x13,0x56,0x1E,0x03,0x46,0x0E,0x13,0xD1,0x8B,0x76,0x11,
    0x60,0x89,0x46,0xFC,0x89,0x56,0xFE,0xB8,0x20,0x00,0xF7,0xE6,0x8B,0x5E,0x0B,0x03,
    0xC3,0x48,0xF7,0xF3,0x01,0x46,0xFC,0x11,0x4E,0xFE,0x61,0xBF,0x00,0x00,0xE8,0xE6,
    0x00,0x72,0x39,0x26,0x38,0x2D,0x74,0x17,0x60,0xB1,0x0B,0xBE,0xA1,0x7D,0xF3,0xA6,
    0x61,0x74,0x32,0x4E,0x74,0x09,0x83,0xC7,0x20,0x3B,0xFB,0x72,0xE6,0xEB,0xDC,0xA0,
    0xFB,0x7D,0xB4,0x7D,0x8B,0xF0,0xAC,0x98,0x40,0x74,0x0C,0x48,0x74,0x13,0xB4,0x0E,
    0xBB,0x07,0x00,0xCD,0x10,0xEB,0xEF,0xA0,0xFD,0x7D,0xEB,0xE6,0xA0,0xFC,0x7D,0xEB,
    0xE1,0xCD,0x16,0xCD,0x19,0x26,0x8B,0x55,0x1A,0x52,0xB0,0x01,0xBB,0x00,0x00,0xE8,
    0x3B,0x00,0x72,0xE8,0x5B,0x8A,0x56,0x24,0xBE,0x0B,0x7C,0x8B,0xFC,0xC7,0x46,0xF0,
    0x3D,0x7D,0xC7,0x46,0xF4,0x29,0x7D,0x8C,0xD9,0x89,0x4E,0xF2,0x89,0x4E,0xF6,0xC6,
    0x06,0x96,0x7D,0xCB,0xEA,0x03,0x00,0x00,0x20,0x0F,0xB6,0xC8,0x66,0x8B,0x46,0xF8,
    0x66,0x03,0x46,0x1C,0x66,0x8B,0xD0,0x66,0xC1,0xEA,0x10,0xEB,0x5E,0x0F,0xB6,0xC8,
    0x4A,0x4A,0x8A,0x46,0x0D,0x32,0xE4,0xF7,0xE2,0x03,0x46,0xFC,0x13,0x56,0xFE,0xEB,
    0x4A,0x52,0x50,0x06,0x53,0x6A,0x01,0x6A,0x10,0x91,0x8B,0x46,0x18,0x96,0x92,0x33,
    0xD2,0xF7,0xF6,0x91,0xF7,0xF6,0x42,0x87,0xCA,0xF7,0x76,0x1A,0x8A,0xF2,0x8A,0xE8,
    0xC0,0xCC,0x02,0x0A,0xCC,0xB8,0x01,0x02,0x80,0x7E,0x02,0x0E,0x75,0x04,0xB4,0x42,
    0x8B,0xF4,0x8A,0x56,0x24,0xCD,0x13,0x61,0x61,0x72,0x0B,0x40,0x75,0x01,0x42,0x03,
    0x5E,0x0B,0x49,0x75,0x06,0xF8,0xC3,0x41,0xBB,0x00,0x00,0x60,0x66,0x6A,0x00,0xEB,
    0xB0,0x4E,0x54,0x4C,0x44,0x52,0x20,0x20,0x20,0x20,0x20,0x20,0x0D,0x0A,0x52,0x65,
    0x6D,0x6F,0x76,0x65,0x20,0x64,0x69,0x73,0x6B,0x73,0x20,0x6F,0x72,0x20,0x6F,0x74,
    0x68,0x65,0x72,0x20,0x6D,0x65,0x64,0x69,0x61,0x2E,0xFF,0x0D,0x0A,0x44,0x69,0x73,
    0x6B,0x20,0x65,0x72,0x72,0x6F,0x72,0xFF,0x0D,0x0A,0x50,0x72,0x65,0x73,0x73,0x20,
    0x61,0x6E,0x79,0x20,0x6B,0x65,0x79,0x20,0x74,0x6F,0x20,0x72,0x65,0x73,0x74,0x61,
    0x72,0x74,0x0D,0x0A,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xAC,0xCB,0xD8,0x55,0xAA,
};

const uint8_t disk_image_1[] = {
    //sector 1: FAT 1
    0xF8,0xFF,0xFF,0xFF,0xFF,0xFF,0xFF,0x0F,
};

const uint8_t disk_image_2[] = {    
    //sector 2: FAT1: two sectors per FAT
};

const uint8_t disk_image_3[] = {     
    //sector 3: root directory
    //entry 1
    'M','b','e','d',' ','U','S','B',' ',' ',' ',   0x28,0x00,0x00,0x00,0x00,
    0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
    //entry 2
    0x52,0x45,0x41,0x44,0x4D,0x45,0x20,0x20,0x54,0x58,0x54, /*readme.txt*/ 0x20,0x00,0x00,0x00,0x00,
    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*/
};
    
const uint8_t disk_image_4[] = {    
    //sector 4: data
    'H','e','l','l','o',' ','f','r','o','m',' ','M','b','e','d','!',
    '\r','\n','U','S','B',' ','M','S','D',' ','d','e','m','o',
};

#define SLOT_SIZE 48
static int slot[SLOT_SIZE];
static uint8_t image[SLOT_SIZE][512];

static int index_block(int block) {
    int i;
    for(i = 0; i < SLOT_SIZE; i++) {
        if (slot[i] == block) {
            return i;
        }
    }
    return -1;
}

static int block_len(uint8_t* buf) {
    int i;
    for(i = 512-1; i >= 0; i--) {
        if (buf[i] != 0x00) {
            return i+1;
        }
    }
    return 0;
}

static void mem_cpy(uint8_t* dst, const uint8_t* src, int size)
{
    while(size-- > 0) {
        *dst++ = *src++;
    }
}

static void mem_set(uint8_t* dst, uint8_t dat, int size)
{
    while(size-- > 0) {
        *dst++ = dat;
    }
}
   
void usbd_msc_read_sect(uint32_t block, uint8_t *buf, uint32_t num_of_blocks)
{
    int i;
    i = index_block(block);
    if (i != (-1)) {
        mem_cpy(buf, image[i], 512);
    } else {
        mem_set(buf, 0x00, 512);
    }
}

void usbd_msc_write_sect(uint32_t block, uint8_t *buf, uint32_t num_of_blocks)
{
    int i, len;
    len = block_len(buf);
    i = index_block(block);
    if (i != -1) {
        if (len == 0) {
            slot[i] = -1;
        } else {
            mem_cpy(image[i], buf, 512);
        }
    } else {
        if (len != 0) {
            for(i = 0; i < SLOT_SIZE; i++) {
                if (slot[i] == (-1)) {
                    slot[i] = block;
                    mem_cpy(image[i], buf, 512);
                    break;
                }
            }
        }
    }
}

void usbd_msc_init () {
    int i;
    for(i = 0; i < SLOT_SIZE; i++) {
        slot[i] = -1;
        mem_set(image[i], 0, 512);
    }
    for(i = 0; i < 5; i++) {
        slot[i] = i;
    }
    mem_cpy(image[0], disk_image_0, sizeof(disk_image_0));
    mem_cpy(image[1], disk_image_1, sizeof(disk_image_1));
    mem_cpy(image[2], disk_image_2, sizeof(disk_image_2));
    mem_cpy(image[3], disk_image_3, sizeof(disk_image_3));
    mem_cpy(image[4], disk_image_4, sizeof(disk_image_4));
    
    USBD_MSC_MemorySize = 65536;
    USBD_MSC_BlockSize  = 512;
    USBD_MSC_BlockGroup = 1;
    USBD_MSC_BlockCount = USBD_MSC_MemorySize / USBD_MSC_BlockSize;
    //USBD_MSC_BlockBuf   = (uint8_t *)usb_buffer;
    //USBD_MSC_MediaReady = __TRUE;
}