Fix terrible performance

diff --git a/STM32CubeMX/SCSI2SD-V6/Drivers/STM32F2xx_HAL_Driver/Src/stm32f2xx_hal_sd.c b/STM32CubeMX/SCSI2SD-V6/Drivers/STM32F2xx_HAL_Driver/Src/stm32f2xx_hal_sd.c
index 418163e46710aaea8c9ba9f59dc210f566b27b74..8511aa7be0ad01e04e373ebc889fb1ac8bf5b4b3 100755 (executable)
--- a/STM32CubeMX/SCSI2SD-V6/Drivers/STM32F2xx_HAL_Driver/Src/stm32f2xx_hal_sd.c
+++ b/STM32CubeMX/SCSI2SD-V6/Drivers/STM32F2xx_HAL_Driver/Src/stm32f2xx_hal_sd.c
@@ -1048,6 +1048,27 @@ HAL_SD_ErrorTypedef HAL_SD_WriteBlocks_DMA(SD_HandleTypeDef *hsd, uint32_t *pWri
   }
   else
   {
+    /* MM: Prepare for write */
+    /* Set Block Size for Card */ 
+    sdio_cmdinitstructure.Argument         = (uint32_t)(hsd->RCA << 16);
+    sdio_cmdinitstructure.CmdIndex         = SD_CMD_APP_CMD;
+    SDIO_SendCommand(hsd->Instance, &sdio_cmdinitstructure);
+    errorstate = SD_CmdResp1Error(hsd, SD_CMD_APP_CMD);
+    if (errorstate != SD_OK)
+    {
+      return errorstate;
+    }
+    sdio_cmdinitstructure.Argument         = (uint32_t)NumberOfBlocks;
+    sdio_cmdinitstructure.CmdIndex         = SD_CMD_SET_BLOCK_COUNT;
+    SDIO_SendCommand(hsd->Instance, &sdio_cmdinitstructure);
+    errorstate = SD_CmdResp1Error(hsd, SD_CMD_SET_BLOCK_COUNT);
+    if (errorstate != SD_OK)
+    {
+      return errorstate;
+    }
+  
+    /* /MM */
+
     /* Send CMD25 WRITE_MULT_BLOCK with argument data address */
     sdio_cmdinitstructure.CmdIndex = SD_CMD_WRITE_MULT_BLOCK;
   }

diff --git a/src/firmware/config.c b/src/firmware/config.c
index 2aed74bc310b5ce64acb03e360e916336a22c36b..eb6b3694c66e7fae019b09473988095ffe8d5a7f 100755 (executable)
--- a/src/firmware/config.c
+++ b/src/firmware/config.c
@@ -37,7 +37,7 @@
 \r
 #include <string.h>\r
 \r
-static const uint16_t FIRMWARE_VERSION = 0x0605;\r
+static const uint16_t FIRMWARE_VERSION = 0x0606;\r
 \r
 // 1 flash row\r
 static const uint8_t DEFAULT_CONFIG[128] =\r

diff --git a/src/firmware/disk.c b/src/firmware/disk.c
index b8c54a2b23493780b30ae5f95ce925210a0f70da..2e69d481c307e9849e13e5b784255238c548da45 100755 (executable)
--- a/src/firmware/disk.c
+++ b/src/firmware/disk.c
@@ -553,14 +553,6 @@ void scsiDiskPoll()
                        likely(scsiDev.phase == DATA_IN) &&\r
                        likely(!scsiDev.resetFlag))\r
                {\r
-                       // Wait for the next DMA interrupt. It's beneficial to halt the\r
-                       // processor to give the DMA controller more memory bandwidth to\r
-                       // work with.\r
-                       if (sdActive && scsiActive)\r
-                       {\r
-                               __WFI();\r
-                       }\r
-\r
                        if (sdActive && sdReadDMAPoll())\r
                        {\r
                                prep += sdActive;\r
@@ -574,11 +566,13 @@ void scsiDiskPoll()
                                // Start an SD transfer if we have space.\r
                                uint32_t startBuffer = prep % buffers;\r
                                uint32_t sectors = totalSDSectors - prep;\r
+#if 0\r
                                if (!scsiActive && prep == i)\r
                                {\r
                                        sectors = 1; // We need to get some data to send ASAP !\r
                                }\r
                                else\r
+#endif\r
                                {\r
                                        uint32_t freeBuffers = buffers - (prep - i);\r
                                        uint32_t contiguousBuffers = buffers - startBuffer;\r
@@ -616,7 +610,6 @@ void scsiDiskPoll()
                        likely(scsiDev.phase == DATA_IN) &&\r
                        likely(!scsiDev.resetFlag))\r
                {\r
-                       __WFI();\r
                }\r
 \r
 \r

diff --git a/src/firmware/main.c b/src/firmware/main.c
index f418d12e3a51de0914a617b6107212fcf17adcfb..67f795653d1578e5904baf4094e4b861533fef7c 100755 (executable)
--- a/src/firmware/main.c
+++ b/src/firmware/main.c
@@ -106,6 +106,9 @@ void mainLoop()
                }\r
                else\r
                {\r
+                       // TODO this hurts performance significantly! Work out why __WFI()\r
+                       // doesn't wake up immediately !\r
+#if 0\r
                        // Wait for our 1ms timer to save some power.\r
                        // There's an interrupt on the SEL signal to ensure we respond\r
                        // quickly to any SCSI commands. The selection abort time is\r
@@ -116,12 +119,13 @@ void mainLoop()
 \r
                        if (!*SCSI_STS_SELECTED)\r
                        {\r
-                               __WFI(); // Will wake on interrupt, regardless of mask\r
+                               //__WFI(); // Will wake on interrupt, regardless of mask\r
                        }\r
                        if (!interruptState)\r
                        {\r
                                __enable_irq();\r
                        }\r
+#endif\r
                }\r
        }\r
        else if (scsiDev.phase >= 0)\r

diff --git a/src/firmware/scsi.h b/src/firmware/scsi.h
index 0a123733ebf730fe7d504383652b10ded9d53cac..2e3a5fa8cab88c29513e16fd68cfcd6f9d9de63b 100755 (executable)
--- a/src/firmware/scsi.h
+++ b/src/firmware/scsi.h
@@ -97,7 +97,8 @@ typedef struct
 
 typedef struct
 {
-       uint8_t data[MAX_SECTOR_SIZE * 2]; // Must be aligned for DMA
+       // TODO reduce this buffer size and add a proper cache
+       uint8_t data[MAX_SECTOR_SIZE * 8]; // Must be aligned for DMA
 
        TargetState targets[S2S_MAX_TARGETS];
        TargetState* target;

diff --git a/src/firmware/scsiPhy.c b/src/firmware/scsiPhy.c
index fa586c3cd71956866ddbff573fe1e8c0f41a77c5..2231089d8bdefb3ef317851a0eda745c6e5b76b3 100755 (executable)
--- a/src/firmware/scsiPhy.c
+++ b/src/firmware/scsiPhy.c
@@ -176,30 +176,32 @@ void
 scsiRead(uint8_t* data, uint32_t count)\r
 {\r
        int i = 0;\r
+\r
+\r
+       uint32_t chunk = ((count - i) > SCSI_FIFO_DEPTH)\r
+               ? SCSI_FIFO_DEPTH : (count - i);\r
+       if (chunk >= 16)\r
+       {\r
+               // DMA is doing 32bit transfers.\r
+               chunk = chunk & 0xFFFFFFF8;\r
+       }\r
+       startScsiRx(chunk);\r
+\r
        while (i < count && likely(!scsiDev.resetFlag))\r
        {\r
-               uint32_t chunk = ((count - i) > SCSI_FIFO_DEPTH)\r
-                       ? SCSI_FIFO_DEPTH : (count - i);\r
+               while (!scsiPhyComplete() && likely(!scsiDev.resetFlag)) {}\r
+               scsiPhyFifoFlip();\r
 \r
-               if (chunk >= 16)\r
+               uint32_t nextChunk = ((count - i - chunk) > SCSI_FIFO_DEPTH)\r
+                       ? SCSI_FIFO_DEPTH : (count - i - chunk);\r
+               if (nextChunk >= 16)\r
                {\r
-                       // DMA is doing 32bit transfers.\r
-                       chunk = chunk & 0xFFFFFFF8;\r
+                       nextChunk = nextChunk & 0xFFFFFFF8;\r
                }\r
-\r
-#if FIFODEBUG\r
-               if (!scsiPhyFifoAltEmpty()) {\r
-                       // Force a lock-up.\r
-                       assertFail();\r
+               if (nextChunk > 0)\r
+               {\r
+                       startScsiRx(nextChunk);\r
                }\r
-#endif\r
-\r
-               startScsiRx(chunk);\r
-               // Wait for the next scsi interrupt (or the 1ms systick)\r
-               __WFI();\r
-\r
-               while (!scsiPhyComplete() && likely(!scsiDev.resetFlag)) {}\r
-               scsiPhyFifoFlip();\r
 \r
                if (chunk < 16)\r
                {\r
@@ -209,15 +211,10 @@ scsiRead(uint8_t* data, uint32_t count)
                {\r
                        scsiReadDMA(data + i, chunk);\r
 \r
-                       // Wait for the next DMA interrupt (or the 1ms systick)\r
-                       // It's beneficial to halt the processor to\r
-                       // give the DMA controller more memory bandwidth to work with.\r
-                       __WFI();\r
                        trace(trace_spinReadDMAPoll);\r
 \r
                        while (!scsiReadDMAPoll() && likely(!scsiDev.resetFlag))\r
                        {\r
-                               __WFI();\r
                        };\r
                }\r
 \r
@@ -230,6 +227,7 @@ scsiRead(uint8_t* data, uint32_t count)
                }\r
 #endif\r
                i += chunk;\r
+               chunk = nextChunk;\r
        }\r
 }\r
 \r
@@ -328,21 +326,15 @@ scsiWrite(const uint8_t* data, uint32_t count)
                        chunk = chunk & 0xFFFFFFF8;\r
                        scsiWriteDMA(data + i, chunk);\r
 \r
-                       // Wait for the next DMA interrupt (or the 1ms systick)\r
-                       // It's beneficial to halt the processor to\r
-                       // give the DMA controller more memory bandwidth to work with.\r
-                       __WFI();\r
                        trace(trace_spinReadDMAPoll);\r
 \r
                        while (!scsiWriteDMAPoll() && likely(!scsiDev.resetFlag))\r
                        {\r
-                               __WFI();\r
-                       };\r
+                       }\r
                }\r
 \r
                while (!scsiPhyComplete() && likely(!scsiDev.resetFlag))\r
                {\r
-                       __WFI();\r
                }\r
 \r
 #if FIFODEBUG\r
@@ -357,7 +349,6 @@ scsiWrite(const uint8_t* data, uint32_t count)
        }\r
        while (!scsiPhyComplete() && likely(!scsiDev.resetFlag))\r
        {\r
-               __WFI();\r
        }\r
 \r
 #if FIFODEBUG\r