SD for DISCO_F746NG basic demo

Dependencies:   BSP_DISCO_F746NG

Revision:
0:99e26e18b424
Child:
2:522456118ea2
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Mon Mar 21 13:29:31 2016 +0000
@@ -0,0 +1,134 @@
+#include "mbed.h"
+#include "SD_DISCO_F746NG.h"
+
+SD_DISCO_F746NG sd;
+
+DigitalOut led_green(LED1);
+DigitalOut led_red(LED2);
+
+Serial pc(USBTX, USBRX);
+
+#define BLOCK_START_ADDR         0     /* Block start address      */
+#define BLOCKSIZE                512   /* Block Size in Bytes      */
+#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 = SD_OK;
+    pc.printf("\n\nuSD example start:\n");
+    led_red = 0;
+  
+    SD_state = sd.Init();
+    if(SD_state != SD_OK){
+        if(SD_state == MSD_ERROR_SD_NOT_PRESENT){
+            pc.printf("SD shall be inserted before running test\n");
+        } else {
+            pc.printf("SD Initialization : FAIL.\n");
+        }
+        pc.printf("SD Test Aborted.\n");
+    } else {
+        pc.printf("SD Initialization : OK.\n");
+
+        if(sd.Erase(BLOCK_START_ADDR, (BLOCKSIZE * NUM_OF_BLOCKS)) != SD_OK){
+            pc.printf("SD ERASE : FAILED.\n");
+            pc.printf("SD Test Aborted.\n");
+        } else {
+            pc.printf("SD ERASE : OK.\n");
+          
+            /* Fill the buffer to write */
+            Fill_Buffer(aTxBuffer, BUFFER_WORDS_SIZE, 0x22FF);
+          
+            if(sd.WriteBlocks(aTxBuffer, BLOCK_START_ADDR, BLOCKSIZE, NUM_OF_BLOCKS) != SD_OK){
+                pc.printf("SD WRITE : FAILED.\n");
+                pc.printf("SD Test Aborted.\n");
+            } else {
+                pc.printf("SD WRITE : OK.\n");
+            
+                if(sd.ReadBlocks(aRxBuffer, BLOCK_START_ADDR, BLOCKSIZE, NUM_OF_BLOCKS)!= SD_OK){
+                    pc.printf("SD READ : FAILED.\n");
+                    pc.printf("SD Test Aborted.\n");
+                } else {
+                    pc.printf("SD READ : OK.\n");
+                    if(Buffercmp(aTxBuffer, aRxBuffer, BUFFER_WORDS_SIZE) > 0){
+                        pc.printf("SD COMPARE : FAILED.\n");
+                        pc.printf("SD Test Aborted.\n");
+                    } else {
+                        pc.printf("SD Test : OK.\n");
+                        pc.printf("SD can be removed.\n");
+                    }
+                }
+            }
+        }
+    }
+  
+    while (1) {
+    }
+} 
+
+/**
+  * @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;
+}
+
+/**
+  * @brief This function provides accurate delay (in milliseconds) based 
+  *        on variable incremented.
+  * @note In the default implementation , SysTick timer is the source of time base.
+  *       It is used to generate interrupts at regular time intervals where uwTick
+  *       is incremented.
+  * @note This function is the modified version of the __weak version contained in 
+  *       stm32f4xx_hal.c
+  * @param Delay: specifies the delay time length, in milliseconds.
+  * @retval None
+  */
+void HAL_Delay(__IO uint32_t Delay)
+{
+    wait_ms((int)Delay);
+}
+