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
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
121
122
123
124
125
126
139
143
144
145
146
151
155
156
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
184
185
186
187
188
189
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
217
218
219
220
221
222
227
231
232
237
241
242
247
/* ... */
#include "usbd_storage.h"
#include "stm32469i_discovery_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();
HAL_NVIC_SetPriority(SDIO_IRQn, 5, 0);
HAL_NVIC_EnableIRQ(SDIO_IRQn);
HAL_NVIC_SetPriority(SD_DMAx_Rx_IRQn, 6, 0);
HAL_NVIC_EnableIRQ(SD_DMAx_Rx_IRQn);
HAL_NVIC_SetPriority(SD_DMAx_Tx_IRQn, 6, 0);
HAL_NVIC_EnableIRQ(SD_DMAx_Tx_IRQn);
return 0;
}{ ... }
/* ... */
int8_t STORAGE_GetCapacity(uint8_t lun, uint32_t *block_num, uint16_t *block_size)
{
HAL_SD_CardInfoTypeDef info;
int8_t ret = -1;
if(BSP_SD_IsDetected() != SD_NOT_PRESENT)
{
BSP_SD_GetCardInfo(&info);
*block_num = info.LogBlockNbr - 1;
*block_size = info.LogBlockSize;
ret = 0;
}if (BSP_SD_IsDetected() != SD_NOT_PRESENT) { ... }
return ret;
}{ ... }
/* ... */
int8_t STORAGE_IsReady(uint8_t lun)
{
static int8_t prev_status = 0;
int8_t ret = -1;
if(BSP_SD_IsDetected() != SD_NOT_PRESENT)
{
if(prev_status < 0)
{
BSP_SD_Init();
prev_status = 0;
}if (prev_status < 0) { ... }
if(BSP_SD_GetCardState() == SD_TRANSFER_OK)
{
ret = 0;
}if (BSP_SD_GetCardState() == SD_TRANSFER_OK) { ... }
}if (BSP_SD_IsDetected() != SD_NOT_PRESENT) { ... }
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;
if(BSP_SD_IsDetected() != SD_NOT_PRESENT)
{
BSP_SD_ReadBlocks_DMA((uint32_t *)buf, blk_addr, blk_len);
while (readstatus == 0){}
readstatus = 0;
while (BSP_SD_GetCardState() != SD_TRANSFER_OK)
{
if (timeout-- == 0)
{
return ret;
}if (timeout-- == 0) { ... }
}while (BSP_SD_GetCardState() != SD_TRANSFER_OK) { ... }
ret = 0;
}if (BSP_SD_IsDetected() != SD_NOT_PRESENT) { ... }
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;
if(BSP_SD_IsDetected() != SD_NOT_PRESENT)
{
BSP_SD_WriteBlocks_DMA((uint32_t *)buf, blk_addr, blk_len);
while (writestatus == 0){}
writestatus = 0;
while (BSP_SD_GetCardState() != SD_TRANSFER_OK)
{
if (timeout-- == 0)
{
return ret;
}if (timeout-- == 0) { ... }
}while (BSP_SD_GetCardState() != SD_TRANSFER_OK) { ... }
ret = 0;
}if (BSP_SD_IsDetected() != SD_NOT_PRESENT) { ... }
return ret;
}{ ... }
/* ... */
int8_t STORAGE_GetMaxLun(void)
{
return(STORAGE_LUN_NBR - 1);
}{ ... }
/* ... */
void BSP_SD_WriteCpltCallback(void)
{
writestatus = 1;
}{ ... }
/* ... */
void BSP_SD_ReadCpltCallback(void)
{
readstatus = 1;
}{ ... }