[linux-block.git] / drivers / staging / rt2860 / common / rt_rf.c

/*
 *************************************************************************
 * Ralink Tech Inc.
 * 5F., No.36, Taiyuan St., Jhubei City,
 * Hsinchu County 302,
 * Taiwan, R.O.C.
 *
 * (c) Copyright 2002-2007, Ralink Technology, Inc.
 *
 * This program is free software; you can redistribute it and/or modify  *
 * it under the terms of the GNU General Public License as published by  *
 * the Free Software Foundation; either version 2 of the License, or     *
 * (at your option) any later version.                                   *
 *                                                                       *
 * 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.,                                       *
 * 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *
 *                                                                       *
 *************************************************************************

	Module Name:
	rt_rf.c

	Abstract:
	Ralink Wireless driver RF related functions

	Revision History:
	Who         When          What
	--------    ----------    ----------------------------------------------
*/

#include "../rt_config.h"

#ifdef RTMP_RF_RW_SUPPORT
/*
	========================================================================

	Routine Description: Write RT30xx RF register through MAC

	Arguments:

	Return Value:

	IRQL =

	Note:

	========================================================================
*/
int RT30xxWriteRFRegister(struct rt_rtmp_adapter *pAd,
				  u8 regID, u8 value)
{
	RF_CSR_CFG_STRUC rfcsr;
	u32 i = 0;

	do {
		RTMP_IO_READ32(pAd, RF_CSR_CFG, &rfcsr.word);

		if (!rfcsr.field.RF_CSR_KICK)
			break;
		i++;
	}
	while ((i < RETRY_LIMIT)
	       && (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST)));

	if ((i == RETRY_LIMIT)
	    || (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))) {
		DBGPRINT_RAW(RT_DEBUG_ERROR,
			     ("Retry count exhausted or device removed!\n"));
		return STATUS_UNSUCCESSFUL;
	}

	rfcsr.field.RF_CSR_WR = 1;
	rfcsr.field.RF_CSR_KICK = 1;
	rfcsr.field.TESTCSR_RFACC_REGNUM = regID;
	rfcsr.field.RF_CSR_DATA = value;

	RTMP_IO_WRITE32(pAd, RF_CSR_CFG, rfcsr.word);

	return NDIS_STATUS_SUCCESS;
}

/*
	========================================================================

	Routine Description: Read RT30xx RF register through MAC

	Arguments:

	Return Value:

	IRQL =

	Note:

	========================================================================
*/
int RT30xxReadRFRegister(struct rt_rtmp_adapter *pAd,
				 u8 regID, u8 *pValue)
{
	RF_CSR_CFG_STRUC rfcsr;
	u32 i = 0, k = 0;

	for (i = 0; i < MAX_BUSY_COUNT; i++) {
		RTMP_IO_READ32(pAd, RF_CSR_CFG, &rfcsr.word);

		if (rfcsr.field.RF_CSR_KICK == BUSY) {
			continue;
		}
		rfcsr.word = 0;
		rfcsr.field.RF_CSR_WR = 0;
		rfcsr.field.RF_CSR_KICK = 1;
		rfcsr.field.TESTCSR_RFACC_REGNUM = regID;
		RTMP_IO_WRITE32(pAd, RF_CSR_CFG, rfcsr.word);
		for (k = 0; k < MAX_BUSY_COUNT; k++) {
			RTMP_IO_READ32(pAd, RF_CSR_CFG, &rfcsr.word);

			if (rfcsr.field.RF_CSR_KICK == IDLE)
				break;
		}
		if ((rfcsr.field.RF_CSR_KICK == IDLE) &&
		    (rfcsr.field.TESTCSR_RFACC_REGNUM == regID)) {
			*pValue = (u8)rfcsr.field.RF_CSR_DATA;
			break;
		}
	}
	if (rfcsr.field.RF_CSR_KICK == BUSY) {
		DBGPRINT_ERR("RF read R%d=0x%x fail, i[%d], k[%d]\n", regID, rfcsr.word, i, k);
		return STATUS_UNSUCCESSFUL;
	}

	return STATUS_SUCCESS;
}

void NICInitRFRegisters(struct rt_rtmp_adapter *pAd)
{
	if (pAd->chipOps.AsicRfInit)
		pAd->chipOps.AsicRfInit(pAd);
}

void RtmpChipOpsRFHook(struct rt_rtmp_adapter *pAd)
{
	struct rt_rtmp_chip_op *pChipOps = &pAd->chipOps;

	pChipOps->pRFRegTable = NULL;
	pChipOps->AsicRfInit = NULL;
	pChipOps->AsicRfTurnOn = NULL;
	pChipOps->AsicRfTurnOff = NULL;
	pChipOps->AsicReverseRfFromSleepMode = NULL;
	pChipOps->AsicHaltAction = NULL;
	/* We depends on RfICType and MACVersion to assign the corresponding operation callbacks. */

#ifdef RT30xx
	if (IS_RT30xx(pAd)) {
		pChipOps->pRFRegTable = RT30xx_RFRegTable;
		pChipOps->AsicHaltAction = RT30xxHaltAction;
#ifdef RT3070
		if ((IS_RT3070(pAd) || IS_RT3071(pAd))
		    && (pAd->infType == RTMP_DEV_INF_USB)) {
			pChipOps->AsicRfInit = NICInitRT3070RFRegisters;
			if (IS_RT3071(pAd)) {
				pChipOps->AsicRfTurnOff =
				    RT30xxLoadRFSleepModeSetup;
				pChipOps->AsicReverseRfFromSleepMode =
				    RT30xxReverseRFSleepModeSetup;
			}
		}
#endif /* RT3070 // */
#ifdef RT3090
		if (IS_RT3090(pAd) && (pAd->infType == RTMP_DEV_INF_PCI)) {
			pChipOps->AsicRfTurnOff = RT30xxLoadRFSleepModeSetup;
			pChipOps->AsicRfInit = NICInitRT3090RFRegisters;
			pChipOps->AsicReverseRfFromSleepMode =
			    RT30xxReverseRFSleepModeSetup;
		}
#endif /* RT3090 // */
	}
#endif /* RT30xx // */
}

#endif /* RTMP_RF_RW_SUPPORT // */
Commit	Line	Data
ca97b838 BZ	1	/*
	2	*************************************************************************
	3	* Ralink Tech Inc.
	4	* 5F., No.36, Taiyuan St., Jhubei City,
	5	* Hsinchu County 302,
	6	* Taiwan, R.O.C.
	7	*
	8	* (c) Copyright 2002-2007, Ralink Technology, Inc.
	9	*
	10	* This program is free software; you can redistribute it and/or modify *
	11	* it under the terms of the GNU General Public License as published by *
	12	* the Free Software Foundation; either version 2 of the License, or *
	13	* (at your option) any later version. *
	14	* *
	15	* This program is distributed in the hope that it will be useful, *
	16	* but WITHOUT ANY WARRANTY; without even the implied warranty of *
	17	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
	18	* GNU General Public License for more details. *
	19	* *
	20	* You should have received a copy of the GNU General Public License *
	21	* along with this program; if not, write to the *
	22	* Free Software Foundation, Inc., *
	23	* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
	24	* *
	25	*************************************************************************
	26
	27	Module Name:
	28	rt_rf.c
	29
	30	Abstract:
	31	Ralink Wireless driver RF related functions
	32
	33	Revision History:
	34	Who When What
	35	-------- ---------- ----------------------------------------------
	36	*/
	37
ca97b838 BZ	38	#include "../rt_config.h"
ca97b838 BZ	39
ca97b838 BZ	40	#ifdef RTMP_RF_RW_SUPPORT
	41	/*
	42	========================================================================
	43
	44	Routine Description: Write RT30xx RF register through MAC
	45
	46	Arguments:
	47
	48	Return Value:
	49
	50	IRQL =
	51
	52	Note:
	53
	54	========================================================================
	55	*/
62eb734b	56	int RT30xxWriteRFRegister(struct rt_rtmp_adapter *pAd,
51126deb	57	u8 regID, u8 value)
ca97b838	58	{
96b3c83d	59	RF_CSR_CFG_STRUC rfcsr;
51126deb	60	u32 i = 0;
ca97b838	61
96b3c83d	62	do {
ca97b838 BZ	63	RTMP_IO_READ32(pAd, RF_CSR_CFG, &rfcsr.word);
	64
	65	if (!rfcsr.field.RF_CSR_KICK)
	66	break;
	67	i++;
	68	}
96b3c83d BZ	69	while ((i < RETRY_LIMIT)
96b3c83d BZ	70	&& (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST)));
ca97b838	71
96b3c83d BZ	72	if ((i == RETRY_LIMIT)
	73	\|\| (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST))) {
	74	DBGPRINT_RAW(RT_DEBUG_ERROR,
06aea994	75	("Retry count exhausted or device removed!\n"));
ca97b838 BZ	76	return STATUS_UNSUCCESSFUL;
	77	}
	78
	79	rfcsr.field.RF_CSR_WR = 1;
	80	rfcsr.field.RF_CSR_KICK = 1;
	81	rfcsr.field.TESTCSR_RFACC_REGNUM = regID;
	82	rfcsr.field.RF_CSR_DATA = value;
	83
	84	RTMP_IO_WRITE32(pAd, RF_CSR_CFG, rfcsr.word);
	85
	86	return NDIS_STATUS_SUCCESS;
	87	}
	88
ca97b838 BZ	89	/*
	90	========================================================================
	91
	92	Routine Description: Read RT30xx RF register through MAC
	93
	94	Arguments:
	95
	96	Return Value:
	97
	98	IRQL =
	99
	100	Note:
	101
	102	========================================================================
	103	*/
62eb734b	104	int RT30xxReadRFRegister(struct rt_rtmp_adapter *pAd,
51126deb	105	u8 regID, u8 *pValue)
ca97b838	106	{
96b3c83d	107	RF_CSR_CFG_STRUC rfcsr;
51126deb	108	u32 i = 0, k = 0;
ca97b838	109
96b3c83d	110	for (i = 0; i < MAX_BUSY_COUNT; i++) {
ca97b838 BZ	111	RTMP_IO_READ32(pAd, RF_CSR_CFG, &rfcsr.word);
ca97b838 BZ	112
96b3c83d	113	if (rfcsr.field.RF_CSR_KICK == BUSY) {
ca97b838 BZ	114	continue;
	115	}
	116	rfcsr.word = 0;
	117	rfcsr.field.RF_CSR_WR = 0;
	118	rfcsr.field.RF_CSR_KICK = 1;
	119	rfcsr.field.TESTCSR_RFACC_REGNUM = regID;
	120	RTMP_IO_WRITE32(pAd, RF_CSR_CFG, rfcsr.word);
96b3c83d	121	for (k = 0; k < MAX_BUSY_COUNT; k++) {
ca97b838 BZ	122	RTMP_IO_READ32(pAd, RF_CSR_CFG, &rfcsr.word);
	123
	124	if (rfcsr.field.RF_CSR_KICK == IDLE)
	125	break;
	126	}
	127	if ((rfcsr.field.RF_CSR_KICK == IDLE) &&
96b3c83d	128	(rfcsr.field.TESTCSR_RFACC_REGNUM == regID)) {
51126deb	129	*pValue = (u8)rfcsr.field.RF_CSR_DATA;
ca97b838 BZ	130	break;
	131	}
	132	}
96b3c83d	133	if (rfcsr.field.RF_CSR_KICK == BUSY) {
8c3d9092	134	DBGPRINT_ERR("RF read R%d=0x%x fail, i[%d], k[%d]\n", regID, rfcsr.word, i, k);
ca97b838 BZ	135	return STATUS_UNSUCCESSFUL;
	136	}
	137
	138	return STATUS_SUCCESS;
	139	}
	140
62eb734b	141	void NICInitRFRegisters(struct rt_rtmp_adapter *pAd)
ca97b838 BZ	142	{
	143	if (pAd->chipOps.AsicRfInit)
	144	pAd->chipOps.AsicRfInit(pAd);
	145	}
	146
62eb734b	147	void RtmpChipOpsRFHook(struct rt_rtmp_adapter *pAd)
ca97b838	148	{
62eb734b	149	struct rt_rtmp_chip_op *pChipOps = &pAd->chipOps;
ca97b838 BZ	150
	151	pChipOps->pRFRegTable = NULL;
	152	pChipOps->AsicRfInit = NULL;
	153	pChipOps->AsicRfTurnOn = NULL;
	154	pChipOps->AsicRfTurnOff = NULL;
	155	pChipOps->AsicReverseRfFromSleepMode = NULL;
	156	pChipOps->AsicHaltAction = NULL;
	157	/* We depends on RfICType and MACVersion to assign the corresponding operation callbacks. */
	158
	159	#ifdef RT30xx
96b3c83d	160	if (IS_RT30xx(pAd)) {
ca97b838 BZ	161	pChipOps->pRFRegTable = RT30xx_RFRegTable;
	162	pChipOps->AsicHaltAction = RT30xxHaltAction;
	163	#ifdef RT3070
96b3c83d BZ	164	if ((IS_RT3070(pAd) \|\| IS_RT3071(pAd))
96b3c83d BZ	165	&& (pAd->infType == RTMP_DEV_INF_USB)) {
ca97b838	166	pChipOps->AsicRfInit = NICInitRT3070RFRegisters;
96b3c83d BZ	167	if (IS_RT3071(pAd)) {
	168	pChipOps->AsicRfTurnOff =
	169	RT30xxLoadRFSleepModeSetup;
	170	pChipOps->AsicReverseRfFromSleepMode =
	171	RT30xxReverseRFSleepModeSetup;
ca97b838 BZ	172	}
ca97b838 BZ	173	}
ec278fa2	174	#endif /* RT3070 // */
e44fd1cf	175	#ifdef RT3090
96b3c83d	176	if (IS_RT3090(pAd) && (pAd->infType == RTMP_DEV_INF_PCI)) {
e44fd1cf BZ	177	pChipOps->AsicRfTurnOff = RT30xxLoadRFSleepModeSetup;
e44fd1cf BZ	178	pChipOps->AsicRfInit = NICInitRT3090RFRegisters;
96b3c83d BZ	179	pChipOps->AsicReverseRfFromSleepMode =
96b3c83d BZ	180	RT30xxReverseRFSleepModeSetup;
e44fd1cf	181	}
ec278fa2	182	#endif /* RT3090 // */
ca97b838	183	}
ec278fa2	184	#endif /* RT30xx // */
ca97b838 BZ	185	}
ca97b838 BZ	186
ec278fa2	187	#endif /* RTMP_RF_RW_SUPPORT // */