git.oblomov.eu Git - linux-2.6/blob - drivers/staging/rt2870/common/dfs.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     ap_dfs.c
  29
  30     Abstract:
  31     Support DFS function.
  32
  33     Revision History:
  34     Who       When            What
  35     --------  ----------      ----------------------------------------------
  36     Fonchi    03-12-2007      created
  37 */
  38
  39 #include "../rt_config.h"
  40
  41 typedef struct _RADAR_DURATION_TABLE
  42 {
  43         ULONG RDDurRegion;
  44         ULONG RadarSignalDuration;
  45         ULONG Tolerance;
  46 } RADAR_DURATION_TABLE, *PRADAR_DURATION_TABLE;
  47
  48
  49 static UCHAR RdIdleTimeTable[MAX_RD_REGION][4] =
  50 {
  51         {9, 250, 250, 250},             // CE
  52         {4, 250, 250, 250},             // FCC
  53         {4, 250, 250, 250},             // JAP
  54         {15, 250, 250, 250},    // JAP_W53
  55         {4, 250, 250, 250}              // JAP_W56
  56 };
  57
  58 /*
  59         ========================================================================
  60
  61         Routine Description:
  62                 Bbp Radar detection routine
  63
  64         Arguments:
  65                 pAd     Pointer to our adapter
  66
  67         Return Value:
  68
  69         ========================================================================
  70 */
  71 VOID BbpRadarDetectionStart(
  72         IN PRTMP_ADAPTER pAd)
  73 {
  74         UINT8 RadarPeriod;
  75
  76         RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, 114, 0x02);
  77         RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, 121, 0x20);
  78         RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, 122, 0x00);
  79         RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, 123, 0x08/*0x80*/);
  80         RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, 124, 0x28);
  81         RTMP_BBP_IO_WRITE8_BY_REG_ID(pAd, 125, 0xff);
  82
  83 #if 0
  84         // toggle Rx enable bit for radar detection.
  85         // it's Andy's recommand.
  86         {
  87                 UINT32 Value;
  88         RTMP_IO_READ32(pAd, MAC_SYS_CTRL, &Value);
  89         Value |= (0x1 << 3);
  90         RTMP_IO_WRITE32(pAd, MAC_SYS_CTRL, Value);
  91         Value &= ~(0x1 << 3);
  92         RTMP_IO_WRITE32(pAd, MAC_SYS_CTRL, Value);
  93         }
  94 #endif
  95         RadarPeriod = ((UINT)RdIdleTimeTable[pAd->CommonCfg.RadarDetect.RDDurRegion][0] + (UINT)pAd->CommonCfg.RadarDetect.DfsSessionTime) < 250 ?
  96                         (RdIdleTimeTable[pAd->CommonCfg.RadarDetect.RDDurRegion][0] + pAd->CommonCfg.RadarDetect.DfsSessionTime) : 250;
  97
  98         RTMP_IO_WRITE8(pAd, 0x7020, 0x1d);
  99         RTMP_IO_WRITE8(pAd, 0x7021, 0x40);
 100
 101         RadarDetectionStart(pAd, 0, RadarPeriod);
 102         return;
 103 }
 104
 105 /*
 106         ========================================================================
 107
 108         Routine Description:
 109                 Bbp Radar detection routine
 110
 111         Arguments:
 112                 pAd     Pointer to our adapter
 113
 114         Return Value:
 115
 116         ========================================================================
 117 */
 118 VOID BbpRadarDetectionStop(
 119         IN PRTMP_ADAPTER pAd)
 120 {
 121         RTMP_IO_WRITE8(pAd, 0x7020, 0x1d);
 122         RTMP_IO_WRITE8(pAd, 0x7021, 0x60);
 123
 124         RadarDetectionStop(pAd);
 125         return;
 126 }
 127
 128 /*
 129         ========================================================================
 130
 131         Routine Description:
 132                 Radar detection routine
 133
 134         Arguments:
 135                 pAd     Pointer to our adapter
 136
 137         Return Value:
 138
 139         ========================================================================
 140 */
 141 VOID RadarDetectionStart(
 142         IN PRTMP_ADAPTER pAd,
 143         IN BOOLEAN CTSProtect,
 144         IN UINT8 CTSPeriod)
 145 {
 146         UINT8 DfsActiveTime = (pAd->CommonCfg.RadarDetect.DfsSessionTime & 0x1f);
 147         UINT8 CtsProtect = (CTSProtect == 1) ? 0x02 : 0x01; // CTS protect.
 148
 149         if (CTSProtect != 0)
 150         {
 151                 switch(pAd->CommonCfg.RadarDetect.RDDurRegion)
 152                 {
 153                 case FCC:
 154                 case JAP_W56:
 155                         CtsProtect = 0x03;
 156                         break;
 157
 158                 case CE:
 159                 case JAP_W53:
 160                 default:
 161                         CtsProtect = 0x02;
 162                         break;
 163                 }
 164         }
 165         else
 166                 CtsProtect = 0x01;
 167
 168
 169         // send start-RD with CTS protection command to MCU
 170         // highbyte [7]         reserve
 171         // highbyte [6:5]       0x: stop Carrier/Radar detection
 172         // highbyte [10]:       Start Carrier/Radar detection without CTS protection, 11: Start Carrier/Radar detection with CTS protection
 173         // highbyte [4:0]       Radar/carrier detection duration. In 1ms.
 174
 175         // lowbyte [7:0]        Radar/carrier detection period, in 1ms.
 176         AsicSendCommandToMcu(pAd, 0x60, 0xff, CTSPeriod, DfsActiveTime | (CtsProtect << 5));
 177         //AsicSendCommandToMcu(pAd, 0x63, 0xff, 10, 0);
 178
 179         return;
 180 }
 181
 182 /*
 183         ========================================================================
 184
 185         Routine Description:
 186                 Radar detection routine
 187
 188         Arguments:
 189                 pAd     Pointer to our adapter
 190
 191         Return Value:
 192                 TRUE    Found radar signal
 193                 FALSE   Not found radar signal
 194
 195         ========================================================================
 196 */
 197 VOID RadarDetectionStop(
 198         IN PRTMP_ADAPTER        pAd)
 199 {
 200         DBGPRINT(RT_DEBUG_TRACE,("RadarDetectionStop.\n"));
 201         AsicSendCommandToMcu(pAd, 0x60, 0xff, 0x00, 0x00);      // send start-RD with CTS protection command to MCU
 202
 203         return;
 204 }
 205
 206 /*
 207         ========================================================================
 208
 209         Routine Description:
 210                 Radar channel check routine
 211
 212         Arguments:
 213                 pAd     Pointer to our adapter
 214
 215         Return Value:
 216                 TRUE    need to do radar detect
 217                 FALSE   need not to do radar detect
 218
 219         ========================================================================
 220 */
 221 BOOLEAN RadarChannelCheck(
 222         IN PRTMP_ADAPTER        pAd,
 223         IN UCHAR                        Ch)
 224 {
 225 #if 1
 226         INT             i;
 227         BOOLEAN result = FALSE;
 228
 229         for (i=0; i<pAd->ChannelListNum; i++)
 230         {
 231                 if (Ch == pAd->ChannelList[i].Channel)
 232                 {
 233                         result = pAd->ChannelList[i].DfsReq;
 234                         break;
 235                 }
 236         }
 237
 238         return result;
 239 #else
 240         INT             i;
 241         UCHAR   Channel[15]={52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140};
 242
 243         for (i=0; i<15; i++)
 244         {
 245                 if (Ch == Channel[i])
 246                 {
 247                         break;
 248                 }
 249         }
 250
 251         if (i != 15)
 252                 return TRUE;
 253         else
 254                 return FALSE;
 255 #endif
 256 }
 257
 258 ULONG JapRadarType(
 259         IN PRTMP_ADAPTER pAd)
 260 {
 261         ULONG           i;
 262         const UCHAR     Channel[15]={52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140};
 263
 264         if (pAd->CommonCfg.RadarDetect.RDDurRegion != JAP)
 265         {
 266                 return pAd->CommonCfg.RadarDetect.RDDurRegion;
 267         }
 268
 269         for (i=0; i<15; i++)
 270         {
 271                 if (pAd->CommonCfg.Channel == Channel[i])
 272                 {
 273                         break;
 274                 }
 275         }
 276
 277         if (i < 4)
 278                 return JAP_W53;
 279         else if (i < 15)
 280                 return JAP_W56;
 281         else
 282                 return JAP; // W52
 283
 284 }
 285
 286 ULONG RTMPBbpReadRadarDuration(
 287         IN PRTMP_ADAPTER        pAd)
 288 {
 289         UINT8 byteValue = 0;
 290         ULONG result;
 291
 292         BBP_IO_READ8_BY_REG_ID(pAd, BBP_R115, &byteValue);
 293
 294         result = 0;
 295         switch (byteValue)
 296         {
 297         case 1: // radar signal detected by pulse mode.
 298         case 2: // radar signal detected by width mode.
 299                 result = RTMPReadRadarDuration(pAd);
 300                 break;
 301
 302         case 0: // No radar signal.
 303         default:
 304
 305                 result = 0;
 306                 break;
 307         }
 308
 309         return result;
 310 }
 311
 312 ULONG RTMPReadRadarDuration(
 313         IN PRTMP_ADAPTER        pAd)
 314 {
 315         ULONG result = 0;
 316
 317         return result;
 318
 319 }
 320
 321 VOID RTMPCleanRadarDuration(
 322         IN PRTMP_ADAPTER        pAd)
 323 {
 324         return;
 325 }
 326
 327 /*
 328     ========================================================================
 329     Routine Description:
 330         Radar wave detection. The API should be invoke each second.
 331
 332     Arguments:
 333         pAd         - Adapter pointer
 334
 335     Return Value:
 336         None
 337
 338     ========================================================================
 339 */
 340 VOID ApRadarDetectPeriodic(
 341         IN PRTMP_ADAPTER pAd)
 342 {
 343         INT     i;
 344
 345         pAd->CommonCfg.RadarDetect.InServiceMonitorCount++;
 346
 347         for (i=0; i<pAd->ChannelListNum; i++)
 348         {
 349                 if (pAd->ChannelList[i].RemainingTimeForUse > 0)
 350                 {
 351                         pAd->ChannelList[i].RemainingTimeForUse --;
 352                         if ((pAd->Mlme.PeriodicRound%5) == 0)
 353                         {
 354                                 DBGPRINT(RT_DEBUG_TRACE, ("RadarDetectPeriodic - ch=%d, RemainingTimeForUse=%d\n", pAd->ChannelList[i].Channel, pAd->ChannelList[i].RemainingTimeForUse));
 355                         }
 356                 }
 357         }
 358
 359         //radar detect
 360         if ((pAd->CommonCfg.Channel > 14)
 361                 && (pAd->CommonCfg.bIEEE80211H == 1)
 362                 && RadarChannelCheck(pAd, pAd->CommonCfg.Channel))
 363         {
 364                 RadarDetectPeriodic(pAd);
 365         }
 366
 367         return;
 368 }
 369
 370 // Periodic Radar detection, switch channel will occur in RTMPHandleTBTTInterrupt()
 371 // Before switch channel, driver needs doing channel switch announcement.
 372 VOID RadarDetectPeriodic(
 373         IN PRTMP_ADAPTER        pAd)
 374 {
 375         // need to check channel availability, after switch channel
 376         if (pAd->CommonCfg.RadarDetect.RDMode != RD_SILENCE_MODE)
 377                         return;
 378
 379         // channel availability check time is 60sec, use 65 for assurance
 380         if (pAd->CommonCfg.RadarDetect.RDCount++ > pAd->CommonCfg.RadarDetect.ChMovingTime)
 381         {
 382                 DBGPRINT(RT_DEBUG_TRACE, ("Not found radar signal, start send beacon and radar detection in service monitor\n\n"));
 383                         BbpRadarDetectionStop(pAd);
 384                 AsicEnableBssSync(pAd);
 385                 pAd->CommonCfg.RadarDetect.RDMode = RD_NORMAL_MODE;
 386
 387
 388                 return;
 389         }
 390
 391         return;
 392 }
 393
 394
 395 /*
 396     ==========================================================================
 397     Description:
 398                 change channel moving time for DFS testing.
 399
 400         Arguments:
 401             pAdapter                    Pointer to our adapter
 402             wrq                         Pointer to the ioctl argument
 403
 404     Return Value:
 405         None
 406
 407     Note:
 408         Usage:
 409                1.) iwpriv ra0 set ChMovTime=[value]
 410     ==========================================================================
 411 */
 412 INT Set_ChMovingTime_Proc(
 413         IN PRTMP_ADAPTER pAd,
 414         IN PUCHAR arg)
 415 {
 416         UINT8 Value;
 417
 418         Value = simple_strtol(arg, 0, 10);
 419
 420         pAd->CommonCfg.RadarDetect.ChMovingTime = Value;
 421
 422         DBGPRINT(RT_DEBUG_TRACE, ("%s:: %d\n", __func__,
 423                 pAd->CommonCfg.RadarDetect.ChMovingTime));
 424
 425         return TRUE;
 426 }
 427
 428 INT Set_LongPulseRadarTh_Proc(
 429         IN PRTMP_ADAPTER pAd,
 430         IN PUCHAR arg)
 431 {
 432         UINT8 Value;
 433
 434         Value = simple_strtol(arg, 0, 10) > 10 ? 10 : simple_strtol(arg, 0, 10);
 435
 436         pAd->CommonCfg.RadarDetect.LongPulseRadarTh = Value;
 437
 438         DBGPRINT(RT_DEBUG_TRACE, ("%s:: %d\n", __func__,
 439                 pAd->CommonCfg.RadarDetect.LongPulseRadarTh));
 440
 441         return TRUE;
 442 }
 443
 444