210 lines
7.1 KiB
C
210 lines
7.1 KiB
C
|
/*
|
|||
|
|
* Copyright : (C) 2022 Phytium Information Technology, Inc.
|
|||
|
|
* All Rights Reserved.
|
|||
|
|
*
|
|||
|
|
* This program is OPEN SOURCE software: you can redistribute it and/or modify it
|
|||
|
|
* under the terms of the Phytium Public License as published by the Phytium Technology Co.,Ltd,
|
|||
|
|
* either version 1.0 of the License, or (at your option) any later version.
|
|||
|
|
*
|
|||
|
|
* This program 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 Phytium Public License for more details.
|
|||
|
|
*
|
|||
|
|
*
|
|||
|
|
* FilePath: fsdio_cmd.c
|
|||
|
|
* Date: 2022-06-01 14:23:59
|
|||
|
|
* LastEditTime: 2022-06-01 14:24:00
|
|||
|
|
* Description: This files is for SDIO command related function
|
|||
|
|
*
|
|||
|
|
* Modify History:
|
|||
|
|
* Ver Who Date Changes
|
|||
|
|
* ----- ------ -------- --------------------------------------
|
|||
|
|
* 1.1 zhugengyu 2022/6/6 modify according to tech manual.
|
|||
|
|
*/
|
|||
|
|
/***************************** Include Files *********************************/
|
|||
|
|
|
|||
|
|
#include "fio.h"
|
|||
|
|
#include "fdebug.h"
|
|||
|
|
#include "fassert.h"
|
|||
|
|
#include "ftypes.h"
|
|||
|
|
|
|||
|
|
#include "fcache.h"
|
|||
|
|
|
|||
|
|
#include "fsdio_hw.h"
|
|||
|
|
#include "fsdio.h"
|
|||
|
|
|
|||
|
|
/************************** Constant Definitions *****************************/
|
|||
|
|
|
|||
|
|
/**************************** Type Definitions *******************************/
|
|||
|
|
|
|||
|
|
/***************** Macros (Inline Functions) Definitions *********************/
|
|||
|
|
#define FSDIO_DEBUG_TAG "FSDIO-CMD"
|
|||
|
|
#define FSDIO_ERROR(format, ...) FT_DEBUG_PRINT_E(FSDIO_DEBUG_TAG, format, ##__VA_ARGS__)
|
|||
|
|
#define FSDIO_WARN(format, ...) FT_DEBUG_PRINT_W(FSDIO_DEBUG_TAG, format, ##__VA_ARGS__)
|
|||
|
|
#define FSDIO_INFO(format, ...) FT_DEBUG_PRINT_I(FSDIO_DEBUG_TAG, format, ##__VA_ARGS__)
|
|||
|
|
#define FSDIO_DEBUG(format, ...) FT_DEBUG_PRINT_D(FSDIO_DEBUG_TAG, format, ##__VA_ARGS__)
|
|||
|
|
|
|||
|
|
/************************** Function Prototypes ******************************/
|
|||
|
|
extern FError FSdioPIOReadData(FSdio *const instance_p, FSdioData *data_p);
|
|||
|
|
|
|||
|
|
/*****************************************************************************/
|
|||
|
|
FError FSdioSendPrivateCmd(uintptr base_addr, u32 cmd, u32 arg)
|
|||
|
|
{
|
|||
|
|
u32 reg_val;
|
|||
|
|
int retries = FSDIO_TIMEOUT;
|
|||
|
|
|
|||
|
|
do
|
|||
|
|
{
|
|||
|
|
reg_val = FSDIO_READ_REG(base_addr, FSDIO_STATUS_OFFSET);
|
|||
|
|
if (--retries <= 0)
|
|||
|
|
break;
|
|||
|
|
}
|
|||
|
|
while (FSDIO_STATUS_DATA_BUSY & reg_val);
|
|||
|
|
|
|||
|
|
if (retries <= 0)
|
|||
|
|
return FSDIO_ERR_BUSY;
|
|||
|
|
|
|||
|
|
FSDIO_WRITE_REG(base_addr, FSDIO_CMD_ARG_OFFSET, arg);
|
|||
|
|
FSDIO_WRITE_REG(base_addr, FSDIO_CMD_OFFSET, FSDIO_CMD_START | cmd);
|
|||
|
|
|
|||
|
|
retries = FSDIO_TIMEOUT;
|
|||
|
|
do
|
|||
|
|
{
|
|||
|
|
reg_val = FSDIO_READ_REG(base_addr, FSDIO_CMD_OFFSET);
|
|||
|
|
if (--retries <= 0)
|
|||
|
|
break;
|
|||
|
|
}
|
|||
|
|
while (FSDIO_CMD_START & reg_val);
|
|||
|
|
|
|||
|
|
return (retries <= 0) ? FSDIO_ERR_TIMEOUT : FSDIO_SUCCESS;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
/**
|
|||
|
|
* @name: FSdioTransferCmd
|
|||
|
|
* @msg: pack and transfer command
|
|||
|
|
* @return {FError} FSDIO_SUCCESS if transfer success
|
|||
|
|
* @param {FSdio} *instance_p, SDIO controller instance
|
|||
|
|
* @param {FSdioCmdData} *cmd_data_p, contents of transfer command and data
|
|||
|
|
*/
|
|||
|
|
FError FSdioTransferCmd(FSdio *const instance_p, FSdioCmdData *const cmd_data_p)
|
|||
|
|
{
|
|||
|
|
FASSERT(cmd_data_p);
|
|||
|
|
FError ret = FSDIO_SUCCESS;
|
|||
|
|
uintptr base_addr = instance_p->config.base_addr;
|
|||
|
|
u32 cmd_flag = cmd_data_p->flag;
|
|||
|
|
u32 raw_cmd = FSDIO_CMD_USE_HOLD_REG; /* USE_HOLD_REG必须为1 */
|
|||
|
|
|
|||
|
|
/* 命令需要进行卡初始化，如CMD-0 */
|
|||
|
|
if (FSDIO_CMD_FLAG_NEED_INIT & cmd_flag)
|
|||
|
|
{
|
|||
|
|
raw_cmd |= FSDIO_CMD_INIT;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
/* 命令涉及电压切换 */
|
|||
|
|
if (FSDIO_CMD_FLAG_SWITCH_VOLTAGE & cmd_flag)
|
|||
|
|
{
|
|||
|
|
raw_cmd |= FSDIO_CMD_VOLT_SWITCH;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
/* 命令传输过程伴随数据传输 */
|
|||
|
|
if (FSDIO_CMD_FLAG_EXP_DATA & cmd_flag)
|
|||
|
|
{
|
|||
|
|
raw_cmd |= FSDIO_CMD_DAT_EXP;
|
|||
|
|
|
|||
|
|
if (FSDIO_CMD_FLAG_WRITE_DATA & cmd_flag) /* 写卡 */
|
|||
|
|
{
|
|||
|
|
raw_cmd |= FSDIO_CMD_DAT_WRITE;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
/* 命令需要进行CRC校验 */
|
|||
|
|
if (FSDIO_CMD_FLAG_NEED_RESP_CRC & cmd_flag)
|
|||
|
|
{
|
|||
|
|
raw_cmd |= FSDIO_CMD_RESP_CRC;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
/* 命令需要响应回复 */
|
|||
|
|
if (FSDIO_CMD_FLAG_EXP_RESP & cmd_flag)
|
|||
|
|
{
|
|||
|
|
raw_cmd |= FSDIO_CMD_RESP_EXP;
|
|||
|
|
|
|||
|
|
if (FSDIO_CMD_FLAG_EXP_LONG_RESP & cmd_flag) /* 命令需要136字节长回复 */
|
|||
|
|
{
|
|||
|
|
raw_cmd |= FSDIO_CMD_RESP_LONG;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
raw_cmd |= FSDIO_CMD_INDX_SET(cmd_data_p->cmdidx);
|
|||
|
|
|
|||
|
|
FSDIO_DEBUG("============[CMD-%d]@0x%x begin ============", cmd_data_p->cmdidx, base_addr);
|
|||
|
|
FSDIO_DEBUG(" cmd: 0x%x", raw_cmd);
|
|||
|
|
FSDIO_DEBUG(" arg: 0x%x", cmd_data_p->cmdarg);
|
|||
|
|
|
|||
|
|
/* enable related interrupt */
|
|||
|
|
FSdioSetInterruptMask(instance_p, FSDIO_GENERAL_INTR,
|
|||
|
|
FSDIO_INTS_CMD_MASK, TRUE);
|
|||
|
|
|
|||
|
|
FSdioSendPrivateCmd(base_addr, raw_cmd, cmd_data_p->cmdarg);
|
|||
|
|
FSDIO_INFO("cmd send done ...");
|
|||
|
|
return ret;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
/**
|
|||
|
|
* @name: FSdioGetCmdResponse
|
|||
|
|
* @msg: Get cmd response and received data after wait poll status or interrupt signal
|
|||
|
|
* @return {FError} FSDIO_SUCCESS if get success
|
|||
|
|
* @param {FSdio} *instance_p, SDIO controller instance
|
|||
|
|
* @param {FSdioCmdData} *cmd_data_p, contents of transfer command and data
|
|||
|
|
*/
|
|||
|
|
FError FSdioGetCmdResponse(FSdio *const instance_p, FSdioCmdData *const cmd_data_p)
|
|||
|
|
{
|
|||
|
|
FASSERT(instance_p);
|
|||
|
|
FASSERT(cmd_data_p);
|
|||
|
|
FError ret = FSDIO_SUCCESS;
|
|||
|
|
u32 reg_val;
|
|||
|
|
const boolean read = cmd_data_p->flag & FSDIO_CMD_FLAG_READ_DATA;
|
|||
|
|
uintptr base_addr = instance_p->config.base_addr;
|
|||
|
|
|
|||
|
|
if (FT_COMPONENT_IS_READY != instance_p->is_ready)
|
|||
|
|
{
|
|||
|
|
FSDIO_ERROR("device is not yet initialized!!!");
|
|||
|
|
return FSDIO_ERR_NOT_INIT;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if ((NULL != cmd_data_p->data_p) && (read))
|
|||
|
|
{
|
|||
|
|
if (FSDIO_PIO_TRANS_MODE == instance_p->config.trans_mode)
|
|||
|
|
{
|
|||
|
|
ret = FSdioPIOReadData(instance_p, cmd_data_p->data_p);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
/* check response of cmd */
|
|||
|
|
if (FSDIO_CMD_FLAG_EXP_RESP & cmd_data_p->flag)
|
|||
|
|
{
|
|||
|
|
if (FSDIO_CMD_FLAG_EXP_LONG_RESP & cmd_data_p->flag)
|
|||
|
|
{
|
|||
|
|
cmd_data_p->response[0] = FSDIO_READ_REG(base_addr, FSDIO_RESP0_OFFSET);
|
|||
|
|
cmd_data_p->response[1] = FSDIO_READ_REG(base_addr, FSDIO_RESP1_OFFSET);
|
|||
|
|
cmd_data_p->response[2] = FSDIO_READ_REG(base_addr, FSDIO_RESP2_OFFSET);
|
|||
|
|
cmd_data_p->response[3] = FSDIO_READ_REG(base_addr, FSDIO_RESP3_OFFSET);
|
|||
|
|
FSDIO_DEBUG(" resp: 0x%x-0x%x-0x%x-0x%x",
|
|||
|
|
cmd_data_p->response[0], cmd_data_p->response[1],
|
|||
|
|
cmd_data_p->response[2], cmd_data_p->response[3]);
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
cmd_data_p->response[0] = FSDIO_READ_REG(base_addr, FSDIO_RESP0_OFFSET);
|
|||
|
|
FSDIO_DEBUG(" resp: 0x%x", cmd_data_p->response[0]);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
cmd_data_p->success = TRUE; /* cmd / data transfer finished successful */
|
|||
|
|
FSDIO_DEBUG("============[CMD-%d]@0x%x end ============", cmd_data_p->cmdidx, base_addr);
|
|||
|
|
|
|||
|
|
/* disable related interrupt */
|
|||
|
|
FSdioSetInterruptMask(instance_p, FSDIO_GENERAL_INTR, FSDIO_INTS_CMD_MASK | FSDIO_INTS_DATA_MASK, FALSE);
|
|||
|
|
FSdioSetInterruptMask(instance_p, FSDIO_IDMA_INTR, FSDIO_DMAC_INTS_MASK, FALSE);
|
|||
|
|
|
|||
|
|
return ret;
|
|||
|
|
}
|