1 /******************************************************************************
2 * Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
3 *
4 * This program is distributed in the hope that it will be useful, but WITHOUT
5 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
6 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
7 * more details.
8 *
9 * The full GNU General Public License is included in this distribution in the
10 * file called LICENSE.
11 *
12 * Contact Information:
13 * wlanfae <wlanfae@realtek.com>
14 ******************************************************************************/
15 #include "dot11d.h"
16
17 struct channel_list {
18 u8 Channel[32];
19 u8 Len;
20 };
21
22 static struct channel_list ChannelPlan[] = {
23 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64,
24 149, 153, 157, 161, 165}, 24},
25 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11}, 11},
26 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56,
27 60, 64}, 21},
28 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
29 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
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, 36, 40, 44, 48, 52,
33 56, 60, 64}, 22},
34 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
35 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
36 56, 60, 64}, 22},
37 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52,
38 56, 60, 64}, 22},
39 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14},
40 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
41 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52,
42 56, 60, 64}, 21}
43 };
44
dot11d_init(struct rtllib_device * ieee)45 void dot11d_init(struct rtllib_device *ieee)
46 {
47 struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(ieee);
48
49 pDot11dInfo->bEnabled = false;
50
51 pDot11dInfo->State = DOT11D_STATE_NONE;
52 pDot11dInfo->CountryIeLen = 0;
53 memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);
54 memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);
55 RESET_CIE_WATCHDOG(ieee);
56
57 }
58 EXPORT_SYMBOL(dot11d_init);
59
Dot11d_Channelmap(u8 channel_plan,struct rtllib_device * ieee)60 void Dot11d_Channelmap(u8 channel_plan, struct rtllib_device *ieee)
61 {
62 int i, max_chan = 14, min_chan = 1;
63
64 ieee->bGlobalDomain = false;
65
66 if (ChannelPlan[channel_plan].Len != 0) {
67 memset(GET_DOT11D_INFO(ieee)->channel_map, 0,
68 sizeof(GET_DOT11D_INFO(ieee)->channel_map));
69 for (i = 0; i < ChannelPlan[channel_plan].Len; i++) {
70 if (ChannelPlan[channel_plan].Channel[i] < min_chan ||
71 ChannelPlan[channel_plan].Channel[i] > max_chan)
72 break;
73 GET_DOT11D_INFO(ieee)->channel_map[ChannelPlan
74 [channel_plan].Channel[i]] = 1;
75 }
76 }
77
78 switch (channel_plan) {
79 case COUNTRY_CODE_GLOBAL_DOMAIN:
80 ieee->bGlobalDomain = true;
81 for (i = 12; i <= 14; i++)
82 GET_DOT11D_INFO(ieee)->channel_map[i] = 2;
83 ieee->IbssStartChnl = 10;
84 ieee->ibss_maxjoin_chal = 11;
85 break;
86
87 case COUNTRY_CODE_WORLD_WIDE_13:
88 for (i = 12; i <= 13; i++)
89 GET_DOT11D_INFO(ieee)->channel_map[i] = 2;
90 ieee->IbssStartChnl = 10;
91 ieee->ibss_maxjoin_chal = 11;
92 break;
93
94 default:
95 ieee->IbssStartChnl = 1;
96 ieee->ibss_maxjoin_chal = 14;
97 break;
98 }
99 }
100 EXPORT_SYMBOL(Dot11d_Channelmap);
101
102
Dot11d_Reset(struct rtllib_device * ieee)103 void Dot11d_Reset(struct rtllib_device *ieee)
104 {
105 struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(ieee);
106 u32 i;
107
108 memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);
109 memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);
110 for (i = 1; i <= 11; i++)
111 (pDot11dInfo->channel_map)[i] = 1;
112 for (i = 12; i <= 14; i++)
113 (pDot11dInfo->channel_map)[i] = 2;
114 pDot11dInfo->State = DOT11D_STATE_NONE;
115 pDot11dInfo->CountryIeLen = 0;
116 RESET_CIE_WATCHDOG(ieee);
117 }
118
Dot11d_UpdateCountryIe(struct rtllib_device * dev,u8 * pTaddr,u16 CoutryIeLen,u8 * pCoutryIe)119 void Dot11d_UpdateCountryIe(struct rtllib_device *dev, u8 *pTaddr,
120 u16 CoutryIeLen, u8 *pCoutryIe)
121 {
122 struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(dev);
123 u8 i, j, NumTriples, MaxChnlNum;
124 struct chnl_txpow_triple *pTriple;
125
126 memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);
127 memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);
128 MaxChnlNum = 0;
129 NumTriples = (CoutryIeLen - 3) / 3;
130 pTriple = (struct chnl_txpow_triple *)(pCoutryIe + 3);
131 for (i = 0; i < NumTriples; i++) {
132 if (MaxChnlNum >= pTriple->FirstChnl) {
133 netdev_info(dev->dev, "Dot11d_UpdateCountryIe(): Invalid country IE, skip it........1\n");
134 return;
135 }
136 if (MAX_CHANNEL_NUMBER < (pTriple->FirstChnl +
137 pTriple->NumChnls)) {
138 netdev_info(dev->dev, "Dot11d_UpdateCountryIe(): Invalid country IE, skip it........2\n");
139 return;
140 }
141
142 for (j = 0; j < pTriple->NumChnls; j++) {
143 pDot11dInfo->channel_map[pTriple->FirstChnl + j] = 1;
144 pDot11dInfo->MaxTxPwrDbmList[pTriple->FirstChnl + j] =
145 pTriple->MaxTxPowerInDbm;
146 MaxChnlNum = pTriple->FirstChnl + j;
147 }
148
149 pTriple = (struct chnl_txpow_triple *)((u8 *)pTriple + 3);
150 }
151
152 UPDATE_CIE_SRC(dev, pTaddr);
153
154 pDot11dInfo->CountryIeLen = CoutryIeLen;
155 memcpy(pDot11dInfo->CountryIeBuf, pCoutryIe, CoutryIeLen);
156 pDot11dInfo->State = DOT11D_STATE_LEARNED;
157 }
158
DOT11D_ScanComplete(struct rtllib_device * dev)159 void DOT11D_ScanComplete(struct rtllib_device *dev)
160 {
161 struct rt_dot11d_info *pDot11dInfo = GET_DOT11D_INFO(dev);
162
163 switch (pDot11dInfo->State) {
164 case DOT11D_STATE_LEARNED:
165 pDot11dInfo->State = DOT11D_STATE_DONE;
166 break;
167 case DOT11D_STATE_DONE:
168 Dot11d_Reset(dev);
169 break;
170 case DOT11D_STATE_NONE:
171 break;
172 }
173 }
174