Commit | Line | Data |
---|---|---|
78de2c06 LF |
1 | /****************************************************************************** |
2 | * | |
3 | * Copyright(c) 2009-2010 Realtek Corporation. | |
4 | * | |
5 | * This program is free software; you can redistribute it and/or modify it | |
6 | * under the terms of version 2 of the GNU General Public License as | |
7 | * published by the Free Software Foundation. | |
8 | * | |
9 | * This program is distributed in the hope that it will be useful, but WITHOUT | |
10 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
11 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
12 | * more details. | |
13 | * | |
14 | * The full GNU General Public License is included in this distribution in the | |
15 | * file called LICENSE. | |
16 | * | |
17 | * Contact Information: | |
18 | * wlanfae <wlanfae@realtek.com> | |
19 | * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, | |
20 | * Hsinchu 300, Taiwan. | |
21 | * | |
22 | * Larry Finger <Larry.Finger@lwfinger.net> | |
23 | * | |
24 | *****************************************************************************/ | |
25 | #include "wifi.h" | |
26 | #include "cam.h" | |
27 | ||
28 | void rtl92e_cam_reset_sec_info(struct ieee80211_hw *hw) | |
29 | { | |
30 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
31 | ||
32 | rtlpriv->sec.use_defaultkey = false; | |
33 | rtlpriv->sec.pairwise_enc_algorithm = NO_ENCRYPTION; | |
34 | rtlpriv->sec.group_enc_algorithm = NO_ENCRYPTION; | |
35 | memset(rtlpriv->sec.key_buf, 0, KEY_BUF_SIZE * MAX_KEY_LEN); | |
36 | memset(rtlpriv->sec.key_len, 0, KEY_BUF_SIZE); | |
37 | rtlpriv->sec.pairwise_key = NULL; | |
38 | } | |
39 | ||
40 | static void rtl_cam_program_entry(struct ieee80211_hw *hw, u32 entry_no, | |
41 | u8 *mac_addr, u8 *key_cont_128, u16 us_config) | |
42 | { | |
43 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
44 | ||
45 | u32 target_command; | |
46 | u32 target_content = 0; | |
47 | u8 entry_i; | |
48 | ||
49 | RT_PRINT_DATA(rtlpriv, COMP_SEC, DBG_DMESG, "Key content:", | |
50 | key_cont_128, 16); | |
51 | ||
52 | for (entry_i = 0; entry_i < CAM_CONTENT_COUNT; entry_i++) { | |
53 | target_command = entry_i + CAM_CONTENT_COUNT * entry_no; | |
54 | target_command = target_command | BIT(31) | BIT(16); | |
55 | ||
56 | if (entry_i == 0) { | |
57 | target_content = (u32) (*(mac_addr + 0)) << 16 | | |
58 | (u32) (*(mac_addr + 1)) << 24 | (u32) us_config; | |
59 | ||
60 | rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[WCAMI], | |
61 | target_content); | |
62 | rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[RWCAM], | |
63 | target_command); | |
64 | ||
65 | RT_TRACE(COMP_SEC, DBG_LOUD, | |
66 | ("WRITE %x: %x\n", | |
67 | rtlpriv->cfg->maps[WCAMI], target_content)); | |
68 | RT_TRACE(COMP_SEC, DBG_LOUD, | |
69 | ("The Key ID is %d\n", entry_no)); | |
70 | RT_TRACE(COMP_SEC, DBG_LOUD, | |
71 | ("WRITE %x: %x\n", | |
72 | rtlpriv->cfg->maps[RWCAM], target_command)); | |
73 | } else if (entry_i == 1) { | |
74 | target_content = (u32) (*(mac_addr + 5)) << 24 | | |
75 | (u32) (*(mac_addr + 4)) << 16 | | |
76 | (u32) (*(mac_addr + 3)) << 8 | | |
77 | (u32) (*(mac_addr + 2)); | |
78 | ||
79 | rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[WCAMI], | |
80 | target_content); | |
81 | rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[RWCAM], | |
82 | target_command); | |
83 | ||
84 | RT_TRACE(COMP_SEC, DBG_LOUD, | |
85 | ("WRITE A4: %x\n", target_content)); | |
86 | RT_TRACE(COMP_SEC, DBG_LOUD, | |
87 | ("WRITE A0: %x\n", target_command)); | |
88 | } else { | |
89 | target_content = | |
90 | (u32) (*(key_cont_128 + (entry_i * 4 - 8) + 3)) << | |
91 | 24 | (u32) (*(key_cont_128 + (entry_i * 4 - 8) + 2)) | |
92 | << 16 | | |
93 | (u32) (*(key_cont_128 + (entry_i * 4 - 8) + 1)) << 8 | |
94 | | (u32) (*(key_cont_128 + (entry_i * 4 - 8) + 0)); | |
95 | ||
96 | rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[WCAMI], | |
97 | target_content); | |
98 | rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[RWCAM], | |
99 | target_command); | |
100 | udelay(100); | |
101 | ||
102 | RT_TRACE(COMP_SEC, DBG_LOUD, | |
103 | ("WRITE A4: %x\n", target_content)); | |
104 | RT_TRACE(COMP_SEC, DBG_LOUD, | |
105 | ("WRITE A0: %x\n", target_command)); | |
106 | } | |
107 | } | |
108 | ||
109 | RT_TRACE(COMP_SEC, DBG_LOUD, | |
110 | ("after set key, usconfig:%x\n", us_config)); | |
111 | } | |
112 | ||
113 | u8 stg_rtl_cam_add_one_entry(struct ieee80211_hw *hw, u8 *mac_addr, | |
114 | u32 ul_key_id, u32 ul_entry_idx, u32 ul_enc_alg, | |
115 | u32 ul_default_key, u8 *key_content) | |
116 | { | |
117 | u32 us_config; | |
118 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
119 | ||
120 | RT_TRACE(COMP_SEC, DBG_DMESG, | |
121 | ("EntryNo:%x, ulKeyId=%x, ulEncAlg=%x, ulUseDK=%x MacAddr %pM\n", | |
122 | ul_entry_idx, ul_key_id, ul_enc_alg, | |
123 | ul_default_key, mac_addr)); | |
124 | ||
125 | if (ul_key_id == TOTAL_CAM_ENTRY) { | |
126 | RT_TRACE(COMP_ERR, DBG_WARNING, | |
127 | ("ulKeyId exceed!\n")); | |
128 | return 0; | |
129 | } | |
130 | ||
131 | if (ul_default_key == 1) | |
132 | us_config = CFG_VALID | ((u16) (ul_enc_alg) << 2); | |
133 | else | |
134 | us_config = CFG_VALID | ((ul_enc_alg) << 2) | ul_key_id; | |
135 | ||
136 | rtl_cam_program_entry(hw, ul_entry_idx, mac_addr, | |
137 | (u8 *)key_content, us_config); | |
138 | ||
139 | RT_TRACE(COMP_SEC, DBG_DMESG, ("end\n")); | |
140 | ||
141 | return 1; | |
142 | } | |
143 | EXPORT_SYMBOL(stg_rtl_cam_add_one_entry); | |
144 | ||
145 | int stg_rtl_cam_delete_one_entry(struct ieee80211_hw *hw, | |
146 | u8 *mac_addr, u32 ul_key_id) | |
147 | { | |
148 | u32 ul_command; | |
149 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
150 | ||
151 | RT_TRACE(COMP_SEC, DBG_DMESG, ("key_idx:%d\n", ul_key_id)); | |
152 | ||
153 | ul_command = ul_key_id * CAM_CONTENT_COUNT; | |
154 | ul_command = ul_command | BIT(31) | BIT(16); | |
155 | ||
156 | rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[WCAMI], 0); | |
157 | rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[RWCAM], ul_command); | |
158 | ||
159 | RT_TRACE(COMP_SEC, DBG_DMESG, | |
160 | ("stg_rtl_cam_delete_one_entry(): WRITE A4: %x\n", 0)); | |
161 | RT_TRACE(COMP_SEC, DBG_DMESG, | |
162 | ("stg_rtl_cam_delete_one_entry(): WRITE A0: %x\n", | |
163 | ul_command)); | |
164 | return 0; | |
165 | } | |
166 | EXPORT_SYMBOL(stg_rtl_cam_delete_one_entry); | |
167 | ||
168 | void stg_rtl_cam_reset_all_entry(struct ieee80211_hw *hw) | |
169 | { | |
170 | u32 ul_command; | |
171 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
172 | ||
173 | ul_command = BIT(31) | BIT(30); | |
174 | rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[RWCAM], ul_command); | |
175 | } | |
176 | EXPORT_SYMBOL(stg_rtl_cam_reset_all_entry); | |
177 | ||
178 | void stg_rtl_cam_mark_invalid(struct ieee80211_hw *hw, u8 uc_index) | |
179 | { | |
180 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
181 | ||
182 | u32 ul_command; | |
183 | u32 ul_content; | |
184 | u32 ul_enc_algo = rtlpriv->cfg->maps[SEC_CAM_AES]; | |
185 | ||
186 | switch (rtlpriv->sec.pairwise_enc_algorithm) { | |
187 | case WEP40_ENCRYPTION: | |
188 | ul_enc_algo = rtlpriv->cfg->maps[SEC_CAM_WEP40]; | |
189 | break; | |
190 | case WEP104_ENCRYPTION: | |
191 | ul_enc_algo = rtlpriv->cfg->maps[SEC_CAM_WEP104]; | |
192 | break; | |
193 | case TKIP_ENCRYPTION: | |
194 | ul_enc_algo = rtlpriv->cfg->maps[SEC_CAM_TKIP]; | |
195 | break; | |
196 | case AESCCMP_ENCRYPTION: | |
197 | ul_enc_algo = rtlpriv->cfg->maps[SEC_CAM_AES]; | |
198 | break; | |
199 | default: | |
200 | ul_enc_algo = rtlpriv->cfg->maps[SEC_CAM_AES]; | |
201 | } | |
202 | ||
203 | ul_content = (uc_index & 3) | ((u16) (ul_enc_algo) << 2); | |
204 | ||
205 | ul_content |= BIT(15); | |
206 | ul_command = CAM_CONTENT_COUNT * uc_index; | |
207 | ul_command = ul_command | BIT(31) | BIT(16); | |
208 | ||
209 | rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[WCAMI], ul_content); | |
210 | rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[RWCAM], ul_command); | |
211 | ||
212 | RT_TRACE(COMP_SEC, DBG_DMESG, | |
213 | ("stg_rtl_cam_mark_invalid(): WRITE A4: %x\n", ul_content)); | |
214 | RT_TRACE(COMP_SEC, DBG_DMESG, | |
215 | ("stg_rtl_cam_mark_invalid(): WRITE A0: %x\n", ul_command)); | |
216 | } | |
217 | EXPORT_SYMBOL(stg_rtl_cam_mark_invalid); | |
218 | ||
219 | void stg_rtl_cam_empty_entry(struct ieee80211_hw *hw, u8 uc_index) | |
220 | { | |
221 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
222 | ||
223 | u32 ul_command; | |
224 | u32 ul_content; | |
225 | u32 ul_encalgo = rtlpriv->cfg->maps[SEC_CAM_AES]; | |
226 | u8 entry_i; | |
227 | ||
228 | switch (rtlpriv->sec.pairwise_enc_algorithm) { | |
229 | case WEP40_ENCRYPTION: | |
230 | ul_encalgo = rtlpriv->cfg->maps[SEC_CAM_WEP40]; | |
231 | break; | |
232 | case WEP104_ENCRYPTION: | |
233 | ul_encalgo = rtlpriv->cfg->maps[SEC_CAM_WEP104]; | |
234 | break; | |
235 | case TKIP_ENCRYPTION: | |
236 | ul_encalgo = rtlpriv->cfg->maps[SEC_CAM_TKIP]; | |
237 | break; | |
238 | case AESCCMP_ENCRYPTION: | |
239 | ul_encalgo = rtlpriv->cfg->maps[SEC_CAM_AES]; | |
240 | break; | |
241 | default: | |
242 | ul_encalgo = rtlpriv->cfg->maps[SEC_CAM_AES]; | |
243 | } | |
244 | ||
245 | for (entry_i = 0; entry_i < CAM_CONTENT_COUNT; entry_i++) { | |
246 | if (entry_i == 0) { | |
247 | ul_content = | |
248 | (uc_index & 0x03) | ((u16) (ul_encalgo) << 2); | |
249 | ul_content |= BIT(15); | |
250 | ||
251 | } else { | |
252 | ul_content = 0; | |
253 | } | |
254 | ||
255 | ul_command = CAM_CONTENT_COUNT * uc_index + entry_i; | |
256 | ul_command = ul_command | BIT(31) | BIT(16); | |
257 | ||
258 | rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[WCAMI], ul_content); | |
259 | rtl_write_dword(rtlpriv, rtlpriv->cfg->maps[RWCAM], ul_command); | |
260 | ||
261 | RT_TRACE(COMP_SEC, DBG_LOUD, | |
262 | ("stg_rtl_cam_empty_entry(): WRITE A4: %x\n", | |
263 | ul_content)); | |
264 | RT_TRACE(COMP_SEC, DBG_LOUD, | |
265 | ("stg_rtl_cam_empty_entry(): WRITE A0: %x\n", | |
266 | ul_command)); | |
267 | } | |
268 | } | |
269 | EXPORT_SYMBOL(stg_rtl_cam_empty_entry); | |
270 | ||
271 | u8 stg_rtl_cam_get_free_entry(struct ieee80211_hw *hw, u8 *sta_addr) | |
272 | { | |
273 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
274 | u32 bitmap = (rtlpriv->sec.hwsec_cam_bitmap) >> 4; | |
275 | u8 entry_idx = 0; | |
276 | u8 i, *addr; | |
277 | ||
278 | if (!sta_addr) { | |
279 | RT_TRACE(COMP_SEC, DBG_EMERG, | |
280 | ("sta_addr is NULL\n")); | |
281 | return TOTAL_CAM_ENTRY; | |
282 | } | |
283 | /* Does STA already exist? */ | |
284 | for (i = 4; i < TOTAL_CAM_ENTRY; i++) { | |
285 | addr = rtlpriv->sec.hwsec_cam_sta_addr[i]; | |
286 | if (memcmp(addr, sta_addr, ETH_ALEN) == 0) | |
287 | return i; | |
288 | } | |
289 | /* Get a free CAM entry. */ | |
290 | for (entry_idx = 4; entry_idx < TOTAL_CAM_ENTRY; entry_idx++) { | |
291 | if ((bitmap & BIT(0)) == 0) { | |
292 | RT_TRACE(COMP_SEC, DBG_EMERG, | |
293 | ("-----hwsec_cam_bitmap: 0x%x entry_idx=%d\n", | |
294 | rtlpriv->sec.hwsec_cam_bitmap, entry_idx)); | |
295 | rtlpriv->sec.hwsec_cam_bitmap |= BIT(0) << entry_idx; | |
296 | memcpy(rtlpriv->sec.hwsec_cam_sta_addr[entry_idx], | |
297 | sta_addr, ETH_ALEN); | |
298 | return entry_idx; | |
299 | } | |
300 | bitmap = bitmap >> 1; | |
301 | } | |
302 | return TOTAL_CAM_ENTRY; | |
303 | } | |
304 | EXPORT_SYMBOL(stg_rtl_cam_get_free_entry); | |
305 | ||
306 | void stg_rtl_cam_del_entry(struct ieee80211_hw *hw, u8 *sta_addr) | |
307 | { | |
308 | struct rtl_priv *rtlpriv = rtl_priv(hw); | |
309 | u32 bitmap; | |
310 | u8 i, *addr; | |
311 | ||
312 | if (NULL == sta_addr) { | |
313 | RT_TRACE(COMP_SEC, DBG_EMERG, | |
314 | ("sta_addr is NULL.\n")); | |
315 | return; | |
316 | } | |
317 | ||
318 | if (is_zero_ether_addr(sta_addr)) { | |
319 | RT_TRACE(COMP_SEC, DBG_EMERG, | |
320 | ("sta_addr is 00:00:00:00:00:00.\n")); | |
321 | return; | |
322 | } | |
323 | /* Does STA already exist? */ | |
324 | for (i = 4; i < TOTAL_CAM_ENTRY; i++) { | |
325 | addr = rtlpriv->sec.hwsec_cam_sta_addr[i]; | |
326 | bitmap = (rtlpriv->sec.hwsec_cam_bitmap) >> i; | |
327 | if (((bitmap & BIT(0)) == BIT(0)) && | |
328 | (memcmp(addr, sta_addr, ETH_ALEN) == 0)) { | |
329 | /* Remove from HW Security CAM */ | |
330 | memset(rtlpriv->sec.hwsec_cam_sta_addr[i], 0, ETH_ALEN); | |
331 | rtlpriv->sec.hwsec_cam_bitmap &= ~(BIT(0) << i); | |
332 | pr_info("&&&&&&&&&del entry %d\n", i); | |
333 | } | |
334 | } | |
335 | return; | |
336 | } | |
337 | EXPORT_SYMBOL(stg_rtl_cam_del_entry); |