sergiotarxz/nuttx
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

mmcsd: add support of getting ext_csd reg data

Browse Source 
Signed-off-by: wanggang26 <wanggang26@xiaomi.com>
This commit is contained in:
wanggang26 2023-10-11 16:43:13 +08:00 committed by Xiang Xiao
parent 24ce8dfbf2
commit a2662bd369
1 changed files with 22 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

32
drivers/mmcsd/mmcsd_sdio.c
View File

@ -185,7 +185,8 @@ static void mmcsd_mediachange(FAR void *arg);
static int mmcsd_widebus(FAR struct mmcsd_state_s *priv); static int mmcsd_widebus(FAR struct mmcsd_state_s *priv);
#ifdef CONFIG_MMCSD_MMCSUPPORT #ifdef CONFIG_MMCSD_MMCSUPPORT
static int mmcsd_mmcinitialize(FAR struct mmcsd_state_s *priv); static int mmcsd_mmcinitialize(FAR struct mmcsd_state_s *priv);
static int mmcsd_read_csd(FAR struct mmcsd_state_s *priv); static int mmcsd_read_csd(FAR struct mmcsd_state_s *priv,
FAR uint8_t *data);
#endif #endif
static int mmcsd_sdinitialize(FAR struct mmcsd_state_s *priv); static int mmcsd_sdinitialize(FAR struct mmcsd_state_s *priv);
static int mmcsd_cardidentify(FAR struct mmcsd_state_s *priv); static int mmcsd_cardidentify(FAR struct mmcsd_state_s *priv);
@ -2755,7 +2756,7 @@ static int mmcsd_mmcinitialize(FAR struct mmcsd_state_s *priv)
if (IS_BLOCK(priv->type)) if (IS_BLOCK(priv->type))
{ {
finfo("Card supports eMMC spec 4.0 (or greater). Reading ext_csd.\n"); finfo("Card supports eMMC spec 4.0 (or greater). Reading ext_csd.\n");
ret = mmcsd_read_csd(priv); ret = mmcsd_read_csd(priv, NULL);
if (ret != OK) if (ret != OK)
{ {
ferr("ERROR: Failed to determinate number of blocks: %d\n", ret); ferr("ERROR: Failed to determinate number of blocks: %d\n", ret);
@ -2790,7 +2791,7 @@ static int mmcsd_mmcinitialize(FAR struct mmcsd_state_s *priv)
* *
****************************************************************************/ ****************************************************************************/
static int mmcsd_read_csd(FAR struct mmcsd_state_s *priv) static int mmcsd_read_csd(FAR struct mmcsd_state_s *priv, FAR uint8_t *data)
{ {
uint8_t buffer[512] aligned_data(16); uint8_t buffer[512] aligned_data(16);
int ret; int ret;
@ -2897,6 +2898,11 @@ static int mmcsd_read_csd(FAR struct mmcsd_state_s *priv)
priv->nblocks = (buffer[215] << 24) | (buffer[214] << 16) | priv->nblocks = (buffer[215] << 24) | (buffer[214] << 16) |
(buffer[213] << 8) | buffer[212]; (buffer[213] << 8) | buffer[212];
if (data != NULL)
{
memcpy(data, buffer, sizeof(buffer));
}
finfo("MMC ext CSD read succsesfully, number of block %" PRId32 "\n", finfo("MMC ext CSD read succsesfully, number of block %" PRId32 "\n",
priv->nblocks); priv->nblocks);
@ -3181,20 +3187,28 @@ static int mmcsd_iocmd(FAR struct mmcsd_state_s *priv,
FAR struct mmc_ioc_cmd *ic_ptr) FAR struct mmc_ioc_cmd *ic_ptr)
{ {
uint32_t opcode; uint32_t opcode;
int ret; int ret = OK;
DEBUGASSERT(priv != NULL && ic_ptr != NULL); DEBUGASSERT(priv != NULL && ic_ptr != NULL);
opcode = ic_ptr->opcode & MMCSD_CMDIDX_MASK; opcode = ic_ptr->opcode & MMCSD_CMDIDX_MASK;
switch (opcode) switch (opcode)
{ {
case MMCSD_CMDIDX2: case MMCSD_CMDIDX2: /* Get cid reg data */
{ {
memcpy((FAR void *)(uintptr_t)ic_ptr->data_ptr, memcpy((FAR void *)(uintptr_t)ic_ptr->data_ptr,
priv->cid, sizeof(priv->cid)); priv->cid, sizeof(priv->cid));
} }
break; break;
case MMCSD_CMDIDX56: /* support general commands */ #ifdef CONFIG_MMCSD_MMCSUPPORT
case MMC_CMDIDX8: /* Get extended csd reg data */
{
ret = mmcsd_read_csd(priv,
(FAR uint8_t *)(uintptr_t)ic_ptr->data_ptr);
}
break;
#endif
case MMCSD_CMDIDX56: /* General commands */
{ {
if (ic_ptr->write_flag) if (ic_ptr->write_flag)
{ {
@ -3204,7 +3218,6 @@ static int mmcsd_iocmd(FAR struct mmcsd_state_s *priv,
if (ret != OK) if (ret != OK)
{ {
ferr("mmcsd_iocmd MMCSD_CMDIDX56 write failed.\n"); ferr("mmcsd_iocmd MMCSD_CMDIDX56 write failed.\n");
return ret;
} }
} }
else else
@ -3215,7 +3228,6 @@ static int mmcsd_iocmd(FAR struct mmcsd_state_s *priv,
if (ret != OK) if (ret != OK)
{ {
ferr("mmcsd_iocmd MMCSD_CMDIDX56 read failed.\n"); ferr("mmcsd_iocmd MMCSD_CMDIDX56 read failed.\n");
return ret;
} }
} }
} }
@ -3223,12 +3235,12 @@ static int mmcsd_iocmd(FAR struct mmcsd_state_s *priv,
default: default:
{ {
ferr("mmcsd_iocmd opcode unsupported.\n"); ferr("mmcsd_iocmd opcode unsupported.\n");
return -EINVAL; ret = -EINVAL;
} }
break; break;
} }
return OK; return ret;
} }
/**************************************************************************** /****************************************************************************