911 lines
20 KiB
C
911 lines
20 KiB
C
|
/******************************************************************************
|
||
|
|
*
|
||
|
|
* Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
|
||
|
|
*
|
||
|
|
* 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.
|
||
|
|
*
|
||
|
|
* You should have received a copy of the GNU General Public License along with
|
||
|
|
* this program; if not, write to the Free Software Foundation, Inc.,
|
||
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
|
||
|
|
*
|
||
|
|
*******************************************************************************/
|
||
|
|
#define _SDIO_OPS_LINUX_C_
|
||
|
|
|
||
|
|
#include <drv_types.h>
|
||
|
|
|
||
|
|
static bool rtw_sdio_claim_host_needed(struct sdio_func *func)
|
||
|
|
{
|
||
|
|
struct dvobj_priv *dvobj = sdio_get_drvdata(func);
|
||
|
|
PSDIO_DATA sdio_data = &dvobj->intf_data;
|
||
|
|
|
||
|
|
if (sdio_data->sys_sdio_irq_thd && sdio_data->sys_sdio_irq_thd == current)
|
||
|
|
return _FALSE;
|
||
|
|
return _TRUE;
|
||
|
|
}
|
||
|
|
|
||
|
|
inline void rtw_sdio_set_irq_thd(struct dvobj_priv *dvobj, _thread_hdl_ thd_hdl)
|
||
|
|
{
|
||
|
|
PSDIO_DATA sdio_data = &dvobj->intf_data;
|
||
|
|
|
||
|
|
sdio_data->sys_sdio_irq_thd = thd_hdl;
|
||
|
|
}
|
||
|
|
|
||
|
|
u8 sd_f0_read8(struct intf_hdl *pintfhdl,u32 addr, s32 *err)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
u8 v=0;
|
||
|
|
struct sdio_func *func;
|
||
|
|
bool claim_needed;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return v;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
claim_needed = rtw_sdio_claim_host_needed(func);
|
||
|
|
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_claim_host(func);
|
||
|
|
v = sdio_f0_readb(func, addr, err);
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_release_host(func);
|
||
|
|
if (err && *err)
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x\n", __func__, *err, addr);
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
|
||
|
|
return v;
|
||
|
|
}
|
||
|
|
|
||
|
|
void sd_f0_write8(struct intf_hdl *pintfhdl, u32 addr, u8 v, s32 *err)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
struct sdio_func *func;
|
||
|
|
bool claim_needed;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
claim_needed = rtw_sdio_claim_host_needed(func);
|
||
|
|
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_claim_host(func);
|
||
|
|
sdio_f0_writeb(func, v, addr, err);
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_release_host(func);
|
||
|
|
if (err && *err)
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x val=0x%02x\n", __func__, *err, addr, v);
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Return:
|
||
|
|
* 0 Success
|
||
|
|
* others Fail
|
||
|
|
*/
|
||
|
|
s32 _sd_cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
int err=0, i;
|
||
|
|
struct sdio_func *func;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
|
||
|
|
for (i = 0; i < cnt; i++) {
|
||
|
|
pdata[i] = sdio_readb(func, addr+i, &err);
|
||
|
|
if (err) {
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x\n", __func__, err, addr+i);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Return:
|
||
|
|
* 0 Success
|
||
|
|
* others Fail
|
||
|
|
*/
|
||
|
|
s32 sd_cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
int err=0, i;
|
||
|
|
struct sdio_func *func;
|
||
|
|
bool claim_needed;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
claim_needed = rtw_sdio_claim_host_needed(func);
|
||
|
|
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_claim_host(func);
|
||
|
|
err = _sd_cmd52_read(pintfhdl, addr, cnt, pdata);
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_release_host(func);
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Return:
|
||
|
|
* 0 Success
|
||
|
|
* others Fail
|
||
|
|
*/
|
||
|
|
s32 _sd_cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
int err=0, i;
|
||
|
|
struct sdio_func *func;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
|
||
|
|
for (i = 0; i < cnt; i++) {
|
||
|
|
sdio_writeb(func, pdata[i], addr+i, &err);
|
||
|
|
if (err) {
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x val=0x%02x\n", __func__, err, addr+i, pdata[i]);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Return:
|
||
|
|
* 0 Success
|
||
|
|
* others Fail
|
||
|
|
*/
|
||
|
|
s32 sd_cmd52_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pdata)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
int err=0, i;
|
||
|
|
struct sdio_func *func;
|
||
|
|
bool claim_needed;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
claim_needed = rtw_sdio_claim_host_needed(func);
|
||
|
|
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_claim_host(func);
|
||
|
|
err = _sd_cmd52_write(pintfhdl, addr, cnt, pdata);
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_release_host(func);
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
u8 _sd_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
u8 v=0;
|
||
|
|
struct sdio_func *func;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return v;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
|
||
|
|
v = sdio_readb(func, addr, err);
|
||
|
|
|
||
|
|
if (err && *err)
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x\n", __func__, *err, addr);
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
|
||
|
|
return v;
|
||
|
|
}
|
||
|
|
|
||
|
|
u8 sd_read8(struct intf_hdl *pintfhdl, u32 addr, s32 *err)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
u8 v=0;
|
||
|
|
struct sdio_func *func;
|
||
|
|
bool claim_needed;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return v;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
claim_needed = rtw_sdio_claim_host_needed(func);
|
||
|
|
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_claim_host(func);
|
||
|
|
v = sdio_readb(func, addr, err);
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_release_host(func);
|
||
|
|
if (err && *err)
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x\n", __func__, *err, addr);
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
|
||
|
|
return v;
|
||
|
|
}
|
||
|
|
|
||
|
|
u16 sd_read16(struct intf_hdl *pintfhdl, u32 addr, s32 *err)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
u16 v=0;
|
||
|
|
struct sdio_func *func;
|
||
|
|
bool claim_needed;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return v;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
claim_needed = rtw_sdio_claim_host_needed(func);
|
||
|
|
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_claim_host(func);
|
||
|
|
v = sdio_readw(func, addr, err);
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_release_host(func);
|
||
|
|
if (err && *err)
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x\n", __func__, *err, addr);
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
|
||
|
|
return v;
|
||
|
|
}
|
||
|
|
|
||
|
|
u32 _sd_read32(struct intf_hdl *pintfhdl, u32 addr, s32 *err)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
u32 v=0;
|
||
|
|
struct sdio_func *func;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return v;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
|
||
|
|
v = sdio_readl(func, addr, err);
|
||
|
|
|
||
|
|
if (err && *err)
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
|
||
|
|
DBG_871X(KERN_ERR "%s: (%d) addr=0x%05x, val=0x%x\n", __func__, *err, addr, v);
|
||
|
|
|
||
|
|
*err = 0;
|
||
|
|
for(i=0; i<SD_IO_TRY_CNT; i++)
|
||
|
|
{
|
||
|
|
//sdio_claim_host(func);
|
||
|
|
v = sdio_readl(func, addr, err);
|
||
|
|
//sdio_release_host(func);
|
||
|
|
if (*err == 0){
|
||
|
|
rtw_reset_continual_io_error(psdiodev);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
else{
|
||
|
|
DBG_871X(KERN_ERR "%s: (%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i);
|
||
|
|
if(( -ESHUTDOWN == *err ) || ( -ENODEV == *err))
|
||
|
|
{
|
||
|
|
rtw_set_surprise_removed(padapter);
|
||
|
|
}
|
||
|
|
|
||
|
|
if(rtw_inc_and_chk_continual_io_error(psdiodev) == _TRUE ){
|
||
|
|
rtw_set_surprise_removed(padapter);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (i==SD_IO_TRY_CNT)
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i);
|
||
|
|
else
|
||
|
|
DBG_871X(KERN_ERR "%s: (%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i);
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
|
||
|
|
return v;
|
||
|
|
}
|
||
|
|
|
||
|
|
u32 sd_read32(struct intf_hdl *pintfhdl, u32 addr, s32 *err)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
u32 v=0;
|
||
|
|
struct sdio_func *func;
|
||
|
|
bool claim_needed;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return v;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
claim_needed = rtw_sdio_claim_host_needed(func);
|
||
|
|
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_claim_host(func);
|
||
|
|
v = sdio_readl(func, addr, err);
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_release_host(func);
|
||
|
|
|
||
|
|
if (err && *err)
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
|
||
|
|
DBG_871X(KERN_ERR "%s: (%d) addr=0x%05x, val=0x%x\n", __func__, *err, addr, v);
|
||
|
|
|
||
|
|
*err = 0;
|
||
|
|
for(i=0; i<SD_IO_TRY_CNT; i++)
|
||
|
|
{
|
||
|
|
if (claim_needed) sdio_claim_host(func);
|
||
|
|
v = sdio_readl(func, addr, err);
|
||
|
|
if (claim_needed) sdio_release_host(func);
|
||
|
|
|
||
|
|
if (*err == 0){
|
||
|
|
rtw_reset_continual_io_error(psdiodev);
|
||
|
|
break;
|
||
|
|
}else{
|
||
|
|
DBG_871X(KERN_ERR "%s: (%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i);
|
||
|
|
if(( -ESHUTDOWN == *err ) || ( -ENODEV == *err)){
|
||
|
|
rtw_set_surprise_removed(padapter);
|
||
|
|
}
|
||
|
|
|
||
|
|
if(rtw_inc_and_chk_continual_io_error(psdiodev) == _TRUE ){
|
||
|
|
rtw_set_surprise_removed(padapter);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (i==SD_IO_TRY_CNT)
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i);
|
||
|
|
else
|
||
|
|
DBG_871X(KERN_ERR "%s: (%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i);
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
|
||
|
|
return v;
|
||
|
|
}
|
||
|
|
|
||
|
|
void sd_write8(struct intf_hdl *pintfhdl, u32 addr, u8 v, s32 *err)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
struct sdio_func *func;
|
||
|
|
bool claim_needed;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return ;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
claim_needed = rtw_sdio_claim_host_needed(func);
|
||
|
|
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_claim_host(func);
|
||
|
|
sdio_writeb(func, v, addr, err);
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_release_host(func);
|
||
|
|
if (err && *err)
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x val=0x%02x\n", __func__, *err, addr, v);
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
}
|
||
|
|
|
||
|
|
void sd_write16(struct intf_hdl *pintfhdl, u32 addr, u16 v, s32 *err)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
struct sdio_func *func;
|
||
|
|
bool claim_needed;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return ;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
claim_needed = rtw_sdio_claim_host_needed(func);
|
||
|
|
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_claim_host(func);
|
||
|
|
sdio_writew(func, v, addr, err);
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_release_host(func);
|
||
|
|
if (err && *err)
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x val=0x%04x\n", __func__, *err, addr, v);
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
}
|
||
|
|
|
||
|
|
void _sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
struct sdio_func *func;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return ;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
|
||
|
|
sdio_writel(func, v, addr, err);
|
||
|
|
|
||
|
|
if (err && *err)
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
|
||
|
|
DBG_871X(KERN_ERR "%s: (%d) addr=0x%05x val=0x%08x\n", __func__, *err, addr, v);
|
||
|
|
|
||
|
|
*err = 0;
|
||
|
|
for(i=0; i<SD_IO_TRY_CNT; i++)
|
||
|
|
{
|
||
|
|
sdio_writel(func, v, addr, err);
|
||
|
|
if (*err == 0){
|
||
|
|
rtw_reset_continual_io_error(psdiodev);
|
||
|
|
break;
|
||
|
|
}else{
|
||
|
|
DBG_871X(KERN_ERR "%s: (%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i);
|
||
|
|
if(( -ESHUTDOWN == *err ) || ( -ENODEV == *err)){
|
||
|
|
rtw_set_surprise_removed(padapter);
|
||
|
|
}
|
||
|
|
|
||
|
|
if(rtw_inc_and_chk_continual_io_error(psdiodev) == _TRUE ){
|
||
|
|
rtw_set_surprise_removed(padapter);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (i==SD_IO_TRY_CNT)
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x val=0x%08x, try_cnt=%d\n", __func__, *err, addr, v, i);
|
||
|
|
else
|
||
|
|
DBG_871X(KERN_ERR "%s: (%d) addr=0x%05x val=0x%08x, try_cnt=%d\n", __func__, *err, addr, v, i);
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
}
|
||
|
|
|
||
|
|
void sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
struct sdio_func *func;
|
||
|
|
bool claim_needed;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return ;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
claim_needed = rtw_sdio_claim_host_needed(func);
|
||
|
|
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_claim_host(func);
|
||
|
|
sdio_writel(func, v, addr, err);
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_release_host(func);
|
||
|
|
|
||
|
|
if (err && *err)
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
|
||
|
|
DBG_871X(KERN_ERR "%s: (%d) addr=0x%05x val=0x%08x\n", __func__, *err, addr, v);
|
||
|
|
|
||
|
|
*err = 0;
|
||
|
|
for(i=0; i<SD_IO_TRY_CNT; i++)
|
||
|
|
{
|
||
|
|
if (claim_needed) sdio_claim_host(func);
|
||
|
|
sdio_writel(func, v, addr, err);
|
||
|
|
if (claim_needed) sdio_release_host(func);
|
||
|
|
if (*err == 0){
|
||
|
|
rtw_reset_continual_io_error(psdiodev);
|
||
|
|
break;
|
||
|
|
}else{
|
||
|
|
DBG_871X(KERN_ERR "%s: (%d) addr=0x%05x, val=0x%x, try_cnt=%d\n", __func__, *err, addr, v, i);
|
||
|
|
if(( -ESHUTDOWN == *err ) || ( -ENODEV == *err)){
|
||
|
|
rtw_set_surprise_removed(padapter);
|
||
|
|
}
|
||
|
|
|
||
|
|
if(rtw_inc_and_chk_continual_io_error(psdiodev) == _TRUE ){
|
||
|
|
rtw_set_surprise_removed(padapter);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (i==SD_IO_TRY_CNT)
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x val=0x%08x, try_cnt=%d\n", __func__, *err, addr, v, i);
|
||
|
|
else
|
||
|
|
DBG_871X(KERN_ERR "%s: (%d) addr=0x%05x val=0x%08x, try_cnt=%d\n", __func__, *err, addr, v, i);
|
||
|
|
}
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Use CMD53 to read data from SDIO device.
|
||
|
|
* This function MUST be called after sdio_claim_host() or
|
||
|
|
* in SDIO ISR(host had been claimed).
|
||
|
|
*
|
||
|
|
* Parameters:
|
||
|
|
* psdio pointer of SDIO_DATA
|
||
|
|
* addr address to read
|
||
|
|
* cnt amount to read
|
||
|
|
* pdata pointer to put data, this should be a "DMA:able scratch buffer"!
|
||
|
|
*
|
||
|
|
* Return:
|
||
|
|
* 0 Success
|
||
|
|
* others Fail
|
||
|
|
*/
|
||
|
|
s32 _sd_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
int err= -EPERM;
|
||
|
|
struct sdio_func *func;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
|
||
|
|
if (unlikely((cnt==1) || (cnt==2)))
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
u8 *pbuf = (u8*)pdata;
|
||
|
|
|
||
|
|
for (i = 0; i < cnt; i++)
|
||
|
|
{
|
||
|
|
*(pbuf+i) = sdio_readb(func, addr+i, &err);
|
||
|
|
|
||
|
|
if (err) {
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x\n", __func__, err, addr);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
err = sdio_memcpy_fromio(func, pdata, addr, cnt);
|
||
|
|
if (err) {
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL(%d)! ADDR=%#x Size=%d\n", __func__, err, addr, cnt);
|
||
|
|
}
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Use CMD53 to read data from SDIO device.
|
||
|
|
*
|
||
|
|
* Parameters:
|
||
|
|
* psdio pointer of SDIO_DATA
|
||
|
|
* addr address to read
|
||
|
|
* cnt amount to read
|
||
|
|
* pdata pointer to put data, this should be a "DMA:able scratch buffer"!
|
||
|
|
*
|
||
|
|
* Return:
|
||
|
|
* 0 Success
|
||
|
|
* others Fail
|
||
|
|
*/
|
||
|
|
s32 sd_read(struct intf_hdl * pintfhdl, u32 addr, u32 cnt, void *pdata)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
struct sdio_func *func;
|
||
|
|
bool claim_needed;
|
||
|
|
s32 err= -EPERM;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
func = psdio->func;
|
||
|
|
claim_needed = rtw_sdio_claim_host_needed(func);
|
||
|
|
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_claim_host(func);
|
||
|
|
err = _sd_read(pintfhdl, addr, cnt, pdata);
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_release_host(func);
|
||
|
|
_func_exit_;
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Use CMD53 to write data to SDIO device.
|
||
|
|
* This function MUST be called after sdio_claim_host() or
|
||
|
|
* in SDIO ISR(host had been claimed).
|
||
|
|
*
|
||
|
|
* Parameters:
|
||
|
|
* psdio pointer of SDIO_DATA
|
||
|
|
* addr address to write
|
||
|
|
* cnt amount to write
|
||
|
|
* pdata data pointer, this should be a "DMA:able scratch buffer"!
|
||
|
|
*
|
||
|
|
* Return:
|
||
|
|
* 0 Success
|
||
|
|
* others Fail
|
||
|
|
*/
|
||
|
|
s32 _sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
struct sdio_func *func;
|
||
|
|
u32 size;
|
||
|
|
s32 err=-EPERM;
|
||
|
|
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
// size = sdio_align_size(func, cnt);
|
||
|
|
|
||
|
|
if (unlikely((cnt==1) || (cnt==2)))
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
u8 *pbuf = (u8*)pdata;
|
||
|
|
|
||
|
|
for (i = 0; i < cnt; i++)
|
||
|
|
{
|
||
|
|
sdio_writeb(func, *(pbuf+i), addr+i, &err);
|
||
|
|
if (err) {
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL!(%d) addr=0x%05x val=0x%02x\n", __func__, err, addr, *(pbuf+i));
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
size = cnt;
|
||
|
|
err = sdio_memcpy_toio(func, addr, pdata, size);
|
||
|
|
if (err) {
|
||
|
|
DBG_871X(KERN_ERR "%s: FAIL(%d)! ADDR=%#x Size=%d(%d)\n", __func__, err, addr, cnt, size);
|
||
|
|
}
|
||
|
|
|
||
|
|
_func_exit_;
|
||
|
|
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Use CMD53 to write data to SDIO device.
|
||
|
|
*
|
||
|
|
* Parameters:
|
||
|
|
* psdio pointer of SDIO_DATA
|
||
|
|
* addr address to write
|
||
|
|
* cnt amount to write
|
||
|
|
* pdata data pointer, this should be a "DMA:able scratch buffer"!
|
||
|
|
*
|
||
|
|
* Return:
|
||
|
|
* 0 Success
|
||
|
|
* others Fail
|
||
|
|
*/
|
||
|
|
s32 sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata)
|
||
|
|
{
|
||
|
|
PADAPTER padapter;
|
||
|
|
struct dvobj_priv *psdiodev;
|
||
|
|
PSDIO_DATA psdio;
|
||
|
|
|
||
|
|
struct sdio_func *func;
|
||
|
|
bool claim_needed;
|
||
|
|
s32 err=-EPERM;
|
||
|
|
_func_enter_;
|
||
|
|
padapter = pintfhdl->padapter;
|
||
|
|
psdiodev = pintfhdl->pintf_dev;
|
||
|
|
psdio = &psdiodev->intf_data;
|
||
|
|
|
||
|
|
if (rtw_is_surprise_removed(padapter)) {
|
||
|
|
//DBG_871X(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n",__FUNCTION__);
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|
||
|
|
func = psdio->func;
|
||
|
|
claim_needed = rtw_sdio_claim_host_needed(func);
|
||
|
|
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_claim_host(func);
|
||
|
|
err = _sd_write(pintfhdl, addr, cnt, pdata);
|
||
|
|
if (claim_needed)
|
||
|
|
sdio_release_host(func);
|
||
|
|
_func_exit_;
|
||
|
|
return err;
|
||
|
|
}
|
||
|
|
|