122 lines
2.5 KiB
C
122 lines
2.5 KiB
C
/*
|
|
***************************************************************************
|
|
* MediaTek Inc.
|
|
*
|
|
* All rights reserved. source code is an unpublished work and the
|
|
* use of a copyright notice does not imply otherwise. This source code
|
|
* contains confidential trade secret material of MediaTek. Any attemp
|
|
* or participation in deciphering, decoding, reverse engineering or in any
|
|
* way altering the source code is stricitly prohibited, unless the prior
|
|
* written consent of MediaTek, Inc. is obtained.
|
|
***************************************************************************
|
|
|
|
Module Name:
|
|
mtusb_io.c
|
|
*/
|
|
|
|
#include "rt_config.h"
|
|
|
|
INT32 MTSDIORead32(RTMP_ADAPTER *pAd, UINT32 Offset, UINT32 *Value)
|
|
{
|
|
|
|
INT32 Ret = 0;
|
|
void* handle = pAd->OS_Cookie;
|
|
struct sdio_func *dev_func = ((POS_COOKIE)handle)->sdio_dev;
|
|
|
|
sdio_claim_host(dev_func);
|
|
*Value = sdio_readl(dev_func, Offset, &Ret);
|
|
sdio_release_host(dev_func);
|
|
|
|
if (Ret) {
|
|
DBGPRINT(RT_DEBUG_ERROR, ("RTSDIORead32 failure!\n"));
|
|
}
|
|
|
|
return Ret;
|
|
}
|
|
|
|
|
|
INT32 MTSDIOWrite32(RTMP_ADAPTER *pAd, UINT32 Offset, UINT32 Value)
|
|
{
|
|
INT32 Ret = 0;
|
|
void* handle = pAd->OS_Cookie;
|
|
struct sdio_func *dev_func = ((POS_COOKIE)handle)->sdio_dev;
|
|
|
|
sdio_claim_host(dev_func);
|
|
sdio_writel(dev_func, Value, Offset, &Ret);
|
|
sdio_release_host(dev_func);
|
|
|
|
return Ret;
|
|
}
|
|
|
|
|
|
INT32 MTSDIOMultiRead(RTMP_ADAPTER *pAd, UINT32 Offset,
|
|
UCHAR *Buf,UINT32 Length)
|
|
{
|
|
UINT32 Count = Length;
|
|
void* handle = pAd->OS_Cookie;
|
|
struct sdio_func *dev_func = ((POS_COOKIE)handle)->sdio_dev;
|
|
UINT32 bNum = 0;
|
|
INT32 Ret;
|
|
|
|
while (Count >= pAd->BlockSize) {
|
|
Count -= pAd->BlockSize;
|
|
bNum++;
|
|
}
|
|
|
|
if (Count > 0 && bNum > 0) {
|
|
bNum++;
|
|
}
|
|
|
|
sdio_claim_host(dev_func);
|
|
|
|
if (bNum > 0) {
|
|
Ret = sdio_readsb(dev_func, Buf, Offset, pAd->BlockSize * bNum);
|
|
}
|
|
else
|
|
{
|
|
Ret = sdio_readsb(dev_func, Buf, Offset, Count);
|
|
}
|
|
|
|
sdio_release_host(dev_func);
|
|
|
|
return Ret;
|
|
}
|
|
|
|
|
|
INT32 MTSDIOMultiWrite(RTMP_ADAPTER *pAd, UINT32 Offset,
|
|
UCHAR *Buf,UINT32 Length)
|
|
{
|
|
|
|
UINT32 Count = Length;
|
|
void* handle = pAd->OS_Cookie;
|
|
struct sdio_func *dev_func = ((POS_COOKIE)handle)->sdio_dev;
|
|
INT32 Ret = 0;
|
|
UINT32 bNum = 0;
|
|
|
|
while (Count >= pAd->BlockSize) {
|
|
Count -= pAd->BlockSize;
|
|
bNum++;
|
|
}
|
|
|
|
if (Count > 0 && bNum > 0) {
|
|
bNum++;
|
|
}
|
|
|
|
sdio_claim_host(dev_func);
|
|
|
|
if (bNum > 0)
|
|
{
|
|
Ret = sdio_writesb(dev_func, Offset, Buf, pAd->BlockSize * bNum);
|
|
}
|
|
else
|
|
{
|
|
Ret = sdio_writesb(dev_func, Offset, Buf, Count);
|
|
}
|
|
|
|
sdio_release_host(dev_func);
|
|
|
|
return Ret;
|
|
}
|
|
|
|
|