1 // SPDX-License-Identifier: GPL-2.0
2 /* Implement 802.11d. */
3
4 #include "dot11d.h"
5
rtl8192u_dot11d_init(struct ieee80211_device * ieee)6 void rtl8192u_dot11d_init(struct ieee80211_device *ieee)
7 {
8 struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(ieee);
9
10 dot11d_info->dot11d_enabled = false;
11
12 dot11d_info->state = DOT11D_STATE_NONE;
13 dot11d_info->country_ie_len = 0;
14 memset(dot11d_info->channel_map, 0, MAX_CHANNEL_NUMBER + 1);
15 memset(dot11d_info->max_tx_pwr_dbm_list, 0xFF, MAX_CHANNEL_NUMBER + 1);
16 RESET_CIE_WATCHDOG(ieee);
17
18 netdev_info(ieee->dev, "rtl8192u_dot11d_init()\n");
19 }
20 EXPORT_SYMBOL(rtl8192u_dot11d_init);
21
22 /* Reset to the state as we are just entering a regulatory domain. */
dot11d_reset(struct ieee80211_device * ieee)23 void dot11d_reset(struct ieee80211_device *ieee)
24 {
25 u32 i;
26 struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(ieee);
27 /* Clear old channel map */
28 memset(dot11d_info->channel_map, 0, MAX_CHANNEL_NUMBER + 1);
29 memset(dot11d_info->max_tx_pwr_dbm_list, 0xFF, MAX_CHANNEL_NUMBER + 1);
30 /* Set new channel map */
31 for (i = 1; i <= 11; i++)
32 (dot11d_info->channel_map)[i] = 1;
33
34 for (i = 12; i <= 14; i++)
35 (dot11d_info->channel_map)[i] = 2;
36
37 dot11d_info->state = DOT11D_STATE_NONE;
38 dot11d_info->country_ie_len = 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 */
dot11d_update_country_ie(struct ieee80211_device * dev,u8 * pTaddr,u16 CoutryIeLen,u8 * pCoutryIe)52 void dot11d_update_country_ie(struct ieee80211_device *dev, u8 *pTaddr,
53 u16 CoutryIeLen, u8 *pCoutryIe)
54 {
55 struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(dev);
56 u8 i, j, NumTriples, MaxChnlNum;
57 struct chnl_txpower_triple *pTriple;
58
59 memset(dot11d_info->channel_map, 0, MAX_CHANNEL_NUMBER + 1);
60 memset(dot11d_info->max_tx_pwr_dbm_list, 0xFF, MAX_CHANNEL_NUMBER + 1);
61 MaxChnlNum = 0;
62 NumTriples = (CoutryIeLen - 3) / 3; /* skip 3-byte country string. */
63 pTriple = (struct chnl_txpower_triple *)(pCoutryIe + 3);
64 for (i = 0; i < NumTriples; i++) {
65 if (MaxChnlNum >= pTriple->first_channel) {
66 /* It is not in a monotonically increasing order, so
67 * stop processing.
68 */
69 netdev_err(dev->dev, "dot11d_update_country_ie(): Invalid country IE, skip it........1\n");
70 return;
71 }
72 if (MAX_CHANNEL_NUMBER < (pTriple->first_channel + pTriple->num_channels)) {
73 /* It is not a valid set of channel id, so stop
74 * processing.
75 */
76 netdev_err(dev->dev, "dot11d_update_country_ie(): Invalid country IE, skip it........2\n");
77 return;
78 }
79
80 for (j = 0; j < pTriple->num_channels; j++) {
81 dot11d_info->channel_map[pTriple->first_channel + j] = 1;
82 dot11d_info->max_tx_pwr_dbm_list[pTriple->first_channel + j] = pTriple->max_tx_pwr_dbm;
83 MaxChnlNum = pTriple->first_channel + j;
84 }
85
86 pTriple = (struct chnl_txpower_triple *)((u8 *)pTriple + 3);
87 }
88 netdev_info(dev->dev, "Channel List:");
89 for (i = 1; i <= MAX_CHANNEL_NUMBER; i++)
90 if (dot11d_info->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 dot11d_info->country_ie_len = CoutryIeLen;
97 memcpy(dot11d_info->country_ie_buf, pCoutryIe, CoutryIeLen);
98 dot11d_info->state = DOT11D_STATE_LEARNED;
99 }
100 EXPORT_SYMBOL(dot11d_update_country_ie);
101
dot11d_get_max_tx_pwr_in_dbm(struct ieee80211_device * dev,u8 Channel)102 u8 dot11d_get_max_tx_pwr_in_dbm(struct ieee80211_device *dev, u8 Channel)
103 {
104 struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(dev);
105 u8 MaxTxPwrInDbm = 255;
106
107 if (Channel > MAX_CHANNEL_NUMBER) {
108 netdev_err(dev->dev, "dot11d_get_max_tx_pwr_in_dbm(): Invalid Channel\n");
109 return MaxTxPwrInDbm;
110 }
111 if (dot11d_info->channel_map[Channel])
112 MaxTxPwrInDbm = dot11d_info->max_tx_pwr_dbm_list[Channel];
113
114 return MaxTxPwrInDbm;
115 }
116 EXPORT_SYMBOL(dot11d_get_max_tx_pwr_in_dbm);
117
dot11d_scan_complete(struct ieee80211_device * dev)118 void dot11d_scan_complete(struct ieee80211_device *dev)
119 {
120 struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(dev);
121
122 switch (dot11d_info->state) {
123 case DOT11D_STATE_LEARNED:
124 dot11d_info->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_scan_complete);
138
is_legal_channel(struct ieee80211_device * dev,u8 channel)139 int is_legal_channel(struct ieee80211_device *dev, u8 channel)
140 {
141 struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(dev);
142
143 if (channel > MAX_CHANNEL_NUMBER) {
144 netdev_err(dev->dev, "is_legal_channel(): Invalid Channel\n");
145 return 0;
146 }
147 if (dot11d_info->channel_map[channel] > 0)
148 return 1;
149 return 0;
150 }
151 EXPORT_SYMBOL(is_legal_channel);
152
to_legal_channel(struct ieee80211_device * dev,u8 channel)153 int to_legal_channel(struct ieee80211_device *dev, u8 channel)
154 {
155 struct rt_dot11d_info *dot11d_info = 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 (dot11d_info->channel_map[i] > 0) {
161 default_chn = i;
162 break;
163 }
164 }
165
166 if (channel > MAX_CHANNEL_NUMBER) {
167 netdev_err(dev->dev, "is_legal_channel(): Invalid Channel\n");
168 return default_chn;
169 }
170
171 if (dot11d_info->channel_map[channel] > 0)
172 return channel;
173
174 return default_chn;
175 }
176 EXPORT_SYMBOL(to_legal_channel);
177