2011-04-26 16:59:14 +00:00
|
|
|
/*
|
|
|
|
ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010,
|
2012-01-21 14:29:42 +00:00
|
|
|
2011,2012 Giovanni Di Sirio.
|
2011-04-26 16:59:14 +00:00
|
|
|
|
|
|
|
This file is part of ChibiOS/RT.
|
|
|
|
|
|
|
|
ChibiOS/RT is free software; you can redistribute it and/or modify
|
|
|
|
it under the terms of the GNU General Public License as published by
|
|
|
|
the Free Software Foundation; either version 3 of the License, or
|
|
|
|
(at your option) any later version.
|
|
|
|
|
|
|
|
ChibiOS/RT is distributed in the hope that it will be useful,
|
|
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
GNU General Public License for more details.
|
|
|
|
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @file STM32/sdc_lld.c
|
|
|
|
* @brief STM32 SDC subsystem low level driver source.
|
|
|
|
*
|
|
|
|
* @addtogroup SDC
|
|
|
|
* @{
|
|
|
|
*/
|
|
|
|
|
2011-05-29 09:09:22 +00:00
|
|
|
#include <string.h>
|
|
|
|
|
2011-04-26 16:59:14 +00:00
|
|
|
#include "ch.h"
|
|
|
|
#include "hal.h"
|
|
|
|
|
|
|
|
#if HAL_USE_SDC || defined(__DOXYGEN__)
|
|
|
|
|
|
|
|
/*===========================================================================*/
|
|
|
|
/* Driver exported variables. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
/** @brief SDCD1 driver identifier.*/
|
|
|
|
SDCDriver SDCD1;
|
|
|
|
|
|
|
|
/*===========================================================================*/
|
|
|
|
/* Driver local variables. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
2011-05-29 09:09:22 +00:00
|
|
|
#if STM32_SDC_UNALIGNED_SUPPORT
|
|
|
|
/**
|
|
|
|
* @brief Buffer for temporary storage during unaligned transfers.
|
|
|
|
*/
|
|
|
|
static union {
|
|
|
|
uint32_t alignment;
|
|
|
|
uint8_t buf[SDC_BLOCK_SIZE];
|
|
|
|
} u;
|
|
|
|
#endif
|
|
|
|
|
2011-04-26 16:59:14 +00:00
|
|
|
/*===========================================================================*/
|
|
|
|
/* Driver local functions. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
2011-05-29 09:09:22 +00:00
|
|
|
/**
|
|
|
|
* @brief Reads one or more blocks.
|
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
|
|
|
* @param[in] startblk first block to read
|
|
|
|
* @param[out] buf pointer to the read buffer, it must be aligned to
|
|
|
|
* four bytes boundary
|
|
|
|
* @param[in] n number of blocks to read
|
|
|
|
* @return The operation status.
|
|
|
|
* @retval FALSE operation succeeded, the requested blocks have been
|
|
|
|
* read.
|
|
|
|
* @retval TRUE operation failed, the state of the buffer is uncertain.
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
static bool_t sdc_lld_read_multiple(SDCDriver *sdcp, uint32_t startblk,
|
|
|
|
uint8_t *buf, uint32_t n) {
|
|
|
|
uint32_t resp[1];
|
|
|
|
|
|
|
|
/* Checks for errors and waits for the card to be ready for reading.*/
|
2011-08-28 08:53:14 +00:00
|
|
|
if (_sdc_wait_for_transfer_state(sdcp))
|
2011-05-29 09:09:22 +00:00
|
|
|
return TRUE;
|
|
|
|
|
|
|
|
/* Prepares the DMA channel for reading.*/
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamSetMemory0(STM32_DMA2_STREAM4, buf);
|
|
|
|
dmaStreamSetTransactionSize(STM32_DMA2_STREAM4,
|
|
|
|
(n * SDC_BLOCK_SIZE) / sizeof (uint32_t));
|
|
|
|
dmaStreamSetMode(STM32_DMA2_STREAM4,
|
|
|
|
STM32_DMA_CR_PL(STM32_SDC_SDIO_DMA_PRIORITY) |
|
|
|
|
STM32_DMA_CR_DIR_P2M | STM32_DMA_CR_PSIZE_WORD |
|
|
|
|
STM32_DMA_CR_MSIZE_WORD | STM32_DMA_CR_MINC);
|
2011-05-29 09:09:22 +00:00
|
|
|
|
|
|
|
/* Setting up data transfer.
|
|
|
|
Options: Card to Controller, Block mode, DMA mode, 512 bytes blocks.*/
|
|
|
|
SDIO->ICR = 0xFFFFFFFF;
|
|
|
|
SDIO->MASK = SDIO_MASK_DCRCFAILIE | SDIO_MASK_DTIMEOUTIE |
|
|
|
|
SDIO_MASK_DATAENDIE | SDIO_MASK_STBITERRIE;
|
|
|
|
SDIO->DLEN = n * SDC_BLOCK_SIZE;
|
|
|
|
SDIO->DCTRL = SDIO_DCTRL_DTDIR |
|
|
|
|
SDIO_DCTRL_DBLOCKSIZE_3 | SDIO_DCTRL_DBLOCKSIZE_0 |
|
|
|
|
SDIO_DCTRL_DMAEN |
|
|
|
|
SDIO_DCTRL_DTEN;
|
|
|
|
|
|
|
|
/* DMA channel activation.*/
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamEnable(STM32_DMA2_STREAM4);
|
2011-05-29 09:09:22 +00:00
|
|
|
|
|
|
|
/* Read multiple blocks command.*/
|
|
|
|
if ((sdcp->cardmode & SDC_MODE_HIGH_CAPACITY) == 0)
|
|
|
|
startblk *= SDC_BLOCK_SIZE;
|
|
|
|
if (sdc_lld_send_cmd_short_crc(sdcp, SDC_CMD_READ_MULTIPLE_BLOCK,
|
|
|
|
startblk, resp) ||
|
|
|
|
SDC_R1_ERROR(resp[0]))
|
|
|
|
goto error;
|
|
|
|
|
|
|
|
chSysLock();
|
|
|
|
if (SDIO->MASK != 0) {
|
|
|
|
chDbgAssert(sdcp->thread == NULL,
|
|
|
|
"sdc_lld_read_multiple(), #1", "not NULL");
|
|
|
|
sdcp->thread = chThdSelf();
|
|
|
|
chSchGoSleepS(THD_STATE_SUSPENDED);
|
|
|
|
chDbgAssert(sdcp->thread == NULL,
|
|
|
|
"sdc_lld_read_multiple(), #2", "not NULL");
|
|
|
|
}
|
|
|
|
if ((SDIO->STA & SDIO_STA_DATAEND) == 0) {
|
|
|
|
chSysUnlock();
|
|
|
|
goto error;
|
|
|
|
}
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamDisable(STM32_DMA2_STREAM4);
|
2011-05-29 09:09:22 +00:00
|
|
|
SDIO->ICR = 0xFFFFFFFF;
|
|
|
|
SDIO->DCTRL = 0;
|
|
|
|
chSysUnlock();
|
|
|
|
|
|
|
|
return sdc_lld_send_cmd_short_crc(sdcp, SDC_CMD_STOP_TRANSMISSION, 0, resp);
|
|
|
|
error:
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamDisable(STM32_DMA2_STREAM4);
|
2011-05-29 09:09:22 +00:00
|
|
|
SDIO->ICR = 0xFFFFFFFF;
|
|
|
|
SDIO->MASK = 0;
|
|
|
|
SDIO->DCTRL = 0;
|
|
|
|
return TRUE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief Reads one block.
|
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
|
|
|
* @param[in] startblk first block to read
|
|
|
|
* @param[out] buf pointer to the read buffer, it must be aligned to
|
|
|
|
* four bytes boundary
|
|
|
|
* @return The operation status.
|
|
|
|
* @retval FALSE operation succeeded, the requested blocks have been
|
|
|
|
* read.
|
|
|
|
* @retval TRUE operation failed, the state of the buffer is uncertain.
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
static bool_t sdc_lld_read_single(SDCDriver *sdcp, uint32_t startblk,
|
|
|
|
uint8_t *buf) {
|
|
|
|
uint32_t resp[1];
|
|
|
|
|
|
|
|
/* Checks for errors and waits for the card to be ready for reading.*/
|
2011-08-28 08:53:14 +00:00
|
|
|
if (_sdc_wait_for_transfer_state(sdcp))
|
2011-05-29 09:09:22 +00:00
|
|
|
return TRUE;
|
|
|
|
|
|
|
|
/* Prepares the DMA channel for reading.*/
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamSetMemory0(STM32_DMA2_STREAM4, buf);
|
|
|
|
dmaStreamSetTransactionSize(STM32_DMA2_STREAM4,
|
|
|
|
SDC_BLOCK_SIZE / sizeof (uint32_t));
|
|
|
|
dmaStreamSetMode(STM32_DMA2_STREAM4,
|
|
|
|
STM32_DMA_CR_PL(STM32_SDC_SDIO_DMA_PRIORITY) |
|
|
|
|
STM32_DMA_CR_DIR_P2M | STM32_DMA_CR_PSIZE_WORD |
|
|
|
|
STM32_DMA_CR_MSIZE_WORD | STM32_DMA_CR_MINC);
|
2011-05-29 09:09:22 +00:00
|
|
|
|
|
|
|
/* Setting up data transfer.
|
|
|
|
Options: Card to Controller, Block mode, DMA mode, 512 bytes blocks.*/
|
|
|
|
SDIO->ICR = 0xFFFFFFFF;
|
|
|
|
SDIO->MASK = SDIO_MASK_DCRCFAILIE | SDIO_MASK_DTIMEOUTIE |
|
|
|
|
SDIO_MASK_DATAENDIE | SDIO_MASK_STBITERRIE;
|
|
|
|
SDIO->DLEN = SDC_BLOCK_SIZE;
|
|
|
|
SDIO->DCTRL = SDIO_DCTRL_DTDIR |
|
|
|
|
SDIO_DCTRL_DBLOCKSIZE_3 | SDIO_DCTRL_DBLOCKSIZE_0 |
|
|
|
|
SDIO_DCTRL_DMAEN |
|
|
|
|
SDIO_DCTRL_DTEN;
|
|
|
|
|
|
|
|
/* DMA channel activation.*/
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamEnable(STM32_DMA2_STREAM4);
|
2011-05-29 09:09:22 +00:00
|
|
|
|
|
|
|
/* Read single block command.*/
|
|
|
|
if ((sdcp->cardmode & SDC_MODE_HIGH_CAPACITY) == 0)
|
|
|
|
startblk *= SDC_BLOCK_SIZE;
|
|
|
|
if (sdc_lld_send_cmd_short_crc(sdcp, SDC_CMD_READ_SINGLE_BLOCK,
|
|
|
|
startblk, resp) ||
|
|
|
|
SDC_R1_ERROR(resp[0]))
|
|
|
|
goto error;
|
|
|
|
|
|
|
|
chSysLock();
|
|
|
|
if (SDIO->MASK != 0) {
|
|
|
|
chDbgAssert(sdcp->thread == NULL,
|
|
|
|
"sdc_lld_read_single(), #1", "not NULL");
|
|
|
|
sdcp->thread = chThdSelf();
|
|
|
|
chSchGoSleepS(THD_STATE_SUSPENDED);
|
|
|
|
chDbgAssert(sdcp->thread == NULL,
|
|
|
|
"sdc_lld_read_single(), #2", "not NULL");
|
|
|
|
}
|
|
|
|
if ((SDIO->STA & SDIO_STA_DATAEND) == 0) {
|
|
|
|
chSysUnlock();
|
|
|
|
goto error;
|
|
|
|
}
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamDisable(STM32_DMA2_STREAM4);
|
2011-05-29 09:09:22 +00:00
|
|
|
SDIO->ICR = 0xFFFFFFFF;
|
|
|
|
SDIO->DCTRL = 0;
|
|
|
|
chSysUnlock();
|
|
|
|
|
|
|
|
return FALSE;
|
|
|
|
error:
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamDisable(STM32_DMA2_STREAM4);
|
2011-05-29 09:09:22 +00:00
|
|
|
SDIO->ICR = 0xFFFFFFFF;
|
|
|
|
SDIO->MASK = 0;
|
|
|
|
SDIO->DCTRL = 0;
|
|
|
|
return TRUE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief Writes one or more blocks.
|
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
|
|
|
* @param[in] startblk first block to write
|
|
|
|
* @param[out] buf pointer to the write buffer, it must be aligned to
|
|
|
|
* four bytes boundary
|
|
|
|
* @param[in] n number of blocks to write
|
|
|
|
* @return The operation status.
|
|
|
|
* @retval FALSE operation succeeded, the requested blocks have been
|
|
|
|
* written.
|
|
|
|
* @retval TRUE operation failed.
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
static bool_t sdc_lld_write_multiple(SDCDriver *sdcp, uint32_t startblk,
|
|
|
|
const uint8_t *buf, uint32_t n) {
|
|
|
|
uint32_t resp[1];
|
|
|
|
|
|
|
|
/* Checks for errors and waits for the card to be ready for writing.*/
|
2011-08-28 08:53:14 +00:00
|
|
|
if (_sdc_wait_for_transfer_state(sdcp))
|
2011-05-29 09:09:22 +00:00
|
|
|
return TRUE;
|
|
|
|
|
|
|
|
/* Prepares the DMA channel for writing.*/
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamSetMemory0(STM32_DMA2_STREAM4, buf);
|
|
|
|
dmaStreamSetTransactionSize(STM32_DMA2_STREAM4,
|
|
|
|
(n * SDC_BLOCK_SIZE) / sizeof (uint32_t));
|
|
|
|
dmaStreamSetMode(STM32_DMA2_STREAM4,
|
|
|
|
STM32_DMA_CR_PL(STM32_SDC_SDIO_DMA_PRIORITY) |
|
|
|
|
STM32_DMA_CR_DIR_M2P | STM32_DMA_CR_PSIZE_WORD |
|
|
|
|
STM32_DMA_CR_MSIZE_WORD | STM32_DMA_CR_MINC);
|
2011-05-29 09:09:22 +00:00
|
|
|
|
|
|
|
/* Write multiple blocks command.*/
|
|
|
|
if ((sdcp->cardmode & SDC_MODE_HIGH_CAPACITY) == 0)
|
|
|
|
startblk *= SDC_BLOCK_SIZE;
|
|
|
|
if (sdc_lld_send_cmd_short_crc(sdcp, SDC_CMD_WRITE_MULTIPLE_BLOCK,
|
|
|
|
startblk, resp) ||
|
|
|
|
SDC_R1_ERROR(resp[0]))
|
|
|
|
return TRUE;
|
|
|
|
|
|
|
|
/* Setting up data transfer.
|
|
|
|
Options: Controller to Card, Block mode, DMA mode, 512 bytes blocks.*/
|
|
|
|
SDIO->ICR = 0xFFFFFFFF;
|
|
|
|
SDIO->MASK = SDIO_MASK_DCRCFAILIE | SDIO_MASK_DTIMEOUTIE |
|
|
|
|
SDIO_MASK_DATAENDIE | SDIO_MASK_TXUNDERRIE |
|
|
|
|
SDIO_MASK_STBITERRIE;
|
|
|
|
SDIO->DLEN = n * SDC_BLOCK_SIZE;
|
|
|
|
SDIO->DCTRL = SDIO_DCTRL_DBLOCKSIZE_3 | SDIO_DCTRL_DBLOCKSIZE_0 |
|
|
|
|
SDIO_DCTRL_DMAEN |
|
|
|
|
SDIO_DCTRL_DTEN;
|
|
|
|
|
|
|
|
/* DMA channel activation.*/
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamEnable(STM32_DMA2_STREAM4);
|
2011-05-29 09:09:22 +00:00
|
|
|
|
|
|
|
/* Note the mask is checked before going to sleep because the interrupt
|
|
|
|
may have occurred before reaching the critical zone.*/
|
|
|
|
chSysLock();
|
|
|
|
if (SDIO->MASK != 0) {
|
|
|
|
chDbgAssert(sdcp->thread == NULL,
|
|
|
|
"sdc_lld_write_multiple(), #1", "not NULL");
|
|
|
|
sdcp->thread = chThdSelf();
|
|
|
|
chSchGoSleepS(THD_STATE_SUSPENDED);
|
|
|
|
chDbgAssert(sdcp->thread == NULL,
|
|
|
|
"sdc_lld_write_multiple(), #2", "not NULL");
|
|
|
|
}
|
|
|
|
if ((SDIO->STA & SDIO_STA_DATAEND) == 0) {
|
|
|
|
chSysUnlock();
|
|
|
|
goto error;
|
|
|
|
}
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamDisable(STM32_DMA2_STREAM4);
|
2011-05-29 09:09:22 +00:00
|
|
|
SDIO->ICR = 0xFFFFFFFF;
|
|
|
|
SDIO->DCTRL = 0;
|
|
|
|
chSysUnlock();
|
|
|
|
|
|
|
|
return sdc_lld_send_cmd_short_crc(sdcp, SDC_CMD_STOP_TRANSMISSION, 0, resp);
|
|
|
|
error:
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamDisable(STM32_DMA2_STREAM4);
|
2011-05-29 09:09:22 +00:00
|
|
|
SDIO->ICR = 0xFFFFFFFF;
|
|
|
|
SDIO->MASK = 0;
|
|
|
|
SDIO->DCTRL = 0;
|
|
|
|
return TRUE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief Writes one block.
|
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
|
|
|
* @param[in] startblk first block to write
|
|
|
|
* @param[out] buf pointer to the write buffer, it must be aligned to
|
|
|
|
* four bytes boundary
|
|
|
|
* @param[in] n number of blocks to write
|
|
|
|
* @return The operation status.
|
|
|
|
* @retval FALSE operation succeeded, the requested blocks have been
|
|
|
|
* written.
|
|
|
|
* @retval TRUE operation failed.
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
static bool_t sdc_lld_write_single(SDCDriver *sdcp, uint32_t startblk,
|
|
|
|
const uint8_t *buf) {
|
|
|
|
uint32_t resp[1];
|
|
|
|
|
|
|
|
/* Checks for errors and waits for the card to be ready for writing.*/
|
2011-08-28 08:53:14 +00:00
|
|
|
if (_sdc_wait_for_transfer_state(sdcp))
|
2011-05-29 09:09:22 +00:00
|
|
|
return TRUE;
|
|
|
|
|
|
|
|
/* Prepares the DMA channel for writing.*/
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamSetMemory0(STM32_DMA2_STREAM4, buf);
|
|
|
|
dmaStreamSetTransactionSize(STM32_DMA2_STREAM4,
|
|
|
|
SDC_BLOCK_SIZE / sizeof (uint32_t));
|
|
|
|
dmaStreamSetMode(STM32_DMA2_STREAM4,
|
|
|
|
STM32_DMA_CR_PL(STM32_SDC_SDIO_DMA_PRIORITY) |
|
|
|
|
STM32_DMA_CR_DIR_M2P | STM32_DMA_CR_PSIZE_WORD |
|
|
|
|
STM32_DMA_CR_MSIZE_WORD | STM32_DMA_CR_MINC);
|
2011-05-29 09:09:22 +00:00
|
|
|
|
|
|
|
/* Write single block command.*/
|
|
|
|
if ((sdcp->cardmode & SDC_MODE_HIGH_CAPACITY) == 0)
|
|
|
|
startblk *= SDC_BLOCK_SIZE;
|
|
|
|
if (sdc_lld_send_cmd_short_crc(sdcp, SDC_CMD_WRITE_BLOCK,
|
|
|
|
startblk, resp) ||
|
|
|
|
SDC_R1_ERROR(resp[0]))
|
|
|
|
return TRUE;
|
|
|
|
|
|
|
|
/* Setting up data transfer.
|
|
|
|
Options: Controller to Card, Block mode, DMA mode, 512 bytes blocks.*/
|
|
|
|
SDIO->ICR = 0xFFFFFFFF;
|
|
|
|
SDIO->MASK = SDIO_MASK_DCRCFAILIE | SDIO_MASK_DTIMEOUTIE |
|
|
|
|
SDIO_MASK_DATAENDIE | SDIO_MASK_TXUNDERRIE |
|
|
|
|
SDIO_MASK_STBITERRIE;
|
|
|
|
SDIO->DLEN = SDC_BLOCK_SIZE;
|
|
|
|
SDIO->DCTRL = SDIO_DCTRL_DBLOCKSIZE_3 | SDIO_DCTRL_DBLOCKSIZE_0 |
|
|
|
|
SDIO_DCTRL_DMAEN |
|
|
|
|
SDIO_DCTRL_DTEN;
|
|
|
|
|
|
|
|
/* DMA channel activation.*/
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamEnable(STM32_DMA2_STREAM4);
|
2011-05-29 09:09:22 +00:00
|
|
|
|
|
|
|
/* Note the mask is checked before going to sleep because the interrupt
|
|
|
|
may have occurred before reaching the critical zone.*/
|
|
|
|
chSysLock();
|
|
|
|
if (SDIO->MASK != 0) {
|
|
|
|
chDbgAssert(sdcp->thread == NULL,
|
|
|
|
"sdc_lld_write_single(), #1", "not NULL");
|
|
|
|
sdcp->thread = chThdSelf();
|
|
|
|
chSchGoSleepS(THD_STATE_SUSPENDED);
|
|
|
|
chDbgAssert(sdcp->thread == NULL,
|
|
|
|
"sdc_lld_write_single(), #2", "not NULL");
|
|
|
|
}
|
|
|
|
if ((SDIO->STA & SDIO_STA_DATAEND) == 0) {
|
|
|
|
chSysUnlock();
|
|
|
|
goto error;
|
|
|
|
}
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamDisable(STM32_DMA2_STREAM4);
|
2011-05-29 09:09:22 +00:00
|
|
|
SDIO->ICR = 0xFFFFFFFF;
|
|
|
|
SDIO->DCTRL = 0;
|
|
|
|
chSysUnlock();
|
|
|
|
|
|
|
|
return FALSE;
|
|
|
|
error:
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamDisable(STM32_DMA2_STREAM4);
|
2011-05-29 09:09:22 +00:00
|
|
|
SDIO->ICR = 0xFFFFFFFF;
|
|
|
|
SDIO->MASK = 0;
|
|
|
|
SDIO->DCTRL = 0;
|
|
|
|
return TRUE;
|
|
|
|
}
|
|
|
|
|
2011-04-26 16:59:14 +00:00
|
|
|
/*===========================================================================*/
|
|
|
|
/* Driver interrupt handlers. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief SDIO IRQ handler.
|
|
|
|
*
|
|
|
|
* @isr
|
|
|
|
*/
|
|
|
|
CH_IRQ_HANDLER(SDIO_IRQHandler) {
|
|
|
|
|
|
|
|
CH_IRQ_PROLOGUE();
|
|
|
|
|
2011-05-07 19:33:47 +00:00
|
|
|
chSysLockFromIsr();
|
|
|
|
if (SDCD1.thread != NULL) {
|
|
|
|
chSchReadyI(SDCD1.thread);
|
|
|
|
SDCD1.thread = NULL;
|
|
|
|
}
|
|
|
|
chSysUnlockFromIsr();
|
2011-04-26 16:59:14 +00:00
|
|
|
|
2011-05-08 09:58:19 +00:00
|
|
|
/* Disables the source but the status flags are not reset because the
|
2011-05-08 19:37:57 +00:00
|
|
|
read/write functions need to check them.*/
|
2011-05-08 09:58:19 +00:00
|
|
|
SDIO->MASK = 0;
|
2011-05-08 06:12:09 +00:00
|
|
|
|
2011-04-26 16:59:14 +00:00
|
|
|
CH_IRQ_EPILOGUE();
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*/
|
|
|
|
/* Driver exported functions. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief Low level SDC driver initialization.
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
void sdc_lld_init(void) {
|
|
|
|
|
|
|
|
sdcObjectInit(&SDCD1);
|
2011-05-02 19:49:35 +00:00
|
|
|
SDCD1.thread = NULL;
|
2011-04-26 16:59:14 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief Configures and activates the SDC peripheral.
|
|
|
|
*
|
2011-06-05 08:39:49 +00:00
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object, must be @p NULL,
|
|
|
|
* this driver does not require any configuration
|
2011-04-26 16:59:14 +00:00
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
void sdc_lld_start(SDCDriver *sdcp) {
|
|
|
|
|
|
|
|
if (sdcp->state == SDC_STOP) {
|
|
|
|
/* Note, the DMA must be enabled before the IRQs.*/
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamAllocate(STM32_DMA2_STREAM4, 0, NULL, NULL);
|
|
|
|
dmaStreamSetPeripheral(STM32_DMA2_STREAM4, &SDIO->FIFO);
|
2011-12-21 18:49:04 +00:00
|
|
|
nvicEnableVector(SDIO_IRQn,
|
2011-04-26 16:59:14 +00:00
|
|
|
CORTEX_PRIORITY_MASK(STM32_SDC_SDIO_IRQ_PRIORITY));
|
2011-09-16 17:38:22 +00:00
|
|
|
rccEnableSDIO(FALSE);
|
2011-04-26 16:59:14 +00:00
|
|
|
}
|
|
|
|
/* Configuration, card clock is initially stopped.*/
|
2011-05-04 14:38:02 +00:00
|
|
|
SDIO->POWER = 0;
|
|
|
|
SDIO->CLKCR = 0;
|
|
|
|
SDIO->DCTRL = 0;
|
|
|
|
SDIO->DTIMER = STM32_SDC_DATATIMEOUT;
|
2011-04-26 16:59:14 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief Deactivates the SDC peripheral.
|
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
void sdc_lld_stop(SDCDriver *sdcp) {
|
|
|
|
|
|
|
|
if ((sdcp->state == SDC_READY) || (sdcp->state == SDC_ACTIVE)) {
|
2011-05-04 14:38:02 +00:00
|
|
|
SDIO->POWER = 0;
|
|
|
|
SDIO->CLKCR = 0;
|
|
|
|
SDIO->DCTRL = 0;
|
|
|
|
SDIO->DTIMER = 0;
|
2011-04-26 16:59:14 +00:00
|
|
|
|
|
|
|
/* Clock deactivation.*/
|
2011-12-21 18:49:04 +00:00
|
|
|
nvicDisableVector(SDIO_IRQn);
|
2011-08-28 08:53:14 +00:00
|
|
|
dmaStreamRelease(STM32_DMA2_STREAM4);
|
2011-09-16 17:38:22 +00:00
|
|
|
rccDisableSDIO(FALSE);
|
2011-04-26 16:59:14 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2011-04-30 07:52:35 +00:00
|
|
|
/**
|
2012-03-26 09:13:37 +00:00
|
|
|
* @brief Starts the SDIO clock and sets it to init mode (400kHz or less).
|
2011-04-30 07:52:35 +00:00
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
void sdc_lld_start_clk(SDCDriver *sdcp) {
|
|
|
|
|
|
|
|
(void)sdcp;
|
2012-03-26 09:13:37 +00:00
|
|
|
/* Initial clock setting: 400kHz, 1bit mode.*/
|
2011-04-30 07:52:35 +00:00
|
|
|
SDIO->CLKCR = STM32_SDIO_DIV_LS;
|
|
|
|
SDIO->POWER |= SDIO_POWER_PWRCTRL_0 | SDIO_POWER_PWRCTRL_1;
|
|
|
|
SDIO->CLKCR |= SDIO_CLKCR_CLKEN;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief Sets the SDIO clock to data mode (25MHz or less).
|
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
void sdc_lld_set_data_clk(SDCDriver *sdcp) {
|
|
|
|
|
|
|
|
(void)sdcp;
|
|
|
|
SDIO->CLKCR = (SDIO->CLKCR & 0xFFFFFF00) | STM32_SDIO_DIV_HS;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief Stops the SDIO clock.
|
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
void sdc_lld_stop_clk(SDCDriver *sdcp) {
|
|
|
|
|
|
|
|
(void)sdcp;
|
|
|
|
SDIO->CLKCR = 0;
|
|
|
|
SDIO->POWER = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief Switches the bus to 4 bits mode.
|
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
2011-05-14 08:27:27 +00:00
|
|
|
* @param[in] mode bus mode
|
2011-04-30 07:52:35 +00:00
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
void sdc_lld_set_bus_mode(SDCDriver *sdcp, sdcbusmode_t mode) {
|
|
|
|
uint32_t clk = SDIO->CLKCR & ~SDIO_CLKCR_WIDBUS;
|
|
|
|
|
|
|
|
(void)sdcp;
|
|
|
|
switch (mode) {
|
|
|
|
case SDC_MODE_1BIT:
|
|
|
|
SDIO->CLKCR = clk;
|
|
|
|
break;
|
|
|
|
case SDC_MODE_4BIT:
|
|
|
|
SDIO->CLKCR = clk | SDIO_CLKCR_WIDBUS_0;
|
|
|
|
break;
|
|
|
|
case SDC_MODE_8BIT:
|
|
|
|
SDIO->CLKCR = clk | SDIO_CLKCR_WIDBUS_1;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2011-04-26 16:59:14 +00:00
|
|
|
/**
|
|
|
|
* @brief Sends an SDIO command with no response expected.
|
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
2011-05-14 08:27:27 +00:00
|
|
|
* @param[in] cmd card command
|
2011-05-01 09:10:22 +00:00
|
|
|
* @param[in] arg command argument
|
2011-04-26 16:59:14 +00:00
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
void sdc_lld_send_cmd_none(SDCDriver *sdcp, uint8_t cmd, uint32_t arg) {
|
|
|
|
|
2011-04-30 18:46:09 +00:00
|
|
|
(void)sdcp;
|
|
|
|
SDIO->ARG = arg;
|
|
|
|
SDIO->CMD = (uint32_t)cmd | SDIO_CMD_CPSMEN;
|
|
|
|
while ((SDIO->STA & SDIO_STA_CMDSENT) == 0)
|
|
|
|
;
|
2011-05-07 13:24:04 +00:00
|
|
|
SDIO->ICR = SDIO_ICR_CMDSENTC;
|
2011-04-26 16:59:14 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief Sends an SDIO command with a short response expected.
|
2011-05-01 10:33:44 +00:00
|
|
|
* @note The CRC is not verified.
|
2011-04-26 16:59:14 +00:00
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
2011-05-14 08:27:27 +00:00
|
|
|
* @param[in] cmd card command
|
2011-05-01 09:10:22 +00:00
|
|
|
* @param[in] arg command argument
|
|
|
|
* @param[out] resp pointer to the response buffer (one word)
|
2011-04-26 16:59:14 +00:00
|
|
|
* @return The operation status.
|
|
|
|
* @retval FALSE the operation succeeded.
|
|
|
|
* @retval TRUE the operation failed because timeout, CRC check or
|
|
|
|
* other errors.
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
bool_t sdc_lld_send_cmd_short(SDCDriver *sdcp, uint8_t cmd, uint32_t arg,
|
|
|
|
uint32_t *resp) {
|
2011-05-01 09:10:22 +00:00
|
|
|
uint32_t sta;
|
2011-04-26 16:59:14 +00:00
|
|
|
|
2011-05-01 10:33:44 +00:00
|
|
|
(void)sdcp;
|
|
|
|
SDIO->ARG = arg;
|
|
|
|
SDIO->CMD = (uint32_t)cmd | SDIO_CMD_WAITRESP_0 | SDIO_CMD_CPSMEN;
|
|
|
|
while (((sta = SDIO->STA) & (SDIO_STA_CMDREND | SDIO_STA_CTIMEOUT |
|
|
|
|
SDIO_STA_CCRCFAIL)) == 0)
|
|
|
|
;
|
2011-05-07 13:24:04 +00:00
|
|
|
SDIO->ICR = SDIO_ICR_CMDRENDC | SDIO_ICR_CTIMEOUTC | SDIO_ICR_CCRCFAILC;
|
2011-05-01 10:33:44 +00:00
|
|
|
if ((sta & (SDIO_STA_CTIMEOUT)) != 0)
|
|
|
|
return TRUE;
|
|
|
|
*resp = SDIO->RESP1;
|
|
|
|
return FALSE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @brief Sends an SDIO command with a short response expected and CRC.
|
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
2011-05-14 08:27:27 +00:00
|
|
|
* @param[in] cmd card command
|
2011-05-01 10:33:44 +00:00
|
|
|
* @param[in] arg command argument
|
|
|
|
* @param[out] resp pointer to the response buffer (one word)
|
|
|
|
* @return The operation status.
|
|
|
|
* @retval FALSE the operation succeeded.
|
|
|
|
* @retval TRUE the operation failed because timeout, CRC check or
|
|
|
|
* other errors.
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
|
|
|
bool_t sdc_lld_send_cmd_short_crc(SDCDriver *sdcp, uint8_t cmd, uint32_t arg,
|
|
|
|
uint32_t *resp) {
|
|
|
|
uint32_t sta;
|
|
|
|
|
2011-05-01 09:10:22 +00:00
|
|
|
(void)sdcp;
|
|
|
|
SDIO->ARG = arg;
|
|
|
|
SDIO->CMD = (uint32_t)cmd | SDIO_CMD_WAITRESP_0 | SDIO_CMD_CPSMEN;
|
|
|
|
while (((sta = SDIO->STA) & (SDIO_STA_CMDREND | SDIO_STA_CTIMEOUT |
|
|
|
|
SDIO_STA_CCRCFAIL)) == 0)
|
|
|
|
;
|
2011-05-07 13:24:04 +00:00
|
|
|
SDIO->ICR = SDIO_ICR_CMDRENDC | SDIO_ICR_CTIMEOUTC | SDIO_ICR_CCRCFAILC;
|
2011-05-01 09:10:22 +00:00
|
|
|
if ((sta & (SDIO_STA_CTIMEOUT | SDIO_STA_CCRCFAIL)) != 0)
|
|
|
|
return TRUE;
|
|
|
|
*resp = SDIO->RESP1;
|
|
|
|
return FALSE;
|
2011-04-26 16:59:14 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2011-05-01 10:33:44 +00:00
|
|
|
* @brief Sends an SDIO command with a long response expected and CRC.
|
2011-04-26 16:59:14 +00:00
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
2011-05-14 08:27:27 +00:00
|
|
|
* @param[in] cmd card command
|
2011-05-01 09:10:22 +00:00
|
|
|
* @param[in] arg command argument
|
|
|
|
* @param[out] resp pointer to the response buffer (four words)
|
2011-04-26 16:59:14 +00:00
|
|
|
* @return The operation status.
|
|
|
|
* @retval FALSE the operation succeeded.
|
|
|
|
* @retval TRUE the operation failed because timeout, CRC check or
|
|
|
|
* other errors.
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
2011-05-01 10:33:44 +00:00
|
|
|
bool_t sdc_lld_send_cmd_long_crc(SDCDriver *sdcp, uint8_t cmd, uint32_t arg,
|
|
|
|
uint32_t *resp) {
|
2011-04-26 16:59:14 +00:00
|
|
|
|
2011-05-01 09:10:22 +00:00
|
|
|
uint32_t sta;
|
|
|
|
|
|
|
|
(void)sdcp;
|
|
|
|
SDIO->ARG = arg;
|
|
|
|
SDIO->CMD = (uint32_t)cmd | SDIO_CMD_WAITRESP_0 | SDIO_CMD_WAITRESP_1 |
|
|
|
|
SDIO_CMD_CPSMEN;
|
|
|
|
while (((sta = SDIO->STA) & (SDIO_STA_CMDREND | SDIO_STA_CTIMEOUT |
|
|
|
|
SDIO_STA_CCRCFAIL)) == 0)
|
|
|
|
;
|
2011-05-07 13:24:04 +00:00
|
|
|
SDIO->ICR = SDIO_ICR_CMDRENDC | SDIO_ICR_CTIMEOUTC | SDIO_ICR_CCRCFAILC;
|
2011-05-01 09:10:22 +00:00
|
|
|
if ((sta & (SDIO_STA_CTIMEOUT | SDIO_STA_CCRCFAIL)) != 0)
|
|
|
|
return TRUE;
|
|
|
|
*resp = SDIO->RESP1;
|
|
|
|
return FALSE;
|
2011-04-26 16:59:14 +00:00
|
|
|
}
|
|
|
|
|
2011-05-02 15:23:50 +00:00
|
|
|
/**
|
2011-05-07 13:24:04 +00:00
|
|
|
* @brief Reads one or more blocks.
|
2011-05-02 15:23:50 +00:00
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
2011-05-07 13:24:04 +00:00
|
|
|
* @param[in] startblk first block to read
|
2011-05-02 15:23:50 +00:00
|
|
|
* @param[out] buf pointer to the read buffer
|
|
|
|
* @param[in] n number of blocks to read
|
|
|
|
* @return The operation status.
|
|
|
|
* @retval FALSE operation succeeded, the requested blocks have been
|
|
|
|
* read.
|
|
|
|
* @retval TRUE operation failed, the state of the buffer is uncertain.
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
2011-05-07 13:24:04 +00:00
|
|
|
bool_t sdc_lld_read(SDCDriver *sdcp, uint32_t startblk,
|
|
|
|
uint8_t *buf, uint32_t n) {
|
|
|
|
|
2011-05-29 09:09:22 +00:00
|
|
|
#if STM32_SDC_UNALIGNED_SUPPORT
|
|
|
|
if (((unsigned)buf & 3) != 0) {
|
|
|
|
uint32_t i;
|
|
|
|
for (i = 0; i < n; i++) {
|
|
|
|
if (sdc_lld_read_single(sdcp, startblk, u.buf))
|
|
|
|
return TRUE;
|
|
|
|
memcpy(buf, u.buf, SDC_BLOCK_SIZE);
|
|
|
|
buf += SDC_BLOCK_SIZE;
|
|
|
|
startblk++;
|
|
|
|
}
|
|
|
|
return FALSE;
|
2011-05-07 19:33:47 +00:00
|
|
|
}
|
2011-05-29 09:09:22 +00:00
|
|
|
#endif
|
|
|
|
if (n == 1)
|
|
|
|
return sdc_lld_read_single(sdcp, startblk, buf);
|
|
|
|
return sdc_lld_read_multiple(sdcp, startblk, buf, n);
|
2011-05-02 15:23:50 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
2011-05-07 13:24:04 +00:00
|
|
|
* @brief Writes one or more blocks.
|
2011-05-02 15:23:50 +00:00
|
|
|
*
|
|
|
|
* @param[in] sdcp pointer to the @p SDCDriver object
|
2011-05-07 13:24:04 +00:00
|
|
|
* @param[in] startblk first block to write
|
2011-05-02 15:23:50 +00:00
|
|
|
* @param[out] buf pointer to the write buffer
|
|
|
|
* @param[in] n number of blocks to write
|
|
|
|
* @return The operation status.
|
|
|
|
* @retval FALSE operation succeeded, the requested blocks have been
|
|
|
|
* written.
|
|
|
|
* @retval TRUE operation failed.
|
|
|
|
*
|
|
|
|
* @notapi
|
|
|
|
*/
|
2011-05-07 13:24:04 +00:00
|
|
|
bool_t sdc_lld_write(SDCDriver *sdcp, uint32_t startblk,
|
|
|
|
const uint8_t *buf, uint32_t n) {
|
2011-05-08 19:46:49 +00:00
|
|
|
|
2012-01-22 09:27:59 +00:00
|
|
|
#if STM32_SDC_UNALIGNED_SUPPORT
|
2011-05-29 09:09:22 +00:00
|
|
|
if (((unsigned)buf & 3) != 0) {
|
|
|
|
uint32_t i;
|
|
|
|
for (i = 0; i < n; i++) {
|
|
|
|
memcpy(u.buf, buf, SDC_BLOCK_SIZE);
|
|
|
|
buf += SDC_BLOCK_SIZE;
|
|
|
|
if (sdc_lld_write_single(sdcp, startblk, u.buf))
|
|
|
|
return TRUE;
|
|
|
|
startblk++;
|
|
|
|
}
|
|
|
|
return FALSE;
|
2011-05-08 19:46:49 +00:00
|
|
|
}
|
2011-05-29 09:09:22 +00:00
|
|
|
#endif
|
|
|
|
if (n == 1)
|
|
|
|
return sdc_lld_write_single(sdcp, startblk, buf);
|
|
|
|
return sdc_lld_write_multiple(sdcp, startblk, buf, n);
|
2011-05-02 15:23:50 +00:00
|
|
|
}
|
|
|
|
|
2011-04-26 16:59:14 +00:00
|
|
|
#endif /* HAL_USE_SDC */
|
|
|
|
|
|
|
|
/** @} */
|