Function sdio_enable_func

components/drivers/sdio/dev_sdio.c:1186–1231

}

rt_int32_t sdio_enable_func(struct rt_sdio_function *func)
{
    rt_int32_t ret;
    rt_uint8_t reg;
    rt_uint32_t timeout;
    struct rt_sdio_function *func0;

    RT_ASSERT(func != RT_NULL);
    RT_ASSERT(func->card != RT_NULL);

    func0 = func->card->sdio_function[0];

    mmcsd_dbg("SDIO: enabling function %d\n", func->num);

    reg = sdio_io_readb(func0, SDIO_REG_CCCR_IO_EN, &ret);
    if (ret)
        goto err;

    reg |= 1 << func->num;

    ret = sdio_io_writeb(func0, SDIO_REG_CCCR_IO_EN, reg);
    if (ret)
        goto err;

    timeout = rt_tick_get() + func->enable_timeout_val * RT_TICK_PER_SECOND / 1000;

    while (1)
    {
        reg = sdio_io_readb(func0, SDIO_REG_CCCR_IO_RDY, &ret);
        if (ret)
            goto err;
        if (reg & (1 << func->num))
            break;
        ret = -RT_ETIMEOUT;
        if (rt_tick_get() > timeout)
            goto err;
    }

    mmcsd_dbg("SDIO: enabled function successfull\n");

    return 0;

err:
    mmcsd_dbg("SDIO: failed to enable function %d\n", func->num);
    return ret;
}

rt_int32_t sdio_disable_func(struct rt_sdio_function *func)
{