1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
22
23
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
74
79
80
87
88
89
90
91
92
93
94
95
96
97
98
99
100
105
106
107
108
109
110
116
120
121
125
126
127
128
133
137
138
145
146
147
148
149
150
151
158
159
160
161
162
169
170
171
172
173
174
175
182
183
184
185
186
191
/* ... */
#include "usbd_storage.h"
#include "stm32_adafruit_sd.h"
Includes
#define STORAGE_LUN_NBR 1
#define STORAGE_BLK_NBR 0x10000
#define STORAGE_BLK_SIZ 0x200
Private define
__IO uint32_t writestatus, readstatus = 0;
int8_t STORAGE_Inquirydata[] = {
0x00,
0x80,
0x02,
0x02,
(STANDARD_INQUIRY_DATA_LEN - 5),
0x00,
0x00,
0x00,
'S', 'T', 'M', ' ', ' ', ' ', ' ', ' ',
'P', 'r', 'o', 'd', 'u', 'c', 't', ' ',
' ', ' ', ' ', ' ', ' ', ' ', ' ', ' ',
'0', '.', '0','1',
...};
Private variables
int8_t STORAGE_Init(uint8_t lun);
int8_t STORAGE_GetCapacity(uint8_t lun, uint32_t *block_num, uint16_t *block_size);
int8_t STORAGE_IsReady(uint8_t lun);
int8_t STORAGE_IsWriteProtected(uint8_t lun);
int8_t STORAGE_Read(uint8_t lun, uint8_t *buf, uint32_t blk_addr, uint16_t blk_len);
int8_t STORAGE_Write(uint8_t lun, uint8_t *buf, uint32_t blk_addr, uint16_t blk_len);
int8_t STORAGE_GetMaxLun(void);
USBD_StorageTypeDef USBD_DISK_fops = {
STORAGE_Init,
STORAGE_GetCapacity,
STORAGE_IsReady,
STORAGE_IsWriteProtected,
STORAGE_Read,
STORAGE_Write,
STORAGE_GetMaxLun,
STORAGE_Inquirydata,
...};Private function prototypes
/* ... */
int8_t STORAGE_Init(uint8_t lun)
{
BSP_SD_Init();
return 0;
}{ ... }
/* ... */
int8_t STORAGE_GetCapacity(uint8_t lun, uint32_t *block_num, uint16_t *block_size)
{
SD_CardInfo info;
int8_t ret = -1;
BSP_SD_GetCardInfo(&info);
*block_num = info.LogBlockNbr - 1;
*block_size = info.LogBlockSize;
ret = 0;
return ret;
}{ ... }
/* ... */
int8_t STORAGE_IsReady(uint8_t lun)
{
static int8_t prev_status = 0;
int8_t ret = -1;
if(prev_status < 0)
{
BSP_SD_Init();
prev_status = 0;
}if (prev_status < 0) { ... }
if(BSP_SD_GetCardState() == BSP_SD_OK)
{
ret = 0;
}if (BSP_SD_GetCardState() == BSP_SD_OK) { ... }
else if(prev_status == 0)
{
prev_status = -1;
}else if (prev_status == 0) { ... }
return ret;
}{ ... }
/* ... */
int8_t STORAGE_IsWriteProtected(uint8_t lun)
{
return 0;
}{ ... }
/* ... */
int8_t STORAGE_Read(uint8_t lun, uint8_t *buf, uint32_t blk_addr, uint16_t blk_len)
{
int8_t ret = -1;
uint32_t timeout = 100000;
BSP_SD_ReadBlocks((uint32_t *)buf, blk_addr * STORAGE_BLK_SIZ, STORAGE_BLK_SIZ, blk_len);
while(BSP_SD_GetCardState() != BSP_SD_OK)
{
if (timeout-- == 0)
{
return ret;
}if (timeout-- == 0) { ... }
}while (BSP_SD_GetCardState() != BSP_SD_OK) { ... }
ret = 0;
return ret;
}{ ... }
/* ... */
int8_t STORAGE_Write(uint8_t lun, uint8_t *buf, uint32_t blk_addr, uint16_t blk_len)
{
int8_t ret = -1;
uint32_t timeout = 100000;
BSP_SD_WriteBlocks((uint32_t *)buf, blk_addr * STORAGE_BLK_SIZ, STORAGE_BLK_SIZ, blk_len);
while(BSP_SD_GetCardState() != BSP_SD_OK)
{
if (timeout-- == 0)
{
return ret;
}if (timeout-- == 0) { ... }
}while (BSP_SD_GetCardState() != BSP_SD_OK) { ... }
ret = 0;
return ret;
}{ ... }
/* ... */
int8_t STORAGE_GetMaxLun(void)
{
return(STORAGE_LUN_NBR - 1);
}{ ... }