From d3af6e7b166b43bfe68c69bebff518a45dcca02b Mon Sep 17 00:00:00 2001
From: gdisirio <gdisirio@35acf78f-673a-0410-8e92-d51de3d6d3f4>
Date: Sun, 8 May 2011 10:02:48 +0000
Subject: SDC optimizations.

git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@2935 35acf78f-673a-0410-8e92-d51de3d6d3f4
---
 os/hal/platforms/STM32/sdc_lld.c | 12 ++++--------
 1 file changed, 4 insertions(+), 8 deletions(-)

(limited to 'os')

diff --git a/os/hal/platforms/STM32/sdc_lld.c b/os/hal/platforms/STM32/sdc_lld.c
index a7a598c45..907651020 100644
--- a/os/hal/platforms/STM32/sdc_lld.c
+++ b/os/hal/platforms/STM32/sdc_lld.c
@@ -375,6 +375,7 @@ bool_t sdc_lld_read(SDCDriver *sdcp, uint32_t startblk,
     }
   }
   else {
+    SDIO->MASK = 0;
     if ((SDIO->STA & SDIO_STA_DATAEND) == 0) {
       chSysUnlock();
       goto error;
@@ -382,13 +383,10 @@ bool_t sdc_lld_read(SDCDriver *sdcp, uint32_t startblk,
   }
   dmaDisableChannel(STM32_DMA2, STM32_DMA_CHANNEL_4);
   SDIO->ICR   = 0xFFFFFFFF;
-  SDIO->MASK  = 0;
   SDIO->DCTRL = 0;
   chSysUnlock();
 
-  if (sdc_lld_send_cmd_short_crc(sdcp, SDC_CMD_STOP_TRANSMISSION, 0, resp))
-    goto error;
-  return FALSE;
+  return sdc_lld_send_cmd_short_crc(sdcp, SDC_CMD_STOP_TRANSMISSION, 0, resp);
 error:
   dmaDisableChannel(STM32_DMA2, STM32_DMA_CHANNEL_4);
   SDIO->ICR   = 0xFFFFFFFF;
@@ -454,6 +452,7 @@ bool_t sdc_lld_write(SDCDriver *sdcp, uint32_t startblk,
     }
   }
   else {
+    SDIO->MASK = 0;
     if ((SDIO->STA & SDIO_STA_DATAEND) == 0) {
       chSysUnlock();
       goto error;
@@ -461,13 +460,10 @@ bool_t sdc_lld_write(SDCDriver *sdcp, uint32_t startblk,
   }
   dmaDisableChannel(STM32_DMA2, STM32_DMA_CHANNEL_4);
   SDIO->ICR   = 0xFFFFFFFF;
-  SDIO->MASK  = 0;
   SDIO->DCTRL = 0;
   chSysUnlock();
 
-  if (sdc_lld_send_cmd_short_crc(sdcp, SDC_CMD_STOP_TRANSMISSION, 0, resp))
-    goto error;
-  return FALSE;
+  return sdc_lld_send_cmd_short_crc(sdcp, SDC_CMD_STOP_TRANSMISSION, 0, resp);
 error:
   dmaDisableChannel(STM32_DMA2, STM32_DMA_CHANNEL_4);
   SDIO->ICR   = 0xFFFFFFFF;
-- 
cgit v1.2.3