1 files changed, 86 insertions, 0 deletions
diff --git a/testhal/STM32/STM32F3xx/SPI-N25Q128/main.c b/testhal/STM32/STM32F3xx/SPI-N25Q128/main.c
index 7df94b53f..c8ca4aaa4 100644
--- a/testhal/STM32/STM32F3xx/SPI-N25Q128/main.c
+++ b/testhal/STM32/STM32F3xx/SPI-N25Q128/main.c
@@ -20,6 +20,46 @@
 #include "n25q128.h"
 
 /*
+ * Maximum speed SPI configuration (18MHz, CPHA=0, CPOL=0, MSb first).
+ */
+static const SPIConfig hs_spicfg = {
+  NULL,
+  GPIOB,
+  12,
+  0,
+  SPI_CR2_DS_2 | SPI_CR2_DS_1 | SPI_CR2_DS_0
+};
+
+/*
+ * Flash driver configuration.
+ */
+static const N25Q128Config flashcfg = {
+  &SPID2,
+  &hs_spicfg
+};
+
+/*
+ * Flash driver object.
+ */
+static N25Q128Driver flash;
+
+/*
+ * Generic buffer.
+ */
+uint8_t buffer[2048];
+
+const uint8_t pattern[128] = {
+  0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15,
+  16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31,
+  0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15,
+  16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31,
+  0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15,
+  16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31,
+  0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15,
+  16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31
+};
+
+/*
  * LED blinker thread, times are in milliseconds.
  */
 static THD_WORKING_AREA(waThread1, 128);
@@ -37,6 +77,7 @@ static THD_FUNCTION(Thread1, arg) {
  * Application entry point.
  */
 int main(void) {
+  flash_error_t err;
 
   /*
    * System initializations.
@@ -53,6 +94,51 @@ int main(void) {
    */
   chThdCreateStatic(waThread1, sizeof(waThread1), NORMALPRIO + 1, Thread1, NULL);
 
+
+  /*
+   * SPI2 I/O pins setup.
+   */
+  palSetPad(GPIOB, 12);
+  palSetPadMode(GPIOB, 12, PAL_MODE_OUTPUT_PUSHPULL |
+                           PAL_STM32_OSPEED_HIGHEST);       /* New CS.      */
+  palSetPadMode(GPIOB, 13, PAL_MODE_ALTERNATE(5) |
+                           PAL_STM32_OSPEED_HIGHEST);       /* New SCK.     */
+  palSetPadMode(GPIOB, 14, PAL_MODE_ALTERNATE(5) |
+                           PAL_STM32_OSPEED_HIGHEST);       /* New MISO.    */
+  palSetPadMode(GPIOB, 15, PAL_MODE_ALTERNATE(5) |
+                           PAL_STM32_OSPEED_HIGHEST);       /* New MOSI.    */
+
+  /*
+   * Initializing and starting flash driver.
+   */
+  n25q128ObjectInit(&flash);
+  n25q128Start(&flash, &flashcfg);
+
+  /*
+   * Reading flash identifier.
+   */
+  n25q128ReadId(&flash, buffer, 17);
+
+  /*
+   * Writing then reading a pattern on a single page with final erase and
+   * verify.
+   */
+  err = flashProgram(&flash, 0, pattern, 128);
+  if (err != FLASH_NO_ERROR)
+    chSysHalt("program error");
+  err = flashRead(&flash, 0, buffer, 128);
+  if (err != FLASH_NO_ERROR)
+    chSysHalt("read error");
+  err = flashEraseSectors(&flash, 0, 1);
+  if (err != FLASH_NO_ERROR)
+    chSysHalt("erase error");
+  err = flashVerifyErase(&flash, 0, 1);
+  if (err != FLASH_NO_ERROR)
+    chSysHalt("verify erase error");
+  err = flashRead(&flash, 0, buffer, 128);
+  if (err != FLASH_NO_ERROR)
+    chSysHalt("read error");
+
   while (true) {
     chThdSleepMilliseconds(500);
   }