diff options
Diffstat (limited to 'os/hal/platforms/STM32/sdc_lld.c')
-rw-r--r-- | os/hal/platforms/STM32/sdc_lld.c | 13 |
1 files changed, 11 insertions, 2 deletions
diff --git a/os/hal/platforms/STM32/sdc_lld.c b/os/hal/platforms/STM32/sdc_lld.c index b289da8ba..43493d8dd 100644 --- a/os/hal/platforms/STM32/sdc_lld.c +++ b/os/hal/platforms/STM32/sdc_lld.c @@ -75,6 +75,7 @@ CH_IRQ_HANDLER(SDIO_IRQHandler) { void sdc_lld_init(void) {
sdcObjectInit(&SDCD1);
+ SDCD1.thread = NULL;
}
/**
@@ -315,8 +316,16 @@ bool_t sdc_lld_send_cmd_long_crc(SDCDriver *sdcp, uint8_t cmd, uint32_t arg, * @notapi
*/
bool_t sdc_lld_read_blocks(SDCDriver *sdcp, uint8_t *buf, uint32_t n) {
-
- return TRUE;
+ msg_t msg;
+
+ chSysLock();
+ chDbgAssert(sdcp->thread == NULL, "sdc_lld_read_blocks(), #1", "not NULL");
+ sdcp->thread = chThdSelf();
+ chSchGoSleepS(THD_STATE_SUSPENDED);
+ chDbgAssert(sdcp->thread == NULL, "sdc_lld_read_blocks(), #2", "not NULL");
+ msg = chThdSelf()->p_u.rdymsg;
+ chSysUnlock();
+ return msg != RDY_OK;
}
/**
|