drivers/staging/rt2860/common/rt_rf.c

   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
  38
  39 #include "../rt_config.h"
  40
  41
  42 #ifdef RTMP_RF_RW_SUPPORT
  43 /*
  44         ========================================================================
  45
  46         Routine Description: Write RT30xx RF register through MAC
  47
  48         Arguments:
  49
  50         Return Value:
  51
  52         IRQL =
  53
  54         Note:
  55
  56         ========================================================================
  57 */
  58 NDIS_STATUS RT30xxWriteRFRegister(
  59         IN      PRTMP_ADAPTER   pAd,
  60         IN      UCHAR                   regID,
  61         IN      UCHAR                   value)
  62 {
  63         RF_CSR_CFG_STRUC        rfcsr;
  64         UINT                            i = 0;
  65
  66         do
  67         {
  68                 RTMP_IO_READ32(pAd, RF_CSR_CFG, &rfcsr.word);
  69
  70                 if (!rfcsr.field.RF_CSR_KICK)
  71                         break;
  72                 i++;
  73         }
  74         while ((i < RETRY_LIMIT) && (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST)));
  75
  76         if ((i == RETRY_LIMIT) || (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST)))
  77         {
  78                 DBGPRINT_RAW(RT_DEBUG_ERROR, ("Retry count exhausted or device removed!!!\n"));
  79                 return STATUS_UNSUCCESSFUL;
  80         }
  81
  82         rfcsr.field.RF_CSR_WR = 1;
  83         rfcsr.field.RF_CSR_KICK = 1;
  84         rfcsr.field.TESTCSR_RFACC_REGNUM = regID;
  85         rfcsr.field.RF_CSR_DATA = value;
  86
  87         RTMP_IO_WRITE32(pAd, RF_CSR_CFG, rfcsr.word);
  88
  89         return NDIS_STATUS_SUCCESS;
  90 }
  91
  92
  93 /*
  94         ========================================================================
  95
  96         Routine Description: Read RT30xx RF register through MAC
  97
  98         Arguments:
  99
 100         Return Value:
 101
 102         IRQL =
 103
 104         Note:
 105
 106         ========================================================================
 107 */
 108 NDIS_STATUS RT30xxReadRFRegister(
 109         IN      PRTMP_ADAPTER   pAd,
 110         IN      UCHAR                   regID,
 111         IN      PUCHAR                  pValue)
 112 {
 113         RF_CSR_CFG_STRUC        rfcsr;
 114         UINT                            i=0, k=0;
 115
 116         for (i=0; i<MAX_BUSY_COUNT; i++)
 117         {
 118                 RTMP_IO_READ32(pAd, RF_CSR_CFG, &rfcsr.word);
 119
 120                 if (rfcsr.field.RF_CSR_KICK == BUSY)
 121                 {
 122                         continue;
 123                 }
 124                 rfcsr.word = 0;
 125                 rfcsr.field.RF_CSR_WR = 0;
 126                 rfcsr.field.RF_CSR_KICK = 1;
 127                 rfcsr.field.TESTCSR_RFACC_REGNUM = regID;
 128                 RTMP_IO_WRITE32(pAd, RF_CSR_CFG, rfcsr.word);
 129                 for (k=0; k<MAX_BUSY_COUNT; k++)
 130                 {
 131                         RTMP_IO_READ32(pAd, RF_CSR_CFG, &rfcsr.word);
 132
 133                         if (rfcsr.field.RF_CSR_KICK == IDLE)
 134                                 break;
 135                 }
 136                 if ((rfcsr.field.RF_CSR_KICK == IDLE) &&
 137                         (rfcsr.field.TESTCSR_RFACC_REGNUM == regID))
 138                 {
 139                         *pValue = (UCHAR)rfcsr.field.RF_CSR_DATA;
 140                         break;
 141                 }
 142         }
 143         if (rfcsr.field.RF_CSR_KICK == BUSY)
 144         {
 145                 DBGPRINT_ERR(("RF read R%d=0x%x fail, i[%d], k[%d]\n", regID, rfcsr.word,i,k));
 146                 return STATUS_UNSUCCESSFUL;
 147         }
 148
 149         return STATUS_SUCCESS;
 150 }
 151
 152
 153 VOID NICInitRFRegisters(
 154         IN RTMP_ADAPTER *pAd)
 155 {
 156         if (pAd->chipOps.AsicRfInit)
 157                 pAd->chipOps.AsicRfInit(pAd);
 158 }
 159
 160
 161 VOID RtmpChipOpsRFHook(
 162         IN RTMP_ADAPTER *pAd)
 163 {
 164         RTMP_CHIP_OP *pChipOps = &pAd->chipOps;
 165
 166         pChipOps->pRFRegTable = NULL;
 167         pChipOps->AsicRfInit = NULL;
 168         pChipOps->AsicRfTurnOn = NULL;
 169         pChipOps->AsicRfTurnOff = NULL;
 170         pChipOps->AsicReverseRfFromSleepMode = NULL;
 171         pChipOps->AsicHaltAction = NULL;
 172         /* We depends on RfICType and MACVersion to assign the corresponding operation callbacks. */
 173
 174 #ifdef RT30xx
 175         if (IS_RT30xx(pAd))
 176         {
 177                 pChipOps->pRFRegTable = RT30xx_RFRegTable;
 178                 pChipOps->AsicHaltAction = RT30xxHaltAction;
 179 #ifdef RT3070
 180                 if((IS_RT3070(pAd) || IS_RT3071(pAd)) && (pAd->infType == RTMP_DEV_INF_USB))
 181                 {
 182                         pChipOps->AsicRfInit = NICInitRT3070RFRegisters;
 183                         if (IS_RT3071(pAd))
 184                         {
 185                                 pChipOps->AsicRfTurnOff = RT30xxLoadRFSleepModeSetup;
 186                                 pChipOps->AsicReverseRfFromSleepMode = RT30xxReverseRFSleepModeSetup;
 187                         }
 188                 }
 189 #endif // RT3070 //
 190 #ifdef RT3090
 191                 if (IS_RT3090(pAd) && (pAd->infType == RTMP_DEV_INF_PCI))
 192                 {
 193                         pChipOps->AsicRfTurnOff = RT30xxLoadRFSleepModeSetup;
 194                         pChipOps->AsicRfInit = NICInitRT3090RFRegisters;
 195                         pChipOps->AsicReverseRfFromSleepMode = RT30xxReverseRFSleepModeSetup;
 196                 }
 197 #endif // RT3090 //
 198         }
 199 #endif // RT30xx //
 200 }
 201
 202 #endif // RTMP_RF_RW_SUPPORT //