236 lines
5.7 KiB
C
236 lines
5.7 KiB
C
/**
|
|
******************************************************************************
|
|
* @file sd_diskio.c
|
|
* @author MCD Application Team
|
|
* @version V1.3.0
|
|
* @date 08-May-2015
|
|
* @brief SD Disk I/O driver
|
|
******************************************************************************
|
|
* @attention
|
|
*
|
|
* <h2><center>© COPYRIGHT 2015 STMicroelectronics</center></h2>
|
|
*
|
|
* Licensed under MCD-ST Liberty SW License Agreement V2, (the "License");
|
|
* You may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at:
|
|
*
|
|
* http://www.st.com/software_license_agreement_liberty_v2
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*
|
|
******************************************************************************
|
|
*/
|
|
|
|
/* Includes ------------------------------------------------------------------*/
|
|
#include <string.h>
|
|
#include "ff_gen_drv.h"
|
|
#include "sdio/bsp_sdio_sd.h"
|
|
/* Private typedef -----------------------------------------------------------*/
|
|
/* Private define ------------------------------------------------------------*/
|
|
/* Block Size in Bytes */
|
|
#define BLOCK_SIZE 512
|
|
|
|
/* Private variables ---------------------------------------------------------*/
|
|
/* Disk status */
|
|
static volatile DSTATUS Stat = STA_NOINIT;
|
|
|
|
/* Private function prototypes -----------------------------------------------*/
|
|
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 ---------------------------------------------------------*/
|
|
|
|
/**
|
|
* @brief Initializes a Drive
|
|
* @param lun : not used
|
|
* @retval DSTATUS: Operation status
|
|
*/
|
|
DSTATUS SD_initialize(BYTE lun)
|
|
{
|
|
Stat = STA_NOINIT;
|
|
|
|
/* Configure the uSD device */
|
|
if(BSP_SD_Init() == MSD_OK)
|
|
{
|
|
Stat &= ~STA_NOINIT;
|
|
}
|
|
|
|
return Stat;
|
|
}
|
|
|
|
/**
|
|
* @brief Gets Disk Status
|
|
* @param lun : not used
|
|
* @retval DSTATUS: Operation status
|
|
*/
|
|
DSTATUS SD_status(BYTE lun)
|
|
{
|
|
Stat = STA_NOINIT;
|
|
|
|
if(BSP_SD_GetStatus() == MSD_OK)
|
|
{
|
|
Stat &= ~STA_NOINIT;
|
|
}
|
|
|
|
return Stat;
|
|
}
|
|
|
|
/**
|
|
* @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_OK;
|
|
|
|
if ((DWORD)buff & 3)
|
|
{
|
|
DWORD scratch[BLOCK_SIZE / 4];
|
|
|
|
while (count--)
|
|
{
|
|
memcpy(scratch, buff, BLOCK_SIZE);
|
|
res = SD_read(lun,(void *)scratch, sector++, 1);
|
|
|
|
if (res != RES_OK)
|
|
{
|
|
break;
|
|
}
|
|
buff += BLOCK_SIZE;
|
|
}
|
|
|
|
return(res);
|
|
}
|
|
if(BSP_SD_ReadBlocks((uint32_t*)buff,
|
|
(uint64_t) (sector * BLOCK_SIZE),
|
|
BLOCK_SIZE,
|
|
count) != MSD_OK)
|
|
{
|
|
res = RES_ERROR;
|
|
}
|
|
|
|
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)
|
|
{
|
|
DRESULT res = RES_OK;
|
|
|
|
if ((DWORD)buff & 3)
|
|
{
|
|
DWORD scratch[BLOCK_SIZE / 4];
|
|
|
|
while (count--)
|
|
{
|
|
memcpy(scratch, buff, BLOCK_SIZE);
|
|
res = SD_write(lun,(void *)scratch, sector++, 1);
|
|
|
|
if (res != RES_OK)
|
|
{
|
|
break;
|
|
}
|
|
buff += BLOCK_SIZE;
|
|
}
|
|
|
|
return(res);
|
|
}
|
|
if(BSP_SD_WriteBlocks((uint32_t*)buff,
|
|
(uint64_t)(sector * BLOCK_SIZE),
|
|
BLOCK_SIZE, count) != MSD_OK)
|
|
{
|
|
res = RES_ERROR;
|
|
}
|
|
|
|
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;
|
|
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.CardCapacity / BLOCK_SIZE;
|
|
res = RES_OK;
|
|
break;
|
|
|
|
/* Get R/W sector size (WORD) */
|
|
case GET_SECTOR_SIZE :
|
|
*(WORD*)buff = BLOCK_SIZE;
|
|
res = RES_OK;
|
|
break;
|
|
|
|
/* Get erase block size in unit of sector (DWORD) */
|
|
case GET_BLOCK_SIZE :
|
|
*(DWORD*)buff = BLOCK_SIZE;
|
|
break;
|
|
|
|
default:
|
|
res = RES_PARERR;
|
|
}
|
|
|
|
return res;
|
|
}
|
|
#endif /* _USE_IOCTL == 1 */
|
|
|
|
/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
|
|
|