rtl8192u/ieee80211/dot11d.c

0001 // SPDX-License-Identifier: GPL-2.0
0002 /* Implement 802.11d. */
0003
0004 #include "dot11d.h"
0005
0006 void rtl8192u_dot11d_init(struct ieee80211_device *ieee)
0007 {
0008     struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(ieee);
0009
0010     dot11d_info->dot11d_enabled = false;
0011
0012     dot11d_info->state = DOT11D_STATE_NONE;
0013     dot11d_info->country_ie_len = 0;
0014     memset(dot11d_info->channel_map, 0, MAX_CHANNEL_NUMBER + 1);
0015     memset(dot11d_info->max_tx_pwr_dbm_list, 0xFF, MAX_CHANNEL_NUMBER + 1);
0016     RESET_CIE_WATCHDOG(ieee);
0017 }
0018 EXPORT_SYMBOL(rtl8192u_dot11d_init);
0019
0020 /* Reset to the state as we are just entering a regulatory domain. */
0021 void dot11d_reset(struct ieee80211_device *ieee)
0022 {
0023     u32 i;
0024     struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(ieee);
0025     /* Clear old channel map */
0026     memset(dot11d_info->channel_map, 0, MAX_CHANNEL_NUMBER + 1);
0027     memset(dot11d_info->max_tx_pwr_dbm_list, 0xFF, MAX_CHANNEL_NUMBER + 1);
0028     /* Set new channel map */
0029     for (i = 1; i <= 11; i++)
0030         (dot11d_info->channel_map)[i] = 1;
0031
0032     for (i = 12; i <= 14; i++)
0033         (dot11d_info->channel_map)[i] = 2;
0034
0035     dot11d_info->state = DOT11D_STATE_NONE;
0036     dot11d_info->country_ie_len = 0;
0037     RESET_CIE_WATCHDOG(ieee);
0038 }
0039 EXPORT_SYMBOL(dot11d_reset);
0040
0041 /*
0042  * Update country IE from Beacon or Probe Resopnse and configure PHY for
0043  * operation in the regulatory domain.
0044  *
0045  * TODO: Configure Tx power.
0046  * Assumption:
0047  * 1. IS_DOT11D_ENABLE() is TRUE.
0048  * 2. Input IE is an valid one.
0049  */
0050 void dot11d_update_country_ie(struct ieee80211_device *dev, u8 *pTaddr,
0051                 u16 CoutryIeLen, u8 *pCoutryIe)
0052 {
0053     struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(dev);
0054     u8 i, j, NumTriples, MaxChnlNum;
0055     struct chnl_txpower_triple *pTriple;
0056
0057     memset(dot11d_info->channel_map, 0, MAX_CHANNEL_NUMBER + 1);
0058     memset(dot11d_info->max_tx_pwr_dbm_list, 0xFF, MAX_CHANNEL_NUMBER + 1);
0059     MaxChnlNum = 0;
0060     NumTriples = (CoutryIeLen - 3) / 3; /* skip 3-byte country string. */
0061     pTriple = (struct chnl_txpower_triple *)(pCoutryIe + 3);
0062     for (i = 0; i < NumTriples; i++) {
0063         if (MaxChnlNum >= pTriple->first_channel) {
0064             /* It is not in a monotonically increasing order, so
0065              * stop processing.
0066              */
0067             netdev_err(dev->dev, "%s: Invalid country IE, skip it 1\n", __func__);
0068             return;
0069         }
0070         if (MAX_CHANNEL_NUMBER < (pTriple->first_channel + pTriple->num_channels)) {
0071             /* It is not a valid set of channel id, so stop
0072              * processing.
0073              */
0074             netdev_err(dev->dev, "%s: Invalid country IE, skip it 2\n", __func__);
0075             return;
0076         }
0077
0078         for (j = 0; j < pTriple->num_channels; j++) {
0079             dot11d_info->channel_map[pTriple->first_channel + j] = 1;
0080             dot11d_info->max_tx_pwr_dbm_list[pTriple->first_channel + j] = pTriple->max_tx_pwr_dbm;
0081             MaxChnlNum = pTriple->first_channel + j;
0082         }
0083
0084         pTriple = (struct chnl_txpower_triple *)((u8 *)pTriple + 3);
0085     }
0086     netdev_info(dev->dev, "Channel List:");
0087     for (i = 1; i <= MAX_CHANNEL_NUMBER; i++)
0088         if (dot11d_info->channel_map[i] > 0)
0089             netdev_info(dev->dev, " %d", i);
0090     netdev_info(dev->dev, "\n");
0091
0092     UPDATE_CIE_SRC(dev, pTaddr);
0093
0094     dot11d_info->country_ie_len = CoutryIeLen;
0095     memcpy(dot11d_info->country_ie_buf, pCoutryIe, CoutryIeLen);
0096     dot11d_info->state = DOT11D_STATE_LEARNED;
0097 }
0098 EXPORT_SYMBOL(dot11d_update_country_ie);
0099
0100 u8 dot11d_get_max_tx_pwr_in_dbm(struct ieee80211_device *dev, u8 Channel)
0101 {
0102     struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(dev);
0103     u8 MaxTxPwrInDbm = 255;
0104
0105     if (Channel > MAX_CHANNEL_NUMBER) {
0106         netdev_err(dev->dev, "%s: Invalid Channel\n", __func__);
0107         return MaxTxPwrInDbm;
0108     }
0109     if (dot11d_info->channel_map[Channel])
0110         MaxTxPwrInDbm = dot11d_info->max_tx_pwr_dbm_list[Channel];
0111
0112     return MaxTxPwrInDbm;
0113 }
0114 EXPORT_SYMBOL(dot11d_get_max_tx_pwr_in_dbm);
0115
0116 void dot11d_scan_complete(struct ieee80211_device *dev)
0117 {
0118     struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(dev);
0119
0120     switch (dot11d_info->state) {
0121     case DOT11D_STATE_LEARNED:
0122         dot11d_info->state = DOT11D_STATE_DONE;
0123         break;
0124
0125     case DOT11D_STATE_DONE:
0126         if (GET_CIE_WATCHDOG(dev) == 0) {
0127             /* Reset country IE if previous one is gone. */
0128             dot11d_reset(dev);
0129         }
0130         break;
0131     case DOT11D_STATE_NONE:
0132         break;
0133     }
0134 }
0135 EXPORT_SYMBOL(dot11d_scan_complete);
0136
0137 int is_legal_channel(struct ieee80211_device *dev, u8 channel)
0138 {
0139     struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(dev);
0140
0141     if (channel > MAX_CHANNEL_NUMBER) {
0142         netdev_err(dev->dev, "%s: Invalid Channel\n", __func__);
0143         return 0;
0144     }
0145     if (dot11d_info->channel_map[channel] > 0)
0146         return 1;
0147     return 0;
0148 }
0149 EXPORT_SYMBOL(is_legal_channel);
0150
0151 int to_legal_channel(struct ieee80211_device *dev, u8 channel)
0152 {
0153     struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(dev);
0154     u8 default_chn = 0;
0155     u32 i = 0;
0156
0157     for (i = 1; i <= MAX_CHANNEL_NUMBER; i++) {
0158         if (dot11d_info->channel_map[i] > 0) {
0159             default_chn = i;
0160             break;
0161         }
0162     }
0163
0164     if (channel > MAX_CHANNEL_NUMBER) {
0165         netdev_err(dev->dev, "%s: Invalid Channel\n", __func__);
0166         return default_chn;
0167     }
0168
0169     if (dot11d_info->channel_map[channel] > 0)
0170         return channel;
0171
0172     return default_chn;
0173 }
0174 EXPORT_SYMBOL(to_legal_channel);