SD for DISCO_F746NG basic demo
Dependencies: BSP_DISCO_F746NG
main.cpp
- Committer:
- Jerome Coutant
- Date:
- 2019-11-20
- Revision:
- 4:85319532f755
- Parent:
- 3:33086de19b14
File content as of revision 4:85319532f755:
#include "mbed.h"
#include "stm32746g_discovery_sd.h"
#define BLOCK_START_ADDR 0 /* Block start address */
#define NUM_OF_BLOCKS 5 /* Total number of blocks */
#define BUFFER_WORDS_SIZE ((BLOCKSIZE * NUM_OF_BLOCKS) >> 2) /* Total data size in bytes */
uint32_t aTxBuffer[BUFFER_WORDS_SIZE];
uint32_t aRxBuffer[BUFFER_WORDS_SIZE];
/* Private function prototypes -----------------------------------------------*/
void SD_main_test(void);
void SD_Detection(void);
static void Fill_Buffer(uint32_t *pBuffer, uint32_t uwBufferLenght, uint32_t uwOffset);
static uint8_t Buffercmp(uint32_t *pBuffer1, uint32_t *pBuffer2, uint16_t BufferLength);
int main()
{
uint8_t SD_state = MSD_OK;
static uint8_t prev_status = SD_PRESENT;
printf("\n\nSD example start:\n");
SD_state = BSP_SD_Init();
if (SD_state != MSD_OK) {
if (SD_state == MSD_ERROR_SD_NOT_PRESENT) {
printf("SD shall be inserted before running test\n");
} else {
printf("SD Initialization : FAIL.\n");
}
printf("SD Test Aborted.\n");
} else {
printf("SD Initialization : OK.\n");
SD_state = BSP_SD_Erase(BLOCK_START_ADDR, (BLOCK_START_ADDR + NUM_OF_BLOCKS - 1));
/* Wait until SD card is ready to use for new operation */
while (BSP_SD_GetCardState() != SD_TRANSFER_OK) {
}
if (SD_state != MSD_OK) {
printf("SD ERASE : FAILED.\n");
printf("SD Test Aborted.\n");
} else {
printf("SD ERASE : OK.\n");
/* Fill the buffer to write */
Fill_Buffer(aTxBuffer, BUFFER_WORDS_SIZE, 0x2300);
SD_state = BSP_SD_WriteBlocks(aTxBuffer, BLOCK_START_ADDR, NUM_OF_BLOCKS, 10000);
/* Wait until SD card is ready to use for new operation */
while (BSP_SD_GetCardState() != SD_TRANSFER_OK) {
}
if (SD_state != MSD_OK) {
printf("SD WRITE : FAILED.\n");
printf("SD Test Aborted.\n");
} else {
printf("SD WRITE : OK.\n");
SD_state = BSP_SD_ReadBlocks(aRxBuffer, BLOCK_START_ADDR, NUM_OF_BLOCKS, 10000);
/* Wait until SD card is ready to use for new operation */
while (BSP_SD_GetCardState() != SD_TRANSFER_OK) {
}
if (SD_state != MSD_OK) {
printf("SD READ : FAILED.\n");
printf("SD Test Aborted.\n");
} else {
printf("SD READ : OK.\n");
if (Buffercmp(aTxBuffer, aRxBuffer, BUFFER_WORDS_SIZE) > 0) {
printf("SD COMPARE : FAILED.\n");
printf("SD Test Aborted.\n");
} else {
printf("SD Test : OK.\n");
printf("SD can be removed.\n");
}
}
}
}
}
while (1) {
if (BSP_SD_IsDetected() != SD_PRESENT) {
if (prev_status != SD_NOT_PRESENT) {
BSP_SD_Init();
prev_status = SD_NOT_PRESENT;
printf("SD removed\n");
}
} else if (prev_status != SD_PRESENT) {
printf("SD detected\n");
prev_status = SD_PRESENT;
}
}
}
/**
* @brief Fills buffer with user predefined data.
* @param pBuffer: pointer on the buffer to fill
* @param uwBufferLenght: size of the buffer to fill
* @param uwOffset: first value to fill on the buffer
* @retval None
*/
static void Fill_Buffer(uint32_t *pBuffer, uint32_t uwBufferLength, uint32_t uwOffset)
{
uint32_t tmpIndex = 0;
/* Put in global buffer different values */
for (tmpIndex = 0; tmpIndex < uwBufferLength; tmpIndex++) {
pBuffer[tmpIndex] = tmpIndex + uwOffset;
}
}
/**
* @brief Compares two buffers.
* @param pBuffer1, pBuffer2: buffers to be compared.
* @param BufferLength: buffer's length
* @retval 1: pBuffer identical to pBuffer1
* 0: pBuffer differs from pBuffer1
*/
static uint8_t Buffercmp(uint32_t *pBuffer1, uint32_t *pBuffer2, uint16_t BufferLength)
{
while (BufferLength--) {
if (*pBuffer1 != *pBuffer2) {
return 1;
}
pBuffer1++;
pBuffer2++;
}
return 0;
}