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; }