/* * 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 file 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 "fswap.h" #include "fsdio_hw.h" #include "fsdio.h" /************************** Constant Definitions *****************************/ /**************************** Type Definitions *******************************/ #define FSDIO_EXT_APP_CMD 55U /***************** 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_DATA_BARRIER(); /* drain writebuffer */ 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); /* wait until command send done */ 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("============[%s-%d]@0x%x begin ============", (FSDIO_EXT_APP_CMD == instance_p->prev_cmd) ? "ACMD" : "CMD", 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); ret = FSdioSendPrivateCmd(base_addr, raw_cmd, cmd_data_p->cmdarg); FSDIO_INFO("cmd send done ..."); return ret; } static void FSdioFlipByteOrder(u32 *response, fsize_t size) { /* swap response and convert byte order resp[0] = bswap32(resp[3]) resp[1] = bswap32(resp[2]) resp[2] = bswap32(resp[1]) resp[3] = bswap32(resp[0]) */ FASSERT(size % (2 * sizeof(u32)) == 0); const fsize_t n_words = size / sizeof(uint32_t); for (int i = 0; i < (int)n_words / 2; ++i) { u32 left = __builtin_bswap32(response[i]); u32 right = __builtin_bswap32(response[n_words - i - 1]); response[i] = right; response[n_words - i - 1] = left; } } /** * @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); /* according to SD spec. 136 bits R2 is send-back in reverse order and big-end, some SD protocol will do this reverse and ntol itself, other do not, filp_resp_byte_order is to compilant with those not */ if (instance_p->config.filp_resp_byte_order) { FSdioFlipByteOrder(cmd_data_p->response, sizeof(u32) * 4); } 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); cmd_data_p->response[1] = 0U; cmd_data_p->response[2] = 0U; cmd_data_p->response[3] = 0U; FSDIO_DEBUG(" resp: 0x%x", cmd_data_p->response[0]); } } cmd_data_p->success = TRUE; /* cmd / data transfer finished successful */ FSDIO_DEBUG("============[%s-%d]@0x%x end ============", (FSDIO_EXT_APP_CMD == instance_p->prev_cmd) ? "ACMD" : "CMD", 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); instance_p->prev_cmd = cmd_data_p->cmdidx; /* record previous command */ return ret; }