src/main/msc/usbd_storage_emfat.c

   1 /*
   2  * Derived from github.com/fetisov/emfat/project/StorageMode.c
   3  */
   4
   5 /*
   6  * The MIT License (MIT)
   7  *
   8  * Copyright (c) 2015 by Sergey Fetisov <fsenok@gmail.com>
   9  *
  10  * Permission is hereby granted, free of charge, to any person obtaining a copy
  11  * of this software and associated documentation files (the "Software"), to deal
  12  * in the Software without restriction, including without limitation the rights
  13  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  14  * copies of the Software, and to permit persons to whom the Software is
  15  * furnished to do so, subject to the following conditions:
  16  *
  17  * The above copyright notice and this permission notice shall be included in all
  18  * copies or substantial portions of the Software.
  19  *
  20  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  21  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  22  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  23  * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  24  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  25  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  26  * SOFTWARE.
  27  */
  28
  29 #include <stdbool.h>
  30
  31 #include "platform.h"
  32
  33 #include "common/utils.h"
  34
  35 #include "drivers/light_led.h"
  36 #include "drivers/time.h"
  37 #include "drivers/flash.h"
  38
  39 #include "io/flashfs.h"
  40
  41 #include "pg/flash.h"
  42
  43 #include "usbd_storage.h"
  44 #include "usbd_storage_emfat.h"
  45 #include "emfat_file.h"
  46
  47
  48 #define STORAGE_LUN_NBR 1
  49
  50 static const uint8_t STORAGE_Inquirydata[] =
  51 {
  52     0x00, 0x80, 0x02, 0x02,
  53 #ifdef USE_HAL_DRIVER
  54     (STANDARD_INQUIRY_DATA_LEN - 5),
  55 #else
  56     (USBD_STD_INQUIRY_LENGTH - 5),
  57 #endif
  58     0x00, 0x00, 0x00,
  59     'B', 'E', 'T', 'A', 'F', 'L', 'T', ' ', // Manufacturer : 8 bytes
  60     'O', 'n', 'b', 'o', 'a', 'r', 'd', ' ', // Product      : 16 Bytes
  61     'F', 'l', 'a', 's', 'h', ' ', ' ', ' ', //
  62     ' ', ' ', ' ' ,' ',                     // Version      : 4 Bytes
  63 };
  64
  65 static int8_t STORAGE_Init(uint8_t lun)
  66 {
  67     UNUSED(lun);
  68
  69     LED0_ON;
  70
  71 #ifdef USE_FLASHFS
  72 #ifdef USE_FLASH_CHIP
  73     flashInit(flashConfig());
  74 #endif
  75     flashfsInit();
  76 #endif
  77     emfat_init_files();
  78
  79     delay(1000);
  80
  81     LED0_OFF;
  82
  83     return 0;
  84 }
  85
  86 #ifdef USE_HAL_DRIVER
  87 static int8_t STORAGE_GetCapacity(uint8_t lun, uint32_t *block_num, uint16_t *block_size)
  88 #else
  89 static int8_t STORAGE_GetCapacity(uint8_t lun, uint32_t *block_num, uint32_t *block_size)
  90 #endif
  91 {
  92     UNUSED(lun);
  93     *block_size = 512;
  94     *block_num = emfat.disk_sectors;
  95     return 0;
  96 }
  97
  98 static int8_t STORAGE_IsReady(uint8_t lun)
  99 {
 100     UNUSED(lun);
 101     return 0;
 102 }
 103
 104 static int8_t STORAGE_IsWriteProtected(uint8_t lun)
 105 {
 106     UNUSED(lun);
 107     return 1;
 108 }
 109
 110 static int8_t STORAGE_Read(
 111     uint8_t lun,        // logical unit number
 112     uint8_t *buf,       // Pointer to the buffer to save data
 113     uint32_t blk_addr,  // address of 1st block to be read
 114     uint16_t blk_len)   // nmber of blocks to be read
 115 {
 116     UNUSED(lun);
 117     LED0_ON;
 118     emfat_read(&emfat, buf, blk_addr, blk_len);
 119     LED0_OFF;
 120     return 0;
 121 }
 122
 123 static int8_t STORAGE_Write(uint8_t lun,
 124     uint8_t *buf,
 125     uint32_t blk_addr,
 126     uint16_t blk_len)
 127 {
 128     UNUSED(lun);
 129     UNUSED(buf);
 130     UNUSED(blk_addr);
 131     UNUSED(blk_len);
 132
 133     return 1;
 134 }
 135
 136 static int8_t STORAGE_GetMaxLun(void)
 137 {
 138   return (STORAGE_LUN_NBR - 1);
 139 }
 140
 141 #ifdef USE_HAL_DRIVER
 142 USBD_StorageTypeDef
 143 #else
 144 USBD_STORAGE_cb_TypeDef
 145 #endif
 146 USBD_MSC_EMFAT_fops =
 147 {
 148     STORAGE_Init,
 149     STORAGE_GetCapacity,
 150     STORAGE_IsReady,
 151     STORAGE_IsWriteProtected,
 152     STORAGE_Read,
 153     STORAGE_Write,
 154     STORAGE_GetMaxLun,
 155     (int8_t *)STORAGE_Inquirydata,
 156 };