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