Pileus Git - ~andy/linux/blob - drivers/staging/rtl8187se/ieee80211/dot11d.c

   1 //-----------------------------------------------------------------------------
   2 //      File:
   3 //              Dot11d.c
   4 //
   5 //      Description:
   6 //              Implement 802.11d.
   7 //
   8 //-----------------------------------------------------------------------------
   9
  10 #include "dot11d.h"
  11
  12 void
  13 Dot11d_Init(struct ieee80211_device *ieee)
  14 {
  15         PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(ieee);
  16
  17         pDot11dInfo->bEnabled = 0;
  18
  19         pDot11dInfo->State = DOT11D_STATE_NONE;
  20         pDot11dInfo->CountryIeLen = 0;
  21         memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);
  22         memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);
  23         RESET_CIE_WATCHDOG(ieee);
  24
  25         printk("Dot11d_Init()\n");
  26 }
  27
  28 //
  29 //      Description:
  30 //              Reset to the state as we are just entering a regulatory domain.
  31 //
  32 void
  33 Dot11d_Reset(struct ieee80211_device *ieee)
  34 {
  35         u32 i;
  36         PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(ieee);
  37
  38         // Clear old channel map
  39         memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);
  40         memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);
  41         // Set new channel map
  42         for (i = 1; i <= 11; i++)
  43                 (pDot11dInfo->channel_map)[i] = 1;
  44
  45         for (i = 12; i <= 14; i++)
  46                 (pDot11dInfo->channel_map)[i] = 2;
  47
  48         pDot11dInfo->State = DOT11D_STATE_NONE;
  49         pDot11dInfo->CountryIeLen = 0;
  50         RESET_CIE_WATCHDOG(ieee);
  51
  52         //printk("Dot11d_Reset()\n");
  53 }
  54
  55 //
  56 //      Description:
  57 //              Update country IE from Beacon or Probe Response
  58 //              and configure PHY for operation in the regulatory domain.
  59 //
  60 //      TODO:
  61 //              Configure Tx power.
  62 //
  63 //      Assumption:
  64 //              1. IS_DOT11D_ENABLE() is TRUE.
  65 //              2. Input IE is an valid one.
  66 //
  67 void
  68 Dot11d_UpdateCountryIe(
  69         struct ieee80211_device *dev,
  70         u8 *pTaddr,
  71         u16     CoutryIeLen,
  72         u8 *pCoutryIe
  73         )
  74 {
  75         PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(dev);
  76         u8 i, j, NumTriples, MaxChnlNum;
  77         PCHNL_TXPOWER_TRIPLE pTriple;
  78
  79         if ((CoutryIeLen - 3)%3 != 0) {
  80                 printk("Dot11d_UpdateCountryIe(): Invalid country IE, skip it........1\n");
  81                 Dot11d_Reset(dev);
  82                 return;
  83         }
  84
  85         memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);
  86         memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);
  87         MaxChnlNum = 0;
  88         NumTriples = (CoutryIeLen - 3) / 3; // skip 3-byte country string.
  89         pTriple = (PCHNL_TXPOWER_TRIPLE)(pCoutryIe + 3);
  90         for (i = 0; i < NumTriples; i++) {
  91                 if (MaxChnlNum >= pTriple->FirstChnl) {
  92                 // It is not in a monotonically increasing order, so stop processing.
  93                         printk("Dot11d_UpdateCountryIe(): Invalid country IE, skip it........1\n");
  94                         Dot11d_Reset(dev);
  95                         return;
  96                 }
  97                 if (MAX_CHANNEL_NUMBER < (pTriple->FirstChnl + pTriple->NumChnls)) {
  98                 // It is not a valid set of channel id, so stop processing.
  99                         printk("Dot11d_UpdateCountryIe(): Invalid country IE, skip it........2\n");
 100                         Dot11d_Reset(dev);
 101                         return;
 102                 }
 103
 104                 for (j = 0 ; j < pTriple->NumChnls; j++) {
 105                         pDot11dInfo->channel_map[pTriple->FirstChnl + j] = 1;
 106                         pDot11dInfo->MaxTxPwrDbmList[pTriple->FirstChnl + j] = pTriple->MaxTxPowerInDbm;
 107                         MaxChnlNum = pTriple->FirstChnl + j;
 108                 }
 109
 110                 pTriple = (PCHNL_TXPOWER_TRIPLE)((u8 *)pTriple + 3);
 111         }
 112 #if 1
 113         //printk("Dot11d_UpdateCountryIe(): Channel List:\n");
 114         printk("Channel List:");
 115         for (i = 1; i <= MAX_CHANNEL_NUMBER; i++)
 116                 if (pDot11dInfo->channel_map[i] > 0)
 117                         printk(" %d", i);
 118         printk("\n");
 119 #endif
 120
 121         UPDATE_CIE_SRC(dev, pTaddr);
 122
 123         pDot11dInfo->CountryIeLen = CoutryIeLen;
 124         memcpy(pDot11dInfo->CountryIeBuf, pCoutryIe, CoutryIeLen);
 125         pDot11dInfo->State = DOT11D_STATE_LEARNED;
 126 }
 127
 128 u8
 129 DOT11D_GetMaxTxPwrInDbm(
 130         struct ieee80211_device *dev,
 131         u8 Channel
 132         )
 133 {
 134         PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(dev);
 135         u8 MaxTxPwrInDbm = 255;
 136
 137         if (MAX_CHANNEL_NUMBER < Channel) {
 138                 printk("DOT11D_GetMaxTxPwrInDbm(): Invalid Channel\n");
 139                 return MaxTxPwrInDbm;
 140         }
 141         if (pDot11dInfo->channel_map[Channel]) {
 142                 MaxTxPwrInDbm = pDot11dInfo->MaxTxPwrDbmList[Channel];
 143         }
 144
 145         return MaxTxPwrInDbm;
 146 }
 147
 148
 149 void
 150 DOT11D_ScanComplete(
 151         struct ieee80211_device *dev
 152         )
 153 {
 154         PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(dev);
 155
 156         switch (pDot11dInfo->State) {
 157         case DOT11D_STATE_LEARNED:
 158                 pDot11dInfo->State = DOT11D_STATE_DONE;
 159                 break;
 160
 161         case DOT11D_STATE_DONE:
 162                 if (GET_CIE_WATCHDOG(dev) == 0) {
 163                 // Reset country IE if previous one is gone.
 164                         Dot11d_Reset(dev);
 165                 }
 166                 break;
 167         case DOT11D_STATE_NONE:
 168                 break;
 169         }
 170 }
 171
 172 int IsLegalChannel(
 173         struct ieee80211_device *dev,
 174         u8 channel
 175 )
 176 {
 177         PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(dev);
 178
 179         if (MAX_CHANNEL_NUMBER < channel) {
 180                 printk("IsLegalChannel(): Invalid Channel\n");
 181                 return 0;
 182         }
 183         if (pDot11dInfo->channel_map[channel] > 0)
 184                 return 1;
 185         return 0;
 186 }
 187
 188 int ToLegalChannel(
 189         struct ieee80211_device *dev,
 190         u8 channel
 191 )
 192 {
 193         PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(dev);
 194         u8 default_chn = 0;
 195         u32 i = 0;
 196
 197         for (i = 1; i <= MAX_CHANNEL_NUMBER; i++) {
 198                 if (pDot11dInfo->channel_map[i] > 0) {
 199                         default_chn = i;
 200                         break;
 201                 }
 202         }
 203
 204         if (MAX_CHANNEL_NUMBER < channel) {
 205                 printk("IsLegalChannel(): Invalid Channel\n");
 206                 return default_chn;
 207         }
 208
 209         if (pDot11dInfo->channel_map[channel] > 0)
 210                 return channel;
 211
 212         return default_chn;
 213 }