1 // SPDX-License-Identifier: GPL-2.0
2 /******************************************************************************
3 * Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
4 *
5 * Contact Information:
6 * wlanfae <wlanfae@realtek.com>
7 ******************************************************************************/
8 #include "dot11d.h"
9
10 struct channel_list {
11 u8 channel[32];
12 u8 len;
13 };
14
15 static struct channel_list channel_array[] = {
16 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64,
17 149, 153, 157, 161, 165}, 24},
18 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11}, 11},
19 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56,
20 60, 64}, 21},
21 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
22 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
23 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
24 56, 60, 64}, 22},
25 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
26 56, 60, 64}, 22},
27 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
28 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
29 56, 60, 64}, 22},
30 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
31 56, 60, 64}, 22},
32 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14},
33 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
34 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52,
35 56, 60, 64}, 21}
36 };
37
dot11d_init(struct rtllib_device * ieee)38 void dot11d_init(struct rtllib_device *ieee)
39 {
40 struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(ieee);
41
42 dot11d_info->enabled = false;
43
44 dot11d_info->state = DOT11D_STATE_NONE;
45 dot11d_info->country_len = 0;
46 memset(dot11d_info->channel_map, 0, MAX_CHANNEL_NUMBER + 1);
47 memset(dot11d_info->max_tx_power_list, 0xFF, MAX_CHANNEL_NUMBER + 1);
48 RESET_CIE_WATCHDOG(ieee);
49 }
50 EXPORT_SYMBOL(dot11d_init);
51
dot11d_channel_map(u8 channel_plan,struct rtllib_device * ieee)52 void dot11d_channel_map(u8 channel_plan, struct rtllib_device *ieee)
53 {
54 int i, max_chan = 14, min_chan = 1;
55
56 ieee->global_domain = false;
57
58 if (channel_array[channel_plan].len != 0) {
59 memset(GET_DOT11D_INFO(ieee)->channel_map, 0,
60 sizeof(GET_DOT11D_INFO(ieee)->channel_map));
61 for (i = 0; i < channel_array[channel_plan].len; i++) {
62 if (channel_array[channel_plan].channel[i] < min_chan ||
63 channel_array[channel_plan].channel[i] > max_chan)
64 break;
65 GET_DOT11D_INFO(ieee)->channel_map[channel_array
66 [channel_plan].channel[i]] = 1;
67 }
68 }
69
70 switch (channel_plan) {
71 case COUNTRY_CODE_GLOBAL_DOMAIN:
72 ieee->global_domain = true;
73 for (i = 12; i <= 14; i++)
74 GET_DOT11D_INFO(ieee)->channel_map[i] = 2;
75 ieee->bss_start_channel = 10;
76 ieee->ibss_maxjoin_chal = 11;
77 break;
78
79 case COUNTRY_CODE_WORLD_WIDE_13:
80 for (i = 12; i <= 13; i++)
81 GET_DOT11D_INFO(ieee)->channel_map[i] = 2;
82 ieee->bss_start_channel = 10;
83 ieee->ibss_maxjoin_chal = 11;
84 break;
85
86 default:
87 ieee->bss_start_channel = 1;
88 ieee->ibss_maxjoin_chal = 14;
89 break;
90 }
91 }
92 EXPORT_SYMBOL(dot11d_channel_map);
93
dot11d_reset(struct rtllib_device * ieee)94 void dot11d_reset(struct rtllib_device *ieee)
95 {
96 struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(ieee);
97 u32 i;
98
99 memset(dot11d_info->channel_map, 0, MAX_CHANNEL_NUMBER + 1);
100 memset(dot11d_info->max_tx_power_list, 0xFF, MAX_CHANNEL_NUMBER + 1);
101 for (i = 1; i <= 11; i++)
102 (dot11d_info->channel_map)[i] = 1;
103 for (i = 12; i <= 14; i++)
104 (dot11d_info->channel_map)[i] = 2;
105 dot11d_info->state = DOT11D_STATE_NONE;
106 dot11d_info->country_len = 0;
107 RESET_CIE_WATCHDOG(ieee);
108 }
109
dot11d_update_country(struct rtllib_device * dev,u8 * address,u16 country_len,u8 * country)110 void dot11d_update_country(struct rtllib_device *dev, u8 *address,
111 u16 country_len, u8 *country)
112 {
113 struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(dev);
114 u8 i, j, number_of_triples, max_channel_number;
115 struct chnl_txpow_triple *triple;
116
117 memset(dot11d_info->channel_map, 0, MAX_CHANNEL_NUMBER + 1);
118 memset(dot11d_info->max_tx_power_list, 0xFF, MAX_CHANNEL_NUMBER + 1);
119 max_channel_number = 0;
120 number_of_triples = (country_len - 3) / 3;
121 triple = (struct chnl_txpow_triple *)(country + 3);
122 for (i = 0; i < number_of_triples; i++) {
123 if (max_channel_number >= triple->first_channel) {
124 netdev_info(dev->dev,
125 "%s: Invalid country IE, skip it......1\n",
126 __func__);
127 return;
128 }
129 if (MAX_CHANNEL_NUMBER < (triple->first_channel +
130 triple->num_channels)) {
131 netdev_info(dev->dev,
132 "%s: Invalid country IE, skip it......2\n",
133 __func__);
134 return;
135 }
136
137 for (j = 0; j < triple->num_channels; j++) {
138 dot11d_info->channel_map[triple->first_channel + j] = 1;
139 dot11d_info->max_tx_power_list[triple->first_channel + j] =
140 triple->max_tx_power;
141 max_channel_number = triple->first_channel + j;
142 }
143
144 triple = (struct chnl_txpow_triple *)((u8 *)triple + 3);
145 }
146
147 UPDATE_CIE_SRC(dev, address);
148
149 dot11d_info->country_len = country_len;
150 memcpy(dot11d_info->country_buffer, country, country_len);
151 dot11d_info->state = DOT11D_STATE_LEARNED;
152 }
153
dot11d_scan_complete(struct rtllib_device * dev)154 void dot11d_scan_complete(struct rtllib_device *dev)
155 {
156 struct rt_dot11d_info *dot11d_info = GET_DOT11D_INFO(dev);
157
158 switch (dot11d_info->state) {
159 case DOT11D_STATE_LEARNED:
160 dot11d_info->state = DOT11D_STATE_DONE;
161 break;
162 case DOT11D_STATE_DONE:
163 dot11d_reset(dev);
164 break;
165 case DOT11D_STATE_NONE:
166 break;
167 }
168 }
169