mirror of https://github.com/brektrou/rtl8821CU
You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
131 lines
3.6 KiB
C
131 lines
3.6 KiB
C
/******************************************************************************
|
|
*
|
|
* Copyright(c) 2015 - 2017 Realtek Corporation.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of version 2 of the GNU General Public License as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* 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 GNU General Public License for
|
|
* more details.
|
|
*
|
|
*****************************************************************************/
|
|
#define _RTW_SDIO_C_
|
|
|
|
#include <drv_types.h> /* struct dvobj_priv and etc. */
|
|
#include <drv_types_sdio.h> /* RTW_SDIO_ADDR_CMD52_GEN */
|
|
|
|
/*
|
|
* Description:
|
|
* Use SDIO cmd52 or cmd53 to read/write data
|
|
*
|
|
* Parameters:
|
|
* d pointer of device object(struct dvobj_priv)
|
|
* addr SDIO address, 17 bits
|
|
* buf buffer for I/O
|
|
* len length
|
|
* write 0:read, 1:write
|
|
* cmd52 0:cmd52, 1:cmd53
|
|
*
|
|
* Return:
|
|
* _SUCCESS I/O ok.
|
|
* _FAIL I/O fail.
|
|
*/
|
|
static u8 sdio_io(struct dvobj_priv *d, u32 addr, void *buf, size_t len, u8 write, u8 cmd52)
|
|
{
|
|
u32 addr_drv; /* address with driver defined bit */
|
|
int err;
|
|
u8 retry = 0;
|
|
u8 stop_retry = _FALSE; /* flag for stopping retry or not */
|
|
|
|
|
|
if (rtw_is_surprise_removed(dvobj_get_primary_adapter(d))) {
|
|
RTW_ERR("%s: bSurpriseRemoved, skip %s 0x%05x, %zu bytes\n",
|
|
__FUNCTION__, write?"write":"read", addr, len);
|
|
return _FAIL;
|
|
}
|
|
|
|
addr_drv = addr;
|
|
if (cmd52)
|
|
addr_drv = RTW_SDIO_ADDR_CMD52_GEN(addr_drv);
|
|
|
|
do {
|
|
if (write)
|
|
err = d->intf_ops->write(d, addr_drv, buf, len, 0);
|
|
else
|
|
err = d->intf_ops->read(d, addr_drv, buf, len, 0);
|
|
if (!err) {
|
|
if (retry) {
|
|
RTW_INFO("%s: Retry %s OK! addr=0x%05x %zu bytes, retry=%u,%u\n",
|
|
__FUNCTION__, write?"write":"read",
|
|
addr, len, retry, ATOMIC_READ(&d->continual_io_error));
|
|
RTW_INFO_DUMP("Data: ", buf, len);
|
|
}
|
|
rtw_reset_continual_io_error(d);
|
|
break;
|
|
}
|
|
RTW_ERR("%s: %s FAIL! error(%d) addr=0x%05x %zu bytes, retry=%u,%u\n",
|
|
__FUNCTION__, write?"write":"read", err, addr, len,
|
|
retry, ATOMIC_READ(&d->continual_io_error));
|
|
|
|
retry++;
|
|
stop_retry = rtw_inc_and_chk_continual_io_error(d);
|
|
if ((err == -1) || (stop_retry == _TRUE) || (retry > SD_IO_TRY_CNT)) {
|
|
/* critical error, unrecoverable */
|
|
RTW_ERR("%s: Fatal error! Set surprise remove flag ON! (retry=%u,%u)\n",
|
|
__FUNCTION__, retry, ATOMIC_READ(&d->continual_io_error));
|
|
rtw_set_surprise_removed(dvobj_get_primary_adapter(d));
|
|
return _FAIL;
|
|
}
|
|
|
|
/* WLAN IOREG or SDIO Local */
|
|
if ((addr & 0x10000) || !(addr & 0xE000)) {
|
|
RTW_WARN("%s: Retry %s addr=0x%05x %zu bytes, retry=%u,%u\n",
|
|
__FUNCTION__, write?"write":"read", addr, len,
|
|
retry, ATOMIC_READ(&d->continual_io_error));
|
|
continue;
|
|
}
|
|
return _FAIL;
|
|
} while (1);
|
|
|
|
return _SUCCESS;
|
|
}
|
|
|
|
u8 rtw_sdio_read_cmd52(struct dvobj_priv *d, u32 addr, void *buf, size_t len)
|
|
{
|
|
return sdio_io(d, addr, buf, len, 0, 1);
|
|
}
|
|
|
|
u8 rtw_sdio_read_cmd53(struct dvobj_priv *d, u32 addr, void *buf, size_t len)
|
|
{
|
|
return sdio_io(d, addr, buf, len, 0, 0);
|
|
}
|
|
|
|
u8 rtw_sdio_write_cmd52(struct dvobj_priv *d, u32 addr, void *buf, size_t len)
|
|
{
|
|
return sdio_io(d, addr, buf, len, 1, 1);
|
|
}
|
|
|
|
u8 rtw_sdio_write_cmd53(struct dvobj_priv *d, u32 addr, void *buf, size_t len)
|
|
{
|
|
return sdio_io(d, addr, buf, len, 1, 0);
|
|
}
|
|
|
|
u8 rtw_sdio_f0_read(struct dvobj_priv *d, u32 addr, void *buf, size_t len)
|
|
{
|
|
int err;
|
|
u8 ret;
|
|
|
|
|
|
ret = _SUCCESS;
|
|
addr = RTW_SDIO_ADDR_F0_GEN(addr);
|
|
|
|
err = d->intf_ops->read(d, addr, buf, len, 0);
|
|
if (err)
|
|
ret = _FAIL;
|
|
|
|
return ret;
|
|
}
|