387 lines
11 KiB
C
387 lines
11 KiB
C
/**
|
|
******************************************************************************
|
|
* @file sd_diskio_dma_rtos_template.c
|
|
* @author MCD Application Team
|
|
* @version V2.0.2
|
|
* @date 10-November-2017
|
|
* @brief SD Disk I/O DMA with RTOS driver template. This file needs to be
|
|
copied at user project alongside the respective header file.
|
|
******************************************************************************
|
|
* @attention
|
|
*
|
|
* <h2><center>© Copyright (c) 2017 STMicroelectronics International N.V.
|
|
* All rights reserved.</center></h2>
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted, provided that the following conditions are met:
|
|
*
|
|
* 1. Redistribution of source code must retain the above copyright notice,
|
|
* this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright notice,
|
|
* this list of conditions and the following disclaimer in the documentation
|
|
* and/or other materials provided with the distribution.
|
|
* 3. Neither the name of STMicroelectronics nor the names of other
|
|
* contributors to this software may be used to endorse or promote products
|
|
* derived from this software without specific written permission.
|
|
* 4. This software, including modifications and/or derivative works of this
|
|
* software, must execute solely and exclusively on microcontroller or
|
|
* microprocessor devices manufactured by or for STMicroelectronics.
|
|
* 5. Redistribution and use of this software other than as permitted under
|
|
* this license is void and will automatically terminate your rights under
|
|
* this license.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY STMICROELECTRONICS AND CONTRIBUTORS "AS IS"
|
|
* AND ANY EXPRESS, IMPLIED OR STATUTORY WARRANTIES, INCLUDING, BUT NOT
|
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS FOR A
|
|
* PARTICULAR PURPOSE AND NON-INFRINGEMENT OF THIRD PARTY INTELLECTUAL PROPERTY
|
|
* RIGHTS ARE DISCLAIMED TO THE FULLEST EXTENT PERMITTED BY LAW. IN NO EVENT
|
|
* SHALL STMICROELECTRONICS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*
|
|
******************************************************************************
|
|
*/
|
|
|
|
/* Includes ------------------------------------------------------------------*/
|
|
#include "ff_gen_drv.h"
|
|
#include "sd_diskio_dma_rtos.h"
|
|
|
|
|
|
/* Private typedef -----------------------------------------------------------*/
|
|
/* Private define ------------------------------------------------------------*/
|
|
#define QUEUE_SIZE (uint32_t) 10
|
|
#define READ_CPLT_MSG (uint32_t) 1
|
|
#define WRITE_CPLT_MSG (uint32_t) 2
|
|
|
|
/*
|
|
* the following Timeout is useful to give the control back to the applications
|
|
* in case of errors in either BSP_SD_ReadCpltCallback() or BSP_SD_WriteCpltCallback()
|
|
* the value by default is as defined in the BSP platform driver otherwise 30 secs
|
|
*
|
|
*/
|
|
|
|
#define SD_TIMEOUT 30 * 1000
|
|
|
|
#define SD_DEFAULT_BLOCK_SIZE 512
|
|
|
|
/*
|
|
* Depending on the usecase, the SD card initialization could be done at the
|
|
* application level, if it is the case define the flag below to disable
|
|
* the BSP_SD_Init() call in the SD_Initialize().
|
|
*/
|
|
|
|
/* #define DISABLE_SD_INIT */
|
|
|
|
|
|
/*
|
|
* when using cachable memory region, it may be needed to maintain the cache
|
|
* validity. Enable the define below to activate a cache maintenance at each
|
|
* read and write operation.
|
|
* Notice: This is applicable only for cortex M7 based platform.
|
|
*/
|
|
|
|
/* #define ENABLE_SD_DMA_CACHE_MAINTENANCE 1 */
|
|
|
|
|
|
/* Private variables ---------------------------------------------------------*/
|
|
/* Disk status */
|
|
static volatile DSTATUS Stat = STA_NOINIT;
|
|
static osMessageQId SDQueueID;
|
|
/* Private function prototypes -----------------------------------------------*/
|
|
static DSTATUS SD_CheckStatus(BYTE lun);
|
|
DSTATUS SD_initialize (BYTE);
|
|
DSTATUS SD_status (BYTE);
|
|
DRESULT SD_read (BYTE, BYTE*, DWORD, UINT);
|
|
#if _USE_WRITE == 1
|
|
DRESULT SD_write (BYTE, const BYTE*, DWORD, UINT);
|
|
#endif /* _USE_WRITE == 1 */
|
|
#if _USE_IOCTL == 1
|
|
DRESULT SD_ioctl (BYTE, BYTE, void*);
|
|
#endif /* _USE_IOCTL == 1 */
|
|
|
|
const Diskio_drvTypeDef SD_Driver =
|
|
{
|
|
SD_initialize,
|
|
SD_status,
|
|
SD_read,
|
|
#if _USE_WRITE == 1
|
|
SD_write,
|
|
#endif /* _USE_WRITE == 1 */
|
|
|
|
#if _USE_IOCTL == 1
|
|
SD_ioctl,
|
|
#endif /* _USE_IOCTL == 1 */
|
|
};
|
|
|
|
/* Private functions ---------------------------------------------------------*/
|
|
static DSTATUS SD_CheckStatus(BYTE lun)
|
|
{
|
|
Stat = STA_NOINIT;
|
|
|
|
if(BSP_SD_GetCardState() == MSD_OK)
|
|
{
|
|
Stat &= ~STA_NOINIT;
|
|
}
|
|
|
|
return Stat;
|
|
}
|
|
|
|
/**
|
|
* @brief Initializes a Drive
|
|
* @param lun : not used
|
|
* @retval DSTATUS: Operation status
|
|
*/
|
|
DSTATUS SD_initialize(BYTE lun)
|
|
{
|
|
Stat = STA_NOINIT;
|
|
/*
|
|
* check that the kernel has been started before continuing
|
|
* as the osMessage API will fail otherwise
|
|
*/
|
|
if(osKernelRunning())
|
|
{
|
|
#if !defined(DISABLE_SD_INIT)
|
|
|
|
if(BSP_SD_Init() == MSD_OK)
|
|
{
|
|
Stat = SD_CheckStatus(lun);
|
|
}
|
|
|
|
#else
|
|
Stat = SD_CheckStatus(lun);
|
|
#endif
|
|
|
|
/*
|
|
* if the SD is correctly initialized, create the operation queue
|
|
*/
|
|
|
|
if (Stat != STA_NOINIT)
|
|
{
|
|
osMessageQDef(SD_Queue, QUEUE_SIZE, uint16_t);
|
|
SDQueueID = osMessageCreate (osMessageQ(SD_Queue), NULL);
|
|
}
|
|
}
|
|
|
|
return Stat;
|
|
}
|
|
|
|
/**
|
|
* @brief Gets Disk Status
|
|
* @param lun : not used
|
|
* @retval DSTATUS: Operation status
|
|
*/
|
|
DSTATUS SD_status(BYTE lun)
|
|
{
|
|
return SD_CheckStatus(lun);
|
|
}
|
|
|
|
/**
|
|
* @brief Reads Sector(s)
|
|
* @param lun : not used
|
|
* @param *buff: Data buffer to store read data
|
|
* @param sector: Sector address (LBA)
|
|
* @param count: Number of sectors to read (1..128)
|
|
* @retval DRESULT: Operation result
|
|
*/
|
|
DRESULT SD_read(BYTE lun, BYTE *buff, DWORD sector, UINT count)
|
|
{
|
|
DRESULT res = RES_ERROR;
|
|
osEvent event;
|
|
uint32_t timer;
|
|
#if (ENABLE_SD_DMA_CACHE_MAINTENANCE == 1)
|
|
uint32_t alignedAddr;
|
|
#endif
|
|
|
|
if(BSP_SD_ReadBlocks_DMA((uint32_t*)buff,
|
|
(uint32_t) (sector),
|
|
count) == MSD_OK)
|
|
{
|
|
/* wait for a message from the queue or a timeout */
|
|
event = osMessageGet(SDQueueID, SD_TIMEOUT);
|
|
|
|
if (event.status == osEventMessage)
|
|
{
|
|
if (event.value.v == READ_CPLT_MSG)
|
|
{
|
|
timer = osKernelSysTick() + SD_TIMEOUT;
|
|
/* block until SDIO IP is ready or a timeout occur */
|
|
while(timer > osKernelSysTick())
|
|
{
|
|
if (BSP_SD_GetCardState() == SD_TRANSFER_OK)
|
|
{
|
|
res = RES_OK;
|
|
#if (ENABLE_SD_DMA_CACHE_MAINTENANCE == 1)
|
|
/*
|
|
the SCB_InvalidateDCache_by_Addr() requires a 32-Byte aligned address,
|
|
adjust the address and the D-Cache size to invalidate accordingly.
|
|
*/
|
|
alignedAddr = (uint32_t)buff & ~0x1F;
|
|
SCB_InvalidateDCache_by_Addr((uint32_t*)alignedAddr, count*BLOCKSIZE + ((uint32_t)buff - alignedAddr));
|
|
#endif
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
return res;
|
|
}
|
|
|
|
/**
|
|
* @brief Writes Sector(s)
|
|
* @param lun : not used
|
|
* @param *buff: Data to be written
|
|
* @param sector: Sector address (LBA)
|
|
* @param count: Number of sectors to write (1..128)
|
|
* @retval DRESULT: Operation result
|
|
*/
|
|
#if _USE_WRITE == 1
|
|
DRESULT SD_write(BYTE lun, const BYTE *buff, DWORD sector, UINT count)
|
|
{
|
|
osEvent event;
|
|
DRESULT res = RES_ERROR;
|
|
uint32_t timer;
|
|
#if (ENABLE_SD_DMA_CACHE_MAINTENANCE == 1)
|
|
uint32_t alignedAddr;
|
|
/*
|
|
the SCB_CleanDCache_by_Addr() requires a 32-Byte aligned address
|
|
adjust the address and the D-Cache size to clean accordingly.
|
|
*/
|
|
alignedAddr = (uint32_t)buff & ~0x1F;
|
|
SCB_CleanDCache_by_Addr((uint32_t*)alignedAddr, count*BLOCKSIZE + ((uint32_t)buff - alignedAddr));
|
|
#endif
|
|
|
|
|
|
if(BSP_SD_WriteBlocks_DMA((uint32_t*)buff,
|
|
(uint32_t) (sector),
|
|
count) == MSD_OK)
|
|
{
|
|
/* Get the message from the queue */
|
|
event = osMessageGet(SDQueueID, SD_TIMEOUT);
|
|
|
|
if (event.status == osEventMessage)
|
|
{
|
|
if (event.value.v == WRITE_CPLT_MSG)
|
|
{
|
|
timer = osKernelSysTick() + SD_TIMEOUT;
|
|
/* block until SDIO IP is ready or a timeout occur */
|
|
while(timer > osKernelSysTick())
|
|
{
|
|
if (BSP_SD_GetCardState() == SD_TRANSFER_OK)
|
|
{
|
|
res = RES_OK;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
return res;
|
|
}
|
|
#endif /* _USE_WRITE == 1 */
|
|
|
|
/**
|
|
* @brief I/O control operation
|
|
* @param lun : not used
|
|
* @param cmd: Control code
|
|
* @param *buff: Buffer to send/receive control data
|
|
* @retval DRESULT: Operation result
|
|
*/
|
|
#if _USE_IOCTL == 1
|
|
DRESULT SD_ioctl(BYTE lun, BYTE cmd, void *buff)
|
|
{
|
|
DRESULT res = RES_ERROR;
|
|
BSP_SD_CardInfo CardInfo;
|
|
|
|
if (Stat & STA_NOINIT) return RES_NOTRDY;
|
|
|
|
switch (cmd)
|
|
{
|
|
/* Make sure that no pending write process */
|
|
case CTRL_SYNC :
|
|
res = RES_OK;
|
|
break;
|
|
|
|
/* Get number of sectors on the disk (DWORD) */
|
|
case GET_SECTOR_COUNT :
|
|
BSP_SD_GetCardInfo(&CardInfo);
|
|
*(DWORD*)buff = CardInfo.LogBlockNbr;
|
|
res = RES_OK;
|
|
break;
|
|
|
|
/* Get R/W sector size (WORD) */
|
|
case GET_SECTOR_SIZE :
|
|
BSP_SD_GetCardInfo(&CardInfo);
|
|
*(WORD*)buff = CardInfo.LogBlockSize;
|
|
res = RES_OK;
|
|
break;
|
|
|
|
/* Get erase block size in unit of sector (DWORD) */
|
|
case GET_BLOCK_SIZE :
|
|
BSP_SD_GetCardInfo(&CardInfo);
|
|
*(DWORD*)buff = CardInfo.LogBlockSize / SD_DEFAULT_BLOCK_SIZE;
|
|
res = RES_OK;
|
|
break;
|
|
|
|
default:
|
|
res = RES_PARERR;
|
|
}
|
|
|
|
return res;
|
|
}
|
|
#endif /* _USE_IOCTL == 1 */
|
|
|
|
|
|
|
|
/**
|
|
* @brief Tx Transfer completed callbacks
|
|
* @param hsd: SD handle
|
|
* @retval None
|
|
*/
|
|
/*
|
|
===============================================================================
|
|
Select the correct function signature depending on your platform.
|
|
please refer to the file "stm32xxxx_eval_sd.h" to verify the correct function
|
|
prototype
|
|
===============================================================================
|
|
*/
|
|
//void BSP_SD_WriteCpltCallback(uint32_t SdCard)
|
|
void BSP_SD_WriteCpltCallback(void)
|
|
{
|
|
/*
|
|
* No need to add an "osKernelRunning()" check here, as the SD_initialize()
|
|
* is always called before any SD_Read()/SD_Write() call
|
|
*/
|
|
osMessagePut(SDQueueID, WRITE_CPLT_MSG, osWaitForever);
|
|
}
|
|
|
|
/**
|
|
* @brief Rx Transfer completed callbacks
|
|
* @param hsd: SD handle
|
|
* @retval None
|
|
*/
|
|
/*
|
|
===============================================================================
|
|
Select the correct function signature depending on your platform.
|
|
please refer to the file "stm32xxxx_eval_sd.h" to verify the correct function
|
|
prototype
|
|
===============================================================================
|
|
*/
|
|
//void BSP_SD_ReadCpltCallback(uint32_t SdCard)
|
|
void BSP_SD_ReadCpltCallback(void)
|
|
{
|
|
/*
|
|
* No need to add an "osKernelRunning()" check here, as the SD_initialize()
|
|
* is always called before any SD_Read()/SD_Write() call
|
|
*/
|
|
osMessagePut(SDQueueID, READ_CPLT_MSG, osWaitForever);
|
|
}
|
|
/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
|
|
|