]>
Commit | Line | Data |
---|---|---|
2cb7cef9 BS |
1 | From a2c94c94994d49114faad8439d7e5c90cae47cae Mon Sep 17 00:00:00 2001 |
2 | From: Greg Kroah-Hartman <gregkh@suse.de> | |
3 | Date: Thu, 4 Dec 2008 20:01:41 -0800 | |
4 | Subject: Staging: add rtl8187se driver | |
5 | Patch-mainline: 2.6.29 | |
6 | ||
7 | From: Greg Kroah-Hartman <gregkh@suse.de> | |
8 | ||
9 | This is a driver for the Ralink 8187 "SE" wireless PCI devices | |
10 | in some netbook computers (MSI Wind, and others). It includes | |
11 | its own copy of the ieee80211 stack, but it is compiled into | |
12 | the driver to prevend duplicate symbol issues. | |
13 | ||
14 | This version comes from Ralink with no authorship, but it is based | |
15 | on an old version of the rtl8180 driver from Andrea Merello. It was | |
16 | hacked up a bit to get it to build properly within the kernel tree and | |
17 | to properly handle the merged wireless stack within the driver. | |
18 | ||
19 | Cc: Andrea Merello <andreamrl@tiscali.it> | |
20 | Cc: linux-wireless <linux-wireless@vger.kernel.org> | |
21 | Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de> | |
22 | ||
23 | --- | |
24 | drivers/staging/Kconfig | 2 | |
25 | drivers/staging/Makefile | 1 | |
26 | drivers/staging/rtl8187se/Kconfig | 5 | |
27 | drivers/staging/rtl8187se/Makefile | 55 | |
28 | drivers/staging/rtl8187se/dot11d.h | 101 | |
29 | drivers/staging/rtl8187se/ieee80211.h | 1755 +++ | |
30 | drivers/staging/rtl8187se/ieee80211/dot11d.c | 246 | |
31 | drivers/staging/rtl8187se/ieee80211/dot11d.h | 102 | |
32 | drivers/staging/rtl8187se/ieee80211/ieee80211.h | 1755 +++ | |
33 | drivers/staging/rtl8187se/ieee80211/ieee80211_crypt.c | 265 | |
34 | drivers/staging/rtl8187se/ieee80211/ieee80211_crypt.h | 86 | |
35 | drivers/staging/rtl8187se/ieee80211/ieee80211_crypt_ccmp.c | 533 + | |
36 | drivers/staging/rtl8187se/ieee80211/ieee80211_crypt_tkip.c | 1001 + | |
37 | drivers/staging/rtl8187se/ieee80211/ieee80211_crypt_wep.c | 394 | |
38 | drivers/staging/rtl8187se/ieee80211/ieee80211_module.c | 299 | |
39 | drivers/staging/rtl8187se/ieee80211/ieee80211_rx.c | 1971 +++ | |
40 | drivers/staging/rtl8187se/ieee80211/ieee80211_softmac.c | 4029 +++++++ | |
41 | drivers/staging/rtl8187se/ieee80211/ieee80211_softmac_wx.c | 602 + | |
42 | drivers/staging/rtl8187se/ieee80211/ieee80211_tx.c | 828 + | |
43 | drivers/staging/rtl8187se/ieee80211/ieee80211_wx.c | 884 + | |
44 | drivers/staging/rtl8187se/ieee80211/internal.h | 115 | |
45 | drivers/staging/rtl8187se/ieee80211/rtl_crypto.h | 399 | |
46 | drivers/staging/rtl8187se/ieee80211_crypt.h | 86 | |
47 | drivers/staging/rtl8187se/r8180.h | 761 + | |
48 | drivers/staging/rtl8187se/r8180_93cx6.c | 146 | |
49 | drivers/staging/rtl8187se/r8180_93cx6.h | 59 | |
50 | drivers/staging/rtl8187se/r8180_core.c | 6828 +++++++++++++ | |
51 | drivers/staging/rtl8187se/r8180_dm.c | 1725 +++ | |
52 | drivers/staging/rtl8187se/r8180_dm.h | 41 | |
53 | drivers/staging/rtl8187se/r8180_gct.c | 296 | |
54 | drivers/staging/rtl8187se/r8180_gct.h | 25 | |
55 | drivers/staging/rtl8187se/r8180_hw.h | 956 + | |
56 | drivers/staging/rtl8187se/r8180_max2820.c | 240 | |
57 | drivers/staging/rtl8187se/r8180_max2820.h | 21 | |
58 | drivers/staging/rtl8187se/r8180_pm.c | 90 | |
59 | drivers/staging/rtl8187se/r8180_pm.h | 28 | |
60 | drivers/staging/rtl8187se/r8180_rtl8225.c | 933 + | |
61 | drivers/staging/rtl8187se/r8180_rtl8225.h | 44 | |
62 | drivers/staging/rtl8187se/r8180_rtl8225z2.c | 1587 +++ | |
63 | drivers/staging/rtl8187se/r8180_rtl8255.c | 1838 +++ | |
64 | drivers/staging/rtl8187se/r8180_rtl8255.h | 19 | |
65 | drivers/staging/rtl8187se/r8180_sa2400.c | 233 | |
66 | drivers/staging/rtl8187se/r8180_sa2400.h | 26 | |
67 | drivers/staging/rtl8187se/r8180_wx.c | 1644 +++ | |
68 | drivers/staging/rtl8187se/r8180_wx.h | 21 | |
69 | drivers/staging/rtl8187se/r8185b_init.c | 3342 ++++++ | |
70 | 46 files changed, 36417 insertions(+) | |
71 | ||
72 | --- a/drivers/staging/Kconfig | |
73 | +++ b/drivers/staging/Kconfig | |
74 | @@ -51,4 +51,6 @@ source "drivers/staging/rt2860/Kconfig" | |
75 | ||
76 | source "drivers/staging/benet/Kconfig" | |
77 | ||
78 | +source "drivers/staging/rtl8187se/Kconfig" | |
79 | + | |
80 | endif # STAGING | |
81 | --- a/drivers/staging/Makefile | |
82 | +++ b/drivers/staging/Makefile | |
83 | @@ -17,3 +17,4 @@ obj-$(CONFIG_AGNX) += agnx/ | |
84 | obj-$(CONFIG_OTUS) += otus/ | |
85 | obj-$(CONFIG_RT2860) += rt2860/ | |
86 | obj-$(CONFIG_BENET) += benet/ | |
87 | +obj-$(CONFIG_RTL8187SE) += rtl8187se/ | |
88 | --- /dev/null | |
89 | +++ b/drivers/staging/rtl8187se/dot11d.h | |
90 | @@ -0,0 +1,101 @@ | |
91 | +#ifndef __INC_DOT11D_H\r | |
92 | +#define __INC_DOT11D_H\r | |
93 | +\r | |
94 | +#include "ieee80211.h"\r | |
95 | +\r | |
96 | +//#define ENABLE_DOT11D\r | |
97 | +\r | |
98 | +//#define DOT11D_MAX_CHNL_NUM 83\r | |
99 | +\r | |
100 | +typedef struct _CHNL_TXPOWER_TRIPLE {\r | |
101 | + u8 FirstChnl;\r | |
102 | + u8 NumChnls;\r | |
103 | + u8 MaxTxPowerInDbm;\r | |
104 | +}CHNL_TXPOWER_TRIPLE, *PCHNL_TXPOWER_TRIPLE;\r | |
105 | +\r | |
106 | +typedef enum _DOT11D_STATE {\r | |
107 | + DOT11D_STATE_NONE = 0,\r | |
108 | + DOT11D_STATE_LEARNED,\r | |
109 | + DOT11D_STATE_DONE,\r | |
110 | +}DOT11D_STATE;\r | |
111 | +\r | |
112 | +typedef struct _RT_DOT11D_INFO {\r | |
113 | + //DECLARE_RT_OBJECT(RT_DOT11D_INFO);\r | |
114 | +\r | |
115 | + bool bEnabled; // dot11MultiDomainCapabilityEnabled\r | |
116 | +\r | |
117 | + u16 CountryIeLen; // > 0 if CountryIeBuf[] contains valid country information element.\r | |
118 | + u8 CountryIeBuf[MAX_IE_LEN];\r | |
119 | + u8 CountryIeSrcAddr[6]; // Source AP of the country IE.\r | |
120 | + u8 CountryIeWatchdog; \r | |
121 | +\r | |
122 | + u8 channel_map[MAX_CHANNEL_NUMBER+1]; //!!!Value 0: Invalid, 1: Valid (active scan), 2: Valid (passive scan)\r | |
123 | + //u8 ChnlListLen; // #Bytes valid in ChnlList[].\r | |
124 | + //u8 ChnlList[DOT11D_MAX_CHNL_NUM];\r | |
125 | + u8 MaxTxPwrDbmList[MAX_CHANNEL_NUMBER+1];\r | |
126 | +\r | |
127 | + DOT11D_STATE State;\r | |
128 | +}RT_DOT11D_INFO, *PRT_DOT11D_INFO;\r | |
129 | +#define eqMacAddr(a,b) ( ((a)[0]==(b)[0] && (a)[1]==(b)[1] && (a)[2]==(b)[2] && (a)[3]==(b)[3] && (a)[4]==(b)[4] && (a)[5]==(b)[5]) ? 1:0 )\r | |
130 | +#define cpMacAddr(des,src) ((des)[0]=(src)[0],(des)[1]=(src)[1],(des)[2]=(src)[2],(des)[3]=(src)[3],(des)[4]=(src)[4],(des)[5]=(src)[5])\r | |
131 | +#define GET_DOT11D_INFO(__pIeeeDev) ((PRT_DOT11D_INFO)((__pIeeeDev)->pDot11dInfo))\r | |
132 | +\r | |
133 | +#define IS_DOT11D_ENABLE(__pIeeeDev) GET_DOT11D_INFO(__pIeeeDev)->bEnabled\r | |
134 | +#define IS_COUNTRY_IE_VALID(__pIeeeDev) (GET_DOT11D_INFO(__pIeeeDev)->CountryIeLen > 0)\r | |
135 | +\r | |
136 | +#define IS_EQUAL_CIE_SRC(__pIeeeDev, __pTa) eqMacAddr(GET_DOT11D_INFO(__pIeeeDev)->CountryIeSrcAddr, __pTa) \r | |
137 | +#define UPDATE_CIE_SRC(__pIeeeDev, __pTa) cpMacAddr(GET_DOT11D_INFO(__pIeeeDev)->CountryIeSrcAddr, __pTa)\r | |
138 | +\r | |
139 | +#define IS_COUNTRY_IE_CHANGED(__pIeeeDev, __Ie) \\r | |
140 | + (((__Ie).Length == 0 || (__Ie).Length != GET_DOT11D_INFO(__pIeeeDev)->CountryIeLen) ? \\r | |
141 | + FALSE : \\r | |
142 | + (!memcmp(GET_DOT11D_INFO(__pIeeeDev)->CountryIeBuf, (__Ie).Octet, (__Ie).Length)))\r | |
143 | +\r | |
144 | +#define CIE_WATCHDOG_TH 1\r | |
145 | +#define GET_CIE_WATCHDOG(__pIeeeDev) GET_DOT11D_INFO(__pIeeeDev)->CountryIeWatchdog\r | |
146 | +#define RESET_CIE_WATCHDOG(__pIeeeDev) GET_CIE_WATCHDOG(__pIeeeDev) = 0 \r | |
147 | +#define UPDATE_CIE_WATCHDOG(__pIeeeDev) ++GET_CIE_WATCHDOG(__pIeeeDev)\r | |
148 | +\r | |
149 | +#define IS_DOT11D_STATE_DONE(__pIeeeDev) (GET_DOT11D_INFO(__pIeeeDev)->State == DOT11D_STATE_DONE)\r | |
150 | +\r | |
151 | +\r | |
152 | +void\r | |
153 | +Dot11d_Init(\r | |
154 | + struct ieee80211_device *dev\r | |
155 | + );\r | |
156 | +\r | |
157 | +void\r | |
158 | +Dot11d_Reset(\r | |
159 | + struct ieee80211_device *dev\r | |
160 | + );\r | |
161 | +\r | |
162 | +void\r | |
163 | +Dot11d_UpdateCountryIe(\r | |
164 | + struct ieee80211_device *dev,\r | |
165 | + u8 * pTaddr,\r | |
166 | + u16 CoutryIeLen,\r | |
167 | + u8 * pCoutryIe \r | |
168 | + );\r | |
169 | +\r | |
170 | +u8\r | |
171 | +DOT11D_GetMaxTxPwrInDbm(\r | |
172 | + struct ieee80211_device *dev,\r | |
173 | + u8 Channel\r | |
174 | + );\r | |
175 | +\r | |
176 | +void\r | |
177 | +DOT11D_ScanComplete(\r | |
178 | + struct ieee80211_device * dev\r | |
179 | + );\r | |
180 | +\r | |
181 | +int IsLegalChannel(\r | |
182 | + struct ieee80211_device * dev,\r | |
183 | + u8 channel\r | |
184 | +);\r | |
185 | +\r | |
186 | +int ToLegalChannel(\r | |
187 | + struct ieee80211_device * dev,\r | |
188 | + u8 channel\r | |
189 | +);\r | |
190 | +\r | |
191 | +#endif // #ifndef __INC_DOT11D_H\r | |
192 | --- /dev/null | |
193 | +++ b/drivers/staging/rtl8187se/ieee80211_crypt.h | |
194 | @@ -0,0 +1,86 @@ | |
195 | +/* | |
196 | + * Original code based on Host AP (software wireless LAN access point) driver | |
197 | + * for Intersil Prism2/2.5/3. | |
198 | + * | |
199 | + * Copyright (c) 2001-2002, SSH Communications Security Corp and Jouni Malinen | |
200 | + * <jkmaline@cc.hut.fi> | |
201 | + * Copyright (c) 2002-2003, Jouni Malinen <jkmaline@cc.hut.fi> | |
202 | + * | |
203 | + * Adaption to a generic IEEE 802.11 stack by James Ketrenos | |
204 | + * <jketreno@linux.intel.com> | |
205 | + * | |
206 | + * Copyright (c) 2004, Intel Corporation | |
207 | + * | |
208 | + * This program is free software; you can redistribute it and/or modify | |
209 | + * it under the terms of the GNU General Public License version 2 as | |
210 | + * published by the Free Software Foundation. See README and COPYING for | |
211 | + * more details. | |
212 | + */ | |
213 | + | |
214 | +/* | |
215 | + * This file defines the interface to the ieee80211 crypto module. | |
216 | + */ | |
217 | +#ifndef IEEE80211_CRYPT_H | |
218 | +#define IEEE80211_CRYPT_H | |
219 | + | |
220 | +#include <linux/skbuff.h> | |
221 | + | |
222 | +struct ieee80211_crypto_ops { | |
223 | + const char *name; | |
224 | + | |
225 | + /* init new crypto context (e.g., allocate private data space, | |
226 | + * select IV, etc.); returns NULL on failure or pointer to allocated | |
227 | + * private data on success */ | |
228 | + void * (*init)(int keyidx); | |
229 | + | |
230 | + /* deinitialize crypto context and free allocated private data */ | |
231 | + void (*deinit)(void *priv); | |
232 | + | |
233 | + /* encrypt/decrypt return < 0 on error or >= 0 on success. The return | |
234 | + * value from decrypt_mpdu is passed as the keyidx value for | |
235 | + * decrypt_msdu. skb must have enough head and tail room for the | |
236 | + * encryption; if not, error will be returned; these functions are | |
237 | + * called for all MPDUs (i.e., fragments). | |
238 | + */ | |
239 | + int (*encrypt_mpdu)(struct sk_buff *skb, int hdr_len, void *priv); | |
240 | + int (*decrypt_mpdu)(struct sk_buff *skb, int hdr_len, void *priv); | |
241 | + | |
242 | + /* These functions are called for full MSDUs, i.e. full frames. | |
243 | + * These can be NULL if full MSDU operations are not needed. */ | |
244 | + int (*encrypt_msdu)(struct sk_buff *skb, int hdr_len, void *priv); | |
245 | + int (*decrypt_msdu)(struct sk_buff *skb, int keyidx, int hdr_len, | |
246 | + void *priv); | |
247 | + | |
248 | + int (*set_key)(void *key, int len, u8 *seq, void *priv); | |
249 | + int (*get_key)(void *key, int len, u8 *seq, void *priv); | |
250 | + | |
251 | + /* procfs handler for printing out key information and possible | |
252 | + * statistics */ | |
253 | + char * (*print_stats)(char *p, void *priv); | |
254 | + | |
255 | + /* maximum number of bytes added by encryption; encrypt buf is | |
256 | + * allocated with extra_prefix_len bytes, copy of in_buf, and | |
257 | + * extra_postfix_len; encrypt need not use all this space, but | |
258 | + * the result must start at the beginning of the buffer and correct | |
259 | + * length must be returned */ | |
260 | + int extra_prefix_len, extra_postfix_len; | |
261 | + | |
262 | + struct module *owner; | |
263 | +}; | |
264 | + | |
265 | +struct ieee80211_crypt_data { | |
266 | + struct list_head list; /* delayed deletion list */ | |
267 | + struct ieee80211_crypto_ops *ops; | |
268 | + void *priv; | |
269 | + atomic_t refcnt; | |
270 | +}; | |
271 | + | |
272 | +int ieee80211_register_crypto_ops(struct ieee80211_crypto_ops *ops); | |
273 | +int ieee80211_unregister_crypto_ops(struct ieee80211_crypto_ops *ops); | |
274 | +struct ieee80211_crypto_ops * ieee80211_get_crypto_ops(const char *name); | |
275 | +void ieee80211_crypt_deinit_entries(struct ieee80211_device *, int); | |
276 | +void ieee80211_crypt_deinit_handler(unsigned long); | |
277 | +void ieee80211_crypt_delayed_deinit(struct ieee80211_device *ieee, | |
278 | + struct ieee80211_crypt_data **crypt); | |
279 | + | |
280 | +#endif | |
281 | --- /dev/null | |
282 | +++ b/drivers/staging/rtl8187se/ieee80211/dot11d.c | |
283 | @@ -0,0 +1,246 @@ | |
284 | +#ifdef ENABLE_DOT11D\r | |
285 | +//-----------------------------------------------------------------------------\r | |
286 | +// File:\r | |
287 | +// Dot11d.c\r | |
288 | +//\r | |
289 | +// Description:\r | |
290 | +// Implement 802.11d. \r | |
291 | +//\r | |
292 | +//-----------------------------------------------------------------------------\r | |
293 | +\r | |
294 | +#include "dot11d.h"\r | |
295 | +\r | |
296 | +void\r | |
297 | +Dot11d_Init(struct ieee80211_device *ieee)\r | |
298 | +{\r | |
299 | + PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(ieee);\r | |
300 | +\r | |
301 | + pDot11dInfo->bEnabled = 0;\r | |
302 | +\r | |
303 | + pDot11dInfo->State = DOT11D_STATE_NONE;\r | |
304 | + pDot11dInfo->CountryIeLen = 0;\r | |
305 | + memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1); \r | |
306 | + memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);\r | |
307 | + RESET_CIE_WATCHDOG(ieee);\r | |
308 | +\r | |
309 | + printk("Dot11d_Init()\n");\r | |
310 | +}\r | |
311 | +\r | |
312 | +//\r | |
313 | +// Description:\r | |
314 | +// Reset to the state as we are just entering a regulatory domain.\r | |
315 | +//\r | |
316 | +void\r | |
317 | +Dot11d_Reset(struct ieee80211_device *ieee)\r | |
318 | +{\r | |
319 | + u32 i;\r | |
320 | + PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(ieee);\r | |
321 | +\r | |
322 | + // Clear old channel map\r | |
323 | + memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);\r | |
324 | + memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);\r | |
325 | + // Set new channel map\r | |
326 | + for (i=1; i<=11; i++) {\r | |
327 | + (pDot11dInfo->channel_map)[i] = 1;\r | |
328 | + }\r | |
329 | + for (i=12; i<=14; i++) {\r | |
330 | + (pDot11dInfo->channel_map)[i] = 2;\r | |
331 | + }\r | |
332 | +\r | |
333 | + pDot11dInfo->State = DOT11D_STATE_NONE;\r | |
334 | + pDot11dInfo->CountryIeLen = 0;\r | |
335 | + RESET_CIE_WATCHDOG(ieee);\r | |
336 | +\r | |
337 | + //printk("Dot11d_Reset()\n");\r | |
338 | +}\r | |
339 | +\r | |
340 | +//\r | |
341 | +// Description:\r | |
342 | +// Update country IE from Beacon or Probe Resopnse \r | |
343 | +// and configure PHY for operation in the regulatory domain.\r | |
344 | +//\r | |
345 | +// TODO: \r | |
346 | +// Configure Tx power.\r | |
347 | +//\r | |
348 | +// Assumption:\r | |
349 | +// 1. IS_DOT11D_ENABLE() is TRUE.\r | |
350 | +// 2. Input IE is an valid one.\r | |
351 | +//\r | |
352 | +void\r | |
353 | +Dot11d_UpdateCountryIe(\r | |
354 | + struct ieee80211_device *dev,\r | |
355 | + u8 * pTaddr,\r | |
356 | + u16 CoutryIeLen,\r | |
357 | + u8 * pCoutryIe \r | |
358 | + )\r | |
359 | +{\r | |
360 | + PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(dev);\r | |
361 | + u8 i, j, NumTriples, MaxChnlNum;\r | |
362 | + PCHNL_TXPOWER_TRIPLE pTriple;\r | |
363 | +\r | |
364 | + if((CoutryIeLen - 3)%3 != 0)\r | |
365 | + {\r | |
366 | + printk("Dot11d_UpdateCountryIe(): Invalid country IE, skip it........1\n");\r | |
367 | + Dot11d_Reset(dev);\r | |
368 | + return;\r | |
369 | + }\r | |
370 | +\r | |
371 | + memset(pDot11dInfo->channel_map, 0, MAX_CHANNEL_NUMBER+1);\r | |
372 | + memset(pDot11dInfo->MaxTxPwrDbmList, 0xFF, MAX_CHANNEL_NUMBER+1);\r | |
373 | + MaxChnlNum = 0;\r | |
374 | + NumTriples = (CoutryIeLen - 3) / 3; // skip 3-byte country string.\r | |
375 | + pTriple = (PCHNL_TXPOWER_TRIPLE)(pCoutryIe + 3);\r | |
376 | + for(i = 0; i < NumTriples; i++)\r | |
377 | + {\r | |
378 | + if(MaxChnlNum >= pTriple->FirstChnl)\r | |
379 | + { // It is not in a monotonically increasing order, so stop processing.\r | |
380 | + printk("Dot11d_UpdateCountryIe(): Invalid country IE, skip it........1\n");\r | |
381 | + Dot11d_Reset(dev);\r | |
382 | + return; \r | |
383 | + }\r | |
384 | + if(MAX_CHANNEL_NUMBER < (pTriple->FirstChnl + pTriple->NumChnls))\r | |
385 | + { // It is not a valid set of channel id, so stop processing.\r | |
386 | + printk("Dot11d_UpdateCountryIe(): Invalid country IE, skip it........2\n");\r | |
387 | + Dot11d_Reset(dev);\r | |
388 | + return; \r | |
389 | + }\r | |
390 | +\r | |
391 | + for(j = 0 ; j < pTriple->NumChnls; j++)\r | |
392 | + {\r | |
393 | + pDot11dInfo->channel_map[pTriple->FirstChnl + j] = 1;\r | |
394 | + pDot11dInfo->MaxTxPwrDbmList[pTriple->FirstChnl + j] = pTriple->MaxTxPowerInDbm;\r | |
395 | + MaxChnlNum = pTriple->FirstChnl + j;\r | |
396 | + } \r | |
397 | +\r | |
398 | + pTriple = (PCHNL_TXPOWER_TRIPLE)((u8*)pTriple + 3);\r | |
399 | + }\r | |
400 | +#if 1\r | |
401 | + //printk("Dot11d_UpdateCountryIe(): Channel List:\n");\r | |
402 | + printk("Channel List:");\r | |
403 | + for(i=1; i<= MAX_CHANNEL_NUMBER; i++)\r | |
404 | + if(pDot11dInfo->channel_map[i] > 0)\r | |
405 | + printk(" %d", i);\r | |
406 | + printk("\n");\r | |
407 | +#endif\r | |
408 | +\r | |
409 | + UPDATE_CIE_SRC(dev, pTaddr);\r | |
410 | +\r | |
411 | + pDot11dInfo->CountryIeLen = CoutryIeLen;\r | |
412 | + memcpy(pDot11dInfo->CountryIeBuf, pCoutryIe,CoutryIeLen);\r | |
413 | + pDot11dInfo->State = DOT11D_STATE_LEARNED;\r | |
414 | +}\r | |
415 | +\r | |
416 | +void dump_chnl_map(u8 * channel_map)\r | |
417 | +{\r | |
418 | + int i;\r | |
419 | + printk("Channel List:");\r | |
420 | + for(i=1; i<= MAX_CHANNEL_NUMBER; i++)\r | |
421 | + if(channel_map[i] > 0)\r | |
422 | + printk(" %d(%d)", i, channel_map[i]);\r | |
423 | + printk("\n");\r | |
424 | +}\r | |
425 | +\r | |
426 | +u8\r | |
427 | +DOT11D_GetMaxTxPwrInDbm(\r | |
428 | + struct ieee80211_device *dev,\r | |
429 | + u8 Channel\r | |
430 | + )\r | |
431 | +{\r | |
432 | + PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(dev);\r | |
433 | + u8 MaxTxPwrInDbm = 255;\r | |
434 | +\r | |
435 | + if(MAX_CHANNEL_NUMBER < Channel)\r | |
436 | + { \r | |
437 | + printk("DOT11D_GetMaxTxPwrInDbm(): Invalid Channel\n");\r | |
438 | + return MaxTxPwrInDbm; \r | |
439 | + }\r | |
440 | + if(pDot11dInfo->channel_map[Channel])\r | |
441 | + {\r | |
442 | + MaxTxPwrInDbm = pDot11dInfo->MaxTxPwrDbmList[Channel]; \r | |
443 | + }\r | |
444 | +\r | |
445 | + return MaxTxPwrInDbm;\r | |
446 | +}\r | |
447 | +\r | |
448 | +\r | |
449 | +void\r | |
450 | +DOT11D_ScanComplete(\r | |
451 | + struct ieee80211_device * dev\r | |
452 | + )\r | |
453 | +{\r | |
454 | + PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(dev);\r | |
455 | +\r | |
456 | + switch(pDot11dInfo->State)\r | |
457 | + {\r | |
458 | + case DOT11D_STATE_LEARNED:\r | |
459 | + pDot11dInfo->State = DOT11D_STATE_DONE;\r | |
460 | + break;\r | |
461 | +\r | |
462 | + case DOT11D_STATE_DONE:\r | |
463 | + if( GET_CIE_WATCHDOG(dev) == 0 )\r | |
464 | + { // Reset country IE if previous one is gone. \r | |
465 | + Dot11d_Reset(dev); \r | |
466 | + }\r | |
467 | + break;\r | |
468 | + case DOT11D_STATE_NONE:\r | |
469 | + break;\r | |
470 | + }\r | |
471 | +}\r | |
472 | +\r | |
473 | +int IsLegalChannel(\r | |
474 | + struct ieee80211_device * dev,\r | |
475 | + u8 channel\r | |
476 | +)\r | |
477 | +{\r | |
478 | + PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(dev);\r | |
479 | +\r | |
480 | + if(MAX_CHANNEL_NUMBER < channel)\r | |
481 | + { \r | |
482 | + printk("IsLegalChannel(): Invalid Channel\n");\r | |
483 | + return 0; \r | |
484 | + }\r | |
485 | + if(pDot11dInfo->channel_map[channel] > 0)\r | |
486 | + return 1;\r | |
487 | + return 0;\r | |
488 | +}\r | |
489 | +\r | |
490 | +int ToLegalChannel(\r | |
491 | + struct ieee80211_device * dev,\r | |
492 | + u8 channel\r | |
493 | +)\r | |
494 | +{\r | |
495 | + PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(dev);\r | |
496 | + u8 default_chn = 0;\r | |
497 | + u32 i = 0;\r | |
498 | +\r | |
499 | + for (i=1; i<= MAX_CHANNEL_NUMBER; i++)\r | |
500 | + {\r | |
501 | + if(pDot11dInfo->channel_map[i] > 0)\r | |
502 | + {\r | |
503 | + default_chn = i;\r | |
504 | + break;\r | |
505 | + }\r | |
506 | + }\r | |
507 | +\r | |
508 | + if(MAX_CHANNEL_NUMBER < channel)\r | |
509 | + { \r | |
510 | + printk("IsLegalChannel(): Invalid Channel\n");\r | |
511 | + return default_chn; \r | |
512 | + }\r | |
513 | + \r | |
514 | + if(pDot11dInfo->channel_map[channel] > 0)\r | |
515 | + return channel;\r | |
516 | + \r | |
517 | + return default_chn;\r | |
518 | +}\r | |
519 | +\r | |
520 | +#if 0\r | |
521 | +EXPORT_SYMBOL(Dot11d_Init);\r | |
522 | +EXPORT_SYMBOL(Dot11d_Reset);\r | |
523 | +EXPORT_SYMBOL(Dot11d_UpdateCountryIe);\r | |
524 | +EXPORT_SYMBOL(DOT11D_GetMaxTxPwrInDbm);\r | |
525 | +EXPORT_SYMBOL(DOT11D_ScanComplete);\r | |
526 | +EXPORT_SYMBOL(IsLegalChannel);\r | |
527 | +EXPORT_SYMBOL(ToLegalChannel);\r | |
528 | +#endif\r | |
529 | +#endif\r | |
530 | --- /dev/null | |
531 | +++ b/drivers/staging/rtl8187se/ieee80211/dot11d.h | |
532 | @@ -0,0 +1,102 @@ | |
533 | +#ifndef __INC_DOT11D_H\r | |
534 | +#define __INC_DOT11D_H\r | |
535 | +\r | |
536 | +#include "ieee80211.h"\r | |
537 | +\r | |
538 | +//#define ENABLE_DOT11D\r | |
539 | +\r | |
540 | +//#define DOT11D_MAX_CHNL_NUM 83\r | |
541 | +\r | |
542 | +typedef struct _CHNL_TXPOWER_TRIPLE {\r | |
543 | + u8 FirstChnl;\r | |
544 | + u8 NumChnls;\r | |
545 | + u8 MaxTxPowerInDbm;\r | |
546 | +}CHNL_TXPOWER_TRIPLE, *PCHNL_TXPOWER_TRIPLE;\r | |
547 | +\r | |
548 | +typedef enum _DOT11D_STATE {\r | |
549 | + DOT11D_STATE_NONE = 0,\r | |
550 | + DOT11D_STATE_LEARNED,\r | |
551 | + DOT11D_STATE_DONE,\r | |
552 | +}DOT11D_STATE;\r | |
553 | +\r | |
554 | +typedef struct _RT_DOT11D_INFO {\r | |
555 | + //DECLARE_RT_OBJECT(RT_DOT11D_INFO);\r | |
556 | +\r | |
557 | + bool bEnabled; // dot11MultiDomainCapabilityEnabled\r | |
558 | +\r | |
559 | + u16 CountryIeLen; // > 0 if CountryIeBuf[] contains valid country information element.\r | |
560 | + u8 CountryIeBuf[MAX_IE_LEN];\r | |
561 | + u8 CountryIeSrcAddr[6]; // Source AP of the country IE.\r | |
562 | + u8 CountryIeWatchdog; \r | |
563 | +\r | |
564 | + u8 channel_map[MAX_CHANNEL_NUMBER+1]; //!!!Value 0: Invalid, 1: Valid (active scan), 2: Valid (passive scan)\r | |
565 | + //u8 ChnlListLen; // #Bytes valid in ChnlList[].\r | |
566 | + //u8 ChnlList[DOT11D_MAX_CHNL_NUM];\r | |
567 | + u8 MaxTxPwrDbmList[MAX_CHANNEL_NUMBER+1];\r | |
568 | +\r | |
569 | + DOT11D_STATE State;\r | |
570 | +}RT_DOT11D_INFO, *PRT_DOT11D_INFO;\r | |
571 | +#define eqMacAddr(a,b) ( ((a)[0]==(b)[0] && (a)[1]==(b)[1] && (a)[2]==(b)[2] && (a)[3]==(b)[3] && (a)[4]==(b)[4] && (a)[5]==(b)[5]) ? 1:0 )\r | |
572 | +#define cpMacAddr(des,src) ((des)[0]=(src)[0],(des)[1]=(src)[1],(des)[2]=(src)[2],(des)[3]=(src)[3],(des)[4]=(src)[4],(des)[5]=(src)[5])\r | |
573 | +#define GET_DOT11D_INFO(__pIeeeDev) ((PRT_DOT11D_INFO)((__pIeeeDev)->pDot11dInfo))\r | |
574 | +\r | |
575 | +#define IS_DOT11D_ENABLE(__pIeeeDev) GET_DOT11D_INFO(__pIeeeDev)->bEnabled\r | |
576 | +#define IS_COUNTRY_IE_VALID(__pIeeeDev) (GET_DOT11D_INFO(__pIeeeDev)->CountryIeLen > 0)\r | |
577 | +\r | |
578 | +#define IS_EQUAL_CIE_SRC(__pIeeeDev, __pTa) eqMacAddr(GET_DOT11D_INFO(__pIeeeDev)->CountryIeSrcAddr, __pTa) \r | |
579 | +#define UPDATE_CIE_SRC(__pIeeeDev, __pTa) cpMacAddr(GET_DOT11D_INFO(__pIeeeDev)->CountryIeSrcAddr, __pTa)\r | |
580 | +\r | |
581 | +#define IS_COUNTRY_IE_CHANGED(__pIeeeDev, __Ie) \\r | |
582 | + (((__Ie).Length == 0 || (__Ie).Length != GET_DOT11D_INFO(__pIeeeDev)->CountryIeLen) ? \\r | |
583 | + FALSE : \\r | |
584 | + (!memcmp(GET_DOT11D_INFO(__pIeeeDev)->CountryIeBuf, (__Ie).Octet, (__Ie).Length)))\r | |
585 | +\r | |
586 | +#define CIE_WATCHDOG_TH 1\r | |
587 | +#define GET_CIE_WATCHDOG(__pIeeeDev) GET_DOT11D_INFO(__pIeeeDev)->CountryIeWatchdog\r | |
588 | +#define RESET_CIE_WATCHDOG(__pIeeeDev) GET_CIE_WATCHDOG(__pIeeeDev) = 0 \r | |
589 | +#define UPDATE_CIE_WATCHDOG(__pIeeeDev) ++GET_CIE_WATCHDOG(__pIeeeDev)\r | |
590 | +\r | |
591 | +#define IS_DOT11D_STATE_DONE(__pIeeeDev) (GET_DOT11D_INFO(__pIeeeDev)->State == DOT11D_STATE_DONE)\r | |
592 | +\r | |
593 | +\r | |
594 | +void\r | |
595 | +Dot11d_Init(\r | |
596 | + struct ieee80211_device *dev\r | |
597 | + );\r | |
598 | +\r | |
599 | +void\r | |
600 | +Dot11d_Reset(\r | |
601 | + struct ieee80211_device *dev\r | |
602 | + );\r | |
603 | +\r | |
604 | +void\r | |
605 | +Dot11d_UpdateCountryIe(\r | |
606 | + struct ieee80211_device *dev,\r | |
607 | + u8 * pTaddr,\r | |
608 | + u16 CoutryIeLen,\r | |
609 | + u8 * pCoutryIe \r | |
610 | + );\r | |
611 | +\r | |
612 | +u8\r | |
613 | +DOT11D_GetMaxTxPwrInDbm(\r | |
614 | + struct ieee80211_device *dev,\r | |
615 | + u8 Channel\r | |
616 | + );\r | |
617 | +\r | |
618 | +void\r | |
619 | +DOT11D_ScanComplete(\r | |
620 | + struct ieee80211_device * dev\r | |
621 | + );\r | |
622 | +\r | |
623 | +int IsLegalChannel(\r | |
624 | + struct ieee80211_device * dev,\r | |
625 | + u8 channel\r | |
626 | +);\r | |
627 | +\r | |
628 | +int ToLegalChannel(\r | |
629 | + struct ieee80211_device * dev,\r | |
630 | + u8 channel\r | |
631 | +);\r | |
632 | +\r | |
633 | +void dump_chnl_map(u8 * channel_map);\r | |
634 | +#endif // #ifndef __INC_DOT11D_H\r | |
635 | --- /dev/null | |
636 | +++ b/drivers/staging/rtl8187se/ieee80211.h | |
637 | @@ -0,0 +1,1755 @@ | |
638 | +/* | |
639 | + * Merged with mainline ieee80211.h in Aug 2004. Original ieee802_11 | |
640 | + * remains copyright by the original authors | |
641 | + * | |
642 | + * Portions of the merged code are based on Host AP (software wireless | |
643 | + * LAN access point) driver for Intersil Prism2/2.5/3. | |
644 | + * | |
645 | + * Copyright (c) 2001-2002, SSH Communications Security Corp and Jouni Malinen | |
646 | + * <jkmaline@cc.hut.fi> | |
647 | + * Copyright (c) 2002-2003, Jouni Malinen <jkmaline@cc.hut.fi> | |
648 | + * | |
649 | + * Adaption to a generic IEEE 802.11 stack by James Ketrenos | |
650 | + * <jketreno@linux.intel.com> | |
651 | + * Copyright (c) 2004, Intel Corporation | |
652 | + * | |
653 | + * Modified for Realtek's wi-fi cards by Andrea Merello | |
654 | + * <andreamrl@tiscali.it> | |
655 | + * | |
656 | + * This program is free software; you can redistribute it and/or modify | |
657 | + * it under the terms of the GNU General Public License version 2 as | |
658 | + * published by the Free Software Foundation. See README and COPYING for | |
659 | + * more details. | |
660 | + */ | |
661 | +#ifndef IEEE80211_H | |
662 | +#define IEEE80211_H | |
663 | +#include <linux/if_ether.h> /* ETH_ALEN */ | |
664 | +#include <linux/kernel.h> /* ARRAY_SIZE */ | |
665 | +#include <linux/version.h> | |
666 | +#include <linux/jiffies.h> | |
667 | +#include <linux/timer.h> | |
668 | +#include <linux/sched.h> | |
669 | + | |
670 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,13)) | |
671 | +#include <linux/wireless.h> | |
672 | +#endif | |
673 | + | |
674 | +/* | |
675 | +#ifndef bool | |
676 | +#define bool int | |
677 | +#endif | |
678 | + | |
679 | +#ifndef true | |
680 | +#define true 1 | |
681 | +#endif | |
682 | + | |
683 | +#ifndef false | |
684 | +#define false 0 | |
685 | +#endif | |
686 | +*/ | |
687 | +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20)) | |
688 | +#ifndef bool | |
689 | +typedef enum{false = 0, true} bool; | |
690 | +#endif | |
691 | +#endif | |
692 | +//#ifdef JOHN_HWSEC | |
693 | +#define KEY_TYPE_NA 0x0 | |
694 | +#define KEY_TYPE_WEP40 0x1 | |
695 | +#define KEY_TYPE_TKIP 0x2 | |
696 | +#define KEY_TYPE_CCMP 0x4 | |
697 | +#define KEY_TYPE_WEP104 0x5 | |
698 | +//#endif | |
699 | + | |
700 | + | |
701 | +#define aSifsTime 10 | |
702 | + | |
703 | +#define MGMT_QUEUE_NUM 5 | |
704 | + | |
705 | + | |
706 | +#define IEEE_CMD_SET_WPA_PARAM 1 | |
707 | +#define IEEE_CMD_SET_WPA_IE 2 | |
708 | +#define IEEE_CMD_SET_ENCRYPTION 3 | |
709 | +#define IEEE_CMD_MLME 4 | |
710 | + | |
711 | +#define IEEE_PARAM_WPA_ENABLED 1 | |
712 | +#define IEEE_PARAM_TKIP_COUNTERMEASURES 2 | |
713 | +#define IEEE_PARAM_DROP_UNENCRYPTED 3 | |
714 | +#define IEEE_PARAM_PRIVACY_INVOKED 4 | |
715 | +#define IEEE_PARAM_AUTH_ALGS 5 | |
716 | +#define IEEE_PARAM_IEEE_802_1X 6 | |
717 | +//It should consistent with the driver_XXX.c | |
718 | +// David, 2006.9.26 | |
719 | +#define IEEE_PARAM_WPAX_SELECT 7 | |
720 | +//Added for notify the encryption type selection | |
721 | +// David, 2006.9.26 | |
722 | +#define IEEE_PROTO_WPA 1 | |
723 | +#define IEEE_PROTO_RSN 2 | |
724 | +//Added for notify the encryption type selection | |
725 | +// David, 2006.9.26 | |
726 | +#define IEEE_WPAX_USEGROUP 0 | |
727 | +#define IEEE_WPAX_WEP40 1 | |
728 | +#define IEEE_WPAX_TKIP 2 | |
729 | +#define IEEE_WPAX_WRAP 3 | |
730 | +#define IEEE_WPAX_CCMP 4 | |
731 | +#define IEEE_WPAX_WEP104 5 | |
732 | + | |
733 | +#define IEEE_KEY_MGMT_IEEE8021X 1 | |
734 | +#define IEEE_KEY_MGMT_PSK 2 | |
735 | + | |
736 | + | |
737 | + | |
738 | +#define IEEE_MLME_STA_DEAUTH 1 | |
739 | +#define IEEE_MLME_STA_DISASSOC 2 | |
740 | + | |
741 | + | |
742 | +#define IEEE_CRYPT_ERR_UNKNOWN_ALG 2 | |
743 | +#define IEEE_CRYPT_ERR_UNKNOWN_ADDR 3 | |
744 | +#define IEEE_CRYPT_ERR_CRYPT_INIT_FAILED 4 | |
745 | +#define IEEE_CRYPT_ERR_KEY_SET_FAILED 5 | |
746 | +#define IEEE_CRYPT_ERR_TX_KEY_SET_FAILED 6 | |
747 | +#define IEEE_CRYPT_ERR_CARD_CONF_FAILED 7 | |
748 | + | |
749 | + | |
750 | +#define IEEE_CRYPT_ALG_NAME_LEN 16 | |
751 | + | |
752 | +#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,10)) | |
753 | +#define ieee80211_wx_get_scan ieee80211_wx_get_scan_rtl | |
754 | +#define ieee80211_wx_set_encode ieee80211_wx_set_encode_rtl | |
755 | +#define ieee80211_wx_get_encode ieee80211_wx_get_encode_rtl | |
756 | +//////////////////////////////// | |
757 | +// added for kernel conflict under FC5 | |
758 | +#define ieee80211_wx_get_name ieee80211_wx_get_name_rtl | |
759 | +#define free_ieee80211 free_ieee80211_rtl | |
760 | +#define alloc_ieee80211 alloc_ieee80211_rtl | |
761 | +/////////////////////////////// | |
762 | +#endif | |
763 | +//error in ubuntu2.6.22,so add these | |
764 | +#define ieee80211_wake_queue ieee80211_wake_queue_rtl | |
765 | +#define ieee80211_stop_queue ieee80211_stop_queue_rtl | |
766 | + | |
767 | +#define ieee80211_rx ieee80211_rx_rtl | |
768 | + | |
769 | +#define ieee80211_register_crypto_ops ieee80211_register_crypto_ops_rtl | |
770 | +#define ieee80211_unregister_crypto_ops ieee80211_unregister_crypto_ops_rtl | |
771 | +#define ieee80211_get_crypto_ops ieee80211_get_crypto_ops_rtl | |
772 | +#define ieee80211_crypt_deinit_entries ieee80211_crypt_deinit_entries_rtl | |
773 | +#define ieee80211_crypt_deinit_handler ieee80211_crypt_deinit_handler_rtl | |
774 | +#define ieee80211_crypt_delayed_deinit ieee80211_crypt_delayed_deinit_rtl | |
775 | + | |
776 | +#define ieee80211_txb_free ieee80211_txb_free_rtl | |
777 | +#define ieee80211_wx_get_essid ieee80211_wx_get_essid_rtl | |
778 | +#define ieee80211_wx_set_essid ieee80211_wx_set_essid_rtl | |
779 | +#define ieee80211_wx_set_rate ieee80211_wx_set_rate_rtl | |
780 | +#define ieee80211_wx_get_rate ieee80211_wx_get_rate_rtl | |
781 | +#define ieee80211_wx_set_wap ieee80211_wx_set_wap_rtl | |
782 | +#define ieee80211_wx_get_wap ieee80211_wx_get_wap_rtl | |
783 | +#define ieee80211_wx_set_mode ieee80211_wx_set_mode_rtl | |
784 | +#define ieee80211_wx_get_mode ieee80211_wx_get_mode_rtl | |
785 | +#define ieee80211_wx_set_scan ieee80211_wx_set_scan_rtl | |
786 | +#define ieee80211_wx_get_freq ieee80211_wx_get_freq_rtl | |
787 | +#define ieee80211_wx_set_freq ieee80211_wx_set_freq_rtl | |
788 | +#define ieee80211_wx_set_rawtx ieee80211_wx_set_rawtx_rtl | |
789 | +#define ieee80211_wx_set_power ieee80211_wx_set_power_rtl | |
790 | +#define ieee80211_wx_get_power ieee80211_wx_get_power_rtl | |
791 | +#define ieee80211_wlan_frequencies ieee80211_wlan_frequencies_rtl | |
792 | +#define ieee80211_softmac_stop_protocol ieee80211_softmac_stop_protocol_rtl | |
793 | +#define ieee80211_softmac_start_protocol ieee80211_softmac_start_protocol_rtl | |
794 | +#define ieee80211_start_protocol ieee80211_start_protocol_rtl | |
795 | +#define ieee80211_stop_protocol ieee80211_stop_protocol_rtl | |
796 | +#define ieee80211_rx_mgt ieee80211_rx_mgt_rtl | |
797 | + | |
798 | +#define ieee80211_wx_set_auth ieee80211_wx_set_auth_rtl | |
799 | +//by amy for ps | |
800 | +#define notify_wx_assoc_event notify_wx_assoc_event_rtl | |
801 | +#define ieee80211_stop_send_beacons ieee80211_stop_send_beacons_rtl | |
802 | +#define ieee80211_disassociate ieee80211_disassociate_rtl | |
803 | +#define ieee80211_start_scan ieee80211_start_scan_rtl | |
804 | +//by amy for ps | |
805 | +typedef struct ieee_param { | |
806 | + u32 cmd; | |
807 | + u8 sta_addr[ETH_ALEN]; | |
808 | + union { | |
809 | + struct { | |
810 | + u8 name; | |
811 | + u32 value; | |
812 | + } wpa_param; | |
813 | + struct { | |
814 | + u32 len; | |
815 | + u8 reserved[32]; | |
816 | + u8 data[0]; | |
817 | + } wpa_ie; | |
818 | + struct{ | |
819 | + int command; | |
820 | + int reason_code; | |
821 | + } mlme; | |
822 | + struct { | |
823 | + u8 alg[IEEE_CRYPT_ALG_NAME_LEN]; | |
824 | + u8 set_tx; | |
825 | + u32 err; | |
826 | + u8 idx; | |
827 | + u8 seq[8]; /* sequence counter (set: RX, get: TX) */ | |
828 | + u16 key_len; | |
829 | + u8 key[0]; | |
830 | + } crypt; | |
831 | + | |
832 | + } u; | |
833 | +}ieee_param; | |
834 | + | |
835 | + | |
836 | +#if WIRELESS_EXT < 17 | |
837 | +#define IW_QUAL_QUAL_INVALID 0x10 | |
838 | +#define IW_QUAL_LEVEL_INVALID 0x20 | |
839 | +#define IW_QUAL_NOISE_INVALID 0x40 | |
840 | +#define IW_QUAL_QUAL_UPDATED 0x1 | |
841 | +#define IW_QUAL_LEVEL_UPDATED 0x2 | |
842 | +#define IW_QUAL_NOISE_UPDATED 0x4 | |
843 | +#endif | |
844 | + | |
845 | +// linux under 2.6.9 release may not support it, so modify it for common use | |
846 | +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,9)) | |
847 | +#define MSECS(t) (1000 * ((t) / HZ) + 1000 * ((t) % HZ) / HZ) | |
848 | +static inline unsigned long msleep_interruptible_rtl(unsigned int msecs) | |
849 | +{ | |
850 | + unsigned long timeout = MSECS(msecs) + 1; | |
851 | + | |
852 | + while (timeout) { | |
853 | + set_current_state(TASK_UNINTERRUPTIBLE); | |
854 | + timeout = schedule_timeout(timeout); | |
855 | + } | |
856 | + return timeout; | |
857 | +} | |
858 | +#else | |
859 | +#define MSECS(t) msecs_to_jiffies(t) | |
860 | +#define msleep_interruptible_rtl msleep_interruptible | |
861 | +#endif | |
862 | + | |
863 | +#define IEEE80211_DATA_LEN 2304 | |
864 | +/* Maximum size for the MA-UNITDATA primitive, 802.11 standard section | |
865 | + 6.2.1.1.2. | |
866 | + | |
867 | + The figure in section 7.1.2 suggests a body size of up to 2312 | |
868 | + bytes is allowed, which is a bit confusing, I suspect this | |
869 | + represents the 2304 bytes of real data, plus a possible 8 bytes of | |
870 | + WEP IV and ICV. (this interpretation suggested by Ramiro Barreiro) */ | |
871 | + | |
872 | + | |
873 | +#define IEEE80211_HLEN 30 | |
874 | +#define IEEE80211_FRAME_LEN (IEEE80211_DATA_LEN + IEEE80211_HLEN) | |
875 | + | |
876 | +/* this is stolen and modified from the madwifi driver*/ | |
877 | +#define IEEE80211_FC0_TYPE_MASK 0x0c | |
878 | +#define IEEE80211_FC0_TYPE_DATA 0x08 | |
879 | +#define IEEE80211_FC0_SUBTYPE_MASK 0xB0 | |
880 | +#define IEEE80211_FC0_SUBTYPE_QOS 0x80 | |
881 | + | |
882 | +#define IEEE80211_QOS_HAS_SEQ(fc) \ | |
883 | + (((fc) & (IEEE80211_FC0_TYPE_MASK | IEEE80211_FC0_SUBTYPE_MASK)) == \ | |
884 | + (IEEE80211_FC0_TYPE_DATA | IEEE80211_FC0_SUBTYPE_QOS)) | |
885 | + | |
886 | +/* this is stolen from ipw2200 driver */ | |
887 | +#define IEEE_IBSS_MAC_HASH_SIZE 31 | |
888 | +struct ieee_ibss_seq { | |
889 | + u8 mac[ETH_ALEN]; | |
890 | + u16 seq_num[17]; | |
891 | + u16 frag_num[17]; | |
892 | + unsigned long packet_time[17]; | |
893 | + struct list_head list; | |
894 | +}; | |
895 | + | |
896 | +struct ieee80211_hdr { | |
897 | + u16 frame_ctl; | |
898 | + u16 duration_id; | |
899 | + u8 addr1[ETH_ALEN]; | |
900 | + u8 addr2[ETH_ALEN]; | |
901 | + u8 addr3[ETH_ALEN]; | |
902 | + u16 seq_ctl; | |
903 | + u8 addr4[ETH_ALEN]; | |
904 | +} __attribute__ ((packed)); | |
905 | + | |
906 | +struct ieee80211_hdr_QOS { | |
907 | + u16 frame_ctl; | |
908 | + u16 duration_id; | |
909 | + u8 addr1[ETH_ALEN]; | |
910 | + u8 addr2[ETH_ALEN]; | |
911 | + u8 addr3[ETH_ALEN]; | |
912 | + u16 seq_ctl; | |
913 | + u8 addr4[ETH_ALEN]; | |
914 | + u16 QOS_ctl; | |
915 | +} __attribute__ ((packed)); | |
916 | + | |
917 | +struct ieee80211_hdr_3addr { | |
918 | + u16 frame_ctl; | |
919 | + u16 duration_id; | |
920 | + u8 addr1[ETH_ALEN]; | |
921 | + u8 addr2[ETH_ALEN]; | |
922 | + u8 addr3[ETH_ALEN]; | |
923 | + u16 seq_ctl; | |
924 | +} __attribute__ ((packed)); | |
925 | + | |
926 | +struct ieee80211_hdr_3addr_QOS { | |
927 | + u16 frame_ctl; | |
928 | + u16 duration_id; | |
929 | + u8 addr1[ETH_ALEN]; | |
930 | + u8 addr2[ETH_ALEN]; | |
931 | + u8 addr3[ETH_ALEN]; | |
932 | + u16 seq_ctl; | |
933 | + u16 QOS_ctl; | |
934 | +} __attribute__ ((packed)); | |
935 | + | |
936 | +enum eap_type { | |
937 | + EAP_PACKET = 0, | |
938 | + EAPOL_START, | |
939 | + EAPOL_LOGOFF, | |
940 | + EAPOL_KEY, | |
941 | + EAPOL_ENCAP_ASF_ALERT | |
942 | +}; | |
943 | + | |
944 | +static const char *eap_types[] = { | |
945 | + [EAP_PACKET] = "EAP-Packet", | |
946 | + [EAPOL_START] = "EAPOL-Start", | |
947 | + [EAPOL_LOGOFF] = "EAPOL-Logoff", | |
948 | + [EAPOL_KEY] = "EAPOL-Key", | |
949 | + [EAPOL_ENCAP_ASF_ALERT] = "EAPOL-Encap-ASF-Alert" | |
950 | +}; | |
951 | + | |
952 | +static inline const char *eap_get_type(int type) | |
953 | +{ | |
954 | + return (type >= ARRAY_SIZE(eap_types)) ? "Unknown" : eap_types[type]; | |
955 | +} | |
956 | + | |
957 | +struct eapol { | |
958 | + u8 snap[6]; | |
959 | + u16 ethertype; | |
960 | + u8 version; | |
961 | + u8 type; | |
962 | + u16 length; | |
963 | +} __attribute__ ((packed)); | |
964 | + | |
965 | +#define IEEE80211_3ADDR_LEN 24 | |
966 | +#define IEEE80211_4ADDR_LEN 30 | |
967 | +#define IEEE80211_FCS_LEN 4 | |
968 | + | |
969 | +#define MIN_FRAG_THRESHOLD 256U | |
970 | +#define MAX_FRAG_THRESHOLD 2346U | |
971 | + | |
972 | +/* Frame control field constants */ | |
973 | +#define IEEE80211_FCTL_VERS 0x0002 | |
974 | +#define IEEE80211_FCTL_FTYPE 0x000c | |
975 | +#define IEEE80211_FCTL_STYPE 0x00f0 | |
976 | +#define IEEE80211_FCTL_TODS 0x0100 | |
977 | +#define IEEE80211_FCTL_FROMDS 0x0200 | |
978 | +#define IEEE80211_FCTL_DSTODS 0x0300 //added by david | |
979 | +#define IEEE80211_FCTL_MOREFRAGS 0x0400 | |
980 | +#define IEEE80211_FCTL_RETRY 0x0800 | |
981 | +#define IEEE80211_FCTL_PM 0x1000 | |
982 | +#define IEEE80211_FCTL_MOREDATA 0x2000 | |
983 | +#define IEEE80211_FCTL_WEP 0x4000 | |
984 | +#define IEEE80211_FCTL_ORDER 0x8000 | |
985 | + | |
986 | +#define IEEE80211_FTYPE_MGMT 0x0000 | |
987 | +#define IEEE80211_FTYPE_CTL 0x0004 | |
988 | +#define IEEE80211_FTYPE_DATA 0x0008 | |
989 | + | |
990 | +/* management */ | |
991 | +#define IEEE80211_STYPE_ASSOC_REQ 0x0000 | |
992 | +#define IEEE80211_STYPE_ASSOC_RESP 0x0010 | |
993 | +#define IEEE80211_STYPE_REASSOC_REQ 0x0020 | |
994 | +#define IEEE80211_STYPE_REASSOC_RESP 0x0030 | |
995 | +#define IEEE80211_STYPE_PROBE_REQ 0x0040 | |
996 | +#define IEEE80211_STYPE_PROBE_RESP 0x0050 | |
997 | +#define IEEE80211_STYPE_BEACON 0x0080 | |
998 | +#define IEEE80211_STYPE_ATIM 0x0090 | |
999 | +#define IEEE80211_STYPE_DISASSOC 0x00A0 | |
1000 | +#define IEEE80211_STYPE_AUTH 0x00B0 | |
1001 | +#define IEEE80211_STYPE_DEAUTH 0x00C0 | |
1002 | +#define IEEE80211_STYPE_MANAGE_ACT 0x00D0 | |
1003 | + | |
1004 | +/* control */ | |
1005 | +#define IEEE80211_STYPE_PSPOLL 0x00A0 | |
1006 | +#define IEEE80211_STYPE_RTS 0x00B0 | |
1007 | +#define IEEE80211_STYPE_CTS 0x00C0 | |
1008 | +#define IEEE80211_STYPE_ACK 0x00D0 | |
1009 | +#define IEEE80211_STYPE_CFEND 0x00E0 | |
1010 | +#define IEEE80211_STYPE_CFENDACK 0x00F0 | |
1011 | + | |
1012 | +/* data */ | |
1013 | +#define IEEE80211_STYPE_DATA 0x0000 | |
1014 | +#define IEEE80211_STYPE_DATA_CFACK 0x0010 | |
1015 | +#define IEEE80211_STYPE_DATA_CFPOLL 0x0020 | |
1016 | +#define IEEE80211_STYPE_DATA_CFACKPOLL 0x0030 | |
1017 | +#define IEEE80211_STYPE_NULLFUNC 0x0040 | |
1018 | +#define IEEE80211_STYPE_CFACK 0x0050 | |
1019 | +#define IEEE80211_STYPE_CFPOLL 0x0060 | |
1020 | +#define IEEE80211_STYPE_CFACKPOLL 0x0070 | |
1021 | +#define IEEE80211_STYPE_QOS_DATA 0x0080 //added for WMM 2006/8/2 | |
1022 | +#define IEEE80211_STYPE_QOS_NULL 0x00C0 | |
1023 | + | |
1024 | + | |
1025 | +#define IEEE80211_SCTL_FRAG 0x000F | |
1026 | +#define IEEE80211_SCTL_SEQ 0xFFF0 | |
1027 | + | |
1028 | + | |
1029 | +/* debug macros */ | |
1030 | + | |
1031 | +#ifdef CONFIG_IEEE80211_DEBUG | |
1032 | +extern u32 ieee80211_debug_level; | |
1033 | +#define IEEE80211_DEBUG(level, fmt, args...) \ | |
1034 | +do { if (ieee80211_debug_level & (level)) \ | |
1035 | + printk(KERN_DEBUG "ieee80211: %c %s " fmt, \ | |
1036 | + in_interrupt() ? 'I' : 'U', __FUNCTION__ , ## args); } while (0) | |
1037 | +#else | |
1038 | +#define IEEE80211_DEBUG(level, fmt, args...) do {} while (0) | |
1039 | +#endif /* CONFIG_IEEE80211_DEBUG */ | |
1040 | + | |
1041 | +/* | |
1042 | + * To use the debug system; | |
1043 | + * | |
1044 | + * If you are defining a new debug classification, simply add it to the #define | |
1045 | + * list here in the form of: | |
1046 | + * | |
1047 | + * #define IEEE80211_DL_xxxx VALUE | |
1048 | + * | |
1049 | + * shifting value to the left one bit from the previous entry. xxxx should be | |
1050 | + * the name of the classification (for example, WEP) | |
1051 | + * | |
1052 | + * You then need to either add a IEEE80211_xxxx_DEBUG() macro definition for your | |
1053 | + * classification, or use IEEE80211_DEBUG(IEEE80211_DL_xxxx, ...) whenever you want | |
1054 | + * to send output to that classification. | |
1055 | + * | |
1056 | + * To add your debug level to the list of levels seen when you perform | |
1057 | + * | |
1058 | + * % cat /proc/net/ipw/debug_level | |
1059 | + * | |
1060 | + * you simply need to add your entry to the ipw_debug_levels array. | |
1061 | + * | |
1062 | + * If you do not see debug_level in /proc/net/ipw then you do not have | |
1063 | + * CONFIG_IEEE80211_DEBUG defined in your kernel configuration | |
1064 | + * | |
1065 | + */ | |
1066 | + | |
1067 | +#define IEEE80211_DL_INFO (1<<0) | |
1068 | +#define IEEE80211_DL_WX (1<<1) | |
1069 | +#define IEEE80211_DL_SCAN (1<<2) | |
1070 | +#define IEEE80211_DL_STATE (1<<3) | |
1071 | +#define IEEE80211_DL_MGMT (1<<4) | |
1072 | +#define IEEE80211_DL_FRAG (1<<5) | |
1073 | +#define IEEE80211_DL_EAP (1<<6) | |
1074 | +#define IEEE80211_DL_DROP (1<<7) | |
1075 | + | |
1076 | +#define IEEE80211_DL_TX (1<<8) | |
1077 | +#define IEEE80211_DL_RX (1<<9) | |
1078 | + | |
1079 | +#define IEEE80211_ERROR(f, a...) printk(KERN_ERR "ieee80211: " f, ## a) | |
1080 | +#define IEEE80211_WARNING(f, a...) printk(KERN_WARNING "ieee80211: " f, ## a) | |
1081 | +#define IEEE80211_DEBUG_INFO(f, a...) IEEE80211_DEBUG(IEEE80211_DL_INFO, f, ## a) | |
1082 | + | |
1083 | +#define IEEE80211_DEBUG_WX(f, a...) IEEE80211_DEBUG(IEEE80211_DL_WX, f, ## a) | |
1084 | +#define IEEE80211_DEBUG_SCAN(f, a...) IEEE80211_DEBUG(IEEE80211_DL_SCAN, f, ## a) | |
1085 | +//#define IEEE_DEBUG_SCAN IEEE80211_WARNING | |
1086 | +#define IEEE80211_DEBUG_STATE(f, a...) IEEE80211_DEBUG(IEEE80211_DL_STATE, f, ## a) | |
1087 | +#define IEEE80211_DEBUG_MGMT(f, a...) IEEE80211_DEBUG(IEEE80211_DL_MGMT, f, ## a) | |
1088 | +#define IEEE80211_DEBUG_FRAG(f, a...) IEEE80211_DEBUG(IEEE80211_DL_FRAG, f, ## a) | |
1089 | +#define IEEE80211_DEBUG_EAP(f, a...) IEEE80211_DEBUG(IEEE80211_DL_EAP, f, ## a) | |
1090 | +#define IEEE80211_DEBUG_DROP(f, a...) IEEE80211_DEBUG(IEEE80211_DL_DROP, f, ## a) | |
1091 | +#define IEEE80211_DEBUG_TX(f, a...) IEEE80211_DEBUG(IEEE80211_DL_TX, f, ## a) | |
1092 | +#define IEEE80211_DEBUG_RX(f, a...) IEEE80211_DEBUG(IEEE80211_DL_RX, f, ## a) | |
1093 | +#include <linux/netdevice.h> | |
1094 | +#include <linux/wireless.h> | |
1095 | +#include <linux/if_arp.h> /* ARPHRD_ETHER */ | |
1096 | + | |
1097 | +#ifndef WIRELESS_SPY | |
1098 | +#define WIRELESS_SPY // enable iwspy support | |
1099 | +#endif | |
1100 | +#include <net/iw_handler.h> // new driver API | |
1101 | + | |
1102 | +#ifndef ETH_P_PAE | |
1103 | +#define ETH_P_PAE 0x888E /* Port Access Entity (IEEE 802.1X) */ | |
1104 | +#endif /* ETH_P_PAE */ | |
1105 | + | |
1106 | +#define ETH_P_PREAUTH 0x88C7 /* IEEE 802.11i pre-authentication */ | |
1107 | + | |
1108 | +#ifndef ETH_P_80211_RAW | |
1109 | +#define ETH_P_80211_RAW (ETH_P_ECONET + 1) | |
1110 | +#endif | |
1111 | + | |
1112 | +/* IEEE 802.11 defines */ | |
1113 | + | |
1114 | +#define P80211_OUI_LEN 3 | |
1115 | + | |
1116 | +struct ieee80211_snap_hdr { | |
1117 | + | |
1118 | + u8 dsap; /* always 0xAA */ | |
1119 | + u8 ssap; /* always 0xAA */ | |
1120 | + u8 ctrl; /* always 0x03 */ | |
1121 | + u8 oui[P80211_OUI_LEN]; /* organizational universal id */ | |
1122 | + | |
1123 | +} __attribute__ ((packed)); | |
1124 | + | |
1125 | +#define SNAP_SIZE sizeof(struct ieee80211_snap_hdr) | |
1126 | + | |
1127 | +#define WLAN_FC_GET_TYPE(fc) ((fc) & IEEE80211_FCTL_FTYPE) | |
1128 | +#define WLAN_FC_GET_STYPE(fc) ((fc) & IEEE80211_FCTL_STYPE) | |
1129 | + | |
1130 | +#define WLAN_GET_SEQ_FRAG(seq) ((seq) & IEEE80211_SCTL_FRAG) | |
1131 | +#define WLAN_GET_SEQ_SEQ(seq) ((seq) & IEEE80211_SCTL_SEQ) | |
1132 | + | |
1133 | +/* Authentication algorithms */ | |
1134 | +#define WLAN_AUTH_OPEN 0 | |
1135 | +#define WLAN_AUTH_SHARED_KEY 1 | |
1136 | + | |
1137 | +#define WLAN_AUTH_CHALLENGE_LEN 128 | |
1138 | + | |
1139 | +#define WLAN_CAPABILITY_BSS (1<<0) | |
1140 | +#define WLAN_CAPABILITY_IBSS (1<<1) | |
1141 | +#define WLAN_CAPABILITY_CF_POLLABLE (1<<2) | |
1142 | +#define WLAN_CAPABILITY_CF_POLL_REQUEST (1<<3) | |
1143 | +#define WLAN_CAPABILITY_PRIVACY (1<<4) | |
1144 | +#define WLAN_CAPABILITY_SHORT_PREAMBLE (1<<5) | |
1145 | +#define WLAN_CAPABILITY_PBCC (1<<6) | |
1146 | +#define WLAN_CAPABILITY_CHANNEL_AGILITY (1<<7) | |
1147 | +#define WLAN_CAPABILITY_SHORT_SLOT (1<<10) | |
1148 | + | |
1149 | +/* Status codes */ | |
1150 | +#define WLAN_STATUS_SUCCESS 0 | |
1151 | +#define WLAN_STATUS_UNSPECIFIED_FAILURE 1 | |
1152 | +#define WLAN_STATUS_CAPS_UNSUPPORTED 10 | |
1153 | +#define WLAN_STATUS_REASSOC_NO_ASSOC 11 | |
1154 | +#define WLAN_STATUS_ASSOC_DENIED_UNSPEC 12 | |
1155 | +#define WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG 13 | |
1156 | +#define WLAN_STATUS_UNKNOWN_AUTH_TRANSACTION 14 | |
1157 | +#define WLAN_STATUS_CHALLENGE_FAIL 15 | |
1158 | +#define WLAN_STATUS_AUTH_TIMEOUT 16 | |
1159 | +#define WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA 17 | |
1160 | +#define WLAN_STATUS_ASSOC_DENIED_RATES 18 | |
1161 | +/* 802.11b */ | |
1162 | +#define WLAN_STATUS_ASSOC_DENIED_NOSHORT 19 | |
1163 | +#define WLAN_STATUS_ASSOC_DENIED_NOPBCC 20 | |
1164 | +#define WLAN_STATUS_ASSOC_DENIED_NOAGILITY 21 | |
1165 | + | |
1166 | +/* Reason codes */ | |
1167 | +#define WLAN_REASON_UNSPECIFIED 1 | |
1168 | +#define WLAN_REASON_PREV_AUTH_NOT_VALID 2 | |
1169 | +#define WLAN_REASON_DEAUTH_LEAVING 3 | |
1170 | +#define WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY 4 | |
1171 | +#define WLAN_REASON_DISASSOC_AP_BUSY 5 | |
1172 | +#define WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA 6 | |
1173 | +#define WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA 7 | |
1174 | +#define WLAN_REASON_DISASSOC_STA_HAS_LEFT 8 | |
1175 | +#define WLAN_REASON_STA_REQ_ASSOC_WITHOUT_AUTH 9 | |
1176 | + | |
1177 | + | |
1178 | +/* Information Element IDs */ | |
1179 | +#define WLAN_EID_SSID 0 | |
1180 | +#define WLAN_EID_SUPP_RATES 1 | |
1181 | +#define WLAN_EID_FH_PARAMS 2 | |
1182 | +#define WLAN_EID_DS_PARAMS 3 | |
1183 | +#define WLAN_EID_CF_PARAMS 4 | |
1184 | +#define WLAN_EID_TIM 5 | |
1185 | +#define WLAN_EID_IBSS_PARAMS 6 | |
1186 | +#define WLAN_EID_CHALLENGE 16 | |
1187 | +#define WLAN_EID_RSN 48 | |
1188 | +#define WLAN_EID_GENERIC 221 | |
1189 | + | |
1190 | +#define IEEE80211_MGMT_HDR_LEN 24 | |
1191 | +#define IEEE80211_DATA_HDR3_LEN 24 | |
1192 | +#define IEEE80211_DATA_HDR4_LEN 30 | |
1193 | + | |
1194 | + | |
1195 | +#define IEEE80211_STATMASK_SIGNAL (1<<0) | |
1196 | +#define IEEE80211_STATMASK_RSSI (1<<1) | |
1197 | +#define IEEE80211_STATMASK_NOISE (1<<2) | |
1198 | +#define IEEE80211_STATMASK_RATE (1<<3) | |
1199 | +#define IEEE80211_STATMASK_WEMASK 0x7 | |
1200 | + | |
1201 | + | |
1202 | +#define IEEE80211_CCK_MODULATION (1<<0) | |
1203 | +#define IEEE80211_OFDM_MODULATION (1<<1) | |
1204 | + | |
1205 | +#define IEEE80211_24GHZ_BAND (1<<0) | |
1206 | +#define IEEE80211_52GHZ_BAND (1<<1) | |
1207 | + | |
1208 | +#define IEEE80211_CCK_RATE_LEN 4 | |
1209 | +#define IEEE80211_CCK_RATE_1MB 0x02 | |
1210 | +#define IEEE80211_CCK_RATE_2MB 0x04 | |
1211 | +#define IEEE80211_CCK_RATE_5MB 0x0B | |
1212 | +#define IEEE80211_CCK_RATE_11MB 0x16 | |
1213 | +#define IEEE80211_OFDM_RATE_LEN 8 | |
1214 | +#define IEEE80211_OFDM_RATE_6MB 0x0C | |
1215 | +#define IEEE80211_OFDM_RATE_9MB 0x12 | |
1216 | +#define IEEE80211_OFDM_RATE_12MB 0x18 | |
1217 | +#define IEEE80211_OFDM_RATE_18MB 0x24 | |
1218 | +#define IEEE80211_OFDM_RATE_24MB 0x30 | |
1219 | +#define IEEE80211_OFDM_RATE_36MB 0x48 | |
1220 | +#define IEEE80211_OFDM_RATE_48MB 0x60 | |
1221 | +#define IEEE80211_OFDM_RATE_54MB 0x6C | |
1222 | +#define IEEE80211_BASIC_RATE_MASK 0x80 | |
1223 | + | |
1224 | +#define IEEE80211_CCK_RATE_1MB_MASK (1<<0) | |
1225 | +#define IEEE80211_CCK_RATE_2MB_MASK (1<<1) | |
1226 | +#define IEEE80211_CCK_RATE_5MB_MASK (1<<2) | |
1227 | +#define IEEE80211_CCK_RATE_11MB_MASK (1<<3) | |
1228 | +#define IEEE80211_OFDM_RATE_6MB_MASK (1<<4) | |
1229 | +#define IEEE80211_OFDM_RATE_9MB_MASK (1<<5) | |
1230 | +#define IEEE80211_OFDM_RATE_12MB_MASK (1<<6) | |
1231 | +#define IEEE80211_OFDM_RATE_18MB_MASK (1<<7) | |
1232 | +#define IEEE80211_OFDM_RATE_24MB_MASK (1<<8) | |
1233 | +#define IEEE80211_OFDM_RATE_36MB_MASK (1<<9) | |
1234 | +#define IEEE80211_OFDM_RATE_48MB_MASK (1<<10) | |
1235 | +#define IEEE80211_OFDM_RATE_54MB_MASK (1<<11) | |
1236 | + | |
1237 | +#define IEEE80211_CCK_RATES_MASK 0x0000000F | |
1238 | +#define IEEE80211_CCK_BASIC_RATES_MASK (IEEE80211_CCK_RATE_1MB_MASK | \ | |
1239 | + IEEE80211_CCK_RATE_2MB_MASK) | |
1240 | +#define IEEE80211_CCK_DEFAULT_RATES_MASK (IEEE80211_CCK_BASIC_RATES_MASK | \ | |
1241 | + IEEE80211_CCK_RATE_5MB_MASK | \ | |
1242 | + IEEE80211_CCK_RATE_11MB_MASK) | |
1243 | + | |
1244 | +#define IEEE80211_OFDM_RATES_MASK 0x00000FF0 | |
1245 | +#define IEEE80211_OFDM_BASIC_RATES_MASK (IEEE80211_OFDM_RATE_6MB_MASK | \ | |
1246 | + IEEE80211_OFDM_RATE_12MB_MASK | \ | |
1247 | + IEEE80211_OFDM_RATE_24MB_MASK) | |
1248 | +#define IEEE80211_OFDM_DEFAULT_RATES_MASK (IEEE80211_OFDM_BASIC_RATES_MASK | \ | |
1249 | + IEEE80211_OFDM_RATE_9MB_MASK | \ | |
1250 | + IEEE80211_OFDM_RATE_18MB_MASK | \ | |
1251 | + IEEE80211_OFDM_RATE_36MB_MASK | \ | |
1252 | + IEEE80211_OFDM_RATE_48MB_MASK | \ | |
1253 | + IEEE80211_OFDM_RATE_54MB_MASK) | |
1254 | +#define IEEE80211_DEFAULT_RATES_MASK (IEEE80211_OFDM_DEFAULT_RATES_MASK | \ | |
1255 | + IEEE80211_CCK_DEFAULT_RATES_MASK) | |
1256 | + | |
1257 | +#define IEEE80211_NUM_OFDM_RATES 8 | |
1258 | +#define IEEE80211_NUM_CCK_RATES 4 | |
1259 | +#define IEEE80211_OFDM_SHIFT_MASK_A 4 | |
1260 | + | |
1261 | + | |
1262 | + | |
1263 | + | |
1264 | +/* NOTE: This data is for statistical purposes; not all hardware provides this | |
1265 | + * information for frames received. Not setting these will not cause | |
1266 | + * any adverse affects. */ | |
1267 | +struct ieee80211_rx_stats { | |
1268 | + u32 mac_time[2]; | |
1269 | + u8 signalstrength; | |
1270 | + s8 rssi; | |
1271 | + u8 signal; | |
1272 | + u8 noise; | |
1273 | + u16 rate; /* in 100 kbps */ | |
1274 | + u8 received_channel; | |
1275 | + u8 control; | |
1276 | + u8 mask; | |
1277 | + u8 freq; | |
1278 | + u16 len; | |
1279 | + u8 nic_type; | |
1280 | +}; | |
1281 | + | |
1282 | +/* IEEE 802.11 requires that STA supports concurrent reception of at least | |
1283 | + * three fragmented frames. This define can be increased to support more | |
1284 | + * concurrent frames, but it should be noted that each entry can consume about | |
1285 | + * 2 kB of RAM and increasing cache size will slow down frame reassembly. */ | |
1286 | +#define IEEE80211_FRAG_CACHE_LEN 4 | |
1287 | + | |
1288 | +struct ieee80211_frag_entry { | |
1289 | + unsigned long first_frag_time; | |
1290 | + unsigned int seq; | |
1291 | + unsigned int last_frag; | |
1292 | + struct sk_buff *skb; | |
1293 | + u8 src_addr[ETH_ALEN]; | |
1294 | + u8 dst_addr[ETH_ALEN]; | |
1295 | +}; | |
1296 | + | |
1297 | +struct ieee80211_stats { | |
1298 | + unsigned int tx_unicast_frames; | |
1299 | + unsigned int tx_multicast_frames; | |
1300 | + unsigned int tx_fragments; | |
1301 | + unsigned int tx_unicast_octets; | |
1302 | + unsigned int tx_multicast_octets; | |
1303 | + unsigned int tx_deferred_transmissions; | |
1304 | + unsigned int tx_single_retry_frames; | |
1305 | + unsigned int tx_multiple_retry_frames; | |
1306 | + unsigned int tx_retry_limit_exceeded; | |
1307 | + unsigned int tx_discards; | |
1308 | + unsigned int rx_unicast_frames; | |
1309 | + unsigned int rx_multicast_frames; | |
1310 | + unsigned int rx_fragments; | |
1311 | + unsigned int rx_unicast_octets; | |
1312 | + unsigned int rx_multicast_octets; | |
1313 | + unsigned int rx_fcs_errors; | |
1314 | + unsigned int rx_discards_no_buffer; | |
1315 | + unsigned int tx_discards_wrong_sa; | |
1316 | + unsigned int rx_discards_undecryptable; | |
1317 | + unsigned int rx_message_in_msg_fragments; | |
1318 | + unsigned int rx_message_in_bad_msg_fragments; | |
1319 | +}; | |
1320 | + | |
1321 | +struct ieee80211_softmac_stats{ | |
1322 | + unsigned int rx_ass_ok; | |
1323 | + unsigned int rx_ass_err; | |
1324 | + unsigned int rx_probe_rq; | |
1325 | + unsigned int tx_probe_rs; | |
1326 | + unsigned int tx_beacons; | |
1327 | + unsigned int rx_auth_rq; | |
1328 | + unsigned int rx_auth_rs_ok; | |
1329 | + unsigned int rx_auth_rs_err; | |
1330 | + unsigned int tx_auth_rq; | |
1331 | + unsigned int no_auth_rs; | |
1332 | + unsigned int no_ass_rs; | |
1333 | + unsigned int tx_ass_rq; | |
1334 | + unsigned int rx_ass_rq; | |
1335 | + unsigned int tx_probe_rq; | |
1336 | + unsigned int reassoc; | |
1337 | + unsigned int swtxstop; | |
1338 | + unsigned int swtxawake; | |
1339 | +}; | |
1340 | + | |
1341 | +struct ieee80211_device; | |
1342 | + | |
1343 | +#include "ieee80211_crypt.h" | |
1344 | + | |
1345 | +#define SEC_KEY_1 (1<<0) | |
1346 | +#define SEC_KEY_2 (1<<1) | |
1347 | +#define SEC_KEY_3 (1<<2) | |
1348 | +#define SEC_KEY_4 (1<<3) | |
1349 | +#define SEC_ACTIVE_KEY (1<<4) | |
1350 | +#define SEC_AUTH_MODE (1<<5) | |
1351 | +#define SEC_UNICAST_GROUP (1<<6) | |
1352 | +#define SEC_LEVEL (1<<7) | |
1353 | +#define SEC_ENABLED (1<<8) | |
1354 | + | |
1355 | +#define SEC_LEVEL_0 0 /* None */ | |
1356 | +#define SEC_LEVEL_1 1 /* WEP 40 and 104 bit */ | |
1357 | +#define SEC_LEVEL_2 2 /* Level 1 + TKIP */ | |
1358 | +#define SEC_LEVEL_2_CKIP 3 /* Level 1 + CKIP */ | |
1359 | +#define SEC_LEVEL_3 4 /* Level 2 + CCMP */ | |
1360 | + | |
1361 | +#define WEP_KEYS 4 | |
1362 | +#define WEP_KEY_LEN 13 | |
1363 | + | |
1364 | +#define WEP_KEY_LEN_MODIF 32 | |
1365 | + | |
1366 | +struct ieee80211_security { | |
1367 | + u16 active_key:2, | |
1368 | + enabled:1, | |
1369 | + auth_mode:2, | |
1370 | + auth_algo:4, | |
1371 | + unicast_uses_group:1; | |
1372 | + u8 key_sizes[WEP_KEYS]; | |
1373 | + u8 keys[WEP_KEYS][WEP_KEY_LEN_MODIF]; | |
1374 | + u8 level; | |
1375 | + u16 flags; | |
1376 | +} __attribute__ ((packed)); | |
1377 | + | |
1378 | + | |
1379 | +/* | |
1380 | + | |
1381 | + 802.11 data frame from AP | |
1382 | + | |
1383 | + ,-------------------------------------------------------------------. | |
1384 | +Bytes | 2 | 2 | 6 | 6 | 6 | 2 | 0..2312 | 4 | | |
1385 | + |------|------|---------|---------|---------|------|---------|------| | |
1386 | +Desc. | ctrl | dura | DA/RA | TA | SA | Sequ | frame | fcs | | |
1387 | + | | tion | (BSSID) | | | ence | data | | | |
1388 | + `-------------------------------------------------------------------' | |
1389 | + | |
1390 | +Total: 28-2340 bytes | |
1391 | + | |
1392 | +*/ | |
1393 | + | |
1394 | +struct ieee80211_header_data { | |
1395 | + u16 frame_ctl; | |
1396 | + u16 duration_id; | |
1397 | + u8 addr1[6]; | |
1398 | + u8 addr2[6]; | |
1399 | + u8 addr3[6]; | |
1400 | + u16 seq_ctrl; | |
1401 | +}; | |
1402 | + | |
1403 | +#define BEACON_PROBE_SSID_ID_POSITION 12 | |
1404 | + | |
1405 | +/* Management Frame Information Element Types */ | |
1406 | +#define MFIE_TYPE_SSID 0 | |
1407 | +#define MFIE_TYPE_RATES 1 | |
1408 | +#define MFIE_TYPE_FH_SET 2 | |
1409 | +#define MFIE_TYPE_DS_SET 3 | |
1410 | +#define MFIE_TYPE_CF_SET 4 | |
1411 | +#define MFIE_TYPE_TIM 5 | |
1412 | +#define MFIE_TYPE_IBSS_SET 6 | |
1413 | +#define MFIE_TYPE_COUNTRY 7 //+YJ,080625 | |
1414 | +#define MFIE_TYPE_CHALLENGE 16 | |
1415 | +#define MFIE_TYPE_ERP 42 | |
1416 | +#define MFIE_TYPE_RSN 48 | |
1417 | +#define MFIE_TYPE_RATES_EX 50 | |
1418 | +#define MFIE_TYPE_GENERIC 221 | |
1419 | + | |
1420 | +#ifdef ENABLE_DOT11D | |
1421 | +typedef enum | |
1422 | +{ | |
1423 | + COUNTRY_CODE_FCC = 0, | |
1424 | + COUNTRY_CODE_IC = 1, | |
1425 | + COUNTRY_CODE_ETSI = 2, | |
1426 | + COUNTRY_CODE_SPAIN = 3, | |
1427 | + COUNTRY_CODE_FRANCE = 4, | |
1428 | + COUNTRY_CODE_MKK = 5, | |
1429 | + COUNTRY_CODE_MKK1 = 6, | |
1430 | + COUNTRY_CODE_ISRAEL = 7, | |
1431 | + COUNTRY_CODE_TELEC = 8, | |
1432 | + COUNTRY_CODE_GLOBAL_DOMAIN = 9, | |
1433 | + COUNTRY_CODE_WORLD_WIDE_13_INDEX = 10 | |
1434 | +}country_code_type_t; | |
1435 | +#endif | |
1436 | + | |
1437 | +struct ieee80211_info_element_hdr { | |
1438 | + u8 id; | |
1439 | + u8 len; | |
1440 | +} __attribute__ ((packed)); | |
1441 | + | |
1442 | +struct ieee80211_info_element { | |
1443 | + u8 id; | |
1444 | + u8 len; | |
1445 | + u8 data[0]; | |
1446 | +} __attribute__ ((packed)); | |
1447 | + | |
1448 | +/* | |
1449 | + * These are the data types that can make up management packets | |
1450 | + * | |
1451 | + u16 auth_algorithm; | |
1452 | + u16 auth_sequence; | |
1453 | + u16 beacon_interval; | |
1454 | + u16 capability; | |
1455 | + u8 current_ap[ETH_ALEN]; | |
1456 | + u16 listen_interval; | |
1457 | + struct { | |
1458 | + u16 association_id:14, reserved:2; | |
1459 | + } __attribute__ ((packed)); | |
1460 | + u32 time_stamp[2]; | |
1461 | + u16 reason; | |
1462 | + u16 status; | |
1463 | +*/ | |
1464 | + | |
1465 | +#define IEEE80211_DEFAULT_TX_ESSID "Penguin" | |
1466 | +#define IEEE80211_DEFAULT_BASIC_RATE 10 | |
1467 | + | |
1468 | +struct ieee80211_authentication { | |
1469 | + struct ieee80211_header_data header; | |
1470 | + u16 algorithm; | |
1471 | + u16 transaction; | |
1472 | + u16 status; | |
1473 | + //struct ieee80211_info_element_hdr info_element; | |
1474 | +} __attribute__ ((packed)); | |
1475 | + | |
1476 | + | |
1477 | +struct ieee80211_probe_response { | |
1478 | + struct ieee80211_header_data header; | |
1479 | + u32 time_stamp[2]; | |
1480 | + u16 beacon_interval; | |
1481 | + u16 capability; | |
1482 | + struct ieee80211_info_element info_element; | |
1483 | +} __attribute__ ((packed)); | |
1484 | + | |
1485 | +struct ieee80211_probe_request { | |
1486 | + struct ieee80211_header_data header; | |
1487 | + /*struct ieee80211_info_element info_element;*/ | |
1488 | +} __attribute__ ((packed)); | |
1489 | + | |
1490 | +struct ieee80211_assoc_request_frame { | |
1491 | + struct ieee80211_hdr_3addr header; | |
1492 | + u16 capability; | |
1493 | + u16 listen_interval; | |
1494 | + //u8 current_ap[ETH_ALEN]; | |
1495 | + struct ieee80211_info_element_hdr info_element; | |
1496 | +} __attribute__ ((packed)); | |
1497 | + | |
1498 | +struct ieee80211_assoc_response_frame { | |
1499 | + struct ieee80211_hdr_3addr header; | |
1500 | + u16 capability; | |
1501 | + u16 status; | |
1502 | + u16 aid; | |
1503 | + struct ieee80211_info_element info_element; /* supported rates */ | |
1504 | +} __attribute__ ((packed)); | |
1505 | + | |
1506 | +struct ieee80211_disassoc_frame{ | |
1507 | + struct ieee80211_hdr_3addr header; | |
1508 | + u16 reasoncode; | |
1509 | +}__attribute__ ((packed)); | |
1510 | + | |
1511 | +struct ieee80211_txb { | |
1512 | + u8 nr_frags; | |
1513 | + u8 encrypted; | |
1514 | + u16 reserved; | |
1515 | + u16 frag_size; | |
1516 | + u16 payload_size; | |
1517 | + struct sk_buff *fragments[0]; | |
1518 | +}; | |
1519 | + | |
1520 | +struct ieee80211_wmm_ac_param { | |
1521 | + u8 ac_aci_acm_aifsn; | |
1522 | + u8 ac_ecwmin_ecwmax; | |
1523 | + u16 ac_txop_limit; | |
1524 | +}; | |
1525 | + | |
1526 | +struct ieee80211_wmm_ts_info { | |
1527 | + u8 ac_dir_tid; | |
1528 | + u8 ac_up_psb; | |
1529 | + u8 reserved; | |
1530 | +} __attribute__ ((packed)); | |
1531 | + | |
1532 | +struct ieee80211_wmm_tspec_elem { | |
1533 | + struct ieee80211_wmm_ts_info ts_info; | |
1534 | + u16 norm_msdu_size; | |
1535 | + u16 max_msdu_size; | |
1536 | + u32 min_serv_inter; | |
1537 | + u32 max_serv_inter; | |
1538 | + u32 inact_inter; | |
1539 | + u32 suspen_inter; | |
1540 | + u32 serv_start_time; | |
1541 | + u32 min_data_rate; | |
1542 | + u32 mean_data_rate; | |
1543 | + u32 peak_data_rate; | |
1544 | + u32 max_burst_size; | |
1545 | + u32 delay_bound; | |
1546 | + u32 min_phy_rate; | |
1547 | + u16 surp_band_allow; | |
1548 | + u16 medium_time; | |
1549 | +}__attribute__((packed)); | |
1550 | + | |
1551 | +enum {WMM_all_frame, WMM_two_frame, WMM_four_frame, WMM_six_frame}; | |
1552 | +#define MAX_SP_Len (WMM_all_frame << 4) | |
1553 | +#define IEEE80211_QOS_TID 0x0f | |
1554 | +#define QOS_CTL_NOTCONTAIN_ACK (0x01 << 5) | |
1555 | + | |
1556 | +/* SWEEP TABLE ENTRIES NUMBER*/ | |
1557 | +#define MAX_SWEEP_TAB_ENTRIES 42 | |
1558 | +#define MAX_SWEEP_TAB_ENTRIES_PER_PACKET 7 | |
1559 | +/* MAX_RATES_LENGTH needs to be 12. The spec says 8, and many APs | |
1560 | + * only use 8, and then use extended rates for the remaining supported | |
1561 | + * rates. Other APs, however, stick all of their supported rates on the | |
1562 | + * main rates information element... */ | |
1563 | +#define MAX_RATES_LENGTH ((u8)12) | |
1564 | +#define MAX_RATES_EX_LENGTH ((u8)16) | |
1565 | +#define MAX_NETWORK_COUNT 128 | |
1566 | +//#define MAX_CHANNEL_NUMBER 161 | |
1567 | +#define MAX_CHANNEL_NUMBER 165 //YJ,modified,080625 | |
1568 | +#define MAX_IE_LEN 0xFF //+YJ,080625 | |
1569 | + | |
1570 | +typedef struct _CHANNEL_LIST{ | |
1571 | + u8 Channel[MAX_CHANNEL_NUMBER + 1]; | |
1572 | + u8 Len; | |
1573 | +}CHANNEL_LIST, *PCHANNEL_LIST; | |
1574 | + | |
1575 | +#define IEEE80211_SOFTMAC_SCAN_TIME 100//400 | |
1576 | +//(HZ / 2) | |
1577 | +//by amy for ps | |
1578 | +#define IEEE80211_WATCH_DOG_TIME 2000 | |
1579 | +//by amy for ps | |
1580 | +//by amy for antenna | |
1581 | +#define ANTENNA_DIVERSITY_TIMER_PERIOD 1000 // 1000 m | |
1582 | +//by amy for antenna | |
1583 | +#define IEEE80211_SOFTMAC_ASSOC_RETRY_TIME (HZ * 2) | |
1584 | + | |
1585 | +#define CRC_LENGTH 4U | |
1586 | + | |
1587 | +#define MAX_WPA_IE_LEN 64 | |
1588 | + | |
1589 | +#define NETWORK_EMPTY_ESSID (1<<0) | |
1590 | +#define NETWORK_HAS_OFDM (1<<1) | |
1591 | +#define NETWORK_HAS_CCK (1<<2) | |
1592 | + | |
1593 | +#define IEEE80211_DTIM_MBCAST 4 | |
1594 | +#define IEEE80211_DTIM_UCAST 2 | |
1595 | +#define IEEE80211_DTIM_VALID 1 | |
1596 | +#define IEEE80211_DTIM_INVALID 0 | |
1597 | + | |
1598 | +#define IEEE80211_PS_DISABLED 0 | |
1599 | +#define IEEE80211_PS_UNICAST IEEE80211_DTIM_UCAST | |
1600 | +#define IEEE80211_PS_MBCAST IEEE80211_DTIM_MBCAST | |
1601 | +#define IEEE80211_PS_ENABLE IEEE80211_DTIM_VALID | |
1602 | +//added by David for QoS 2006/6/30 | |
1603 | +//#define WMM_Hang_8187 | |
1604 | +#ifdef WMM_Hang_8187 | |
1605 | +#undef WMM_Hang_8187 | |
1606 | +#endif | |
1607 | + | |
1608 | +#define WME_AC_BE 0x00 | |
1609 | +#define WME_AC_BK 0x01 | |
1610 | +#define WME_AC_VI 0x02 | |
1611 | +#define WME_AC_VO 0x03 | |
1612 | +#define WME_ACI_MASK 0x03 | |
1613 | +#define WME_AIFSN_MASK 0x03 | |
1614 | +#define WME_AC_PRAM_LEN 16 | |
1615 | + | |
1616 | +//UP Mapping to AC, using in MgntQuery_SequenceNumber() and maybe for DSCP | |
1617 | +//#define UP2AC(up) ((up<3) ? ((up==0)?1:0) : (up>>1)) | |
1618 | +#define UP2AC(up) ( \ | |
1619 | + ((up) < 1) ? WME_AC_BE : \ | |
1620 | + ((up) < 3) ? WME_AC_BK : \ | |
1621 | + ((up) < 4) ? WME_AC_BE : \ | |
1622 | + ((up) < 6) ? WME_AC_VI : \ | |
1623 | + WME_AC_VO) | |
1624 | +//AC Mapping to UP, using in Tx part for selecting the corresponding TX queue | |
1625 | +#define AC2UP(_ac) ( \ | |
1626 | + ((_ac) == WME_AC_VO) ? 6 : \ | |
1627 | + ((_ac) == WME_AC_VI) ? 5 : \ | |
1628 | + ((_ac) == WME_AC_BK) ? 1 : \ | |
1629 | + 0) | |
1630 | + | |
1631 | +#define ETHER_ADDR_LEN 6 /* length of an Ethernet address */ | |
1632 | +struct ether_header { | |
1633 | + u8 ether_dhost[ETHER_ADDR_LEN]; | |
1634 | + u8 ether_shost[ETHER_ADDR_LEN]; | |
1635 | + u16 ether_type; | |
1636 | +} __attribute__((packed)); | |
1637 | + | |
1638 | +#ifndef ETHERTYPE_PAE | |
1639 | +#define ETHERTYPE_PAE 0x888e /* EAPOL PAE/802.1x */ | |
1640 | +#endif | |
1641 | +#ifndef ETHERTYPE_IP | |
1642 | +#define ETHERTYPE_IP 0x0800 /* IP protocol */ | |
1643 | +#endif | |
1644 | + | |
1645 | +struct ieee80211_network { | |
1646 | + /* These entries are used to identify a unique network */ | |
1647 | + u8 bssid[ETH_ALEN]; | |
1648 | + u8 channel; | |
1649 | + /* Ensure null-terminated for any debug msgs */ | |
1650 | + u8 ssid[IW_ESSID_MAX_SIZE + 1]; | |
1651 | + u8 ssid_len; | |
1652 | + | |
1653 | + /* These are network statistics */ | |
1654 | + struct ieee80211_rx_stats stats; | |
1655 | + u16 capability; | |
1656 | + u8 rates[MAX_RATES_LENGTH]; | |
1657 | + u8 rates_len; | |
1658 | + u8 rates_ex[MAX_RATES_EX_LENGTH]; | |
1659 | + u8 rates_ex_len; | |
1660 | + unsigned long last_scanned; | |
1661 | + u8 mode; | |
1662 | + u8 flags; | |
1663 | + u32 last_associate; | |
1664 | + u32 time_stamp[2]; | |
1665 | + u16 beacon_interval; | |
1666 | + u16 listen_interval; | |
1667 | + u16 atim_window; | |
1668 | + u8 wpa_ie[MAX_WPA_IE_LEN]; | |
1669 | + size_t wpa_ie_len; | |
1670 | + u8 rsn_ie[MAX_WPA_IE_LEN]; | |
1671 | + size_t rsn_ie_len; | |
1672 | + u8 dtim_period; | |
1673 | + u8 dtim_data; | |
1674 | + u32 last_dtim_sta_time[2]; | |
1675 | + struct list_head list; | |
1676 | + //appeded for QoS | |
1677 | + u8 wmm_info; | |
1678 | + struct ieee80211_wmm_ac_param wmm_param[4]; | |
1679 | + u8 QoS_Enable; | |
1680 | + u8 SignalStrength; | |
1681 | +//by amy 080312 | |
1682 | + u8 HighestOperaRate; | |
1683 | +//by amy 080312 | |
1684 | +#ifdef THOMAS_TURBO | |
1685 | + u8 Turbo_Enable;//enable turbo mode, added by thomas | |
1686 | +#endif | |
1687 | +#ifdef ENABLE_DOT11D | |
1688 | + u16 CountryIeLen; | |
1689 | + u8 CountryIeBuf[MAX_IE_LEN]; | |
1690 | +#endif | |
1691 | +}; | |
1692 | + | |
1693 | +enum ieee80211_state { | |
1694 | + | |
1695 | + /* the card is not linked at all */ | |
1696 | + IEEE80211_NOLINK = 0, | |
1697 | + | |
1698 | + /* IEEE80211_ASSOCIATING* are for BSS client mode | |
1699 | + * the driver shall not perform RX filtering unless | |
1700 | + * the state is LINKED. | |
1701 | + * The driver shall just check for the state LINKED and | |
1702 | + * defaults to NOLINK for ALL the other states (including | |
1703 | + * LINKED_SCANNING) | |
1704 | + */ | |
1705 | + | |
1706 | + /* the association procedure will start (wq scheduling)*/ | |
1707 | + IEEE80211_ASSOCIATING, | |
1708 | + IEEE80211_ASSOCIATING_RETRY, | |
1709 | + | |
1710 | + /* the association procedure is sending AUTH request*/ | |
1711 | + IEEE80211_ASSOCIATING_AUTHENTICATING, | |
1712 | + | |
1713 | + /* the association procedure has successfully authentcated | |
1714 | + * and is sending association request | |
1715 | + */ | |
1716 | + IEEE80211_ASSOCIATING_AUTHENTICATED, | |
1717 | + | |
1718 | + /* the link is ok. the card associated to a BSS or linked | |
1719 | + * to a ibss cell or acting as an AP and creating the bss | |
1720 | + */ | |
1721 | + IEEE80211_LINKED, | |
1722 | + | |
1723 | + /* same as LINKED, but the driver shall apply RX filter | |
1724 | + * rules as we are in NO_LINK mode. As the card is still | |
1725 | + * logically linked, but it is doing a syncro site survey | |
1726 | + * then it will be back to LINKED state. | |
1727 | + */ | |
1728 | + IEEE80211_LINKED_SCANNING, | |
1729 | + | |
1730 | +}; | |
1731 | + | |
1732 | +#define DEFAULT_MAX_SCAN_AGE (15 * HZ) | |
1733 | +#define DEFAULT_FTS 2346 | |
1734 | +#define MAC_FMT "%02x:%02x:%02x:%02x:%02x:%02x" | |
1735 | +#define MAC_ARG(x) ((u8*)(x))[0],((u8*)(x))[1],((u8*)(x))[2],((u8*)(x))[3],((u8*)(x))[4],((u8*)(x))[5] | |
1736 | + | |
1737 | + | |
1738 | +#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,11)) | |
1739 | +extern inline int is_multicast_ether_addr(const u8 *addr) | |
1740 | +{ | |
1741 | + return ((addr[0] != 0xff) && (0x01 & addr[0])); | |
1742 | +} | |
1743 | +#endif | |
1744 | + | |
1745 | +#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,13)) | |
1746 | +extern inline int is_broadcast_ether_addr(const u8 *addr) | |
1747 | +{ | |
1748 | + return ((addr[0] == 0xff) && (addr[1] == 0xff) && (addr[2] == 0xff) && \ | |
1749 | + (addr[3] == 0xff) && (addr[4] == 0xff) && (addr[5] == 0xff)); | |
1750 | +} | |
1751 | +#endif | |
1752 | + | |
1753 | +#define CFG_IEEE80211_RESERVE_FCS (1<<0) | |
1754 | +#define CFG_IEEE80211_COMPUTE_FCS (1<<1) | |
1755 | + | |
1756 | +typedef struct tx_pending_t{ | |
1757 | + int frag; | |
1758 | + struct ieee80211_txb *txb; | |
1759 | +}tx_pending_t; | |
1760 | + | |
1761 | + | |
1762 | +struct ieee80211_device { | |
1763 | + struct net_device *dev; | |
1764 | + | |
1765 | + /* Bookkeeping structures */ | |
1766 | + struct net_device_stats stats; | |
1767 | + struct ieee80211_stats ieee_stats; | |
1768 | + struct ieee80211_softmac_stats softmac_stats; | |
1769 | + | |
1770 | + /* Probe / Beacon management */ | |
1771 | + struct list_head network_free_list; | |
1772 | + struct list_head network_list; | |
1773 | + struct ieee80211_network *networks; | |
1774 | + int scans; | |
1775 | + int scan_age; | |
1776 | + | |
1777 | + int iw_mode; /* operating mode (IW_MODE_*) */ | |
1778 | + | |
1779 | + spinlock_t lock; | |
1780 | + spinlock_t wpax_suitlist_lock; | |
1781 | + | |
1782 | + int tx_headroom; /* Set to size of any additional room needed at front | |
1783 | + * of allocated Tx SKBs */ | |
1784 | + u32 config; | |
1785 | + | |
1786 | + /* WEP and other encryption related settings at the device level */ | |
1787 | + int open_wep; /* Set to 1 to allow unencrypted frames */ | |
1788 | + | |
1789 | + int reset_on_keychange; /* Set to 1 if the HW needs to be reset on | |
1790 | + * WEP key changes */ | |
1791 | + | |
1792 | + /* If the host performs {en,de}cryption, then set to 1 */ | |
1793 | + int host_encrypt; | |
1794 | + int host_decrypt; | |
1795 | + int ieee802_1x; /* is IEEE 802.1X used */ | |
1796 | + | |
1797 | + /* WPA data */ | |
1798 | + int wpa_enabled; | |
1799 | + int drop_unencrypted; | |
1800 | + int tkip_countermeasures; | |
1801 | + int privacy_invoked; | |
1802 | + size_t wpa_ie_len; | |
1803 | + u8 *wpa_ie; | |
1804 | + | |
1805 | + u8 ap_mac_addr[6]; | |
1806 | + u16 pairwise_key_type; | |
1807 | + u16 broadcast_key_type; | |
1808 | + | |
1809 | + struct list_head crypt_deinit_list; | |
1810 | + struct ieee80211_crypt_data *crypt[WEP_KEYS]; | |
1811 | + int tx_keyidx; /* default TX key index (crypt[tx_keyidx]) */ | |
1812 | + struct timer_list crypt_deinit_timer; | |
1813 | + | |
1814 | + int bcrx_sta_key; /* use individual keys to override default keys even | |
1815 | + * with RX of broad/multicast frames */ | |
1816 | + | |
1817 | + /* Fragmentation structures */ | |
1818 | + // each streaming contain a entry | |
1819 | + struct ieee80211_frag_entry frag_cache[17][IEEE80211_FRAG_CACHE_LEN]; | |
1820 | + unsigned int frag_next_idx[17]; | |
1821 | + u16 fts; /* Fragmentation Threshold */ | |
1822 | + | |
1823 | + /* This stores infos for the current network. | |
1824 | + * Either the network we are associated in INFRASTRUCTURE | |
1825 | + * or the network that we are creating in MASTER mode. | |
1826 | + * ad-hoc is a mixture ;-). | |
1827 | + * Note that in infrastructure mode, even when not associated, | |
1828 | + * fields bssid and essid may be valid (if wpa_set and essid_set | |
1829 | + * are true) as thy carry the value set by the user via iwconfig | |
1830 | + */ | |
1831 | + struct ieee80211_network current_network; | |
1832 | + | |
1833 | + | |
1834 | + enum ieee80211_state state; | |
1835 | + | |
1836 | + int short_slot; | |
1837 | + int mode; /* A, B, G */ | |
1838 | + int modulation; /* CCK, OFDM */ | |
1839 | + int freq_band; /* 2.4Ghz, 5.2Ghz, Mixed */ | |
1840 | + int abg_true; /* ABG flag */ | |
1841 | + | |
1842 | + /* used for forcing the ibss workqueue to terminate | |
1843 | + * without wait for the syncro scan to terminate | |
1844 | + */ | |
1845 | + short sync_scan_hurryup; | |
1846 | + | |
1847 | +#ifdef ENABLE_DOT11D | |
1848 | + void * pDot11dInfo; | |
1849 | + bool bGlobalDomain; | |
1850 | + | |
1851 | + // For Liteon Ch12~13 passive scan | |
1852 | + u8 MinPassiveChnlNum; | |
1853 | + u8 IbssStartChnl; | |
1854 | +#else | |
1855 | + /* map of allowed channels. 0 is dummy */ | |
1856 | + // FIXME: remeber to default to a basic channel plan depending of the PHY type | |
1857 | + int channel_map[MAX_CHANNEL_NUMBER+1]; | |
1858 | +#endif | |
1859 | + | |
1860 | + int rate; /* current rate */ | |
1861 | + int basic_rate; | |
1862 | + //FIXME: pleace callback, see if redundant with softmac_features | |
1863 | + short active_scan; | |
1864 | + | |
1865 | + /* this contains flags for selectively enable softmac support */ | |
1866 | + u16 softmac_features; | |
1867 | + | |
1868 | + /* if the sequence control field is not filled by HW */ | |
1869 | + u16 seq_ctrl[5]; | |
1870 | + | |
1871 | + /* association procedure transaction sequence number */ | |
1872 | + u16 associate_seq; | |
1873 | + | |
1874 | + /* AID for RTXed association responses */ | |
1875 | + u16 assoc_id; | |
1876 | + | |
1877 | + /* power save mode related*/ | |
1878 | + short ps; | |
1879 | + short sta_sleep; | |
1880 | + int ps_timeout; | |
1881 | + struct tasklet_struct ps_task; | |
1882 | + u32 ps_th; | |
1883 | + u32 ps_tl; | |
1884 | + | |
1885 | + short raw_tx; | |
1886 | + /* used if IEEE_SOFTMAC_TX_QUEUE is set */ | |
1887 | + short queue_stop; | |
1888 | + short scanning; | |
1889 | + short proto_started; | |
1890 | + | |
1891 | + struct semaphore wx_sem; | |
1892 | + struct semaphore scan_sem; | |
1893 | + | |
1894 | + spinlock_t mgmt_tx_lock; | |
1895 | + spinlock_t beacon_lock; | |
1896 | + | |
1897 | + short beacon_txing; | |
1898 | + | |
1899 | + short wap_set; | |
1900 | + short ssid_set; | |
1901 | + | |
1902 | + u8 wpax_type_set; //{added by David, 2006.9.28} | |
1903 | + u32 wpax_type_notify; //{added by David, 2006.9.26} | |
1904 | + | |
1905 | + /* QoS related flag */ | |
1906 | + char init_wmmparam_flag; | |
1907 | + | |
1908 | + /* for discarding duplicated packets in IBSS */ | |
1909 | + struct list_head ibss_mac_hash[IEEE_IBSS_MAC_HASH_SIZE]; | |
1910 | + | |
1911 | + /* for discarding duplicated packets in BSS */ | |
1912 | + u16 last_rxseq_num[17]; /* rx seq previous per-tid */ | |
1913 | + u16 last_rxfrag_num[17];/* tx frag previous per-tid */ | |
1914 | + unsigned long last_packet_time[17]; | |
1915 | + | |
1916 | + /* for PS mode */ | |
1917 | + unsigned long last_rx_ps_time; | |
1918 | + | |
1919 | + /* used if IEEE_SOFTMAC_SINGLE_QUEUE is set */ | |
1920 | + struct sk_buff *mgmt_queue_ring[MGMT_QUEUE_NUM]; | |
1921 | + int mgmt_queue_head; | |
1922 | + int mgmt_queue_tail; | |
1923 | + | |
1924 | + | |
1925 | + /* used if IEEE_SOFTMAC_TX_QUEUE is set */ | |
1926 | + struct tx_pending_t tx_pending; | |
1927 | + | |
1928 | + /* used if IEEE_SOFTMAC_ASSOCIATE is set */ | |
1929 | + struct timer_list associate_timer; | |
1930 | + | |
1931 | + /* used if IEEE_SOFTMAC_BEACONS is set */ | |
1932 | + struct timer_list beacon_timer; | |
1933 | + | |
1934 | + struct work_struct associate_complete_wq; | |
1935 | +// struct work_struct associate_retry_wq; | |
1936 | + struct work_struct associate_procedure_wq; | |
1937 | +// struct work_struct softmac_scan_wq; | |
1938 | + struct work_struct wx_sync_scan_wq; | |
1939 | + struct work_struct wmm_param_update_wq; | |
1940 | + struct work_struct ps_request_tx_ack_wq;//for ps | |
1941 | +// struct work_struct hw_wakeup_wq; | |
1942 | +// struct work_struct hw_sleep_wq; | |
1943 | +// struct work_struct watch_dog_wq; | |
1944 | + bool bInactivePs; | |
1945 | + bool actscanning; | |
1946 | + bool beinretry; | |
1947 | + u16 ListenInterval; | |
1948 | + unsigned long NumRxDataInPeriod; //YJ,add,080828 | |
1949 | + unsigned long NumRxBcnInPeriod; //YJ,add,080828 | |
1950 | + unsigned long NumRxOkTotal; | |
1951 | + unsigned long NumRxUnicast;//YJ,add,080828,for keep alive | |
1952 | + bool bHwRadioOff; | |
1953 | +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20) | |
1954 | + struct delayed_work softmac_scan_wq; | |
1955 | + struct delayed_work associate_retry_wq; | |
1956 | + struct delayed_work hw_wakeup_wq; | |
1957 | + struct delayed_work hw_sleep_wq;//+by amy 080324 | |
1958 | + struct delayed_work watch_dog_wq; | |
1959 | + struct delayed_work sw_antenna_wq; | |
1960 | + struct delayed_work start_ibss_wq; | |
1961 | +//by amy for rate adaptive 080312 | |
1962 | + struct delayed_work rate_adapter_wq; | |
1963 | +//by amy for rate adaptive | |
1964 | + struct delayed_work hw_dig_wq; | |
1965 | + struct delayed_work tx_pw_wq; | |
1966 | + | |
1967 | +//Added for RF power on power off by lizhaoming 080512 | |
1968 | + struct delayed_work GPIOChangeRFWorkItem; | |
1969 | +#else | |
1970 | + | |
1971 | + struct work_struct start_ibss_wq; | |
1972 | + struct work_struct softmac_scan_wq; | |
1973 | + struct work_struct associate_retry_wq; | |
1974 | + struct work_struct hw_wakeup_wq; | |
1975 | + struct work_struct hw_sleep_wq; | |
1976 | + struct work_struct watch_dog_wq; | |
1977 | + struct work_struct sw_antenna_wq; | |
1978 | +//by amy for rate adaptive 080312 | |
1979 | + struct work_struct rate_adapter_wq; | |
1980 | +//by amy for rate adaptive | |
1981 | + struct work_struct hw_dig_wq; | |
1982 | + struct work_struct tx_pw_wq; | |
1983 | + | |
1984 | +//Added for RF power on power off by lizhaoming 080512 | |
1985 | + struct work_struct GPIOChangeRFWorkItem; | |
1986 | +#endif | |
1987 | + struct workqueue_struct *wq; | |
1988 | + | |
1989 | + /* Callback functions */ | |
1990 | + void (*set_security)(struct net_device *dev, | |
1991 | + struct ieee80211_security *sec); | |
1992 | + | |
1993 | + /* Used to TX data frame by using txb structs. | |
1994 | + * this is not used if in the softmac_features | |
1995 | + * is set the flag IEEE_SOFTMAC_TX_QUEUE | |
1996 | + */ | |
1997 | + int (*hard_start_xmit)(struct ieee80211_txb *txb, | |
1998 | + struct net_device *dev); | |
1999 | + | |
2000 | + int (*reset_port)(struct net_device *dev); | |
2001 | + | |
2002 | + /* Softmac-generated frames (mamagement) are TXed via this | |
2003 | + * callback if the flag IEEE_SOFTMAC_SINGLE_QUEUE is | |
2004 | + * not set. As some cards may have different HW queues that | |
2005 | + * one might want to use for data and management frames | |
2006 | + * the option to have two callbacks might be useful. | |
2007 | + * This fucntion can't sleep. | |
2008 | + */ | |
2009 | + int (*softmac_hard_start_xmit)(struct sk_buff *skb, | |
2010 | + struct net_device *dev); | |
2011 | + | |
2012 | + /* used instead of hard_start_xmit (not softmac_hard_start_xmit) | |
2013 | + * if the IEEE_SOFTMAC_TX_QUEUE feature is used to TX data | |
2014 | + * frames. I the option IEEE_SOFTMAC_SINGLE_QUEUE is also set | |
2015 | + * then also management frames are sent via this callback. | |
2016 | + * This function can't sleep. | |
2017 | + */ | |
2018 | + void (*softmac_data_hard_start_xmit)(struct sk_buff *skb, | |
2019 | + struct net_device *dev,int rate); | |
2020 | + | |
2021 | + /* stops the HW queue for DATA frames. Useful to avoid | |
2022 | + * waste time to TX data frame when we are reassociating | |
2023 | + * This function can sleep. | |
2024 | + */ | |
2025 | + void (*data_hard_stop)(struct net_device *dev); | |
2026 | + | |
2027 | + /* OK this is complementar to data_poll_hard_stop */ | |
2028 | + void (*data_hard_resume)(struct net_device *dev); | |
2029 | + | |
2030 | + /* ask to the driver to retune the radio . | |
2031 | + * This function can sleep. the driver should ensure | |
2032 | + * the radio has been swithced before return. | |
2033 | + */ | |
2034 | + void (*set_chan)(struct net_device *dev,short ch); | |
2035 | + | |
2036 | + /* These are not used if the ieee stack takes care of | |
2037 | + * scanning (IEEE_SOFTMAC_SCAN feature set). | |
2038 | + * In this case only the set_chan is used. | |
2039 | + * | |
2040 | + * The syncro version is similar to the start_scan but | |
2041 | + * does not return until all channels has been scanned. | |
2042 | + * this is called in user context and should sleep, | |
2043 | + * it is called in a work_queue when swithcing to ad-hoc mode | |
2044 | + * or in behalf of iwlist scan when the card is associated | |
2045 | + * and root user ask for a scan. | |
2046 | + * the fucntion stop_scan should stop both the syncro and | |
2047 | + * background scanning and can sleep. | |
2048 | + * The fucntion start_scan should initiate the background | |
2049 | + * scanning and can't sleep. | |
2050 | + */ | |
2051 | + void (*scan_syncro)(struct net_device *dev); | |
2052 | + void (*start_scan)(struct net_device *dev); | |
2053 | + void (*stop_scan)(struct net_device *dev); | |
2054 | + | |
2055 | + /* indicate the driver that the link state is changed | |
2056 | + * for example it may indicate the card is associated now. | |
2057 | + * Driver might be interested in this to apply RX filter | |
2058 | + * rules or simply light the LINK led | |
2059 | + */ | |
2060 | + void (*link_change)(struct net_device *dev); | |
2061 | + | |
2062 | + /* these two function indicates to the HW when to start | |
2063 | + * and stop to send beacons. This is used when the | |
2064 | + * IEEE_SOFTMAC_BEACONS is not set. For now the | |
2065 | + * stop_send_bacons is NOT guaranteed to be called only | |
2066 | + * after start_send_beacons. | |
2067 | + */ | |
2068 | + void (*start_send_beacons) (struct net_device *dev); | |
2069 | + void (*stop_send_beacons) (struct net_device *dev); | |
2070 | + | |
2071 | + /* power save mode related */ | |
2072 | + void (*sta_wake_up) (struct net_device *dev); | |
2073 | + void (*ps_request_tx_ack) (struct net_device *dev); | |
2074 | + void (*enter_sleep_state) (struct net_device *dev, u32 th, u32 tl); | |
2075 | + short (*ps_is_queue_empty) (struct net_device *dev); | |
2076 | + | |
2077 | + /* QoS related */ | |
2078 | + //void (*wmm_param_update) (struct net_device *dev, u8 *ac_param); | |
2079 | + //void (*wmm_param_update) (struct ieee80211_device *ieee); | |
2080 | + | |
2081 | + /* This must be the last item so that it points to the data | |
2082 | + * allocated beyond this structure by alloc_ieee80211 */ | |
2083 | + u8 priv[0]; | |
2084 | +}; | |
2085 | + | |
2086 | +#define IEEE_A (1<<0) | |
2087 | +#define IEEE_B (1<<1) | |
2088 | +#define IEEE_G (1<<2) | |
2089 | +#define IEEE_MODE_MASK (IEEE_A|IEEE_B|IEEE_G) | |
2090 | + | |
2091 | +/* Generate a 802.11 header */ | |
2092 | + | |
2093 | +/* Uses the channel change callback directly | |
2094 | + * instead of [start/stop] scan callbacks | |
2095 | + */ | |
2096 | +#define IEEE_SOFTMAC_SCAN (1<<2) | |
2097 | + | |
2098 | +/* Perform authentication and association handshake */ | |
2099 | +#define IEEE_SOFTMAC_ASSOCIATE (1<<3) | |
2100 | + | |
2101 | +/* Generate probe requests */ | |
2102 | +#define IEEE_SOFTMAC_PROBERQ (1<<4) | |
2103 | + | |
2104 | +/* Generate respones to probe requests */ | |
2105 | +#define IEEE_SOFTMAC_PROBERS (1<<5) | |
2106 | + | |
2107 | +/* The ieee802.11 stack will manages the netif queue | |
2108 | + * wake/stop for the driver, taking care of 802.11 | |
2109 | + * fragmentation. See softmac.c for details. */ | |
2110 | +#define IEEE_SOFTMAC_TX_QUEUE (1<<7) | |
2111 | + | |
2112 | +/* Uses only the softmac_data_hard_start_xmit | |
2113 | + * even for TX management frames. | |
2114 | + */ | |
2115 | +#define IEEE_SOFTMAC_SINGLE_QUEUE (1<<8) | |
2116 | + | |
2117 | +/* Generate beacons. The stack will enqueue beacons | |
2118 | + * to the card | |
2119 | + */ | |
2120 | +#define IEEE_SOFTMAC_BEACONS (1<<6) | |
2121 | + | |
2122 | + | |
2123 | + | |
2124 | +static inline void *ieee80211_priv(struct net_device *dev) | |
2125 | +{ | |
2126 | + return ((struct ieee80211_device *)netdev_priv(dev))->priv; | |
2127 | +} | |
2128 | + | |
2129 | +extern inline int ieee80211_is_empty_essid(const char *essid, int essid_len) | |
2130 | +{ | |
2131 | + /* Single white space is for Linksys APs */ | |
2132 | + if (essid_len == 1 && essid[0] == ' ') | |
2133 | + return 1; | |
2134 | + | |
2135 | + /* Otherwise, if the entire essid is 0, we assume it is hidden */ | |
2136 | + while (essid_len) { | |
2137 | + essid_len--; | |
2138 | + if (essid[essid_len] != '\0') | |
2139 | + return 0; | |
2140 | + } | |
2141 | + | |
2142 | + return 1; | |
2143 | +} | |
2144 | + | |
2145 | +extern inline int ieee80211_is_valid_mode(struct ieee80211_device *ieee, int mode) | |
2146 | +{ | |
2147 | + /* | |
2148 | + * It is possible for both access points and our device to support | |
2149 | + * combinations of modes, so as long as there is one valid combination | |
2150 | + * of ap/device supported modes, then return success | |
2151 | + * | |
2152 | + */ | |
2153 | + if ((mode & IEEE_A) && | |
2154 | + (ieee->modulation & IEEE80211_OFDM_MODULATION) && | |
2155 | + (ieee->freq_band & IEEE80211_52GHZ_BAND)) | |
2156 | + return 1; | |
2157 | + | |
2158 | + if ((mode & IEEE_G) && | |
2159 | + (ieee->modulation & IEEE80211_OFDM_MODULATION) && | |
2160 | + (ieee->freq_band & IEEE80211_24GHZ_BAND)) | |
2161 | + return 1; | |
2162 | + | |
2163 | + if ((mode & IEEE_B) && | |
2164 | + (ieee->modulation & IEEE80211_CCK_MODULATION) && | |
2165 | + (ieee->freq_band & IEEE80211_24GHZ_BAND)) | |
2166 | + return 1; | |
2167 | + | |
2168 | + return 0; | |
2169 | +} | |
2170 | + | |
2171 | +extern inline int ieee80211_get_hdrlen(u16 fc) | |
2172 | +{ | |
2173 | + int hdrlen = 24; | |
2174 | + | |
2175 | + switch (WLAN_FC_GET_TYPE(fc)) { | |
2176 | + case IEEE80211_FTYPE_DATA: | |
2177 | + if ((fc & IEEE80211_FCTL_FROMDS) && (fc & IEEE80211_FCTL_TODS)) | |
2178 | + hdrlen = 30; /* Addr4 */ | |
2179 | + if(IEEE80211_QOS_HAS_SEQ(fc)) | |
2180 | + hdrlen += 2; /* QOS ctrl*/ | |
2181 | + break; | |
2182 | + case IEEE80211_FTYPE_CTL: | |
2183 | + switch (WLAN_FC_GET_STYPE(fc)) { | |
2184 | + case IEEE80211_STYPE_CTS: | |
2185 | + case IEEE80211_STYPE_ACK: | |
2186 | + hdrlen = 10; | |
2187 | + break; | |
2188 | + default: | |
2189 | + hdrlen = 16; | |
2190 | + break; | |
2191 | + } | |
2192 | + break; | |
2193 | + } | |
2194 | + | |
2195 | + return hdrlen; | |
2196 | +} | |
2197 | + | |
2198 | + | |
2199 | + | |
2200 | +/* ieee80211.c */ | |
2201 | +extern void free_ieee80211(struct net_device *dev); | |
2202 | +extern struct net_device *alloc_ieee80211(int sizeof_priv); | |
2203 | + | |
2204 | +extern int ieee80211_set_encryption(struct ieee80211_device *ieee); | |
2205 | + | |
2206 | +/* ieee80211_tx.c */ | |
2207 | + | |
2208 | +extern int ieee80211_encrypt_fragment( | |
2209 | + struct ieee80211_device *ieee, | |
2210 | + struct sk_buff *frag, | |
2211 | + int hdr_len); | |
2212 | + | |
2213 | +extern int ieee80211_xmit(struct sk_buff *skb, | |
2214 | + struct net_device *dev); | |
2215 | +extern void ieee80211_txb_free(struct ieee80211_txb *); | |
2216 | + | |
2217 | + | |
2218 | +/* ieee80211_rx.c */ | |
2219 | +extern int ieee80211_rx(struct ieee80211_device *ieee, struct sk_buff *skb, | |
2220 | + struct ieee80211_rx_stats *rx_stats); | |
2221 | +extern void ieee80211_rx_mgt(struct ieee80211_device *ieee, | |
2222 | + struct ieee80211_hdr *header, | |
2223 | + struct ieee80211_rx_stats *stats); | |
2224 | + | |
2225 | +/* ieee80211_wx.c */ | |
2226 | +extern int ieee80211_wx_get_scan(struct ieee80211_device *ieee, | |
2227 | + struct iw_request_info *info, | |
2228 | + union iwreq_data *wrqu, char *key); | |
2229 | +extern int ieee80211_wx_set_encode(struct ieee80211_device *ieee, | |
2230 | + struct iw_request_info *info, | |
2231 | + union iwreq_data *wrqu, char *key); | |
2232 | +extern int ieee80211_wx_get_encode(struct ieee80211_device *ieee, | |
2233 | + struct iw_request_info *info, | |
2234 | + union iwreq_data *wrqu, char *key); | |
2235 | +extern int ieee80211_wx_set_encode_ext(struct ieee80211_device *ieee, | |
2236 | + struct iw_request_info *info, | |
2237 | + union iwreq_data* wrqu, char *extra); | |
2238 | +int ieee80211_wx_set_auth(struct ieee80211_device *ieee, | |
2239 | + struct iw_request_info *info, | |
2240 | + struct iw_param *data, char *extra); | |
2241 | +int ieee80211_wx_set_mlme(struct ieee80211_device *ieee, | |
2242 | + struct iw_request_info *info, | |
2243 | + union iwreq_data *wrqu, char *extra); | |
2244 | + | |
2245 | +int ieee80211_wx_set_gen_ie(struct ieee80211_device *ieee, u8 *ie, size_t len); | |
2246 | +/* ieee80211_softmac.c */ | |
2247 | +extern short ieee80211_is_54g(struct ieee80211_network net); | |
2248 | +extern short ieee80211_is_shortslot(struct ieee80211_network net); | |
2249 | +extern int ieee80211_rx_frame_softmac(struct ieee80211_device *ieee, struct sk_buff *skb, | |
2250 | + struct ieee80211_rx_stats *rx_stats, u16 type, | |
2251 | + u16 stype); | |
2252 | +extern void ieee80211_softmac_new_net(struct ieee80211_device *ieee, struct ieee80211_network *net); | |
2253 | + | |
2254 | +extern void ieee80211_softmac_xmit(struct ieee80211_txb *txb, struct ieee80211_device *ieee); | |
2255 | +extern void ieee80211_softmac_check_all_nets(struct ieee80211_device *ieee); | |
2256 | +extern void ieee80211_start_bss(struct ieee80211_device *ieee); | |
2257 | +extern void ieee80211_start_master_bss(struct ieee80211_device *ieee); | |
2258 | +extern void ieee80211_start_ibss(struct ieee80211_device *ieee); | |
2259 | +extern void ieee80211_softmac_init(struct ieee80211_device *ieee); | |
2260 | +extern void ieee80211_softmac_free(struct ieee80211_device *ieee); | |
2261 | +extern void ieee80211_associate_abort(struct ieee80211_device *ieee); | |
2262 | +extern void ieee80211_disassociate(struct ieee80211_device *ieee); | |
2263 | +extern void ieee80211_stop_scan(struct ieee80211_device *ieee); | |
2264 | +extern void ieee80211_start_scan_syncro(struct ieee80211_device *ieee); | |
2265 | +extern void ieee80211_check_all_nets(struct ieee80211_device *ieee); | |
2266 | +extern void ieee80211_start_protocol(struct ieee80211_device *ieee); | |
2267 | +extern void ieee80211_stop_protocol(struct ieee80211_device *ieee); | |
2268 | +extern void ieee80211_softmac_start_protocol(struct ieee80211_device *ieee); | |
2269 | +extern void ieee80211_softmac_stop_protocol(struct ieee80211_device *ieee); | |
2270 | +extern void ieee80211_reset_queue(struct ieee80211_device *ieee); | |
2271 | +extern void ieee80211_wake_queue(struct ieee80211_device *ieee); | |
2272 | +extern void ieee80211_stop_queue(struct ieee80211_device *ieee); | |
2273 | +extern struct sk_buff *ieee80211_get_beacon(struct ieee80211_device *ieee); | |
2274 | +extern void ieee80211_start_send_beacons(struct ieee80211_device *ieee); | |
2275 | +extern void ieee80211_stop_send_beacons(struct ieee80211_device *ieee); | |
2276 | +extern int ieee80211_wpa_supplicant_ioctl(struct ieee80211_device *ieee, struct iw_point *p); | |
2277 | +extern void notify_wx_assoc_event(struct ieee80211_device *ieee); | |
2278 | +extern void ieee80211_ps_tx_ack(struct ieee80211_device *ieee, short success); | |
2279 | +extern void SendDisassociation(struct ieee80211_device *ieee,u8* asSta,u8 asRsn); | |
2280 | +extern void ieee80211_start_scan(struct ieee80211_device *ieee); | |
2281 | + | |
2282 | +//Add for RF power on power off by lizhaoming 080512 | |
2283 | +extern void SendDisassociation(struct ieee80211_device *ieee, | |
2284 | + u8* asSta, | |
2285 | + u8 asRsn); | |
2286 | + | |
2287 | +/* ieee80211_crypt_ccmp&tkip&wep.c */ | |
2288 | +extern void ieee80211_tkip_null(void); | |
2289 | +extern void ieee80211_wep_null(void); | |
2290 | +extern void ieee80211_ccmp_null(void); | |
2291 | +/* ieee80211_softmac_wx.c */ | |
2292 | + | |
2293 | +extern int ieee80211_wx_get_wap(struct ieee80211_device *ieee, | |
2294 | + struct iw_request_info *info, | |
2295 | + union iwreq_data *wrqu, char *ext); | |
2296 | + | |
2297 | +extern int ieee80211_wx_set_wap(struct ieee80211_device *ieee, | |
2298 | + struct iw_request_info *info, | |
2299 | + union iwreq_data *awrq, | |
2300 | + char *extra); | |
2301 | + | |
2302 | +extern int ieee80211_wx_get_essid(struct ieee80211_device *ieee, struct iw_request_info *a,union iwreq_data *wrqu,char *b); | |
2303 | + | |
2304 | +extern int ieee80211_wx_set_rate(struct ieee80211_device *ieee, | |
2305 | + struct iw_request_info *info, | |
2306 | + union iwreq_data *wrqu, char *extra); | |
2307 | + | |
2308 | +extern int ieee80211_wx_get_rate(struct ieee80211_device *ieee, | |
2309 | + struct iw_request_info *info, | |
2310 | + union iwreq_data *wrqu, char *extra); | |
2311 | + | |
2312 | +extern int ieee80211_wx_set_mode(struct ieee80211_device *ieee, struct iw_request_info *a, | |
2313 | + union iwreq_data *wrqu, char *b); | |
2314 | + | |
2315 | +extern int ieee80211_wx_set_scan(struct ieee80211_device *ieee, struct iw_request_info *a, | |
2316 | + union iwreq_data *wrqu, char *b); | |
2317 | + | |
2318 | +extern int ieee80211_wx_set_essid(struct ieee80211_device *ieee, | |
2319 | + struct iw_request_info *a, | |
2320 | + union iwreq_data *wrqu, char *extra); | |
2321 | + | |
2322 | +extern int ieee80211_wx_get_mode(struct ieee80211_device *ieee, struct iw_request_info *a, | |
2323 | + union iwreq_data *wrqu, char *b); | |
2324 | + | |
2325 | +extern int ieee80211_wx_set_freq(struct ieee80211_device *ieee, struct iw_request_info *a, | |
2326 | + union iwreq_data *wrqu, char *b); | |
2327 | + | |
2328 | +extern int ieee80211_wx_get_freq(struct ieee80211_device *ieee, struct iw_request_info *a, | |
2329 | + union iwreq_data *wrqu, char *b); | |
2330 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
2331 | +extern void ieee80211_wx_sync_scan_wq(struct work_struct *work); | |
2332 | +#else | |
2333 | + extern void ieee80211_wx_sync_scan_wq(struct ieee80211_device *ieee); | |
2334 | +#endif | |
2335 | +//extern void ieee80211_wx_sync_scan_wq(struct ieee80211_device *ieee); | |
2336 | + | |
2337 | +extern int ieee80211_wx_set_rawtx(struct ieee80211_device *ieee, | |
2338 | + struct iw_request_info *info, | |
2339 | + union iwreq_data *wrqu, char *extra); | |
2340 | + | |
2341 | +extern int ieee80211_wx_get_name(struct ieee80211_device *ieee, | |
2342 | + struct iw_request_info *info, | |
2343 | + union iwreq_data *wrqu, char *extra); | |
2344 | + | |
2345 | +extern int ieee80211_wx_set_power(struct ieee80211_device *ieee, | |
2346 | + struct iw_request_info *info, | |
2347 | + union iwreq_data *wrqu, char *extra); | |
2348 | + | |
2349 | +extern int ieee80211_wx_get_power(struct ieee80211_device *ieee, | |
2350 | + struct iw_request_info *info, | |
2351 | + union iwreq_data *wrqu, char *extra); | |
2352 | + | |
2353 | +extern void ieee80211_softmac_ips_scan_syncro(struct ieee80211_device *ieee); | |
2354 | + | |
2355 | +extern void ieee80211_sta_ps_send_null_frame(struct ieee80211_device *ieee, short pwr); | |
2356 | + | |
2357 | +extern const long ieee80211_wlan_frequencies[]; | |
2358 | + | |
2359 | +extern inline void ieee80211_increment_scans(struct ieee80211_device *ieee) | |
2360 | +{ | |
2361 | + ieee->scans++; | |
2362 | +} | |
2363 | + | |
2364 | +extern inline int ieee80211_get_scans(struct ieee80211_device *ieee) | |
2365 | +{ | |
2366 | + return ieee->scans; | |
2367 | +} | |
2368 | + | |
2369 | +static inline const char *escape_essid(const char *essid, u8 essid_len) { | |
2370 | + static char escaped[IW_ESSID_MAX_SIZE * 2 + 1]; | |
2371 | + const char *s = essid; | |
2372 | + char *d = escaped; | |
2373 | + | |
2374 | + if (ieee80211_is_empty_essid(essid, essid_len)) { | |
2375 | + memcpy(escaped, "<hidden>", sizeof("<hidden>")); | |
2376 | + return escaped; | |
2377 | + } | |
2378 | + | |
2379 | + essid_len = min(essid_len, (u8)IW_ESSID_MAX_SIZE); | |
2380 | + while (essid_len--) { | |
2381 | + if (*s == '\0') { | |
2382 | + *d++ = '\\'; | |
2383 | + *d++ = '0'; | |
2384 | + s++; | |
2385 | + } else { | |
2386 | + *d++ = *s++; | |
2387 | + } | |
2388 | + } | |
2389 | + *d = '\0'; | |
2390 | + return escaped; | |
2391 | +} | |
2392 | +#endif /* IEEE80211_H */ | |
2393 | --- /dev/null | |
2394 | +++ b/drivers/staging/rtl8187se/ieee80211/ieee80211_crypt.c | |
2395 | @@ -0,0 +1,265 @@ | |
2396 | +/* | |
2397 | + * Host AP crypto routines | |
2398 | + * | |
2399 | + * Copyright (c) 2002-2003, Jouni Malinen <jkmaline@cc.hut.fi> | |
2400 | + * Portions Copyright (C) 2004, Intel Corporation <jketreno@linux.intel.com> | |
2401 | + * | |
2402 | + * This program is free software; you can redistribute it and/or modify | |
2403 | + * it under the terms of the GNU General Public License version 2 as | |
2404 | + * published by the Free Software Foundation. See README and COPYING for | |
2405 | + * more details. | |
2406 | + * | |
2407 | + */ | |
2408 | + | |
2409 | +//#include <linux/config.h> | |
2410 | +#include <linux/version.h> | |
2411 | +#include <linux/module.h> | |
2412 | +#include <linux/init.h> | |
2413 | +#include <linux/slab.h> | |
2414 | +#include <asm/string.h> | |
2415 | +#include <asm/errno.h> | |
2416 | + | |
2417 | +#if (LINUX_VERSION_CODE<KERNEL_VERSION(2,6,18)) | |
2418 | +#include<linux/config.h> | |
2419 | +#endif | |
2420 | + | |
2421 | +#include "ieee80211.h" | |
2422 | + | |
2423 | +MODULE_AUTHOR("Jouni Malinen"); | |
2424 | +MODULE_DESCRIPTION("HostAP crypto"); | |
2425 | +MODULE_LICENSE("GPL"); | |
2426 | + | |
2427 | +struct ieee80211_crypto_alg { | |
2428 | + struct list_head list; | |
2429 | + struct ieee80211_crypto_ops *ops; | |
2430 | +}; | |
2431 | + | |
2432 | + | |
2433 | +struct ieee80211_crypto { | |
2434 | + struct list_head algs; | |
2435 | + spinlock_t lock; | |
2436 | +}; | |
2437 | + | |
2438 | +static struct ieee80211_crypto *hcrypt; | |
2439 | + | |
2440 | +void ieee80211_crypt_deinit_entries(struct ieee80211_device *ieee, | |
2441 | + int force) | |
2442 | +{ | |
2443 | + struct list_head *ptr, *n; | |
2444 | + struct ieee80211_crypt_data *entry; | |
2445 | + | |
2446 | + for (ptr = ieee->crypt_deinit_list.next, n = ptr->next; | |
2447 | + ptr != &ieee->crypt_deinit_list; ptr = n, n = ptr->next) { | |
2448 | + entry = list_entry(ptr, struct ieee80211_crypt_data, list); | |
2449 | + | |
2450 | + if (atomic_read(&entry->refcnt) != 0 && !force) | |
2451 | + continue; | |
2452 | + | |
2453 | + list_del(ptr); | |
2454 | + | |
2455 | + if (entry->ops) { | |
2456 | + entry->ops->deinit(entry->priv); | |
2457 | + module_put(entry->ops->owner); | |
2458 | + } | |
2459 | + kfree(entry); | |
2460 | + } | |
2461 | +} | |
2462 | + | |
2463 | +void ieee80211_crypt_deinit_handler(unsigned long data) | |
2464 | +{ | |
2465 | + struct ieee80211_device *ieee = (struct ieee80211_device *)data; | |
2466 | + unsigned long flags; | |
2467 | + | |
2468 | + spin_lock_irqsave(&ieee->lock, flags); | |
2469 | + ieee80211_crypt_deinit_entries(ieee, 0); | |
2470 | + if (!list_empty(&ieee->crypt_deinit_list)) { | |
2471 | + printk(KERN_DEBUG "%s: entries remaining in delayed crypt " | |
2472 | + "deletion list\n", ieee->dev->name); | |
2473 | + ieee->crypt_deinit_timer.expires = jiffies + HZ; | |
2474 | + add_timer(&ieee->crypt_deinit_timer); | |
2475 | + } | |
2476 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
2477 | + | |
2478 | +} | |
2479 | + | |
2480 | +void ieee80211_crypt_delayed_deinit(struct ieee80211_device *ieee, | |
2481 | + struct ieee80211_crypt_data **crypt) | |
2482 | +{ | |
2483 | + struct ieee80211_crypt_data *tmp; | |
2484 | + unsigned long flags; | |
2485 | + | |
2486 | + if (*crypt == NULL) | |
2487 | + return; | |
2488 | + | |
2489 | + tmp = *crypt; | |
2490 | + *crypt = NULL; | |
2491 | + | |
2492 | + /* must not run ops->deinit() while there may be pending encrypt or | |
2493 | + * decrypt operations. Use a list of delayed deinits to avoid needing | |
2494 | + * locking. */ | |
2495 | + | |
2496 | + spin_lock_irqsave(&ieee->lock, flags); | |
2497 | + list_add(&tmp->list, &ieee->crypt_deinit_list); | |
2498 | + if (!timer_pending(&ieee->crypt_deinit_timer)) { | |
2499 | + ieee->crypt_deinit_timer.expires = jiffies + HZ; | |
2500 | + add_timer(&ieee->crypt_deinit_timer); | |
2501 | + } | |
2502 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
2503 | +} | |
2504 | + | |
2505 | +int ieee80211_register_crypto_ops(struct ieee80211_crypto_ops *ops) | |
2506 | +{ | |
2507 | + unsigned long flags; | |
2508 | + struct ieee80211_crypto_alg *alg; | |
2509 | + | |
2510 | + if (hcrypt == NULL) | |
2511 | + return -1; | |
2512 | + | |
2513 | + alg = kmalloc(sizeof(*alg), GFP_KERNEL); | |
2514 | + if (alg == NULL) | |
2515 | + return -ENOMEM; | |
2516 | + | |
2517 | + memset(alg, 0, sizeof(*alg)); | |
2518 | + alg->ops = ops; | |
2519 | + | |
2520 | + spin_lock_irqsave(&hcrypt->lock, flags); | |
2521 | + list_add(&alg->list, &hcrypt->algs); | |
2522 | + spin_unlock_irqrestore(&hcrypt->lock, flags); | |
2523 | + | |
2524 | + printk(KERN_DEBUG "ieee80211_crypt: registered algorithm '%s'\n", | |
2525 | + ops->name); | |
2526 | + | |
2527 | + return 0; | |
2528 | +} | |
2529 | + | |
2530 | +int ieee80211_unregister_crypto_ops(struct ieee80211_crypto_ops *ops) | |
2531 | +{ | |
2532 | + unsigned long flags; | |
2533 | + struct list_head *ptr; | |
2534 | + struct ieee80211_crypto_alg *del_alg = NULL; | |
2535 | + | |
2536 | + if (hcrypt == NULL) | |
2537 | + return -1; | |
2538 | + | |
2539 | + spin_lock_irqsave(&hcrypt->lock, flags); | |
2540 | + for (ptr = hcrypt->algs.next; ptr != &hcrypt->algs; ptr = ptr->next) { | |
2541 | + struct ieee80211_crypto_alg *alg = | |
2542 | + (struct ieee80211_crypto_alg *) ptr; | |
2543 | + if (alg->ops == ops) { | |
2544 | + list_del(&alg->list); | |
2545 | + del_alg = alg; | |
2546 | + break; | |
2547 | + } | |
2548 | + } | |
2549 | + spin_unlock_irqrestore(&hcrypt->lock, flags); | |
2550 | + | |
2551 | + if (del_alg) { | |
2552 | + printk(KERN_DEBUG "ieee80211_crypt: unregistered algorithm " | |
2553 | + "'%s'\n", ops->name); | |
2554 | + kfree(del_alg); | |
2555 | + } | |
2556 | + | |
2557 | + return del_alg ? 0 : -1; | |
2558 | +} | |
2559 | + | |
2560 | + | |
2561 | +struct ieee80211_crypto_ops * ieee80211_get_crypto_ops(const char *name) | |
2562 | +{ | |
2563 | + unsigned long flags; | |
2564 | + struct list_head *ptr; | |
2565 | + struct ieee80211_crypto_alg *found_alg = NULL; | |
2566 | + | |
2567 | + if (hcrypt == NULL) | |
2568 | + return NULL; | |
2569 | + | |
2570 | + spin_lock_irqsave(&hcrypt->lock, flags); | |
2571 | + for (ptr = hcrypt->algs.next; ptr != &hcrypt->algs; ptr = ptr->next) { | |
2572 | + struct ieee80211_crypto_alg *alg = | |
2573 | + (struct ieee80211_crypto_alg *) ptr; | |
2574 | + if (strcmp(alg->ops->name, name) == 0) { | |
2575 | + found_alg = alg; | |
2576 | + break; | |
2577 | + } | |
2578 | + } | |
2579 | + spin_unlock_irqrestore(&hcrypt->lock, flags); | |
2580 | + | |
2581 | + if (found_alg) | |
2582 | + return found_alg->ops; | |
2583 | + else | |
2584 | + return NULL; | |
2585 | +} | |
2586 | + | |
2587 | + | |
2588 | +static void * ieee80211_crypt_null_init(int keyidx) { return (void *) 1; } | |
2589 | +static void ieee80211_crypt_null_deinit(void *priv) {} | |
2590 | + | |
2591 | +static struct ieee80211_crypto_ops ieee80211_crypt_null = { | |
2592 | + .name = "NULL", | |
2593 | + .init = ieee80211_crypt_null_init, | |
2594 | + .deinit = ieee80211_crypt_null_deinit, | |
2595 | + .encrypt_mpdu = NULL, | |
2596 | + .decrypt_mpdu = NULL, | |
2597 | + .encrypt_msdu = NULL, | |
2598 | + .decrypt_msdu = NULL, | |
2599 | + .set_key = NULL, | |
2600 | + .get_key = NULL, | |
2601 | + .extra_prefix_len = 0, | |
2602 | + .extra_postfix_len = 0, | |
2603 | + .owner = THIS_MODULE, | |
2604 | +}; | |
2605 | + | |
2606 | + | |
2607 | +int ieee80211_crypto_init(void) | |
2608 | +{ | |
2609 | + int ret = -ENOMEM; | |
2610 | + | |
2611 | + hcrypt = kmalloc(sizeof(*hcrypt), GFP_KERNEL); | |
2612 | + if (!hcrypt) | |
2613 | + goto out; | |
2614 | + | |
2615 | + memset(hcrypt, 0, sizeof(*hcrypt)); | |
2616 | + INIT_LIST_HEAD(&hcrypt->algs); | |
2617 | + spin_lock_init(&hcrypt->lock); | |
2618 | + | |
2619 | + ret = ieee80211_register_crypto_ops(&ieee80211_crypt_null); | |
2620 | + if (ret < 0) { | |
2621 | + kfree(hcrypt); | |
2622 | + hcrypt = NULL; | |
2623 | + } | |
2624 | +out: | |
2625 | + return ret; | |
2626 | +} | |
2627 | + | |
2628 | + | |
2629 | +void ieee80211_crypto_deinit(void) | |
2630 | +{ | |
2631 | + struct list_head *ptr, *n; | |
2632 | + | |
2633 | + if (hcrypt == NULL) | |
2634 | + return; | |
2635 | + | |
2636 | + for (ptr = hcrypt->algs.next, n = ptr->next; ptr != &hcrypt->algs; | |
2637 | + ptr = n, n = ptr->next) { | |
2638 | + struct ieee80211_crypto_alg *alg = | |
2639 | + (struct ieee80211_crypto_alg *) ptr; | |
2640 | + list_del(ptr); | |
2641 | + printk(KERN_DEBUG "ieee80211_crypt: unregistered algorithm " | |
2642 | + "'%s' (deinit)\n", alg->ops->name); | |
2643 | + kfree(alg); | |
2644 | + } | |
2645 | + | |
2646 | + kfree(hcrypt); | |
2647 | +} | |
2648 | + | |
2649 | +#if 0 | |
2650 | +EXPORT_SYMBOL(ieee80211_crypt_deinit_entries); | |
2651 | +EXPORT_SYMBOL(ieee80211_crypt_deinit_handler); | |
2652 | +EXPORT_SYMBOL(ieee80211_crypt_delayed_deinit); | |
2653 | + | |
2654 | +EXPORT_SYMBOL(ieee80211_register_crypto_ops); | |
2655 | +EXPORT_SYMBOL(ieee80211_unregister_crypto_ops); | |
2656 | +EXPORT_SYMBOL(ieee80211_get_crypto_ops); | |
2657 | +#endif | |
2658 | + | |
2659 | +//module_init(ieee80211_crypto_init); | |
2660 | +//module_exit(ieee80211_crypto_deinit); | |
2661 | --- /dev/null | |
2662 | +++ b/drivers/staging/rtl8187se/ieee80211/ieee80211_crypt_ccmp.c | |
2663 | @@ -0,0 +1,533 @@ | |
2664 | +/* | |
2665 | + * Host AP crypt: host-based CCMP encryption implementation for Host AP driver | |
2666 | + * | |
2667 | + * Copyright (c) 2003-2004, Jouni Malinen <jkmaline@cc.hut.fi> | |
2668 | + * | |
2669 | + * This program is free software; you can redistribute it and/or modify | |
2670 | + * it under the terms of the GNU General Public License version 2 as | |
2671 | + * published by the Free Software Foundation. See README and COPYING for | |
2672 | + * more details. | |
2673 | + */ | |
2674 | + | |
2675 | +//#include <linux/config.h> | |
2676 | +#include <linux/version.h> | |
2677 | +#include <linux/module.h> | |
2678 | +#include <linux/init.h> | |
2679 | +#include <linux/slab.h> | |
2680 | +#include <linux/random.h> | |
2681 | +#include <linux/skbuff.h> | |
2682 | +#include <linux/netdevice.h> | |
2683 | +#include <linux/if_ether.h> | |
2684 | +#include <linux/if_arp.h> | |
2685 | +#include <asm/string.h> | |
2686 | +#include <linux/wireless.h> | |
2687 | + | |
2688 | +#include "ieee80211.h" | |
2689 | + | |
2690 | +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)) | |
2691 | +#include "rtl_crypto.h" | |
2692 | +#else | |
2693 | +#include <linux/crypto.h> | |
2694 | +#endif | |
2695 | +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20) | |
2696 | + #include <asm/scatterlist.h> | |
2697 | +#else | |
2698 | + #include <linux/scatterlist.h> | |
2699 | +#endif | |
2700 | + | |
2701 | +//#include <asm/scatterlist.h> | |
2702 | + | |
2703 | +MODULE_AUTHOR("Jouni Malinen"); | |
2704 | +MODULE_DESCRIPTION("Host AP crypt: CCMP"); | |
2705 | +MODULE_LICENSE("GPL"); | |
2706 | + | |
2707 | +#ifdef OPENSUSE_SLED | |
2708 | +#ifndef IN_OPENSUSE_SLED | |
2709 | +#define IN_OPENSUSE_SLED 1 | |
2710 | +#endif | |
2711 | +#endif | |
2712 | + | |
2713 | +#define AES_BLOCK_LEN 16 | |
2714 | +#define CCMP_HDR_LEN 8 | |
2715 | +#define CCMP_MIC_LEN 8 | |
2716 | +#define CCMP_TK_LEN 16 | |
2717 | +#define CCMP_PN_LEN 6 | |
2718 | + | |
2719 | +struct ieee80211_ccmp_data { | |
2720 | + u8 key[CCMP_TK_LEN]; | |
2721 | + int key_set; | |
2722 | + | |
2723 | + u8 tx_pn[CCMP_PN_LEN]; | |
2724 | + u8 rx_pn[CCMP_PN_LEN]; | |
2725 | + | |
2726 | + u32 dot11RSNAStatsCCMPFormatErrors; | |
2727 | + u32 dot11RSNAStatsCCMPReplays; | |
2728 | + u32 dot11RSNAStatsCCMPDecryptErrors; | |
2729 | + | |
2730 | + int key_idx; | |
2731 | + | |
2732 | + struct crypto_tfm *tfm; | |
2733 | + | |
2734 | + /* scratch buffers for virt_to_page() (crypto API) */ | |
2735 | + u8 tx_b0[AES_BLOCK_LEN], tx_b[AES_BLOCK_LEN], | |
2736 | + tx_e[AES_BLOCK_LEN], tx_s0[AES_BLOCK_LEN]; | |
2737 | + u8 rx_b0[AES_BLOCK_LEN], rx_b[AES_BLOCK_LEN], rx_a[AES_BLOCK_LEN]; | |
2738 | +}; | |
2739 | + | |
2740 | +void ieee80211_ccmp_aes_encrypt(struct crypto_tfm *tfm, | |
2741 | + const u8 pt[16], u8 ct[16]) | |
2742 | +{ | |
2743 | + #if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,21))||(IN_OPENSUSE_SLED)) | |
2744 | + crypto_cipher_encrypt_one((void *)tfm, ct, pt); | |
2745 | + #else | |
2746 | + struct scatterlist src, dst; | |
2747 | + | |
2748 | + src.page = virt_to_page(pt); | |
2749 | + src.offset = offset_in_page(pt); | |
2750 | + src.length = AES_BLOCK_LEN; | |
2751 | + | |
2752 | + dst.page = virt_to_page(ct); | |
2753 | + dst.offset = offset_in_page(ct); | |
2754 | + dst.length = AES_BLOCK_LEN; | |
2755 | + | |
2756 | + crypto_cipher_encrypt(tfm, &dst, &src, AES_BLOCK_LEN); | |
2757 | + #endif | |
2758 | +} | |
2759 | + | |
2760 | +static void * ieee80211_ccmp_init(int key_idx) | |
2761 | +{ | |
2762 | + struct ieee80211_ccmp_data *priv; | |
2763 | + | |
2764 | + priv = kmalloc(sizeof(*priv), GFP_ATOMIC); | |
2765 | + if (priv == NULL) | |
2766 | + goto fail; | |
2767 | + memset(priv, 0, sizeof(*priv)); | |
2768 | + priv->key_idx = key_idx; | |
2769 | + | |
2770 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21)) && (!IN_OPENSUSE_SLED)) | |
2771 | + priv->tfm = crypto_alloc_tfm("aes", 0); | |
2772 | + if (priv->tfm == NULL) { | |
2773 | + printk(KERN_DEBUG "ieee80211_crypt_ccmp: could not allocate " | |
2774 | + "crypto API aes\n"); | |
2775 | + goto fail; | |
2776 | + } | |
2777 | + #else | |
2778 | + priv->tfm = (void *)crypto_alloc_cipher("aes", 0, CRYPTO_ALG_ASYNC); | |
2779 | + if (IS_ERR(priv->tfm)) { | |
2780 | + printk(KERN_DEBUG "ieee80211_crypt_ccmp: could not allocate " | |
2781 | + "crypto API aes\n"); | |
2782 | + priv->tfm = NULL; | |
2783 | + goto fail; | |
2784 | + } | |
2785 | + #endif | |
2786 | + return priv; | |
2787 | + | |
2788 | +fail: | |
2789 | + if (priv) { | |
2790 | + if (priv->tfm) | |
2791 | + //#if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21)) | |
2792 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21)) && (!IN_OPENSUSE_SLED)) | |
2793 | + crypto_free_tfm(priv->tfm); | |
2794 | + #else | |
2795 | + crypto_free_cipher((void *)priv->tfm); | |
2796 | + #endif | |
2797 | + kfree(priv); | |
2798 | + } | |
2799 | + | |
2800 | + return NULL; | |
2801 | +} | |
2802 | + | |
2803 | + | |
2804 | +static void ieee80211_ccmp_deinit(void *priv) | |
2805 | +{ | |
2806 | + struct ieee80211_ccmp_data *_priv = priv; | |
2807 | + if (_priv && _priv->tfm) | |
2808 | + //#if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21)) | |
2809 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21)) && (!IN_OPENSUSE_SLED)) | |
2810 | + crypto_free_tfm(_priv->tfm); | |
2811 | + #else | |
2812 | + crypto_free_cipher((void *)_priv->tfm); | |
2813 | + #endif | |
2814 | + kfree(priv); | |
2815 | +} | |
2816 | + | |
2817 | + | |
2818 | +static inline void xor_block(u8 *b, u8 *a, size_t len) | |
2819 | +{ | |
2820 | + int i; | |
2821 | + for (i = 0; i < len; i++) | |
2822 | + b[i] ^= a[i]; | |
2823 | +} | |
2824 | + | |
2825 | +#ifndef JOHN_CCMP | |
2826 | +static void ccmp_init_blocks(struct crypto_tfm *tfm, | |
2827 | + struct ieee80211_hdr *hdr, | |
2828 | + u8 *pn, size_t dlen, u8 *b0, u8 *auth, | |
2829 | + u8 *s0) | |
2830 | +{ | |
2831 | + u8 *pos, qc = 0; | |
2832 | + size_t aad_len; | |
2833 | + u16 fc; | |
2834 | + int a4_included, qc_included; | |
2835 | + u8 aad[2 * AES_BLOCK_LEN]; | |
2836 | + | |
2837 | + fc = le16_to_cpu(hdr->frame_ctl); | |
2838 | + a4_included = ((fc & (IEEE80211_FCTL_TODS | IEEE80211_FCTL_FROMDS)) == | |
2839 | + (IEEE80211_FCTL_TODS | IEEE80211_FCTL_FROMDS)); | |
2840 | + /* | |
2841 | + qc_included = ((WLAN_FC_GET_TYPE(fc) == IEEE80211_FTYPE_DATA) && | |
2842 | + (WLAN_FC_GET_STYPE(fc) & 0x08)); | |
2843 | + */ | |
2844 | + // fixed by David :2006.9.6 | |
2845 | + qc_included = ((WLAN_FC_GET_TYPE(fc) == IEEE80211_FTYPE_DATA) && | |
2846 | + (WLAN_FC_GET_STYPE(fc) & 0x80)); | |
2847 | + aad_len = 22; | |
2848 | + if (a4_included) | |
2849 | + aad_len += 6; | |
2850 | + if (qc_included) { | |
2851 | + pos = (u8 *) &hdr->addr4; | |
2852 | + if (a4_included) | |
2853 | + pos += 6; | |
2854 | + qc = *pos & 0x0f; | |
2855 | + aad_len += 2; | |
2856 | + } | |
2857 | + /* CCM Initial Block: | |
2858 | + * Flag (Include authentication header, M=3 (8-octet MIC), | |
2859 | + * L=1 (2-octet Dlen)) | |
2860 | + * Nonce: 0x00 | A2 | PN | |
2861 | + * Dlen */ | |
2862 | + b0[0] = 0x59; | |
2863 | + b0[1] = qc; | |
2864 | + memcpy(b0 + 2, hdr->addr2, ETH_ALEN); | |
2865 | + memcpy(b0 + 8, pn, CCMP_PN_LEN); | |
2866 | + b0[14] = (dlen >> 8) & 0xff; | |
2867 | + b0[15] = dlen & 0xff; | |
2868 | + | |
2869 | + /* AAD: | |
2870 | + * FC with bits 4..6 and 11..13 masked to zero; 14 is always one | |
2871 | + * A1 | A2 | A3 | |
2872 | + * SC with bits 4..15 (seq#) masked to zero | |
2873 | + * A4 (if present) | |
2874 | + * QC (if present) | |
2875 | + */ | |
2876 | + pos = (u8 *) hdr; | |
2877 | + aad[0] = 0; /* aad_len >> 8 */ | |
2878 | + aad[1] = aad_len & 0xff; | |
2879 | + aad[2] = pos[0] & 0x8f; | |
2880 | + aad[3] = pos[1] & 0xc7; | |
2881 | + memcpy(aad + 4, hdr->addr1, 3 * ETH_ALEN); | |
2882 | + pos = (u8 *) &hdr->seq_ctl; | |
2883 | + aad[22] = pos[0] & 0x0f; | |
2884 | + aad[23] = 0; /* all bits masked */ | |
2885 | + memset(aad + 24, 0, 8); | |
2886 | + if (a4_included) | |
2887 | + memcpy(aad + 24, hdr->addr4, ETH_ALEN); | |
2888 | + if (qc_included) { | |
2889 | + aad[a4_included ? 30 : 24] = qc; | |
2890 | + /* rest of QC masked */ | |
2891 | + } | |
2892 | + | |
2893 | + /* Start with the first block and AAD */ | |
2894 | + ieee80211_ccmp_aes_encrypt(tfm, b0, auth); | |
2895 | + xor_block(auth, aad, AES_BLOCK_LEN); | |
2896 | + ieee80211_ccmp_aes_encrypt(tfm, auth, auth); | |
2897 | + xor_block(auth, &aad[AES_BLOCK_LEN], AES_BLOCK_LEN); | |
2898 | + ieee80211_ccmp_aes_encrypt(tfm, auth, auth); | |
2899 | + b0[0] &= 0x07; | |
2900 | + b0[14] = b0[15] = 0; | |
2901 | + ieee80211_ccmp_aes_encrypt(tfm, b0, s0); | |
2902 | +} | |
2903 | +#endif | |
2904 | + | |
2905 | +static int ieee80211_ccmp_encrypt(struct sk_buff *skb, int hdr_len, void *priv) | |
2906 | +{ | |
2907 | + struct ieee80211_ccmp_data *key = priv; | |
2908 | + int data_len, i; | |
2909 | + u8 *pos; | |
2910 | + struct ieee80211_hdr *hdr; | |
2911 | +#ifndef JOHN_CCMP | |
2912 | + int blocks, last, len; | |
2913 | + u8 *mic; | |
2914 | + u8 *b0 = key->tx_b0; | |
2915 | + u8 *b = key->tx_b; | |
2916 | + u8 *e = key->tx_e; | |
2917 | + u8 *s0 = key->tx_s0; | |
2918 | +#endif | |
2919 | + if (skb_headroom(skb) < CCMP_HDR_LEN || | |
2920 | + skb_tailroom(skb) < CCMP_MIC_LEN || | |
2921 | + skb->len < hdr_len) | |
2922 | + return -1; | |
2923 | + | |
2924 | + data_len = skb->len - hdr_len; | |
2925 | + pos = skb_push(skb, CCMP_HDR_LEN); | |
2926 | + memmove(pos, pos + CCMP_HDR_LEN, hdr_len); | |
2927 | + pos += hdr_len; | |
2928 | +// mic = skb_put(skb, CCMP_MIC_LEN); | |
2929 | + | |
2930 | + i = CCMP_PN_LEN - 1; | |
2931 | + while (i >= 0) { | |
2932 | + key->tx_pn[i]++; | |
2933 | + if (key->tx_pn[i] != 0) | |
2934 | + break; | |
2935 | + i--; | |
2936 | + } | |
2937 | + | |
2938 | + *pos++ = key->tx_pn[5]; | |
2939 | + *pos++ = key->tx_pn[4]; | |
2940 | + *pos++ = 0; | |
2941 | + *pos++ = (key->key_idx << 6) | (1 << 5) /* Ext IV included */; | |
2942 | + *pos++ = key->tx_pn[3]; | |
2943 | + *pos++ = key->tx_pn[2]; | |
2944 | + *pos++ = key->tx_pn[1]; | |
2945 | + *pos++ = key->tx_pn[0]; | |
2946 | + | |
2947 | + hdr = (struct ieee80211_hdr *) skb->data; | |
2948 | +#ifndef JOHN_CCMP | |
2949 | + //mic is moved to here by john | |
2950 | + mic = skb_put(skb, CCMP_MIC_LEN); | |
2951 | + | |
2952 | + ccmp_init_blocks(key->tfm, hdr, key->tx_pn, data_len, b0, b, s0); | |
2953 | + | |
2954 | + blocks = (data_len + AES_BLOCK_LEN - 1) / AES_BLOCK_LEN; | |
2955 | + last = data_len % AES_BLOCK_LEN; | |
2956 | + | |
2957 | + for (i = 1; i <= blocks; i++) { | |
2958 | + len = (i == blocks && last) ? last : AES_BLOCK_LEN; | |
2959 | + /* Authentication */ | |
2960 | + xor_block(b, pos, len); | |
2961 | + ieee80211_ccmp_aes_encrypt(key->tfm, b, b); | |
2962 | + /* Encryption, with counter */ | |
2963 | + b0[14] = (i >> 8) & 0xff; | |
2964 | + b0[15] = i & 0xff; | |
2965 | + ieee80211_ccmp_aes_encrypt(key->tfm, b0, e); | |
2966 | + xor_block(pos, e, len); | |
2967 | + pos += len; | |
2968 | + } | |
2969 | + | |
2970 | + for (i = 0; i < CCMP_MIC_LEN; i++) | |
2971 | + mic[i] = b[i] ^ s0[i]; | |
2972 | +#endif | |
2973 | + return 0; | |
2974 | +} | |
2975 | + | |
2976 | + | |
2977 | +static int ieee80211_ccmp_decrypt(struct sk_buff *skb, int hdr_len, void *priv) | |
2978 | +{ | |
2979 | + struct ieee80211_ccmp_data *key = priv; | |
2980 | + u8 keyidx, *pos; | |
2981 | + struct ieee80211_hdr *hdr; | |
2982 | + u8 pn[6]; | |
2983 | +#ifndef JOHN_CCMP | |
2984 | + size_t data_len = skb->len - hdr_len - CCMP_HDR_LEN - CCMP_MIC_LEN; | |
2985 | + u8 *mic = skb->data + skb->len - CCMP_MIC_LEN; | |
2986 | + u8 *b0 = key->rx_b0; | |
2987 | + u8 *b = key->rx_b; | |
2988 | + u8 *a = key->rx_a; | |
2989 | + int i, blocks, last, len; | |
2990 | +#endif | |
2991 | + if (skb->len < hdr_len + CCMP_HDR_LEN + CCMP_MIC_LEN) { | |
2992 | + key->dot11RSNAStatsCCMPFormatErrors++; | |
2993 | + return -1; | |
2994 | + } | |
2995 | + | |
2996 | + hdr = (struct ieee80211_hdr *) skb->data; | |
2997 | + pos = skb->data + hdr_len; | |
2998 | + keyidx = pos[3]; | |
2999 | + if (!(keyidx & (1 << 5))) { | |
3000 | + if (net_ratelimit()) { | |
3001 | + printk(KERN_DEBUG "CCMP: received packet without ExtIV" | |
3002 | + " flag from " MAC_FMT "\n", MAC_ARG(hdr->addr2)); | |
3003 | + } | |
3004 | + key->dot11RSNAStatsCCMPFormatErrors++; | |
3005 | + return -2; | |
3006 | + } | |
3007 | + keyidx >>= 6; | |
3008 | + if (key->key_idx != keyidx) { | |
3009 | + printk(KERN_DEBUG "CCMP: RX tkey->key_idx=%d frame " | |
3010 | + "keyidx=%d priv=%p\n", key->key_idx, keyidx, priv); | |
3011 | + return -6; | |
3012 | + } | |
3013 | + if (!key->key_set) { | |
3014 | + if (net_ratelimit()) { | |
3015 | + printk(KERN_DEBUG "CCMP: received packet from " MAC_FMT | |
3016 | + " with keyid=%d that does not have a configured" | |
3017 | + " key\n", MAC_ARG(hdr->addr2), keyidx); | |
3018 | + } | |
3019 | + return -3; | |
3020 | + } | |
3021 | + | |
3022 | + pn[0] = pos[7]; | |
3023 | + pn[1] = pos[6]; | |
3024 | + pn[2] = pos[5]; | |
3025 | + pn[3] = pos[4]; | |
3026 | + pn[4] = pos[1]; | |
3027 | + pn[5] = pos[0]; | |
3028 | + pos += 8; | |
3029 | + | |
3030 | + if (memcmp(pn, key->rx_pn, CCMP_PN_LEN) <= 0) { | |
3031 | + if (net_ratelimit()) { | |
3032 | + printk(KERN_DEBUG "CCMP: replay detected: STA=" MAC_FMT | |
3033 | + " previous PN %02x%02x%02x%02x%02x%02x " | |
3034 | + "received PN %02x%02x%02x%02x%02x%02x\n", | |
3035 | + MAC_ARG(hdr->addr2), MAC_ARG(key->rx_pn), | |
3036 | + MAC_ARG(pn)); | |
3037 | + } | |
3038 | + key->dot11RSNAStatsCCMPReplays++; | |
3039 | + return -4; | |
3040 | + } | |
3041 | + | |
3042 | +#ifndef JOHN_CCMP | |
3043 | + ccmp_init_blocks(key->tfm, hdr, pn, data_len, b0, a, b); | |
3044 | + xor_block(mic, b, CCMP_MIC_LEN); | |
3045 | + | |
3046 | + blocks = (data_len + AES_BLOCK_LEN - 1) / AES_BLOCK_LEN; | |
3047 | + last = data_len % AES_BLOCK_LEN; | |
3048 | + | |
3049 | + for (i = 1; i <= blocks; i++) { | |
3050 | + len = (i == blocks && last) ? last : AES_BLOCK_LEN; | |
3051 | + /* Decrypt, with counter */ | |
3052 | + b0[14] = (i >> 8) & 0xff; | |
3053 | + b0[15] = i & 0xff; | |
3054 | + ieee80211_ccmp_aes_encrypt(key->tfm, b0, b); | |
3055 | + xor_block(pos, b, len); | |
3056 | + /* Authentication */ | |
3057 | + xor_block(a, pos, len); | |
3058 | + ieee80211_ccmp_aes_encrypt(key->tfm, a, a); | |
3059 | + pos += len; | |
3060 | + } | |
3061 | + | |
3062 | + if (memcmp(mic, a, CCMP_MIC_LEN) != 0) { | |
3063 | + if (net_ratelimit()) { | |
3064 | + printk(KERN_DEBUG "CCMP: decrypt failed: STA=" | |
3065 | + MAC_FMT "\n", MAC_ARG(hdr->addr2)); | |
3066 | + } | |
3067 | + key->dot11RSNAStatsCCMPDecryptErrors++; | |
3068 | + return -5; | |
3069 | + } | |
3070 | + | |
3071 | + memcpy(key->rx_pn, pn, CCMP_PN_LEN); | |
3072 | + | |
3073 | +#endif | |
3074 | + /* Remove hdr and MIC */ | |
3075 | + memmove(skb->data + CCMP_HDR_LEN, skb->data, hdr_len); | |
3076 | + skb_pull(skb, CCMP_HDR_LEN); | |
3077 | + skb_trim(skb, skb->len - CCMP_MIC_LEN); | |
3078 | + | |
3079 | + return keyidx; | |
3080 | +} | |
3081 | + | |
3082 | + | |
3083 | +static int ieee80211_ccmp_set_key(void *key, int len, u8 *seq, void *priv) | |
3084 | +{ | |
3085 | + struct ieee80211_ccmp_data *data = priv; | |
3086 | + int keyidx; | |
3087 | + struct crypto_tfm *tfm = data->tfm; | |
3088 | + | |
3089 | + keyidx = data->key_idx; | |
3090 | + memset(data, 0, sizeof(*data)); | |
3091 | + data->key_idx = keyidx; | |
3092 | + data->tfm = tfm; | |
3093 | + if (len == CCMP_TK_LEN) { | |
3094 | + memcpy(data->key, key, CCMP_TK_LEN); | |
3095 | + data->key_set = 1; | |
3096 | + if (seq) { | |
3097 | + data->rx_pn[0] = seq[5]; | |
3098 | + data->rx_pn[1] = seq[4]; | |
3099 | + data->rx_pn[2] = seq[3]; | |
3100 | + data->rx_pn[3] = seq[2]; | |
3101 | + data->rx_pn[4] = seq[1]; | |
3102 | + data->rx_pn[5] = seq[0]; | |
3103 | + } | |
3104 | + crypto_cipher_setkey((void *)data->tfm, data->key, CCMP_TK_LEN); | |
3105 | + } else if (len == 0) | |
3106 | + data->key_set = 0; | |
3107 | + else | |
3108 | + return -1; | |
3109 | + | |
3110 | + return 0; | |
3111 | +} | |
3112 | + | |
3113 | + | |
3114 | +static int ieee80211_ccmp_get_key(void *key, int len, u8 *seq, void *priv) | |
3115 | +{ | |
3116 | + struct ieee80211_ccmp_data *data = priv; | |
3117 | + | |
3118 | + if (len < CCMP_TK_LEN) | |
3119 | + return -1; | |
3120 | + | |
3121 | + if (!data->key_set) | |
3122 | + return 0; | |
3123 | + memcpy(key, data->key, CCMP_TK_LEN); | |
3124 | + | |
3125 | + if (seq) { | |
3126 | + seq[0] = data->tx_pn[5]; | |
3127 | + seq[1] = data->tx_pn[4]; | |
3128 | + seq[2] = data->tx_pn[3]; | |
3129 | + seq[3] = data->tx_pn[2]; | |
3130 | + seq[4] = data->tx_pn[1]; | |
3131 | + seq[5] = data->tx_pn[0]; | |
3132 | + } | |
3133 | + | |
3134 | + return CCMP_TK_LEN; | |
3135 | +} | |
3136 | + | |
3137 | + | |
3138 | +static char * ieee80211_ccmp_print_stats(char *p, void *priv) | |
3139 | +{ | |
3140 | + struct ieee80211_ccmp_data *ccmp = priv; | |
3141 | + p += sprintf(p, "key[%d] alg=CCMP key_set=%d " | |
3142 | + "tx_pn=%02x%02x%02x%02x%02x%02x " | |
3143 | + "rx_pn=%02x%02x%02x%02x%02x%02x " | |
3144 | + "format_errors=%d replays=%d decrypt_errors=%d\n", | |
3145 | + ccmp->key_idx, ccmp->key_set, | |
3146 | + MAC_ARG(ccmp->tx_pn), MAC_ARG(ccmp->rx_pn), | |
3147 | + ccmp->dot11RSNAStatsCCMPFormatErrors, | |
3148 | + ccmp->dot11RSNAStatsCCMPReplays, | |
3149 | + ccmp->dot11RSNAStatsCCMPDecryptErrors); | |
3150 | + | |
3151 | + return p; | |
3152 | +} | |
3153 | + | |
3154 | +void ieee80211_ccmp_null(void) | |
3155 | +{ | |
3156 | +// printk("============>%s()\n", __FUNCTION__); | |
3157 | + return; | |
3158 | +} | |
3159 | +static struct ieee80211_crypto_ops ieee80211_crypt_ccmp = { | |
3160 | + .name = "CCMP", | |
3161 | + .init = ieee80211_ccmp_init, | |
3162 | + .deinit = ieee80211_ccmp_deinit, | |
3163 | + .encrypt_mpdu = ieee80211_ccmp_encrypt, | |
3164 | + .decrypt_mpdu = ieee80211_ccmp_decrypt, | |
3165 | + .encrypt_msdu = NULL, | |
3166 | + .decrypt_msdu = NULL, | |
3167 | + .set_key = ieee80211_ccmp_set_key, | |
3168 | + .get_key = ieee80211_ccmp_get_key, | |
3169 | + .print_stats = ieee80211_ccmp_print_stats, | |
3170 | + .extra_prefix_len = CCMP_HDR_LEN, | |
3171 | + .extra_postfix_len = CCMP_MIC_LEN, | |
3172 | + .owner = THIS_MODULE, | |
3173 | +}; | |
3174 | + | |
3175 | + | |
3176 | +int ieee80211_crypto_ccmp_init(void) | |
3177 | +{ | |
3178 | + return ieee80211_register_crypto_ops(&ieee80211_crypt_ccmp); | |
3179 | +} | |
3180 | + | |
3181 | + | |
3182 | +void ieee80211_crypto_ccmp_exit(void) | |
3183 | +{ | |
3184 | + ieee80211_unregister_crypto_ops(&ieee80211_crypt_ccmp); | |
3185 | +} | |
3186 | + | |
3187 | +#if 0 | |
3188 | +#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0)) | |
3189 | +EXPORT_SYMBOL(ieee80211_ccmp_null); | |
3190 | +#else | |
3191 | +EXPORT_SYMBOL_NOVERS(ieee80211_ccmp_null); | |
3192 | +#endif | |
3193 | +#endif | |
3194 | + | |
3195 | +//module_init(ieee80211_crypto_ccmp_init); | |
3196 | +//module_exit(ieee80211_crypto_ccmp_exit); | |
3197 | --- /dev/null | |
3198 | +++ b/drivers/staging/rtl8187se/ieee80211/ieee80211_crypt.h | |
3199 | @@ -0,0 +1,86 @@ | |
3200 | +/* | |
3201 | + * Original code based on Host AP (software wireless LAN access point) driver | |
3202 | + * for Intersil Prism2/2.5/3. | |
3203 | + * | |
3204 | + * Copyright (c) 2001-2002, SSH Communications Security Corp and Jouni Malinen | |
3205 | + * <jkmaline@cc.hut.fi> | |
3206 | + * Copyright (c) 2002-2003, Jouni Malinen <jkmaline@cc.hut.fi> | |
3207 | + * | |
3208 | + * Adaption to a generic IEEE 802.11 stack by James Ketrenos | |
3209 | + * <jketreno@linux.intel.com> | |
3210 | + * | |
3211 | + * Copyright (c) 2004, Intel Corporation | |
3212 | + * | |
3213 | + * This program is free software; you can redistribute it and/or modify | |
3214 | + * it under the terms of the GNU General Public License version 2 as | |
3215 | + * published by the Free Software Foundation. See README and COPYING for | |
3216 | + * more details. | |
3217 | + */ | |
3218 | + | |
3219 | +/* | |
3220 | + * This file defines the interface to the ieee80211 crypto module. | |
3221 | + */ | |
3222 | +#ifndef IEEE80211_CRYPT_H | |
3223 | +#define IEEE80211_CRYPT_H | |
3224 | + | |
3225 | +#include <linux/skbuff.h> | |
3226 | + | |
3227 | +struct ieee80211_crypto_ops { | |
3228 | + const char *name; | |
3229 | + | |
3230 | + /* init new crypto context (e.g., allocate private data space, | |
3231 | + * select IV, etc.); returns NULL on failure or pointer to allocated | |
3232 | + * private data on success */ | |
3233 | + void * (*init)(int keyidx); | |
3234 | + | |
3235 | + /* deinitialize crypto context and free allocated private data */ | |
3236 | + void (*deinit)(void *priv); | |
3237 | + | |
3238 | + /* encrypt/decrypt return < 0 on error or >= 0 on success. The return | |
3239 | + * value from decrypt_mpdu is passed as the keyidx value for | |
3240 | + * decrypt_msdu. skb must have enough head and tail room for the | |
3241 | + * encryption; if not, error will be returned; these functions are | |
3242 | + * called for all MPDUs (i.e., fragments). | |
3243 | + */ | |
3244 | + int (*encrypt_mpdu)(struct sk_buff *skb, int hdr_len, void *priv); | |
3245 | + int (*decrypt_mpdu)(struct sk_buff *skb, int hdr_len, void *priv); | |
3246 | + | |
3247 | + /* These functions are called for full MSDUs, i.e. full frames. | |
3248 | + * These can be NULL if full MSDU operations are not needed. */ | |
3249 | + int (*encrypt_msdu)(struct sk_buff *skb, int hdr_len, void *priv); | |
3250 | + int (*decrypt_msdu)(struct sk_buff *skb, int keyidx, int hdr_len, | |
3251 | + void *priv); | |
3252 | + | |
3253 | + int (*set_key)(void *key, int len, u8 *seq, void *priv); | |
3254 | + int (*get_key)(void *key, int len, u8 *seq, void *priv); | |
3255 | + | |
3256 | + /* procfs handler for printing out key information and possible | |
3257 | + * statistics */ | |
3258 | + char * (*print_stats)(char *p, void *priv); | |
3259 | + | |
3260 | + /* maximum number of bytes added by encryption; encrypt buf is | |
3261 | + * allocated with extra_prefix_len bytes, copy of in_buf, and | |
3262 | + * extra_postfix_len; encrypt need not use all this space, but | |
3263 | + * the result must start at the beginning of the buffer and correct | |
3264 | + * length must be returned */ | |
3265 | + int extra_prefix_len, extra_postfix_len; | |
3266 | + | |
3267 | + struct module *owner; | |
3268 | +}; | |
3269 | + | |
3270 | +struct ieee80211_crypt_data { | |
3271 | + struct list_head list; /* delayed deletion list */ | |
3272 | + struct ieee80211_crypto_ops *ops; | |
3273 | + void *priv; | |
3274 | + atomic_t refcnt; | |
3275 | +}; | |
3276 | + | |
3277 | +int ieee80211_register_crypto_ops(struct ieee80211_crypto_ops *ops); | |
3278 | +int ieee80211_unregister_crypto_ops(struct ieee80211_crypto_ops *ops); | |
3279 | +struct ieee80211_crypto_ops * ieee80211_get_crypto_ops(const char *name); | |
3280 | +void ieee80211_crypt_deinit_entries(struct ieee80211_device *, int); | |
3281 | +void ieee80211_crypt_deinit_handler(unsigned long); | |
3282 | +void ieee80211_crypt_delayed_deinit(struct ieee80211_device *ieee, | |
3283 | + struct ieee80211_crypt_data **crypt); | |
3284 | + | |
3285 | +#endif | |
3286 | --- /dev/null | |
3287 | +++ b/drivers/staging/rtl8187se/ieee80211/ieee80211_crypt_tkip.c | |
3288 | @@ -0,0 +1,1001 @@ | |
3289 | +/* | |
3290 | + * Host AP crypt: host-based TKIP encryption implementation for Host AP driver | |
3291 | + * | |
3292 | + * Copyright (c) 2003-2004, Jouni Malinen <jkmaline@cc.hut.fi> | |
3293 | + * | |
3294 | + * This program is free software; you can redistribute it and/or modify | |
3295 | + * it under the terms of the GNU General Public License version 2 as | |
3296 | + * published by the Free Software Foundation. See README and COPYING for | |
3297 | + * more details. | |
3298 | + */ | |
3299 | + | |
3300 | +//#include <linux/config.h> | |
3301 | +#include <linux/version.h> | |
3302 | +#include <linux/module.h> | |
3303 | +#include <linux/init.h> | |
3304 | +#include <linux/slab.h> | |
3305 | +#include <linux/random.h> | |
3306 | +#include <linux/skbuff.h> | |
3307 | +#include <linux/netdevice.h> | |
3308 | +#include <linux/if_ether.h> | |
3309 | +#include <linux/if_arp.h> | |
3310 | +#include <asm/string.h> | |
3311 | + | |
3312 | +#include "ieee80211.h" | |
3313 | + | |
3314 | +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)) | |
3315 | +#include "rtl_crypto.h" | |
3316 | +#else | |
3317 | +#include <linux/crypto.h> | |
3318 | +#endif | |
3319 | +//#include <asm/scatterlist.h> | |
3320 | +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20)) | |
3321 | + #include <asm/scatterlist.h> | |
3322 | +#else | |
3323 | + #include <linux/scatterlist.h> | |
3324 | +#endif | |
3325 | + | |
3326 | +#include <linux/crc32.h> | |
3327 | + | |
3328 | +MODULE_AUTHOR("Jouni Malinen"); | |
3329 | +MODULE_DESCRIPTION("Host AP crypt: TKIP"); | |
3330 | +MODULE_LICENSE("GPL"); | |
3331 | + | |
3332 | +#ifdef OPENSUSE_SLED | |
3333 | +#ifndef IN_OPENSUSE_SLED | |
3334 | +#define IN_OPENSUSE_SLED 1 | |
3335 | +#endif | |
3336 | +#endif | |
3337 | + | |
3338 | +struct ieee80211_tkip_data { | |
3339 | +#define TKIP_KEY_LEN 32 | |
3340 | + u8 key[TKIP_KEY_LEN]; | |
3341 | + int key_set; | |
3342 | + | |
3343 | + u32 tx_iv32; | |
3344 | + u16 tx_iv16; | |
3345 | + u16 tx_ttak[5]; | |
3346 | + int tx_phase1_done; | |
3347 | + | |
3348 | + u32 rx_iv32; | |
3349 | + u16 rx_iv16; | |
3350 | + u16 rx_ttak[5]; | |
3351 | + int rx_phase1_done; | |
3352 | + u32 rx_iv32_new; | |
3353 | + u16 rx_iv16_new; | |
3354 | + | |
3355 | + u32 dot11RSNAStatsTKIPReplays; | |
3356 | + u32 dot11RSNAStatsTKIPICVErrors; | |
3357 | + u32 dot11RSNAStatsTKIPLocalMICFailures; | |
3358 | + | |
3359 | + int key_idx; | |
3360 | + | |
3361 | + #if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,21))||(IN_OPENSUSE_SLED)) | |
3362 | + struct crypto_blkcipher *rx_tfm_arc4; | |
3363 | + struct crypto_hash *rx_tfm_michael; | |
3364 | + struct crypto_blkcipher *tx_tfm_arc4; | |
3365 | + struct crypto_hash *tx_tfm_michael; | |
3366 | + #endif | |
3367 | + | |
3368 | + struct crypto_tfm *tfm_arc4; | |
3369 | + struct crypto_tfm *tfm_michael; | |
3370 | + | |
3371 | + /* scratch buffers for virt_to_page() (crypto API) */ | |
3372 | + u8 rx_hdr[16], tx_hdr[16]; | |
3373 | +}; | |
3374 | + | |
3375 | +static void * ieee80211_tkip_init(int key_idx) | |
3376 | +{ | |
3377 | + struct ieee80211_tkip_data *priv; | |
3378 | + | |
3379 | + priv = kmalloc(sizeof(*priv), GFP_ATOMIC); | |
3380 | + if (priv == NULL) | |
3381 | + goto fail; | |
3382 | + memset(priv, 0, sizeof(*priv)); | |
3383 | + priv->key_idx = key_idx; | |
3384 | + | |
3385 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
3386 | + priv->tfm_arc4 = crypto_alloc_tfm("arc4", 0); | |
3387 | + if (priv->tfm_arc4 == NULL) { | |
3388 | + printk(KERN_DEBUG "ieee80211_crypt_tkip: could not allocate " | |
3389 | + "crypto API arc4\n"); | |
3390 | + goto fail; | |
3391 | + } | |
3392 | + | |
3393 | + priv->tfm_michael = crypto_alloc_tfm("michael_mic", 0); | |
3394 | + if (priv->tfm_michael == NULL) { | |
3395 | + printk(KERN_DEBUG "ieee80211_crypt_tkip: could not allocate " | |
3396 | + "crypto API michael_mic\n"); | |
3397 | + goto fail; | |
3398 | + } | |
3399 | + | |
3400 | + #else | |
3401 | + priv->tx_tfm_arc4 = crypto_alloc_blkcipher("ecb(arc4)", 0, | |
3402 | + CRYPTO_ALG_ASYNC); | |
3403 | + if (IS_ERR(priv->tx_tfm_arc4)) { | |
3404 | + printk(KERN_DEBUG "ieee80211_crypt_tkip: could not allocate " | |
3405 | + "crypto API arc4\n"); | |
3406 | + priv->tx_tfm_arc4 = NULL; | |
3407 | + goto fail; | |
3408 | + } | |
3409 | + | |
3410 | + priv->tx_tfm_michael = crypto_alloc_hash("michael_mic", 0, | |
3411 | + CRYPTO_ALG_ASYNC); | |
3412 | + if (IS_ERR(priv->tx_tfm_michael)) { | |
3413 | + printk(KERN_DEBUG "ieee80211_crypt_tkip: could not allocate " | |
3414 | + "crypto API michael_mic\n"); | |
3415 | + priv->tx_tfm_michael = NULL; | |
3416 | + goto fail; | |
3417 | + } | |
3418 | + | |
3419 | + priv->rx_tfm_arc4 = crypto_alloc_blkcipher("ecb(arc4)", 0, | |
3420 | + CRYPTO_ALG_ASYNC); | |
3421 | + if (IS_ERR(priv->rx_tfm_arc4)) { | |
3422 | + printk(KERN_DEBUG "ieee80211_crypt_tkip: could not allocate " | |
3423 | + "crypto API arc4\n"); | |
3424 | + priv->rx_tfm_arc4 = NULL; | |
3425 | + goto fail; | |
3426 | + } | |
3427 | + | |
3428 | + priv->rx_tfm_michael = crypto_alloc_hash("michael_mic", 0, | |
3429 | + CRYPTO_ALG_ASYNC); | |
3430 | + if (IS_ERR(priv->rx_tfm_michael)) { | |
3431 | + printk(KERN_DEBUG "ieee80211_crypt_tkip: could not allocate " | |
3432 | + "crypto API michael_mic\n"); | |
3433 | + priv->rx_tfm_michael = NULL; | |
3434 | + goto fail; | |
3435 | + } | |
3436 | + #endif | |
3437 | + return priv; | |
3438 | + | |
3439 | +fail: | |
3440 | + if (priv) { | |
3441 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
3442 | + if (priv->tfm_michael) | |
3443 | + crypto_free_tfm(priv->tfm_michael); | |
3444 | + if (priv->tfm_arc4) | |
3445 | + crypto_free_tfm(priv->tfm_arc4); | |
3446 | + #else | |
3447 | + if (priv->tx_tfm_michael) | |
3448 | + crypto_free_hash(priv->tx_tfm_michael); | |
3449 | + if (priv->tx_tfm_arc4) | |
3450 | + crypto_free_blkcipher(priv->tx_tfm_arc4); | |
3451 | + if (priv->rx_tfm_michael) | |
3452 | + crypto_free_hash(priv->rx_tfm_michael); | |
3453 | + if (priv->rx_tfm_arc4) | |
3454 | + crypto_free_blkcipher(priv->rx_tfm_arc4); | |
3455 | + #endif | |
3456 | + kfree(priv); | |
3457 | + } | |
3458 | + | |
3459 | + return NULL; | |
3460 | +} | |
3461 | + | |
3462 | + | |
3463 | +static void ieee80211_tkip_deinit(void *priv) | |
3464 | +{ | |
3465 | + struct ieee80211_tkip_data *_priv = priv; | |
3466 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
3467 | + if (_priv && _priv->tfm_michael) | |
3468 | + crypto_free_tfm(_priv->tfm_michael); | |
3469 | + if (_priv && _priv->tfm_arc4) | |
3470 | + crypto_free_tfm(_priv->tfm_arc4); | |
3471 | + #else | |
3472 | + if (_priv) { | |
3473 | + if (_priv->tx_tfm_michael) | |
3474 | + crypto_free_hash(_priv->tx_tfm_michael); | |
3475 | + if (_priv->tx_tfm_arc4) | |
3476 | + crypto_free_blkcipher(_priv->tx_tfm_arc4); | |
3477 | + if (_priv->rx_tfm_michael) | |
3478 | + crypto_free_hash(_priv->rx_tfm_michael); | |
3479 | + if (_priv->rx_tfm_arc4) | |
3480 | + crypto_free_blkcipher(_priv->rx_tfm_arc4); | |
3481 | + } | |
3482 | + #endif | |
3483 | + kfree(priv); | |
3484 | +} | |
3485 | + | |
3486 | + | |
3487 | +static inline u16 RotR1(u16 val) | |
3488 | +{ | |
3489 | + return (val >> 1) | (val << 15); | |
3490 | +} | |
3491 | + | |
3492 | + | |
3493 | +static inline u8 Lo8(u16 val) | |
3494 | +{ | |
3495 | + return val & 0xff; | |
3496 | +} | |
3497 | + | |
3498 | + | |
3499 | +static inline u8 Hi8(u16 val) | |
3500 | +{ | |
3501 | + return val >> 8; | |
3502 | +} | |
3503 | + | |
3504 | + | |
3505 | +static inline u16 Lo16(u32 val) | |
3506 | +{ | |
3507 | + return val & 0xffff; | |
3508 | +} | |
3509 | + | |
3510 | + | |
3511 | +static inline u16 Hi16(u32 val) | |
3512 | +{ | |
3513 | + return val >> 16; | |
3514 | +} | |
3515 | + | |
3516 | + | |
3517 | +static inline u16 Mk16(u8 hi, u8 lo) | |
3518 | +{ | |
3519 | + return lo | (((u16) hi) << 8); | |
3520 | +} | |
3521 | + | |
3522 | + | |
3523 | +static inline u16 Mk16_le(u16 *v) | |
3524 | +{ | |
3525 | + return le16_to_cpu(*v); | |
3526 | +} | |
3527 | + | |
3528 | + | |
3529 | +static const u16 Sbox[256] = | |
3530 | +{ | |
3531 | + 0xC6A5, 0xF884, 0xEE99, 0xF68D, 0xFF0D, 0xD6BD, 0xDEB1, 0x9154, | |
3532 | + 0x6050, 0x0203, 0xCEA9, 0x567D, 0xE719, 0xB562, 0x4DE6, 0xEC9A, | |
3533 | + 0x8F45, 0x1F9D, 0x8940, 0xFA87, 0xEF15, 0xB2EB, 0x8EC9, 0xFB0B, | |
3534 | + 0x41EC, 0xB367, 0x5FFD, 0x45EA, 0x23BF, 0x53F7, 0xE496, 0x9B5B, | |
3535 | + 0x75C2, 0xE11C, 0x3DAE, 0x4C6A, 0x6C5A, 0x7E41, 0xF502, 0x834F, | |
3536 | + 0x685C, 0x51F4, 0xD134, 0xF908, 0xE293, 0xAB73, 0x6253, 0x2A3F, | |
3537 | + 0x080C, 0x9552, 0x4665, 0x9D5E, 0x3028, 0x37A1, 0x0A0F, 0x2FB5, | |
3538 | + 0x0E09, 0x2436, 0x1B9B, 0xDF3D, 0xCD26, 0x4E69, 0x7FCD, 0xEA9F, | |
3539 | + 0x121B, 0x1D9E, 0x5874, 0x342E, 0x362D, 0xDCB2, 0xB4EE, 0x5BFB, | |
3540 | + 0xA4F6, 0x764D, 0xB761, 0x7DCE, 0x527B, 0xDD3E, 0x5E71, 0x1397, | |
3541 | + 0xA6F5, 0xB968, 0x0000, 0xC12C, 0x4060, 0xE31F, 0x79C8, 0xB6ED, | |
3542 | + 0xD4BE, 0x8D46, 0x67D9, 0x724B, 0x94DE, 0x98D4, 0xB0E8, 0x854A, | |
3543 | + 0xBB6B, 0xC52A, 0x4FE5, 0xED16, 0x86C5, 0x9AD7, 0x6655, 0x1194, | |
3544 | + 0x8ACF, 0xE910, 0x0406, 0xFE81, 0xA0F0, 0x7844, 0x25BA, 0x4BE3, | |
3545 | + 0xA2F3, 0x5DFE, 0x80C0, 0x058A, 0x3FAD, 0x21BC, 0x7048, 0xF104, | |
3546 | + 0x63DF, 0x77C1, 0xAF75, 0x4263, 0x2030, 0xE51A, 0xFD0E, 0xBF6D, | |
3547 | + 0x814C, 0x1814, 0x2635, 0xC32F, 0xBEE1, 0x35A2, 0x88CC, 0x2E39, | |
3548 | + 0x9357, 0x55F2, 0xFC82, 0x7A47, 0xC8AC, 0xBAE7, 0x322B, 0xE695, | |
3549 | + 0xC0A0, 0x1998, 0x9ED1, 0xA37F, 0x4466, 0x547E, 0x3BAB, 0x0B83, | |
3550 | + 0x8CCA, 0xC729, 0x6BD3, 0x283C, 0xA779, 0xBCE2, 0x161D, 0xAD76, | |
3551 | + 0xDB3B, 0x6456, 0x744E, 0x141E, 0x92DB, 0x0C0A, 0x486C, 0xB8E4, | |
3552 | + 0x9F5D, 0xBD6E, 0x43EF, 0xC4A6, 0x39A8, 0x31A4, 0xD337, 0xF28B, | |
3553 | + 0xD532, 0x8B43, 0x6E59, 0xDAB7, 0x018C, 0xB164, 0x9CD2, 0x49E0, | |
3554 | + 0xD8B4, 0xACFA, 0xF307, 0xCF25, 0xCAAF, 0xF48E, 0x47E9, 0x1018, | |
3555 | + 0x6FD5, 0xF088, 0x4A6F, 0x5C72, 0x3824, 0x57F1, 0x73C7, 0x9751, | |
3556 | + 0xCB23, 0xA17C, 0xE89C, 0x3E21, 0x96DD, 0x61DC, 0x0D86, 0x0F85, | |
3557 | + 0xE090, 0x7C42, 0x71C4, 0xCCAA, 0x90D8, 0x0605, 0xF701, 0x1C12, | |
3558 | + 0xC2A3, 0x6A5F, 0xAEF9, 0x69D0, 0x1791, 0x9958, 0x3A27, 0x27B9, | |
3559 | + 0xD938, 0xEB13, 0x2BB3, 0x2233, 0xD2BB, 0xA970, 0x0789, 0x33A7, | |
3560 | + 0x2DB6, 0x3C22, 0x1592, 0xC920, 0x8749, 0xAAFF, 0x5078, 0xA57A, | |
3561 | + 0x038F, 0x59F8, 0x0980, 0x1A17, 0x65DA, 0xD731, 0x84C6, 0xD0B8, | |
3562 | + 0x82C3, 0x29B0, 0x5A77, 0x1E11, 0x7BCB, 0xA8FC, 0x6DD6, 0x2C3A, | |
3563 | +}; | |
3564 | + | |
3565 | + | |
3566 | +static inline u16 _S_(u16 v) | |
3567 | +{ | |
3568 | + u16 t = Sbox[Hi8(v)]; | |
3569 | + return Sbox[Lo8(v)] ^ ((t << 8) | (t >> 8)); | |
3570 | +} | |
3571 | + | |
3572 | +#ifndef JOHN_TKIP | |
3573 | +#define PHASE1_LOOP_COUNT 8 | |
3574 | + | |
3575 | +static void tkip_mixing_phase1(u16 *TTAK, const u8 *TK, const u8 *TA, u32 IV32) | |
3576 | +{ | |
3577 | + int i, j; | |
3578 | + | |
3579 | + /* Initialize the 80-bit TTAK from TSC (IV32) and TA[0..5] */ | |
3580 | + TTAK[0] = Lo16(IV32); | |
3581 | + TTAK[1] = Hi16(IV32); | |
3582 | + TTAK[2] = Mk16(TA[1], TA[0]); | |
3583 | + TTAK[3] = Mk16(TA[3], TA[2]); | |
3584 | + TTAK[4] = Mk16(TA[5], TA[4]); | |
3585 | + | |
3586 | + for (i = 0; i < PHASE1_LOOP_COUNT; i++) { | |
3587 | + j = 2 * (i & 1); | |
3588 | + TTAK[0] += _S_(TTAK[4] ^ Mk16(TK[1 + j], TK[0 + j])); | |
3589 | + TTAK[1] += _S_(TTAK[0] ^ Mk16(TK[5 + j], TK[4 + j])); | |
3590 | + TTAK[2] += _S_(TTAK[1] ^ Mk16(TK[9 + j], TK[8 + j])); | |
3591 | + TTAK[3] += _S_(TTAK[2] ^ Mk16(TK[13 + j], TK[12 + j])); | |
3592 | + TTAK[4] += _S_(TTAK[3] ^ Mk16(TK[1 + j], TK[0 + j])) + i; | |
3593 | + } | |
3594 | +} | |
3595 | + | |
3596 | + | |
3597 | +static void tkip_mixing_phase2(u8 *WEPSeed, const u8 *TK, const u16 *TTAK, | |
3598 | + u16 IV16) | |
3599 | +{ | |
3600 | + /* Make temporary area overlap WEP seed so that the final copy can be | |
3601 | + * avoided on little endian hosts. */ | |
3602 | + u16 *PPK = (u16 *) &WEPSeed[4]; | |
3603 | + | |
3604 | + /* Step 1 - make copy of TTAK and bring in TSC */ | |
3605 | + PPK[0] = TTAK[0]; | |
3606 | + PPK[1] = TTAK[1]; | |
3607 | + PPK[2] = TTAK[2]; | |
3608 | + PPK[3] = TTAK[3]; | |
3609 | + PPK[4] = TTAK[4]; | |
3610 | + PPK[5] = TTAK[4] + IV16; | |
3611 | + | |
3612 | + /* Step 2 - 96-bit bijective mixing using S-box */ | |
3613 | + PPK[0] += _S_(PPK[5] ^ Mk16_le((u16 *) &TK[0])); | |
3614 | + PPK[1] += _S_(PPK[0] ^ Mk16_le((u16 *) &TK[2])); | |
3615 | + PPK[2] += _S_(PPK[1] ^ Mk16_le((u16 *) &TK[4])); | |
3616 | + PPK[3] += _S_(PPK[2] ^ Mk16_le((u16 *) &TK[6])); | |
3617 | + PPK[4] += _S_(PPK[3] ^ Mk16_le((u16 *) &TK[8])); | |
3618 | + PPK[5] += _S_(PPK[4] ^ Mk16_le((u16 *) &TK[10])); | |
3619 | + | |
3620 | + PPK[0] += RotR1(PPK[5] ^ Mk16_le((u16 *) &TK[12])); | |
3621 | + PPK[1] += RotR1(PPK[0] ^ Mk16_le((u16 *) &TK[14])); | |
3622 | + PPK[2] += RotR1(PPK[1]); | |
3623 | + PPK[3] += RotR1(PPK[2]); | |
3624 | + PPK[4] += RotR1(PPK[3]); | |
3625 | + PPK[5] += RotR1(PPK[4]); | |
3626 | + | |
3627 | + /* Step 3 - bring in last of TK bits, assign 24-bit WEP IV value | |
3628 | + * WEPSeed[0..2] is transmitted as WEP IV */ | |
3629 | + WEPSeed[0] = Hi8(IV16); | |
3630 | + WEPSeed[1] = (Hi8(IV16) | 0x20) & 0x7F; | |
3631 | + WEPSeed[2] = Lo8(IV16); | |
3632 | + WEPSeed[3] = Lo8((PPK[5] ^ Mk16_le((u16 *) &TK[0])) >> 1); | |
3633 | + | |
3634 | +#ifdef __BIG_ENDIAN | |
3635 | + { | |
3636 | + int i; | |
3637 | + for (i = 0; i < 6; i++) | |
3638 | + PPK[i] = (PPK[i] << 8) | (PPK[i] >> 8); | |
3639 | + } | |
3640 | +#endif | |
3641 | +} | |
3642 | +#endif | |
3643 | +static int ieee80211_tkip_encrypt(struct sk_buff *skb, int hdr_len, void *priv) | |
3644 | +{ | |
3645 | + struct ieee80211_tkip_data *tkey = priv; | |
3646 | + #if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,21))||(IN_OPENSUSE_SLED)) | |
3647 | + struct blkcipher_desc desc = {.tfm = tkey->tx_tfm_arc4}; | |
3648 | + #endif | |
3649 | + int len; | |
3650 | + u8 *pos; | |
3651 | + struct ieee80211_hdr *hdr; | |
3652 | +#ifndef JOHN_TKIP | |
3653 | + u8 rc4key[16],*icv; | |
3654 | + u32 crc; | |
3655 | + struct scatterlist sg; | |
3656 | +#endif | |
3657 | + int ret; | |
3658 | + | |
3659 | + ret = 0; | |
3660 | + if (skb_headroom(skb) < 8 || skb_tailroom(skb) < 4 || | |
3661 | + skb->len < hdr_len) | |
3662 | + return -1; | |
3663 | + | |
3664 | + hdr = (struct ieee80211_hdr *) skb->data; | |
3665 | +#if 0 | |
3666 | +printk("@@ tkey\n"); | |
3667 | +printk("%x|", ((u32*)tkey->key)[0]); | |
3668 | +printk("%x|", ((u32*)tkey->key)[1]); | |
3669 | +printk("%x|", ((u32*)tkey->key)[2]); | |
3670 | +printk("%x|", ((u32*)tkey->key)[3]); | |
3671 | +printk("%x|", ((u32*)tkey->key)[4]); | |
3672 | +printk("%x|", ((u32*)tkey->key)[5]); | |
3673 | +printk("%x|", ((u32*)tkey->key)[6]); | |
3674 | +printk("%x\n", ((u32*)tkey->key)[7]); | |
3675 | +#endif | |
3676 | + | |
3677 | +#ifndef JOHN_TKIP | |
3678 | + if (!tkey->tx_phase1_done) { | |
3679 | + tkip_mixing_phase1(tkey->tx_ttak, tkey->key, hdr->addr2, | |
3680 | + tkey->tx_iv32); | |
3681 | + tkey->tx_phase1_done = 1; | |
3682 | + } | |
3683 | + tkip_mixing_phase2(rc4key, tkey->key, tkey->tx_ttak, tkey->tx_iv16); | |
3684 | + | |
3685 | +#else | |
3686 | + tkey->tx_phase1_done = 1; | |
3687 | +#endif /*JOHN_TKIP*/ | |
3688 | + | |
3689 | + len = skb->len - hdr_len; | |
3690 | + pos = skb_push(skb, 8); | |
3691 | + memmove(pos, pos + 8, hdr_len); | |
3692 | + pos += hdr_len; | |
3693 | + | |
3694 | +#ifdef JOHN_TKIP | |
3695 | + *pos++ = Hi8(tkey->tx_iv16); | |
3696 | + *pos++ = (Hi8(tkey->tx_iv16) | 0x20) & 0x7F; | |
3697 | + *pos++ = Lo8(tkey->tx_iv16); | |
3698 | +#else | |
3699 | + *pos++ = rc4key[0]; | |
3700 | + *pos++ = rc4key[1]; | |
3701 | + *pos++ = rc4key[2]; | |
3702 | +#endif | |
3703 | + *pos++ = (tkey->key_idx << 6) | (1 << 5) /* Ext IV included */; | |
3704 | + *pos++ = tkey->tx_iv32 & 0xff; | |
3705 | + *pos++ = (tkey->tx_iv32 >> 8) & 0xff; | |
3706 | + *pos++ = (tkey->tx_iv32 >> 16) & 0xff; | |
3707 | + *pos++ = (tkey->tx_iv32 >> 24) & 0xff; | |
3708 | +#ifndef JOHN_TKIP | |
3709 | + icv = skb_put(skb, 4); | |
3710 | +#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0)) | |
3711 | + crc = ~crc32_le(~0, pos, len); | |
3712 | +#else | |
3713 | + crc = ~ether_crc_le(len, pos); | |
3714 | +#endif | |
3715 | + icv[0] = crc; | |
3716 | + icv[1] = crc >> 8; | |
3717 | + icv[2] = crc >> 16; | |
3718 | + icv[3] = crc >> 24; | |
3719 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
3720 | + crypto_cipher_setkey(tkey->tfm_arc4, rc4key, 16); | |
3721 | + sg.page = virt_to_page(pos); | |
3722 | + sg.offset = offset_in_page(pos); | |
3723 | + sg.length = len + 4; | |
3724 | + crypto_cipher_encrypt(tkey->tfm_arc4, &sg, &sg, len + 4); | |
3725 | + #else | |
3726 | + crypto_blkcipher_setkey(tkey->tx_tfm_arc4, rc4key, 16); | |
3727 | + #if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) | |
3728 | + sg.page = virt_to_page(pos); | |
3729 | + sg.offset = offset_in_page(pos); | |
3730 | + sg.length = len + 4; | |
3731 | + #else | |
3732 | + sg_init_one(&sg, pos, len+4); | |
3733 | + #endif | |
3734 | + ret= crypto_blkcipher_encrypt(&desc, &sg, &sg, len + 4); | |
3735 | + #endif | |
3736 | +#endif | |
3737 | + tkey->tx_iv16++; | |
3738 | + if (tkey->tx_iv16 == 0) { | |
3739 | + tkey->tx_phase1_done = 0; | |
3740 | + tkey->tx_iv32++; | |
3741 | + } | |
3742 | +#ifndef JOHN_TKIP | |
3743 | + #if((LINUX_VERSION_CODE <KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
3744 | + return 0; | |
3745 | + #else | |
3746 | + return ret; | |
3747 | + #endif | |
3748 | +#else | |
3749 | + return 0; | |
3750 | +#endif | |
3751 | +} | |
3752 | + | |
3753 | +static int ieee80211_tkip_decrypt(struct sk_buff *skb, int hdr_len, void *priv) | |
3754 | +{ | |
3755 | + struct ieee80211_tkip_data *tkey = priv; | |
3756 | + #if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,21)) ||(IN_OPENSUSE_SLED)) | |
3757 | + struct blkcipher_desc desc = {.tfm = tkey->rx_tfm_arc4}; | |
3758 | + #endif | |
3759 | + u8 keyidx, *pos; | |
3760 | + u32 iv32; | |
3761 | + u16 iv16; | |
3762 | + struct ieee80211_hdr *hdr; | |
3763 | +#ifndef JOHN_TKIP | |
3764 | + u8 icv[4]; | |
3765 | + u32 crc; | |
3766 | + struct scatterlist sg; | |
3767 | + u8 rc4key[16]; | |
3768 | + int plen; | |
3769 | +#endif | |
3770 | + if (skb->len < hdr_len + 8 + 4) | |
3771 | + return -1; | |
3772 | + | |
3773 | + hdr = (struct ieee80211_hdr *) skb->data; | |
3774 | + pos = skb->data + hdr_len; | |
3775 | + keyidx = pos[3]; | |
3776 | + if (!(keyidx & (1 << 5))) { | |
3777 | + if (net_ratelimit()) { | |
3778 | + printk(KERN_DEBUG "TKIP: received packet without ExtIV" | |
3779 | + " flag from " MAC_FMT "\n", MAC_ARG(hdr->addr2)); | |
3780 | + } | |
3781 | + return -2; | |
3782 | + } | |
3783 | + keyidx >>= 6; | |
3784 | + if (tkey->key_idx != keyidx) { | |
3785 | + printk(KERN_DEBUG "TKIP: RX tkey->key_idx=%d frame " | |
3786 | + "keyidx=%d priv=%p\n", tkey->key_idx, keyidx, priv); | |
3787 | + return -6; | |
3788 | + } | |
3789 | + if (!tkey->key_set) { | |
3790 | + if (net_ratelimit()) { | |
3791 | + printk(KERN_DEBUG "TKIP: received packet from " MAC_FMT | |
3792 | + " with keyid=%d that does not have a configured" | |
3793 | + " key\n", MAC_ARG(hdr->addr2), keyidx); | |
3794 | + } | |
3795 | + return -3; | |
3796 | + } | |
3797 | + iv16 = (pos[0] << 8) | pos[2]; | |
3798 | + iv32 = pos[4] | (pos[5] << 8) | (pos[6] << 16) | (pos[7] << 24); | |
3799 | + pos += 8; | |
3800 | +#ifndef JOHN_TKIP | |
3801 | + | |
3802 | + if (iv32 < tkey->rx_iv32 || | |
3803 | + (iv32 == tkey->rx_iv32 && iv16 <= tkey->rx_iv16)) { | |
3804 | + if (net_ratelimit()) { | |
3805 | + printk(KERN_DEBUG "TKIP: replay detected: STA=" MAC_FMT | |
3806 | + " previous TSC %08x%04x received TSC " | |
3807 | + "%08x%04x\n", MAC_ARG(hdr->addr2), | |
3808 | + tkey->rx_iv32, tkey->rx_iv16, iv32, iv16); | |
3809 | + } | |
3810 | + tkey->dot11RSNAStatsTKIPReplays++; | |
3811 | + return -4; | |
3812 | + } | |
3813 | + | |
3814 | + if (iv32 != tkey->rx_iv32 || !tkey->rx_phase1_done) { | |
3815 | + tkip_mixing_phase1(tkey->rx_ttak, tkey->key, hdr->addr2, iv32); | |
3816 | + tkey->rx_phase1_done = 1; | |
3817 | + } | |
3818 | + tkip_mixing_phase2(rc4key, tkey->key, tkey->rx_ttak, iv16); | |
3819 | + | |
3820 | + plen = skb->len - hdr_len - 12; | |
3821 | + #if((LINUX_VERSION_CODE <KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
3822 | + crypto_cipher_setkey(tkey->tfm_arc4, rc4key, 16); | |
3823 | + sg.page = virt_to_page(pos); | |
3824 | + sg.offset = offset_in_page(pos); | |
3825 | + sg.length = plen + 4; | |
3826 | + crypto_cipher_decrypt(tkey->tfm_arc4, &sg, &sg, plen + 4); | |
3827 | + #else | |
3828 | + crypto_blkcipher_setkey(tkey->rx_tfm_arc4, rc4key, 16); | |
3829 | + #if(LINUX_VERSION_CODE <KERNEL_VERSION(2,6,24)) | |
3830 | + sg.page = virt_to_page(pos); | |
3831 | + sg.offset = offset_in_page(pos); | |
3832 | + sg.length = plen + 4; | |
3833 | + #else | |
3834 | + sg_init_one(&sg, pos, plen+4); | |
3835 | + #endif | |
3836 | + if (crypto_blkcipher_decrypt(&desc, &sg, &sg, plen + 4)) { | |
3837 | + if (net_ratelimit()) { | |
3838 | + printk(KERN_DEBUG ": TKIP: failed to decrypt " | |
3839 | + "received packet from " MAC_FMT "\n", | |
3840 | + MAC_ARG(hdr->addr2)); | |
3841 | + } | |
3842 | + return -7; | |
3843 | + } | |
3844 | + #endif | |
3845 | + | |
3846 | +#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0)) | |
3847 | + crc = ~crc32_le(~0, pos, plen); | |
3848 | +#else | |
3849 | + crc = ~ether_crc_le(plen, pos); | |
3850 | +#endif | |
3851 | + icv[0] = crc; | |
3852 | + icv[1] = crc >> 8; | |
3853 | + icv[2] = crc >> 16; | |
3854 | + icv[3] = crc >> 24; | |
3855 | + if (memcmp(icv, pos + plen, 4) != 0) { | |
3856 | + if (iv32 != tkey->rx_iv32) { | |
3857 | + /* Previously cached Phase1 result was already lost, so | |
3858 | + * it needs to be recalculated for the next packet. */ | |
3859 | + tkey->rx_phase1_done = 0; | |
3860 | + } | |
3861 | + if (net_ratelimit()) { | |
3862 | + printk(KERN_DEBUG "TKIP: ICV error detected: STA=" | |
3863 | + MAC_FMT "\n", MAC_ARG(hdr->addr2)); | |
3864 | + } | |
3865 | + tkey->dot11RSNAStatsTKIPICVErrors++; | |
3866 | + return -5; | |
3867 | + } | |
3868 | + | |
3869 | +#endif /* JOHN_TKIP */ | |
3870 | + | |
3871 | + /* Update real counters only after Michael MIC verification has | |
3872 | + * completed */ | |
3873 | + tkey->rx_iv32_new = iv32; | |
3874 | + tkey->rx_iv16_new = iv16; | |
3875 | + | |
3876 | + /* Remove IV and ICV */ | |
3877 | + memmove(skb->data + 8, skb->data, hdr_len); | |
3878 | + skb_pull(skb, 8); | |
3879 | + skb_trim(skb, skb->len - 4); | |
3880 | + | |
3881 | +//john's test | |
3882 | +#ifdef JOHN_DUMP | |
3883 | +if( ((u16*)skb->data)[0] & 0x4000){ | |
3884 | + printk("@@ rx decrypted skb->data"); | |
3885 | + int i; | |
3886 | + for(i=0;i<skb->len;i++){ | |
3887 | + if( (i%24)==0 ) printk("\n"); | |
3888 | + printk("%2x ", ((u8*)skb->data)[i]); | |
3889 | + } | |
3890 | + printk("\n"); | |
3891 | +} | |
3892 | +#endif /*JOHN_DUMP*/ | |
3893 | + return keyidx; | |
3894 | +} | |
3895 | + | |
3896 | +#if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21)) && (!IN_OPENSUSE_SLED)) | |
3897 | +static int michael_mic(struct ieee80211_tkip_data *tkey, u8 *key, u8 *hdr, | |
3898 | + u8 *data, size_t data_len, u8 *mic) | |
3899 | +{ | |
3900 | + struct scatterlist sg[2]; | |
3901 | +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20) | |
3902 | + struct hash_desc desc; | |
3903 | + int ret=0; | |
3904 | +#endif | |
3905 | + if (tkey->tfm_michael == NULL) { | |
3906 | + printk(KERN_WARNING "michael_mic: tfm_michael == NULL\n"); | |
3907 | + return -1; | |
3908 | + } | |
3909 | + sg[0].page = virt_to_page(hdr); | |
3910 | + sg[0].offset = offset_in_page(hdr); | |
3911 | + sg[0].length = 16; | |
3912 | + | |
3913 | + sg[1].page = virt_to_page(data); | |
3914 | + sg[1].offset = offset_in_page(data); | |
3915 | + sg[1].length = data_len; | |
3916 | + | |
3917 | + //crypto_digest_init(tkey->tfm_michael); | |
3918 | + //crypto_digest_setkey(tkey->tfm_michael, key, 8); | |
3919 | + //crypto_digest_update(tkey->tfm_michael, sg, 2); | |
3920 | + //crypto_digest_final(tkey->tfm_michael, mic); | |
3921 | + | |
3922 | + //return 0; | |
3923 | +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20) | |
3924 | + crypto_digest_init(tkey->tfm_michael); | |
3925 | + crypto_digest_setkey(tkey->tfm_michael, key, 8); | |
3926 | + crypto_digest_update(tkey->tfm_michael, sg, 2); | |
3927 | + crypto_digest_final(tkey->tfm_michael, mic); | |
3928 | + | |
3929 | + return 0; | |
3930 | +#else | |
3931 | +if (crypto_hash_setkey(tkey->tfm_michael, key, 8)) | |
3932 | + return -1; | |
3933 | + | |
3934 | +// return 0; | |
3935 | + desc.tfm = tkey->tfm_michael; | |
3936 | + desc.flags = 0; | |
3937 | + ret = crypto_hash_digest(&desc, sg, data_len + 16, mic); | |
3938 | + return ret; | |
3939 | +#endif | |
3940 | +} | |
3941 | +#else | |
3942 | +static int michael_mic(struct crypto_hash *tfm_michael, u8 * key, u8 * hdr, | |
3943 | + u8 * data, size_t data_len, u8 * mic) | |
3944 | +{ | |
3945 | + struct hash_desc desc; | |
3946 | + struct scatterlist sg[2]; | |
3947 | + | |
3948 | + if (tfm_michael == NULL) { | |
3949 | + printk(KERN_WARNING "michael_mic: tfm_michael == NULL\n"); | |
3950 | + return -1; | |
3951 | + } | |
3952 | + #if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) | |
3953 | + sg[0].page = virt_to_page(hdr); | |
3954 | + sg[0].offset = offset_in_page(hdr); | |
3955 | + sg[0].length = 16; | |
3956 | + sg[1].page = virt_to_page(data); | |
3957 | + sg[1].offset = offset_in_page(data); | |
3958 | + sg[1].length = data_len; | |
3959 | + #else | |
3960 | + sg_init_table(sg, 2); | |
3961 | + sg_set_buf(&sg[0], hdr, 16); | |
3962 | + sg_set_buf(&sg[1], data, data_len); | |
3963 | + #endif | |
3964 | + | |
3965 | + if (crypto_hash_setkey(tfm_michael, key, 8)) | |
3966 | + return -1; | |
3967 | + | |
3968 | + desc.tfm = tfm_michael; | |
3969 | + desc.flags = 0; | |
3970 | + return crypto_hash_digest(&desc, sg, data_len + 16, mic); | |
3971 | +} | |
3972 | +#endif | |
3973 | + | |
3974 | + | |
3975 | + | |
3976 | +static void michael_mic_hdr(struct sk_buff *skb, u8 *hdr) | |
3977 | +{ | |
3978 | + struct ieee80211_hdr *hdr11; | |
3979 | + | |
3980 | + hdr11 = (struct ieee80211_hdr *) skb->data; | |
3981 | + switch (le16_to_cpu(hdr11->frame_ctl) & | |
3982 | + (IEEE80211_FCTL_FROMDS | IEEE80211_FCTL_TODS)) { | |
3983 | + case IEEE80211_FCTL_TODS: | |
3984 | + memcpy(hdr, hdr11->addr3, ETH_ALEN); /* DA */ | |
3985 | + memcpy(hdr + ETH_ALEN, hdr11->addr2, ETH_ALEN); /* SA */ | |
3986 | + break; | |
3987 | + case IEEE80211_FCTL_FROMDS: | |
3988 | + memcpy(hdr, hdr11->addr1, ETH_ALEN); /* DA */ | |
3989 | + memcpy(hdr + ETH_ALEN, hdr11->addr3, ETH_ALEN); /* SA */ | |
3990 | + break; | |
3991 | + case IEEE80211_FCTL_FROMDS | IEEE80211_FCTL_TODS: | |
3992 | + memcpy(hdr, hdr11->addr3, ETH_ALEN); /* DA */ | |
3993 | + memcpy(hdr + ETH_ALEN, hdr11->addr4, ETH_ALEN); /* SA */ | |
3994 | + break; | |
3995 | + case 0: | |
3996 | + memcpy(hdr, hdr11->addr1, ETH_ALEN); /* DA */ | |
3997 | + memcpy(hdr + ETH_ALEN, hdr11->addr2, ETH_ALEN); /* SA */ | |
3998 | + break; | |
3999 | + } | |
4000 | + | |
4001 | + hdr[12] = 0; /* priority */ | |
4002 | + | |
4003 | + hdr[13] = hdr[14] = hdr[15] = 0; /* reserved */ | |
4004 | +} | |
4005 | + | |
4006 | + | |
4007 | +static int ieee80211_michael_mic_add(struct sk_buff *skb, int hdr_len, void *priv) | |
4008 | +{ | |
4009 | + struct ieee80211_tkip_data *tkey = priv; | |
4010 | + u8 *pos; | |
4011 | + struct ieee80211_hdr *hdr; | |
4012 | + | |
4013 | + hdr = (struct ieee80211_hdr *) skb->data; | |
4014 | + | |
4015 | + if (skb_tailroom(skb) < 8 || skb->len < hdr_len) { | |
4016 | + printk(KERN_DEBUG "Invalid packet for Michael MIC add " | |
4017 | + "(tailroom=%d hdr_len=%d skb->len=%d)\n", | |
4018 | + skb_tailroom(skb), hdr_len, skb->len); | |
4019 | + return -1; | |
4020 | + } | |
4021 | + | |
4022 | + michael_mic_hdr(skb, tkey->tx_hdr); | |
4023 | + | |
4024 | + // { david, 2006.9.1 | |
4025 | + // fix the wpa process with wmm enabled. | |
4026 | + if(IEEE80211_QOS_HAS_SEQ(le16_to_cpu(hdr->frame_ctl))) { | |
4027 | + tkey->tx_hdr[12] = *(skb->data + hdr_len - 2) & 0x07; | |
4028 | + } | |
4029 | + // } | |
4030 | + pos = skb_put(skb, 8); | |
4031 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
4032 | + if (michael_mic(tkey, &tkey->key[16], tkey->tx_hdr, | |
4033 | + skb->data + hdr_len, skb->len - 8 - hdr_len, pos)) | |
4034 | + #else | |
4035 | + if (michael_mic(tkey->tx_tfm_michael, &tkey->key[16], tkey->tx_hdr, | |
4036 | + skb->data + hdr_len, skb->len - 8 - hdr_len, pos)) | |
4037 | + #endif | |
4038 | + return -1; | |
4039 | + | |
4040 | + return 0; | |
4041 | +} | |
4042 | + | |
4043 | + | |
4044 | +#if WIRELESS_EXT >= 18 | |
4045 | +static void ieee80211_michael_mic_failure(struct net_device *dev, | |
4046 | + struct ieee80211_hdr *hdr, | |
4047 | + int keyidx) | |
4048 | +{ | |
4049 | + union iwreq_data wrqu; | |
4050 | + struct iw_michaelmicfailure ev; | |
4051 | + | |
4052 | + /* TODO: needed parameters: count, keyid, key type, TSC */ | |
4053 | + memset(&ev, 0, sizeof(ev)); | |
4054 | + ev.flags = keyidx & IW_MICFAILURE_KEY_ID; | |
4055 | + if (hdr->addr1[0] & 0x01) | |
4056 | + ev.flags |= IW_MICFAILURE_GROUP; | |
4057 | + else | |
4058 | + ev.flags |= IW_MICFAILURE_PAIRWISE; | |
4059 | + ev.src_addr.sa_family = ARPHRD_ETHER; | |
4060 | + memcpy(ev.src_addr.sa_data, hdr->addr2, ETH_ALEN); | |
4061 | + memset(&wrqu, 0, sizeof(wrqu)); | |
4062 | + wrqu.data.length = sizeof(ev); | |
4063 | + wireless_send_event(dev, IWEVMICHAELMICFAILURE, &wrqu, (char *) &ev); | |
4064 | +} | |
4065 | +#elif WIRELESS_EXT >= 15 | |
4066 | +static void ieee80211_michael_mic_failure(struct net_device *dev, | |
4067 | + struct ieee80211_hdr *hdr, | |
4068 | + int keyidx) | |
4069 | +{ | |
4070 | + union iwreq_data wrqu; | |
4071 | + char buf[128]; | |
4072 | + | |
4073 | + /* TODO: needed parameters: count, keyid, key type, TSC */ | |
4074 | + sprintf(buf, "MLME-MICHAELMICFAILURE.indication(keyid=%d %scast addr=" | |
4075 | + MAC_FMT ")", keyidx, hdr->addr1[0] & 0x01 ? "broad" : "uni", | |
4076 | + MAC_ARG(hdr->addr2)); | |
4077 | + memset(&wrqu, 0, sizeof(wrqu)); | |
4078 | + wrqu.data.length = strlen(buf); | |
4079 | + wireless_send_event(dev, IWEVCUSTOM, &wrqu, buf); | |
4080 | +} | |
4081 | +#else /* WIRELESS_EXT >= 15 */ | |
4082 | +static inline void ieee80211_michael_mic_failure(struct net_device *dev, | |
4083 | + struct ieee80211_hdr *hdr, | |
4084 | + int keyidx) | |
4085 | +{ | |
4086 | +} | |
4087 | +#endif /* WIRELESS_EXT >= 15 */ | |
4088 | + | |
4089 | + | |
4090 | +static int ieee80211_michael_mic_verify(struct sk_buff *skb, int keyidx, | |
4091 | + int hdr_len, void *priv) | |
4092 | +{ | |
4093 | + struct ieee80211_tkip_data *tkey = priv; | |
4094 | + u8 mic[8]; | |
4095 | + struct ieee80211_hdr *hdr; | |
4096 | + | |
4097 | + hdr = (struct ieee80211_hdr *) skb->data; | |
4098 | + | |
4099 | + if (!tkey->key_set) | |
4100 | + return -1; | |
4101 | + | |
4102 | + michael_mic_hdr(skb, tkey->rx_hdr); | |
4103 | + // { david, 2006.9.1 | |
4104 | + // fix the wpa process with wmm enabled. | |
4105 | + if(IEEE80211_QOS_HAS_SEQ(le16_to_cpu(hdr->frame_ctl))) { | |
4106 | + tkey->rx_hdr[12] = *(skb->data + hdr_len - 2) & 0x07; | |
4107 | + } | |
4108 | + // } | |
4109 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
4110 | + if (michael_mic(tkey, &tkey->key[24], tkey->rx_hdr, | |
4111 | + skb->data + hdr_len, skb->len - 8 - hdr_len, mic)) | |
4112 | + #else | |
4113 | + if (michael_mic(tkey->rx_tfm_michael, &tkey->key[24], tkey->rx_hdr, | |
4114 | + skb->data + hdr_len, skb->len - 8 - hdr_len, mic)) | |
4115 | + #endif | |
4116 | + return -1; | |
4117 | + if (memcmp(mic, skb->data + skb->len - 8, 8) != 0) { | |
4118 | + struct ieee80211_hdr *hdr; | |
4119 | + hdr = (struct ieee80211_hdr *) skb->data; | |
4120 | + printk(KERN_DEBUG "%s: Michael MIC verification failed for " | |
4121 | + "MSDU from " MAC_FMT " keyidx=%d\n", | |
4122 | + skb->dev ? skb->dev->name : "N/A", MAC_ARG(hdr->addr2), | |
4123 | + keyidx); | |
4124 | + if (skb->dev) | |
4125 | + ieee80211_michael_mic_failure(skb->dev, hdr, keyidx); | |
4126 | + tkey->dot11RSNAStatsTKIPLocalMICFailures++; | |
4127 | + return -1; | |
4128 | + } | |
4129 | + | |
4130 | + /* Update TSC counters for RX now that the packet verification has | |
4131 | + * completed. */ | |
4132 | + tkey->rx_iv32 = tkey->rx_iv32_new; | |
4133 | + tkey->rx_iv16 = tkey->rx_iv16_new; | |
4134 | + | |
4135 | + skb_trim(skb, skb->len - 8); | |
4136 | + | |
4137 | + return 0; | |
4138 | +} | |
4139 | + | |
4140 | + | |
4141 | +static int ieee80211_tkip_set_key(void *key, int len, u8 *seq, void *priv) | |
4142 | +{ | |
4143 | + struct ieee80211_tkip_data *tkey = priv; | |
4144 | + int keyidx; | |
4145 | + #if ((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
4146 | + struct crypto_tfm *tfm = tkey->tfm_michael; | |
4147 | + struct crypto_tfm *tfm2 = tkey->tfm_arc4; | |
4148 | + #else | |
4149 | + struct crypto_hash *tfm = tkey->tx_tfm_michael; | |
4150 | + struct crypto_blkcipher *tfm2 = tkey->tx_tfm_arc4; | |
4151 | + struct crypto_hash *tfm3 = tkey->rx_tfm_michael; | |
4152 | + struct crypto_blkcipher *tfm4 = tkey->rx_tfm_arc4; | |
4153 | + #endif | |
4154 | + | |
4155 | + keyidx = tkey->key_idx; | |
4156 | + memset(tkey, 0, sizeof(*tkey)); | |
4157 | + tkey->key_idx = keyidx; | |
4158 | + | |
4159 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
4160 | + tkey->tfm_michael = tfm; | |
4161 | + tkey->tfm_arc4 = tfm2; | |
4162 | + #else | |
4163 | + tkey->tx_tfm_michael = tfm; | |
4164 | + tkey->tx_tfm_arc4 = tfm2; | |
4165 | + tkey->rx_tfm_michael = tfm3; | |
4166 | + tkey->rx_tfm_arc4 = tfm4; | |
4167 | + #endif | |
4168 | + | |
4169 | + if (len == TKIP_KEY_LEN) { | |
4170 | + memcpy(tkey->key, key, TKIP_KEY_LEN); | |
4171 | + tkey->key_set = 1; | |
4172 | + tkey->tx_iv16 = 1; /* TSC is initialized to 1 */ | |
4173 | + if (seq) { | |
4174 | + tkey->rx_iv32 = (seq[5] << 24) | (seq[4] << 16) | | |
4175 | + (seq[3] << 8) | seq[2]; | |
4176 | + tkey->rx_iv16 = (seq[1] << 8) | seq[0]; | |
4177 | + } | |
4178 | + } else if (len == 0) | |
4179 | + tkey->key_set = 0; | |
4180 | + else | |
4181 | + return -1; | |
4182 | + | |
4183 | + return 0; | |
4184 | +} | |
4185 | + | |
4186 | + | |
4187 | +static int ieee80211_tkip_get_key(void *key, int len, u8 *seq, void *priv) | |
4188 | +{ | |
4189 | + struct ieee80211_tkip_data *tkey = priv; | |
4190 | + | |
4191 | + if (len < TKIP_KEY_LEN) | |
4192 | + return -1; | |
4193 | + | |
4194 | + if (!tkey->key_set) | |
4195 | + return 0; | |
4196 | + memcpy(key, tkey->key, TKIP_KEY_LEN); | |
4197 | + | |
4198 | + if (seq) { | |
4199 | + /* Return the sequence number of the last transmitted frame. */ | |
4200 | + u16 iv16 = tkey->tx_iv16; | |
4201 | + u32 iv32 = tkey->tx_iv32; | |
4202 | + if (iv16 == 0) | |
4203 | + iv32--; | |
4204 | + iv16--; | |
4205 | + seq[0] = tkey->tx_iv16; | |
4206 | + seq[1] = tkey->tx_iv16 >> 8; | |
4207 | + seq[2] = tkey->tx_iv32; | |
4208 | + seq[3] = tkey->tx_iv32 >> 8; | |
4209 | + seq[4] = tkey->tx_iv32 >> 16; | |
4210 | + seq[5] = tkey->tx_iv32 >> 24; | |
4211 | + } | |
4212 | + | |
4213 | + return TKIP_KEY_LEN; | |
4214 | +} | |
4215 | + | |
4216 | + | |
4217 | +static char * ieee80211_tkip_print_stats(char *p, void *priv) | |
4218 | +{ | |
4219 | + struct ieee80211_tkip_data *tkip = priv; | |
4220 | + p += sprintf(p, "key[%d] alg=TKIP key_set=%d " | |
4221 | + "tx_pn=%02x%02x%02x%02x%02x%02x " | |
4222 | + "rx_pn=%02x%02x%02x%02x%02x%02x " | |
4223 | + "replays=%d icv_errors=%d local_mic_failures=%d\n", | |
4224 | + tkip->key_idx, tkip->key_set, | |
4225 | + (tkip->tx_iv32 >> 24) & 0xff, | |
4226 | + (tkip->tx_iv32 >> 16) & 0xff, | |
4227 | + (tkip->tx_iv32 >> 8) & 0xff, | |
4228 | + tkip->tx_iv32 & 0xff, | |
4229 | + (tkip->tx_iv16 >> 8) & 0xff, | |
4230 | + tkip->tx_iv16 & 0xff, | |
4231 | + (tkip->rx_iv32 >> 24) & 0xff, | |
4232 | + (tkip->rx_iv32 >> 16) & 0xff, | |
4233 | + (tkip->rx_iv32 >> 8) & 0xff, | |
4234 | + tkip->rx_iv32 & 0xff, | |
4235 | + (tkip->rx_iv16 >> 8) & 0xff, | |
4236 | + tkip->rx_iv16 & 0xff, | |
4237 | + tkip->dot11RSNAStatsTKIPReplays, | |
4238 | + tkip->dot11RSNAStatsTKIPICVErrors, | |
4239 | + tkip->dot11RSNAStatsTKIPLocalMICFailures); | |
4240 | + return p; | |
4241 | +} | |
4242 | + | |
4243 | + | |
4244 | +static struct ieee80211_crypto_ops ieee80211_crypt_tkip = { | |
4245 | + .name = "TKIP", | |
4246 | + .init = ieee80211_tkip_init, | |
4247 | + .deinit = ieee80211_tkip_deinit, | |
4248 | + .encrypt_mpdu = ieee80211_tkip_encrypt, | |
4249 | + .decrypt_mpdu = ieee80211_tkip_decrypt, | |
4250 | + .encrypt_msdu = ieee80211_michael_mic_add, | |
4251 | + .decrypt_msdu = ieee80211_michael_mic_verify, | |
4252 | + .set_key = ieee80211_tkip_set_key, | |
4253 | + .get_key = ieee80211_tkip_get_key, | |
4254 | + .print_stats = ieee80211_tkip_print_stats, | |
4255 | + .extra_prefix_len = 4 + 4, /* IV + ExtIV */ | |
4256 | + .extra_postfix_len = 8 + 4, /* MIC + ICV */ | |
4257 | + .owner = THIS_MODULE, | |
4258 | +}; | |
4259 | + | |
4260 | + | |
4261 | +int ieee80211_crypto_tkip_init(void) | |
4262 | +{ | |
4263 | + return ieee80211_register_crypto_ops(&ieee80211_crypt_tkip); | |
4264 | +} | |
4265 | + | |
4266 | + | |
4267 | +void ieee80211_crypto_tkip_exit(void) | |
4268 | +{ | |
4269 | + ieee80211_unregister_crypto_ops(&ieee80211_crypt_tkip); | |
4270 | +} | |
4271 | + | |
4272 | + | |
4273 | +void ieee80211_tkip_null(void) | |
4274 | +{ | |
4275 | +// printk("============>%s()\n", __FUNCTION__); | |
4276 | + return; | |
4277 | +} | |
4278 | + | |
4279 | +#if 0 | |
4280 | +#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0)) | |
4281 | +EXPORT_SYMBOL(ieee80211_tkip_null); | |
4282 | +#else | |
4283 | +EXPORT_SYMBOL_NOVERS(ieee80211_tkip_null); | |
4284 | +#endif | |
4285 | +#endif | |
4286 | + | |
4287 | + | |
4288 | +//module_init(ieee80211_crypto_tkip_init); | |
4289 | +//module_exit(ieee80211_crypto_tkip_exit); | |
4290 | --- /dev/null | |
4291 | +++ b/drivers/staging/rtl8187se/ieee80211/ieee80211_crypt_wep.c | |
4292 | @@ -0,0 +1,394 @@ | |
4293 | +/* | |
4294 | + * Host AP crypt: host-based WEP encryption implementation for Host AP driver | |
4295 | + * | |
4296 | + * Copyright (c) 2002-2004, Jouni Malinen <jkmaline@cc.hut.fi> | |
4297 | + * | |
4298 | + * This program is free software; you can redistribute it and/or modify | |
4299 | + * it under the terms of the GNU General Public License version 2 as | |
4300 | + * published by the Free Software Foundation. See README and COPYING for | |
4301 | + * more details. | |
4302 | + */ | |
4303 | + | |
4304 | +//#include <linux/config.h> | |
4305 | +#include <linux/version.h> | |
4306 | +#include <linux/module.h> | |
4307 | +#include <linux/init.h> | |
4308 | +#include <linux/slab.h> | |
4309 | +#include <linux/random.h> | |
4310 | +#include <linux/skbuff.h> | |
4311 | +#include <asm/string.h> | |
4312 | + | |
4313 | +#include "ieee80211.h" | |
4314 | + | |
4315 | +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)) | |
4316 | +#include "rtl_crypto.h" | |
4317 | +#else | |
4318 | +#include <linux/crypto.h> | |
4319 | +#endif | |
4320 | + | |
4321 | +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20) | |
4322 | + #include <asm/scatterlist.h> | |
4323 | +#else | |
4324 | + #include <linux/scatterlist.h> | |
4325 | +#endif | |
4326 | +//#include <asm/scatterlist.h> | |
4327 | +#include <linux/crc32.h> | |
4328 | + | |
4329 | +MODULE_AUTHOR("Jouni Malinen"); | |
4330 | +MODULE_DESCRIPTION("Host AP crypt: WEP"); | |
4331 | +MODULE_LICENSE("GPL"); | |
4332 | + | |
4333 | +#ifdef OPENSUSE_SLED | |
4334 | +#ifndef IN_OPENSUSE_SLED | |
4335 | +#define IN_OPENSUSE_SLED 1 | |
4336 | +#endif | |
4337 | +#endif | |
4338 | + | |
4339 | + | |
4340 | +struct prism2_wep_data { | |
4341 | + u32 iv; | |
4342 | +#define WEP_KEY_LEN 13 | |
4343 | + u8 key[WEP_KEY_LEN + 1]; | |
4344 | + u8 key_len; | |
4345 | + u8 key_idx; | |
4346 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
4347 | + struct crypto_tfm *tfm; | |
4348 | + #else | |
4349 | + struct crypto_blkcipher *tx_tfm; | |
4350 | + struct crypto_blkcipher *rx_tfm; | |
4351 | + #endif | |
4352 | +}; | |
4353 | + | |
4354 | + | |
4355 | +static void * prism2_wep_init(int keyidx) | |
4356 | +{ | |
4357 | + struct prism2_wep_data *priv; | |
4358 | + | |
4359 | + priv = kmalloc(sizeof(*priv), GFP_ATOMIC); | |
4360 | + if (priv == NULL) | |
4361 | + goto fail; | |
4362 | + memset(priv, 0, sizeof(*priv)); | |
4363 | + priv->key_idx = keyidx; | |
4364 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
4365 | + priv->tfm = crypto_alloc_tfm("arc4", 0); | |
4366 | + if (priv->tfm == NULL) { | |
4367 | + printk(KERN_DEBUG "ieee80211_crypt_wep: could not allocate " | |
4368 | + "crypto API arc4\n"); | |
4369 | + goto fail; | |
4370 | + } | |
4371 | + #else | |
4372 | + priv->tx_tfm = crypto_alloc_blkcipher("ecb(arc4)", 0, CRYPTO_ALG_ASYNC); | |
4373 | + if (IS_ERR(priv->tx_tfm)) { | |
4374 | + printk(KERN_DEBUG "ieee80211_crypt_wep: could not allocate " | |
4375 | + "crypto API arc4\n"); | |
4376 | + priv->tx_tfm = NULL; | |
4377 | + goto fail; | |
4378 | + } | |
4379 | + priv->rx_tfm = crypto_alloc_blkcipher("ecb(arc4)", 0, CRYPTO_ALG_ASYNC); | |
4380 | + if (IS_ERR(priv->rx_tfm)) { | |
4381 | + printk(KERN_DEBUG "ieee80211_crypt_wep: could not allocate " | |
4382 | + "crypto API arc4\n"); | |
4383 | + priv->rx_tfm = NULL; | |
4384 | + goto fail; | |
4385 | + } | |
4386 | + #endif | |
4387 | + | |
4388 | + /* start WEP IV from a random value */ | |
4389 | + get_random_bytes(&priv->iv, 4); | |
4390 | + | |
4391 | + return priv; | |
4392 | + | |
4393 | +fail: | |
4394 | + //#if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21)) | |
4395 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
4396 | + if (priv) { | |
4397 | + if (priv->tfm) | |
4398 | + crypto_free_tfm(priv->tfm); | |
4399 | + kfree(priv); | |
4400 | + } | |
4401 | + #else | |
4402 | + if (priv) { | |
4403 | + if (priv->tx_tfm) | |
4404 | + crypto_free_blkcipher(priv->tx_tfm); | |
4405 | + if (priv->rx_tfm) | |
4406 | + crypto_free_blkcipher(priv->rx_tfm); | |
4407 | + kfree(priv); | |
4408 | + } | |
4409 | + #endif | |
4410 | + return NULL; | |
4411 | +} | |
4412 | + | |
4413 | + | |
4414 | +static void prism2_wep_deinit(void *priv) | |
4415 | +{ | |
4416 | + struct prism2_wep_data *_priv = priv; | |
4417 | + //#if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21)) | |
4418 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
4419 | + if (_priv && _priv->tfm) | |
4420 | + crypto_free_tfm(_priv->tfm); | |
4421 | + #else | |
4422 | + if (_priv) { | |
4423 | + if (_priv->tx_tfm) | |
4424 | + crypto_free_blkcipher(_priv->tx_tfm); | |
4425 | + if (_priv->rx_tfm) | |
4426 | + crypto_free_blkcipher(_priv->rx_tfm); | |
4427 | + } | |
4428 | + #endif | |
4429 | + kfree(priv); | |
4430 | +} | |
4431 | + | |
4432 | + | |
4433 | +/* Perform WEP encryption on given skb that has at least 4 bytes of headroom | |
4434 | + * for IV and 4 bytes of tailroom for ICV. Both IV and ICV will be transmitted, | |
4435 | + * so the payload length increases with 8 bytes. | |
4436 | + * | |
4437 | + * WEP frame payload: IV + TX key idx, RC4(data), ICV = RC4(CRC32(data)) | |
4438 | + */ | |
4439 | +static int prism2_wep_encrypt(struct sk_buff *skb, int hdr_len, void *priv) | |
4440 | +{ | |
4441 | + struct prism2_wep_data *wep = priv; | |
4442 | +//#if(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,21)) | |
4443 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,21))||(IN_OPENSUSE_SLED)) | |
4444 | + struct blkcipher_desc desc = {.tfm = wep->tx_tfm}; | |
4445 | +#endif | |
4446 | + u32 klen, len; | |
4447 | + u8 key[WEP_KEY_LEN + 3]; | |
4448 | + u8 *pos; | |
4449 | +#ifndef JOHN_HWSEC | |
4450 | + u32 crc; | |
4451 | + u8 *icv; | |
4452 | + struct scatterlist sg; | |
4453 | +#endif | |
4454 | + if (skb_headroom(skb) < 4 || skb_tailroom(skb) < 4 || | |
4455 | + skb->len < hdr_len) | |
4456 | + return -1; | |
4457 | + | |
4458 | + len = skb->len - hdr_len; | |
4459 | + pos = skb_push(skb, 4); | |
4460 | + memmove(pos, pos + 4, hdr_len); | |
4461 | + pos += hdr_len; | |
4462 | + | |
4463 | + klen = 3 + wep->key_len; | |
4464 | + | |
4465 | + wep->iv++; | |
4466 | + | |
4467 | + /* Fluhrer, Mantin, and Shamir have reported weaknesses in the key | |
4468 | + * scheduling algorithm of RC4. At least IVs (KeyByte + 3, 0xff, N) | |
4469 | + * can be used to speedup attacks, so avoid using them. */ | |
4470 | + if ((wep->iv & 0xff00) == 0xff00) { | |
4471 | + u8 B = (wep->iv >> 16) & 0xff; | |
4472 | + if (B >= 3 && B < klen) | |
4473 | + wep->iv += 0x0100; | |
4474 | + } | |
4475 | + | |
4476 | + /* Prepend 24-bit IV to RC4 key and TX frame */ | |
4477 | + *pos++ = key[0] = (wep->iv >> 16) & 0xff; | |
4478 | + *pos++ = key[1] = (wep->iv >> 8) & 0xff; | |
4479 | + *pos++ = key[2] = wep->iv & 0xff; | |
4480 | + *pos++ = wep->key_idx << 6; | |
4481 | + | |
4482 | + /* Copy rest of the WEP key (the secret part) */ | |
4483 | + memcpy(key + 3, wep->key, wep->key_len); | |
4484 | + | |
4485 | +#ifndef JOHN_HWSEC | |
4486 | + /* Append little-endian CRC32 and encrypt it to produce ICV */ | |
4487 | +#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0)) | |
4488 | + crc = ~crc32_le(~0, pos, len); | |
4489 | +#else | |
4490 | + crc = ~ether_crc_le(len, pos); | |
4491 | +#endif | |
4492 | + icv = skb_put(skb, 4); | |
4493 | + icv[0] = crc; | |
4494 | + icv[1] = crc >> 8; | |
4495 | + icv[2] = crc >> 16; | |
4496 | + icv[3] = crc >> 24; | |
4497 | + | |
4498 | + //#if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21)) | |
4499 | + #if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
4500 | + crypto_cipher_setkey(wep->tfm, key, klen); | |
4501 | + sg.page = virt_to_page(pos); | |
4502 | + sg.offset = offset_in_page(pos); | |
4503 | + sg.length = len + 4; | |
4504 | + crypto_cipher_encrypt(wep->tfm, &sg, &sg, len + 4); | |
4505 | + | |
4506 | + return 0; | |
4507 | + #else | |
4508 | + crypto_blkcipher_setkey(wep->tx_tfm, key, klen); | |
4509 | + #if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) | |
4510 | + sg.page = virt_to_page(pos); | |
4511 | + sg.offset = offset_in_page(pos); | |
4512 | + sg.length = len + 4; | |
4513 | + #else | |
4514 | + sg_init_one(&sg, pos, len+4); | |
4515 | + #endif | |
4516 | + return crypto_blkcipher_encrypt(&desc, &sg, &sg, len + 4); | |
4517 | + #endif | |
4518 | +#endif /* JOHN_HWSEC */ | |
4519 | + return 0; | |
4520 | +} | |
4521 | + | |
4522 | + | |
4523 | +/* Perform WEP decryption on given buffer. Buffer includes whole WEP part of | |
4524 | + * the frame: IV (4 bytes), encrypted payload (including SNAP header), | |
4525 | + * ICV (4 bytes). len includes both IV and ICV. | |
4526 | + * | |
4527 | + * Returns 0 if frame was decrypted successfully and ICV was correct and -1 on | |
4528 | + * failure. If frame is OK, IV and ICV will be removed. | |
4529 | + */ | |
4530 | +static int prism2_wep_decrypt(struct sk_buff *skb, int hdr_len, void *priv) | |
4531 | +{ | |
4532 | + struct prism2_wep_data *wep = priv; | |
4533 | + //#if(LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,21)) | |
4534 | + #if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,21))||(IN_OPENSUSE_SLED)) | |
4535 | + struct blkcipher_desc desc = {.tfm = wep->rx_tfm}; | |
4536 | + #endif | |
4537 | + u32 klen, plen; | |
4538 | + u8 key[WEP_KEY_LEN + 3]; | |
4539 | + u8 keyidx, *pos; | |
4540 | +#ifndef JOHN_HWSEC | |
4541 | + u32 crc; | |
4542 | + u8 icv[4]; | |
4543 | + struct scatterlist sg; | |
4544 | +#endif | |
4545 | + if (skb->len < hdr_len + 8) | |
4546 | + return -1; | |
4547 | + | |
4548 | + pos = skb->data + hdr_len; | |
4549 | + key[0] = *pos++; | |
4550 | + key[1] = *pos++; | |
4551 | + key[2] = *pos++; | |
4552 | + keyidx = *pos++ >> 6; | |
4553 | + if (keyidx != wep->key_idx) | |
4554 | + return -1; | |
4555 | + | |
4556 | + klen = 3 + wep->key_len; | |
4557 | + | |
4558 | + /* Copy rest of the WEP key (the secret part) */ | |
4559 | + memcpy(key + 3, wep->key, wep->key_len); | |
4560 | + | |
4561 | + /* Apply RC4 to data and compute CRC32 over decrypted data */ | |
4562 | + plen = skb->len - hdr_len - 8; | |
4563 | +#ifndef JOHN_HWSEC | |
4564 | +//#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21)) | |
4565 | +#if((LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21))&&(!IN_OPENSUSE_SLED)) | |
4566 | + crypto_cipher_setkey(wep->tfm, key, klen); | |
4567 | + sg.page = virt_to_page(pos); | |
4568 | + sg.offset = offset_in_page(pos); | |
4569 | + sg.length = plen + 4; | |
4570 | + crypto_cipher_decrypt(wep->tfm, &sg, &sg, plen + 4); | |
4571 | +#else | |
4572 | + crypto_blkcipher_setkey(wep->rx_tfm, key, klen); | |
4573 | + #if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24)) | |
4574 | + sg.page = virt_to_page(pos); | |
4575 | + sg.offset = offset_in_page(pos); | |
4576 | + sg.length = plen + 4; | |
4577 | + #else | |
4578 | + sg_init_one(&sg, pos, plen+4); | |
4579 | + #endif | |
4580 | + if (crypto_blkcipher_decrypt(&desc, &sg, &sg, plen + 4)) | |
4581 | + return -7; | |
4582 | +#endif | |
4583 | + | |
4584 | +#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0)) | |
4585 | + crc = ~crc32_le(~0, pos, plen); | |
4586 | +#else | |
4587 | + crc = ~ether_crc_le(plen, pos); | |
4588 | +#endif | |
4589 | + icv[0] = crc; | |
4590 | + icv[1] = crc >> 8; | |
4591 | + icv[2] = crc >> 16; | |
4592 | + icv[3] = crc >> 24; | |
4593 | + | |
4594 | + if (memcmp(icv, pos + plen, 4) != 0) { | |
4595 | + /* ICV mismatch - drop frame */ | |
4596 | + return -2; | |
4597 | + } | |
4598 | +#endif /* JOHN_HWSEC */ | |
4599 | + | |
4600 | + /* Remove IV and ICV */ | |
4601 | + memmove(skb->data + 4, skb->data, hdr_len); | |
4602 | + skb_pull(skb, 4); | |
4603 | + skb_trim(skb, skb->len - 4); | |
4604 | + return 0; | |
4605 | +} | |
4606 | + | |
4607 | + | |
4608 | +static int prism2_wep_set_key(void *key, int len, u8 *seq, void *priv) | |
4609 | +{ | |
4610 | + struct prism2_wep_data *wep = priv; | |
4611 | + | |
4612 | + if (len < 0 || len > WEP_KEY_LEN) | |
4613 | + return -1; | |
4614 | + | |
4615 | + memcpy(wep->key, key, len); | |
4616 | + wep->key_len = len; | |
4617 | + | |
4618 | + return 0; | |
4619 | +} | |
4620 | + | |
4621 | + | |
4622 | +static int prism2_wep_get_key(void *key, int len, u8 *seq, void *priv) | |
4623 | +{ | |
4624 | + struct prism2_wep_data *wep = priv; | |
4625 | + | |
4626 | + if (len < wep->key_len) | |
4627 | + return -1; | |
4628 | + | |
4629 | + memcpy(key, wep->key, wep->key_len); | |
4630 | + | |
4631 | + return wep->key_len; | |
4632 | +} | |
4633 | + | |
4634 | + | |
4635 | +static char * prism2_wep_print_stats(char *p, void *priv) | |
4636 | +{ | |
4637 | + struct prism2_wep_data *wep = priv; | |
4638 | + p += sprintf(p, "key[%d] alg=WEP len=%d\n", | |
4639 | + wep->key_idx, wep->key_len); | |
4640 | + return p; | |
4641 | +} | |
4642 | + | |
4643 | + | |
4644 | +static struct ieee80211_crypto_ops ieee80211_crypt_wep = { | |
4645 | + .name = "WEP", | |
4646 | + .init = prism2_wep_init, | |
4647 | + .deinit = prism2_wep_deinit, | |
4648 | + .encrypt_mpdu = prism2_wep_encrypt, | |
4649 | + .decrypt_mpdu = prism2_wep_decrypt, | |
4650 | + .encrypt_msdu = NULL, | |
4651 | + .decrypt_msdu = NULL, | |
4652 | + .set_key = prism2_wep_set_key, | |
4653 | + .get_key = prism2_wep_get_key, | |
4654 | + .print_stats = prism2_wep_print_stats, | |
4655 | + .extra_prefix_len = 4, /* IV */ | |
4656 | + .extra_postfix_len = 4, /* ICV */ | |
4657 | + .owner = THIS_MODULE, | |
4658 | +}; | |
4659 | + | |
4660 | + | |
4661 | +int ieee80211_crypto_wep_init(void) | |
4662 | +{ | |
4663 | + return ieee80211_register_crypto_ops(&ieee80211_crypt_wep); | |
4664 | +} | |
4665 | + | |
4666 | + | |
4667 | +void ieee80211_crypto_wep_exit(void) | |
4668 | +{ | |
4669 | + ieee80211_unregister_crypto_ops(&ieee80211_crypt_wep); | |
4670 | +} | |
4671 | + | |
4672 | + | |
4673 | +void ieee80211_wep_null(void) | |
4674 | +{ | |
4675 | +// printk("============>%s()\n", __FUNCTION__); | |
4676 | + return; | |
4677 | +} | |
4678 | +#if 0 | |
4679 | +#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0)) | |
4680 | +EXPORT_SYMBOL(ieee80211_wep_null); | |
4681 | +#else | |
4682 | +EXPORT_SYMBOL_NOVERS(ieee80211_wep_null); | |
4683 | +#endif | |
4684 | +#endif | |
4685 | +//module_init(ieee80211_crypto_wep_init); | |
4686 | +//module_exit(ieee80211_crypto_wep_exit); | |
4687 | --- /dev/null | |
4688 | +++ b/drivers/staging/rtl8187se/ieee80211/ieee80211.h | |
4689 | @@ -0,0 +1,1755 @@ | |
4690 | +/* | |
4691 | + * Merged with mainline ieee80211.h in Aug 2004. Original ieee802_11 | |
4692 | + * remains copyright by the original authors | |
4693 | + * | |
4694 | + * Portions of the merged code are based on Host AP (software wireless | |
4695 | + * LAN access point) driver for Intersil Prism2/2.5/3. | |
4696 | + * | |
4697 | + * Copyright (c) 2001-2002, SSH Communications Security Corp and Jouni Malinen | |
4698 | + * <jkmaline@cc.hut.fi> | |
4699 | + * Copyright (c) 2002-2003, Jouni Malinen <jkmaline@cc.hut.fi> | |
4700 | + * | |
4701 | + * Adaption to a generic IEEE 802.11 stack by James Ketrenos | |
4702 | + * <jketreno@linux.intel.com> | |
4703 | + * Copyright (c) 2004, Intel Corporation | |
4704 | + * | |
4705 | + * Modified for Realtek's wi-fi cards by Andrea Merello | |
4706 | + * <andreamrl@tiscali.it> | |
4707 | + * | |
4708 | + * This program is free software; you can redistribute it and/or modify | |
4709 | + * it under the terms of the GNU General Public License version 2 as | |
4710 | + * published by the Free Software Foundation. See README and COPYING for | |
4711 | + * more details. | |
4712 | + */ | |
4713 | +#ifndef IEEE80211_H | |
4714 | +#define IEEE80211_H | |
4715 | +#include <linux/if_ether.h> /* ETH_ALEN */ | |
4716 | +#include <linux/kernel.h> /* ARRAY_SIZE */ | |
4717 | +#include <linux/version.h> | |
4718 | +#include <linux/jiffies.h> | |
4719 | +#include <linux/timer.h> | |
4720 | +#include <linux/sched.h> | |
4721 | + | |
4722 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,13)) | |
4723 | +#include <linux/wireless.h> | |
4724 | +#endif | |
4725 | + | |
4726 | +/* | |
4727 | +#ifndef bool | |
4728 | +#define bool int | |
4729 | +#endif | |
4730 | + | |
4731 | +#ifndef true | |
4732 | +#define true 1 | |
4733 | +#endif | |
4734 | + | |
4735 | +#ifndef false | |
4736 | +#define false 0 | |
4737 | +#endif | |
4738 | +*/ | |
4739 | +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20)) | |
4740 | +#ifndef bool | |
4741 | +typedef enum{false = 0, true} bool; | |
4742 | +#endif | |
4743 | +#endif | |
4744 | +//#ifdef JOHN_HWSEC | |
4745 | +#define KEY_TYPE_NA 0x0 | |
4746 | +#define KEY_TYPE_WEP40 0x1 | |
4747 | +#define KEY_TYPE_TKIP 0x2 | |
4748 | +#define KEY_TYPE_CCMP 0x4 | |
4749 | +#define KEY_TYPE_WEP104 0x5 | |
4750 | +//#endif | |
4751 | + | |
4752 | + | |
4753 | +#define aSifsTime 10 | |
4754 | + | |
4755 | +#define MGMT_QUEUE_NUM 5 | |
4756 | + | |
4757 | + | |
4758 | +#define IEEE_CMD_SET_WPA_PARAM 1 | |
4759 | +#define IEEE_CMD_SET_WPA_IE 2 | |
4760 | +#define IEEE_CMD_SET_ENCRYPTION 3 | |
4761 | +#define IEEE_CMD_MLME 4 | |
4762 | + | |
4763 | +#define IEEE_PARAM_WPA_ENABLED 1 | |
4764 | +#define IEEE_PARAM_TKIP_COUNTERMEASURES 2 | |
4765 | +#define IEEE_PARAM_DROP_UNENCRYPTED 3 | |
4766 | +#define IEEE_PARAM_PRIVACY_INVOKED 4 | |
4767 | +#define IEEE_PARAM_AUTH_ALGS 5 | |
4768 | +#define IEEE_PARAM_IEEE_802_1X 6 | |
4769 | +//It should consistent with the driver_XXX.c | |
4770 | +// David, 2006.9.26 | |
4771 | +#define IEEE_PARAM_WPAX_SELECT 7 | |
4772 | +//Added for notify the encryption type selection | |
4773 | +// David, 2006.9.26 | |
4774 | +#define IEEE_PROTO_WPA 1 | |
4775 | +#define IEEE_PROTO_RSN 2 | |
4776 | +//Added for notify the encryption type selection | |
4777 | +// David, 2006.9.26 | |
4778 | +#define IEEE_WPAX_USEGROUP 0 | |
4779 | +#define IEEE_WPAX_WEP40 1 | |
4780 | +#define IEEE_WPAX_TKIP 2 | |
4781 | +#define IEEE_WPAX_WRAP 3 | |
4782 | +#define IEEE_WPAX_CCMP 4 | |
4783 | +#define IEEE_WPAX_WEP104 5 | |
4784 | + | |
4785 | +#define IEEE_KEY_MGMT_IEEE8021X 1 | |
4786 | +#define IEEE_KEY_MGMT_PSK 2 | |
4787 | + | |
4788 | + | |
4789 | + | |
4790 | +#define IEEE_MLME_STA_DEAUTH 1 | |
4791 | +#define IEEE_MLME_STA_DISASSOC 2 | |
4792 | + | |
4793 | + | |
4794 | +#define IEEE_CRYPT_ERR_UNKNOWN_ALG 2 | |
4795 | +#define IEEE_CRYPT_ERR_UNKNOWN_ADDR 3 | |
4796 | +#define IEEE_CRYPT_ERR_CRYPT_INIT_FAILED 4 | |
4797 | +#define IEEE_CRYPT_ERR_KEY_SET_FAILED 5 | |
4798 | +#define IEEE_CRYPT_ERR_TX_KEY_SET_FAILED 6 | |
4799 | +#define IEEE_CRYPT_ERR_CARD_CONF_FAILED 7 | |
4800 | + | |
4801 | + | |
4802 | +#define IEEE_CRYPT_ALG_NAME_LEN 16 | |
4803 | + | |
4804 | +#if (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,10)) | |
4805 | +#define ieee80211_wx_get_scan ieee80211_wx_get_scan_rtl | |
4806 | +#define ieee80211_wx_set_encode ieee80211_wx_set_encode_rtl | |
4807 | +#define ieee80211_wx_get_encode ieee80211_wx_get_encode_rtl | |
4808 | +//////////////////////////////// | |
4809 | +// added for kernel conflict under FC5 | |
4810 | +#define ieee80211_wx_get_name ieee80211_wx_get_name_rtl | |
4811 | +#define free_ieee80211 free_ieee80211_rtl | |
4812 | +#define alloc_ieee80211 alloc_ieee80211_rtl | |
4813 | +/////////////////////////////// | |
4814 | +#endif | |
4815 | +//error in ubuntu2.6.22,so add these | |
4816 | +#define ieee80211_wake_queue ieee80211_wake_queue_rtl | |
4817 | +#define ieee80211_stop_queue ieee80211_stop_queue_rtl | |
4818 | + | |
4819 | +#define ieee80211_rx ieee80211_rx_rtl | |
4820 | + | |
4821 | +#define ieee80211_register_crypto_ops ieee80211_register_crypto_ops_rtl | |
4822 | +#define ieee80211_unregister_crypto_ops ieee80211_unregister_crypto_ops_rtl | |
4823 | +#define ieee80211_get_crypto_ops ieee80211_get_crypto_ops_rtl | |
4824 | +#define ieee80211_crypt_deinit_entries ieee80211_crypt_deinit_entries_rtl | |
4825 | +#define ieee80211_crypt_deinit_handler ieee80211_crypt_deinit_handler_rtl | |
4826 | +#define ieee80211_crypt_delayed_deinit ieee80211_crypt_delayed_deinit_rtl | |
4827 | + | |
4828 | +#define ieee80211_txb_free ieee80211_txb_free_rtl | |
4829 | +#define ieee80211_wx_get_essid ieee80211_wx_get_essid_rtl | |
4830 | +#define ieee80211_wx_set_essid ieee80211_wx_set_essid_rtl | |
4831 | +#define ieee80211_wx_set_rate ieee80211_wx_set_rate_rtl | |
4832 | +#define ieee80211_wx_get_rate ieee80211_wx_get_rate_rtl | |
4833 | +#define ieee80211_wx_set_wap ieee80211_wx_set_wap_rtl | |
4834 | +#define ieee80211_wx_get_wap ieee80211_wx_get_wap_rtl | |
4835 | +#define ieee80211_wx_set_mode ieee80211_wx_set_mode_rtl | |
4836 | +#define ieee80211_wx_get_mode ieee80211_wx_get_mode_rtl | |
4837 | +#define ieee80211_wx_set_scan ieee80211_wx_set_scan_rtl | |
4838 | +#define ieee80211_wx_get_freq ieee80211_wx_get_freq_rtl | |
4839 | +#define ieee80211_wx_set_freq ieee80211_wx_set_freq_rtl | |
4840 | +#define ieee80211_wx_set_rawtx ieee80211_wx_set_rawtx_rtl | |
4841 | +#define ieee80211_wx_set_power ieee80211_wx_set_power_rtl | |
4842 | +#define ieee80211_wx_get_power ieee80211_wx_get_power_rtl | |
4843 | +#define ieee80211_wlan_frequencies ieee80211_wlan_frequencies_rtl | |
4844 | +#define ieee80211_softmac_stop_protocol ieee80211_softmac_stop_protocol_rtl | |
4845 | +#define ieee80211_softmac_start_protocol ieee80211_softmac_start_protocol_rtl | |
4846 | +#define ieee80211_start_protocol ieee80211_start_protocol_rtl | |
4847 | +#define ieee80211_stop_protocol ieee80211_stop_protocol_rtl | |
4848 | +#define ieee80211_rx_mgt ieee80211_rx_mgt_rtl | |
4849 | + | |
4850 | +#define ieee80211_wx_set_auth ieee80211_wx_set_auth_rtl | |
4851 | +//by amy for ps | |
4852 | +#define notify_wx_assoc_event notify_wx_assoc_event_rtl | |
4853 | +#define ieee80211_stop_send_beacons ieee80211_stop_send_beacons_rtl | |
4854 | +#define ieee80211_disassociate ieee80211_disassociate_rtl | |
4855 | +#define ieee80211_start_scan ieee80211_start_scan_rtl | |
4856 | +//by amy for ps | |
4857 | +typedef struct ieee_param { | |
4858 | + u32 cmd; | |
4859 | + u8 sta_addr[ETH_ALEN]; | |
4860 | + union { | |
4861 | + struct { | |
4862 | + u8 name; | |
4863 | + u32 value; | |
4864 | + } wpa_param; | |
4865 | + struct { | |
4866 | + u32 len; | |
4867 | + u8 reserved[32]; | |
4868 | + u8 data[0]; | |
4869 | + } wpa_ie; | |
4870 | + struct{ | |
4871 | + int command; | |
4872 | + int reason_code; | |
4873 | + } mlme; | |
4874 | + struct { | |
4875 | + u8 alg[IEEE_CRYPT_ALG_NAME_LEN]; | |
4876 | + u8 set_tx; | |
4877 | + u32 err; | |
4878 | + u8 idx; | |
4879 | + u8 seq[8]; /* sequence counter (set: RX, get: TX) */ | |
4880 | + u16 key_len; | |
4881 | + u8 key[0]; | |
4882 | + } crypt; | |
4883 | + | |
4884 | + } u; | |
4885 | +}ieee_param; | |
4886 | + | |
4887 | + | |
4888 | +#if WIRELESS_EXT < 17 | |
4889 | +#define IW_QUAL_QUAL_INVALID 0x10 | |
4890 | +#define IW_QUAL_LEVEL_INVALID 0x20 | |
4891 | +#define IW_QUAL_NOISE_INVALID 0x40 | |
4892 | +#define IW_QUAL_QUAL_UPDATED 0x1 | |
4893 | +#define IW_QUAL_LEVEL_UPDATED 0x2 | |
4894 | +#define IW_QUAL_NOISE_UPDATED 0x4 | |
4895 | +#endif | |
4896 | + | |
4897 | +// linux under 2.6.9 release may not support it, so modify it for common use | |
4898 | +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,9)) | |
4899 | +#define MSECS(t) (1000 * ((t) / HZ) + 1000 * ((t) % HZ) / HZ) | |
4900 | +static inline unsigned long msleep_interruptible_rtl(unsigned int msecs) | |
4901 | +{ | |
4902 | + unsigned long timeout = MSECS(msecs) + 1; | |
4903 | + | |
4904 | + while (timeout) { | |
4905 | + set_current_state(TASK_UNINTERRUPTIBLE); | |
4906 | + timeout = schedule_timeout(timeout); | |
4907 | + } | |
4908 | + return timeout; | |
4909 | +} | |
4910 | +#else | |
4911 | +#define MSECS(t) msecs_to_jiffies(t) | |
4912 | +#define msleep_interruptible_rtl msleep_interruptible | |
4913 | +#endif | |
4914 | + | |
4915 | +#define IEEE80211_DATA_LEN 2304 | |
4916 | +/* Maximum size for the MA-UNITDATA primitive, 802.11 standard section | |
4917 | + 6.2.1.1.2. | |
4918 | + | |
4919 | + The figure in section 7.1.2 suggests a body size of up to 2312 | |
4920 | + bytes is allowed, which is a bit confusing, I suspect this | |
4921 | + represents the 2304 bytes of real data, plus a possible 8 bytes of | |
4922 | + WEP IV and ICV. (this interpretation suggested by Ramiro Barreiro) */ | |
4923 | + | |
4924 | + | |
4925 | +#define IEEE80211_HLEN 30 | |
4926 | +#define IEEE80211_FRAME_LEN (IEEE80211_DATA_LEN + IEEE80211_HLEN) | |
4927 | + | |
4928 | +/* this is stolen and modified from the madwifi driver*/ | |
4929 | +#define IEEE80211_FC0_TYPE_MASK 0x0c | |
4930 | +#define IEEE80211_FC0_TYPE_DATA 0x08 | |
4931 | +#define IEEE80211_FC0_SUBTYPE_MASK 0xB0 | |
4932 | +#define IEEE80211_FC0_SUBTYPE_QOS 0x80 | |
4933 | + | |
4934 | +#define IEEE80211_QOS_HAS_SEQ(fc) \ | |
4935 | + (((fc) & (IEEE80211_FC0_TYPE_MASK | IEEE80211_FC0_SUBTYPE_MASK)) == \ | |
4936 | + (IEEE80211_FC0_TYPE_DATA | IEEE80211_FC0_SUBTYPE_QOS)) | |
4937 | + | |
4938 | +/* this is stolen from ipw2200 driver */ | |
4939 | +#define IEEE_IBSS_MAC_HASH_SIZE 31 | |
4940 | +struct ieee_ibss_seq { | |
4941 | + u8 mac[ETH_ALEN]; | |
4942 | + u16 seq_num[17]; | |
4943 | + u16 frag_num[17]; | |
4944 | + unsigned long packet_time[17]; | |
4945 | + struct list_head list; | |
4946 | +}; | |
4947 | + | |
4948 | +struct ieee80211_hdr { | |
4949 | + u16 frame_ctl; | |
4950 | + u16 duration_id; | |
4951 | + u8 addr1[ETH_ALEN]; | |
4952 | + u8 addr2[ETH_ALEN]; | |
4953 | + u8 addr3[ETH_ALEN]; | |
4954 | + u16 seq_ctl; | |
4955 | + u8 addr4[ETH_ALEN]; | |
4956 | +} __attribute__ ((packed)); | |
4957 | + | |
4958 | +struct ieee80211_hdr_QOS { | |
4959 | + u16 frame_ctl; | |
4960 | + u16 duration_id; | |
4961 | + u8 addr1[ETH_ALEN]; | |
4962 | + u8 addr2[ETH_ALEN]; | |
4963 | + u8 addr3[ETH_ALEN]; | |
4964 | + u16 seq_ctl; | |
4965 | + u8 addr4[ETH_ALEN]; | |
4966 | + u16 QOS_ctl; | |
4967 | +} __attribute__ ((packed)); | |
4968 | + | |
4969 | +struct ieee80211_hdr_3addr { | |
4970 | + u16 frame_ctl; | |
4971 | + u16 duration_id; | |
4972 | + u8 addr1[ETH_ALEN]; | |
4973 | + u8 addr2[ETH_ALEN]; | |
4974 | + u8 addr3[ETH_ALEN]; | |
4975 | + u16 seq_ctl; | |
4976 | +} __attribute__ ((packed)); | |
4977 | + | |
4978 | +struct ieee80211_hdr_3addr_QOS { | |
4979 | + u16 frame_ctl; | |
4980 | + u16 duration_id; | |
4981 | + u8 addr1[ETH_ALEN]; | |
4982 | + u8 addr2[ETH_ALEN]; | |
4983 | + u8 addr3[ETH_ALEN]; | |
4984 | + u16 seq_ctl; | |
4985 | + u16 QOS_ctl; | |
4986 | +} __attribute__ ((packed)); | |
4987 | + | |
4988 | +enum eap_type { | |
4989 | + EAP_PACKET = 0, | |
4990 | + EAPOL_START, | |
4991 | + EAPOL_LOGOFF, | |
4992 | + EAPOL_KEY, | |
4993 | + EAPOL_ENCAP_ASF_ALERT | |
4994 | +}; | |
4995 | + | |
4996 | +static const char *eap_types[] = { | |
4997 | + [EAP_PACKET] = "EAP-Packet", | |
4998 | + [EAPOL_START] = "EAPOL-Start", | |
4999 | + [EAPOL_LOGOFF] = "EAPOL-Logoff", | |
5000 | + [EAPOL_KEY] = "EAPOL-Key", | |
5001 | + [EAPOL_ENCAP_ASF_ALERT] = "EAPOL-Encap-ASF-Alert" | |
5002 | +}; | |
5003 | + | |
5004 | +static inline const char *eap_get_type(int type) | |
5005 | +{ | |
5006 | + return (type >= ARRAY_SIZE(eap_types)) ? "Unknown" : eap_types[type]; | |
5007 | +} | |
5008 | + | |
5009 | +struct eapol { | |
5010 | + u8 snap[6]; | |
5011 | + u16 ethertype; | |
5012 | + u8 version; | |
5013 | + u8 type; | |
5014 | + u16 length; | |
5015 | +} __attribute__ ((packed)); | |
5016 | + | |
5017 | +#define IEEE80211_3ADDR_LEN 24 | |
5018 | +#define IEEE80211_4ADDR_LEN 30 | |
5019 | +#define IEEE80211_FCS_LEN 4 | |
5020 | + | |
5021 | +#define MIN_FRAG_THRESHOLD 256U | |
5022 | +#define MAX_FRAG_THRESHOLD 2346U | |
5023 | + | |
5024 | +/* Frame control field constants */ | |
5025 | +#define IEEE80211_FCTL_VERS 0x0002 | |
5026 | +#define IEEE80211_FCTL_FTYPE 0x000c | |
5027 | +#define IEEE80211_FCTL_STYPE 0x00f0 | |
5028 | +#define IEEE80211_FCTL_TODS 0x0100 | |
5029 | +#define IEEE80211_FCTL_FROMDS 0x0200 | |
5030 | +#define IEEE80211_FCTL_DSTODS 0x0300 //added by david | |
5031 | +#define IEEE80211_FCTL_MOREFRAGS 0x0400 | |
5032 | +#define IEEE80211_FCTL_RETRY 0x0800 | |
5033 | +#define IEEE80211_FCTL_PM 0x1000 | |
5034 | +#define IEEE80211_FCTL_MOREDATA 0x2000 | |
5035 | +#define IEEE80211_FCTL_WEP 0x4000 | |
5036 | +#define IEEE80211_FCTL_ORDER 0x8000 | |
5037 | + | |
5038 | +#define IEEE80211_FTYPE_MGMT 0x0000 | |
5039 | +#define IEEE80211_FTYPE_CTL 0x0004 | |
5040 | +#define IEEE80211_FTYPE_DATA 0x0008 | |
5041 | + | |
5042 | +/* management */ | |
5043 | +#define IEEE80211_STYPE_ASSOC_REQ 0x0000 | |
5044 | +#define IEEE80211_STYPE_ASSOC_RESP 0x0010 | |
5045 | +#define IEEE80211_STYPE_REASSOC_REQ 0x0020 | |
5046 | +#define IEEE80211_STYPE_REASSOC_RESP 0x0030 | |
5047 | +#define IEEE80211_STYPE_PROBE_REQ 0x0040 | |
5048 | +#define IEEE80211_STYPE_PROBE_RESP 0x0050 | |
5049 | +#define IEEE80211_STYPE_BEACON 0x0080 | |
5050 | +#define IEEE80211_STYPE_ATIM 0x0090 | |
5051 | +#define IEEE80211_STYPE_DISASSOC 0x00A0 | |
5052 | +#define IEEE80211_STYPE_AUTH 0x00B0 | |
5053 | +#define IEEE80211_STYPE_DEAUTH 0x00C0 | |
5054 | +#define IEEE80211_STYPE_MANAGE_ACT 0x00D0 | |
5055 | + | |
5056 | +/* control */ | |
5057 | +#define IEEE80211_STYPE_PSPOLL 0x00A0 | |
5058 | +#define IEEE80211_STYPE_RTS 0x00B0 | |
5059 | +#define IEEE80211_STYPE_CTS 0x00C0 | |
5060 | +#define IEEE80211_STYPE_ACK 0x00D0 | |
5061 | +#define IEEE80211_STYPE_CFEND 0x00E0 | |
5062 | +#define IEEE80211_STYPE_CFENDACK 0x00F0 | |
5063 | + | |
5064 | +/* data */ | |
5065 | +#define IEEE80211_STYPE_DATA 0x0000 | |
5066 | +#define IEEE80211_STYPE_DATA_CFACK 0x0010 | |
5067 | +#define IEEE80211_STYPE_DATA_CFPOLL 0x0020 | |
5068 | +#define IEEE80211_STYPE_DATA_CFACKPOLL 0x0030 | |
5069 | +#define IEEE80211_STYPE_NULLFUNC 0x0040 | |
5070 | +#define IEEE80211_STYPE_CFACK 0x0050 | |
5071 | +#define IEEE80211_STYPE_CFPOLL 0x0060 | |
5072 | +#define IEEE80211_STYPE_CFACKPOLL 0x0070 | |
5073 | +#define IEEE80211_STYPE_QOS_DATA 0x0080 //added for WMM 2006/8/2 | |
5074 | +#define IEEE80211_STYPE_QOS_NULL 0x00C0 | |
5075 | + | |
5076 | + | |
5077 | +#define IEEE80211_SCTL_FRAG 0x000F | |
5078 | +#define IEEE80211_SCTL_SEQ 0xFFF0 | |
5079 | + | |
5080 | + | |
5081 | +/* debug macros */ | |
5082 | + | |
5083 | +#ifdef CONFIG_IEEE80211_DEBUG | |
5084 | +extern u32 ieee80211_debug_level; | |
5085 | +#define IEEE80211_DEBUG(level, fmt, args...) \ | |
5086 | +do { if (ieee80211_debug_level & (level)) \ | |
5087 | + printk(KERN_DEBUG "ieee80211: %c %s " fmt, \ | |
5088 | + in_interrupt() ? 'I' : 'U', __FUNCTION__ , ## args); } while (0) | |
5089 | +#else | |
5090 | +#define IEEE80211_DEBUG(level, fmt, args...) do {} while (0) | |
5091 | +#endif /* CONFIG_IEEE80211_DEBUG */ | |
5092 | + | |
5093 | +/* | |
5094 | + * To use the debug system; | |
5095 | + * | |
5096 | + * If you are defining a new debug classification, simply add it to the #define | |
5097 | + * list here in the form of: | |
5098 | + * | |
5099 | + * #define IEEE80211_DL_xxxx VALUE | |
5100 | + * | |
5101 | + * shifting value to the left one bit from the previous entry. xxxx should be | |
5102 | + * the name of the classification (for example, WEP) | |
5103 | + * | |
5104 | + * You then need to either add a IEEE80211_xxxx_DEBUG() macro definition for your | |
5105 | + * classification, or use IEEE80211_DEBUG(IEEE80211_DL_xxxx, ...) whenever you want | |
5106 | + * to send output to that classification. | |
5107 | + * | |
5108 | + * To add your debug level to the list of levels seen when you perform | |
5109 | + * | |
5110 | + * % cat /proc/net/ipw/debug_level | |
5111 | + * | |
5112 | + * you simply need to add your entry to the ipw_debug_levels array. | |
5113 | + * | |
5114 | + * If you do not see debug_level in /proc/net/ipw then you do not have | |
5115 | + * CONFIG_IEEE80211_DEBUG defined in your kernel configuration | |
5116 | + * | |
5117 | + */ | |
5118 | + | |
5119 | +#define IEEE80211_DL_INFO (1<<0) | |
5120 | +#define IEEE80211_DL_WX (1<<1) | |
5121 | +#define IEEE80211_DL_SCAN (1<<2) | |
5122 | +#define IEEE80211_DL_STATE (1<<3) | |
5123 | +#define IEEE80211_DL_MGMT (1<<4) | |
5124 | +#define IEEE80211_DL_FRAG (1<<5) | |
5125 | +#define IEEE80211_DL_EAP (1<<6) | |
5126 | +#define IEEE80211_DL_DROP (1<<7) | |
5127 | + | |
5128 | +#define IEEE80211_DL_TX (1<<8) | |
5129 | +#define IEEE80211_DL_RX (1<<9) | |
5130 | + | |
5131 | +#define IEEE80211_ERROR(f, a...) printk(KERN_ERR "ieee80211: " f, ## a) | |
5132 | +#define IEEE80211_WARNING(f, a...) printk(KERN_WARNING "ieee80211: " f, ## a) | |
5133 | +#define IEEE80211_DEBUG_INFO(f, a...) IEEE80211_DEBUG(IEEE80211_DL_INFO, f, ## a) | |
5134 | + | |
5135 | +#define IEEE80211_DEBUG_WX(f, a...) IEEE80211_DEBUG(IEEE80211_DL_WX, f, ## a) | |
5136 | +#define IEEE80211_DEBUG_SCAN(f, a...) IEEE80211_DEBUG(IEEE80211_DL_SCAN, f, ## a) | |
5137 | +//#define IEEE_DEBUG_SCAN IEEE80211_WARNING | |
5138 | +#define IEEE80211_DEBUG_STATE(f, a...) IEEE80211_DEBUG(IEEE80211_DL_STATE, f, ## a) | |
5139 | +#define IEEE80211_DEBUG_MGMT(f, a...) IEEE80211_DEBUG(IEEE80211_DL_MGMT, f, ## a) | |
5140 | +#define IEEE80211_DEBUG_FRAG(f, a...) IEEE80211_DEBUG(IEEE80211_DL_FRAG, f, ## a) | |
5141 | +#define IEEE80211_DEBUG_EAP(f, a...) IEEE80211_DEBUG(IEEE80211_DL_EAP, f, ## a) | |
5142 | +#define IEEE80211_DEBUG_DROP(f, a...) IEEE80211_DEBUG(IEEE80211_DL_DROP, f, ## a) | |
5143 | +#define IEEE80211_DEBUG_TX(f, a...) IEEE80211_DEBUG(IEEE80211_DL_TX, f, ## a) | |
5144 | +#define IEEE80211_DEBUG_RX(f, a...) IEEE80211_DEBUG(IEEE80211_DL_RX, f, ## a) | |
5145 | +#include <linux/netdevice.h> | |
5146 | +#include <linux/wireless.h> | |
5147 | +#include <linux/if_arp.h> /* ARPHRD_ETHER */ | |
5148 | + | |
5149 | +#ifndef WIRELESS_SPY | |
5150 | +#define WIRELESS_SPY // enable iwspy support | |
5151 | +#endif | |
5152 | +#include <net/iw_handler.h> // new driver API | |
5153 | + | |
5154 | +#ifndef ETH_P_PAE | |
5155 | +#define ETH_P_PAE 0x888E /* Port Access Entity (IEEE 802.1X) */ | |
5156 | +#endif /* ETH_P_PAE */ | |
5157 | + | |
5158 | +#define ETH_P_PREAUTH 0x88C7 /* IEEE 802.11i pre-authentication */ | |
5159 | + | |
5160 | +#ifndef ETH_P_80211_RAW | |
5161 | +#define ETH_P_80211_RAW (ETH_P_ECONET + 1) | |
5162 | +#endif | |
5163 | + | |
5164 | +/* IEEE 802.11 defines */ | |
5165 | + | |
5166 | +#define P80211_OUI_LEN 3 | |
5167 | + | |
5168 | +struct ieee80211_snap_hdr { | |
5169 | + | |
5170 | + u8 dsap; /* always 0xAA */ | |
5171 | + u8 ssap; /* always 0xAA */ | |
5172 | + u8 ctrl; /* always 0x03 */ | |
5173 | + u8 oui[P80211_OUI_LEN]; /* organizational universal id */ | |
5174 | + | |
5175 | +} __attribute__ ((packed)); | |
5176 | + | |
5177 | +#define SNAP_SIZE sizeof(struct ieee80211_snap_hdr) | |
5178 | + | |
5179 | +#define WLAN_FC_GET_TYPE(fc) ((fc) & IEEE80211_FCTL_FTYPE) | |
5180 | +#define WLAN_FC_GET_STYPE(fc) ((fc) & IEEE80211_FCTL_STYPE) | |
5181 | + | |
5182 | +#define WLAN_GET_SEQ_FRAG(seq) ((seq) & IEEE80211_SCTL_FRAG) | |
5183 | +#define WLAN_GET_SEQ_SEQ(seq) ((seq) & IEEE80211_SCTL_SEQ) | |
5184 | + | |
5185 | +/* Authentication algorithms */ | |
5186 | +#define WLAN_AUTH_OPEN 0 | |
5187 | +#define WLAN_AUTH_SHARED_KEY 1 | |
5188 | + | |
5189 | +#define WLAN_AUTH_CHALLENGE_LEN 128 | |
5190 | + | |
5191 | +#define WLAN_CAPABILITY_BSS (1<<0) | |
5192 | +#define WLAN_CAPABILITY_IBSS (1<<1) | |
5193 | +#define WLAN_CAPABILITY_CF_POLLABLE (1<<2) | |
5194 | +#define WLAN_CAPABILITY_CF_POLL_REQUEST (1<<3) | |
5195 | +#define WLAN_CAPABILITY_PRIVACY (1<<4) | |
5196 | +#define WLAN_CAPABILITY_SHORT_PREAMBLE (1<<5) | |
5197 | +#define WLAN_CAPABILITY_PBCC (1<<6) | |
5198 | +#define WLAN_CAPABILITY_CHANNEL_AGILITY (1<<7) | |
5199 | +#define WLAN_CAPABILITY_SHORT_SLOT (1<<10) | |
5200 | + | |
5201 | +/* Status codes */ | |
5202 | +#define WLAN_STATUS_SUCCESS 0 | |
5203 | +#define WLAN_STATUS_UNSPECIFIED_FAILURE 1 | |
5204 | +#define WLAN_STATUS_CAPS_UNSUPPORTED 10 | |
5205 | +#define WLAN_STATUS_REASSOC_NO_ASSOC 11 | |
5206 | +#define WLAN_STATUS_ASSOC_DENIED_UNSPEC 12 | |
5207 | +#define WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG 13 | |
5208 | +#define WLAN_STATUS_UNKNOWN_AUTH_TRANSACTION 14 | |
5209 | +#define WLAN_STATUS_CHALLENGE_FAIL 15 | |
5210 | +#define WLAN_STATUS_AUTH_TIMEOUT 16 | |
5211 | +#define WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA 17 | |
5212 | +#define WLAN_STATUS_ASSOC_DENIED_RATES 18 | |
5213 | +/* 802.11b */ | |
5214 | +#define WLAN_STATUS_ASSOC_DENIED_NOSHORT 19 | |
5215 | +#define WLAN_STATUS_ASSOC_DENIED_NOPBCC 20 | |
5216 | +#define WLAN_STATUS_ASSOC_DENIED_NOAGILITY 21 | |
5217 | + | |
5218 | +/* Reason codes */ | |
5219 | +#define WLAN_REASON_UNSPECIFIED 1 | |
5220 | +#define WLAN_REASON_PREV_AUTH_NOT_VALID 2 | |
5221 | +#define WLAN_REASON_DEAUTH_LEAVING 3 | |
5222 | +#define WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY 4 | |
5223 | +#define WLAN_REASON_DISASSOC_AP_BUSY 5 | |
5224 | +#define WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA 6 | |
5225 | +#define WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA 7 | |
5226 | +#define WLAN_REASON_DISASSOC_STA_HAS_LEFT 8 | |
5227 | +#define WLAN_REASON_STA_REQ_ASSOC_WITHOUT_AUTH 9 | |
5228 | + | |
5229 | + | |
5230 | +/* Information Element IDs */ | |
5231 | +#define WLAN_EID_SSID 0 | |
5232 | +#define WLAN_EID_SUPP_RATES 1 | |
5233 | +#define WLAN_EID_FH_PARAMS 2 | |
5234 | +#define WLAN_EID_DS_PARAMS 3 | |
5235 | +#define WLAN_EID_CF_PARAMS 4 | |
5236 | +#define WLAN_EID_TIM 5 | |
5237 | +#define WLAN_EID_IBSS_PARAMS 6 | |
5238 | +#define WLAN_EID_CHALLENGE 16 | |
5239 | +#define WLAN_EID_RSN 48 | |
5240 | +#define WLAN_EID_GENERIC 221 | |
5241 | + | |
5242 | +#define IEEE80211_MGMT_HDR_LEN 24 | |
5243 | +#define IEEE80211_DATA_HDR3_LEN 24 | |
5244 | +#define IEEE80211_DATA_HDR4_LEN 30 | |
5245 | + | |
5246 | + | |
5247 | +#define IEEE80211_STATMASK_SIGNAL (1<<0) | |
5248 | +#define IEEE80211_STATMASK_RSSI (1<<1) | |
5249 | +#define IEEE80211_STATMASK_NOISE (1<<2) | |
5250 | +#define IEEE80211_STATMASK_RATE (1<<3) | |
5251 | +#define IEEE80211_STATMASK_WEMASK 0x7 | |
5252 | + | |
5253 | + | |
5254 | +#define IEEE80211_CCK_MODULATION (1<<0) | |
5255 | +#define IEEE80211_OFDM_MODULATION (1<<1) | |
5256 | + | |
5257 | +#define IEEE80211_24GHZ_BAND (1<<0) | |
5258 | +#define IEEE80211_52GHZ_BAND (1<<1) | |
5259 | + | |
5260 | +#define IEEE80211_CCK_RATE_LEN 4 | |
5261 | +#define IEEE80211_CCK_RATE_1MB 0x02 | |
5262 | +#define IEEE80211_CCK_RATE_2MB 0x04 | |
5263 | +#define IEEE80211_CCK_RATE_5MB 0x0B | |
5264 | +#define IEEE80211_CCK_RATE_11MB 0x16 | |
5265 | +#define IEEE80211_OFDM_RATE_LEN 8 | |
5266 | +#define IEEE80211_OFDM_RATE_6MB 0x0C | |
5267 | +#define IEEE80211_OFDM_RATE_9MB 0x12 | |
5268 | +#define IEEE80211_OFDM_RATE_12MB 0x18 | |
5269 | +#define IEEE80211_OFDM_RATE_18MB 0x24 | |
5270 | +#define IEEE80211_OFDM_RATE_24MB 0x30 | |
5271 | +#define IEEE80211_OFDM_RATE_36MB 0x48 | |
5272 | +#define IEEE80211_OFDM_RATE_48MB 0x60 | |
5273 | +#define IEEE80211_OFDM_RATE_54MB 0x6C | |
5274 | +#define IEEE80211_BASIC_RATE_MASK 0x80 | |
5275 | + | |
5276 | +#define IEEE80211_CCK_RATE_1MB_MASK (1<<0) | |
5277 | +#define IEEE80211_CCK_RATE_2MB_MASK (1<<1) | |
5278 | +#define IEEE80211_CCK_RATE_5MB_MASK (1<<2) | |
5279 | +#define IEEE80211_CCK_RATE_11MB_MASK (1<<3) | |
5280 | +#define IEEE80211_OFDM_RATE_6MB_MASK (1<<4) | |
5281 | +#define IEEE80211_OFDM_RATE_9MB_MASK (1<<5) | |
5282 | +#define IEEE80211_OFDM_RATE_12MB_MASK (1<<6) | |
5283 | +#define IEEE80211_OFDM_RATE_18MB_MASK (1<<7) | |
5284 | +#define IEEE80211_OFDM_RATE_24MB_MASK (1<<8) | |
5285 | +#define IEEE80211_OFDM_RATE_36MB_MASK (1<<9) | |
5286 | +#define IEEE80211_OFDM_RATE_48MB_MASK (1<<10) | |
5287 | +#define IEEE80211_OFDM_RATE_54MB_MASK (1<<11) | |
5288 | + | |
5289 | +#define IEEE80211_CCK_RATES_MASK 0x0000000F | |
5290 | +#define IEEE80211_CCK_BASIC_RATES_MASK (IEEE80211_CCK_RATE_1MB_MASK | \ | |
5291 | + IEEE80211_CCK_RATE_2MB_MASK) | |
5292 | +#define IEEE80211_CCK_DEFAULT_RATES_MASK (IEEE80211_CCK_BASIC_RATES_MASK | \ | |
5293 | + IEEE80211_CCK_RATE_5MB_MASK | \ | |
5294 | + IEEE80211_CCK_RATE_11MB_MASK) | |
5295 | + | |
5296 | +#define IEEE80211_OFDM_RATES_MASK 0x00000FF0 | |
5297 | +#define IEEE80211_OFDM_BASIC_RATES_MASK (IEEE80211_OFDM_RATE_6MB_MASK | \ | |
5298 | + IEEE80211_OFDM_RATE_12MB_MASK | \ | |
5299 | + IEEE80211_OFDM_RATE_24MB_MASK) | |
5300 | +#define IEEE80211_OFDM_DEFAULT_RATES_MASK (IEEE80211_OFDM_BASIC_RATES_MASK | \ | |
5301 | + IEEE80211_OFDM_RATE_9MB_MASK | \ | |
5302 | + IEEE80211_OFDM_RATE_18MB_MASK | \ | |
5303 | + IEEE80211_OFDM_RATE_36MB_MASK | \ | |
5304 | + IEEE80211_OFDM_RATE_48MB_MASK | \ | |
5305 | + IEEE80211_OFDM_RATE_54MB_MASK) | |
5306 | +#define IEEE80211_DEFAULT_RATES_MASK (IEEE80211_OFDM_DEFAULT_RATES_MASK | \ | |
5307 | + IEEE80211_CCK_DEFAULT_RATES_MASK) | |
5308 | + | |
5309 | +#define IEEE80211_NUM_OFDM_RATES 8 | |
5310 | +#define IEEE80211_NUM_CCK_RATES 4 | |
5311 | +#define IEEE80211_OFDM_SHIFT_MASK_A 4 | |
5312 | + | |
5313 | + | |
5314 | + | |
5315 | + | |
5316 | +/* NOTE: This data is for statistical purposes; not all hardware provides this | |
5317 | + * information for frames received. Not setting these will not cause | |
5318 | + * any adverse affects. */ | |
5319 | +struct ieee80211_rx_stats { | |
5320 | + u32 mac_time[2]; | |
5321 | + u8 signalstrength; | |
5322 | + s8 rssi; | |
5323 | + u8 signal; | |
5324 | + u8 noise; | |
5325 | + u16 rate; /* in 100 kbps */ | |
5326 | + u8 received_channel; | |
5327 | + u8 control; | |
5328 | + u8 mask; | |
5329 | + u8 freq; | |
5330 | + u16 len; | |
5331 | + u8 nic_type; | |
5332 | +}; | |
5333 | + | |
5334 | +/* IEEE 802.11 requires that STA supports concurrent reception of at least | |
5335 | + * three fragmented frames. This define can be increased to support more | |
5336 | + * concurrent frames, but it should be noted that each entry can consume about | |
5337 | + * 2 kB of RAM and increasing cache size will slow down frame reassembly. */ | |
5338 | +#define IEEE80211_FRAG_CACHE_LEN 4 | |
5339 | + | |
5340 | +struct ieee80211_frag_entry { | |
5341 | + unsigned long first_frag_time; | |
5342 | + unsigned int seq; | |
5343 | + unsigned int last_frag; | |
5344 | + struct sk_buff *skb; | |
5345 | + u8 src_addr[ETH_ALEN]; | |
5346 | + u8 dst_addr[ETH_ALEN]; | |
5347 | +}; | |
5348 | + | |
5349 | +struct ieee80211_stats { | |
5350 | + unsigned int tx_unicast_frames; | |
5351 | + unsigned int tx_multicast_frames; | |
5352 | + unsigned int tx_fragments; | |
5353 | + unsigned int tx_unicast_octets; | |
5354 | + unsigned int tx_multicast_octets; | |
5355 | + unsigned int tx_deferred_transmissions; | |
5356 | + unsigned int tx_single_retry_frames; | |
5357 | + unsigned int tx_multiple_retry_frames; | |
5358 | + unsigned int tx_retry_limit_exceeded; | |
5359 | + unsigned int tx_discards; | |
5360 | + unsigned int rx_unicast_frames; | |
5361 | + unsigned int rx_multicast_frames; | |
5362 | + unsigned int rx_fragments; | |
5363 | + unsigned int rx_unicast_octets; | |
5364 | + unsigned int rx_multicast_octets; | |
5365 | + unsigned int rx_fcs_errors; | |
5366 | + unsigned int rx_discards_no_buffer; | |
5367 | + unsigned int tx_discards_wrong_sa; | |
5368 | + unsigned int rx_discards_undecryptable; | |
5369 | + unsigned int rx_message_in_msg_fragments; | |
5370 | + unsigned int rx_message_in_bad_msg_fragments; | |
5371 | +}; | |
5372 | + | |
5373 | +struct ieee80211_softmac_stats{ | |
5374 | + unsigned int rx_ass_ok; | |
5375 | + unsigned int rx_ass_err; | |
5376 | + unsigned int rx_probe_rq; | |
5377 | + unsigned int tx_probe_rs; | |
5378 | + unsigned int tx_beacons; | |
5379 | + unsigned int rx_auth_rq; | |
5380 | + unsigned int rx_auth_rs_ok; | |
5381 | + unsigned int rx_auth_rs_err; | |
5382 | + unsigned int tx_auth_rq; | |
5383 | + unsigned int no_auth_rs; | |
5384 | + unsigned int no_ass_rs; | |
5385 | + unsigned int tx_ass_rq; | |
5386 | + unsigned int rx_ass_rq; | |
5387 | + unsigned int tx_probe_rq; | |
5388 | + unsigned int reassoc; | |
5389 | + unsigned int swtxstop; | |
5390 | + unsigned int swtxawake; | |
5391 | +}; | |
5392 | + | |
5393 | +struct ieee80211_device; | |
5394 | + | |
5395 | +#include "ieee80211_crypt.h" | |
5396 | + | |
5397 | +#define SEC_KEY_1 (1<<0) | |
5398 | +#define SEC_KEY_2 (1<<1) | |
5399 | +#define SEC_KEY_3 (1<<2) | |
5400 | +#define SEC_KEY_4 (1<<3) | |
5401 | +#define SEC_ACTIVE_KEY (1<<4) | |
5402 | +#define SEC_AUTH_MODE (1<<5) | |
5403 | +#define SEC_UNICAST_GROUP (1<<6) | |
5404 | +#define SEC_LEVEL (1<<7) | |
5405 | +#define SEC_ENABLED (1<<8) | |
5406 | + | |
5407 | +#define SEC_LEVEL_0 0 /* None */ | |
5408 | +#define SEC_LEVEL_1 1 /* WEP 40 and 104 bit */ | |
5409 | +#define SEC_LEVEL_2 2 /* Level 1 + TKIP */ | |
5410 | +#define SEC_LEVEL_2_CKIP 3 /* Level 1 + CKIP */ | |
5411 | +#define SEC_LEVEL_3 4 /* Level 2 + CCMP */ | |
5412 | + | |
5413 | +#define WEP_KEYS 4 | |
5414 | +#define WEP_KEY_LEN 13 | |
5415 | + | |
5416 | +#define WEP_KEY_LEN_MODIF 32 | |
5417 | + | |
5418 | +struct ieee80211_security { | |
5419 | + u16 active_key:2, | |
5420 | + enabled:1, | |
5421 | + auth_mode:2, | |
5422 | + auth_algo:4, | |
5423 | + unicast_uses_group:1; | |
5424 | + u8 key_sizes[WEP_KEYS]; | |
5425 | + u8 keys[WEP_KEYS][WEP_KEY_LEN_MODIF]; | |
5426 | + u8 level; | |
5427 | + u16 flags; | |
5428 | +} __attribute__ ((packed)); | |
5429 | + | |
5430 | + | |
5431 | +/* | |
5432 | + | |
5433 | + 802.11 data frame from AP | |
5434 | + | |
5435 | + ,-------------------------------------------------------------------. | |
5436 | +Bytes | 2 | 2 | 6 | 6 | 6 | 2 | 0..2312 | 4 | | |
5437 | + |------|------|---------|---------|---------|------|---------|------| | |
5438 | +Desc. | ctrl | dura | DA/RA | TA | SA | Sequ | frame | fcs | | |
5439 | + | | tion | (BSSID) | | | ence | data | | | |
5440 | + `-------------------------------------------------------------------' | |
5441 | + | |
5442 | +Total: 28-2340 bytes | |
5443 | + | |
5444 | +*/ | |
5445 | + | |
5446 | +struct ieee80211_header_data { | |
5447 | + u16 frame_ctl; | |
5448 | + u16 duration_id; | |
5449 | + u8 addr1[6]; | |
5450 | + u8 addr2[6]; | |
5451 | + u8 addr3[6]; | |
5452 | + u16 seq_ctrl; | |
5453 | +}; | |
5454 | + | |
5455 | +#define BEACON_PROBE_SSID_ID_POSITION 12 | |
5456 | + | |
5457 | +/* Management Frame Information Element Types */ | |
5458 | +#define MFIE_TYPE_SSID 0 | |
5459 | +#define MFIE_TYPE_RATES 1 | |
5460 | +#define MFIE_TYPE_FH_SET 2 | |
5461 | +#define MFIE_TYPE_DS_SET 3 | |
5462 | +#define MFIE_TYPE_CF_SET 4 | |
5463 | +#define MFIE_TYPE_TIM 5 | |
5464 | +#define MFIE_TYPE_IBSS_SET 6 | |
5465 | +#define MFIE_TYPE_COUNTRY 7 //+YJ,080625 | |
5466 | +#define MFIE_TYPE_CHALLENGE 16 | |
5467 | +#define MFIE_TYPE_ERP 42 | |
5468 | +#define MFIE_TYPE_RSN 48 | |
5469 | +#define MFIE_TYPE_RATES_EX 50 | |
5470 | +#define MFIE_TYPE_GENERIC 221 | |
5471 | + | |
5472 | +#ifdef ENABLE_DOT11D | |
5473 | +typedef enum | |
5474 | +{ | |
5475 | + COUNTRY_CODE_FCC = 0, | |
5476 | + COUNTRY_CODE_IC = 1, | |
5477 | + COUNTRY_CODE_ETSI = 2, | |
5478 | + COUNTRY_CODE_SPAIN = 3, | |
5479 | + COUNTRY_CODE_FRANCE = 4, | |
5480 | + COUNTRY_CODE_MKK = 5, | |
5481 | + COUNTRY_CODE_MKK1 = 6, | |
5482 | + COUNTRY_CODE_ISRAEL = 7, | |
5483 | + COUNTRY_CODE_TELEC = 8, | |
5484 | + COUNTRY_CODE_GLOBAL_DOMAIN = 9, | |
5485 | + COUNTRY_CODE_WORLD_WIDE_13_INDEX = 10 | |
5486 | +}country_code_type_t; | |
5487 | +#endif | |
5488 | + | |
5489 | +struct ieee80211_info_element_hdr { | |
5490 | + u8 id; | |
5491 | + u8 len; | |
5492 | +} __attribute__ ((packed)); | |
5493 | + | |
5494 | +struct ieee80211_info_element { | |
5495 | + u8 id; | |
5496 | + u8 len; | |
5497 | + u8 data[0]; | |
5498 | +} __attribute__ ((packed)); | |
5499 | + | |
5500 | +/* | |
5501 | + * These are the data types that can make up management packets | |
5502 | + * | |
5503 | + u16 auth_algorithm; | |
5504 | + u16 auth_sequence; | |
5505 | + u16 beacon_interval; | |
5506 | + u16 capability; | |
5507 | + u8 current_ap[ETH_ALEN]; | |
5508 | + u16 listen_interval; | |
5509 | + struct { | |
5510 | + u16 association_id:14, reserved:2; | |
5511 | + } __attribute__ ((packed)); | |
5512 | + u32 time_stamp[2]; | |
5513 | + u16 reason; | |
5514 | + u16 status; | |
5515 | +*/ | |
5516 | + | |
5517 | +#define IEEE80211_DEFAULT_TX_ESSID "Penguin" | |
5518 | +#define IEEE80211_DEFAULT_BASIC_RATE 10 | |
5519 | + | |
5520 | +struct ieee80211_authentication { | |
5521 | + struct ieee80211_header_data header; | |
5522 | + u16 algorithm; | |
5523 | + u16 transaction; | |
5524 | + u16 status; | |
5525 | + //struct ieee80211_info_element_hdr info_element; | |
5526 | +} __attribute__ ((packed)); | |
5527 | + | |
5528 | + | |
5529 | +struct ieee80211_probe_response { | |
5530 | + struct ieee80211_header_data header; | |
5531 | + u32 time_stamp[2]; | |
5532 | + u16 beacon_interval; | |
5533 | + u16 capability; | |
5534 | + struct ieee80211_info_element info_element; | |
5535 | +} __attribute__ ((packed)); | |
5536 | + | |
5537 | +struct ieee80211_probe_request { | |
5538 | + struct ieee80211_header_data header; | |
5539 | + /*struct ieee80211_info_element info_element;*/ | |
5540 | +} __attribute__ ((packed)); | |
5541 | + | |
5542 | +struct ieee80211_assoc_request_frame { | |
5543 | + struct ieee80211_hdr_3addr header; | |
5544 | + u16 capability; | |
5545 | + u16 listen_interval; | |
5546 | + //u8 current_ap[ETH_ALEN]; | |
5547 | + struct ieee80211_info_element_hdr info_element; | |
5548 | +} __attribute__ ((packed)); | |
5549 | + | |
5550 | +struct ieee80211_assoc_response_frame { | |
5551 | + struct ieee80211_hdr_3addr header; | |
5552 | + u16 capability; | |
5553 | + u16 status; | |
5554 | + u16 aid; | |
5555 | + struct ieee80211_info_element info_element; /* supported rates */ | |
5556 | +} __attribute__ ((packed)); | |
5557 | + | |
5558 | +struct ieee80211_disassoc_frame{ | |
5559 | + struct ieee80211_hdr_3addr header; | |
5560 | + u16 reasoncode; | |
5561 | +}__attribute__ ((packed)); | |
5562 | + | |
5563 | +struct ieee80211_txb { | |
5564 | + u8 nr_frags; | |
5565 | + u8 encrypted; | |
5566 | + u16 reserved; | |
5567 | + u16 frag_size; | |
5568 | + u16 payload_size; | |
5569 | + struct sk_buff *fragments[0]; | |
5570 | +}; | |
5571 | + | |
5572 | +struct ieee80211_wmm_ac_param { | |
5573 | + u8 ac_aci_acm_aifsn; | |
5574 | + u8 ac_ecwmin_ecwmax; | |
5575 | + u16 ac_txop_limit; | |
5576 | +}; | |
5577 | + | |
5578 | +struct ieee80211_wmm_ts_info { | |
5579 | + u8 ac_dir_tid; | |
5580 | + u8 ac_up_psb; | |
5581 | + u8 reserved; | |
5582 | +} __attribute__ ((packed)); | |
5583 | + | |
5584 | +struct ieee80211_wmm_tspec_elem { | |
5585 | + struct ieee80211_wmm_ts_info ts_info; | |
5586 | + u16 norm_msdu_size; | |
5587 | + u16 max_msdu_size; | |
5588 | + u32 min_serv_inter; | |
5589 | + u32 max_serv_inter; | |
5590 | + u32 inact_inter; | |
5591 | + u32 suspen_inter; | |
5592 | + u32 serv_start_time; | |
5593 | + u32 min_data_rate; | |
5594 | + u32 mean_data_rate; | |
5595 | + u32 peak_data_rate; | |
5596 | + u32 max_burst_size; | |
5597 | + u32 delay_bound; | |
5598 | + u32 min_phy_rate; | |
5599 | + u16 surp_band_allow; | |
5600 | + u16 medium_time; | |
5601 | +}__attribute__((packed)); | |
5602 | + | |
5603 | +enum {WMM_all_frame, WMM_two_frame, WMM_four_frame, WMM_six_frame}; | |
5604 | +#define MAX_SP_Len (WMM_all_frame << 4) | |
5605 | +#define IEEE80211_QOS_TID 0x0f | |
5606 | +#define QOS_CTL_NOTCONTAIN_ACK (0x01 << 5) | |
5607 | + | |
5608 | +/* SWEEP TABLE ENTRIES NUMBER*/ | |
5609 | +#define MAX_SWEEP_TAB_ENTRIES 42 | |
5610 | +#define MAX_SWEEP_TAB_ENTRIES_PER_PACKET 7 | |
5611 | +/* MAX_RATES_LENGTH needs to be 12. The spec says 8, and many APs | |
5612 | + * only use 8, and then use extended rates for the remaining supported | |
5613 | + * rates. Other APs, however, stick all of their supported rates on the | |
5614 | + * main rates information element... */ | |
5615 | +#define MAX_RATES_LENGTH ((u8)12) | |
5616 | +#define MAX_RATES_EX_LENGTH ((u8)16) | |
5617 | +#define MAX_NETWORK_COUNT 128 | |
5618 | +//#define MAX_CHANNEL_NUMBER 161 | |
5619 | +#define MAX_CHANNEL_NUMBER 165 //YJ,modified,080625 | |
5620 | +#define MAX_IE_LEN 0xFF //+YJ,080625 | |
5621 | + | |
5622 | +typedef struct _CHANNEL_LIST{ | |
5623 | + u8 Channel[MAX_CHANNEL_NUMBER + 1]; | |
5624 | + u8 Len; | |
5625 | +}CHANNEL_LIST, *PCHANNEL_LIST; | |
5626 | + | |
5627 | +#define IEEE80211_SOFTMAC_SCAN_TIME 100//400 | |
5628 | +//(HZ / 2) | |
5629 | +//by amy for ps | |
5630 | +#define IEEE80211_WATCH_DOG_TIME 2000 | |
5631 | +//by amy for ps | |
5632 | +//by amy for antenna | |
5633 | +#define ANTENNA_DIVERSITY_TIMER_PERIOD 1000 // 1000 m | |
5634 | +//by amy for antenna | |
5635 | +#define IEEE80211_SOFTMAC_ASSOC_RETRY_TIME (HZ * 2) | |
5636 | + | |
5637 | +#define CRC_LENGTH 4U | |
5638 | + | |
5639 | +#define MAX_WPA_IE_LEN 64 | |
5640 | + | |
5641 | +#define NETWORK_EMPTY_ESSID (1<<0) | |
5642 | +#define NETWORK_HAS_OFDM (1<<1) | |
5643 | +#define NETWORK_HAS_CCK (1<<2) | |
5644 | + | |
5645 | +#define IEEE80211_DTIM_MBCAST 4 | |
5646 | +#define IEEE80211_DTIM_UCAST 2 | |
5647 | +#define IEEE80211_DTIM_VALID 1 | |
5648 | +#define IEEE80211_DTIM_INVALID 0 | |
5649 | + | |
5650 | +#define IEEE80211_PS_DISABLED 0 | |
5651 | +#define IEEE80211_PS_UNICAST IEEE80211_DTIM_UCAST | |
5652 | +#define IEEE80211_PS_MBCAST IEEE80211_DTIM_MBCAST | |
5653 | +#define IEEE80211_PS_ENABLE IEEE80211_DTIM_VALID | |
5654 | +//added by David for QoS 2006/6/30 | |
5655 | +//#define WMM_Hang_8187 | |
5656 | +#ifdef WMM_Hang_8187 | |
5657 | +#undef WMM_Hang_8187 | |
5658 | +#endif | |
5659 | + | |
5660 | +#define WME_AC_BE 0x00 | |
5661 | +#define WME_AC_BK 0x01 | |
5662 | +#define WME_AC_VI 0x02 | |
5663 | +#define WME_AC_VO 0x03 | |
5664 | +#define WME_ACI_MASK 0x03 | |
5665 | +#define WME_AIFSN_MASK 0x03 | |
5666 | +#define WME_AC_PRAM_LEN 16 | |
5667 | + | |
5668 | +//UP Mapping to AC, using in MgntQuery_SequenceNumber() and maybe for DSCP | |
5669 | +//#define UP2AC(up) ((up<3) ? ((up==0)?1:0) : (up>>1)) | |
5670 | +#define UP2AC(up) ( \ | |
5671 | + ((up) < 1) ? WME_AC_BE : \ | |
5672 | + ((up) < 3) ? WME_AC_BK : \ | |
5673 | + ((up) < 4) ? WME_AC_BE : \ | |
5674 | + ((up) < 6) ? WME_AC_VI : \ | |
5675 | + WME_AC_VO) | |
5676 | +//AC Mapping to UP, using in Tx part for selecting the corresponding TX queue | |
5677 | +#define AC2UP(_ac) ( \ | |
5678 | + ((_ac) == WME_AC_VO) ? 6 : \ | |
5679 | + ((_ac) == WME_AC_VI) ? 5 : \ | |
5680 | + ((_ac) == WME_AC_BK) ? 1 : \ | |
5681 | + 0) | |
5682 | + | |
5683 | +#define ETHER_ADDR_LEN 6 /* length of an Ethernet address */ | |
5684 | +struct ether_header { | |
5685 | + u8 ether_dhost[ETHER_ADDR_LEN]; | |
5686 | + u8 ether_shost[ETHER_ADDR_LEN]; | |
5687 | + u16 ether_type; | |
5688 | +} __attribute__((packed)); | |
5689 | + | |
5690 | +#ifndef ETHERTYPE_PAE | |
5691 | +#define ETHERTYPE_PAE 0x888e /* EAPOL PAE/802.1x */ | |
5692 | +#endif | |
5693 | +#ifndef ETHERTYPE_IP | |
5694 | +#define ETHERTYPE_IP 0x0800 /* IP protocol */ | |
5695 | +#endif | |
5696 | + | |
5697 | +struct ieee80211_network { | |
5698 | + /* These entries are used to identify a unique network */ | |
5699 | + u8 bssid[ETH_ALEN]; | |
5700 | + u8 channel; | |
5701 | + /* Ensure null-terminated for any debug msgs */ | |
5702 | + u8 ssid[IW_ESSID_MAX_SIZE + 1]; | |
5703 | + u8 ssid_len; | |
5704 | + | |
5705 | + /* These are network statistics */ | |
5706 | + struct ieee80211_rx_stats stats; | |
5707 | + u16 capability; | |
5708 | + u8 rates[MAX_RATES_LENGTH]; | |
5709 | + u8 rates_len; | |
5710 | + u8 rates_ex[MAX_RATES_EX_LENGTH]; | |
5711 | + u8 rates_ex_len; | |
5712 | + unsigned long last_scanned; | |
5713 | + u8 mode; | |
5714 | + u8 flags; | |
5715 | + u32 last_associate; | |
5716 | + u32 time_stamp[2]; | |
5717 | + u16 beacon_interval; | |
5718 | + u16 listen_interval; | |
5719 | + u16 atim_window; | |
5720 | + u8 wpa_ie[MAX_WPA_IE_LEN]; | |
5721 | + size_t wpa_ie_len; | |
5722 | + u8 rsn_ie[MAX_WPA_IE_LEN]; | |
5723 | + size_t rsn_ie_len; | |
5724 | + u8 dtim_period; | |
5725 | + u8 dtim_data; | |
5726 | + u32 last_dtim_sta_time[2]; | |
5727 | + struct list_head list; | |
5728 | + //appeded for QoS | |
5729 | + u8 wmm_info; | |
5730 | + struct ieee80211_wmm_ac_param wmm_param[4]; | |
5731 | + u8 QoS_Enable; | |
5732 | + u8 SignalStrength; | |
5733 | +//by amy 080312 | |
5734 | + u8 HighestOperaRate; | |
5735 | +//by amy 080312 | |
5736 | +#ifdef THOMAS_TURBO | |
5737 | + u8 Turbo_Enable;//enable turbo mode, added by thomas | |
5738 | +#endif | |
5739 | +#ifdef ENABLE_DOT11D | |
5740 | + u16 CountryIeLen; | |
5741 | + u8 CountryIeBuf[MAX_IE_LEN]; | |
5742 | +#endif | |
5743 | +}; | |
5744 | + | |
5745 | +enum ieee80211_state { | |
5746 | + | |
5747 | + /* the card is not linked at all */ | |
5748 | + IEEE80211_NOLINK = 0, | |
5749 | + | |
5750 | + /* IEEE80211_ASSOCIATING* are for BSS client mode | |
5751 | + * the driver shall not perform RX filtering unless | |
5752 | + * the state is LINKED. | |
5753 | + * The driver shall just check for the state LINKED and | |
5754 | + * defaults to NOLINK for ALL the other states (including | |
5755 | + * LINKED_SCANNING) | |
5756 | + */ | |
5757 | + | |
5758 | + /* the association procedure will start (wq scheduling)*/ | |
5759 | + IEEE80211_ASSOCIATING, | |
5760 | + IEEE80211_ASSOCIATING_RETRY, | |
5761 | + | |
5762 | + /* the association procedure is sending AUTH request*/ | |
5763 | + IEEE80211_ASSOCIATING_AUTHENTICATING, | |
5764 | + | |
5765 | + /* the association procedure has successfully authentcated | |
5766 | + * and is sending association request | |
5767 | + */ | |
5768 | + IEEE80211_ASSOCIATING_AUTHENTICATED, | |
5769 | + | |
5770 | + /* the link is ok. the card associated to a BSS or linked | |
5771 | + * to a ibss cell or acting as an AP and creating the bss | |
5772 | + */ | |
5773 | + IEEE80211_LINKED, | |
5774 | + | |
5775 | + /* same as LINKED, but the driver shall apply RX filter | |
5776 | + * rules as we are in NO_LINK mode. As the card is still | |
5777 | + * logically linked, but it is doing a syncro site survey | |
5778 | + * then it will be back to LINKED state. | |
5779 | + */ | |
5780 | + IEEE80211_LINKED_SCANNING, | |
5781 | + | |
5782 | +}; | |
5783 | + | |
5784 | +#define DEFAULT_MAX_SCAN_AGE (15 * HZ) | |
5785 | +#define DEFAULT_FTS 2346 | |
5786 | +#define MAC_FMT "%02x:%02x:%02x:%02x:%02x:%02x" | |
5787 | +#define MAC_ARG(x) ((u8*)(x))[0],((u8*)(x))[1],((u8*)(x))[2],((u8*)(x))[3],((u8*)(x))[4],((u8*)(x))[5] | |
5788 | + | |
5789 | + | |
5790 | +#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,11)) | |
5791 | +extern inline int is_multicast_ether_addr(const u8 *addr) | |
5792 | +{ | |
5793 | + return ((addr[0] != 0xff) && (0x01 & addr[0])); | |
5794 | +} | |
5795 | +#endif | |
5796 | + | |
5797 | +#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,13)) | |
5798 | +extern inline int is_broadcast_ether_addr(const u8 *addr) | |
5799 | +{ | |
5800 | + return ((addr[0] == 0xff) && (addr[1] == 0xff) && (addr[2] == 0xff) && \ | |
5801 | + (addr[3] == 0xff) && (addr[4] == 0xff) && (addr[5] == 0xff)); | |
5802 | +} | |
5803 | +#endif | |
5804 | + | |
5805 | +#define CFG_IEEE80211_RESERVE_FCS (1<<0) | |
5806 | +#define CFG_IEEE80211_COMPUTE_FCS (1<<1) | |
5807 | + | |
5808 | +typedef struct tx_pending_t{ | |
5809 | + int frag; | |
5810 | + struct ieee80211_txb *txb; | |
5811 | +}tx_pending_t; | |
5812 | + | |
5813 | + | |
5814 | +struct ieee80211_device { | |
5815 | + struct net_device *dev; | |
5816 | + | |
5817 | + /* Bookkeeping structures */ | |
5818 | + struct net_device_stats stats; | |
5819 | + struct ieee80211_stats ieee_stats; | |
5820 | + struct ieee80211_softmac_stats softmac_stats; | |
5821 | + | |
5822 | + /* Probe / Beacon management */ | |
5823 | + struct list_head network_free_list; | |
5824 | + struct list_head network_list; | |
5825 | + struct ieee80211_network *networks; | |
5826 | + int scans; | |
5827 | + int scan_age; | |
5828 | + | |
5829 | + int iw_mode; /* operating mode (IW_MODE_*) */ | |
5830 | + | |
5831 | + spinlock_t lock; | |
5832 | + spinlock_t wpax_suitlist_lock; | |
5833 | + | |
5834 | + int tx_headroom; /* Set to size of any additional room needed at front | |
5835 | + * of allocated Tx SKBs */ | |
5836 | + u32 config; | |
5837 | + | |
5838 | + /* WEP and other encryption related settings at the device level */ | |
5839 | + int open_wep; /* Set to 1 to allow unencrypted frames */ | |
5840 | + | |
5841 | + int reset_on_keychange; /* Set to 1 if the HW needs to be reset on | |
5842 | + * WEP key changes */ | |
5843 | + | |
5844 | + /* If the host performs {en,de}cryption, then set to 1 */ | |
5845 | + int host_encrypt; | |
5846 | + int host_decrypt; | |
5847 | + int ieee802_1x; /* is IEEE 802.1X used */ | |
5848 | + | |
5849 | + /* WPA data */ | |
5850 | + int wpa_enabled; | |
5851 | + int drop_unencrypted; | |
5852 | + int tkip_countermeasures; | |
5853 | + int privacy_invoked; | |
5854 | + size_t wpa_ie_len; | |
5855 | + u8 *wpa_ie; | |
5856 | + | |
5857 | + u8 ap_mac_addr[6]; | |
5858 | + u16 pairwise_key_type; | |
5859 | + u16 broadcast_key_type; | |
5860 | + | |
5861 | + struct list_head crypt_deinit_list; | |
5862 | + struct ieee80211_crypt_data *crypt[WEP_KEYS]; | |
5863 | + int tx_keyidx; /* default TX key index (crypt[tx_keyidx]) */ | |
5864 | + struct timer_list crypt_deinit_timer; | |
5865 | + | |
5866 | + int bcrx_sta_key; /* use individual keys to override default keys even | |
5867 | + * with RX of broad/multicast frames */ | |
5868 | + | |
5869 | + /* Fragmentation structures */ | |
5870 | + // each streaming contain a entry | |
5871 | + struct ieee80211_frag_entry frag_cache[17][IEEE80211_FRAG_CACHE_LEN]; | |
5872 | + unsigned int frag_next_idx[17]; | |
5873 | + u16 fts; /* Fragmentation Threshold */ | |
5874 | + | |
5875 | + /* This stores infos for the current network. | |
5876 | + * Either the network we are associated in INFRASTRUCTURE | |
5877 | + * or the network that we are creating in MASTER mode. | |
5878 | + * ad-hoc is a mixture ;-). | |
5879 | + * Note that in infrastructure mode, even when not associated, | |
5880 | + * fields bssid and essid may be valid (if wpa_set and essid_set | |
5881 | + * are true) as thy carry the value set by the user via iwconfig | |
5882 | + */ | |
5883 | + struct ieee80211_network current_network; | |
5884 | + | |
5885 | + | |
5886 | + enum ieee80211_state state; | |
5887 | + | |
5888 | + int short_slot; | |
5889 | + int mode; /* A, B, G */ | |
5890 | + int modulation; /* CCK, OFDM */ | |
5891 | + int freq_band; /* 2.4Ghz, 5.2Ghz, Mixed */ | |
5892 | + int abg_true; /* ABG flag */ | |
5893 | + | |
5894 | + /* used for forcing the ibss workqueue to terminate | |
5895 | + * without wait for the syncro scan to terminate | |
5896 | + */ | |
5897 | + short sync_scan_hurryup; | |
5898 | + | |
5899 | +#ifdef ENABLE_DOT11D | |
5900 | + void * pDot11dInfo; | |
5901 | + bool bGlobalDomain; | |
5902 | + | |
5903 | + // For Liteon Ch12~13 passive scan | |
5904 | + u8 MinPassiveChnlNum; | |
5905 | + u8 IbssStartChnl; | |
5906 | +#else | |
5907 | + /* map of allowed channels. 0 is dummy */ | |
5908 | + // FIXME: remeber to default to a basic channel plan depending of the PHY type | |
5909 | + int channel_map[MAX_CHANNEL_NUMBER+1]; | |
5910 | +#endif | |
5911 | + | |
5912 | + int rate; /* current rate */ | |
5913 | + int basic_rate; | |
5914 | + //FIXME: pleace callback, see if redundant with softmac_features | |
5915 | + short active_scan; | |
5916 | + | |
5917 | + /* this contains flags for selectively enable softmac support */ | |
5918 | + u16 softmac_features; | |
5919 | + | |
5920 | + /* if the sequence control field is not filled by HW */ | |
5921 | + u16 seq_ctrl[5]; | |
5922 | + | |
5923 | + /* association procedure transaction sequence number */ | |
5924 | + u16 associate_seq; | |
5925 | + | |
5926 | + /* AID for RTXed association responses */ | |
5927 | + u16 assoc_id; | |
5928 | + | |
5929 | + /* power save mode related*/ | |
5930 | + short ps; | |
5931 | + short sta_sleep; | |
5932 | + int ps_timeout; | |
5933 | + struct tasklet_struct ps_task; | |
5934 | + u32 ps_th; | |
5935 | + u32 ps_tl; | |
5936 | + | |
5937 | + short raw_tx; | |
5938 | + /* used if IEEE_SOFTMAC_TX_QUEUE is set */ | |
5939 | + short queue_stop; | |
5940 | + short scanning; | |
5941 | + short proto_started; | |
5942 | + | |
5943 | + struct semaphore wx_sem; | |
5944 | + struct semaphore scan_sem; | |
5945 | + | |
5946 | + spinlock_t mgmt_tx_lock; | |
5947 | + spinlock_t beacon_lock; | |
5948 | + | |
5949 | + short beacon_txing; | |
5950 | + | |
5951 | + short wap_set; | |
5952 | + short ssid_set; | |
5953 | + | |
5954 | + u8 wpax_type_set; //{added by David, 2006.9.28} | |
5955 | + u32 wpax_type_notify; //{added by David, 2006.9.26} | |
5956 | + | |
5957 | + /* QoS related flag */ | |
5958 | + char init_wmmparam_flag; | |
5959 | + | |
5960 | + /* for discarding duplicated packets in IBSS */ | |
5961 | + struct list_head ibss_mac_hash[IEEE_IBSS_MAC_HASH_SIZE]; | |
5962 | + | |
5963 | + /* for discarding duplicated packets in BSS */ | |
5964 | + u16 last_rxseq_num[17]; /* rx seq previous per-tid */ | |
5965 | + u16 last_rxfrag_num[17];/* tx frag previous per-tid */ | |
5966 | + unsigned long last_packet_time[17]; | |
5967 | + | |
5968 | + /* for PS mode */ | |
5969 | + unsigned long last_rx_ps_time; | |
5970 | + | |
5971 | + /* used if IEEE_SOFTMAC_SINGLE_QUEUE is set */ | |
5972 | + struct sk_buff *mgmt_queue_ring[MGMT_QUEUE_NUM]; | |
5973 | + int mgmt_queue_head; | |
5974 | + int mgmt_queue_tail; | |
5975 | + | |
5976 | + | |
5977 | + /* used if IEEE_SOFTMAC_TX_QUEUE is set */ | |
5978 | + struct tx_pending_t tx_pending; | |
5979 | + | |
5980 | + /* used if IEEE_SOFTMAC_ASSOCIATE is set */ | |
5981 | + struct timer_list associate_timer; | |
5982 | + | |
5983 | + /* used if IEEE_SOFTMAC_BEACONS is set */ | |
5984 | + struct timer_list beacon_timer; | |
5985 | + | |
5986 | + struct work_struct associate_complete_wq; | |
5987 | +// struct work_struct associate_retry_wq; | |
5988 | + struct work_struct associate_procedure_wq; | |
5989 | +// struct work_struct softmac_scan_wq; | |
5990 | + struct work_struct wx_sync_scan_wq; | |
5991 | + struct work_struct wmm_param_update_wq; | |
5992 | + struct work_struct ps_request_tx_ack_wq;//for ps | |
5993 | +// struct work_struct hw_wakeup_wq; | |
5994 | +// struct work_struct hw_sleep_wq; | |
5995 | +// struct work_struct watch_dog_wq; | |
5996 | + bool bInactivePs; | |
5997 | + bool actscanning; | |
5998 | + bool beinretry; | |
5999 | + u16 ListenInterval; | |
6000 | + unsigned long NumRxDataInPeriod; //YJ,add,080828 | |
6001 | + unsigned long NumRxBcnInPeriod; //YJ,add,080828 | |
6002 | + unsigned long NumRxOkTotal; | |
6003 | + unsigned long NumRxUnicast;//YJ,add,080828,for keep alive | |
6004 | + bool bHwRadioOff; | |
6005 | +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20) | |
6006 | + struct delayed_work softmac_scan_wq; | |
6007 | + struct delayed_work associate_retry_wq; | |
6008 | + struct delayed_work hw_wakeup_wq; | |
6009 | + struct delayed_work hw_sleep_wq;//+by amy 080324 | |
6010 | + struct delayed_work watch_dog_wq; | |
6011 | + struct delayed_work sw_antenna_wq; | |
6012 | + struct delayed_work start_ibss_wq; | |
6013 | +//by amy for rate adaptive 080312 | |
6014 | + struct delayed_work rate_adapter_wq; | |
6015 | +//by amy for rate adaptive | |
6016 | + struct delayed_work hw_dig_wq; | |
6017 | + struct delayed_work tx_pw_wq; | |
6018 | + | |
6019 | +//Added for RF power on power off by lizhaoming 080512 | |
6020 | + struct delayed_work GPIOChangeRFWorkItem; | |
6021 | +#else | |
6022 | + | |
6023 | + struct work_struct start_ibss_wq; | |
6024 | + struct work_struct softmac_scan_wq; | |
6025 | + struct work_struct associate_retry_wq; | |
6026 | + struct work_struct hw_wakeup_wq; | |
6027 | + struct work_struct hw_sleep_wq; | |
6028 | + struct work_struct watch_dog_wq; | |
6029 | + struct work_struct sw_antenna_wq; | |
6030 | +//by amy for rate adaptive 080312 | |
6031 | + struct work_struct rate_adapter_wq; | |
6032 | +//by amy for rate adaptive | |
6033 | + struct work_struct hw_dig_wq; | |
6034 | + struct work_struct tx_pw_wq; | |
6035 | + | |
6036 | +//Added for RF power on power off by lizhaoming 080512 | |
6037 | + struct work_struct GPIOChangeRFWorkItem; | |
6038 | +#endif | |
6039 | + struct workqueue_struct *wq; | |
6040 | + | |
6041 | + /* Callback functions */ | |
6042 | + void (*set_security)(struct net_device *dev, | |
6043 | + struct ieee80211_security *sec); | |
6044 | + | |
6045 | + /* Used to TX data frame by using txb structs. | |
6046 | + * this is not used if in the softmac_features | |
6047 | + * is set the flag IEEE_SOFTMAC_TX_QUEUE | |
6048 | + */ | |
6049 | + int (*hard_start_xmit)(struct ieee80211_txb *txb, | |
6050 | + struct net_device *dev); | |
6051 | + | |
6052 | + int (*reset_port)(struct net_device *dev); | |
6053 | + | |
6054 | + /* Softmac-generated frames (mamagement) are TXed via this | |
6055 | + * callback if the flag IEEE_SOFTMAC_SINGLE_QUEUE is | |
6056 | + * not set. As some cards may have different HW queues that | |
6057 | + * one might want to use for data and management frames | |
6058 | + * the option to have two callbacks might be useful. | |
6059 | + * This fucntion can't sleep. | |
6060 | + */ | |
6061 | + int (*softmac_hard_start_xmit)(struct sk_buff *skb, | |
6062 | + struct net_device *dev); | |
6063 | + | |
6064 | + /* used instead of hard_start_xmit (not softmac_hard_start_xmit) | |
6065 | + * if the IEEE_SOFTMAC_TX_QUEUE feature is used to TX data | |
6066 | + * frames. I the option IEEE_SOFTMAC_SINGLE_QUEUE is also set | |
6067 | + * then also management frames are sent via this callback. | |
6068 | + * This function can't sleep. | |
6069 | + */ | |
6070 | + void (*softmac_data_hard_start_xmit)(struct sk_buff *skb, | |
6071 | + struct net_device *dev,int rate); | |
6072 | + | |
6073 | + /* stops the HW queue for DATA frames. Useful to avoid | |
6074 | + * waste time to TX data frame when we are reassociating | |
6075 | + * This function can sleep. | |
6076 | + */ | |
6077 | + void (*data_hard_stop)(struct net_device *dev); | |
6078 | + | |
6079 | + /* OK this is complementar to data_poll_hard_stop */ | |
6080 | + void (*data_hard_resume)(struct net_device *dev); | |
6081 | + | |
6082 | + /* ask to the driver to retune the radio . | |
6083 | + * This function can sleep. the driver should ensure | |
6084 | + * the radio has been swithced before return. | |
6085 | + */ | |
6086 | + void (*set_chan)(struct net_device *dev,short ch); | |
6087 | + | |
6088 | + /* These are not used if the ieee stack takes care of | |
6089 | + * scanning (IEEE_SOFTMAC_SCAN feature set). | |
6090 | + * In this case only the set_chan is used. | |
6091 | + * | |
6092 | + * The syncro version is similar to the start_scan but | |
6093 | + * does not return until all channels has been scanned. | |
6094 | + * this is called in user context and should sleep, | |
6095 | + * it is called in a work_queue when swithcing to ad-hoc mode | |
6096 | + * or in behalf of iwlist scan when the card is associated | |
6097 | + * and root user ask for a scan. | |
6098 | + * the fucntion stop_scan should stop both the syncro and | |
6099 | + * background scanning and can sleep. | |
6100 | + * The fucntion start_scan should initiate the background | |
6101 | + * scanning and can't sleep. | |
6102 | + */ | |
6103 | + void (*scan_syncro)(struct net_device *dev); | |
6104 | + void (*start_scan)(struct net_device *dev); | |
6105 | + void (*stop_scan)(struct net_device *dev); | |
6106 | + | |
6107 | + /* indicate the driver that the link state is changed | |
6108 | + * for example it may indicate the card is associated now. | |
6109 | + * Driver might be interested in this to apply RX filter | |
6110 | + * rules or simply light the LINK led | |
6111 | + */ | |
6112 | + void (*link_change)(struct net_device *dev); | |
6113 | + | |
6114 | + /* these two function indicates to the HW when to start | |
6115 | + * and stop to send beacons. This is used when the | |
6116 | + * IEEE_SOFTMAC_BEACONS is not set. For now the | |
6117 | + * stop_send_bacons is NOT guaranteed to be called only | |
6118 | + * after start_send_beacons. | |
6119 | + */ | |
6120 | + void (*start_send_beacons) (struct net_device *dev); | |
6121 | + void (*stop_send_beacons) (struct net_device *dev); | |
6122 | + | |
6123 | + /* power save mode related */ | |
6124 | + void (*sta_wake_up) (struct net_device *dev); | |
6125 | + void (*ps_request_tx_ack) (struct net_device *dev); | |
6126 | + void (*enter_sleep_state) (struct net_device *dev, u32 th, u32 tl); | |
6127 | + short (*ps_is_queue_empty) (struct net_device *dev); | |
6128 | + | |
6129 | + /* QoS related */ | |
6130 | + //void (*wmm_param_update) (struct net_device *dev, u8 *ac_param); | |
6131 | + //void (*wmm_param_update) (struct ieee80211_device *ieee); | |
6132 | + | |
6133 | + /* This must be the last item so that it points to the data | |
6134 | + * allocated beyond this structure by alloc_ieee80211 */ | |
6135 | + u8 priv[0]; | |
6136 | +}; | |
6137 | + | |
6138 | +#define IEEE_A (1<<0) | |
6139 | +#define IEEE_B (1<<1) | |
6140 | +#define IEEE_G (1<<2) | |
6141 | +#define IEEE_MODE_MASK (IEEE_A|IEEE_B|IEEE_G) | |
6142 | + | |
6143 | +/* Generate a 802.11 header */ | |
6144 | + | |
6145 | +/* Uses the channel change callback directly | |
6146 | + * instead of [start/stop] scan callbacks | |
6147 | + */ | |
6148 | +#define IEEE_SOFTMAC_SCAN (1<<2) | |
6149 | + | |
6150 | +/* Perform authentication and association handshake */ | |
6151 | +#define IEEE_SOFTMAC_ASSOCIATE (1<<3) | |
6152 | + | |
6153 | +/* Generate probe requests */ | |
6154 | +#define IEEE_SOFTMAC_PROBERQ (1<<4) | |
6155 | + | |
6156 | +/* Generate respones to probe requests */ | |
6157 | +#define IEEE_SOFTMAC_PROBERS (1<<5) | |
6158 | + | |
6159 | +/* The ieee802.11 stack will manages the netif queue | |
6160 | + * wake/stop for the driver, taking care of 802.11 | |
6161 | + * fragmentation. See softmac.c for details. */ | |
6162 | +#define IEEE_SOFTMAC_TX_QUEUE (1<<7) | |
6163 | + | |
6164 | +/* Uses only the softmac_data_hard_start_xmit | |
6165 | + * even for TX management frames. | |
6166 | + */ | |
6167 | +#define IEEE_SOFTMAC_SINGLE_QUEUE (1<<8) | |
6168 | + | |
6169 | +/* Generate beacons. The stack will enqueue beacons | |
6170 | + * to the card | |
6171 | + */ | |
6172 | +#define IEEE_SOFTMAC_BEACONS (1<<6) | |
6173 | + | |
6174 | + | |
6175 | + | |
6176 | +static inline void *ieee80211_priv(struct net_device *dev) | |
6177 | +{ | |
6178 | + return ((struct ieee80211_device *)netdev_priv(dev))->priv; | |
6179 | +} | |
6180 | + | |
6181 | +extern inline int ieee80211_is_empty_essid(const char *essid, int essid_len) | |
6182 | +{ | |
6183 | + /* Single white space is for Linksys APs */ | |
6184 | + if (essid_len == 1 && essid[0] == ' ') | |
6185 | + return 1; | |
6186 | + | |
6187 | + /* Otherwise, if the entire essid is 0, we assume it is hidden */ | |
6188 | + while (essid_len) { | |
6189 | + essid_len--; | |
6190 | + if (essid[essid_len] != '\0') | |
6191 | + return 0; | |
6192 | + } | |
6193 | + | |
6194 | + return 1; | |
6195 | +} | |
6196 | + | |
6197 | +extern inline int ieee80211_is_valid_mode(struct ieee80211_device *ieee, int mode) | |
6198 | +{ | |
6199 | + /* | |
6200 | + * It is possible for both access points and our device to support | |
6201 | + * combinations of modes, so as long as there is one valid combination | |
6202 | + * of ap/device supported modes, then return success | |
6203 | + * | |
6204 | + */ | |
6205 | + if ((mode & IEEE_A) && | |
6206 | + (ieee->modulation & IEEE80211_OFDM_MODULATION) && | |
6207 | + (ieee->freq_band & IEEE80211_52GHZ_BAND)) | |
6208 | + return 1; | |
6209 | + | |
6210 | + if ((mode & IEEE_G) && | |
6211 | + (ieee->modulation & IEEE80211_OFDM_MODULATION) && | |
6212 | + (ieee->freq_band & IEEE80211_24GHZ_BAND)) | |
6213 | + return 1; | |
6214 | + | |
6215 | + if ((mode & IEEE_B) && | |
6216 | + (ieee->modulation & IEEE80211_CCK_MODULATION) && | |
6217 | + (ieee->freq_band & IEEE80211_24GHZ_BAND)) | |
6218 | + return 1; | |
6219 | + | |
6220 | + return 0; | |
6221 | +} | |
6222 | + | |
6223 | +extern inline int ieee80211_get_hdrlen(u16 fc) | |
6224 | +{ | |
6225 | + int hdrlen = 24; | |
6226 | + | |
6227 | + switch (WLAN_FC_GET_TYPE(fc)) { | |
6228 | + case IEEE80211_FTYPE_DATA: | |
6229 | + if ((fc & IEEE80211_FCTL_FROMDS) && (fc & IEEE80211_FCTL_TODS)) | |
6230 | + hdrlen = 30; /* Addr4 */ | |
6231 | + if(IEEE80211_QOS_HAS_SEQ(fc)) | |
6232 | + hdrlen += 2; /* QOS ctrl*/ | |
6233 | + break; | |
6234 | + case IEEE80211_FTYPE_CTL: | |
6235 | + switch (WLAN_FC_GET_STYPE(fc)) { | |
6236 | + case IEEE80211_STYPE_CTS: | |
6237 | + case IEEE80211_STYPE_ACK: | |
6238 | + hdrlen = 10; | |
6239 | + break; | |
6240 | + default: | |
6241 | + hdrlen = 16; | |
6242 | + break; | |
6243 | + } | |
6244 | + break; | |
6245 | + } | |
6246 | + | |
6247 | + return hdrlen; | |
6248 | +} | |
6249 | + | |
6250 | + | |
6251 | + | |
6252 | +/* ieee80211.c */ | |
6253 | +extern void free_ieee80211(struct net_device *dev); | |
6254 | +extern struct net_device *alloc_ieee80211(int sizeof_priv); | |
6255 | + | |
6256 | +extern int ieee80211_set_encryption(struct ieee80211_device *ieee); | |
6257 | + | |
6258 | +/* ieee80211_tx.c */ | |
6259 | + | |
6260 | +extern int ieee80211_encrypt_fragment( | |
6261 | + struct ieee80211_device *ieee, | |
6262 | + struct sk_buff *frag, | |
6263 | + int hdr_len); | |
6264 | + | |
6265 | +extern int ieee80211_xmit(struct sk_buff *skb, | |
6266 | + struct net_device *dev); | |
6267 | +extern void ieee80211_txb_free(struct ieee80211_txb *); | |
6268 | + | |
6269 | + | |
6270 | +/* ieee80211_rx.c */ | |
6271 | +extern int ieee80211_rx(struct ieee80211_device *ieee, struct sk_buff *skb, | |
6272 | + struct ieee80211_rx_stats *rx_stats); | |
6273 | +extern void ieee80211_rx_mgt(struct ieee80211_device *ieee, | |
6274 | + struct ieee80211_hdr *header, | |
6275 | + struct ieee80211_rx_stats *stats); | |
6276 | + | |
6277 | +/* ieee80211_wx.c */ | |
6278 | +extern int ieee80211_wx_get_scan(struct ieee80211_device *ieee, | |
6279 | + struct iw_request_info *info, | |
6280 | + union iwreq_data *wrqu, char *key); | |
6281 | +extern int ieee80211_wx_set_encode(struct ieee80211_device *ieee, | |
6282 | + struct iw_request_info *info, | |
6283 | + union iwreq_data *wrqu, char *key); | |
6284 | +extern int ieee80211_wx_get_encode(struct ieee80211_device *ieee, | |
6285 | + struct iw_request_info *info, | |
6286 | + union iwreq_data *wrqu, char *key); | |
6287 | +extern int ieee80211_wx_set_encode_ext(struct ieee80211_device *ieee, | |
6288 | + struct iw_request_info *info, | |
6289 | + union iwreq_data* wrqu, char *extra); | |
6290 | +int ieee80211_wx_set_auth(struct ieee80211_device *ieee, | |
6291 | + struct iw_request_info *info, | |
6292 | + struct iw_param *data, char *extra); | |
6293 | +int ieee80211_wx_set_mlme(struct ieee80211_device *ieee, | |
6294 | + struct iw_request_info *info, | |
6295 | + union iwreq_data *wrqu, char *extra); | |
6296 | + | |
6297 | +int ieee80211_wx_set_gen_ie(struct ieee80211_device *ieee, u8 *ie, size_t len); | |
6298 | +/* ieee80211_softmac.c */ | |
6299 | +extern short ieee80211_is_54g(struct ieee80211_network net); | |
6300 | +extern short ieee80211_is_shortslot(struct ieee80211_network net); | |
6301 | +extern int ieee80211_rx_frame_softmac(struct ieee80211_device *ieee, struct sk_buff *skb, | |
6302 | + struct ieee80211_rx_stats *rx_stats, u16 type, | |
6303 | + u16 stype); | |
6304 | +extern void ieee80211_softmac_new_net(struct ieee80211_device *ieee, struct ieee80211_network *net); | |
6305 | + | |
6306 | +extern void ieee80211_softmac_xmit(struct ieee80211_txb *txb, struct ieee80211_device *ieee); | |
6307 | +extern void ieee80211_softmac_check_all_nets(struct ieee80211_device *ieee); | |
6308 | +extern void ieee80211_start_bss(struct ieee80211_device *ieee); | |
6309 | +extern void ieee80211_start_master_bss(struct ieee80211_device *ieee); | |
6310 | +extern void ieee80211_start_ibss(struct ieee80211_device *ieee); | |
6311 | +extern void ieee80211_softmac_init(struct ieee80211_device *ieee); | |
6312 | +extern void ieee80211_softmac_free(struct ieee80211_device *ieee); | |
6313 | +extern void ieee80211_associate_abort(struct ieee80211_device *ieee); | |
6314 | +extern void ieee80211_disassociate(struct ieee80211_device *ieee); | |
6315 | +extern void ieee80211_stop_scan(struct ieee80211_device *ieee); | |
6316 | +extern void ieee80211_start_scan_syncro(struct ieee80211_device *ieee); | |
6317 | +extern void ieee80211_check_all_nets(struct ieee80211_device *ieee); | |
6318 | +extern void ieee80211_start_protocol(struct ieee80211_device *ieee); | |
6319 | +extern void ieee80211_stop_protocol(struct ieee80211_device *ieee); | |
6320 | +extern void ieee80211_softmac_start_protocol(struct ieee80211_device *ieee); | |
6321 | +extern void ieee80211_softmac_stop_protocol(struct ieee80211_device *ieee); | |
6322 | +extern void ieee80211_reset_queue(struct ieee80211_device *ieee); | |
6323 | +extern void ieee80211_wake_queue(struct ieee80211_device *ieee); | |
6324 | +extern void ieee80211_stop_queue(struct ieee80211_device *ieee); | |
6325 | +extern struct sk_buff *ieee80211_get_beacon(struct ieee80211_device *ieee); | |
6326 | +extern void ieee80211_start_send_beacons(struct ieee80211_device *ieee); | |
6327 | +extern void ieee80211_stop_send_beacons(struct ieee80211_device *ieee); | |
6328 | +extern int ieee80211_wpa_supplicant_ioctl(struct ieee80211_device *ieee, struct iw_point *p); | |
6329 | +extern void notify_wx_assoc_event(struct ieee80211_device *ieee); | |
6330 | +extern void ieee80211_ps_tx_ack(struct ieee80211_device *ieee, short success); | |
6331 | +extern void SendDisassociation(struct ieee80211_device *ieee,u8* asSta,u8 asRsn); | |
6332 | +extern void ieee80211_start_scan(struct ieee80211_device *ieee); | |
6333 | + | |
6334 | +//Add for RF power on power off by lizhaoming 080512 | |
6335 | +extern void SendDisassociation(struct ieee80211_device *ieee, | |
6336 | + u8* asSta, | |
6337 | + u8 asRsn); | |
6338 | + | |
6339 | +/* ieee80211_crypt_ccmp&tkip&wep.c */ | |
6340 | +extern void ieee80211_tkip_null(void); | |
6341 | +extern void ieee80211_wep_null(void); | |
6342 | +extern void ieee80211_ccmp_null(void); | |
6343 | +/* ieee80211_softmac_wx.c */ | |
6344 | + | |
6345 | +extern int ieee80211_wx_get_wap(struct ieee80211_device *ieee, | |
6346 | + struct iw_request_info *info, | |
6347 | + union iwreq_data *wrqu, char *ext); | |
6348 | + | |
6349 | +extern int ieee80211_wx_set_wap(struct ieee80211_device *ieee, | |
6350 | + struct iw_request_info *info, | |
6351 | + union iwreq_data *awrq, | |
6352 | + char *extra); | |
6353 | + | |
6354 | +extern int ieee80211_wx_get_essid(struct ieee80211_device *ieee, struct iw_request_info *a,union iwreq_data *wrqu,char *b); | |
6355 | + | |
6356 | +extern int ieee80211_wx_set_rate(struct ieee80211_device *ieee, | |
6357 | + struct iw_request_info *info, | |
6358 | + union iwreq_data *wrqu, char *extra); | |
6359 | + | |
6360 | +extern int ieee80211_wx_get_rate(struct ieee80211_device *ieee, | |
6361 | + struct iw_request_info *info, | |
6362 | + union iwreq_data *wrqu, char *extra); | |
6363 | + | |
6364 | +extern int ieee80211_wx_set_mode(struct ieee80211_device *ieee, struct iw_request_info *a, | |
6365 | + union iwreq_data *wrqu, char *b); | |
6366 | + | |
6367 | +extern int ieee80211_wx_set_scan(struct ieee80211_device *ieee, struct iw_request_info *a, | |
6368 | + union iwreq_data *wrqu, char *b); | |
6369 | + | |
6370 | +extern int ieee80211_wx_set_essid(struct ieee80211_device *ieee, | |
6371 | + struct iw_request_info *a, | |
6372 | + union iwreq_data *wrqu, char *extra); | |
6373 | + | |
6374 | +extern int ieee80211_wx_get_mode(struct ieee80211_device *ieee, struct iw_request_info *a, | |
6375 | + union iwreq_data *wrqu, char *b); | |
6376 | + | |
6377 | +extern int ieee80211_wx_set_freq(struct ieee80211_device *ieee, struct iw_request_info *a, | |
6378 | + union iwreq_data *wrqu, char *b); | |
6379 | + | |
6380 | +extern int ieee80211_wx_get_freq(struct ieee80211_device *ieee, struct iw_request_info *a, | |
6381 | + union iwreq_data *wrqu, char *b); | |
6382 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
6383 | +extern void ieee80211_wx_sync_scan_wq(struct work_struct *work); | |
6384 | +#else | |
6385 | + extern void ieee80211_wx_sync_scan_wq(struct ieee80211_device *ieee); | |
6386 | +#endif | |
6387 | +//extern void ieee80211_wx_sync_scan_wq(struct ieee80211_device *ieee); | |
6388 | + | |
6389 | +extern int ieee80211_wx_set_rawtx(struct ieee80211_device *ieee, | |
6390 | + struct iw_request_info *info, | |
6391 | + union iwreq_data *wrqu, char *extra); | |
6392 | + | |
6393 | +extern int ieee80211_wx_get_name(struct ieee80211_device *ieee, | |
6394 | + struct iw_request_info *info, | |
6395 | + union iwreq_data *wrqu, char *extra); | |
6396 | + | |
6397 | +extern int ieee80211_wx_set_power(struct ieee80211_device *ieee, | |
6398 | + struct iw_request_info *info, | |
6399 | + union iwreq_data *wrqu, char *extra); | |
6400 | + | |
6401 | +extern int ieee80211_wx_get_power(struct ieee80211_device *ieee, | |
6402 | + struct iw_request_info *info, | |
6403 | + union iwreq_data *wrqu, char *extra); | |
6404 | + | |
6405 | +extern void ieee80211_softmac_ips_scan_syncro(struct ieee80211_device *ieee); | |
6406 | + | |
6407 | +extern void ieee80211_sta_ps_send_null_frame(struct ieee80211_device *ieee, short pwr); | |
6408 | + | |
6409 | +extern const long ieee80211_wlan_frequencies[]; | |
6410 | + | |
6411 | +extern inline void ieee80211_increment_scans(struct ieee80211_device *ieee) | |
6412 | +{ | |
6413 | + ieee->scans++; | |
6414 | +} | |
6415 | + | |
6416 | +extern inline int ieee80211_get_scans(struct ieee80211_device *ieee) | |
6417 | +{ | |
6418 | + return ieee->scans; | |
6419 | +} | |
6420 | + | |
6421 | +static inline const char *escape_essid(const char *essid, u8 essid_len) { | |
6422 | + static char escaped[IW_ESSID_MAX_SIZE * 2 + 1]; | |
6423 | + const char *s = essid; | |
6424 | + char *d = escaped; | |
6425 | + | |
6426 | + if (ieee80211_is_empty_essid(essid, essid_len)) { | |
6427 | + memcpy(escaped, "<hidden>", sizeof("<hidden>")); | |
6428 | + return escaped; | |
6429 | + } | |
6430 | + | |
6431 | + essid_len = min(essid_len, (u8)IW_ESSID_MAX_SIZE); | |
6432 | + while (essid_len--) { | |
6433 | + if (*s == '\0') { | |
6434 | + *d++ = '\\'; | |
6435 | + *d++ = '0'; | |
6436 | + s++; | |
6437 | + } else { | |
6438 | + *d++ = *s++; | |
6439 | + } | |
6440 | + } | |
6441 | + *d = '\0'; | |
6442 | + return escaped; | |
6443 | +} | |
6444 | +#endif /* IEEE80211_H */ | |
6445 | --- /dev/null | |
6446 | +++ b/drivers/staging/rtl8187se/ieee80211/ieee80211_module.c | |
6447 | @@ -0,0 +1,299 @@ | |
6448 | +/******************************************************************************* | |
6449 | + | |
6450 | + Copyright(c) 2004 Intel Corporation. All rights reserved. | |
6451 | + | |
6452 | + Portions of this file are based on the WEP enablement code provided by the | |
6453 | + Host AP project hostap-drivers v0.1.3 | |
6454 | + Copyright (c) 2001-2002, SSH Communications Security Corp and Jouni Malinen | |
6455 | + <jkmaline@cc.hut.fi> | |
6456 | + Copyright (c) 2002-2003, Jouni Malinen <jkmaline@cc.hut.fi> | |
6457 | + | |
6458 | + This program is free software; you can redistribute it and/or modify it | |
6459 | + under the terms of version 2 of the GNU General Public License as | |
6460 | + published by the Free Software Foundation. | |
6461 | + | |
6462 | + This program is distributed in the hope that it will be useful, but WITHOUT | |
6463 | + ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
6464 | + FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
6465 | + more details. | |
6466 | + | |
6467 | + You should have received a copy of the GNU General Public License along with | |
6468 | + this program; if not, write to the Free Software Foundation, Inc., 59 | |
6469 | + Temple Place - Suite 330, Boston, MA 02111-1307, USA. | |
6470 | + | |
6471 | + The full GNU General Public License is included in this distribution in the | |
6472 | + file called LICENSE. | |
6473 | + | |
6474 | + Contact Information: | |
6475 | + James P. Ketrenos <ipw2100-admin@linux.intel.com> | |
6476 | + Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 | |
6477 | + | |
6478 | +*******************************************************************************/ | |
6479 | + | |
6480 | +#include <linux/compiler.h> | |
6481 | +//#include <linux/config.h> | |
6482 | +#include <linux/errno.h> | |
6483 | +#include <linux/if_arp.h> | |
6484 | +#include <linux/in6.h> | |
6485 | +#include <linux/in.h> | |
6486 | +#include <linux/ip.h> | |
6487 | +#include <linux/kernel.h> | |
6488 | +#include <linux/module.h> | |
6489 | +#include <linux/netdevice.h> | |
6490 | +#include <linux/pci.h> | |
6491 | +#include <linux/proc_fs.h> | |
6492 | +#include <linux/skbuff.h> | |
6493 | +#include <linux/slab.h> | |
6494 | +#include <linux/tcp.h> | |
6495 | +#include <linux/types.h> | |
6496 | +#include <linux/version.h> | |
6497 | +#include <linux/wireless.h> | |
6498 | +#include <linux/etherdevice.h> | |
6499 | +#include <asm/uaccess.h> | |
6500 | +#include <net/arp.h> | |
6501 | + | |
6502 | +#include "ieee80211.h" | |
6503 | + | |
6504 | +MODULE_DESCRIPTION("802.11 data/management/control stack"); | |
6505 | +MODULE_AUTHOR("Copyright (C) 2004 Intel Corporation <jketreno@linux.intel.com>"); | |
6506 | +MODULE_LICENSE("GPL"); | |
6507 | + | |
6508 | +#define DRV_NAME "ieee80211" | |
6509 | + | |
6510 | +static inline int ieee80211_networks_allocate(struct ieee80211_device *ieee) | |
6511 | +{ | |
6512 | + if (ieee->networks) | |
6513 | + return 0; | |
6514 | + | |
6515 | + ieee->networks = kmalloc( | |
6516 | + MAX_NETWORK_COUNT * sizeof(struct ieee80211_network), | |
6517 | + GFP_KERNEL); | |
6518 | + if (!ieee->networks) { | |
6519 | + printk(KERN_WARNING "%s: Out of memory allocating beacons\n", | |
6520 | + ieee->dev->name); | |
6521 | + return -ENOMEM; | |
6522 | + } | |
6523 | + | |
6524 | + memset(ieee->networks, 0, | |
6525 | + MAX_NETWORK_COUNT * sizeof(struct ieee80211_network)); | |
6526 | + | |
6527 | + return 0; | |
6528 | +} | |
6529 | + | |
6530 | +static inline void ieee80211_networks_free(struct ieee80211_device *ieee) | |
6531 | +{ | |
6532 | + if (!ieee->networks) | |
6533 | + return; | |
6534 | + kfree(ieee->networks); | |
6535 | + ieee->networks = NULL; | |
6536 | +} | |
6537 | + | |
6538 | +static inline void ieee80211_networks_initialize(struct ieee80211_device *ieee) | |
6539 | +{ | |
6540 | + int i; | |
6541 | + | |
6542 | + INIT_LIST_HEAD(&ieee->network_free_list); | |
6543 | + INIT_LIST_HEAD(&ieee->network_list); | |
6544 | + for (i = 0; i < MAX_NETWORK_COUNT; i++) | |
6545 | + list_add_tail(&ieee->networks[i].list, &ieee->network_free_list); | |
6546 | +} | |
6547 | + | |
6548 | + | |
6549 | +struct net_device *alloc_ieee80211(int sizeof_priv) | |
6550 | +{ | |
6551 | + struct ieee80211_device *ieee; | |
6552 | + struct net_device *dev; | |
6553 | + int i,err; | |
6554 | + | |
6555 | + IEEE80211_DEBUG_INFO("Initializing...\n"); | |
6556 | + | |
6557 | + dev = alloc_etherdev(sizeof(struct ieee80211_device) + sizeof_priv); | |
6558 | + if (!dev) { | |
6559 | + IEEE80211_ERROR("Unable to network device.\n"); | |
6560 | + goto failed; | |
6561 | + } | |
6562 | + ieee = netdev_priv(dev); | |
6563 | + dev->hard_start_xmit = ieee80211_xmit; | |
6564 | + | |
6565 | + ieee->dev = dev; | |
6566 | + | |
6567 | + err = ieee80211_networks_allocate(ieee); | |
6568 | + if (err) { | |
6569 | + IEEE80211_ERROR("Unable to allocate beacon storage: %d\n", | |
6570 | + err); | |
6571 | + goto failed; | |
6572 | + } | |
6573 | + ieee80211_networks_initialize(ieee); | |
6574 | + | |
6575 | + /* Default fragmentation threshold is maximum payload size */ | |
6576 | + ieee->fts = DEFAULT_FTS; | |
6577 | + ieee->scan_age = DEFAULT_MAX_SCAN_AGE; | |
6578 | + ieee->open_wep = 1; | |
6579 | + | |
6580 | + /* Default to enabling full open WEP with host based encrypt/decrypt */ | |
6581 | + ieee->host_encrypt = 1; | |
6582 | + ieee->host_decrypt = 1; | |
6583 | + ieee->ieee802_1x = 1; /* Default to supporting 802.1x */ | |
6584 | + | |
6585 | + INIT_LIST_HEAD(&ieee->crypt_deinit_list); | |
6586 | + init_timer(&ieee->crypt_deinit_timer); | |
6587 | + ieee->crypt_deinit_timer.data = (unsigned long)ieee; | |
6588 | + ieee->crypt_deinit_timer.function = ieee80211_crypt_deinit_handler; | |
6589 | + | |
6590 | + spin_lock_init(&ieee->lock); | |
6591 | + spin_lock_init(&ieee->wpax_suitlist_lock); | |
6592 | + | |
6593 | + ieee->wpax_type_set = 0; | |
6594 | + ieee->wpa_enabled = 0; | |
6595 | + ieee->tkip_countermeasures = 0; | |
6596 | + ieee->drop_unencrypted = 0; | |
6597 | + ieee->privacy_invoked = 0; | |
6598 | + ieee->ieee802_1x = 1; | |
6599 | + ieee->raw_tx = 0; | |
6600 | + | |
6601 | + ieee80211_softmac_init(ieee); | |
6602 | + | |
6603 | + for (i = 0; i < IEEE_IBSS_MAC_HASH_SIZE; i++) | |
6604 | + INIT_LIST_HEAD(&ieee->ibss_mac_hash[i]); | |
6605 | + | |
6606 | + for (i = 0; i < 17; i++) { | |
6607 | + ieee->last_rxseq_num[i] = -1; | |
6608 | + ieee->last_rxfrag_num[i] = -1; | |
6609 | + ieee->last_packet_time[i] = 0; | |
6610 | + } | |
6611 | +//These function were added to load crypte module autoly | |
6612 | + ieee80211_tkip_null(); | |
6613 | + ieee80211_wep_null(); | |
6614 | + ieee80211_ccmp_null(); | |
6615 | + return dev; | |
6616 | + | |
6617 | + failed: | |
6618 | + if (dev) | |
6619 | + free_netdev(dev); | |
6620 | + return NULL; | |
6621 | +} | |
6622 | + | |
6623 | + | |
6624 | +void free_ieee80211(struct net_device *dev) | |
6625 | +{ | |
6626 | + struct ieee80211_device *ieee = netdev_priv(dev); | |
6627 | + | |
6628 | + int i; | |
6629 | + struct list_head *p, *q; | |
6630 | + | |
6631 | + | |
6632 | + ieee80211_softmac_free(ieee); | |
6633 | + del_timer_sync(&ieee->crypt_deinit_timer); | |
6634 | + ieee80211_crypt_deinit_entries(ieee, 1); | |
6635 | + | |
6636 | + for (i = 0; i < WEP_KEYS; i++) { | |
6637 | + struct ieee80211_crypt_data *crypt = ieee->crypt[i]; | |
6638 | + if (crypt) { | |
6639 | + if (crypt->ops) { | |
6640 | + crypt->ops->deinit(crypt->priv); | |
6641 | + module_put(crypt->ops->owner); | |
6642 | + } | |
6643 | + kfree(crypt); | |
6644 | + ieee->crypt[i] = NULL; | |
6645 | + } | |
6646 | + } | |
6647 | + | |
6648 | + ieee80211_networks_free(ieee); | |
6649 | + | |
6650 | + for (i = 0; i < IEEE_IBSS_MAC_HASH_SIZE; i++) { | |
6651 | + list_for_each_safe(p, q, &ieee->ibss_mac_hash[i]) { | |
6652 | + kfree(list_entry(p, struct ieee_ibss_seq, list)); | |
6653 | + list_del(p); | |
6654 | + } | |
6655 | + } | |
6656 | + | |
6657 | + | |
6658 | + free_netdev(dev); | |
6659 | +} | |
6660 | + | |
6661 | +#ifdef CONFIG_IEEE80211_DEBUG | |
6662 | + | |
6663 | +static int debug = 0; | |
6664 | +u32 ieee80211_debug_level = 0; | |
6665 | +struct proc_dir_entry *ieee80211_proc = NULL; | |
6666 | + | |
6667 | +static int show_debug_level(char *page, char **start, off_t offset, | |
6668 | + int count, int *eof, void *data) | |
6669 | +{ | |
6670 | + return snprintf(page, count, "0x%08X\n", ieee80211_debug_level); | |
6671 | +} | |
6672 | + | |
6673 | +static int store_debug_level(struct file *file, const char *buffer, | |
6674 | + unsigned long count, void *data) | |
6675 | +{ | |
6676 | + char buf[] = "0x00000000"; | |
6677 | + unsigned long len = min(sizeof(buf) - 1, (u32)count); | |
6678 | + char *p = (char *)buf; | |
6679 | + unsigned long val; | |
6680 | + | |
6681 | + if (copy_from_user(buf, buffer, len)) | |
6682 | + return count; | |
6683 | + buf[len] = 0; | |
6684 | + if (p[1] == 'x' || p[1] == 'X' || p[0] == 'x' || p[0] == 'X') { | |
6685 | + p++; | |
6686 | + if (p[0] == 'x' || p[0] == 'X') | |
6687 | + p++; | |
6688 | + val = simple_strtoul(p, &p, 16); | |
6689 | + } else | |
6690 | + val = simple_strtoul(p, &p, 10); | |
6691 | + if (p == buf) | |
6692 | + printk(KERN_INFO DRV_NAME | |
6693 | + ": %s is not in hex or decimal form.\n", buf); | |
6694 | + else | |
6695 | + ieee80211_debug_level = val; | |
6696 | + | |
6697 | + return strnlen(buf, count); | |
6698 | +} | |
6699 | + | |
6700 | +static int __init ieee80211_init(void) | |
6701 | +{ | |
6702 | + struct proc_dir_entry *e; | |
6703 | + | |
6704 | + ieee80211_debug_level = debug; | |
6705 | + ieee80211_proc = create_proc_entry(DRV_NAME, S_IFDIR, proc_net); | |
6706 | + if (ieee80211_proc == NULL) { | |
6707 | + IEEE80211_ERROR("Unable to create " DRV_NAME | |
6708 | + " proc directory\n"); | |
6709 | + return -EIO; | |
6710 | + } | |
6711 | + e = create_proc_entry("debug_level", S_IFREG | S_IRUGO | S_IWUSR, | |
6712 | + ieee80211_proc); | |
6713 | + if (!e) { | |
6714 | + remove_proc_entry(DRV_NAME, proc_net); | |
6715 | + ieee80211_proc = NULL; | |
6716 | + return -EIO; | |
6717 | + } | |
6718 | + e->read_proc = show_debug_level; | |
6719 | + e->write_proc = store_debug_level; | |
6720 | + e->data = NULL; | |
6721 | + | |
6722 | + return 0; | |
6723 | +} | |
6724 | + | |
6725 | +static void __exit ieee80211_exit(void) | |
6726 | +{ | |
6727 | + if (ieee80211_proc) { | |
6728 | + remove_proc_entry("debug_level", ieee80211_proc); | |
6729 | + remove_proc_entry(DRV_NAME, proc_net); | |
6730 | + ieee80211_proc = NULL; | |
6731 | + } | |
6732 | +} | |
6733 | + | |
6734 | +#include <linux/moduleparam.h> | |
6735 | +module_param(debug, int, 0444); | |
6736 | +MODULE_PARM_DESC(debug, "debug output mask"); | |
6737 | + | |
6738 | + | |
6739 | +module_exit(ieee80211_exit); | |
6740 | +module_init(ieee80211_init); | |
6741 | +#endif | |
6742 | + | |
6743 | +#if 0 | |
6744 | +EXPORT_SYMBOL(alloc_ieee80211); | |
6745 | +EXPORT_SYMBOL(free_ieee80211); | |
6746 | +#endif | |
6747 | --- /dev/null | |
6748 | +++ b/drivers/staging/rtl8187se/ieee80211/ieee80211_rx.c | |
6749 | @@ -0,0 +1,1971 @@ | |
6750 | +/* | |
6751 | + * Original code based Host AP (software wireless LAN access point) driver | |
6752 | + * for Intersil Prism2/2.5/3 - hostap.o module, common routines | |
6753 | + * | |
6754 | + * Copyright (c) 2001-2002, SSH Communications Security Corp and Jouni Malinen | |
6755 | + * <jkmaline@cc.hut.fi> | |
6756 | + * Copyright (c) 2002-2003, Jouni Malinen <jkmaline@cc.hut.fi> | |
6757 | + * Copyright (c) 2004, Intel Corporation | |
6758 | + * | |
6759 | + * This program is free software; you can redistribute it and/or modify | |
6760 | + * it under the terms of the GNU General Public License version 2 as | |
6761 | + * published by the Free Software Foundation. See README and COPYING for | |
6762 | + * more details. | |
6763 | + ****************************************************************************** | |
6764 | + | |
6765 | + Few modifications for Realtek's Wi-Fi drivers by | |
6766 | + Andrea Merello <andreamrl@tiscali.it> | |
6767 | + | |
6768 | + A special thanks goes to Realtek for their support ! | |
6769 | + | |
6770 | +******************************************************************************/ | |
6771 | + | |
6772 | + | |
6773 | +#include <linux/compiler.h> | |
6774 | +//#include <linux/config.h> | |
6775 | +#include <linux/errno.h> | |
6776 | +#include <linux/if_arp.h> | |
6777 | +#include <linux/in6.h> | |
6778 | +#include <linux/in.h> | |
6779 | +#include <linux/ip.h> | |
6780 | +#include <linux/kernel.h> | |
6781 | +#include <linux/module.h> | |
6782 | +#include <linux/netdevice.h> | |
6783 | +#include <linux/pci.h> | |
6784 | +#include <linux/proc_fs.h> | |
6785 | +#include <linux/skbuff.h> | |
6786 | +#include <linux/slab.h> | |
6787 | +#include <linux/tcp.h> | |
6788 | +#include <linux/types.h> | |
6789 | +#include <linux/version.h> | |
6790 | +#include <linux/wireless.h> | |
6791 | +#include <linux/etherdevice.h> | |
6792 | +#include <asm/uaccess.h> | |
6793 | +#include <linux/ctype.h> | |
6794 | + | |
6795 | +#include "ieee80211.h" | |
6796 | +#ifdef ENABLE_DOT11D | |
6797 | +#include "dot11d.h" | |
6798 | +#endif | |
6799 | +static inline void ieee80211_monitor_rx(struct ieee80211_device *ieee, | |
6800 | + struct sk_buff *skb, | |
6801 | + struct ieee80211_rx_stats *rx_stats) | |
6802 | +{ | |
6803 | + struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; | |
6804 | + u16 fc = le16_to_cpu(hdr->frame_ctl); | |
6805 | + | |
6806 | + skb->dev = ieee->dev; | |
6807 | +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,22) | |
6808 | + skb_reset_mac_header(skb); | |
6809 | +#else | |
6810 | + skb->mac.raw = skb->data; | |
6811 | +#endif | |
6812 | + skb_pull(skb, ieee80211_get_hdrlen(fc)); | |
6813 | + skb->pkt_type = PACKET_OTHERHOST; | |
6814 | + skb->protocol = __constant_htons(ETH_P_80211_RAW); | |
6815 | + memset(skb->cb, 0, sizeof(skb->cb)); | |
6816 | + netif_rx(skb); | |
6817 | +} | |
6818 | + | |
6819 | + | |
6820 | +/* Called only as a tasklet (software IRQ) */ | |
6821 | +static struct ieee80211_frag_entry * | |
6822 | +ieee80211_frag_cache_find(struct ieee80211_device *ieee, unsigned int seq, | |
6823 | + unsigned int frag, u8 tid,u8 *src, u8 *dst) | |
6824 | +{ | |
6825 | + struct ieee80211_frag_entry *entry; | |
6826 | + int i; | |
6827 | + | |
6828 | + for (i = 0; i < IEEE80211_FRAG_CACHE_LEN; i++) { | |
6829 | + entry = &ieee->frag_cache[tid][i]; | |
6830 | + if (entry->skb != NULL && | |
6831 | + time_after(jiffies, entry->first_frag_time + 2 * HZ)) { | |
6832 | + IEEE80211_DEBUG_FRAG( | |
6833 | + "expiring fragment cache entry " | |
6834 | + "seq=%u last_frag=%u\n", | |
6835 | + entry->seq, entry->last_frag); | |
6836 | + dev_kfree_skb_any(entry->skb); | |
6837 | + entry->skb = NULL; | |
6838 | + } | |
6839 | + | |
6840 | + if (entry->skb != NULL && entry->seq == seq && | |
6841 | + (entry->last_frag + 1 == frag || frag == -1) && | |
6842 | + memcmp(entry->src_addr, src, ETH_ALEN) == 0 && | |
6843 | + memcmp(entry->dst_addr, dst, ETH_ALEN) == 0) | |
6844 | + return entry; | |
6845 | + } | |
6846 | + | |
6847 | + return NULL; | |
6848 | +} | |
6849 | + | |
6850 | +/* Called only as a tasklet (software IRQ) */ | |
6851 | +static struct sk_buff * | |
6852 | +ieee80211_frag_cache_get(struct ieee80211_device *ieee, | |
6853 | + struct ieee80211_hdr *hdr) | |
6854 | +{ | |
6855 | + struct sk_buff *skb = NULL; | |
6856 | + u16 fc = le16_to_cpu(hdr->frame_ctl); | |
6857 | + u16 sc = le16_to_cpu(hdr->seq_ctl); | |
6858 | + unsigned int frag = WLAN_GET_SEQ_FRAG(sc); | |
6859 | + unsigned int seq = WLAN_GET_SEQ_SEQ(sc); | |
6860 | + struct ieee80211_frag_entry *entry; | |
6861 | + struct ieee80211_hdr_3addr_QOS *hdr_3addr_QoS; | |
6862 | + struct ieee80211_hdr_QOS *hdr_4addr_QoS; | |
6863 | + u8 tid; | |
6864 | + | |
6865 | +#ifdef _RTL8187_EXT_PATCH_ | |
6866 | + if(ieee->iw_mode == ieee->iw_ext_mode) | |
6867 | + { | |
6868 | + tid = (hdr->addr2[ETH_ALEN-2] ^ hdr->addr2[ETH_ALEN-1]) & IEEE80211_QOS_TID; | |
6869 | + } | |
6870 | + else | |
6871 | +#endif | |
6872 | + if (((fc & IEEE80211_FCTL_DSTODS) == IEEE80211_FCTL_DSTODS)&&IEEE80211_QOS_HAS_SEQ(fc)) { | |
6873 | + hdr_4addr_QoS = (struct ieee80211_hdr_QOS *)hdr; | |
6874 | + tid = le16_to_cpu(hdr_4addr_QoS->QOS_ctl) & IEEE80211_QOS_TID; | |
6875 | + tid = UP2AC(tid); | |
6876 | + tid ++; | |
6877 | + } else if (IEEE80211_QOS_HAS_SEQ(fc)) { | |
6878 | + hdr_3addr_QoS = (struct ieee80211_hdr_3addr_QOS *)hdr; | |
6879 | + tid = le16_to_cpu(hdr_3addr_QoS->QOS_ctl) & IEEE80211_QOS_TID; | |
6880 | + tid = UP2AC(tid); | |
6881 | + tid ++; | |
6882 | + } else { | |
6883 | + tid = 0; | |
6884 | + } | |
6885 | + | |
6886 | + if (frag == 0) { | |
6887 | + /* Reserve enough space to fit maximum frame length */ | |
6888 | + skb = dev_alloc_skb(ieee->dev->mtu + | |
6889 | + sizeof(struct ieee80211_hdr) + | |
6890 | + 8 /* LLC */ + | |
6891 | + 2 /* alignment */ + | |
6892 | + 8 /* WEP */ + | |
6893 | + ETH_ALEN /* WDS */ + | |
6894 | + (IEEE80211_QOS_HAS_SEQ(fc)?2:0) /* QOS Control */); | |
6895 | + if (skb == NULL) | |
6896 | + return NULL; | |
6897 | + | |
6898 | + entry = &ieee->frag_cache[tid][ieee->frag_next_idx[tid]]; | |
6899 | + ieee->frag_next_idx[tid]++; | |
6900 | + if (ieee->frag_next_idx[tid] >= IEEE80211_FRAG_CACHE_LEN) | |
6901 | + ieee->frag_next_idx[tid] = 0; | |
6902 | + | |
6903 | + if (entry->skb != NULL) | |
6904 | + dev_kfree_skb_any(entry->skb); | |
6905 | + | |
6906 | + entry->first_frag_time = jiffies; | |
6907 | + entry->seq = seq; | |
6908 | + entry->last_frag = frag; | |
6909 | + entry->skb = skb; | |
6910 | + memcpy(entry->src_addr, hdr->addr2, ETH_ALEN); | |
6911 | + memcpy(entry->dst_addr, hdr->addr1, ETH_ALEN); | |
6912 | + } else { | |
6913 | + /* received a fragment of a frame for which the head fragment | |
6914 | + * should have already been received */ | |
6915 | + entry = ieee80211_frag_cache_find(ieee, seq, frag, tid,hdr->addr2, | |
6916 | + hdr->addr1); | |
6917 | + if (entry != NULL) { | |
6918 | + entry->last_frag = frag; | |
6919 | + skb = entry->skb; | |
6920 | + } | |
6921 | + } | |
6922 | + | |
6923 | + return skb; | |
6924 | +} | |
6925 | + | |
6926 | + | |
6927 | +/* Called only as a tasklet (software IRQ) */ | |
6928 | +static int ieee80211_frag_cache_invalidate(struct ieee80211_device *ieee, | |
6929 | + struct ieee80211_hdr *hdr) | |
6930 | +{ | |
6931 | + u16 fc = le16_to_cpu(hdr->frame_ctl); | |
6932 | + u16 sc = le16_to_cpu(hdr->seq_ctl); | |
6933 | + unsigned int seq = WLAN_GET_SEQ_SEQ(sc); | |
6934 | + struct ieee80211_frag_entry *entry; | |
6935 | + struct ieee80211_hdr_3addr_QOS *hdr_3addr_QoS; | |
6936 | + struct ieee80211_hdr_QOS *hdr_4addr_QoS; | |
6937 | + u8 tid; | |
6938 | + | |
6939 | +#ifdef _RTL8187_EXT_PATCH_ | |
6940 | + if(ieee->iw_mode == ieee->iw_ext_mode) | |
6941 | + { | |
6942 | + tid = (hdr->addr2[ETH_ALEN-2] ^ hdr->addr2[ETH_ALEN-1]) & IEEE80211_QOS_TID; | |
6943 | + } | |
6944 | + else | |
6945 | +#endif | |
6946 | + if(((fc & IEEE80211_FCTL_DSTODS) == IEEE80211_FCTL_DSTODS)&&IEEE80211_QOS_HAS_SEQ(fc)) { | |
6947 | + hdr_4addr_QoS = (struct ieee80211_hdr_QOS *)hdr; | |
6948 | + tid = le16_to_cpu(hdr_4addr_QoS->QOS_ctl) & IEEE80211_QOS_TID; | |
6949 | + tid = UP2AC(tid); | |
6950 | + tid ++; | |
6951 | + } else if (IEEE80211_QOS_HAS_SEQ(fc)) { | |
6952 | + hdr_3addr_QoS = (struct ieee80211_hdr_3addr_QOS *)hdr; | |
6953 | + tid = le16_to_cpu(hdr_3addr_QoS->QOS_ctl) & IEEE80211_QOS_TID; | |
6954 | + tid = UP2AC(tid); | |
6955 | + tid ++; | |
6956 | + } else { | |
6957 | + tid = 0; | |
6958 | + } | |
6959 | + | |
6960 | + entry = ieee80211_frag_cache_find(ieee, seq, -1, tid,hdr->addr2, | |
6961 | + hdr->addr1); | |
6962 | + | |
6963 | + if (entry == NULL) { | |
6964 | + IEEE80211_DEBUG_FRAG( | |
6965 | + "could not invalidate fragment cache " | |
6966 | + "entry (seq=%u)\n", seq); | |
6967 | + return -1; | |
6968 | + } | |
6969 | + | |
6970 | + entry->skb = NULL; | |
6971 | + return 0; | |
6972 | +} | |
6973 | + | |
6974 | + | |
6975 | + | |
6976 | +/* ieee80211_rx_frame_mgtmt | |
6977 | + * | |
6978 | + * Responsible for handling management control frames | |
6979 | + * | |
6980 | + * Called by ieee80211_rx */ | |
6981 | +static inline int | |
6982 | +ieee80211_rx_frame_mgmt(struct ieee80211_device *ieee, struct sk_buff *skb, | |
6983 | + struct ieee80211_rx_stats *rx_stats, u16 type, | |
6984 | + u16 stype) | |
6985 | +{ | |
6986 | + struct ieee80211_hdr *hdr; | |
6987 | + | |
6988 | + // cheat the the hdr type | |
6989 | + hdr = (struct ieee80211_hdr *)skb->data; | |
6990 | + | |
6991 | + /* On the struct stats definition there is written that | |
6992 | + * this is not mandatory.... but seems that the probe | |
6993 | + * response parser uses it | |
6994 | + */ | |
6995 | + rx_stats->len = skb->len; | |
6996 | + ieee80211_rx_mgt(ieee,(struct ieee80211_hdr *)skb->data,rx_stats); | |
6997 | + | |
6998 | + if((ieee->state == IEEE80211_LINKED)&&(memcmp(hdr->addr3,ieee->current_network.bssid,ETH_ALEN))) { | |
6999 | + dev_kfree_skb_any(skb); | |
7000 | + return 0; | |
7001 | + } | |
7002 | + | |
7003 | + ieee80211_rx_frame_softmac(ieee, skb, rx_stats, type, stype); | |
7004 | + | |
7005 | + dev_kfree_skb_any(skb); | |
7006 | + | |
7007 | + return 0; | |
7008 | + | |
7009 | + #ifdef NOT_YET | |
7010 | + if (ieee->iw_mode == IW_MODE_MASTER) { | |
7011 | + printk(KERN_DEBUG "%s: Master mode not yet suppported.\n", | |
7012 | + ieee->dev->name); | |
7013 | + return 0; | |
7014 | +/* | |
7015 | + hostap_update_sta_ps(ieee, (struct hostap_ieee80211_hdr *) | |
7016 | + skb->data);*/ | |
7017 | + } | |
7018 | + | |
7019 | + if (ieee->hostapd && type == IEEE80211_TYPE_MGMT) { | |
7020 | + if (stype == WLAN_FC_STYPE_BEACON && | |
7021 | + ieee->iw_mode == IW_MODE_MASTER) { | |
7022 | + struct sk_buff *skb2; | |
7023 | + /* Process beacon frames also in kernel driver to | |
7024 | + * update STA(AP) table statistics */ | |
7025 | + skb2 = skb_clone(skb, GFP_ATOMIC); | |
7026 | + if (skb2) | |
7027 | + hostap_rx(skb2->dev, skb2, rx_stats); | |
7028 | + } | |
7029 | + | |
7030 | + /* send management frames to the user space daemon for | |
7031 | + * processing */ | |
7032 | + ieee->apdevstats.rx_packets++; | |
7033 | + ieee->apdevstats.rx_bytes += skb->len; | |
7034 | + prism2_rx_80211(ieee->apdev, skb, rx_stats, PRISM2_RX_MGMT); | |
7035 | + return 0; | |
7036 | + } | |
7037 | + | |
7038 | + if (ieee->iw_mode == IW_MODE_MASTER) { | |
7039 | + if (type != WLAN_FC_TYPE_MGMT && type != WLAN_FC_TYPE_CTRL) { | |
7040 | + printk(KERN_DEBUG "%s: unknown management frame " | |
7041 | + "(type=0x%02x, stype=0x%02x) dropped\n", | |
7042 | + skb->dev->name, type, stype); | |
7043 | + return -1; | |
7044 | + } | |
7045 | + | |
7046 | + hostap_rx(skb->dev, skb, rx_stats); | |
7047 | + return 0; | |
7048 | + } | |
7049 | + | |
7050 | + printk(KERN_DEBUG "%s: hostap_rx_frame_mgmt: management frame " | |
7051 | + "received in non-Host AP mode\n", skb->dev->name); | |
7052 | + return -1; | |
7053 | + #endif | |
7054 | +} | |
7055 | + | |
7056 | + | |
7057 | + | |
7058 | +/* See IEEE 802.1H for LLC/SNAP encapsulation/decapsulation */ | |
7059 | +/* Ethernet-II snap header (RFC1042 for most EtherTypes) */ | |
7060 | +static unsigned char rfc1042_header[] = | |
7061 | +{ 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00 }; | |
7062 | +/* Bridge-Tunnel header (for EtherTypes ETH_P_AARP and ETH_P_IPX) */ | |
7063 | +static unsigned char bridge_tunnel_header[] = | |
7064 | +{ 0xaa, 0xaa, 0x03, 0x00, 0x00, 0xf8 }; | |
7065 | +/* No encapsulation header if EtherType < 0x600 (=length) */ | |
7066 | + | |
7067 | +/* Called by ieee80211_rx_frame_decrypt */ | |
7068 | +static int ieee80211_is_eapol_frame(struct ieee80211_device *ieee, | |
7069 | + struct sk_buff *skb, size_t hdrlen) | |
7070 | +{ | |
7071 | + struct net_device *dev = ieee->dev; | |
7072 | + u16 fc, ethertype; | |
7073 | + struct ieee80211_hdr *hdr; | |
7074 | + u8 *pos; | |
7075 | + | |
7076 | + if (skb->len < 24) | |
7077 | + return 0; | |
7078 | + | |
7079 | + hdr = (struct ieee80211_hdr *) skb->data; | |
7080 | + fc = le16_to_cpu(hdr->frame_ctl); | |
7081 | + | |
7082 | + /* check that the frame is unicast frame to us */ | |
7083 | + if ((fc & (IEEE80211_FCTL_TODS | IEEE80211_FCTL_FROMDS)) == | |
7084 | + IEEE80211_FCTL_TODS && | |
7085 | + memcmp(hdr->addr1, dev->dev_addr, ETH_ALEN) == 0 && | |
7086 | + memcmp(hdr->addr3, dev->dev_addr, ETH_ALEN) == 0) { | |
7087 | + /* ToDS frame with own addr BSSID and DA */ | |
7088 | + } else if ((fc & (IEEE80211_FCTL_TODS | IEEE80211_FCTL_FROMDS)) == | |
7089 | + IEEE80211_FCTL_FROMDS && | |
7090 | + memcmp(hdr->addr1, dev->dev_addr, ETH_ALEN) == 0) { | |
7091 | + /* FromDS frame with own addr as DA */ | |
7092 | + } else | |
7093 | + return 0; | |
7094 | + | |
7095 | + if (skb->len < 24 + 8) | |
7096 | + return 0; | |
7097 | + | |
7098 | + /* check for port access entity Ethernet type */ | |
7099 | +// pos = skb->data + 24; | |
7100 | + pos = skb->data + hdrlen; | |
7101 | + ethertype = (pos[6] << 8) | pos[7]; | |
7102 | + if (ethertype == ETH_P_PAE) | |
7103 | + return 1; | |
7104 | + | |
7105 | + return 0; | |
7106 | +} | |
7107 | + | |
7108 | +/* Called only as a tasklet (software IRQ), by ieee80211_rx */ | |
7109 | +static inline int | |
7110 | +ieee80211_rx_frame_decrypt(struct ieee80211_device* ieee, struct sk_buff *skb, | |
7111 | + struct ieee80211_crypt_data *crypt) | |
7112 | +{ | |
7113 | + struct ieee80211_hdr *hdr; | |
7114 | + int res, hdrlen; | |
7115 | + | |
7116 | + if (crypt == NULL || crypt->ops->decrypt_mpdu == NULL) | |
7117 | + return 0; | |
7118 | + | |
7119 | + hdr = (struct ieee80211_hdr *) skb->data; | |
7120 | +#ifdef _RTL8187_EXT_PATCH_ | |
7121 | + if((ieee->iw_mode == ieee->iw_ext_mode) && (ieee->ext_patch_ieee80211_rx_frame_get_hdrlen)) | |
7122 | + { | |
7123 | + hdrlen = ieee->ext_patch_ieee80211_rx_frame_get_hdrlen(ieee, skb); | |
7124 | + } | |
7125 | + else | |
7126 | +#endif | |
7127 | + hdrlen = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl)); | |
7128 | + | |
7129 | +#ifdef CONFIG_IEEE80211_CRYPT_TKIP | |
7130 | + if (ieee->tkip_countermeasures && | |
7131 | + strcmp(crypt->ops->name, "TKIP") == 0) { | |
7132 | + if (net_ratelimit()) { | |
7133 | + printk(KERN_DEBUG "%s: TKIP countermeasures: dropped " | |
7134 | + "received packet from " MAC_FMT "\n", | |
7135 | + ieee->dev->name, MAC_ARG(hdr->addr2)); | |
7136 | + } | |
7137 | + return -1; | |
7138 | + } | |
7139 | +#endif | |
7140 | + | |
7141 | + atomic_inc(&crypt->refcnt); | |
7142 | + res = crypt->ops->decrypt_mpdu(skb, hdrlen, crypt->priv); | |
7143 | + atomic_dec(&crypt->refcnt); | |
7144 | + if (res < 0) { | |
7145 | + IEEE80211_DEBUG_DROP( | |
7146 | + "decryption failed (SA=" MAC_FMT | |
7147 | + ") res=%d\n", MAC_ARG(hdr->addr2), res); | |
7148 | + if (res == -2) | |
7149 | + IEEE80211_DEBUG_DROP("Decryption failed ICV " | |
7150 | + "mismatch (key %d)\n", | |
7151 | + skb->data[hdrlen + 3] >> 6); | |
7152 | + ieee->ieee_stats.rx_discards_undecryptable++; | |
7153 | + return -1; | |
7154 | + } | |
7155 | + | |
7156 | + return res; | |
7157 | +} | |
7158 | + | |
7159 | + | |
7160 | +/* Called only as a tasklet (software IRQ), by ieee80211_rx */ | |
7161 | +static inline int | |
7162 | +ieee80211_rx_frame_decrypt_msdu(struct ieee80211_device* ieee, struct sk_buff *skb, | |
7163 | + int keyidx, struct ieee80211_crypt_data *crypt) | |
7164 | +{ | |
7165 | + struct ieee80211_hdr *hdr; | |
7166 | + int res, hdrlen; | |
7167 | + | |
7168 | + if (crypt == NULL || crypt->ops->decrypt_msdu == NULL) | |
7169 | + return 0; | |
7170 | + | |
7171 | + hdr = (struct ieee80211_hdr *) skb->data; | |
7172 | +#ifdef _RTL8187_EXT_PATCH_ | |
7173 | + if((ieee->iw_mode == ieee->iw_ext_mode) && (ieee->ext_patch_ieee80211_rx_frame_get_hdrlen)) | |
7174 | + { | |
7175 | + hdrlen = ieee->ext_patch_ieee80211_rx_frame_get_hdrlen(ieee, skb); | |
7176 | + } | |
7177 | + else | |
7178 | +#endif | |
7179 | + hdrlen = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_ctl)); | |
7180 | + | |
7181 | + atomic_inc(&crypt->refcnt); | |
7182 | + res = crypt->ops->decrypt_msdu(skb, keyidx, hdrlen, crypt->priv); | |
7183 | + atomic_dec(&crypt->refcnt); | |
7184 | + if (res < 0) { | |
7185 | + printk(KERN_DEBUG "%s: MSDU decryption/MIC verification failed" | |
7186 | + " (SA=" MAC_FMT " keyidx=%d)\n", | |
7187 | + ieee->dev->name, MAC_ARG(hdr->addr2), keyidx); | |
7188 | + return -1; | |
7189 | + } | |
7190 | + | |
7191 | + return 0; | |
7192 | +} | |
7193 | + | |
7194 | + | |
7195 | +/* this function is stolen from ipw2200 driver*/ | |
7196 | +#define IEEE_PACKET_RETRY_TIME (5*HZ) | |
7197 | +static int is_duplicate_packet(struct ieee80211_device *ieee, | |
7198 | + struct ieee80211_hdr *header) | |
7199 | +{ | |
7200 | + u16 fc = le16_to_cpu(header->frame_ctl); | |
7201 | + u16 sc = le16_to_cpu(header->seq_ctl); | |
7202 | + u16 seq = WLAN_GET_SEQ_SEQ(sc); | |
7203 | + u16 frag = WLAN_GET_SEQ_FRAG(sc); | |
7204 | + u16 *last_seq, *last_frag; | |
7205 | + unsigned long *last_time; | |
7206 | + struct ieee80211_hdr_3addr_QOS *hdr_3addr_QoS; | |
7207 | + struct ieee80211_hdr_QOS *hdr_4addr_QoS; | |
7208 | + u8 tid; | |
7209 | + | |
7210 | +#ifdef _RTL8187_EXT_PATCH_ | |
7211 | + if(ieee->iw_mode == ieee->iw_ext_mode) | |
7212 | + { | |
7213 | + tid = (header->addr2[ETH_ALEN-2] ^ header->addr2[ETH_ALEN-1]) & IEEE80211_QOS_TID; | |
7214 | + } | |
7215 | + else | |
7216 | +#endif | |
7217 | + //TO2DS and QoS | |
7218 | + if(((fc & IEEE80211_FCTL_DSTODS) == IEEE80211_FCTL_DSTODS)&&IEEE80211_QOS_HAS_SEQ(fc)) { | |
7219 | + hdr_4addr_QoS = (struct ieee80211_hdr_QOS *)header; | |
7220 | + tid = le16_to_cpu(hdr_4addr_QoS->QOS_ctl) & IEEE80211_QOS_TID; | |
7221 | + tid = UP2AC(tid); | |
7222 | + tid ++; | |
7223 | + } else if(IEEE80211_QOS_HAS_SEQ(fc)) { //QoS | |
7224 | + hdr_3addr_QoS = (struct ieee80211_hdr_3addr_QOS*)header; | |
7225 | + tid = le16_to_cpu(hdr_3addr_QoS->QOS_ctl) & IEEE80211_QOS_TID; | |
7226 | + tid = UP2AC(tid); | |
7227 | + tid ++; | |
7228 | + } else { // no QoS | |
7229 | + tid = 0; | |
7230 | + } | |
7231 | + switch (ieee->iw_mode) { | |
7232 | + case IW_MODE_ADHOC: | |
7233 | + { | |
7234 | + struct list_head *p; | |
7235 | + struct ieee_ibss_seq *entry = NULL; | |
7236 | + u8 *mac = header->addr2; | |
7237 | + int index = mac[5] % IEEE_IBSS_MAC_HASH_SIZE; | |
7238 | + //for (pos = (head)->next; pos != (head); pos = pos->next) | |
7239 | + __list_for_each(p, &ieee->ibss_mac_hash[index]) { | |
7240 | + entry = list_entry(p, struct ieee_ibss_seq, list); | |
7241 | + if (!memcmp(entry->mac, mac, ETH_ALEN)) | |
7242 | + break; | |
7243 | + } | |
7244 | + // if (memcmp(entry->mac, mac, ETH_ALEN)){ | |
7245 | + if (p == &ieee->ibss_mac_hash[index]) { | |
7246 | + entry = kmalloc(sizeof(struct ieee_ibss_seq), GFP_ATOMIC); | |
7247 | + if (!entry) { | |
7248 | + printk(KERN_WARNING "Cannot malloc new mac entry\n"); | |
7249 | + return 0; | |
7250 | + } | |
7251 | + memcpy(entry->mac, mac, ETH_ALEN); | |
7252 | + entry->seq_num[tid] = seq; | |
7253 | + entry->frag_num[tid] = frag; | |
7254 | + entry->packet_time[tid] = jiffies; | |
7255 | + list_add(&entry->list, &ieee->ibss_mac_hash[index]); | |
7256 | + return 0; | |
7257 | + } | |
7258 | + last_seq = &entry->seq_num[tid]; | |
7259 | + last_frag = &entry->frag_num[tid]; | |
7260 | + last_time = &entry->packet_time[tid]; | |
7261 | + break; | |
7262 | + } | |
7263 | + | |
7264 | + case IW_MODE_INFRA: | |
7265 | + last_seq = &ieee->last_rxseq_num[tid]; | |
7266 | + last_frag = &ieee->last_rxfrag_num[tid]; | |
7267 | + last_time = &ieee->last_packet_time[tid]; | |
7268 | + | |
7269 | + break; | |
7270 | + default: | |
7271 | +#ifdef _RTL8187_EXT_PATCH_ | |
7272 | + if(ieee->iw_mode == ieee->iw_ext_mode) | |
7273 | + { | |
7274 | + last_seq = &ieee->last_rxseq_num[tid]; | |
7275 | + last_frag = &ieee->last_rxfrag_num[tid]; | |
7276 | + last_time = &ieee->last_packet_time[tid]; | |
7277 | + break; | |
7278 | + } | |
7279 | + else | |
7280 | +#endif | |
7281 | + return 0; | |
7282 | + } | |
7283 | + | |
7284 | +// if(tid != 0) { | |
7285 | +// printk(KERN_WARNING ":)))))))))))%x %x %x, fc(%x)\n", tid, *last_seq, seq, header->frame_ctl); | |
7286 | +// } | |
7287 | + if ((*last_seq == seq) && | |
7288 | + time_after(*last_time + IEEE_PACKET_RETRY_TIME, jiffies)) { | |
7289 | + if (*last_frag == frag){ | |
7290 | + //printk(KERN_WARNING "[1] go drop!\n"); | |
7291 | + goto drop; | |
7292 | + | |
7293 | + } | |
7294 | + if (*last_frag + 1 != frag) | |
7295 | + /* out-of-order fragment */ | |
7296 | + //printk(KERN_WARNING "[2] go drop!\n"); | |
7297 | + goto drop; | |
7298 | + } else | |
7299 | + *last_seq = seq; | |
7300 | + | |
7301 | + *last_frag = frag; | |
7302 | + *last_time = jiffies; | |
7303 | + return 0; | |
7304 | + | |
7305 | +drop: | |
7306 | +// BUG_ON(!(fc & IEEE80211_FCTL_RETRY)); | |
7307 | +// printk("DUP\n"); | |
7308 | + | |
7309 | + return 1; | |
7310 | +} | |
7311 | + | |
7312 | + | |
7313 | +/* All received frames are sent to this function. @skb contains the frame in | |
7314 | + * IEEE 802.11 format, i.e., in the format it was sent over air. | |
7315 | + * This function is called only as a tasklet (software IRQ). */ | |
7316 | +int ieee80211_rx(struct ieee80211_device *ieee, struct sk_buff *skb, | |
7317 | + struct ieee80211_rx_stats *rx_stats) | |
7318 | +{ | |
7319 | + struct net_device *dev = ieee->dev; | |
7320 | + //struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
7321 | + struct ieee80211_hdr *hdr; | |
7322 | + //struct ieee80211_hdr_3addr_QOS *hdr; | |
7323 | + | |
7324 | + size_t hdrlen; | |
7325 | + u16 fc, type, stype, sc; | |
7326 | + struct net_device_stats *stats; | |
7327 | + unsigned int frag; | |
7328 | + u8 *payload; | |
7329 | + u16 ethertype; | |
7330 | +#ifdef NOT_YET | |
7331 | + struct net_device *wds = NULL; | |
7332 | + struct sk_buff *skb2 = NULL; | |
7333 | + struct net_device *wds = NULL; | |
7334 | + int frame_authorized = 0; | |
7335 | + int from_assoc_ap = 0; | |
7336 | + void *sta = NULL; | |
7337 | +#endif | |
7338 | +// u16 QOS_ctl = 0; | |
7339 | + u8 dst[ETH_ALEN]; | |
7340 | + u8 src[ETH_ALEN]; | |
7341 | + u8 bssid[ETH_ALEN]; | |
7342 | + struct ieee80211_crypt_data *crypt = NULL; | |
7343 | + int keyidx = 0; | |
7344 | + | |
7345 | + //Added for mesh by Lawrence. | |
7346 | +#ifdef _RTL8187_EXT_PATCH_ | |
7347 | + u8 status; | |
7348 | + u32 flags; | |
7349 | +#endif | |
7350 | + // cheat the the hdr type | |
7351 | + hdr = (struct ieee80211_hdr *)skb->data; | |
7352 | + stats = &ieee->stats; | |
7353 | + | |
7354 | + if (skb->len < 10) { | |
7355 | + printk(KERN_INFO "%s: SKB length < 10\n", | |
7356 | + dev->name); | |
7357 | + goto rx_dropped; | |
7358 | + } | |
7359 | + | |
7360 | + fc = le16_to_cpu(hdr->frame_ctl); | |
7361 | + type = WLAN_FC_GET_TYPE(fc); | |
7362 | + stype = WLAN_FC_GET_STYPE(fc); | |
7363 | + sc = le16_to_cpu(hdr->seq_ctl); | |
7364 | + | |
7365 | + frag = WLAN_GET_SEQ_FRAG(sc); | |
7366 | + | |
7367 | +//YJ,add,080828,for keep alive | |
7368 | + if((fc & IEEE80211_FCTL_TODS) != IEEE80211_FCTL_TODS) | |
7369 | + { | |
7370 | + if(!memcmp(hdr->addr1,dev->dev_addr, ETH_ALEN)) | |
7371 | + { | |
7372 | + ieee->NumRxUnicast++; | |
7373 | + } | |
7374 | + } | |
7375 | + else | |
7376 | + { | |
7377 | + if(!memcmp(hdr->addr3, dev->dev_addr, ETH_ALEN)) | |
7378 | + { | |
7379 | + ieee->NumRxUnicast++; | |
7380 | + } | |
7381 | + } | |
7382 | +//YJ,add,080828,for keep alive,end | |
7383 | + | |
7384 | +#ifdef _RTL8187_EXT_PATCH_ | |
7385 | + if((ieee->iw_mode == ieee->iw_ext_mode) && (ieee->ext_patch_ieee80211_rx_frame_get_hdrlen)) | |
7386 | + { | |
7387 | + hdrlen = ieee->ext_patch_ieee80211_rx_frame_get_hdrlen(ieee, skb); | |
7388 | + if(skb->len < hdrlen) | |
7389 | + goto rx_dropped; | |
7390 | + } | |
7391 | + else | |
7392 | +#endif | |
7393 | + hdrlen = ieee80211_get_hdrlen(fc); | |
7394 | + | |
7395 | +#ifdef NOT_YET | |
7396 | +#if WIRELESS_EXT > 15 | |
7397 | + /* Put this code here so that we avoid duplicating it in all | |
7398 | + * Rx paths. - Jean II */ | |
7399 | +#ifdef IW_WIRELESS_SPY /* defined in iw_handler.h */ | |
7400 | + /* If spy monitoring on */ | |
7401 | + if (iface->spy_data.spy_number > 0) { | |
7402 | + struct iw_quality wstats; | |
7403 | + wstats.level = rx_stats->signal; | |
7404 | + wstats.noise = rx_stats->noise; | |
7405 | + wstats.updated = 6; /* No qual value */ | |
7406 | + /* Update spy records */ | |
7407 | + wireless_spy_update(dev, hdr->addr2, &wstats); | |
7408 | + } | |
7409 | +#endif /* IW_WIRELESS_SPY */ | |
7410 | +#endif /* WIRELESS_EXT > 15 */ | |
7411 | + hostap_update_rx_stats(local->ap, hdr, rx_stats); | |
7412 | +#endif | |
7413 | + | |
7414 | +#if WIRELESS_EXT > 15 | |
7415 | + if (ieee->iw_mode == IW_MODE_MONITOR) { | |
7416 | + ieee80211_monitor_rx(ieee, skb, rx_stats); | |
7417 | + stats->rx_packets++; | |
7418 | + stats->rx_bytes += skb->len; | |
7419 | + return 1; | |
7420 | + } | |
7421 | +#endif | |
7422 | + if (ieee->host_decrypt) { | |
7423 | + int idx = 0; | |
7424 | + if (skb->len >= hdrlen + 3) | |
7425 | + idx = skb->data[hdrlen + 3] >> 6; | |
7426 | + crypt = ieee->crypt[idx]; | |
7427 | +#ifdef NOT_YET | |
7428 | + sta = NULL; | |
7429 | + | |
7430 | + /* Use station specific key to override default keys if the | |
7431 | + * receiver address is a unicast address ("individual RA"). If | |
7432 | + * bcrx_sta_key parameter is set, station specific key is used | |
7433 | + * even with broad/multicast targets (this is against IEEE | |
7434 | + * 802.11, but makes it easier to use different keys with | |
7435 | + * stations that do not support WEP key mapping). */ | |
7436 | + | |
7437 | + if (!(hdr->addr1[0] & 0x01) || local->bcrx_sta_key) | |
7438 | + (void) hostap_handle_sta_crypto(local, hdr, &crypt, | |
7439 | + &sta); | |
7440 | +#endif | |
7441 | + | |
7442 | + /* allow NULL decrypt to indicate an station specific override | |
7443 | + * for default encryption */ | |
7444 | + if (crypt && (crypt->ops == NULL || | |
7445 | + crypt->ops->decrypt_mpdu == NULL)) | |
7446 | + crypt = NULL; | |
7447 | + | |
7448 | + if (!crypt && (fc & IEEE80211_FCTL_WEP)) { | |
7449 | + /* This seems to be triggered by some (multicast?) | |
7450 | + * frames from other than current BSS, so just drop the | |
7451 | + * frames silently instead of filling system log with | |
7452 | + * these reports. */ | |
7453 | + IEEE80211_DEBUG_DROP("Decryption failed (not set)" | |
7454 | + " (SA=" MAC_FMT ")\n", | |
7455 | + MAC_ARG(hdr->addr2)); | |
7456 | + ieee->ieee_stats.rx_discards_undecryptable++; | |
7457 | + goto rx_dropped; | |
7458 | + } | |
7459 | + } | |
7460 | + | |
7461 | + if (skb->len < IEEE80211_DATA_HDR3_LEN) | |
7462 | + goto rx_dropped; | |
7463 | + | |
7464 | +#ifdef _RTL8187_EXT_PATCH_ | |
7465 | + if( ieee->iw_mode == ieee->iw_ext_mode && ieee->ext_patch_ieee80211_rx_mgt_update_expire ) | |
7466 | + ieee->ext_patch_ieee80211_rx_mgt_update_expire( ieee, skb ); | |
7467 | +#endif | |
7468 | + | |
7469 | + // if QoS enabled, should check the sequence for each of the AC | |
7470 | + if (is_duplicate_packet(ieee, hdr)) | |
7471 | + goto rx_dropped; | |
7472 | + | |
7473 | + | |
7474 | + if (type == IEEE80211_FTYPE_MGMT) { | |
7475 | + | |
7476 | + #if 0 | |
7477 | + if ( stype == IEEE80211_STYPE_AUTH && | |
7478 | + fc & IEEE80211_FCTL_WEP && ieee->host_decrypt && | |
7479 | + (keyidx = hostap_rx_frame_decrypt(ieee, skb, crypt)) < 0) | |
7480 | + { | |
7481 | + printk(KERN_DEBUG "%s: failed to decrypt mgmt::auth " | |
7482 | + "from " MAC_FMT "\n", dev->name, | |
7483 | + MAC_ARG(hdr->addr2)); | |
7484 | + /* TODO: could inform hostapd about this so that it | |
7485 | + * could send auth failure report */ | |
7486 | + goto rx_dropped; | |
7487 | + } | |
7488 | + #endif | |
7489 | + | |
7490 | + | |
7491 | + if (ieee80211_rx_frame_mgmt(ieee, skb, rx_stats, type, stype)) | |
7492 | + goto rx_dropped; | |
7493 | + else | |
7494 | + goto rx_exit; | |
7495 | + } | |
7496 | +#ifdef _RTL8187_EXT_PATCH_ | |
7497 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_rx_on_rx) | |
7498 | + { | |
7499 | + if(ieee->ext_patch_ieee80211_rx_on_rx(ieee, skb, rx_stats, type, stype)==0) | |
7500 | + { | |
7501 | + goto rx_exit; | |
7502 | + } | |
7503 | + } | |
7504 | +#endif | |
7505 | + | |
7506 | + /* Data frame - extract src/dst addresses */ | |
7507 | + switch (fc & (IEEE80211_FCTL_FROMDS | IEEE80211_FCTL_TODS)) { | |
7508 | + case IEEE80211_FCTL_FROMDS: | |
7509 | + memcpy(dst, hdr->addr1, ETH_ALEN); | |
7510 | + memcpy(src, hdr->addr3, ETH_ALEN); | |
7511 | + memcpy(bssid,hdr->addr2,ETH_ALEN); | |
7512 | + break; | |
7513 | + case IEEE80211_FCTL_TODS: | |
7514 | + memcpy(dst, hdr->addr3, ETH_ALEN); | |
7515 | + memcpy(src, hdr->addr2, ETH_ALEN); | |
7516 | + memcpy(bssid,hdr->addr1,ETH_ALEN); | |
7517 | + break; | |
7518 | + case IEEE80211_FCTL_FROMDS | IEEE80211_FCTL_TODS: | |
7519 | + if (skb->len < IEEE80211_DATA_HDR4_LEN) | |
7520 | + goto rx_dropped; | |
7521 | + memcpy(dst, hdr->addr3, ETH_ALEN); | |
7522 | + memcpy(src, hdr->addr4, ETH_ALEN); | |
7523 | + memcpy(bssid, ieee->current_network.bssid, ETH_ALEN); | |
7524 | + break; | |
7525 | + case 0: | |
7526 | + memcpy(dst, hdr->addr1, ETH_ALEN); | |
7527 | + memcpy(src, hdr->addr2, ETH_ALEN); | |
7528 | + memcpy(bssid,hdr->addr3,ETH_ALEN); | |
7529 | + break; | |
7530 | + } | |
7531 | + | |
7532 | +#ifdef NOT_YET | |
7533 | + if (hostap_rx_frame_wds(ieee, hdr, fc, &wds)) | |
7534 | + goto rx_dropped; | |
7535 | + if (wds) { | |
7536 | + skb->dev = dev = wds; | |
7537 | + stats = hostap_get_stats(dev); | |
7538 | + } | |
7539 | + | |
7540 | + if (ieee->iw_mode == IW_MODE_MASTER && !wds && | |
7541 | + (fc & (IEEE80211_FCTL_TODS | IEEE80211_FCTL_FROMDS)) == IEEE80211_FCTL_FROMDS && | |
7542 | + ieee->stadev && | |
7543 | + memcmp(hdr->addr2, ieee->assoc_ap_addr, ETH_ALEN) == 0) { | |
7544 | + /* Frame from BSSID of the AP for which we are a client */ | |
7545 | + skb->dev = dev = ieee->stadev; | |
7546 | + stats = hostap_get_stats(dev); | |
7547 | + from_assoc_ap = 1; | |
7548 | + } | |
7549 | +#endif | |
7550 | + | |
7551 | + dev->last_rx = jiffies; | |
7552 | + | |
7553 | +#ifdef NOT_YET | |
7554 | + if ((ieee->iw_mode == IW_MODE_MASTER || | |
7555 | + ieee->iw_mode == IW_MODE_REPEAT) && | |
7556 | + !from_assoc_ap) { | |
7557 | + switch (hostap_handle_sta_rx(ieee, dev, skb, rx_stats, | |
7558 | + wds != NULL)) { | |
7559 | + case AP_RX_CONTINUE_NOT_AUTHORIZED: | |
7560 | + frame_authorized = 0; | |
7561 | + break; | |
7562 | + case AP_RX_CONTINUE: | |
7563 | + frame_authorized = 1; | |
7564 | + break; | |
7565 | + case AP_RX_DROP: | |
7566 | + goto rx_dropped; | |
7567 | + case AP_RX_EXIT: | |
7568 | + goto rx_exit; | |
7569 | + } | |
7570 | + } | |
7571 | +#endif | |
7572 | + | |
7573 | +#ifdef _RTL8187_EXT_PATCH_ | |
7574 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_rx_is_valid_framectl) | |
7575 | + { | |
7576 | + if(ieee->ext_patch_ieee80211_rx_is_valid_framectl(ieee, fc, type, stype)==0) | |
7577 | + goto rx_dropped; | |
7578 | + } | |
7579 | + else | |
7580 | +#endif | |
7581 | + /* Nullfunc frames may have PS-bit set, so they must be passed to | |
7582 | + * hostap_handle_sta_rx() before being dropped here. */ | |
7583 | + if (stype != IEEE80211_STYPE_DATA && | |
7584 | + stype != IEEE80211_STYPE_DATA_CFACK && | |
7585 | + stype != IEEE80211_STYPE_DATA_CFPOLL && | |
7586 | + stype != IEEE80211_STYPE_DATA_CFACKPOLL&& | |
7587 | + stype != IEEE80211_STYPE_QOS_DATA//add by David,2006.8.4 | |
7588 | + ) { | |
7589 | + if (stype != IEEE80211_STYPE_NULLFUNC) | |
7590 | + IEEE80211_DEBUG_DROP( | |
7591 | + "RX: dropped data frame " | |
7592 | + "with no data (type=0x%02x, " | |
7593 | + "subtype=0x%02x, len=%d)\n", | |
7594 | + type, stype, skb->len); | |
7595 | + goto rx_dropped; | |
7596 | + } | |
7597 | + if(memcmp(bssid,ieee->current_network.bssid,ETH_ALEN)) { | |
7598 | + goto rx_dropped; | |
7599 | + } | |
7600 | + | |
7601 | + ieee->NumRxDataInPeriod++; | |
7602 | + ieee->NumRxOkTotal++; | |
7603 | + /* skb: hdr + (possibly fragmented, possibly encrypted) payload */ | |
7604 | + | |
7605 | + if (ieee->host_decrypt && (fc & IEEE80211_FCTL_WEP) && | |
7606 | + (keyidx = ieee80211_rx_frame_decrypt(ieee, skb, crypt)) < 0) | |
7607 | + goto rx_dropped; | |
7608 | + | |
7609 | + hdr = (struct ieee80211_hdr *) skb->data; | |
7610 | + | |
7611 | + /* skb: hdr + (possibly fragmented) plaintext payload */ | |
7612 | + // PR: FIXME: hostap has additional conditions in the "if" below: | |
7613 | + // ieee->host_decrypt && (fc & IEEE80211_FCTL_WEP) && | |
7614 | + if ((frag != 0 || (fc & IEEE80211_FCTL_MOREFRAGS))) { | |
7615 | + int flen; | |
7616 | + struct sk_buff *frag_skb = ieee80211_frag_cache_get(ieee, hdr); | |
7617 | + IEEE80211_DEBUG_FRAG("Rx Fragment received (%u)\n", frag); | |
7618 | + | |
7619 | + if (!frag_skb) { | |
7620 | + IEEE80211_DEBUG(IEEE80211_DL_RX | IEEE80211_DL_FRAG, | |
7621 | + "Rx cannot get skb from fragment " | |
7622 | + "cache (morefrag=%d seq=%u frag=%u)\n", | |
7623 | + (fc & IEEE80211_FCTL_MOREFRAGS) != 0, | |
7624 | + WLAN_GET_SEQ_SEQ(sc), frag); | |
7625 | + goto rx_dropped; | |
7626 | + } | |
7627 | + flen = skb->len; | |
7628 | + if (frag != 0) | |
7629 | + flen -= hdrlen; | |
7630 | + | |
7631 | + if (frag_skb->tail + flen > frag_skb->end) { | |
7632 | + printk(KERN_WARNING "%s: host decrypted and " | |
7633 | + "reassembled frame did not fit skb\n", | |
7634 | + dev->name); | |
7635 | + ieee80211_frag_cache_invalidate(ieee, hdr); | |
7636 | + goto rx_dropped; | |
7637 | + } | |
7638 | + | |
7639 | + if (frag == 0) { | |
7640 | + /* copy first fragment (including full headers) into | |
7641 | + * beginning of the fragment cache skb */ | |
7642 | + memcpy(skb_put(frag_skb, flen), skb->data, flen); | |
7643 | + } else { | |
7644 | + /* append frame payload to the end of the fragment | |
7645 | + * cache skb */ | |
7646 | + memcpy(skb_put(frag_skb, flen), skb->data + hdrlen, | |
7647 | + flen); | |
7648 | + } | |
7649 | + dev_kfree_skb_any(skb); | |
7650 | + skb = NULL; | |
7651 | + | |
7652 | + if (fc & IEEE80211_FCTL_MOREFRAGS) { | |
7653 | + /* more fragments expected - leave the skb in fragment | |
7654 | + * cache for now; it will be delivered to upper layers | |
7655 | + * after all fragments have been received */ | |
7656 | + goto rx_exit; | |
7657 | + } | |
7658 | + | |
7659 | + /* this was the last fragment and the frame will be | |
7660 | + * delivered, so remove skb from fragment cache */ | |
7661 | + skb = frag_skb; | |
7662 | + hdr = (struct ieee80211_hdr *) skb->data; | |
7663 | + ieee80211_frag_cache_invalidate(ieee, hdr); | |
7664 | + } | |
7665 | + | |
7666 | + /* skb: hdr + (possible reassembled) full MSDU payload; possibly still | |
7667 | + * encrypted/authenticated */ | |
7668 | + if (ieee->host_decrypt && (fc & IEEE80211_FCTL_WEP) && | |
7669 | + ieee80211_rx_frame_decrypt_msdu(ieee, skb, keyidx, crypt)) | |
7670 | + goto rx_dropped; | |
7671 | + | |
7672 | + hdr = (struct ieee80211_hdr *) skb->data; | |
7673 | + if (crypt && !(fc & IEEE80211_FCTL_WEP) && !ieee->open_wep) { | |
7674 | + if (/*ieee->ieee802_1x &&*/ | |
7675 | + ieee80211_is_eapol_frame(ieee, skb, hdrlen)) { | |
7676 | + | |
7677 | +#ifdef CONFIG_IEEE80211_DEBUG | |
7678 | + /* pass unencrypted EAPOL frames even if encryption is | |
7679 | + * configured */ | |
7680 | + struct eapol *eap = (struct eapol *)(skb->data + | |
7681 | + 24); | |
7682 | + IEEE80211_DEBUG_EAP("RX: IEEE 802.1X EAPOL frame: %s\n", | |
7683 | + eap_get_type(eap->type)); | |
7684 | +#endif | |
7685 | + } else { | |
7686 | + IEEE80211_DEBUG_DROP( | |
7687 | + "encryption configured, but RX " | |
7688 | + "frame not encrypted (SA=" MAC_FMT ")\n", | |
7689 | + MAC_ARG(hdr->addr2)); | |
7690 | + goto rx_dropped; | |
7691 | + } | |
7692 | + } | |
7693 | + | |
7694 | +#ifdef CONFIG_IEEE80211_DEBUG | |
7695 | + if (crypt && !(fc & IEEE80211_FCTL_WEP) && | |
7696 | + ieee80211_is_eapol_frame(ieee, skb)) { | |
7697 | + struct eapol *eap = (struct eapol *)(skb->data + | |
7698 | + 24); | |
7699 | + IEEE80211_DEBUG_EAP("RX: IEEE 802.1X EAPOL frame: %s\n", | |
7700 | + eap_get_type(eap->type)); | |
7701 | + } | |
7702 | +#endif | |
7703 | + | |
7704 | + if (crypt && !(fc & IEEE80211_FCTL_WEP) && !ieee->open_wep && | |
7705 | + !ieee80211_is_eapol_frame(ieee, skb, hdrlen)) { | |
7706 | + IEEE80211_DEBUG_DROP( | |
7707 | + "dropped unencrypted RX data " | |
7708 | + "frame from " MAC_FMT | |
7709 | + " (drop_unencrypted=1)\n", | |
7710 | + MAC_ARG(hdr->addr2)); | |
7711 | + goto rx_dropped; | |
7712 | + } | |
7713 | +/* | |
7714 | + if(ieee80211_is_eapol_frame(ieee, skb, hdrlen)) { | |
7715 | + printk(KERN_WARNING "RX: IEEE802.1X EPAOL frame!\n"); | |
7716 | + } | |
7717 | +*/ | |
7718 | + /* skb: hdr + (possible reassembled) full plaintext payload */ | |
7719 | + payload = skb->data + hdrlen; | |
7720 | + ethertype = (payload[6] << 8) | payload[7]; | |
7721 | + | |
7722 | +#ifdef NOT_YET | |
7723 | + /* If IEEE 802.1X is used, check whether the port is authorized to send | |
7724 | + * the received frame. */ | |
7725 | + if (ieee->ieee802_1x && ieee->iw_mode == IW_MODE_MASTER) { | |
7726 | + if (ethertype == ETH_P_PAE) { | |
7727 | + printk(KERN_DEBUG "%s: RX: IEEE 802.1X frame\n", | |
7728 | + dev->name); | |
7729 | + if (ieee->hostapd && ieee->apdev) { | |
7730 | + /* Send IEEE 802.1X frames to the user | |
7731 | + * space daemon for processing */ | |
7732 | + prism2_rx_80211(ieee->apdev, skb, rx_stats, | |
7733 | + PRISM2_RX_MGMT); | |
7734 | + ieee->apdevstats.rx_packets++; | |
7735 | + ieee->apdevstats.rx_bytes += skb->len; | |
7736 | + goto rx_exit; | |
7737 | + } | |
7738 | + } else if (!frame_authorized) { | |
7739 | + printk(KERN_DEBUG "%s: dropped frame from " | |
7740 | + "unauthorized port (IEEE 802.1X): " | |
7741 | + "ethertype=0x%04x\n", | |
7742 | + dev->name, ethertype); | |
7743 | + goto rx_dropped; | |
7744 | + } | |
7745 | + } | |
7746 | +#endif | |
7747 | + | |
7748 | +#ifdef _RTL8187_EXT_PATCH_ | |
7749 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_rx_process_dataframe) | |
7750 | + { | |
7751 | + //Added for mesh rx interrupt. | |
7752 | + //spin_lock_irqsave(&ieee->lock,flags); | |
7753 | + status = ieee->ext_patch_ieee80211_rx_process_dataframe(ieee, skb, rx_stats); | |
7754 | + //spin_unlock_irqrestore(&ieee->lock,flags); | |
7755 | + | |
7756 | + if(status) | |
7757 | +// if(ieee->ext_patch_ieee80211_rx_process_dataframe(ieee, skb, rx_stats)) | |
7758 | + goto rx_exit; | |
7759 | + else | |
7760 | + goto rx_dropped; | |
7761 | + } | |
7762 | +#endif | |
7763 | + | |
7764 | + /* convert hdr + possible LLC headers into Ethernet header */ | |
7765 | + if (skb->len - hdrlen >= 8 && | |
7766 | + ((memcmp(payload, rfc1042_header, SNAP_SIZE) == 0 && | |
7767 | + ethertype != ETH_P_AARP && ethertype != ETH_P_IPX) || | |
7768 | + memcmp(payload, bridge_tunnel_header, SNAP_SIZE) == 0)) { | |
7769 | + /* remove RFC1042 or Bridge-Tunnel encapsulation and | |
7770 | + * replace EtherType */ | |
7771 | + skb_pull(skb, hdrlen + SNAP_SIZE); | |
7772 | + memcpy(skb_push(skb, ETH_ALEN), src, ETH_ALEN); | |
7773 | + memcpy(skb_push(skb, ETH_ALEN), dst, ETH_ALEN); | |
7774 | + } else { | |
7775 | + u16 len; | |
7776 | + /* Leave Ethernet header part of hdr and full payload */ | |
7777 | + skb_pull(skb, hdrlen); | |
7778 | + len = htons(skb->len); | |
7779 | + memcpy(skb_push(skb, 2), &len, 2); | |
7780 | + memcpy(skb_push(skb, ETH_ALEN), src, ETH_ALEN); | |
7781 | + memcpy(skb_push(skb, ETH_ALEN), dst, ETH_ALEN); | |
7782 | + } | |
7783 | + | |
7784 | +#ifdef NOT_YET | |
7785 | + if (wds && ((fc & (IEEE80211_FCTL_TODS | IEEE80211_FCTL_FROMDS)) == | |
7786 | + IEEE80211_FCTL_TODS) && | |
7787 | + skb->len >= ETH_HLEN + ETH_ALEN) { | |
7788 | + /* Non-standard frame: get addr4 from its bogus location after | |
7789 | + * the payload */ | |
7790 | + memcpy(skb->data + ETH_ALEN, | |
7791 | + skb->data + skb->len - ETH_ALEN, ETH_ALEN); | |
7792 | + skb_trim(skb, skb->len - ETH_ALEN); | |
7793 | + } | |
7794 | +#endif | |
7795 | + | |
7796 | + stats->rx_packets++; | |
7797 | + stats->rx_bytes += skb->len; | |
7798 | + | |
7799 | +#ifdef NOT_YET | |
7800 | + if (ieee->iw_mode == IW_MODE_MASTER && !wds && | |
7801 | + ieee->ap->bridge_packets) { | |
7802 | + if (dst[0] & 0x01) { | |
7803 | + /* copy multicast frame both to the higher layers and | |
7804 | + * to the wireless media */ | |
7805 | + ieee->ap->bridged_multicast++; | |
7806 | + skb2 = skb_clone(skb, GFP_ATOMIC); | |
7807 | + if (skb2 == NULL) | |
7808 | + printk(KERN_DEBUG "%s: skb_clone failed for " | |
7809 | + "multicast frame\n", dev->name); | |
7810 | + } else if (hostap_is_sta_assoc(ieee->ap, dst)) { | |
7811 | + /* send frame directly to the associated STA using | |
7812 | + * wireless media and not passing to higher layers */ | |
7813 | + ieee->ap->bridged_unicast++; | |
7814 | + skb2 = skb; | |
7815 | + skb = NULL; | |
7816 | + } | |
7817 | + } | |
7818 | + | |
7819 | + if (skb2 != NULL) { | |
7820 | + /* send to wireless media */ | |
7821 | + skb2->protocol = __constant_htons(ETH_P_802_3); | |
7822 | + skb2->mac.raw = skb2->nh.raw = skb2->data; | |
7823 | + /* skb2->nh.raw = skb2->data + ETH_HLEN; */ | |
7824 | + skb2->dev = dev; | |
7825 | + dev_queue_xmit(skb2); | |
7826 | + } | |
7827 | + | |
7828 | +#endif | |
7829 | + if (skb) { | |
7830 | + skb->protocol = eth_type_trans(skb, dev); | |
7831 | + memset(skb->cb, 0, sizeof(skb->cb)); | |
7832 | + skb->dev = dev; | |
7833 | + skb->ip_summed = CHECKSUM_NONE; /* 802.11 crc not sufficient */ | |
7834 | + ieee->last_rx_ps_time = jiffies; | |
7835 | + netif_rx(skb); | |
7836 | + } | |
7837 | + | |
7838 | + rx_exit: | |
7839 | +#ifdef NOT_YET | |
7840 | + if (sta) | |
7841 | + hostap_handle_sta_release(sta); | |
7842 | +#endif | |
7843 | + return 1; | |
7844 | + | |
7845 | + rx_dropped: | |
7846 | + stats->rx_dropped++; | |
7847 | + | |
7848 | + /* Returning 0 indicates to caller that we have not handled the SKB-- | |
7849 | + * so it is still allocated and can be used again by underlying | |
7850 | + * hardware as a DMA target */ | |
7851 | + return 0; | |
7852 | +} | |
7853 | + | |
7854 | +#ifdef _RTL8187_EXT_PATCH_ | |
7855 | +int ieee_ext_skb_p80211_to_ether(struct sk_buff *skb, int hdrlen, u8 *dst, u8 *src) | |
7856 | +{ | |
7857 | + u8 *payload; | |
7858 | + u16 ethertype; | |
7859 | + | |
7860 | + /* skb: hdr + (possible reassembled) full plaintext payload */ | |
7861 | + payload = skb->data + hdrlen; | |
7862 | + ethertype = (payload[6] << 8) | payload[7]; | |
7863 | + | |
7864 | + /* convert hdr + possible LLC headers into Ethernet header */ | |
7865 | + if (skb->len - hdrlen >= 8 && | |
7866 | + ((memcmp(payload, rfc1042_header, SNAP_SIZE) == 0 && | |
7867 | + ethertype != ETH_P_AARP && ethertype != ETH_P_IPX) || | |
7868 | + memcmp(payload, bridge_tunnel_header, SNAP_SIZE) == 0)) { | |
7869 | + /* remove RFC1042 or Bridge-Tunnel encapsulation and | |
7870 | + * replace EtherType */ | |
7871 | + skb_pull(skb, hdrlen + SNAP_SIZE); | |
7872 | + memcpy(skb_push(skb, ETH_ALEN), src, ETH_ALEN); | |
7873 | + memcpy(skb_push(skb, ETH_ALEN), dst, ETH_ALEN); | |
7874 | + } else { | |
7875 | + u16 len; | |
7876 | + /* Leave Ethernet header part of hdr and full payload */ | |
7877 | + skb_pull(skb, hdrlen); | |
7878 | + len = htons(skb->len); | |
7879 | + memcpy(skb_push(skb, 2), &len, 2); | |
7880 | + memcpy(skb_push(skb, ETH_ALEN), src, ETH_ALEN); | |
7881 | + memcpy(skb_push(skb, ETH_ALEN), dst, ETH_ALEN); | |
7882 | + } | |
7883 | + | |
7884 | + return 1; | |
7885 | +} | |
7886 | +#endif // _RTL8187_EXT_PATCH_ | |
7887 | + | |
7888 | + | |
7889 | +#define MGMT_FRAME_FIXED_PART_LENGTH 0x24 | |
7890 | + | |
7891 | +static inline int ieee80211_is_ofdm_rate(u8 rate) | |
7892 | +{ | |
7893 | + switch (rate & ~IEEE80211_BASIC_RATE_MASK) { | |
7894 | + case IEEE80211_OFDM_RATE_6MB: | |
7895 | + case IEEE80211_OFDM_RATE_9MB: | |
7896 | + case IEEE80211_OFDM_RATE_12MB: | |
7897 | + case IEEE80211_OFDM_RATE_18MB: | |
7898 | + case IEEE80211_OFDM_RATE_24MB: | |
7899 | + case IEEE80211_OFDM_RATE_36MB: | |
7900 | + case IEEE80211_OFDM_RATE_48MB: | |
7901 | + case IEEE80211_OFDM_RATE_54MB: | |
7902 | + return 1; | |
7903 | + } | |
7904 | + return 0; | |
7905 | +} | |
7906 | + | |
7907 | +static inline int ieee80211_SignalStrengthTranslate( | |
7908 | + int CurrSS | |
7909 | + ) | |
7910 | +{ | |
7911 | + int RetSS; | |
7912 | + | |
7913 | + // Step 1. Scale mapping. | |
7914 | + if(CurrSS >= 71 && CurrSS <= 100) | |
7915 | + { | |
7916 | + RetSS = 90 + ((CurrSS - 70) / 3); | |
7917 | + } | |
7918 | + else if(CurrSS >= 41 && CurrSS <= 70) | |
7919 | + { | |
7920 | + RetSS = 78 + ((CurrSS - 40) / 3); | |
7921 | + } | |
7922 | + else if(CurrSS >= 31 && CurrSS <= 40) | |
7923 | + { | |
7924 | + RetSS = 66 + (CurrSS - 30); | |
7925 | + } | |
7926 | + else if(CurrSS >= 21 && CurrSS <= 30) | |
7927 | + { | |
7928 | + RetSS = 54 + (CurrSS - 20); | |
7929 | + } | |
7930 | + else if(CurrSS >= 5 && CurrSS <= 20) | |
7931 | + { | |
7932 | + RetSS = 42 + (((CurrSS - 5) * 2) / 3); | |
7933 | + } | |
7934 | + else if(CurrSS == 4) | |
7935 | + { | |
7936 | + RetSS = 36; | |
7937 | + } | |
7938 | + else if(CurrSS == 3) | |
7939 | + { | |
7940 | + RetSS = 27; | |
7941 | + } | |
7942 | + else if(CurrSS == 2) | |
7943 | + { | |
7944 | + RetSS = 18; | |
7945 | + } | |
7946 | + else if(CurrSS == 1) | |
7947 | + { | |
7948 | + RetSS = 9; | |
7949 | + } | |
7950 | + else | |
7951 | + { | |
7952 | + RetSS = CurrSS; | |
7953 | + } | |
7954 | + //RT_TRACE(COMP_DBG, DBG_LOUD, ("##### After Mapping: LastSS: %d, CurrSS: %d, RetSS: %d\n", LastSS, CurrSS, RetSS)); | |
7955 | + | |
7956 | + // Step 2. Smoothing. | |
7957 | + | |
7958 | + //RT_TRACE(COMP_DBG, DBG_LOUD, ("$$$$$ After Smoothing: LastSS: %d, CurrSS: %d, RetSS: %d\n", LastSS, CurrSS, RetSS)); | |
7959 | + | |
7960 | + return RetSS; | |
7961 | +} | |
7962 | + | |
7963 | +#ifdef ENABLE_DOT11D | |
7964 | +static inline void ieee80211_extract_country_ie( | |
7965 | + struct ieee80211_device *ieee, | |
7966 | + struct ieee80211_info_element *info_element, | |
7967 | + struct ieee80211_network *network, | |
7968 | + u8 * addr2 | |
7969 | +) | |
7970 | +{ | |
7971 | +#if 0 | |
7972 | + u32 i = 0; | |
7973 | + u8 * p = (u8*)info_element->data; | |
7974 | + printk("-----------------------\n"); | |
7975 | + printk("%s Country IE:", network->ssid); | |
7976 | + for(i=0; i<info_element->len; i++) | |
7977 | + printk("\t%2.2x", *(p+i)); | |
7978 | + printk("\n-----------------------\n"); | |
7979 | +#endif | |
7980 | + if(IS_DOT11D_ENABLE(ieee)) | |
7981 | + { | |
7982 | + if(info_element->len!= 0) | |
7983 | + { | |
7984 | + memcpy(network->CountryIeBuf, info_element->data, info_element->len); | |
7985 | + network->CountryIeLen = info_element->len; | |
7986 | + | |
7987 | + if(!IS_COUNTRY_IE_VALID(ieee)) | |
7988 | + { | |
7989 | + Dot11d_UpdateCountryIe(ieee, addr2, info_element->len, info_element->data); | |
7990 | + } | |
7991 | + } | |
7992 | + | |
7993 | + // | |
7994 | + // 070305, rcnjko: I update country IE watch dog here because | |
7995 | + // some AP (e.g. Cisco 1242) don't include country IE in their | |
7996 | + // probe response frame. | |
7997 | + // | |
7998 | + if(IS_EQUAL_CIE_SRC(ieee, addr2) ) | |
7999 | + { | |
8000 | + UPDATE_CIE_WATCHDOG(ieee); | |
8001 | + } | |
8002 | + } | |
8003 | + | |
8004 | +} | |
8005 | +#endif | |
8006 | + | |
8007 | +int | |
8008 | +ieee80211_TranslateToDbm( | |
8009 | + unsigned char SignalStrengthIndex // 0-100 index. | |
8010 | + ) | |
8011 | +{ | |
8012 | + unsigned char SignalPower; // in dBm. | |
8013 | + | |
8014 | + // Translate to dBm (x=0.5y-95). | |
8015 | + SignalPower = (int)SignalStrengthIndex * 7 / 10; | |
8016 | + SignalPower -= 95; | |
8017 | + | |
8018 | + return SignalPower; | |
8019 | +} | |
8020 | +inline int ieee80211_network_init( | |
8021 | + struct ieee80211_device *ieee, | |
8022 | + struct ieee80211_probe_response *beacon, | |
8023 | + struct ieee80211_network *network, | |
8024 | + struct ieee80211_rx_stats *stats) | |
8025 | +{ | |
8026 | +#ifdef CONFIG_IEEE80211_DEBUG | |
8027 | + char rates_str[64]; | |
8028 | + char *p; | |
8029 | +#endif | |
8030 | + struct ieee80211_info_element *info_element; | |
8031 | + u16 left; | |
8032 | + u8 i; | |
8033 | + short offset; | |
8034 | + u8 curRate = 0,hOpRate = 0,curRate_ex = 0; | |
8035 | + | |
8036 | + /* Pull out fixed field data */ | |
8037 | + memcpy(network->bssid, beacon->header.addr3, ETH_ALEN); | |
8038 | + network->capability = beacon->capability; | |
8039 | + network->last_scanned = jiffies; | |
8040 | + network->time_stamp[0] = beacon->time_stamp[0]; | |
8041 | + network->time_stamp[1] = beacon->time_stamp[1]; | |
8042 | + network->beacon_interval = beacon->beacon_interval; | |
8043 | + /* Where to pull this? beacon->listen_interval;*/ | |
8044 | + network->listen_interval = 0x0A; | |
8045 | + network->rates_len = network->rates_ex_len = 0; | |
8046 | + network->last_associate = 0; | |
8047 | + network->ssid_len = 0; | |
8048 | + network->flags = 0; | |
8049 | + network->atim_window = 0; | |
8050 | + network->QoS_Enable = 0; | |
8051 | +//by amy 080312 | |
8052 | + network->HighestOperaRate = 0; | |
8053 | +//by amy 080312 | |
8054 | +#ifdef THOMAS_TURBO | |
8055 | + network->Turbo_Enable = 0; | |
8056 | +#endif | |
8057 | +#ifdef ENABLE_DOT11D | |
8058 | + network->CountryIeLen = 0; | |
8059 | + memset(network->CountryIeBuf, 0, MAX_IE_LEN); | |
8060 | +#endif | |
8061 | + | |
8062 | + if (stats->freq == IEEE80211_52GHZ_BAND) { | |
8063 | + /* for A band (No DS info) */ | |
8064 | + network->channel = stats->received_channel; | |
8065 | + } else | |
8066 | + network->flags |= NETWORK_HAS_CCK; | |
8067 | + | |
8068 | + network->wpa_ie_len = 0; | |
8069 | + network->rsn_ie_len = 0; | |
8070 | + | |
8071 | + info_element = &beacon->info_element; | |
8072 | + left = stats->len - ((void *)info_element - (void *)beacon); | |
8073 | + while (left >= sizeof(struct ieee80211_info_element_hdr)) { | |
8074 | + if (sizeof(struct ieee80211_info_element_hdr) + info_element->len > left) { | |
8075 | + IEEE80211_DEBUG_SCAN("SCAN: parse failed: info_element->len + 2 > left : info_element->len+2=%d left=%d.\n", | |
8076 | + info_element->len + sizeof(struct ieee80211_info_element), | |
8077 | + left); | |
8078 | + return 1; | |
8079 | + } | |
8080 | + | |
8081 | + switch (info_element->id) { | |
8082 | + case MFIE_TYPE_SSID: | |
8083 | + if (ieee80211_is_empty_essid(info_element->data, | |
8084 | + info_element->len)) { | |
8085 | + network->flags |= NETWORK_EMPTY_ESSID; | |
8086 | + break; | |
8087 | + } | |
8088 | + | |
8089 | + network->ssid_len = min(info_element->len, | |
8090 | + (u8)IW_ESSID_MAX_SIZE); | |
8091 | + memcpy(network->ssid, info_element->data, network->ssid_len); | |
8092 | + if (network->ssid_len < IW_ESSID_MAX_SIZE) | |
8093 | + memset(network->ssid + network->ssid_len, 0, | |
8094 | + IW_ESSID_MAX_SIZE - network->ssid_len); | |
8095 | + | |
8096 | + IEEE80211_DEBUG_SCAN("MFIE_TYPE_SSID: '%s' len=%d.\n", | |
8097 | + network->ssid, network->ssid_len); | |
8098 | + break; | |
8099 | + | |
8100 | + case MFIE_TYPE_RATES: | |
8101 | +#ifdef CONFIG_IEEE80211_DEBUG | |
8102 | + p = rates_str; | |
8103 | +#endif | |
8104 | + network->rates_len = min(info_element->len, MAX_RATES_LENGTH); | |
8105 | + for (i = 0; i < network->rates_len; i++) { | |
8106 | + network->rates[i] = info_element->data[i]; | |
8107 | + curRate = network->rates[i] & 0x7f; | |
8108 | + if( hOpRate < curRate ) | |
8109 | + hOpRate = curRate; | |
8110 | +#ifdef CONFIG_IEEE80211_DEBUG | |
8111 | + p += snprintf(p, sizeof(rates_str) - (p - rates_str), "%02X ", network->rates[i]); | |
8112 | +#endif | |
8113 | + if (ieee80211_is_ofdm_rate(info_element->data[i])) { | |
8114 | + network->flags |= NETWORK_HAS_OFDM; | |
8115 | + if (info_element->data[i] & | |
8116 | + IEEE80211_BASIC_RATE_MASK) | |
8117 | + network->flags &= | |
8118 | + ~NETWORK_HAS_CCK; | |
8119 | + } | |
8120 | + } | |
8121 | + | |
8122 | + IEEE80211_DEBUG_SCAN("MFIE_TYPE_RATES: '%s' (%d)\n", | |
8123 | + rates_str, network->rates_len); | |
8124 | + break; | |
8125 | + | |
8126 | + case MFIE_TYPE_RATES_EX: | |
8127 | +#ifdef CONFIG_IEEE80211_DEBUG | |
8128 | + p = rates_str; | |
8129 | +#endif | |
8130 | + network->rates_ex_len = min(info_element->len, MAX_RATES_EX_LENGTH); | |
8131 | + for (i = 0; i < network->rates_ex_len; i++) { | |
8132 | + network->rates_ex[i] = info_element->data[i]; | |
8133 | + curRate_ex = network->rates_ex[i] & 0x7f; | |
8134 | + if( hOpRate < curRate_ex ) | |
8135 | + hOpRate = curRate_ex; | |
8136 | +#ifdef CONFIG_IEEE80211_DEBUG | |
8137 | + p += snprintf(p, sizeof(rates_str) - (p - rates_str), "%02X ", network->rates[i]); | |
8138 | +#endif | |
8139 | + if (ieee80211_is_ofdm_rate(info_element->data[i])) { | |
8140 | + network->flags |= NETWORK_HAS_OFDM; | |
8141 | + if (info_element->data[i] & | |
8142 | + IEEE80211_BASIC_RATE_MASK) | |
8143 | + network->flags &= | |
8144 | + ~NETWORK_HAS_CCK; | |
8145 | + } | |
8146 | + } | |
8147 | + | |
8148 | + IEEE80211_DEBUG_SCAN("MFIE_TYPE_RATES_EX: '%s' (%d)\n", | |
8149 | + rates_str, network->rates_ex_len); | |
8150 | + break; | |
8151 | + | |
8152 | + case MFIE_TYPE_DS_SET: | |
8153 | + IEEE80211_DEBUG_SCAN("MFIE_TYPE_DS_SET: %d\n", | |
8154 | + info_element->data[0]); | |
8155 | + if (stats->freq == IEEE80211_24GHZ_BAND) | |
8156 | + network->channel = info_element->data[0]; | |
8157 | + break; | |
8158 | + | |
8159 | + case MFIE_TYPE_FH_SET: | |
8160 | + IEEE80211_DEBUG_SCAN("MFIE_TYPE_FH_SET: ignored\n"); | |
8161 | + break; | |
8162 | + | |
8163 | + case MFIE_TYPE_CF_SET: | |
8164 | + IEEE80211_DEBUG_SCAN("MFIE_TYPE_CF_SET: ignored\n"); | |
8165 | + break; | |
8166 | + | |
8167 | + case MFIE_TYPE_TIM: | |
8168 | + | |
8169 | + if(info_element->len < 4) | |
8170 | + break; | |
8171 | + | |
8172 | + network->dtim_period = info_element->data[1]; | |
8173 | + | |
8174 | + if(ieee->state != IEEE80211_LINKED) | |
8175 | + break; | |
8176 | +#if 0 | |
8177 | + network->last_dtim_sta_time[0] = stats->mac_time[0]; | |
8178 | +#else | |
8179 | + network->last_dtim_sta_time[0] = jiffies; | |
8180 | +#endif | |
8181 | + network->last_dtim_sta_time[1] = stats->mac_time[1]; | |
8182 | + | |
8183 | + network->dtim_data = IEEE80211_DTIM_VALID; | |
8184 | + | |
8185 | + if(info_element->data[0] != 0) | |
8186 | + break; | |
8187 | + | |
8188 | + if(info_element->data[2] & 1) | |
8189 | + network->dtim_data |= IEEE80211_DTIM_MBCAST; | |
8190 | + | |
8191 | + offset = (info_element->data[2] >> 1)*2; | |
8192 | + | |
8193 | + //printk("offset1:%x aid:%x\n",offset, ieee->assoc_id); | |
8194 | + | |
8195 | + /* add and modified for ps 2008.1.22 */ | |
8196 | + if(ieee->assoc_id < 8*offset || | |
8197 | + ieee->assoc_id > 8*(offset + info_element->len -3)) { | |
8198 | + break; | |
8199 | + } | |
8200 | + | |
8201 | + offset = (ieee->assoc_id/8) - offset;// + ((aid % 8)? 0 : 1) ; | |
8202 | + | |
8203 | + // printk("offset:%x data:%x, ucast:%d\n", offset, | |
8204 | + // info_element->data[3+offset] , | |
8205 | + // info_element->data[3+offset] & (1<<(ieee->assoc_id%8))); | |
8206 | + | |
8207 | + if(info_element->data[3+offset] & (1<<(ieee->assoc_id%8))) { | |
8208 | + network->dtim_data |= IEEE80211_DTIM_UCAST; | |
8209 | + } | |
8210 | + break; | |
8211 | + | |
8212 | + case MFIE_TYPE_IBSS_SET: | |
8213 | + IEEE80211_DEBUG_SCAN("MFIE_TYPE_IBSS_SET: ignored\n"); | |
8214 | + break; | |
8215 | + | |
8216 | + case MFIE_TYPE_CHALLENGE: | |
8217 | + IEEE80211_DEBUG_SCAN("MFIE_TYPE_CHALLENGE: ignored\n"); | |
8218 | + break; | |
8219 | + | |
8220 | + case MFIE_TYPE_GENERIC: | |
8221 | + //nic is 87B | |
8222 | + IEEE80211_DEBUG_SCAN("MFIE_TYPE_GENERIC: %d bytes\n", | |
8223 | + info_element->len); | |
8224 | + if (info_element->len >= 4 && | |
8225 | + info_element->data[0] == 0x00 && | |
8226 | + info_element->data[1] == 0x50 && | |
8227 | + info_element->data[2] == 0xf2 && | |
8228 | + info_element->data[3] == 0x01) { | |
8229 | + network->wpa_ie_len = min(info_element->len + 2, | |
8230 | + MAX_WPA_IE_LEN); | |
8231 | + memcpy(network->wpa_ie, info_element, | |
8232 | + network->wpa_ie_len); | |
8233 | + } | |
8234 | + | |
8235 | +#ifdef THOMAS_TURBO | |
8236 | + if (info_element->len == 7 && | |
8237 | + info_element->data[0] == 0x00 && | |
8238 | + info_element->data[1] == 0xe0 && | |
8239 | + info_element->data[2] == 0x4c && | |
8240 | + info_element->data[3] == 0x01 && | |
8241 | + info_element->data[4] == 0x02) { | |
8242 | + network->Turbo_Enable = 1; | |
8243 | + } | |
8244 | +#endif | |
8245 | + if (1 == stats->nic_type) {//nic 87 | |
8246 | + break; | |
8247 | + } | |
8248 | + | |
8249 | + if (info_element->len >= 5 && | |
8250 | + info_element->data[0] == 0x00 && | |
8251 | + info_element->data[1] == 0x50 && | |
8252 | + info_element->data[2] == 0xf2 && | |
8253 | + info_element->data[3] == 0x02 && | |
8254 | + info_element->data[4] == 0x00) { | |
8255 | + //printk(KERN_WARNING "wmm info updated: %x\n", info_element->data[6]); | |
8256 | + //WMM Information Element | |
8257 | + network->wmm_info = info_element->data[6]; | |
8258 | + network->QoS_Enable = 1; | |
8259 | + } | |
8260 | + | |
8261 | + if (info_element->len >= 8 && | |
8262 | + info_element->data[0] == 0x00 && | |
8263 | + info_element->data[1] == 0x50 && | |
8264 | + info_element->data[2] == 0xf2 && | |
8265 | + info_element->data[3] == 0x02 && | |
8266 | + info_element->data[4] == 0x01) { | |
8267 | + // Not care about version at present. | |
8268 | + //WMM Information Element | |
8269 | + //printk(KERN_WARNING "wmm info¶m updated: %x\n", info_element->data[6]); | |
8270 | + network->wmm_info = info_element->data[6]; | |
8271 | + //WMM Parameter Element | |
8272 | + memcpy(network->wmm_param, (u8 *)(info_element->data + 8),(info_element->len - 8)); | |
8273 | + network->QoS_Enable = 1; | |
8274 | + } | |
8275 | + break; | |
8276 | + | |
8277 | + case MFIE_TYPE_RSN: | |
8278 | + IEEE80211_DEBUG_SCAN("MFIE_TYPE_RSN: %d bytes\n", | |
8279 | + info_element->len); | |
8280 | + network->rsn_ie_len = min(info_element->len + 2, | |
8281 | + MAX_WPA_IE_LEN); | |
8282 | + memcpy(network->rsn_ie, info_element, | |
8283 | + network->rsn_ie_len); | |
8284 | + break; | |
8285 | +#ifdef ENABLE_DOT11D | |
8286 | + case MFIE_TYPE_COUNTRY: | |
8287 | + IEEE80211_DEBUG_SCAN("MFIE_TYPE_COUNTRY: %d bytes\n", | |
8288 | + info_element->len); | |
8289 | +// printk("=====>Receive <%s> Country IE\n",network->ssid); | |
8290 | + ieee80211_extract_country_ie(ieee, info_element, network, beacon->header.addr2); | |
8291 | + break; | |
8292 | +#endif | |
8293 | + default: | |
8294 | + IEEE80211_DEBUG_SCAN("unsupported IE %d\n", | |
8295 | + info_element->id); | |
8296 | + break; | |
8297 | + } | |
8298 | + | |
8299 | + left -= sizeof(struct ieee80211_info_element_hdr) + | |
8300 | + info_element->len; | |
8301 | + info_element = (struct ieee80211_info_element *) | |
8302 | + &info_element->data[info_element->len]; | |
8303 | + } | |
8304 | +//by amy 080312 | |
8305 | + network->HighestOperaRate = hOpRate; | |
8306 | +//by amy 080312 | |
8307 | + network->mode = 0; | |
8308 | + if (stats->freq == IEEE80211_52GHZ_BAND) | |
8309 | + network->mode = IEEE_A; | |
8310 | + else { | |
8311 | + if (network->flags & NETWORK_HAS_OFDM) | |
8312 | + network->mode |= IEEE_G; | |
8313 | + if (network->flags & NETWORK_HAS_CCK) | |
8314 | + network->mode |= IEEE_B; | |
8315 | + } | |
8316 | + | |
8317 | + if (network->mode == 0) { | |
8318 | + IEEE80211_DEBUG_SCAN("Filtered out '%s (" MAC_FMT ")' " | |
8319 | + "network.\n", | |
8320 | + escape_essid(network->ssid, | |
8321 | + network->ssid_len), | |
8322 | + MAC_ARG(network->bssid)); | |
8323 | + return 1; | |
8324 | + } | |
8325 | + | |
8326 | + if (ieee80211_is_empty_essid(network->ssid, network->ssid_len)) | |
8327 | + network->flags |= NETWORK_EMPTY_ESSID; | |
8328 | +#if 0 | |
8329 | + stats->signal = ieee80211_SignalStrengthTranslate(stats->signal); | |
8330 | +#endif | |
8331 | + stats->signal = ieee80211_TranslateToDbm(stats->signalstrength); | |
8332 | + //stats->noise = stats->signal - stats->noise; | |
8333 | + stats->noise = ieee80211_TranslateToDbm(100 - stats->signalstrength) - 25; | |
8334 | + memcpy(&network->stats, stats, sizeof(network->stats)); | |
8335 | + | |
8336 | + return 0; | |
8337 | +} | |
8338 | + | |
8339 | +static inline int is_same_network(struct ieee80211_network *src, | |
8340 | + struct ieee80211_network *dst, | |
8341 | + struct ieee80211_device * ieee) | |
8342 | +{ | |
8343 | + /* A network is only a duplicate if the channel, BSSID, ESSID | |
8344 | + * and the capability field (in particular IBSS and BSS) all match. | |
8345 | + * We treat all <hidden> with the same BSSID and channel | |
8346 | + * as one network */ | |
8347 | + return (((src->ssid_len == dst->ssid_len) || (ieee->iw_mode == IW_MODE_INFRA)) && //YJ,mod,080819,for hidden ap | |
8348 | + //((src->ssid_len == dst->ssid_len) && | |
8349 | + (src->channel == dst->channel) && | |
8350 | + !memcmp(src->bssid, dst->bssid, ETH_ALEN) && | |
8351 | + (!memcmp(src->ssid, dst->ssid, src->ssid_len) || (ieee->iw_mode == IW_MODE_INFRA)) && //YJ,mod,080819,for hidden ap | |
8352 | + //!memcmp(src->ssid, dst->ssid, src->ssid_len) && | |
8353 | + ((src->capability & WLAN_CAPABILITY_IBSS) == | |
8354 | + (dst->capability & WLAN_CAPABILITY_IBSS)) && | |
8355 | + ((src->capability & WLAN_CAPABILITY_BSS) == | |
8356 | + (dst->capability & WLAN_CAPABILITY_BSS))); | |
8357 | +} | |
8358 | + | |
8359 | +inline void update_network(struct ieee80211_network *dst, | |
8360 | + struct ieee80211_network *src) | |
8361 | +{ | |
8362 | + unsigned char quality = src->stats.signalstrength; | |
8363 | + unsigned char signal = 0; | |
8364 | + unsigned char noise = 0; | |
8365 | + if(dst->stats.signalstrength > 0) { | |
8366 | + quality = (dst->stats.signalstrength * 5 + src->stats.signalstrength + 5)/6; | |
8367 | + } | |
8368 | + signal = ieee80211_TranslateToDbm(quality); | |
8369 | + //noise = signal - src->stats.noise; | |
8370 | + if(dst->stats.noise > 0) | |
8371 | + noise = (dst->stats.noise * 5 + src->stats.noise)/6; | |
8372 | + //if(strcmp(dst->ssid, "linksys_lzm000") == 0) | |
8373 | +// printk("ssid:%s, quality:%d, signal:%d\n", dst->ssid, quality, signal); | |
8374 | + memcpy(&dst->stats, &src->stats, sizeof(struct ieee80211_rx_stats)); | |
8375 | + dst->stats.signalstrength = quality; | |
8376 | + dst->stats.signal = signal; | |
8377 | +// printk("==================>stats.signal is %d\n",dst->stats.signal); | |
8378 | + dst->stats.noise = noise; | |
8379 | + | |
8380 | + | |
8381 | + dst->capability = src->capability; | |
8382 | + memcpy(dst->rates, src->rates, src->rates_len); | |
8383 | + dst->rates_len = src->rates_len; | |
8384 | + memcpy(dst->rates_ex, src->rates_ex, src->rates_ex_len); | |
8385 | + dst->rates_ex_len = src->rates_ex_len; | |
8386 | + dst->HighestOperaRate= src->HighestOperaRate; | |
8387 | + //printk("==========>in %s: src->ssid is %s,chan is %d\n",__FUNCTION__,src->ssid,src->channel); | |
8388 | + | |
8389 | + //YJ,add,080819,for hidden ap | |
8390 | + if(src->ssid_len > 0) | |
8391 | + { | |
8392 | + //if(src->ssid_len == 13) | |
8393 | + // printk("=====================>>>>>>>> Dst ssid: %s Src ssid: %s\n", dst->ssid, src->ssid); | |
8394 | + memset(dst->ssid, 0, dst->ssid_len); | |
8395 | + dst->ssid_len = src->ssid_len; | |
8396 | + memcpy(dst->ssid, src->ssid, src->ssid_len); | |
8397 | + } | |
8398 | + //YJ,add,080819,for hidden ap,end | |
8399 | + | |
8400 | + dst->channel = src->channel; | |
8401 | + dst->mode = src->mode; | |
8402 | + dst->flags = src->flags; | |
8403 | + dst->time_stamp[0] = src->time_stamp[0]; | |
8404 | + dst->time_stamp[1] = src->time_stamp[1]; | |
8405 | + | |
8406 | + dst->beacon_interval = src->beacon_interval; | |
8407 | + dst->listen_interval = src->listen_interval; | |
8408 | + dst->atim_window = src->atim_window; | |
8409 | + dst->dtim_period = src->dtim_period; | |
8410 | + dst->dtim_data = src->dtim_data; | |
8411 | + dst->last_dtim_sta_time[0] = src->last_dtim_sta_time[0]; | |
8412 | + dst->last_dtim_sta_time[1] = src->last_dtim_sta_time[1]; | |
8413 | +// printk("update:%s, dtim_period:%x, dtim_data:%x\n", src->ssid, src->dtim_period, src->dtim_data); | |
8414 | + memcpy(dst->wpa_ie, src->wpa_ie, src->wpa_ie_len); | |
8415 | + dst->wpa_ie_len = src->wpa_ie_len; | |
8416 | + memcpy(dst->rsn_ie, src->rsn_ie, src->rsn_ie_len); | |
8417 | + dst->rsn_ie_len = src->rsn_ie_len; | |
8418 | + | |
8419 | + dst->last_scanned = jiffies; | |
8420 | + /* dst->last_associate is not overwritten */ | |
8421 | +// disable QoS process now, added by David 2006/7/25 | |
8422 | +#if 1 | |
8423 | + dst->wmm_info = src->wmm_info; //sure to exist in beacon or probe response frame. | |
8424 | +/* | |
8425 | + if((dst->wmm_info^src->wmm_info)&0x0f) {//Param Set Count change, update Parameter | |
8426 | + memcpy(dst->wmm_param, src->wmm_param, IEEE80211_AC_PRAM_LEN); | |
8427 | + } | |
8428 | +*/ | |
8429 | + if(src->wmm_param[0].ac_aci_acm_aifsn|| \ | |
8430 | + src->wmm_param[1].ac_aci_acm_aifsn|| \ | |
8431 | + src->wmm_param[2].ac_aci_acm_aifsn|| \ | |
8432 | + src->wmm_param[1].ac_aci_acm_aifsn) { | |
8433 | + memcpy(dst->wmm_param, src->wmm_param, WME_AC_PRAM_LEN); | |
8434 | + } | |
8435 | + dst->QoS_Enable = src->QoS_Enable; | |
8436 | +#else | |
8437 | + dst->QoS_Enable = 1;//for Rtl8187 simulation | |
8438 | +#endif | |
8439 | + dst->SignalStrength = src->SignalStrength; | |
8440 | +#ifdef THOMAS_TURBO | |
8441 | + dst->Turbo_Enable = src->Turbo_Enable; | |
8442 | +#endif | |
8443 | +#ifdef ENABLE_DOT11D | |
8444 | + dst->CountryIeLen = src->CountryIeLen; | |
8445 | + memcpy(dst->CountryIeBuf, src->CountryIeBuf, src->CountryIeLen); | |
8446 | +#endif | |
8447 | +} | |
8448 | + | |
8449 | + | |
8450 | +inline void ieee80211_process_probe_response( | |
8451 | + struct ieee80211_device *ieee, | |
8452 | + struct ieee80211_probe_response *beacon, | |
8453 | + struct ieee80211_rx_stats *stats) | |
8454 | +{ | |
8455 | + struct ieee80211_network network; | |
8456 | + struct ieee80211_network *target; | |
8457 | + struct ieee80211_network *oldest = NULL; | |
8458 | +#ifdef CONFIG_IEEE80211_DEBUG | |
8459 | + struct ieee80211_info_element *info_element = &beacon->info_element; | |
8460 | +#endif | |
8461 | + unsigned long flags; | |
8462 | + short renew; | |
8463 | + u8 wmm_info; | |
8464 | + u8 is_beacon = (WLAN_FC_GET_STYPE(beacon->header.frame_ctl) == IEEE80211_STYPE_BEACON)? 1:0; //YJ,add,080819,for hidden ap | |
8465 | + | |
8466 | + memset(&network, 0, sizeof(struct ieee80211_network)); | |
8467 | +//rz | |
8468 | +#ifdef _RTL8187_EXT_PATCH_ | |
8469 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_process_probe_response_1) { | |
8470 | + ieee->ext_patch_ieee80211_process_probe_response_1(ieee, beacon, stats); | |
8471 | + return; | |
8472 | + } | |
8473 | +#endif | |
8474 | + | |
8475 | + IEEE80211_DEBUG_SCAN( | |
8476 | + "'%s' (" MAC_FMT "): %c%c%c%c %c%c%c%c-%c%c%c%c %c%c%c%c\n", | |
8477 | + escape_essid(info_element->data, info_element->len), | |
8478 | + MAC_ARG(beacon->header.addr3), | |
8479 | + (beacon->capability & (1<<0xf)) ? '1' : '0', | |
8480 | + (beacon->capability & (1<<0xe)) ? '1' : '0', | |
8481 | + (beacon->capability & (1<<0xd)) ? '1' : '0', | |
8482 | + (beacon->capability & (1<<0xc)) ? '1' : '0', | |
8483 | + (beacon->capability & (1<<0xb)) ? '1' : '0', | |
8484 | + (beacon->capability & (1<<0xa)) ? '1' : '0', | |
8485 | + (beacon->capability & (1<<0x9)) ? '1' : '0', | |
8486 | + (beacon->capability & (1<<0x8)) ? '1' : '0', | |
8487 | + (beacon->capability & (1<<0x7)) ? '1' : '0', | |
8488 | + (beacon->capability & (1<<0x6)) ? '1' : '0', | |
8489 | + (beacon->capability & (1<<0x5)) ? '1' : '0', | |
8490 | + (beacon->capability & (1<<0x4)) ? '1' : '0', | |
8491 | + (beacon->capability & (1<<0x3)) ? '1' : '0', | |
8492 | + (beacon->capability & (1<<0x2)) ? '1' : '0', | |
8493 | + (beacon->capability & (1<<0x1)) ? '1' : '0', | |
8494 | + (beacon->capability & (1<<0x0)) ? '1' : '0'); | |
8495 | +#if 0 | |
8496 | + if(strcmp(escape_essid(beacon->info_element.data, beacon->info_element.len), "rtl_softap") == 0) | |
8497 | + { | |
8498 | + if(WLAN_FC_GET_STYPE(beacon->header.frame_ctl) == IEEE80211_STYPE_BEACON) | |
8499 | + { | |
8500 | + u32 i = 0, len = stats->len; | |
8501 | + u8 * p = (u8*)beacon; | |
8502 | + printk("-----------------------\n"); | |
8503 | + printk("rtl_softap Beacon:"); | |
8504 | + for(i=0; i<len; i++) | |
8505 | + printk("\t%2.2x", *(p+i)); | |
8506 | + printk("\n-----------------------\n"); | |
8507 | + } | |
8508 | + } | |
8509 | +#endif | |
8510 | + if (ieee80211_network_init(ieee, beacon, &network, stats)) { | |
8511 | + IEEE80211_DEBUG_SCAN("Dropped '%s' (" MAC_FMT ") via %s.\n", | |
8512 | + escape_essid(info_element->data, | |
8513 | + info_element->len), | |
8514 | + MAC_ARG(beacon->header.addr3), | |
8515 | + WLAN_FC_GET_STYPE(beacon->header.frame_ctl) == | |
8516 | + IEEE80211_STYPE_PROBE_RESP ? | |
8517 | + "PROBE RESPONSE" : "BEACON"); | |
8518 | + return; | |
8519 | + } | |
8520 | + | |
8521 | +#ifdef ENABLE_DOT11D | |
8522 | + // For Asus EeePc request, | |
8523 | + // (1) if wireless adapter receive get any 802.11d country code in AP beacon, | |
8524 | + // wireless adapter should follow the country code. | |
8525 | + // (2) If there is no any country code in beacon, | |
8526 | + // then wireless adapter should do active scan from ch1~11 and | |
8527 | + // passive scan from ch12~14 | |
8528 | + if(ieee->bGlobalDomain) | |
8529 | + { | |
8530 | + if (WLAN_FC_GET_STYPE(beacon->header.frame_ctl) == IEEE80211_STYPE_PROBE_RESP) | |
8531 | + { | |
8532 | + // Case 1: Country code | |
8533 | + if(IS_COUNTRY_IE_VALID(ieee) ) | |
8534 | + { | |
8535 | + if( !IsLegalChannel(ieee, network.channel) ) | |
8536 | + { | |
8537 | + printk("GetScanInfo(): For Country code, filter probe response at channel(%d).\n", network.channel); | |
8538 | + return; | |
8539 | + } | |
8540 | + } | |
8541 | + // Case 2: No any country code. | |
8542 | + else | |
8543 | + { | |
8544 | + // Filter over channel ch12~14 | |
8545 | + if(network.channel > 11) | |
8546 | + { | |
8547 | + printk("GetScanInfo(): For Global Domain, filter probe response at channel(%d).\n", network.channel); | |
8548 | + return; | |
8549 | + } | |
8550 | + } | |
8551 | + } | |
8552 | + else | |
8553 | + { | |
8554 | + // Case 1: Country code | |
8555 | + if(IS_COUNTRY_IE_VALID(ieee) ) | |
8556 | + { | |
8557 | + if( !IsLegalChannel(ieee, network.channel) ) | |
8558 | + { | |
8559 | + printk("GetScanInfo(): For Country code, filter beacon at channel(%d).\n",network.channel); | |
8560 | + return; | |
8561 | + } | |
8562 | + } | |
8563 | + // Case 2: No any country code. | |
8564 | + else | |
8565 | + { | |
8566 | + // Filter over channel ch12~14 | |
8567 | + if(network.channel > 14) | |
8568 | + { | |
8569 | + printk("GetScanInfo(): For Global Domain, filter beacon at channel(%d).\n",network.channel); | |
8570 | + return; | |
8571 | + } | |
8572 | + } | |
8573 | + } | |
8574 | + } | |
8575 | +#endif | |
8576 | + /* The network parsed correctly -- so now we scan our known networks | |
8577 | + * to see if we can find it in our list. | |
8578 | + * | |
8579 | + * NOTE: This search is definitely not optimized. Once its doing | |
8580 | + * the "right thing" we'll optimize it for efficiency if | |
8581 | + * necessary */ | |
8582 | + | |
8583 | + /* Search for this entry in the list and update it if it is | |
8584 | + * already there. */ | |
8585 | + | |
8586 | + spin_lock_irqsave(&ieee->lock, flags); | |
8587 | + | |
8588 | + if(is_same_network(&ieee->current_network, &network, ieee)) { | |
8589 | + wmm_info = ieee->current_network.wmm_info; | |
8590 | + //YJ,add,080819,for hidden ap | |
8591 | + if(is_beacon == 0) | |
8592 | + network.flags = (~NETWORK_EMPTY_ESSID & network.flags)|(NETWORK_EMPTY_ESSID & ieee->current_network.flags); | |
8593 | + else if(ieee->state == IEEE80211_LINKED) | |
8594 | + ieee->NumRxBcnInPeriod++; | |
8595 | + //YJ,add,080819,for hidden ap,end | |
8596 | + //printk("====>network.ssid=%s cur_ssid=%s\n", network.ssid, ieee->current_network.ssid); | |
8597 | + update_network(&ieee->current_network, &network); | |
8598 | + } | |
8599 | + | |
8600 | + list_for_each_entry(target, &ieee->network_list, list) { | |
8601 | + if (is_same_network(target, &network, ieee)) | |
8602 | + break; | |
8603 | + if ((oldest == NULL) || | |
8604 | + (target->last_scanned < oldest->last_scanned)) | |
8605 | + oldest = target; | |
8606 | + } | |
8607 | + | |
8608 | + /* If we didn't find a match, then get a new network slot to initialize | |
8609 | + * with this beacon's information */ | |
8610 | + if (&target->list == &ieee->network_list) { | |
8611 | + if (list_empty(&ieee->network_free_list)) { | |
8612 | + /* If there are no more slots, expire the oldest */ | |
8613 | + list_del(&oldest->list); | |
8614 | + target = oldest; | |
8615 | + IEEE80211_DEBUG_SCAN("Expired '%s' (" MAC_FMT ") from " | |
8616 | + "network list.\n", | |
8617 | + escape_essid(target->ssid, | |
8618 | + target->ssid_len), | |
8619 | + MAC_ARG(target->bssid)); | |
8620 | + } else { | |
8621 | + /* Otherwise just pull from the free list */ | |
8622 | + target = list_entry(ieee->network_free_list.next, | |
8623 | + struct ieee80211_network, list); | |
8624 | + list_del(ieee->network_free_list.next); | |
8625 | + } | |
8626 | + | |
8627 | + | |
8628 | +#ifdef CONFIG_IEEE80211_DEBUG | |
8629 | + IEEE80211_DEBUG_SCAN("Adding '%s' (" MAC_FMT ") via %s.\n", | |
8630 | + escape_essid(network.ssid, | |
8631 | + network.ssid_len), | |
8632 | + MAC_ARG(network.bssid), | |
8633 | + WLAN_FC_GET_STYPE(beacon->header.frame_ctl) == | |
8634 | + IEEE80211_STYPE_PROBE_RESP ? | |
8635 | + "PROBE RESPONSE" : "BEACON"); | |
8636 | +#endif | |
8637 | + | |
8638 | +#ifdef _RTL8187_EXT_PATCH_ | |
8639 | + network.ext_entry = target->ext_entry; | |
8640 | +#endif | |
8641 | + memcpy(target, &network, sizeof(*target)); | |
8642 | + list_add_tail(&target->list, &ieee->network_list); | |
8643 | + if(ieee->softmac_features & IEEE_SOFTMAC_ASSOCIATE) | |
8644 | + ieee80211_softmac_new_net(ieee,&network); | |
8645 | + } else { | |
8646 | + IEEE80211_DEBUG_SCAN("Updating '%s' (" MAC_FMT ") via %s.\n", | |
8647 | + escape_essid(target->ssid, | |
8648 | + target->ssid_len), | |
8649 | + MAC_ARG(target->bssid), | |
8650 | + WLAN_FC_GET_STYPE(beacon->header.frame_ctl) == | |
8651 | + IEEE80211_STYPE_PROBE_RESP ? | |
8652 | + "PROBE RESPONSE" : "BEACON"); | |
8653 | + | |
8654 | + /* we have an entry and we are going to update it. But this entry may | |
8655 | + * be already expired. In this case we do the same as we found a new | |
8656 | + * net and call the new_net handler | |
8657 | + */ | |
8658 | + renew = !time_after(target->last_scanned + ieee->scan_age, jiffies); | |
8659 | + //YJ,add,080819,for hidden ap | |
8660 | + if(is_beacon == 0) | |
8661 | + network.flags = (~NETWORK_EMPTY_ESSID & network.flags)|(NETWORK_EMPTY_ESSID & target->flags); | |
8662 | + //if(strncmp(network.ssid, "linksys-c",9) == 0) | |
8663 | + // printk("====>2 network.ssid=%s FLAG=%d target.ssid=%s FLAG=%d\n", network.ssid, network.flags, target->ssid, target->flags); | |
8664 | + if(((network.flags & NETWORK_EMPTY_ESSID) == NETWORK_EMPTY_ESSID) \ | |
8665 | + && (((network.ssid_len > 0) && (strncmp(target->ssid, network.ssid, network.ssid_len)))\ | |
8666 | + ||((ieee->current_network.ssid_len == network.ssid_len)&&(strncmp(ieee->current_network.ssid, network.ssid, network.ssid_len) == 0)&&(ieee->state == IEEE80211_NOLINK)))) | |
8667 | + renew = 1; | |
8668 | + //YJ,add,080819,for hidden ap,end | |
8669 | + update_network(target, &network); | |
8670 | + if(renew && (ieee->softmac_features & IEEE_SOFTMAC_ASSOCIATE)) | |
8671 | + ieee80211_softmac_new_net(ieee,&network); | |
8672 | + } | |
8673 | + | |
8674 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
8675 | +} | |
8676 | + | |
8677 | +void ieee80211_rx_mgt(struct ieee80211_device *ieee, | |
8678 | + struct ieee80211_hdr *header, | |
8679 | + struct ieee80211_rx_stats *stats) | |
8680 | +{ | |
8681 | + switch (WLAN_FC_GET_STYPE(header->frame_ctl)) { | |
8682 | + | |
8683 | + case IEEE80211_STYPE_BEACON: | |
8684 | + IEEE80211_DEBUG_MGMT("received BEACON (%d)\n", | |
8685 | + WLAN_FC_GET_STYPE(header->frame_ctl)); | |
8686 | + IEEE80211_DEBUG_SCAN("Beacon\n"); | |
8687 | + ieee80211_process_probe_response( | |
8688 | + ieee, (struct ieee80211_probe_response *)header, stats); | |
8689 | + break; | |
8690 | + | |
8691 | + case IEEE80211_STYPE_PROBE_RESP: | |
8692 | + IEEE80211_DEBUG_MGMT("received PROBE RESPONSE (%d)\n", | |
8693 | + WLAN_FC_GET_STYPE(header->frame_ctl)); | |
8694 | + IEEE80211_DEBUG_SCAN("Probe response\n"); | |
8695 | + ieee80211_process_probe_response( | |
8696 | + ieee, (struct ieee80211_probe_response *)header, stats); | |
8697 | + break; | |
8698 | +//rz | |
8699 | +#ifdef _RTL8187_EXT_PATCH_ | |
8700 | + case IEEE80211_STYPE_PROBE_REQ: | |
8701 | + IEEE80211_DEBUG_MGMT("received PROBE REQUEST (%d)\n", | |
8702 | + WLAN_FC_GET_STYPE(header->frame_ctl)); | |
8703 | + IEEE80211_DEBUG_SCAN("Probe request\n"); | |
8704 | + /// | |
8705 | + if( ieee->iw_mode == ieee->iw_ext_mode && ieee->ext_patch_ieee80211_rx_mgt_on_probe_req ) | |
8706 | + ieee->ext_patch_ieee80211_rx_mgt_on_probe_req( ieee, (struct ieee80211_probe_request *)header, stats); | |
8707 | + break; | |
8708 | +#endif // _RTL8187_EXT_PATCH_ | |
8709 | + | |
8710 | + } | |
8711 | +} | |
8712 | + | |
8713 | +#if 0 | |
8714 | +EXPORT_SYMBOL(ieee80211_rx_mgt); | |
8715 | +EXPORT_SYMBOL(ieee80211_rx); | |
8716 | +EXPORT_SYMBOL(ieee80211_network_init); | |
8717 | +#ifdef _RTL8187_EXT_PATCH_ | |
8718 | +EXPORT_SYMBOL(ieee_ext_skb_p80211_to_ether); | |
8719 | +#endif | |
8720 | +#endif | |
8721 | --- /dev/null | |
8722 | +++ b/drivers/staging/rtl8187se/ieee80211/ieee80211_softmac.c | |
8723 | @@ -0,0 +1,4029 @@ | |
8724 | +/* IEEE 802.11 SoftMAC layer | |
8725 | + * Copyright (c) 2005 Andrea Merello <andreamrl@tiscali.it> | |
8726 | + * | |
8727 | + * Mostly extracted from the rtl8180-sa2400 driver for the | |
8728 | + * in-kernel generic ieee802.11 stack. | |
8729 | + * | |
8730 | + * Few lines might be stolen from other part of the ieee80211 | |
8731 | + * stack. Copyright who own it's copyright | |
8732 | + * | |
8733 | + * WPA code stolen from the ipw2200 driver. | |
8734 | + * Copyright who own it's copyright. | |
8735 | + * | |
8736 | + * released under the GPL | |
8737 | + */ | |
8738 | + | |
8739 | + | |
8740 | +#include "ieee80211.h" | |
8741 | + | |
8742 | +#include <linux/random.h> | |
8743 | +#include <linux/delay.h> | |
8744 | +#include <linux/version.h> | |
8745 | +#include <asm/uaccess.h> | |
8746 | + | |
8747 | +#ifdef ENABLE_DOT11D | |
8748 | +#include "dot11d.h" | |
8749 | +#endif | |
8750 | +u8 rsn_authen_cipher_suite[16][4] = { | |
8751 | + {0x00,0x0F,0xAC,0x00}, //Use group key, //Reserved | |
8752 | + {0x00,0x0F,0xAC,0x01}, //WEP-40 //RSNA default | |
8753 | + {0x00,0x0F,0xAC,0x02}, //TKIP //NONE //{used just as default} | |
8754 | + {0x00,0x0F,0xAC,0x03}, //WRAP-historical | |
8755 | + {0x00,0x0F,0xAC,0x04}, //CCMP | |
8756 | + {0x00,0x0F,0xAC,0x05}, //WEP-104 | |
8757 | +}; | |
8758 | + | |
8759 | +short ieee80211_is_54g(struct ieee80211_network net) | |
8760 | +{ | |
8761 | + return ((net.rates_ex_len > 0) || (net.rates_len > 4)); | |
8762 | +} | |
8763 | + | |
8764 | +short ieee80211_is_shortslot(struct ieee80211_network net) | |
8765 | +{ | |
8766 | + return (net.capability & WLAN_CAPABILITY_SHORT_SLOT); | |
8767 | +} | |
8768 | + | |
8769 | +/* returns the total length needed for pleacing the RATE MFIE | |
8770 | + * tag and the EXTENDED RATE MFIE tag if needed. | |
8771 | + * It encludes two bytes per tag for the tag itself and its len | |
8772 | + */ | |
8773 | +unsigned int ieee80211_MFIE_rate_len(struct ieee80211_device *ieee) | |
8774 | +{ | |
8775 | + unsigned int rate_len = 0; | |
8776 | + | |
8777 | + if (ieee->modulation & IEEE80211_CCK_MODULATION) | |
8778 | + rate_len = IEEE80211_CCK_RATE_LEN + 2; | |
8779 | + | |
8780 | + if (ieee->modulation & IEEE80211_OFDM_MODULATION) | |
8781 | + | |
8782 | + rate_len += IEEE80211_OFDM_RATE_LEN + 2; | |
8783 | + | |
8784 | + return rate_len; | |
8785 | +} | |
8786 | + | |
8787 | +/* pleace the MFIE rate, tag to the memory (double) poined. | |
8788 | + * Then it updates the pointer so that | |
8789 | + * it points after the new MFIE tag added. | |
8790 | + */ | |
8791 | +void ieee80211_MFIE_Brate(struct ieee80211_device *ieee, u8 **tag_p) | |
8792 | +{ | |
8793 | + u8 *tag = *tag_p; | |
8794 | + | |
8795 | + if (ieee->modulation & IEEE80211_CCK_MODULATION){ | |
8796 | + *tag++ = MFIE_TYPE_RATES; | |
8797 | + *tag++ = 4; | |
8798 | + *tag++ = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_1MB; | |
8799 | + *tag++ = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_2MB; | |
8800 | + *tag++ = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_5MB; | |
8801 | + *tag++ = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_11MB; | |
8802 | + } | |
8803 | + | |
8804 | + /* We may add an option for custom rates that specific HW might support */ | |
8805 | + *tag_p = tag; | |
8806 | +} | |
8807 | + | |
8808 | +void ieee80211_MFIE_Grate(struct ieee80211_device *ieee, u8 **tag_p) | |
8809 | +{ | |
8810 | + u8 *tag = *tag_p; | |
8811 | + | |
8812 | + if (ieee->modulation & IEEE80211_OFDM_MODULATION){ | |
8813 | + | |
8814 | + *tag++ = MFIE_TYPE_RATES_EX; | |
8815 | + *tag++ = 8; | |
8816 | + *tag++ = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_6MB; | |
8817 | + *tag++ = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_9MB; | |
8818 | + *tag++ = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_12MB; | |
8819 | + *tag++ = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_18MB; | |
8820 | + *tag++ = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_24MB; | |
8821 | + *tag++ = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_36MB; | |
8822 | + *tag++ = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_48MB; | |
8823 | + *tag++ = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_54MB; | |
8824 | + | |
8825 | + } | |
8826 | + | |
8827 | + /* We may add an option for custom rates that specific HW might support */ | |
8828 | + *tag_p = tag; | |
8829 | +} | |
8830 | + | |
8831 | + | |
8832 | +void ieee80211_WMM_Info(struct ieee80211_device *ieee, u8 **tag_p) { | |
8833 | + u8 *tag = *tag_p; | |
8834 | + | |
8835 | + *tag++ = MFIE_TYPE_GENERIC; //0 | |
8836 | + *tag++ = 7; | |
8837 | + *tag++ = 0x00; | |
8838 | + *tag++ = 0x50; | |
8839 | + *tag++ = 0xf2; | |
8840 | + *tag++ = 0x02;//5 | |
8841 | + *tag++ = 0x00; | |
8842 | + *tag++ = 0x01; | |
8843 | +#ifdef SUPPORT_USPD | |
8844 | + if(ieee->current_network.wmm_info & 0x80) { | |
8845 | + *tag++ = 0x0f|MAX_SP_Len; | |
8846 | + } else { | |
8847 | + *tag++ = MAX_SP_Len; | |
8848 | + } | |
8849 | +#else | |
8850 | + *tag++ = MAX_SP_Len; | |
8851 | +#endif | |
8852 | + *tag_p = tag; | |
8853 | +} | |
8854 | + | |
8855 | +#ifdef THOMAS_TURBO | |
8856 | +void ieee80211_TURBO_Info(struct ieee80211_device *ieee, u8 **tag_p) { | |
8857 | + u8 *tag = *tag_p; | |
8858 | + | |
8859 | + *tag++ = MFIE_TYPE_GENERIC; //0 | |
8860 | + *tag++ = 7; | |
8861 | + *tag++ = 0x00; | |
8862 | + *tag++ = 0xe0; | |
8863 | + *tag++ = 0x4c; | |
8864 | + *tag++ = 0x01;//5 | |
8865 | + *tag++ = 0x02; | |
8866 | + *tag++ = 0x11; | |
8867 | + *tag++ = 0x00; | |
8868 | + | |
8869 | + *tag_p = tag; | |
8870 | + printk(KERN_ALERT "This is enable turbo mode IE process\n"); | |
8871 | +} | |
8872 | +#endif | |
8873 | + | |
8874 | +void enqueue_mgmt(struct ieee80211_device *ieee, struct sk_buff *skb) | |
8875 | +{ | |
8876 | + int nh; | |
8877 | + nh = (ieee->mgmt_queue_head +1) % MGMT_QUEUE_NUM; | |
8878 | + | |
8879 | +/* | |
8880 | + * if the queue is full but we have newer frames then | |
8881 | + * just overwrites the oldest. | |
8882 | + * | |
8883 | + * if (nh == ieee->mgmt_queue_tail) | |
8884 | + * return -1; | |
8885 | + */ | |
8886 | + ieee->mgmt_queue_head = nh; | |
8887 | + ieee->mgmt_queue_ring[nh] = skb; | |
8888 | + | |
8889 | + //return 0; | |
8890 | +} | |
8891 | + | |
8892 | +struct sk_buff *dequeue_mgmt(struct ieee80211_device *ieee) | |
8893 | +{ | |
8894 | + struct sk_buff *ret; | |
8895 | + | |
8896 | + if(ieee->mgmt_queue_tail == ieee->mgmt_queue_head) | |
8897 | + return NULL; | |
8898 | + | |
8899 | + ret = ieee->mgmt_queue_ring[ieee->mgmt_queue_tail]; | |
8900 | + | |
8901 | + ieee->mgmt_queue_tail = | |
8902 | + (ieee->mgmt_queue_tail+1) % MGMT_QUEUE_NUM; | |
8903 | + | |
8904 | + return ret; | |
8905 | +} | |
8906 | + | |
8907 | +void init_mgmt_queue(struct ieee80211_device *ieee) | |
8908 | +{ | |
8909 | + ieee->mgmt_queue_tail = ieee->mgmt_queue_head = 0; | |
8910 | +} | |
8911 | + | |
8912 | + | |
8913 | +void ieee80211_sta_wakeup(struct ieee80211_device *ieee, short nl); | |
8914 | + | |
8915 | +inline void softmac_mgmt_xmit(struct sk_buff *skb, struct ieee80211_device *ieee) | |
8916 | +{ | |
8917 | + unsigned long flags; | |
8918 | + short single = ieee->softmac_features & IEEE_SOFTMAC_SINGLE_QUEUE; | |
8919 | + struct ieee80211_hdr_3addr *header= | |
8920 | + (struct ieee80211_hdr_3addr *) skb->data; | |
8921 | + | |
8922 | + | |
8923 | + spin_lock_irqsave(&ieee->lock, flags); | |
8924 | + | |
8925 | + /* called with 2nd param 0, no mgmt lock required */ | |
8926 | + ieee80211_sta_wakeup(ieee,0); | |
8927 | + | |
8928 | + if(single){ | |
8929 | + if(ieee->queue_stop){ | |
8930 | + | |
8931 | + enqueue_mgmt(ieee,skb); | |
8932 | + }else{ | |
8933 | + header->seq_ctl = cpu_to_le16(ieee->seq_ctrl[0]<<4); | |
8934 | + | |
8935 | + if (ieee->seq_ctrl[0] == 0xFFF) | |
8936 | + ieee->seq_ctrl[0] = 0; | |
8937 | + else | |
8938 | + ieee->seq_ctrl[0]++; | |
8939 | + | |
8940 | + /* avoid watchdog triggers */ | |
8941 | + ieee->dev->trans_start = jiffies; | |
8942 | + ieee->softmac_data_hard_start_xmit(skb,ieee->dev,ieee->basic_rate); | |
8943 | + } | |
8944 | + | |
8945 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
8946 | + }else{ | |
8947 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
8948 | + spin_lock_irqsave(&ieee->mgmt_tx_lock, flags); | |
8949 | + | |
8950 | + header->seq_ctl = cpu_to_le16(ieee->seq_ctrl[0] << 4); | |
8951 | + | |
8952 | + if (ieee->seq_ctrl[0] == 0xFFF) | |
8953 | + ieee->seq_ctrl[0] = 0; | |
8954 | + else | |
8955 | + ieee->seq_ctrl[0]++; | |
8956 | + | |
8957 | + /* avoid watchdog triggers */ | |
8958 | + ieee->dev->trans_start = jiffies; | |
8959 | + ieee->softmac_hard_start_xmit(skb,ieee->dev); | |
8960 | + | |
8961 | + spin_unlock_irqrestore(&ieee->mgmt_tx_lock, flags); | |
8962 | + } | |
8963 | +} | |
8964 | + | |
8965 | + | |
8966 | +inline void softmac_ps_mgmt_xmit(struct sk_buff *skb, struct ieee80211_device *ieee) | |
8967 | +{ | |
8968 | + | |
8969 | + short single = ieee->softmac_features & IEEE_SOFTMAC_SINGLE_QUEUE; | |
8970 | + struct ieee80211_hdr_3addr *header = | |
8971 | + (struct ieee80211_hdr_3addr *) skb->data; | |
8972 | + | |
8973 | + | |
8974 | + if(single){ | |
8975 | + | |
8976 | + header->seq_ctl = cpu_to_le16(ieee->seq_ctrl[0] << 4); | |
8977 | + | |
8978 | + if (ieee->seq_ctrl[0] == 0xFFF) | |
8979 | + ieee->seq_ctrl[0] = 0; | |
8980 | + else | |
8981 | + ieee->seq_ctrl[0]++; | |
8982 | + | |
8983 | + /* avoid watchdog triggers */ | |
8984 | + ieee->dev->trans_start = jiffies; | |
8985 | + ieee->softmac_data_hard_start_xmit(skb,ieee->dev,ieee->basic_rate); | |
8986 | + | |
8987 | + }else{ | |
8988 | + | |
8989 | + header->seq_ctl = cpu_to_le16(ieee->seq_ctrl[0] << 4); | |
8990 | + | |
8991 | + if (ieee->seq_ctrl[0] == 0xFFF) | |
8992 | + ieee->seq_ctrl[0] = 0; | |
8993 | + else | |
8994 | + ieee->seq_ctrl[0]++; | |
8995 | + | |
8996 | + /* avoid watchdog triggers */ | |
8997 | + ieee->dev->trans_start = jiffies; | |
8998 | + ieee->softmac_hard_start_xmit(skb,ieee->dev); | |
8999 | + | |
9000 | + } | |
9001 | +// dev_kfree_skb_any(skb);//edit by thomas | |
9002 | +} | |
9003 | +//by amy for power save | |
9004 | +inline struct sk_buff *ieee80211_disassociate_skb( | |
9005 | + struct ieee80211_network *beacon, | |
9006 | + struct ieee80211_device *ieee, | |
9007 | + u8 asRsn) | |
9008 | +{ | |
9009 | + struct sk_buff *skb; | |
9010 | + struct ieee80211_disassoc_frame *disass; | |
9011 | + | |
9012 | + skb = dev_alloc_skb(sizeof(struct ieee80211_disassoc_frame)); | |
9013 | + if (!skb) | |
9014 | + return NULL; | |
9015 | + | |
9016 | + disass = (struct ieee80211_disassoc_frame *) skb_put(skb,sizeof(struct ieee80211_disassoc_frame)); | |
9017 | + disass->header.frame_ctl = cpu_to_le16(IEEE80211_STYPE_DISASSOC); | |
9018 | + disass->header.duration_id = 0; | |
9019 | + | |
9020 | + memcpy(disass->header.addr1, beacon->bssid, ETH_ALEN); | |
9021 | + memcpy(disass->header.addr2, ieee->dev->dev_addr, ETH_ALEN); | |
9022 | + memcpy(disass->header.addr3, beacon->bssid, ETH_ALEN); | |
9023 | + | |
9024 | + disass->reasoncode = asRsn; | |
9025 | + return skb; | |
9026 | +} | |
9027 | +void | |
9028 | +SendDisassociation( | |
9029 | + struct ieee80211_device *ieee, | |
9030 | + u8* asSta, | |
9031 | + u8 asRsn | |
9032 | +) | |
9033 | +{ | |
9034 | + struct ieee80211_network *beacon = &ieee->current_network; | |
9035 | + struct sk_buff *skb; | |
9036 | + skb = ieee80211_disassociate_skb(beacon,ieee,asRsn); | |
9037 | + if (skb){ | |
9038 | + softmac_mgmt_xmit(skb, ieee); | |
9039 | + //dev_kfree_skb_any(skb);//edit by thomas | |
9040 | + } | |
9041 | +} | |
9042 | + | |
9043 | +//by amy for power save | |
9044 | +inline struct sk_buff *ieee80211_probe_req(struct ieee80211_device *ieee) | |
9045 | +{ | |
9046 | + unsigned int len,rate_len; | |
9047 | + u8 *tag; | |
9048 | + struct sk_buff *skb; | |
9049 | + struct ieee80211_probe_request *req; | |
9050 | + | |
9051 | +#ifdef _RTL8187_EXT_PATCH_ | |
9052 | + short extMore = 0; | |
9053 | + if(ieee->ext_patch_ieee80211_probe_req_1) | |
9054 | + extMore = ieee->ext_patch_ieee80211_probe_req_1(ieee); | |
9055 | +#endif | |
9056 | + | |
9057 | + len = ieee->current_network.ssid_len; | |
9058 | + | |
9059 | + rate_len = ieee80211_MFIE_rate_len(ieee); | |
9060 | + | |
9061 | +#ifdef _RTL8187_EXT_PATCH_ | |
9062 | + if(!extMore) | |
9063 | +#endif | |
9064 | + skb = dev_alloc_skb(sizeof(struct ieee80211_probe_request) + | |
9065 | + 2 + len + rate_len); | |
9066 | +#ifdef _RTL8187_EXT_PATCH_ | |
9067 | + else | |
9068 | + skb = dev_alloc_skb(sizeof(struct ieee80211_probe_request) + | |
9069 | + 2 + len + rate_len+128); // MESHID + CAP | |
9070 | +#endif | |
9071 | + | |
9072 | + if (!skb) | |
9073 | + return NULL; | |
9074 | + | |
9075 | + req = (struct ieee80211_probe_request *) skb_put(skb,sizeof(struct ieee80211_probe_request)); | |
9076 | + req->header.frame_ctl = cpu_to_le16(IEEE80211_STYPE_PROBE_REQ); | |
9077 | + req->header.duration_id = 0; //FIXME: is this OK ? | |
9078 | + | |
9079 | + memset(req->header.addr1, 0xff, ETH_ALEN); | |
9080 | + memcpy(req->header.addr2, ieee->dev->dev_addr, ETH_ALEN); | |
9081 | + memset(req->header.addr3, 0xff, ETH_ALEN); | |
9082 | + | |
9083 | + tag = (u8 *) skb_put(skb,len+2+rate_len); | |
9084 | + | |
9085 | + *tag++ = MFIE_TYPE_SSID; | |
9086 | + *tag++ = len; | |
9087 | + memcpy(tag, ieee->current_network.ssid, len); | |
9088 | + tag += len; | |
9089 | + ieee80211_MFIE_Brate(ieee,&tag); | |
9090 | + ieee80211_MFIE_Grate(ieee,&tag); | |
9091 | + | |
9092 | +#ifdef _RTL8187_EXT_PATCH_ | |
9093 | + if(extMore) | |
9094 | + ieee->ext_patch_ieee80211_probe_req_2(ieee, skb, tag); | |
9095 | +#endif | |
9096 | + return skb; | |
9097 | +} | |
9098 | + | |
9099 | +struct sk_buff *ieee80211_get_beacon_(struct ieee80211_device *ieee); | |
9100 | + | |
9101 | +//#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20) | |
9102 | +//void ext_ieee80211_send_beacon_wq(struct work_struct *work) | |
9103 | +//{ | |
9104 | +// struct ieee80211_device *ieee = container_of(work, struct ieee80211_device, ext_send_beacon_wq); | |
9105 | +//#else | |
9106 | +void ext_ieee80211_send_beacon_wq(struct ieee80211_device *ieee) | |
9107 | +{ | |
9108 | +//#endif | |
9109 | + | |
9110 | + struct sk_buff *skb; | |
9111 | + | |
9112 | + //unsigned long flags; | |
9113 | + | |
9114 | + skb = ieee80211_get_beacon_(ieee); | |
9115 | + | |
9116 | + if (skb){ | |
9117 | + softmac_mgmt_xmit(skb, ieee); | |
9118 | + ieee->softmac_stats.tx_beacons++; | |
9119 | + dev_kfree_skb_any(skb);//edit by thomas | |
9120 | + } | |
9121 | + | |
9122 | + | |
9123 | + //printk(KERN_WARNING "[1] beacon sending!\n"); | |
9124 | + ieee->beacon_timer.expires = jiffies + | |
9125 | + (MSECS( ieee->current_network.beacon_interval -5)); | |
9126 | + | |
9127 | + //spin_lock_irqsave(&ieee->beacon_lock,flags); | |
9128 | + if(ieee->beacon_txing) | |
9129 | + add_timer(&ieee->beacon_timer); | |
9130 | + //spin_unlock_irqrestore(&ieee->beacon_lock,flags); | |
9131 | +} | |
9132 | + | |
9133 | +void ieee80211_send_beacon(struct ieee80211_device *ieee) | |
9134 | +{ | |
9135 | + struct sk_buff *skb; | |
9136 | + | |
9137 | + //unsigned long flags; | |
9138 | + | |
9139 | + skb = ieee80211_get_beacon_(ieee); | |
9140 | + | |
9141 | + if (skb){ | |
9142 | + softmac_mgmt_xmit(skb, ieee); | |
9143 | + ieee->softmac_stats.tx_beacons++; | |
9144 | + dev_kfree_skb_any(skb);//edit by thomas | |
9145 | + } | |
9146 | + | |
9147 | + //printk(KERN_WARNING "[1] beacon sending!\n"); | |
9148 | + ieee->beacon_timer.expires = jiffies + | |
9149 | + (MSECS( ieee->current_network.beacon_interval -5)); | |
9150 | + | |
9151 | + //spin_lock_irqsave(&ieee->beacon_lock,flags); | |
9152 | + if(ieee->beacon_txing) | |
9153 | + add_timer(&ieee->beacon_timer); | |
9154 | + //spin_unlock_irqrestore(&ieee->beacon_lock,flags); | |
9155 | +} | |
9156 | + | |
9157 | + | |
9158 | +void ieee80211_send_beacon_cb(unsigned long _ieee) | |
9159 | +{ | |
9160 | + struct ieee80211_device *ieee = | |
9161 | + (struct ieee80211_device *) _ieee; | |
9162 | + unsigned long flags; | |
9163 | + | |
9164 | + spin_lock_irqsave(&ieee->beacon_lock, flags); | |
9165 | + ieee80211_send_beacon(ieee); | |
9166 | + spin_unlock_irqrestore(&ieee->beacon_lock, flags); | |
9167 | +} | |
9168 | + | |
9169 | +#ifdef _RTL8187_EXT_PATCH_ | |
9170 | + | |
9171 | +inline struct sk_buff *ieee80211_probe_req_with_SSID(struct ieee80211_device *ieee, char *ssid, int len_ssid) | |
9172 | +{ | |
9173 | + unsigned int len,rate_len; | |
9174 | + u8 *tag; | |
9175 | + struct sk_buff *skb; | |
9176 | + struct ieee80211_probe_request *req; | |
9177 | + | |
9178 | +#ifdef _RTL8187_EXT_PATCH_ | |
9179 | + short extMore = 0; | |
9180 | + if(ieee->ext_patch_ieee80211_probe_req_1) | |
9181 | + extMore = ieee->ext_patch_ieee80211_probe_req_1(ieee); | |
9182 | +#endif | |
9183 | + | |
9184 | + len = len_ssid; | |
9185 | + | |
9186 | + rate_len = ieee80211_MFIE_rate_len(ieee); | |
9187 | + | |
9188 | +#ifdef _RTL8187_EXT_PATCH_ | |
9189 | + if(!extMore) | |
9190 | +#endif | |
9191 | + skb = dev_alloc_skb(sizeof(struct ieee80211_probe_request) + | |
9192 | + 2 + len + rate_len); | |
9193 | +#ifdef _RTL8187_EXT_PATCH_ | |
9194 | + else | |
9195 | + skb = dev_alloc_skb(sizeof(struct ieee80211_probe_request) + | |
9196 | + 2 + len + rate_len+128); // MESHID + CAP | |
9197 | +#endif | |
9198 | + | |
9199 | + if (!skb) | |
9200 | + return NULL; | |
9201 | + | |
9202 | + req = (struct ieee80211_probe_request *) skb_put(skb,sizeof(struct ieee80211_probe_request)); | |
9203 | + req->header.frame_ctl = cpu_to_le16(IEEE80211_STYPE_PROBE_REQ); | |
9204 | + req->header.duration_id = 0; //FIXME: is this OK ? | |
9205 | + | |
9206 | + memset(req->header.addr1, 0xff, ETH_ALEN); | |
9207 | + memcpy(req->header.addr2, ieee->dev->dev_addr, ETH_ALEN); | |
9208 | + memset(req->header.addr3, 0xff, ETH_ALEN); | |
9209 | + | |
9210 | + tag = (u8 *) skb_put(skb,len+2+rate_len); | |
9211 | + | |
9212 | + *tag++ = MFIE_TYPE_SSID; | |
9213 | + *tag++ = len; | |
9214 | + if(len) | |
9215 | + { | |
9216 | + memcpy(tag, ssid, len); | |
9217 | + tag += len; | |
9218 | + } | |
9219 | + | |
9220 | + ieee80211_MFIE_Brate(ieee,&tag); | |
9221 | + ieee80211_MFIE_Grate(ieee,&tag); | |
9222 | + | |
9223 | +#ifdef _RTL8187_EXT_PATCH_ | |
9224 | + if(extMore) | |
9225 | + ieee->ext_patch_ieee80211_probe_req_2(ieee, skb, tag); | |
9226 | +#endif | |
9227 | + return skb; | |
9228 | +} | |
9229 | + | |
9230 | +#endif // _RTL8187_EXT_PATCH_ | |
9231 | + | |
9232 | + | |
9233 | +void ieee80211_send_probe(struct ieee80211_device *ieee) | |
9234 | +{ | |
9235 | + struct sk_buff *skb; | |
9236 | + | |
9237 | +#ifdef _RTL8187_EXT_PATCH_ | |
9238 | + if(ieee->iw_mode == ieee->iw_ext_mode) | |
9239 | + skb = ieee80211_probe_req_with_SSID(ieee, NULL, 0); | |
9240 | + else | |
9241 | +#endif | |
9242 | + skb = ieee80211_probe_req(ieee); | |
9243 | + if (skb){ | |
9244 | + softmac_mgmt_xmit(skb, ieee); | |
9245 | + ieee->softmac_stats.tx_probe_rq++; | |
9246 | + //dev_kfree_skb_any(skb);//edit by thomas | |
9247 | + } | |
9248 | +} | |
9249 | + | |
9250 | +void ieee80211_send_probe_requests(struct ieee80211_device *ieee) | |
9251 | +{ | |
9252 | + if (ieee->active_scan && (ieee->softmac_features & IEEE_SOFTMAC_PROBERQ)){ | |
9253 | + ieee80211_send_probe(ieee); | |
9254 | + ieee80211_send_probe(ieee); | |
9255 | + } | |
9256 | +} | |
9257 | + | |
9258 | +/* this performs syncro scan blocking the caller until all channels | |
9259 | + * in the allowed channel map has been checked. | |
9260 | + */ | |
9261 | +void ieee80211_softmac_scan_syncro(struct ieee80211_device *ieee) | |
9262 | +{ | |
9263 | + short ch = 0; | |
9264 | +#ifdef ENABLE_DOT11D | |
9265 | + u8 channel_map[MAX_CHANNEL_NUMBER+1]; | |
9266 | + memcpy(channel_map, GET_DOT11D_INFO(ieee)->channel_map, MAX_CHANNEL_NUMBER+1); | |
9267 | +#endif | |
9268 | + down(&ieee->scan_sem); | |
9269 | +// printk("==================> Sync scan\n"); | |
9270 | +// dump_chnl_map(channel_map); | |
9271 | + | |
9272 | + while(1) | |
9273 | + { | |
9274 | + | |
9275 | + do{ | |
9276 | + ch++; | |
9277 | + if (ch > MAX_CHANNEL_NUMBER) | |
9278 | + goto out; /* scan completed */ | |
9279 | + | |
9280 | +#ifdef ENABLE_DOT11D | |
9281 | + }while(!channel_map[ch]); | |
9282 | +#else | |
9283 | + }while(!ieee->channel_map[ch]); | |
9284 | +#endif | |
9285 | + /* this fuction can be called in two situations | |
9286 | + * 1- We have switched to ad-hoc mode and we are | |
9287 | + * performing a complete syncro scan before conclude | |
9288 | + * there are no interesting cell and to create a | |
9289 | + * new one. In this case the link state is | |
9290 | + * IEEE80211_NOLINK until we found an interesting cell. | |
9291 | + * If so the ieee8021_new_net, called by the RX path | |
9292 | + * will set the state to IEEE80211_LINKED, so we stop | |
9293 | + * scanning | |
9294 | + * 2- We are linked and the root uses run iwlist scan. | |
9295 | + * So we switch to IEEE80211_LINKED_SCANNING to remember | |
9296 | + * that we are still logically linked (not interested in | |
9297 | + * new network events, despite for updating the net list, | |
9298 | + * but we are temporarly 'unlinked' as the driver shall | |
9299 | + * not filter RX frames and the channel is changing. | |
9300 | + * So the only situation in witch are interested is to check | |
9301 | + * if the state become LINKED because of the #1 situation | |
9302 | + */ | |
9303 | + | |
9304 | + if (ieee->state == IEEE80211_LINKED) | |
9305 | + goto out; | |
9306 | + | |
9307 | + ieee->set_chan(ieee->dev, ch); | |
9308 | +// printk("=====>channel=%d ",ch); | |
9309 | +#ifdef ENABLE_DOT11D | |
9310 | + if(channel_map[ch] == 1) | |
9311 | +#endif | |
9312 | + { | |
9313 | +// printk("====send probe request\n"); | |
9314 | + ieee80211_send_probe_requests(ieee); | |
9315 | + } | |
9316 | + /* this prevent excessive time wait when we | |
9317 | + * need to wait for a syncro scan to end.. | |
9318 | + */ | |
9319 | + if (ieee->sync_scan_hurryup) | |
9320 | + goto out; | |
9321 | + | |
9322 | + | |
9323 | + msleep_interruptible_rtl(IEEE80211_SOFTMAC_SCAN_TIME); | |
9324 | + | |
9325 | + } | |
9326 | +out: | |
9327 | + ieee->sync_scan_hurryup = 0; | |
9328 | + up(&ieee->scan_sem); | |
9329 | +#ifdef ENABLE_DOT11D | |
9330 | + if(IS_DOT11D_ENABLE(ieee)) | |
9331 | + DOT11D_ScanComplete(ieee); | |
9332 | +#endif | |
9333 | +} | |
9334 | + | |
9335 | +void ieee80211_softmac_ips_scan_syncro(struct ieee80211_device *ieee) | |
9336 | +{ | |
9337 | + int ch; | |
9338 | + unsigned int watch_dog = 0; | |
9339 | +#ifdef ENABLE_DOT11D | |
9340 | + u8 channel_map[MAX_CHANNEL_NUMBER+1]; | |
9341 | + memcpy(channel_map, GET_DOT11D_INFO(ieee)->channel_map, MAX_CHANNEL_NUMBER+1); | |
9342 | +#endif | |
9343 | + down(&ieee->scan_sem); | |
9344 | + ch = ieee->current_network.channel; | |
9345 | +// if(ieee->sync_scan_hurryup) | |
9346 | +// { | |
9347 | + | |
9348 | +// printk("stop scan sync\n"); | |
9349 | +// goto out; | |
9350 | +// } | |
9351 | +// printk("=======hh===============>ips scan\n"); | |
9352 | + while(1) | |
9353 | + { | |
9354 | + /* this fuction can be called in two situations | |
9355 | + * 1- We have switched to ad-hoc mode and we are | |
9356 | + * performing a complete syncro scan before conclude | |
9357 | + * there are no interesting cell and to create a | |
9358 | + * new one. In this case the link state is | |
9359 | + * IEEE80211_NOLINK until we found an interesting cell. | |
9360 | + * If so the ieee8021_new_net, called by the RX path | |
9361 | + * will set the state to IEEE80211_LINKED, so we stop | |
9362 | + * scanning | |
9363 | + * 2- We are linked and the root uses run iwlist scan. | |
9364 | + * So we switch to IEEE80211_LINKED_SCANNING to remember | |
9365 | + * that we are still logically linked (not interested in | |
9366 | + * new network events, despite for updating the net list, | |
9367 | + * but we are temporarly 'unlinked' as the driver shall | |
9368 | + * not filter RX frames and the channel is changing. | |
9369 | + * So the only situation in witch are interested is to check | |
9370 | + * if the state become LINKED because of the #1 situation | |
9371 | + */ | |
9372 | + if (ieee->state == IEEE80211_LINKED) | |
9373 | + { | |
9374 | + goto out; | |
9375 | + } | |
9376 | +#ifdef ENABLE_DOT11D | |
9377 | + if(channel_map[ieee->current_network.channel] > 0) | |
9378 | +#endif | |
9379 | + { | |
9380 | + ieee->set_chan(ieee->dev, ieee->current_network.channel); | |
9381 | +// printk("======>channel=%d ",ieee->current_network.channel); | |
9382 | + } | |
9383 | +#ifdef ENABLE_DOT11D | |
9384 | + if(channel_map[ieee->current_network.channel] == 1) | |
9385 | +#endif | |
9386 | + { | |
9387 | +// printk("====send probe request\n"); | |
9388 | + ieee80211_send_probe_requests(ieee); | |
9389 | + } | |
9390 | + /* this prevent excessive time wait when we | |
9391 | + * need to wait for a syncro scan to end.. | |
9392 | + */ | |
9393 | +// if (ieee->sync_scan_hurryup) | |
9394 | +// goto out; | |
9395 | + | |
9396 | + msleep_interruptible_rtl(IEEE80211_SOFTMAC_SCAN_TIME); | |
9397 | + | |
9398 | + do{ | |
9399 | + if (watch_dog++ >= MAX_CHANNEL_NUMBER) | |
9400 | + // if (++watch_dog >= 15);//MAX_CHANNEL_NUMBER) //YJ,modified,080630 | |
9401 | + goto out; /* scan completed */ | |
9402 | + | |
9403 | + ieee->current_network.channel = (ieee->current_network.channel + 1)%MAX_CHANNEL_NUMBER; | |
9404 | +#ifdef ENABLE_DOT11D | |
9405 | + }while(!channel_map[ieee->current_network.channel]); | |
9406 | +#else | |
9407 | + }while(!ieee->channel_map[ieee->current_network.channel]); | |
9408 | +#endif | |
9409 | + } | |
9410 | +out: | |
9411 | + //ieee->sync_scan_hurryup = 0; | |
9412 | + //ieee->set_chan(ieee->dev, ch); | |
9413 | + //ieee->current_network.channel = ch; | |
9414 | + ieee->actscanning = false; | |
9415 | + up(&ieee->scan_sem); | |
9416 | +#ifdef ENABLE_DOT11D | |
9417 | + if(IS_DOT11D_ENABLE(ieee)) | |
9418 | + DOT11D_ScanComplete(ieee); | |
9419 | +#endif | |
9420 | +} | |
9421 | + | |
9422 | + | |
9423 | +#if 0 | |
9424 | +/* called both by wq with ieee->lock held */ | |
9425 | +void ieee80211_softmac_scan(struct ieee80211_device *ieee) | |
9426 | +{ | |
9427 | + short watchdog = 0; | |
9428 | + | |
9429 | + do{ | |
9430 | + ieee->current_network.channel = | |
9431 | + (ieee->current_network.channel + 1) % MAX_CHANNEL_NUMBER; | |
9432 | + if (watchdog++ > MAX_CHANNEL_NUMBER) | |
9433 | + return; /* no good chans */ | |
9434 | + | |
9435 | + }while(!ieee->channel_map[ieee->current_network.channel]); | |
9436 | + | |
9437 | + | |
9438 | + schedule_work(&ieee->softmac_scan_wq); | |
9439 | +} | |
9440 | +#endif | |
9441 | +#ifdef ENABLE_IPS | |
9442 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
9443 | +void ieee80211_softmac_scan_wq(struct work_struct *work) | |
9444 | +{ | |
9445 | + struct delayed_work *dwork = container_of(work, struct delayed_work, work); | |
9446 | + struct ieee80211_device *ieee = container_of(dwork, struct ieee80211_device, softmac_scan_wq); | |
9447 | +#else | |
9448 | +void ieee80211_softmac_scan_wq(struct ieee80211_device *ieee) | |
9449 | +{ | |
9450 | +#endif | |
9451 | + static short watchdog = 0; | |
9452 | +#ifdef ENABLE_DOT11D | |
9453 | + u8 channel_map[MAX_CHANNEL_NUMBER+1]; | |
9454 | + memcpy(channel_map, GET_DOT11D_INFO(ieee)->channel_map, MAX_CHANNEL_NUMBER+1); | |
9455 | +#endif | |
9456 | +// printk("ieee80211_softmac_scan_wq ENABLE_IPS\n"); | |
9457 | +// printk("in %s\n",__FUNCTION__); | |
9458 | + down(&ieee->scan_sem); | |
9459 | + | |
9460 | + do{ | |
9461 | + ieee->current_network.channel = | |
9462 | + (ieee->current_network.channel + 1) % MAX_CHANNEL_NUMBER; | |
9463 | + if (watchdog++ > MAX_CHANNEL_NUMBER) | |
9464 | + goto out; /* no good chans */ | |
9465 | + | |
9466 | +#ifdef ENABLE_DOT11D | |
9467 | + }while(!channel_map[ieee->current_network.channel]); | |
9468 | +#else | |
9469 | + }while(!ieee->channel_map[ieee->current_network.channel]); | |
9470 | +#endif | |
9471 | + | |
9472 | + //printk("current_network.channel:%d\n", ieee->current_network.channel); | |
9473 | + if (ieee->scanning == 0 ) | |
9474 | + { | |
9475 | + printk("error out, scanning = 0\n"); | |
9476 | + goto out; | |
9477 | + } | |
9478 | + ieee->set_chan(ieee->dev, ieee->current_network.channel); | |
9479 | +#ifdef ENABLE_DOT11D | |
9480 | + if(channel_map[ieee->current_network.channel] == 1) | |
9481 | +#endif | |
9482 | + ieee80211_send_probe_requests(ieee); | |
9483 | + | |
9484 | + queue_delayed_work(ieee->wq, &ieee->softmac_scan_wq, IEEE80211_SOFTMAC_SCAN_TIME); | |
9485 | + up(&ieee->scan_sem); | |
9486 | + return; | |
9487 | +out: | |
9488 | + ieee->actscanning = false; | |
9489 | + watchdog = 0; | |
9490 | + ieee->scanning = 0; | |
9491 | + up(&ieee->scan_sem); | |
9492 | + | |
9493 | +#ifdef ENABLE_DOT11D | |
9494 | + if(IS_DOT11D_ENABLE(ieee)) | |
9495 | + DOT11D_ScanComplete(ieee); | |
9496 | +#endif | |
9497 | + return; | |
9498 | +} | |
9499 | +#else | |
9500 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
9501 | +void ieee80211_softmac_scan_wq(struct work_struct *work) | |
9502 | +{ | |
9503 | + struct delayed_work *dwork = container_of(work, struct delayed_work, work); | |
9504 | + struct ieee80211_device *ieee = container_of(work, struct ieee80211_device, softmac_scan_wq); | |
9505 | +#else | |
9506 | +void ieee80211_softmac_scan_wq(struct ieee80211_device *ieee) | |
9507 | +{ | |
9508 | +#endif | |
9509 | + | |
9510 | + short watchdog = 0; | |
9511 | +#ifdef ENABLE_DOT11D | |
9512 | + u8 channel_map[MAX_CHANNEL_NUMBER+1]; | |
9513 | + memcpy(channel_map, GET_DOT11D_INFO(ieee)->channel_map, MAX_CHANNEL_NUMBER+1); | |
9514 | +#endif | |
9515 | +// printk("enter scan wq,watchdog is %d\n",watchdog); | |
9516 | + down(&ieee->scan_sem); | |
9517 | + | |
9518 | + do{ | |
9519 | + ieee->current_network.channel = | |
9520 | + (ieee->current_network.channel + 1) % MAX_CHANNEL_NUMBER; | |
9521 | + if (watchdog++ > MAX_CHANNEL_NUMBER) | |
9522 | + goto out; /* no good chans */ | |
9523 | + | |
9524 | +#ifdef ENABLE_DOT11D | |
9525 | + }while(!channel_map[ieee->current_network.channel]); | |
9526 | +#else | |
9527 | + }while(!ieee->channel_map[ieee->current_network.channel]); | |
9528 | +#endif | |
9529 | + | |
9530 | +// printk("current_network.channel:%d\n", ieee->current_network.channel); | |
9531 | + if (ieee->scanning == 0 ) | |
9532 | + { | |
9533 | + printk("error out, scanning = 0\n"); | |
9534 | + goto out; | |
9535 | + } | |
9536 | + ieee->set_chan(ieee->dev, ieee->current_network.channel); | |
9537 | +#ifdef ENABLE_DOT11D | |
9538 | + if(channel_map[ieee->current_network.channel] == 1) | |
9539 | +#endif | |
9540 | + ieee80211_send_probe_requests(ieee); | |
9541 | + | |
9542 | + queue_delayed_work(ieee->wq, &ieee->softmac_scan_wq, IEEE80211_SOFTMAC_SCAN_TIME); | |
9543 | +out: | |
9544 | + up(&ieee->scan_sem); | |
9545 | +#ifdef ENABLE_DOT11D | |
9546 | + if(IS_DOT11D_ENABLE(ieee)) | |
9547 | + DOT11D_ScanComplete(ieee); | |
9548 | +#endif | |
9549 | +} | |
9550 | + | |
9551 | +#endif | |
9552 | +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0) | |
9553 | +void ieee80211_softmac_scan_cb(unsigned long _dev) | |
9554 | +{ | |
9555 | + unsigned long flags; | |
9556 | + struct ieee80211_device *ieee = (struct ieee80211_device *)_dev; | |
9557 | + | |
9558 | + spin_lock_irqsave(&ieee->lock, flags); | |
9559 | + ieee80211_softmac_scan(ieee); | |
9560 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
9561 | +} | |
9562 | +#endif | |
9563 | + | |
9564 | + | |
9565 | +void ieee80211_beacons_start(struct ieee80211_device *ieee) | |
9566 | +{ | |
9567 | + unsigned long flags; | |
9568 | + | |
9569 | + spin_lock_irqsave(&ieee->beacon_lock,flags); | |
9570 | + | |
9571 | + ieee->beacon_txing = 1; | |
9572 | + ieee80211_send_beacon(ieee); | |
9573 | + | |
9574 | + spin_unlock_irqrestore(&ieee->beacon_lock,flags); | |
9575 | +} | |
9576 | + | |
9577 | +void ieee80211_beacons_stop(struct ieee80211_device *ieee) | |
9578 | +{ | |
9579 | + unsigned long flags; | |
9580 | + | |
9581 | + spin_lock_irqsave(&ieee->beacon_lock,flags); | |
9582 | + | |
9583 | + ieee->beacon_txing = 0; | |
9584 | + del_timer_sync(&ieee->beacon_timer); | |
9585 | + | |
9586 | + spin_unlock_irqrestore(&ieee->beacon_lock,flags); | |
9587 | + | |
9588 | +} | |
9589 | + | |
9590 | + | |
9591 | +void ieee80211_stop_send_beacons(struct ieee80211_device *ieee) | |
9592 | +{ | |
9593 | + if(ieee->stop_send_beacons) | |
9594 | + ieee->stop_send_beacons(ieee->dev); | |
9595 | + if (ieee->softmac_features & IEEE_SOFTMAC_BEACONS) | |
9596 | + ieee80211_beacons_stop(ieee); | |
9597 | +} | |
9598 | + | |
9599 | + | |
9600 | +void ieee80211_start_send_beacons(struct ieee80211_device *ieee) | |
9601 | +{ | |
9602 | + if(ieee->start_send_beacons) | |
9603 | + ieee->start_send_beacons(ieee->dev); | |
9604 | + if(ieee->softmac_features & IEEE_SOFTMAC_BEACONS) | |
9605 | + ieee80211_beacons_start(ieee); | |
9606 | +} | |
9607 | + | |
9608 | + | |
9609 | +void ieee80211_softmac_stop_scan(struct ieee80211_device *ieee) | |
9610 | +{ | |
9611 | +// unsigned long flags; | |
9612 | + | |
9613 | + //ieee->sync_scan_hurryup = 1; | |
9614 | + | |
9615 | + down(&ieee->scan_sem); | |
9616 | +// spin_lock_irqsave(&ieee->lock, flags); | |
9617 | + | |
9618 | + if (ieee->scanning == 1){ | |
9619 | + ieee->scanning = 0; | |
9620 | + //del_timer_sync(&ieee->scan_timer); | |
9621 | + cancel_delayed_work(&ieee->softmac_scan_wq); | |
9622 | + } | |
9623 | + | |
9624 | +// spin_unlock_irqrestore(&ieee->lock, flags); | |
9625 | + up(&ieee->scan_sem); | |
9626 | +} | |
9627 | + | |
9628 | +void ieee80211_stop_scan(struct ieee80211_device *ieee) | |
9629 | +{ | |
9630 | + if (ieee->softmac_features & IEEE_SOFTMAC_SCAN) | |
9631 | + ieee80211_softmac_stop_scan(ieee); | |
9632 | + else | |
9633 | + ieee->stop_scan(ieee->dev); | |
9634 | +} | |
9635 | + | |
9636 | +/* called with ieee->lock held */ | |
9637 | +void ieee80211_start_scan(struct ieee80211_device *ieee) | |
9638 | +{ | |
9639 | +#ifdef ENABLE_DOT11D | |
9640 | + if(IS_DOT11D_ENABLE(ieee) ) | |
9641 | + { | |
9642 | + if(IS_COUNTRY_IE_VALID(ieee)) | |
9643 | + { | |
9644 | + RESET_CIE_WATCHDOG(ieee); | |
9645 | + } | |
9646 | + } | |
9647 | +#endif | |
9648 | + if (ieee->softmac_features & IEEE_SOFTMAC_SCAN){ | |
9649 | + if (ieee->scanning == 0) | |
9650 | + { | |
9651 | + ieee->scanning = 1; | |
9652 | + //ieee80211_softmac_scan(ieee); | |
9653 | + // queue_work(ieee->wq, &ieee->softmac_scan_wq); | |
9654 | + //care this,1203,2007,by lawrence | |
9655 | +#if 1 | |
9656 | + queue_delayed_work(ieee->wq, &ieee->softmac_scan_wq,0); | |
9657 | +#endif | |
9658 | + } | |
9659 | + }else | |
9660 | + ieee->start_scan(ieee->dev); | |
9661 | + | |
9662 | +} | |
9663 | + | |
9664 | +/* called with wx_sem held */ | |
9665 | +void ieee80211_start_scan_syncro(struct ieee80211_device *ieee) | |
9666 | +{ | |
9667 | +#ifdef ENABLE_DOT11D | |
9668 | + if(IS_DOT11D_ENABLE(ieee) ) | |
9669 | + { | |
9670 | + if(IS_COUNTRY_IE_VALID(ieee)) | |
9671 | + { | |
9672 | + RESET_CIE_WATCHDOG(ieee); | |
9673 | + } | |
9674 | + } | |
9675 | +#endif | |
9676 | + ieee->sync_scan_hurryup = 0; | |
9677 | + | |
9678 | + if (ieee->softmac_features & IEEE_SOFTMAC_SCAN) | |
9679 | + ieee80211_softmac_scan_syncro(ieee); | |
9680 | + else | |
9681 | + ieee->scan_syncro(ieee->dev); | |
9682 | + | |
9683 | +} | |
9684 | + | |
9685 | +inline struct sk_buff *ieee80211_authentication_req(struct ieee80211_network *beacon, | |
9686 | + struct ieee80211_device *ieee, int challengelen) | |
9687 | +{ | |
9688 | + struct sk_buff *skb; | |
9689 | + struct ieee80211_authentication *auth; | |
9690 | + | |
9691 | + skb = dev_alloc_skb(sizeof(struct ieee80211_authentication) + challengelen); | |
9692 | + | |
9693 | + if (!skb) return NULL; | |
9694 | + | |
9695 | + auth = (struct ieee80211_authentication *) | |
9696 | + skb_put(skb, sizeof(struct ieee80211_authentication)); | |
9697 | + | |
9698 | + auth->header.frame_ctl = IEEE80211_STYPE_AUTH; | |
9699 | + if (challengelen) auth->header.frame_ctl |= IEEE80211_FCTL_WEP; | |
9700 | + | |
9701 | + auth->header.duration_id = 0x013a; //FIXME | |
9702 | + | |
9703 | + memcpy(auth->header.addr1, beacon->bssid, ETH_ALEN); | |
9704 | + memcpy(auth->header.addr2, ieee->dev->dev_addr, ETH_ALEN); | |
9705 | + memcpy(auth->header.addr3, beacon->bssid, ETH_ALEN); | |
9706 | + | |
9707 | + auth->algorithm = ieee->open_wep ? WLAN_AUTH_OPEN : WLAN_AUTH_SHARED_KEY; | |
9708 | + | |
9709 | + auth->transaction = cpu_to_le16(ieee->associate_seq); | |
9710 | + ieee->associate_seq++; | |
9711 | + | |
9712 | + auth->status = cpu_to_le16(WLAN_STATUS_SUCCESS); | |
9713 | + | |
9714 | + return skb; | |
9715 | + | |
9716 | +} | |
9717 | + | |
9718 | +static struct sk_buff* ieee80211_probe_resp(struct ieee80211_device *ieee, u8 *dest) | |
9719 | +{ | |
9720 | + u8 *tag; | |
9721 | + int beacon_size; | |
9722 | + struct ieee80211_probe_response *beacon_buf; | |
9723 | + struct sk_buff *skb; | |
9724 | + int encrypt; | |
9725 | + int atim_len,erp_len; | |
9726 | + struct ieee80211_crypt_data* crypt; | |
9727 | + | |
9728 | + char *ssid = ieee->current_network.ssid; | |
9729 | + int ssid_len = ieee->current_network.ssid_len; | |
9730 | + int rate_len = ieee->current_network.rates_len+2; | |
9731 | + int rate_ex_len = ieee->current_network.rates_ex_len; | |
9732 | + int wpa_ie_len = ieee->wpa_ie_len; | |
9733 | + if(rate_ex_len > 0) rate_ex_len+=2; | |
9734 | + | |
9735 | + if(ieee->current_network.capability & WLAN_CAPABILITY_IBSS) | |
9736 | + atim_len = 4; | |
9737 | + else | |
9738 | + atim_len = 0; | |
9739 | + | |
9740 | + if(ieee80211_is_54g(ieee->current_network)) | |
9741 | + erp_len = 3; | |
9742 | + else | |
9743 | + erp_len = 0; | |
9744 | + | |
9745 | + beacon_size = sizeof(struct ieee80211_probe_response)+ | |
9746 | + ssid_len | |
9747 | + +3 //channel | |
9748 | + +rate_len | |
9749 | + +rate_ex_len | |
9750 | + +atim_len | |
9751 | + +wpa_ie_len | |
9752 | + +erp_len; | |
9753 | + | |
9754 | + skb = dev_alloc_skb(beacon_size); | |
9755 | + | |
9756 | + if (!skb) | |
9757 | + return NULL; | |
9758 | + | |
9759 | + beacon_buf = (struct ieee80211_probe_response*) skb_put(skb, beacon_size); | |
9760 | + | |
9761 | + memcpy (beacon_buf->header.addr1, dest,ETH_ALEN); | |
9762 | + memcpy (beacon_buf->header.addr2, ieee->dev->dev_addr, ETH_ALEN); | |
9763 | + memcpy (beacon_buf->header.addr3, ieee->current_network.bssid, ETH_ALEN); | |
9764 | + | |
9765 | + beacon_buf->header.duration_id = 0; //FIXME | |
9766 | + beacon_buf->beacon_interval = | |
9767 | + cpu_to_le16(ieee->current_network.beacon_interval); | |
9768 | + beacon_buf->capability = | |
9769 | + cpu_to_le16(ieee->current_network.capability & WLAN_CAPABILITY_IBSS); | |
9770 | + | |
9771 | + if(ieee->short_slot && (ieee->current_network.capability & WLAN_CAPABILITY_SHORT_SLOT)) | |
9772 | + cpu_to_le16((beacon_buf->capability |= WLAN_CAPABILITY_SHORT_SLOT)); | |
9773 | + | |
9774 | + crypt = ieee->crypt[ieee->tx_keyidx]; | |
9775 | + | |
9776 | + encrypt = ieee->host_encrypt && crypt && crypt->ops && | |
9777 | + ((0 == strcmp(crypt->ops->name, "WEP")) || wpa_ie_len); | |
9778 | + | |
9779 | + if (encrypt) | |
9780 | + beacon_buf->capability |= cpu_to_le16(WLAN_CAPABILITY_PRIVACY); | |
9781 | + | |
9782 | + | |
9783 | + beacon_buf->header.frame_ctl = cpu_to_le16(IEEE80211_STYPE_PROBE_RESP); | |
9784 | + | |
9785 | + beacon_buf->info_element.id = MFIE_TYPE_SSID; | |
9786 | + beacon_buf->info_element.len = ssid_len; | |
9787 | + | |
9788 | + tag = (u8*) beacon_buf->info_element.data; | |
9789 | + | |
9790 | + memcpy(tag, ssid, ssid_len); | |
9791 | + | |
9792 | + tag += ssid_len; | |
9793 | + | |
9794 | + *(tag++) = MFIE_TYPE_RATES; | |
9795 | + *(tag++) = rate_len-2; | |
9796 | + memcpy(tag,ieee->current_network.rates,rate_len-2); | |
9797 | + tag+=rate_len-2; | |
9798 | + | |
9799 | + *(tag++) = MFIE_TYPE_DS_SET; | |
9800 | + *(tag++) = 1; | |
9801 | + *(tag++) = ieee->current_network.channel; | |
9802 | + | |
9803 | + if(atim_len){ | |
9804 | + *(tag++) = MFIE_TYPE_IBSS_SET; | |
9805 | + *(tag++) = 2; | |
9806 | + *((u16*)(tag)) = cpu_to_le16(ieee->current_network.atim_window); | |
9807 | + tag+=2; | |
9808 | + } | |
9809 | + | |
9810 | + if(erp_len){ | |
9811 | + *(tag++) = MFIE_TYPE_ERP; | |
9812 | + *(tag++) = 1; | |
9813 | + *(tag++) = 0; | |
9814 | + } | |
9815 | + | |
9816 | + if(rate_ex_len){ | |
9817 | + *(tag++) = MFIE_TYPE_RATES_EX; | |
9818 | + *(tag++) = rate_ex_len-2; | |
9819 | + memcpy(tag,ieee->current_network.rates_ex,rate_ex_len-2); | |
9820 | + tag+=rate_ex_len-2; | |
9821 | + } | |
9822 | + | |
9823 | + if (wpa_ie_len) | |
9824 | + { | |
9825 | + if (ieee->iw_mode == IW_MODE_ADHOC) | |
9826 | + {//as Windows will set pairwise key same as the group key which is not allowed in Linux, so set this for IOT issue. WB 2008.07.07 | |
9827 | + memcpy(&ieee->wpa_ie[14], &ieee->wpa_ie[8], 4); | |
9828 | + } | |
9829 | + | |
9830 | + memcpy(tag, ieee->wpa_ie, ieee->wpa_ie_len); | |
9831 | + } | |
9832 | + | |
9833 | + skb->dev = ieee->dev; | |
9834 | + return skb; | |
9835 | +} | |
9836 | +#ifdef _RTL8187_EXT_PATCH_ | |
9837 | +struct sk_buff* ieee80211_ext_probe_resp_by_net(struct ieee80211_device *ieee, u8 *dest, struct ieee80211_network *net) | |
9838 | +{ | |
9839 | + u8 *tag; | |
9840 | + int beacon_size; | |
9841 | + struct ieee80211_probe_response *beacon_buf; | |
9842 | + struct sk_buff *skb; | |
9843 | + int encrypt; | |
9844 | + int atim_len,erp_len; | |
9845 | + struct ieee80211_crypt_data* crypt; | |
9846 | + u8 broadcast_addr[] = {0xff,0xff,0xff,0xff,0xff,0xff}; | |
9847 | + int wpa_ie_len = ieee->wpa_ie_len; | |
9848 | + char *ssid = net->ssid; | |
9849 | + int ssid_len = net->ssid_len; | |
9850 | + | |
9851 | + int rate_len = ieee->current_network.rates_len+2; | |
9852 | + int rate_ex_len = ieee->current_network.rates_ex_len; | |
9853 | + if(rate_ex_len > 0) rate_ex_len+=2; | |
9854 | + | |
9855 | + if( ieee->meshScanMode&4) | |
9856 | + ieee->current_network.channel = ieee->ext_patch_ieee80211_ext_stop_scan_wq_set_channel(ieee); | |
9857 | + if( ieee->meshScanMode&6) | |
9858 | + { | |
9859 | + | |
9860 | +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0) | |
9861 | + queue_work(ieee->wq, &ieee->ext_stop_scan_wq); | |
9862 | +#else | |
9863 | + schedule_task(&ieee->ext_stop_scan_wq); | |
9864 | +#endif | |
9865 | + } | |
9866 | + if(ieee->current_network.capability & WLAN_CAPABILITY_IBSS) // use current_network here | |
9867 | + atim_len = 4; | |
9868 | + else | |
9869 | + atim_len = 0; | |
9870 | + | |
9871 | + if(ieee80211_is_54g(*net)) | |
9872 | + erp_len = 3; | |
9873 | + else | |
9874 | + erp_len = 0; | |
9875 | + | |
9876 | + beacon_size = sizeof(struct ieee80211_probe_response)+ | |
9877 | + ssid_len | |
9878 | + +3 //channel | |
9879 | + +rate_len | |
9880 | + +rate_ex_len | |
9881 | + +atim_len | |
9882 | + +erp_len; | |
9883 | +//b | |
9884 | + skb = dev_alloc_skb(beacon_size+196); | |
9885 | + | |
9886 | + if (!skb) | |
9887 | + return NULL; | |
9888 | + | |
9889 | + beacon_buf = (struct ieee80211_probe_response*) skb_put(skb, beacon_size); | |
9890 | + | |
9891 | + memcpy (beacon_buf->header.addr1, dest,ETH_ALEN); | |
9892 | + memcpy (beacon_buf->header.addr2, ieee->dev->dev_addr, ETH_ALEN); | |
9893 | + memcpy (beacon_buf->header.addr3, ieee->current_network.bssid, ETH_ALEN); | |
9894 | + | |
9895 | + beacon_buf->header.duration_id = 0; //FIXME | |
9896 | + | |
9897 | + beacon_buf->beacon_interval = | |
9898 | + cpu_to_le16(ieee->current_network.beacon_interval); // use current_network here | |
9899 | + beacon_buf->capability = | |
9900 | + cpu_to_le16(ieee->current_network.capability & WLAN_CAPABILITY_IBSS); | |
9901 | + | |
9902 | + if(ieee->short_slot && (ieee->current_network.capability & WLAN_CAPABILITY_SHORT_SLOT)) | |
9903 | + cpu_to_le16((beacon_buf->capability |= WLAN_CAPABILITY_SHORT_SLOT)); | |
9904 | + | |
9905 | + crypt = ieee->crypt[ieee->tx_keyidx]; | |
9906 | + | |
9907 | + encrypt = ieee->host_encrypt && crypt && crypt->ops && | |
9908 | + ((0 == strcmp(crypt->ops->name, "WEP"))||wpa_ie_len); | |
9909 | + | |
9910 | + if (encrypt) | |
9911 | + beacon_buf->capability |= cpu_to_le16(WLAN_CAPABILITY_PRIVACY); | |
9912 | + | |
9913 | + | |
9914 | + beacon_buf->header.frame_ctl = cpu_to_le16(IEEE80211_STYPE_PROBE_RESP); | |
9915 | + | |
9916 | + beacon_buf->info_element.id = MFIE_TYPE_SSID; | |
9917 | + beacon_buf->info_element.len = ssid_len; | |
9918 | + | |
9919 | + tag = (u8*) beacon_buf->info_element.data; | |
9920 | + | |
9921 | + // brocad cast / probe rsp | |
9922 | + if(memcmp(dest, broadcast_addr, ETH_ALEN )) | |
9923 | + memcpy(tag, ssid, ssid_len); | |
9924 | + else | |
9925 | + ssid_len=0; | |
9926 | + | |
9927 | + tag += ssid_len; | |
9928 | + | |
9929 | +//get_bssrate_set(priv, _SUPPORTEDRATES_IE_, &pbssrate, &bssrate_len); | |
9930 | +//pbuf = set_ie(pbuf, _SUPPORTEDRATES_IE_, bssrate_len, pbssrate, &frlen); | |
9931 | + | |
9932 | + *(tag++) = MFIE_TYPE_RATES; | |
9933 | + *(tag++) = rate_len-2; | |
9934 | + memcpy(tag,ieee->current_network.rates,rate_len-2); | |
9935 | + tag+=rate_len-2; | |
9936 | + | |
9937 | + *(tag++) = MFIE_TYPE_DS_SET; | |
9938 | + *(tag++) = 1; | |
9939 | + *(tag++) = ieee->current_network.channel; // use current_network here | |
9940 | + | |
9941 | + | |
9942 | + if(atim_len){ | |
9943 | + *(tag++) = MFIE_TYPE_IBSS_SET; | |
9944 | + *(tag++) = 2; | |
9945 | + *((u16*)(tag)) = cpu_to_le16(ieee->current_network.atim_window); // use current_network here | |
9946 | + tag+=2; | |
9947 | + } | |
9948 | + | |
9949 | + if(erp_len){ | |
9950 | + *(tag++) = MFIE_TYPE_ERP; | |
9951 | + *(tag++) = 1; | |
9952 | + *(tag++) = 0; | |
9953 | + } | |
9954 | + | |
9955 | + if(rate_ex_len){ | |
9956 | + *(tag++) = MFIE_TYPE_RATES_EX; | |
9957 | + *(tag++) = rate_ex_len-2; | |
9958 | + memcpy(tag,ieee->current_network.rates_ex,rate_ex_len-2); | |
9959 | + tag+=rate_ex_len-2; | |
9960 | + } | |
9961 | + if (wpa_ie_len) | |
9962 | + memcpy(tag, ieee->wpa_ie, ieee->wpa_ie_len); | |
9963 | + | |
9964 | + skb->dev = ieee->dev; | |
9965 | + return skb; | |
9966 | +} | |
9967 | +#endif // _RTL8187_EXT_PATCH_ | |
9968 | + | |
9969 | +struct sk_buff* ieee80211_assoc_resp(struct ieee80211_device *ieee, u8 *dest) | |
9970 | +{ | |
9971 | + struct sk_buff *skb; | |
9972 | + u8* tag; | |
9973 | + | |
9974 | + struct ieee80211_crypt_data* crypt; | |
9975 | + struct ieee80211_assoc_response_frame *assoc; | |
9976 | + short encrypt; | |
9977 | + | |
9978 | + unsigned int rate_len = ieee80211_MFIE_rate_len(ieee); | |
9979 | + int len = sizeof(struct ieee80211_assoc_response_frame) + rate_len; | |
9980 | + | |
9981 | + skb = dev_alloc_skb(len); | |
9982 | + | |
9983 | + if (!skb) | |
9984 | + return NULL; | |
9985 | + | |
9986 | + assoc = (struct ieee80211_assoc_response_frame *) | |
9987 | + skb_put(skb,sizeof(struct ieee80211_assoc_response_frame)); | |
9988 | + | |
9989 | + assoc->header.frame_ctl = cpu_to_le16(IEEE80211_STYPE_ASSOC_RESP); | |
9990 | + memcpy(assoc->header.addr1, dest,ETH_ALEN); | |
9991 | + memcpy(assoc->header.addr3, ieee->dev->dev_addr, ETH_ALEN); | |
9992 | + memcpy(assoc->header.addr2, ieee->dev->dev_addr, ETH_ALEN); | |
9993 | + assoc->capability = cpu_to_le16(ieee->iw_mode == IW_MODE_MASTER ? | |
9994 | + WLAN_CAPABILITY_BSS : WLAN_CAPABILITY_IBSS); | |
9995 | + | |
9996 | + | |
9997 | + if(ieee->short_slot) | |
9998 | + assoc->capability |= cpu_to_le16(WLAN_CAPABILITY_SHORT_SLOT); | |
9999 | + | |
10000 | + if (ieee->host_encrypt) | |
10001 | + crypt = ieee->crypt[ieee->tx_keyidx]; | |
10002 | + else crypt = NULL; | |
10003 | + | |
10004 | + encrypt = ( crypt && crypt->ops); | |
10005 | + | |
10006 | + if (encrypt) | |
10007 | + assoc->capability |= cpu_to_le16(WLAN_CAPABILITY_PRIVACY); | |
10008 | + | |
10009 | + assoc->status = 0; | |
10010 | + assoc->aid = cpu_to_le16(ieee->assoc_id); | |
10011 | + if (ieee->assoc_id == 0x2007) ieee->assoc_id=0; | |
10012 | + else ieee->assoc_id++; | |
10013 | + | |
10014 | + tag = (u8*) skb_put(skb, rate_len); | |
10015 | + | |
10016 | + ieee80211_MFIE_Brate(ieee, &tag); | |
10017 | + ieee80211_MFIE_Grate(ieee, &tag); | |
10018 | + | |
10019 | + return skb; | |
10020 | +} | |
10021 | + | |
10022 | +struct sk_buff* ieee80211_auth_resp(struct ieee80211_device *ieee,int status, u8 *dest) | |
10023 | +{ | |
10024 | + struct sk_buff *skb; | |
10025 | + struct ieee80211_authentication *auth; | |
10026 | + | |
10027 | + skb = dev_alloc_skb(sizeof(struct ieee80211_authentication)+1); | |
10028 | + | |
10029 | + if (!skb) | |
10030 | + return NULL; | |
10031 | + | |
10032 | + skb->len = sizeof(struct ieee80211_authentication); | |
10033 | + | |
10034 | + auth = (struct ieee80211_authentication *)skb->data; | |
10035 | + | |
10036 | + auth->status = cpu_to_le16(status); | |
10037 | + auth->transaction = cpu_to_le16(2); | |
10038 | + auth->algorithm = cpu_to_le16(WLAN_AUTH_OPEN); | |
10039 | + | |
10040 | +#ifdef _RTL8187_EXT_PATCH_ | |
10041 | + if(ieee->iw_mode == ieee->iw_ext_mode) | |
10042 | + memcpy(auth->header.addr3, dest, ETH_ALEN); | |
10043 | +#else | |
10044 | + memcpy(auth->header.addr3, ieee->dev->dev_addr, ETH_ALEN); | |
10045 | +#endif | |
10046 | + memcpy(auth->header.addr2, ieee->dev->dev_addr, ETH_ALEN); | |
10047 | + memcpy(auth->header.addr1, dest, ETH_ALEN); | |
10048 | + auth->header.frame_ctl = cpu_to_le16(IEEE80211_STYPE_AUTH); | |
10049 | + return skb; | |
10050 | + | |
10051 | + | |
10052 | +} | |
10053 | + | |
10054 | +struct sk_buff* ieee80211_null_func(struct ieee80211_device *ieee,short pwr) | |
10055 | +{ | |
10056 | + struct sk_buff *skb; | |
10057 | + struct ieee80211_hdr_3addr* hdr; | |
10058 | + | |
10059 | + skb = dev_alloc_skb(sizeof(struct ieee80211_hdr_3addr)); | |
10060 | + | |
10061 | + if (!skb) | |
10062 | + return NULL; | |
10063 | + | |
10064 | + hdr = (struct ieee80211_hdr_3addr*)skb_put(skb,sizeof(struct ieee80211_hdr_3addr)); | |
10065 | + | |
10066 | + memcpy(hdr->addr1, ieee->current_network.bssid, ETH_ALEN); | |
10067 | + memcpy(hdr->addr2, ieee->dev->dev_addr, ETH_ALEN); | |
10068 | + memcpy(hdr->addr3, ieee->current_network.bssid, ETH_ALEN); | |
10069 | + | |
10070 | + hdr->frame_ctl = cpu_to_le16(IEEE80211_FTYPE_DATA | | |
10071 | + IEEE80211_STYPE_NULLFUNC | IEEE80211_FCTL_TODS | | |
10072 | + (pwr ? IEEE80211_FCTL_PM:0)); | |
10073 | + | |
10074 | + return skb; | |
10075 | + | |
10076 | + | |
10077 | +} | |
10078 | + | |
10079 | + | |
10080 | +void ieee80211_resp_to_assoc_rq(struct ieee80211_device *ieee, u8* dest) | |
10081 | +{ | |
10082 | + struct sk_buff *buf = ieee80211_assoc_resp(ieee, dest); | |
10083 | + | |
10084 | + if (buf){ | |
10085 | + softmac_mgmt_xmit(buf, ieee); | |
10086 | + dev_kfree_skb_any(buf);//edit by thomas | |
10087 | + } | |
10088 | +} | |
10089 | + | |
10090 | + | |
10091 | +void ieee80211_resp_to_auth(struct ieee80211_device *ieee, int s, u8* dest) | |
10092 | +{ | |
10093 | + struct sk_buff *buf = ieee80211_auth_resp(ieee, s, dest); | |
10094 | + | |
10095 | + if (buf){ | |
10096 | + softmac_mgmt_xmit(buf, ieee); | |
10097 | + dev_kfree_skb_any(buf);//edit by thomas | |
10098 | + } | |
10099 | +} | |
10100 | + | |
10101 | + | |
10102 | +void ieee80211_resp_to_probe(struct ieee80211_device *ieee, u8 *dest) | |
10103 | +{ | |
10104 | + | |
10105 | + struct sk_buff *buf = ieee80211_probe_resp(ieee, dest); | |
10106 | + | |
10107 | + if (buf) { | |
10108 | + softmac_mgmt_xmit(buf, ieee); | |
10109 | + dev_kfree_skb_any(buf);//edit by thomas | |
10110 | + } | |
10111 | +} | |
10112 | + | |
10113 | + | |
10114 | +inline struct sk_buff *ieee80211_association_req(struct ieee80211_network *beacon,struct ieee80211_device *ieee) | |
10115 | +{ | |
10116 | + struct sk_buff *skb; | |
10117 | + //unsigned long flags; | |
10118 | + | |
10119 | + struct ieee80211_assoc_request_frame *hdr; | |
10120 | + u8 *tag; | |
10121 | + //short info_addr = 0; | |
10122 | + //int i; | |
10123 | + //u16 suite_count = 0; | |
10124 | + //u8 suit_select = 0; | |
10125 | + unsigned int wpa_len = beacon->wpa_ie_len; | |
10126 | + //struct net_device *dev = ieee->dev; | |
10127 | + //union iwreq_data wrqu; | |
10128 | + //u8 *buff; | |
10129 | + //u8 *p; | |
10130 | +#if 1 | |
10131 | + // for testing purpose | |
10132 | + unsigned int rsn_len = beacon->rsn_ie_len; | |
10133 | +#else | |
10134 | + unsigned int rsn_len = beacon->rsn_ie_len - 4; | |
10135 | +#endif | |
10136 | + unsigned int rate_len = ieee80211_MFIE_rate_len(ieee); | |
10137 | + unsigned int wmm_info_len = beacon->QoS_Enable?9:0; | |
10138 | +#ifdef THOMAS_TURBO | |
10139 | + unsigned int turbo_info_len = beacon->Turbo_Enable?9:0; | |
10140 | +#endif | |
10141 | + | |
10142 | + u8 encry_proto = ieee->wpax_type_notify & 0xff; | |
10143 | + //u8 pairwise_type = (ieee->wpax_type_notify >> 8) & 0xff; | |
10144 | + //u8 authen_type = (ieee->wpax_type_notify >> 16) & 0xff; | |
10145 | + | |
10146 | + int len = 0; | |
10147 | + | |
10148 | + //[0] Notify type of encryption: WPA/WPA2 | |
10149 | + //[1] pair wise type | |
10150 | + //[2] authen type | |
10151 | + if(ieee->wpax_type_set) { | |
10152 | + if (IEEE_PROTO_WPA == encry_proto) { | |
10153 | + rsn_len = 0; | |
10154 | + } else if (IEEE_PROTO_RSN == encry_proto) { | |
10155 | + wpa_len = 0; | |
10156 | + } | |
10157 | + } | |
10158 | +#ifdef THOMAS_TURBO | |
10159 | + len = sizeof(struct ieee80211_assoc_request_frame)+ | |
10160 | + + beacon->ssid_len//essid tagged val | |
10161 | + + rate_len//rates tagged val | |
10162 | + + wpa_len | |
10163 | + + rsn_len | |
10164 | + + wmm_info_len | |
10165 | + + turbo_info_len; | |
10166 | +#else | |
10167 | + len = sizeof(struct ieee80211_assoc_request_frame)+ | |
10168 | + + beacon->ssid_len//essid tagged val | |
10169 | + + rate_len//rates tagged val | |
10170 | + + wpa_len | |
10171 | + + rsn_len | |
10172 | + + wmm_info_len; | |
10173 | +#endif | |
10174 | + | |
10175 | +#ifdef _RTL8187_EXT_PATCH_ | |
10176 | + if(ieee->iw_mode == ieee->iw_ext_mode) | |
10177 | + skb = dev_alloc_skb(len+256); // stanley | |
10178 | + else | |
10179 | +#endif | |
10180 | + skb = dev_alloc_skb(len); | |
10181 | + | |
10182 | + if (!skb) | |
10183 | + return NULL; | |
10184 | + | |
10185 | + hdr = (struct ieee80211_assoc_request_frame *) | |
10186 | + skb_put(skb, sizeof(struct ieee80211_assoc_request_frame)); | |
10187 | + | |
10188 | + | |
10189 | + hdr->header.frame_ctl = IEEE80211_STYPE_ASSOC_REQ; | |
10190 | + hdr->header.duration_id= 37; //FIXME | |
10191 | + memcpy(hdr->header.addr1, beacon->bssid, ETH_ALEN); | |
10192 | + memcpy(hdr->header.addr2, ieee->dev->dev_addr, ETH_ALEN); | |
10193 | + memcpy(hdr->header.addr3, beacon->bssid, ETH_ALEN); | |
10194 | + memcpy(ieee->ap_mac_addr, beacon->bssid, ETH_ALEN);//for HW security, John | |
10195 | + | |
10196 | + hdr->capability = cpu_to_le16(WLAN_CAPABILITY_BSS); | |
10197 | + if (beacon->capability & WLAN_CAPABILITY_PRIVACY ) | |
10198 | + hdr->capability |= cpu_to_le16(WLAN_CAPABILITY_PRIVACY); | |
10199 | + if (beacon->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) | |
10200 | + hdr->capability |= cpu_to_le16(WLAN_CAPABILITY_SHORT_PREAMBLE); | |
10201 | + | |
10202 | + if(ieee->short_slot) | |
10203 | + hdr->capability |= cpu_to_le16(WLAN_CAPABILITY_SHORT_SLOT); | |
10204 | + | |
10205 | +#ifdef _RTL8187_EXT_PATCH_ | |
10206 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_association_req_1) | |
10207 | + ieee->ext_patch_ieee80211_association_req_1(hdr); | |
10208 | +#endif | |
10209 | + | |
10210 | + hdr->listen_interval = 0xa; //FIXME | |
10211 | + | |
10212 | + hdr->info_element.id = MFIE_TYPE_SSID; | |
10213 | + | |
10214 | + hdr->info_element.len = beacon->ssid_len; | |
10215 | + tag = skb_put(skb, beacon->ssid_len); | |
10216 | + memcpy(tag, beacon->ssid, beacon->ssid_len); | |
10217 | + | |
10218 | + tag = skb_put(skb, rate_len); | |
10219 | + | |
10220 | + ieee80211_MFIE_Brate(ieee, &tag); | |
10221 | + ieee80211_MFIE_Grate(ieee, &tag); | |
10222 | + | |
10223 | + //add rsn==0 condition for ap's mix security mode(wpa+wpa2), john2007.8.9 | |
10224 | + //choose AES encryption as default algorithm while using mixed mode | |
10225 | +#if 0 | |
10226 | + if(rsn_len == 0){ | |
10227 | + | |
10228 | + tag = skb_put(skb,wpa_len); | |
10229 | + | |
10230 | + if(wpa_len) { | |
10231 | + | |
10232 | + | |
10233 | + //{add by david. 2006.8.31 | |
10234 | + //fix linksys compatibility bug | |
10235 | + //} | |
10236 | + if(wpa_len > 24) {//22+2, mean include the capability | |
10237 | + beacon->wpa_ie[wpa_len - 2] = 0; | |
10238 | + } | |
10239 | + //multicast cipher OUI | |
10240 | + if( beacon->wpa_ie[11]==0x2 ){ //0x0050f202 is the oui of tkip | |
10241 | + ieee->broadcast_key_type = KEY_TYPE_TKIP; | |
10242 | + } | |
10243 | + else if( beacon->wpa_ie[11]==0x4 ){//0x0050f204 is the oui of ccmp | |
10244 | + ieee->broadcast_key_type = KEY_TYPE_CCMP; | |
10245 | + } | |
10246 | + //unicast cipher OUI | |
10247 | + if( beacon->wpa_ie[14]==0 | |
10248 | + && beacon->wpa_ie[15]==0x50 | |
10249 | + && beacon->wpa_ie[16]==0xf2 | |
10250 | + && beacon->wpa_ie[17]==0x2 ){ //0x0050f202 is the oui of tkip | |
10251 | + ieee->pairwise_key_type = KEY_TYPE_TKIP; | |
10252 | + } | |
10253 | + | |
10254 | + else if( beacon->wpa_ie[14]==0 | |
10255 | + && beacon->wpa_ie[15]==0x50 | |
10256 | + && beacon->wpa_ie[16]==0xf2 | |
10257 | + && beacon->wpa_ie[17]==0x4 ){//0x0050f204 is the oui of ccmp | |
10258 | + ieee->pairwise_key_type = KEY_TYPE_CCMP; | |
10259 | + } | |
10260 | + //indicate the wpa_ie content to WPA_SUPPLICANT | |
10261 | + buff = kmalloc(IW_CUSTOM_MAX, GFP_ATOMIC); | |
10262 | + memset(buff, 0, IW_CUSTOM_MAX); | |
10263 | + p=buff; | |
10264 | + p += sprintf(p, "ASSOCINFO(ReqIEs="); | |
10265 | + for(i=0;i<wpa_len;i++){ | |
10266 | + p += sprintf(p, "%02x", beacon->wpa_ie[i]); | |
10267 | + } | |
10268 | + p += sprintf(p, ")"); | |
10269 | + memset(&wrqu, 0, sizeof(wrqu) ); | |
10270 | + wrqu.data.length = p - buff; | |
10271 | + | |
10272 | + wireless_send_event(dev, IWEVCUSTOM, &wrqu, buff); | |
10273 | + memcpy(tag,beacon->wpa_ie,wpa_len); | |
10274 | + } | |
10275 | + | |
10276 | + } | |
10277 | + | |
10278 | + if(rsn_len > 22) { | |
10279 | + | |
10280 | + if( beacon->rsn_ie[4]==0x0 && | |
10281 | + beacon->rsn_ie[5]==0xf && | |
10282 | + beacon->rsn_ie[6]==0xac){ | |
10283 | + | |
10284 | + switch(beacon->rsn_ie[7]){ | |
10285 | + case 0x1: | |
10286 | + ieee->broadcast_key_type = KEY_TYPE_WEP40; | |
10287 | + break; | |
10288 | + case 0x2: | |
10289 | + ieee->broadcast_key_type = KEY_TYPE_TKIP; | |
10290 | + break; | |
10291 | + case 0x4: | |
10292 | + ieee->broadcast_key_type = KEY_TYPE_CCMP; | |
10293 | + break; | |
10294 | + case 0x5: | |
10295 | + ieee->broadcast_key_type = KEY_TYPE_WEP104; | |
10296 | + break; | |
10297 | + default: | |
10298 | + printk("fault suite type in RSN broadcast key\n"); | |
10299 | + break; | |
10300 | + } | |
10301 | + } | |
10302 | + | |
10303 | + if( beacon->rsn_ie[10]==0x0 && | |
10304 | + beacon->rsn_ie[11]==0xf && | |
10305 | + beacon->rsn_ie[12]==0xac){ | |
10306 | + if(beacon->rsn_ie[8]==1){//not mixed mode | |
10307 | + switch(beacon->rsn_ie[13]){ | |
10308 | + case 0x2: | |
10309 | + ieee->pairwise_key_type = KEY_TYPE_TKIP; | |
10310 | + break; | |
10311 | + case 0x4: | |
10312 | + ieee->pairwise_key_type = KEY_TYPE_CCMP; | |
10313 | + break; | |
10314 | + default: | |
10315 | + printk("fault suite type in RSN pairwise key\n"); | |
10316 | + break; | |
10317 | + } | |
10318 | + } | |
10319 | + else if(beacon->rsn_ie[8]==2){//mixed mode | |
10320 | + ieee->pairwise_key_type = KEY_TYPE_CCMP; | |
10321 | + } | |
10322 | + } | |
10323 | + | |
10324 | + | |
10325 | + | |
10326 | + tag = skb_put(skb,22); | |
10327 | + memcpy(tag,(beacon->rsn_ie + info_addr),8); | |
10328 | + tag[1] = 20; | |
10329 | + tag += 8; | |
10330 | + info_addr += 8; | |
10331 | + | |
10332 | + spin_lock_irqsave(&ieee->wpax_suitlist_lock,flags); | |
10333 | + for (i = 0; i < 2; i++) { | |
10334 | + tag[0] = 1; | |
10335 | + tag[1] = 0; | |
10336 | + tag += 2; | |
10337 | + suite_count = beacon->rsn_ie[info_addr] + \ | |
10338 | + (beacon->rsn_ie[info_addr + 1] << 8); | |
10339 | + info_addr += 2; | |
10340 | + if(1 == suite_count) { | |
10341 | + memcpy(tag,(beacon->rsn_ie + info_addr),4); | |
10342 | + info_addr += 4; | |
10343 | + } else { | |
10344 | + // if the wpax_type_notify has been set by the application, | |
10345 | + // just use it, otherwise just use the default one. | |
10346 | + if(ieee->wpax_type_set) { | |
10347 | + suit_select = ((0 == i) ? pairwise_type:authen_type)&0x0f ; | |
10348 | + memcpy(tag,rsn_authen_cipher_suite[suit_select],4); | |
10349 | + } else { | |
10350 | + //default set as ccmp, or none authentication | |
10351 | + if(i == 0) { | |
10352 | + memcpy(tag,rsn_authen_cipher_suite[4],4); | |
10353 | + } else { | |
10354 | + memcpy(tag,rsn_authen_cipher_suite[2],4); | |
10355 | + } | |
10356 | + | |
10357 | + } | |
10358 | + | |
10359 | + info_addr += (suite_count * 4); | |
10360 | + } | |
10361 | + tag += 4; | |
10362 | + } | |
10363 | + spin_unlock_irqrestore(&ieee->wpax_suitlist_lock,flags); | |
10364 | + | |
10365 | + tag[0] = 0; | |
10366 | + tag[1] = beacon->rsn_ie[info_addr+1]; | |
10367 | + | |
10368 | + } else { | |
10369 | + tag = skb_put(skb,rsn_len); | |
10370 | + if(rsn_len) { | |
10371 | + | |
10372 | + | |
10373 | + if( beacon->rsn_ie[4]==0x0 && | |
10374 | + beacon->rsn_ie[5]==0xf && | |
10375 | + beacon->rsn_ie[6]==0xac){ | |
10376 | + switch(beacon->rsn_ie[7]){ | |
10377 | + case 0x1: | |
10378 | + ieee->broadcast_key_type = KEY_TYPE_WEP40; | |
10379 | + break; | |
10380 | + case 0x2: | |
10381 | + ieee->broadcast_key_type = KEY_TYPE_TKIP; | |
10382 | + break; | |
10383 | + case 0x4: | |
10384 | + ieee->broadcast_key_type = KEY_TYPE_CCMP; | |
10385 | + break; | |
10386 | + case 0x5: | |
10387 | + ieee->broadcast_key_type = KEY_TYPE_WEP104; | |
10388 | + break; | |
10389 | + default: | |
10390 | + printk("fault suite type in RSN broadcast key\n"); | |
10391 | + break; | |
10392 | + } | |
10393 | + } | |
10394 | + if( beacon->rsn_ie[10]==0x0 && | |
10395 | + beacon->rsn_ie[11]==0xf && | |
10396 | + beacon->rsn_ie[12]==0xac){ | |
10397 | + if(beacon->rsn_ie[8]==1){//not mixed mode | |
10398 | + switch(beacon->rsn_ie[13]){ | |
10399 | + case 0x2: | |
10400 | + ieee->pairwise_key_type = KEY_TYPE_TKIP; | |
10401 | + break; | |
10402 | + case 0x4: | |
10403 | + ieee->pairwise_key_type = KEY_TYPE_CCMP; | |
10404 | + break; | |
10405 | + default: | |
10406 | + printk("fault suite type in RSN pairwise key\n"); | |
10407 | + break; | |
10408 | + } | |
10409 | + | |
10410 | + } | |
10411 | + else if(beacon->rsn_ie[8]==2){//mixed mode | |
10412 | + ieee->pairwise_key_type = KEY_TYPE_CCMP; | |
10413 | + } | |
10414 | + } | |
10415 | + | |
10416 | + | |
10417 | + beacon->rsn_ie[rsn_len - 2] = 0; | |
10418 | + memcpy(tag,beacon->rsn_ie,rsn_len); | |
10419 | + } | |
10420 | + } | |
10421 | +#else | |
10422 | + tag = skb_put(skb,ieee->wpa_ie_len); | |
10423 | + memcpy(tag,ieee->wpa_ie,ieee->wpa_ie_len); | |
10424 | +#endif | |
10425 | + tag = skb_put(skb,wmm_info_len); | |
10426 | + if(wmm_info_len) { | |
10427 | + ieee80211_WMM_Info(ieee, &tag); | |
10428 | + } | |
10429 | +#ifdef THOMAS_TURBO | |
10430 | + tag = skb_put(skb,turbo_info_len); | |
10431 | + if(turbo_info_len) { | |
10432 | + ieee80211_TURBO_Info(ieee, &tag); | |
10433 | + } | |
10434 | +#endif | |
10435 | + | |
10436 | +#ifdef _RTL8187_EXT_PATCH_ | |
10437 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_association_req_2) | |
10438 | + ieee->ext_patch_ieee80211_association_req_2(ieee, beacon, skb); | |
10439 | +#endif | |
10440 | + | |
10441 | + return skb; | |
10442 | +} | |
10443 | + | |
10444 | +void ieee80211_associate_abort(struct ieee80211_device *ieee) | |
10445 | +{ | |
10446 | + | |
10447 | + unsigned long flags; | |
10448 | + spin_lock_irqsave(&ieee->lock, flags); | |
10449 | + | |
10450 | + ieee->associate_seq++; | |
10451 | + | |
10452 | + /* don't scan, and avoid to have the RX path possibily | |
10453 | + * try again to associate. Even do not react to AUTH or | |
10454 | + * ASSOC response. Just wait for the retry wq to be scheduled. | |
10455 | + * Here we will check if there are good nets to associate | |
10456 | + * with, so we retry or just get back to NO_LINK and scanning | |
10457 | + */ | |
10458 | + if (ieee->state == IEEE80211_ASSOCIATING_AUTHENTICATING){ | |
10459 | + IEEE80211_DEBUG_MGMT("Authentication failed\n"); | |
10460 | + ieee->softmac_stats.no_auth_rs++; | |
10461 | + }else{ | |
10462 | + IEEE80211_DEBUG_MGMT("Association failed\n"); | |
10463 | + ieee->softmac_stats.no_ass_rs++; | |
10464 | + } | |
10465 | + | |
10466 | + ieee->state = IEEE80211_ASSOCIATING_RETRY; | |
10467 | + | |
10468 | + queue_delayed_work(ieee->wq, &ieee->associate_retry_wq,IEEE80211_SOFTMAC_ASSOC_RETRY_TIME); | |
10469 | + | |
10470 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
10471 | +} | |
10472 | + | |
10473 | +void ieee80211_associate_abort_cb(unsigned long dev) | |
10474 | +{ | |
10475 | + ieee80211_associate_abort((struct ieee80211_device *) dev); | |
10476 | +} | |
10477 | + | |
10478 | + | |
10479 | +void ieee80211_associate_step1(struct ieee80211_device *ieee) | |
10480 | +{ | |
10481 | + struct ieee80211_network *beacon = &ieee->current_network; | |
10482 | + struct sk_buff *skb; | |
10483 | + | |
10484 | + IEEE80211_DEBUG_MGMT("Stopping scan\n"); | |
10485 | + ieee->softmac_stats.tx_auth_rq++; | |
10486 | + skb=ieee80211_authentication_req(beacon, ieee, 0); | |
10487 | +#ifdef _RTL8187_EXT_PATCH_ | |
10488 | + if(ieee->iw_mode == ieee->iw_ext_mode ) { | |
10489 | + if(skb) | |
10490 | + softmac_mgmt_xmit(skb, ieee); | |
10491 | + return; | |
10492 | + }else | |
10493 | +#endif | |
10494 | + if (!skb){ | |
10495 | + | |
10496 | + ieee80211_associate_abort(ieee); | |
10497 | + } | |
10498 | + else{ | |
10499 | + ieee->state = IEEE80211_ASSOCIATING_AUTHENTICATING ; | |
10500 | + IEEE80211_DEBUG_MGMT("Sending authentication request\n"); | |
10501 | + //printk("---Sending authentication request\n"); | |
10502 | + softmac_mgmt_xmit(skb, ieee); | |
10503 | + //BUGON when you try to add_timer twice, using mod_timer may be better, john0709 | |
10504 | + if(!timer_pending(&ieee->associate_timer)){ | |
10505 | + ieee->associate_timer.expires = jiffies + (HZ / 2); | |
10506 | + add_timer(&ieee->associate_timer); | |
10507 | + } | |
10508 | + //If call dev_kfree_skb_any,a warning will ocur.... | |
10509 | + //KERNEL: assertion (!atomic_read(&skb->users)) failed at net/core/dev.c (1708) | |
10510 | + //So ... 1204 by lawrence. | |
10511 | + //printk("\nIn %s,line %d call kfree skb.",__FUNCTION__,__LINE__); | |
10512 | + //dev_kfree_skb_any(skb);//edit by thomas | |
10513 | + } | |
10514 | +} | |
10515 | + | |
10516 | +void ieee80211_auth_challenge(struct ieee80211_device *ieee, u8 *challenge, int chlen) | |
10517 | +{ | |
10518 | + u8 *c; | |
10519 | + struct sk_buff *skb; | |
10520 | + struct ieee80211_network *beacon = &ieee->current_network; | |
10521 | +// int hlen = sizeof(struct ieee80211_authentication); | |
10522 | + del_timer_sync(&ieee->associate_timer); | |
10523 | + ieee->associate_seq++; | |
10524 | + ieee->softmac_stats.tx_auth_rq++; | |
10525 | + | |
10526 | + skb = ieee80211_authentication_req(beacon, ieee, chlen+2); | |
10527 | + if (!skb) | |
10528 | + ieee80211_associate_abort(ieee); | |
10529 | + else{ | |
10530 | + c = skb_put(skb, chlen+2); | |
10531 | + *(c++) = MFIE_TYPE_CHALLENGE; | |
10532 | + *(c++) = chlen; | |
10533 | + memcpy(c, challenge, chlen); | |
10534 | + | |
10535 | + IEEE80211_DEBUG_MGMT("Sending authentication challenge response\n"); | |
10536 | + | |
10537 | + ieee80211_encrypt_fragment(ieee, skb, sizeof(struct ieee80211_hdr_3addr )); | |
10538 | + | |
10539 | + softmac_mgmt_xmit(skb, ieee); | |
10540 | + if (!timer_pending(&ieee->associate_timer)){ | |
10541 | + //printk("=========>add timer again, to crash\n"); | |
10542 | + ieee->associate_timer.expires = jiffies + (HZ / 2); | |
10543 | + add_timer(&ieee->associate_timer); | |
10544 | + } | |
10545 | + dev_kfree_skb_any(skb);//edit by thomas | |
10546 | + } | |
10547 | + kfree(challenge); | |
10548 | +} | |
10549 | + | |
10550 | +#ifdef _RTL8187_EXT_PATCH_ | |
10551 | + | |
10552 | +// based on ieee80211_assoc_resp | |
10553 | +struct sk_buff* ieee80211_assoc_resp_by_net(struct ieee80211_device *ieee, u8 *dest, unsigned short status, struct ieee80211_network *pstat, int pkt_type) | |
10554 | +{ | |
10555 | + struct sk_buff *skb; | |
10556 | + u8* tag; | |
10557 | + | |
10558 | + struct ieee80211_crypt_data* crypt; | |
10559 | + struct ieee80211_assoc_response_frame *assoc; | |
10560 | + short encrypt; | |
10561 | + | |
10562 | + unsigned int rate_len = ieee80211_MFIE_rate_len(ieee); | |
10563 | + int len = sizeof(struct ieee80211_assoc_response_frame) + rate_len; | |
10564 | + | |
10565 | + if(ieee->iw_mode == ieee->iw_ext_mode) | |
10566 | + skb = dev_alloc_skb(len+256); // stanley | |
10567 | + else | |
10568 | + skb = dev_alloc_skb(len); | |
10569 | + | |
10570 | + if (!skb) | |
10571 | + return NULL; | |
10572 | + | |
10573 | + assoc = (struct ieee80211_assoc_response_frame *) | |
10574 | + skb_put(skb,sizeof(struct ieee80211_assoc_response_frame)); | |
10575 | + | |
10576 | + assoc->header.frame_ctl = cpu_to_le16(pkt_type); | |
10577 | + | |
10578 | + memcpy(assoc->header.addr1, dest,ETH_ALEN); | |
10579 | + memcpy(assoc->header.addr3, ieee->dev->dev_addr, ETH_ALEN); | |
10580 | + memcpy(assoc->header.addr2, ieee->dev->dev_addr, ETH_ALEN); | |
10581 | + assoc->capability = cpu_to_le16(ieee->iw_mode == IW_MODE_MASTER ? | |
10582 | + WLAN_CAPABILITY_BSS : WLAN_CAPABILITY_IBSS); | |
10583 | + | |
10584 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_assoc_resp_by_net_1) | |
10585 | + ieee->ext_patch_ieee80211_assoc_resp_by_net_1(assoc); | |
10586 | + | |
10587 | + if(ieee->short_slot) | |
10588 | + assoc->capability |= cpu_to_le16(WLAN_CAPABILITY_SHORT_SLOT); | |
10589 | + | |
10590 | + if (ieee->host_encrypt) | |
10591 | + crypt = ieee->crypt[ieee->tx_keyidx]; | |
10592 | + else crypt = NULL; | |
10593 | + | |
10594 | + encrypt = ( crypt && crypt->ops); | |
10595 | + | |
10596 | + if (encrypt) | |
10597 | + assoc->capability |= cpu_to_le16(WLAN_CAPABILITY_PRIVACY); | |
10598 | + | |
10599 | + assoc->status = 0; | |
10600 | + assoc->aid = cpu_to_le16(ieee->assoc_id); | |
10601 | + if (ieee->assoc_id == 0x2007) ieee->assoc_id=0; | |
10602 | + else ieee->assoc_id++; | |
10603 | + | |
10604 | + assoc->info_element.id = 230; // Stanley, an unused id (just a hot fix) | |
10605 | + assoc->info_element.len = 0; | |
10606 | + | |
10607 | + tag = (u8*) skb_put(skb, rate_len); | |
10608 | + | |
10609 | + ieee80211_MFIE_Brate(ieee, &tag); | |
10610 | + ieee80211_MFIE_Grate(ieee, &tag); | |
10611 | + | |
10612 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_assoc_resp_by_net_2) | |
10613 | + ieee->ext_patch_ieee80211_assoc_resp_by_net_2(ieee, pstat, pkt_type, skb); | |
10614 | + | |
10615 | + return skb; | |
10616 | +} | |
10617 | + | |
10618 | +// based on ieee80211_resp_to_assoc_rq | |
10619 | +void ieee80211_ext_issue_assoc_rsp(struct ieee80211_device *ieee, u8 *dest, unsigned short status, struct ieee80211_network *pstat, int pkt_type) | |
10620 | +{ | |
10621 | + struct sk_buff *buf = ieee80211_assoc_resp_by_net(ieee, dest, status, pstat, pkt_type); | |
10622 | + | |
10623 | + if (buf) | |
10624 | + softmac_mgmt_xmit(buf, ieee); | |
10625 | +} | |
10626 | + | |
10627 | +// based on ieee80211_associate_step2 | |
10628 | +void ieee80211_ext_issue_assoc_req(struct ieee80211_device *ieee, struct ieee80211_network *pstat) | |
10629 | +{ | |
10630 | + | |
10631 | + struct sk_buff* skb; | |
10632 | + | |
10633 | + // printk("@@@@@ ieee80211_ext_issue_assoc_req on channel: %d\n", ieee->current_network.channel); | |
10634 | + | |
10635 | + ieee->softmac_stats.tx_ass_rq++; | |
10636 | + skb=ieee80211_association_req(pstat, ieee); | |
10637 | + if (skb) | |
10638 | + softmac_mgmt_xmit(skb, ieee); | |
10639 | +} | |
10640 | + | |
10641 | +void ieee80211_ext_issue_disassoc(struct ieee80211_device *ieee, struct ieee80211_network *pstat, int reason, unsigned char extReason) | |
10642 | +{ | |
10643 | + // do nothing | |
10644 | + // printk("@@@@@ ieee80211_ext_issue_disassoc\n"); | |
10645 | + return; | |
10646 | +} | |
10647 | +#endif // _RTL8187_EXT_PATCH_ | |
10648 | + | |
10649 | +void ieee80211_associate_step2(struct ieee80211_device *ieee) | |
10650 | +{ | |
10651 | + struct sk_buff* skb; | |
10652 | + struct ieee80211_network *beacon = &ieee->current_network; | |
10653 | + | |
10654 | + del_timer_sync(&ieee->associate_timer); | |
10655 | + | |
10656 | + IEEE80211_DEBUG_MGMT("Sending association request\n"); | |
10657 | + ieee->softmac_stats.tx_ass_rq++; | |
10658 | + skb=ieee80211_association_req(beacon, ieee); | |
10659 | + if (!skb) | |
10660 | + ieee80211_associate_abort(ieee); | |
10661 | + else{ | |
10662 | + softmac_mgmt_xmit(skb, ieee); | |
10663 | + if (!timer_pending(&ieee->associate_timer)){ | |
10664 | + ieee->associate_timer.expires = jiffies + (HZ / 2); | |
10665 | + add_timer(&ieee->associate_timer); | |
10666 | + } | |
10667 | + //dev_kfree_skb_any(skb);//edit by thomas | |
10668 | + } | |
10669 | +} | |
10670 | + | |
10671 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
10672 | +void ieee80211_associate_complete_wq(struct work_struct *work) | |
10673 | +{ | |
10674 | + struct ieee80211_device *ieee = container_of(work, struct ieee80211_device, associate_complete_wq); | |
10675 | +#else | |
10676 | +void ieee80211_associate_complete_wq(struct ieee80211_device *ieee) | |
10677 | +{ | |
10678 | +#endif | |
10679 | + printk(KERN_INFO "Associated successfully\n"); | |
10680 | + if(ieee80211_is_54g(ieee->current_network) && | |
10681 | + (ieee->modulation & IEEE80211_OFDM_MODULATION)){ | |
10682 | + | |
10683 | + ieee->rate = 540; | |
10684 | + printk(KERN_INFO"Using G rates\n"); | |
10685 | + }else{ | |
10686 | + ieee->rate = 110; | |
10687 | + printk(KERN_INFO"Using B rates\n"); | |
10688 | + } | |
10689 | + ieee->link_change(ieee->dev); | |
10690 | + notify_wx_assoc_event(ieee); | |
10691 | + if (ieee->data_hard_resume) | |
10692 | + ieee->data_hard_resume(ieee->dev); | |
10693 | + netif_carrier_on(ieee->dev); | |
10694 | +} | |
10695 | + | |
10696 | +void ieee80211_associate_complete(struct ieee80211_device *ieee) | |
10697 | +{ | |
10698 | + int i; | |
10699 | + del_timer_sync(&ieee->associate_timer); | |
10700 | + | |
10701 | + for(i = 0; i < 6; i++) { | |
10702 | + //ieee->seq_ctrl[i] = 0; | |
10703 | + } | |
10704 | + ieee->state = IEEE80211_LINKED; | |
10705 | + IEEE80211_DEBUG_MGMT("Successfully associated\n"); | |
10706 | + | |
10707 | + queue_work(ieee->wq, &ieee->associate_complete_wq); | |
10708 | +} | |
10709 | + | |
10710 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
10711 | +void ieee80211_associate_procedure_wq(struct work_struct *work) | |
10712 | +{ | |
10713 | + struct ieee80211_device *ieee = container_of(work, struct ieee80211_device, associate_procedure_wq); | |
10714 | +#else | |
10715 | +void ieee80211_associate_procedure_wq(struct ieee80211_device *ieee) | |
10716 | +{ | |
10717 | +#endif | |
10718 | + ieee->sync_scan_hurryup = 1; | |
10719 | + down(&ieee->wx_sem); | |
10720 | + | |
10721 | + if (ieee->data_hard_stop) | |
10722 | + ieee->data_hard_stop(ieee->dev); | |
10723 | + | |
10724 | + ieee80211_stop_scan(ieee); | |
10725 | + ieee->set_chan(ieee->dev, ieee->current_network.channel); | |
10726 | + | |
10727 | + ieee->associate_seq = 1; | |
10728 | + ieee80211_associate_step1(ieee); | |
10729 | + | |
10730 | + up(&ieee->wx_sem); | |
10731 | +} | |
10732 | +#ifdef _RTL8187_EXT_PATCH_ | |
10733 | +// based on ieee80211_associate_procedure_wq | |
10734 | + | |
10735 | +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20) | |
10736 | +void ieee80211_ext_stop_scan_wq(struct work_struct *work) | |
10737 | +{ | |
10738 | + struct ieee80211_device *ieee = container_of(work, struct ieee80211_device, ext_stop_scan_wq); | |
10739 | +#else | |
10740 | +void ieee80211_ext_stop_scan_wq(struct ieee80211_device *ieee) | |
10741 | +{ | |
10742 | +#endif | |
10743 | + if (ieee->scanning == 0) | |
10744 | + { | |
10745 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_ext_stop_scan_wq_set_channel | |
10746 | + && ( ieee->current_network.channel == ieee->ext_patch_ieee80211_ext_stop_scan_wq_set_channel(ieee) ) ) | |
10747 | + return; | |
10748 | + } | |
10749 | + | |
10750 | + ieee->sync_scan_hurryup = 1; | |
10751 | + | |
10752 | + down(&ieee->wx_sem); | |
10753 | + | |
10754 | + // printk("@@@@@@@@@@ ieee80211_ext_stop_scan_wq\n"); | |
10755 | + if (ieee->data_hard_stop) | |
10756 | + ieee->data_hard_stop(ieee->dev); | |
10757 | + | |
10758 | + ieee80211_stop_scan(ieee); | |
10759 | + | |
10760 | + // set channel | |
10761 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_ext_stop_scan_wq_set_channel) | |
10762 | + ieee->set_chan(ieee->dev, ieee->ext_patch_ieee80211_ext_stop_scan_wq_set_channel(ieee)); | |
10763 | + else | |
10764 | + ieee->set_chan(ieee->dev, ieee->current_network.channel); | |
10765 | + // | |
10766 | + up(&ieee->wx_sem); | |
10767 | +} | |
10768 | + | |
10769 | + | |
10770 | +void ieee80211_ext_send_11s_beacon(struct ieee80211_device *ieee) | |
10771 | +{ | |
10772 | + #if LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0) | |
10773 | + queue_work(ieee->wq, &ieee->ext_send_beacon_wq); | |
10774 | + #else | |
10775 | + schedule_task(&ieee->ext_send_beacon_wq); | |
10776 | + #endif | |
10777 | + | |
10778 | +} | |
10779 | + | |
10780 | +#endif // _RTL8187_EXT_PATCH_ | |
10781 | + | |
10782 | +inline void ieee80211_softmac_new_net(struct ieee80211_device *ieee, struct ieee80211_network *net) | |
10783 | +{ | |
10784 | + u8 tmp_ssid[IW_ESSID_MAX_SIZE+1]; | |
10785 | + int tmp_ssid_len = 0; | |
10786 | + | |
10787 | + short apset,ssidset,ssidbroad,apmatch,ssidmatch; | |
10788 | + | |
10789 | + /* we are interested in new new only if we are not associated | |
10790 | + * and we are not associating / authenticating | |
10791 | + */ | |
10792 | + if (ieee->state != IEEE80211_NOLINK) | |
10793 | + return; | |
10794 | + | |
10795 | + if ((ieee->iw_mode == IW_MODE_INFRA) && !(net->capability & WLAN_CAPABILITY_BSS)) | |
10796 | + return; | |
10797 | + | |
10798 | + if ((ieee->iw_mode == IW_MODE_ADHOC) && !(net->capability & WLAN_CAPABILITY_IBSS)) | |
10799 | + return; | |
10800 | + | |
10801 | + | |
10802 | + if (ieee->iw_mode == IW_MODE_INFRA || ieee->iw_mode == IW_MODE_ADHOC){ | |
10803 | + /* if the user specified the AP MAC, we need also the essid | |
10804 | + * This could be obtained by beacons or, if the network does not | |
10805 | + * broadcast it, it can be put manually. | |
10806 | + */ | |
10807 | + apset = ieee->wap_set;//(memcmp(ieee->current_network.bssid, zero,ETH_ALEN)!=0 ); | |
10808 | + ssidset = ieee->ssid_set;//ieee->current_network.ssid[0] != '\0'; | |
10809 | + ssidbroad = !(net->ssid_len == 0 || net->ssid[0]== '\0'); | |
10810 | + apmatch = (memcmp(ieee->current_network.bssid, net->bssid, ETH_ALEN)==0); | |
10811 | + | |
10812 | + if(ieee->current_network.ssid_len != net->ssid_len) | |
10813 | + ssidmatch = 0; | |
10814 | + else | |
10815 | + ssidmatch = (0==strncmp(ieee->current_network.ssid, net->ssid, net->ssid_len)); | |
10816 | + | |
10817 | + //printk("cur: %s, %d, net:%s, %d\n", ieee->current_network.ssid, ieee->current_network.ssid_len, net->ssid, net->ssid_len); | |
10818 | + //printk("apset=%d apmatch=%d ssidset=%d ssidbroad=%d ssidmatch=%d\n",apset,apmatch,ssidset,ssidbroad,ssidmatch); | |
10819 | + | |
10820 | + if ( /* if the user set the AP check if match. | |
10821 | + * if the network does not broadcast essid we check the user supplyed ANY essid | |
10822 | + * if the network does broadcast and the user does not set essid it is OK | |
10823 | + * if the network does broadcast and the user did set essid chech if essid match | |
10824 | + */ | |
10825 | + ( apset && apmatch && | |
10826 | + ((ssidset && ssidbroad && ssidmatch) || (ssidbroad && !ssidset) || (!ssidbroad && ssidset)) ) || | |
10827 | + /* if the ap is not set, check that the user set the bssid | |
10828 | + * and the network does bradcast and that those two bssid matches | |
10829 | + */ | |
10830 | + (!apset && ssidset && ssidbroad && ssidmatch) | |
10831 | + ){ | |
10832 | + | |
10833 | + | |
10834 | + /* if the essid is hidden replace it with the | |
10835 | + * essid provided by the user. | |
10836 | + */ | |
10837 | + if (!ssidbroad){ | |
10838 | + strncpy(tmp_ssid, ieee->current_network.ssid, IW_ESSID_MAX_SIZE); | |
10839 | + tmp_ssid_len = ieee->current_network.ssid_len; | |
10840 | + } | |
10841 | + memcpy(&ieee->current_network, net, sizeof(struct ieee80211_network)); | |
10842 | + | |
10843 | + if (!ssidbroad){ | |
10844 | + strncpy(ieee->current_network.ssid, tmp_ssid, IW_ESSID_MAX_SIZE); | |
10845 | + ieee->current_network.ssid_len = tmp_ssid_len; | |
10846 | + } | |
10847 | + printk(KERN_INFO"Linking with %s: channel is %d\n",ieee->current_network.ssid,ieee->current_network.channel); | |
10848 | + | |
10849 | + if (ieee->iw_mode == IW_MODE_INFRA){ | |
10850 | + ieee->state = IEEE80211_ASSOCIATING; | |
10851 | + ieee->beinretry = false; | |
10852 | + queue_work(ieee->wq, &ieee->associate_procedure_wq); | |
10853 | + }else{ | |
10854 | + if(ieee80211_is_54g(ieee->current_network) && | |
10855 | + (ieee->modulation & IEEE80211_OFDM_MODULATION)){ | |
10856 | + ieee->rate = 540; | |
10857 | + printk(KERN_INFO"Using G rates\n"); | |
10858 | + }else{ | |
10859 | + ieee->rate = 110; | |
10860 | + printk(KERN_INFO"Using B rates\n"); | |
10861 | + } | |
10862 | + ieee->state = IEEE80211_LINKED; | |
10863 | + ieee->beinretry = false; | |
10864 | + } | |
10865 | + | |
10866 | + } | |
10867 | + } | |
10868 | + | |
10869 | +} | |
10870 | + | |
10871 | +void ieee80211_softmac_check_all_nets(struct ieee80211_device *ieee) | |
10872 | +{ | |
10873 | + unsigned long flags; | |
10874 | + struct ieee80211_network *target; | |
10875 | + | |
10876 | + spin_lock_irqsave(&ieee->lock, flags); | |
10877 | + list_for_each_entry(target, &ieee->network_list, list) { | |
10878 | + | |
10879 | + /* if the state become different that NOLINK means | |
10880 | + * we had found what we are searching for | |
10881 | + */ | |
10882 | + | |
10883 | + if (ieee->state != IEEE80211_NOLINK) | |
10884 | + break; | |
10885 | + | |
10886 | + if (ieee->scan_age == 0 || time_after(target->last_scanned + ieee->scan_age, jiffies)) | |
10887 | + ieee80211_softmac_new_net(ieee, target); | |
10888 | + } | |
10889 | + | |
10890 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
10891 | + | |
10892 | +} | |
10893 | + | |
10894 | + | |
10895 | +static inline u16 auth_parse(struct sk_buff *skb, u8** challenge, int *chlen) | |
10896 | +{ | |
10897 | + struct ieee80211_authentication *a; | |
10898 | + u8 *t; | |
10899 | + if (skb->len < (sizeof(struct ieee80211_authentication)-sizeof(struct ieee80211_info_element))){ | |
10900 | + IEEE80211_DEBUG_MGMT("invalid len in auth resp: %d\n",skb->len); | |
10901 | + return 0xcafe; | |
10902 | + } | |
10903 | + *challenge = NULL; | |
10904 | + a = (struct ieee80211_authentication*) skb->data; | |
10905 | + if(skb->len > (sizeof(struct ieee80211_authentication) +3)){ | |
10906 | + t = skb->data + sizeof(struct ieee80211_authentication); | |
10907 | + | |
10908 | + if(*(t++) == MFIE_TYPE_CHALLENGE){ | |
10909 | + *chlen = *(t++); | |
10910 | + *challenge = (u8*)kmalloc(*chlen, GFP_ATOMIC); | |
10911 | + memcpy(*challenge, t, *chlen); | |
10912 | + } | |
10913 | + } | |
10914 | + | |
10915 | + return cpu_to_le16(a->status); | |
10916 | + | |
10917 | +} | |
10918 | + | |
10919 | + | |
10920 | +int auth_rq_parse(struct sk_buff *skb,u8* dest) | |
10921 | +{ | |
10922 | + struct ieee80211_authentication *a; | |
10923 | + | |
10924 | + if (skb->len < (sizeof(struct ieee80211_authentication)-sizeof(struct ieee80211_info_element))){ | |
10925 | + IEEE80211_DEBUG_MGMT("invalid len in auth request: %d\n",skb->len); | |
10926 | + return -1; | |
10927 | + } | |
10928 | + a = (struct ieee80211_authentication*) skb->data; | |
10929 | + | |
10930 | + memcpy(dest,a->header.addr2, ETH_ALEN); | |
10931 | + | |
10932 | + if (le16_to_cpu(a->algorithm) != WLAN_AUTH_OPEN) | |
10933 | + return WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG; | |
10934 | + | |
10935 | + return WLAN_STATUS_SUCCESS; | |
10936 | +} | |
10937 | + | |
10938 | +static short probe_rq_parse(struct ieee80211_device *ieee, struct sk_buff *skb, u8 *src) | |
10939 | +{ | |
10940 | + u8 *tag; | |
10941 | + u8 *skbend; | |
10942 | + u8 *ssid=NULL; | |
10943 | + u8 ssidlen = 0; | |
10944 | + | |
10945 | + struct ieee80211_hdr_3addr *header = | |
10946 | + (struct ieee80211_hdr_3addr *) skb->data; | |
10947 | + | |
10948 | + if (skb->len < sizeof (struct ieee80211_hdr_3addr )) | |
10949 | + return -1; /* corrupted */ | |
10950 | + | |
10951 | + memcpy(src,header->addr2, ETH_ALEN); | |
10952 | + | |
10953 | + skbend = (u8*)skb->data + skb->len; | |
10954 | + | |
10955 | + tag = skb->data + sizeof (struct ieee80211_hdr_3addr ); | |
10956 | + | |
10957 | + while (tag+1 < skbend){ | |
10958 | + if (*tag == 0){ | |
10959 | + ssid = tag+2; | |
10960 | + ssidlen = *(tag+1); | |
10961 | + break; | |
10962 | + } | |
10963 | + tag++; /* point to the len field */ | |
10964 | + tag = tag + *(tag); /* point to the last data byte of the tag */ | |
10965 | + tag++; /* point to the next tag */ | |
10966 | + } | |
10967 | + | |
10968 | + //IEEE80211DMESG("Card MAC address is "MACSTR, MAC2STR(src)); | |
10969 | + if (ssidlen == 0) return 1; | |
10970 | + | |
10971 | + if (!ssid) return 1; /* ssid not found in tagged param */ | |
10972 | + return (!strncmp(ssid, ieee->current_network.ssid, ssidlen)); | |
10973 | + | |
10974 | +} | |
10975 | + | |
10976 | +int assoc_rq_parse(struct sk_buff *skb,u8* dest) | |
10977 | +{ | |
10978 | + struct ieee80211_assoc_request_frame *a; | |
10979 | + | |
10980 | + if (skb->len < (sizeof(struct ieee80211_assoc_request_frame) - | |
10981 | + sizeof(struct ieee80211_info_element))) { | |
10982 | + | |
10983 | + IEEE80211_DEBUG_MGMT("invalid len in auth request:%d \n", skb->len); | |
10984 | + return -1; | |
10985 | + } | |
10986 | + | |
10987 | + a = (struct ieee80211_assoc_request_frame*) skb->data; | |
10988 | + | |
10989 | + memcpy(dest,a->header.addr2,ETH_ALEN); | |
10990 | + | |
10991 | + return 0; | |
10992 | +} | |
10993 | + | |
10994 | +static inline u16 assoc_parse(struct sk_buff *skb, int *aid) | |
10995 | +{ | |
10996 | + struct ieee80211_assoc_response_frame *a; | |
10997 | + if (skb->len < sizeof(struct ieee80211_assoc_response_frame)){ | |
10998 | + IEEE80211_DEBUG_MGMT("invalid len in auth resp: %d\n", skb->len); | |
10999 | + return 0xcafe; | |
11000 | + } | |
11001 | + | |
11002 | + a = (struct ieee80211_assoc_response_frame*) skb->data; | |
11003 | + *aid = le16_to_cpu(a->aid) & 0x3fff; | |
11004 | + return le16_to_cpu(a->status); | |
11005 | +} | |
11006 | + | |
11007 | +static inline void | |
11008 | +ieee80211_rx_probe_rq(struct ieee80211_device *ieee, struct sk_buff *skb) | |
11009 | +{ | |
11010 | + u8 dest[ETH_ALEN]; | |
11011 | + | |
11012 | + //IEEE80211DMESG("Rx probe"); | |
11013 | + ieee->softmac_stats.rx_probe_rq++; | |
11014 | + //DMESG("Dest is "MACSTR, MAC2STR(dest)); | |
11015 | + if (probe_rq_parse(ieee, skb, dest)){ | |
11016 | + //IEEE80211DMESG("Was for me!"); | |
11017 | + ieee->softmac_stats.tx_probe_rs++; | |
11018 | + ieee80211_resp_to_probe(ieee, dest); | |
11019 | + } | |
11020 | +} | |
11021 | + | |
11022 | +inline void | |
11023 | +ieee80211_rx_auth_rq(struct ieee80211_device *ieee, struct sk_buff *skb) | |
11024 | +{ | |
11025 | + u8 dest[ETH_ALEN]; | |
11026 | + int status; | |
11027 | + //IEEE80211DMESG("Rx probe"); | |
11028 | + ieee->softmac_stats.rx_auth_rq++; | |
11029 | + | |
11030 | + if ((status = auth_rq_parse(skb, dest))!= -1){ | |
11031 | + ieee80211_resp_to_auth(ieee, status, dest); | |
11032 | + } | |
11033 | + //DMESG("Dest is "MACSTR, MAC2STR(dest)); | |
11034 | + | |
11035 | +} | |
11036 | + | |
11037 | + inline void | |
11038 | +ieee80211_rx_assoc_rq(struct ieee80211_device *ieee, struct sk_buff *skb) | |
11039 | +{ | |
11040 | + | |
11041 | + u8 dest[ETH_ALEN]; | |
11042 | + //unsigned long flags; | |
11043 | + | |
11044 | + ieee->softmac_stats.rx_ass_rq++; | |
11045 | + if (assoc_rq_parse(skb,dest) != -1){ | |
11046 | + ieee80211_resp_to_assoc_rq(ieee, dest); | |
11047 | + } | |
11048 | + | |
11049 | + printk(KERN_INFO"New client associated: "MAC_FMT"\n", MAC_ARG(dest)); | |
11050 | + //FIXME | |
11051 | + #if 0 | |
11052 | + spin_lock_irqsave(&ieee->lock,flags); | |
11053 | + add_associate(ieee,dest); | |
11054 | + spin_unlock_irqrestore(&ieee->lock,flags); | |
11055 | + #endif | |
11056 | +} | |
11057 | + | |
11058 | + | |
11059 | + | |
11060 | +void ieee80211_sta_ps_send_null_frame(struct ieee80211_device *ieee, short pwr) | |
11061 | +{ | |
11062 | + | |
11063 | + struct sk_buff *buf = ieee80211_null_func(ieee, pwr); | |
11064 | + | |
11065 | + if (buf) | |
11066 | + softmac_ps_mgmt_xmit(buf, ieee); | |
11067 | + | |
11068 | +} | |
11069 | + | |
11070 | + | |
11071 | +short ieee80211_sta_ps_sleep(struct ieee80211_device *ieee, u32 *time_h, u32 *time_l) | |
11072 | +{ | |
11073 | +#if 0 | |
11074 | + int timeout = ieee->ps_timeout; | |
11075 | +#else | |
11076 | + int timeout = 0; | |
11077 | +#endif | |
11078 | + u8 dtim; | |
11079 | + /*if(ieee->ps == IEEE80211_PS_DISABLED || | |
11080 | + ieee->iw_mode != IW_MODE_INFRA || | |
11081 | + ieee->state != IEEE80211_LINKED) | |
11082 | + | |
11083 | + return 0; | |
11084 | + */ | |
11085 | + dtim = ieee->current_network.dtim_data; | |
11086 | + //printk("DTIM\n"); | |
11087 | + | |
11088 | + if(!(dtim & IEEE80211_DTIM_VALID)) | |
11089 | + return 0; | |
11090 | + else | |
11091 | + timeout = ieee->current_network.beacon_interval; | |
11092 | + | |
11093 | + //printk("VALID\n"); | |
11094 | + ieee->current_network.dtim_data = IEEE80211_DTIM_INVALID; | |
11095 | + | |
11096 | + if(dtim & ((IEEE80211_DTIM_UCAST | IEEE80211_DTIM_MBCAST)& ieee->ps)) | |
11097 | + return 2; | |
11098 | + | |
11099 | + if(!time_after(jiffies, ieee->dev->trans_start + MSECS(timeout))) | |
11100 | + return 0; | |
11101 | + | |
11102 | + if(!time_after(jiffies, ieee->last_rx_ps_time + MSECS(timeout))) | |
11103 | + return 0; | |
11104 | + | |
11105 | + if((ieee->softmac_features & IEEE_SOFTMAC_SINGLE_QUEUE ) && | |
11106 | + (ieee->mgmt_queue_tail != ieee->mgmt_queue_head)) | |
11107 | + return 0; | |
11108 | +#if 0 | |
11109 | + if(time_l){ | |
11110 | + *time_l = ieee->current_network.last_dtim_sta_time[0] | |
11111 | + + (ieee->current_network.beacon_interval | |
11112 | + * ieee->current_network.dtim_period) * 1000; | |
11113 | + } | |
11114 | +#else | |
11115 | + if(time_l){ | |
11116 | + *time_l = ieee->current_network.last_dtim_sta_time[0] | |
11117 | + + MSECS((ieee->current_network.beacon_interval)); | |
11118 | + //* ieee->current_network.dtim_period)); | |
11119 | + //printk("beacon_interval:%x, dtim_period:%x, totol to Msecs:%x, HZ:%x\n", ieee->current_network.beacon_interval, ieee->current_network.dtim_period, MSECS(((ieee->current_network.beacon_interval * ieee->current_network.dtim_period))), HZ); | |
11120 | + } | |
11121 | + | |
11122 | +#endif | |
11123 | + if(time_h){ | |
11124 | + *time_h = ieee->current_network.last_dtim_sta_time[1]; | |
11125 | + if(time_l && *time_l < ieee->current_network.last_dtim_sta_time[0]) | |
11126 | + *time_h += 1; | |
11127 | + } | |
11128 | + | |
11129 | + return 1; | |
11130 | + | |
11131 | + | |
11132 | +} | |
11133 | + | |
11134 | +inline void ieee80211_sta_ps(struct ieee80211_device *ieee) | |
11135 | +{ | |
11136 | + | |
11137 | + u32 th,tl; | |
11138 | + short sleep; | |
11139 | + | |
11140 | + unsigned long flags,flags2; | |
11141 | + | |
11142 | + spin_lock_irqsave(&ieee->lock, flags); | |
11143 | + | |
11144 | + if((ieee->ps == IEEE80211_PS_DISABLED || | |
11145 | + | |
11146 | + ieee->iw_mode != IW_MODE_INFRA || | |
11147 | + ieee->state != IEEE80211_LINKED)){ | |
11148 | + | |
11149 | + //#warning CHECK_LOCK_HERE | |
11150 | + spin_lock_irqsave(&ieee->mgmt_tx_lock, flags2); | |
11151 | + | |
11152 | + ieee80211_sta_wakeup(ieee, 1); | |
11153 | + | |
11154 | + spin_unlock_irqrestore(&ieee->mgmt_tx_lock, flags2); | |
11155 | + } | |
11156 | + | |
11157 | + sleep = ieee80211_sta_ps_sleep(ieee,&th, &tl); | |
11158 | +// printk("===>%s,%d[2 wake, 1 sleep, 0 do nothing], ieee->sta_sleep = %d\n",__FUNCTION__, sleep,ieee->sta_sleep); | |
11159 | + /* 2 wake, 1 sleep, 0 do nothing */ | |
11160 | + if(sleep == 0) | |
11161 | + goto out; | |
11162 | + | |
11163 | + if(sleep == 1){ | |
11164 | + | |
11165 | + if(ieee->sta_sleep == 1) | |
11166 | + ieee->enter_sleep_state(ieee->dev,th,tl); | |
11167 | + | |
11168 | + else if(ieee->sta_sleep == 0){ | |
11169 | + // printk("send null 1\n"); | |
11170 | + spin_lock_irqsave(&ieee->mgmt_tx_lock, flags2); | |
11171 | + | |
11172 | + if(ieee->ps_is_queue_empty(ieee->dev)){ | |
11173 | + | |
11174 | + | |
11175 | + ieee->sta_sleep = 2; | |
11176 | + | |
11177 | + ieee->ps_request_tx_ack(ieee->dev); | |
11178 | + | |
11179 | + ieee80211_sta_ps_send_null_frame(ieee,1); | |
11180 | + | |
11181 | + ieee->ps_th = th; | |
11182 | + ieee->ps_tl = tl; | |
11183 | + } | |
11184 | + spin_unlock_irqrestore(&ieee->mgmt_tx_lock, flags2); | |
11185 | + | |
11186 | + } | |
11187 | + | |
11188 | + | |
11189 | + }else if(sleep == 2){ | |
11190 | +//#warning CHECK_LOCK_HERE | |
11191 | + spin_lock_irqsave(&ieee->mgmt_tx_lock, flags2); | |
11192 | + | |
11193 | + // printk("send wakeup packet\n"); | |
11194 | + ieee80211_sta_wakeup(ieee,1); | |
11195 | + | |
11196 | + spin_unlock_irqrestore(&ieee->mgmt_tx_lock, flags2); | |
11197 | + } | |
11198 | + | |
11199 | +out: | |
11200 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
11201 | + | |
11202 | +} | |
11203 | + | |
11204 | +void ieee80211_sta_wakeup(struct ieee80211_device *ieee, short nl) | |
11205 | +{ | |
11206 | + if(ieee->sta_sleep == 0){ | |
11207 | + if(nl){ | |
11208 | + // printk("Warning: driver is probably failing to report TX ps error\n"); | |
11209 | + ieee->ps_request_tx_ack(ieee->dev); | |
11210 | + ieee80211_sta_ps_send_null_frame(ieee, 0); | |
11211 | + } | |
11212 | + return; | |
11213 | + | |
11214 | + } | |
11215 | + | |
11216 | + if(ieee->sta_sleep == 1) | |
11217 | + ieee->sta_wake_up(ieee->dev); | |
11218 | + | |
11219 | + ieee->sta_sleep = 0; | |
11220 | + | |
11221 | + if(nl){ | |
11222 | + ieee->ps_request_tx_ack(ieee->dev); | |
11223 | + ieee80211_sta_ps_send_null_frame(ieee, 0); | |
11224 | + } | |
11225 | +} | |
11226 | + | |
11227 | +void ieee80211_ps_tx_ack(struct ieee80211_device *ieee, short success) | |
11228 | +{ | |
11229 | + unsigned long flags,flags2; | |
11230 | + | |
11231 | + spin_lock_irqsave(&ieee->lock, flags); | |
11232 | + if(ieee->sta_sleep == 2){ | |
11233 | + /* Null frame with PS bit set */ | |
11234 | + if(success){ | |
11235 | + | |
11236 | + // printk("==================> %s::enter sleep state\n",__FUNCTION__); | |
11237 | + ieee->sta_sleep = 1; | |
11238 | + ieee->enter_sleep_state(ieee->dev,ieee->ps_th,ieee->ps_tl); | |
11239 | + } | |
11240 | + /* if the card report not success we can't be sure the AP | |
11241 | + * has not RXed so we can't assume the AP believe us awake | |
11242 | + */ | |
11243 | + } | |
11244 | + /* 21112005 - tx again null without PS bit if lost */ | |
11245 | + else { | |
11246 | + | |
11247 | + if((ieee->sta_sleep == 0) && !success){ | |
11248 | + spin_lock_irqsave(&ieee->mgmt_tx_lock, flags2); | |
11249 | + ieee80211_sta_ps_send_null_frame(ieee, 0); | |
11250 | + spin_unlock_irqrestore(&ieee->mgmt_tx_lock, flags2); | |
11251 | + } | |
11252 | + } | |
11253 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
11254 | +} | |
11255 | + | |
11256 | +inline int | |
11257 | +ieee80211_rx_frame_softmac(struct ieee80211_device *ieee, struct sk_buff *skb, | |
11258 | + struct ieee80211_rx_stats *rx_stats, u16 type, | |
11259 | + u16 stype) | |
11260 | +{ | |
11261 | + struct ieee80211_hdr_3addr *header = (struct ieee80211_hdr_3addr *) skb->data; | |
11262 | + u16 errcode; | |
11263 | + u8* challenge=NULL; | |
11264 | + int chlen=0; | |
11265 | + int aid=0; | |
11266 | + struct ieee80211_assoc_response_frame *assoc_resp; | |
11267 | + struct ieee80211_info_element *info_element; | |
11268 | + | |
11269 | + if(!ieee->proto_started) | |
11270 | + return 0; | |
11271 | + | |
11272 | + if(ieee->sta_sleep || (ieee->ps != IEEE80211_PS_DISABLED && | |
11273 | + ieee->iw_mode == IW_MODE_INFRA && | |
11274 | + ieee->state == IEEE80211_LINKED)) | |
11275 | + | |
11276 | + tasklet_schedule(&ieee->ps_task); | |
11277 | + | |
11278 | + if(WLAN_FC_GET_STYPE(header->frame_ctl) != IEEE80211_STYPE_PROBE_RESP && | |
11279 | + WLAN_FC_GET_STYPE(header->frame_ctl) != IEEE80211_STYPE_BEACON) | |
11280 | + ieee->last_rx_ps_time = jiffies; | |
11281 | + | |
11282 | + switch (WLAN_FC_GET_STYPE(header->frame_ctl)) { | |
11283 | + | |
11284 | + case IEEE80211_STYPE_ASSOC_RESP: | |
11285 | + case IEEE80211_STYPE_REASSOC_RESP: | |
11286 | + | |
11287 | + IEEE80211_DEBUG_MGMT("received [RE]ASSOCIATION RESPONSE (%d)\n", | |
11288 | + WLAN_FC_GET_STYPE(header->frame_ctl)); | |
11289 | + if ((ieee->softmac_features & IEEE_SOFTMAC_ASSOCIATE) && | |
11290 | + ieee->state == IEEE80211_ASSOCIATING_AUTHENTICATED && | |
11291 | + ieee->iw_mode == IW_MODE_INFRA){ | |
11292 | + if (0 == (errcode=assoc_parse(skb, &aid))){ | |
11293 | + u16 left; | |
11294 | + | |
11295 | + ieee->state=IEEE80211_LINKED; | |
11296 | + ieee->assoc_id = aid; | |
11297 | + ieee->softmac_stats.rx_ass_ok++; | |
11298 | + | |
11299 | + //printk(KERN_WARNING "nic_type = %s", (rx_stats->nic_type == 1)?"rtl8187":"rtl8187B"); | |
11300 | + if(1 == rx_stats->nic_type) //card type is 8187 | |
11301 | + { | |
11302 | + goto associate_complete; | |
11303 | + } | |
11304 | + assoc_resp = (struct ieee80211_assoc_response_frame*)skb->data; | |
11305 | + info_element = &assoc_resp->info_element; | |
11306 | + left = skb->len - ((void*)info_element - (void*)assoc_resp); | |
11307 | + | |
11308 | + while (left >= sizeof(struct ieee80211_info_element_hdr)) { | |
11309 | + if (sizeof(struct ieee80211_info_element_hdr) + info_element->len > left) { | |
11310 | + printk(KERN_WARNING "[re]associate reeponse error!"); | |
11311 | + return 1; | |
11312 | + } | |
11313 | + switch (info_element->id) { | |
11314 | + case MFIE_TYPE_GENERIC: | |
11315 | + IEEE80211_DEBUG_SCAN("MFIE_TYPE_GENERIC: %d bytes\n", info_element->len); | |
11316 | + if (info_element->len >= 8 && | |
11317 | + info_element->data[0] == 0x00 && | |
11318 | + info_element->data[1] == 0x50 && | |
11319 | + info_element->data[2] == 0xf2 && | |
11320 | + info_element->data[3] == 0x02 && | |
11321 | + info_element->data[4] == 0x01) { | |
11322 | + // Not care about version at present. | |
11323 | + //WMM Parameter Element | |
11324 | + memcpy(ieee->current_network.wmm_param,(u8*)(info_element->data\ | |
11325 | + + 8),(info_element->len - 8)); | |
11326 | + | |
11327 | + if (((ieee->current_network.wmm_info^info_element->data[6])& \ | |
11328 | + 0x0f)||(!ieee->init_wmmparam_flag)) { | |
11329 | + //refresh paramete element for current network | |
11330 | + // update the register parameter for hardware | |
11331 | + ieee->init_wmmparam_flag = 1; | |
11332 | + queue_work(ieee->wq, &ieee->wmm_param_update_wq); | |
11333 | + | |
11334 | + } | |
11335 | + //update info_element for current network | |
11336 | + ieee->current_network.wmm_info = info_element->data[6]; | |
11337 | + } | |
11338 | + break; | |
11339 | + default: | |
11340 | + //nothing to do at present!!! | |
11341 | + break; | |
11342 | + } | |
11343 | + | |
11344 | + left -= sizeof(struct ieee80211_info_element_hdr) + | |
11345 | + info_element->len; | |
11346 | + info_element = (struct ieee80211_info_element *) | |
11347 | + &info_element->data[info_element->len]; | |
11348 | + } | |
11349 | + if(!ieee->init_wmmparam_flag) //legacy AP, reset the AC_xx_param register | |
11350 | + { | |
11351 | + queue_work(ieee->wq,&ieee->wmm_param_update_wq); | |
11352 | + ieee->init_wmmparam_flag = 1;//indicate AC_xx_param upated since last associate | |
11353 | + } | |
11354 | +associate_complete: | |
11355 | + ieee80211_associate_complete(ieee); | |
11356 | + }else{ | |
11357 | + ieee->softmac_stats.rx_ass_err++; | |
11358 | + IEEE80211_DEBUG_MGMT( | |
11359 | + "Association response status code 0x%x\n", | |
11360 | + errcode); | |
11361 | + ieee80211_associate_abort(ieee); | |
11362 | + } | |
11363 | + } | |
11364 | +#ifdef _RTL8187_EXT_PATCH_ | |
11365 | + else if ((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_rx_frame_softmac_on_assoc_rsp) | |
11366 | + { | |
11367 | + ieee->ext_patch_ieee80211_rx_frame_softmac_on_assoc_rsp(ieee, skb); | |
11368 | + } | |
11369 | +#endif | |
11370 | + break; | |
11371 | + | |
11372 | + case IEEE80211_STYPE_ASSOC_REQ: | |
11373 | + case IEEE80211_STYPE_REASSOC_REQ: | |
11374 | + | |
11375 | + if ((ieee->softmac_features & IEEE_SOFTMAC_ASSOCIATE) && | |
11376 | + ieee->iw_mode == IW_MODE_MASTER) | |
11377 | + | |
11378 | + ieee80211_rx_assoc_rq(ieee, skb); | |
11379 | +#ifdef _RTL8187_EXT_PATCH_ | |
11380 | + else if ((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_rx_frame_softmac_on_assoc_req) | |
11381 | + { | |
11382 | + ieee->ext_patch_ieee80211_rx_frame_softmac_on_assoc_req(ieee, skb); | |
11383 | + } | |
11384 | +#endif | |
11385 | + break; | |
11386 | + | |
11387 | + case IEEE80211_STYPE_AUTH: | |
11388 | + | |
11389 | +#ifdef _RTL8187_EXT_PATCH_ | |
11390 | +printk("IEEE80211_STYPE_AUTH\n"); | |
11391 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_rx_frame_softmac_on_auth) | |
11392 | + if( ieee->ext_patch_ieee80211_rx_frame_softmac_on_auth(ieee, skb, rx_stats) ); | |
11393 | +#endif | |
11394 | + if (ieee->softmac_features & IEEE_SOFTMAC_ASSOCIATE){ | |
11395 | + if (ieee->state == IEEE80211_ASSOCIATING_AUTHENTICATING && | |
11396 | + ieee->iw_mode == IW_MODE_INFRA){ | |
11397 | + | |
11398 | + IEEE80211_DEBUG_MGMT("Received authentication response"); | |
11399 | + | |
11400 | + if (0 == (errcode=auth_parse(skb, &challenge, &chlen))){ | |
11401 | + if(ieee->open_wep || !challenge){ | |
11402 | + ieee->state = IEEE80211_ASSOCIATING_AUTHENTICATED; | |
11403 | + ieee->softmac_stats.rx_auth_rs_ok++; | |
11404 | + | |
11405 | + ieee80211_associate_step2(ieee); | |
11406 | + }else{ | |
11407 | + ieee80211_auth_challenge(ieee, challenge, chlen); | |
11408 | + } | |
11409 | + }else{ | |
11410 | + ieee->softmac_stats.rx_auth_rs_err++; | |
11411 | + IEEE80211_DEBUG_MGMT("Authentication respose status code 0x%x",errcode); | |
11412 | + ieee80211_associate_abort(ieee); | |
11413 | + } | |
11414 | + | |
11415 | + }else if (ieee->iw_mode == IW_MODE_MASTER){ | |
11416 | + ieee80211_rx_auth_rq(ieee, skb); | |
11417 | + } | |
11418 | + } | |
11419 | + break; | |
11420 | + | |
11421 | + case IEEE80211_STYPE_PROBE_REQ: | |
11422 | + | |
11423 | + if ((ieee->softmac_features & IEEE_SOFTMAC_PROBERS) && | |
11424 | + ((ieee->iw_mode == IW_MODE_ADHOC || | |
11425 | + ieee->iw_mode == IW_MODE_MASTER) && | |
11426 | + ieee->state == IEEE80211_LINKED)) | |
11427 | + | |
11428 | + ieee80211_rx_probe_rq(ieee, skb); | |
11429 | + break; | |
11430 | + | |
11431 | + case IEEE80211_STYPE_DISASSOC: | |
11432 | + case IEEE80211_STYPE_DEAUTH: | |
11433 | +#ifdef _RTL8187_EXT_PATCH_ | |
11434 | +printk("IEEE80211_STYPE_DEAUTH\n"); | |
11435 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_rx_frame_softmac_on_deauth) | |
11436 | + if( ieee->ext_patch_ieee80211_rx_frame_softmac_on_deauth(ieee, skb, rx_stats) ) ; | |
11437 | +#endif | |
11438 | + /* FIXME for now repeat all the association procedure | |
11439 | + * both for disassociation and deauthentication | |
11440 | + */ | |
11441 | + if ((ieee->softmac_features & IEEE_SOFTMAC_ASSOCIATE) && | |
11442 | + (ieee->state == IEEE80211_LINKED) && | |
11443 | + (ieee->iw_mode == IW_MODE_INFRA) && | |
11444 | + (!memcmp(header->addr2,ieee->current_network.bssid,ETH_ALEN))){ | |
11445 | + ieee->state = IEEE80211_ASSOCIATING; | |
11446 | + ieee->softmac_stats.reassoc++; | |
11447 | + | |
11448 | + //notify_wx_assoc_event(ieee); //YJ,del,080828, do not notify os here | |
11449 | + queue_work(ieee->wq, &ieee->associate_procedure_wq); | |
11450 | + } | |
11451 | + | |
11452 | + break; | |
11453 | + | |
11454 | + default: | |
11455 | + return -1; | |
11456 | + break; | |
11457 | + } | |
11458 | + | |
11459 | + //dev_kfree_skb_any(skb); | |
11460 | + return 0; | |
11461 | +} | |
11462 | + | |
11463 | + | |
11464 | + | |
11465 | +/* following are for a simplier TX queue management. | |
11466 | + * Instead of using netif_[stop/wake]_queue the driver | |
11467 | + * will uses these two function (plus a reset one), that | |
11468 | + * will internally uses the kernel netif_* and takes | |
11469 | + * care of the ieee802.11 fragmentation. | |
11470 | + * So the driver receives a fragment per time and might | |
11471 | + * call the stop function when it want without take care | |
11472 | + * to have enought room to TX an entire packet. | |
11473 | + * This might be useful if each fragment need it's own | |
11474 | + * descriptor, thus just keep a total free memory > than | |
11475 | + * the max fragmentation treshold is not enought.. If the | |
11476 | + * ieee802.11 stack passed a TXB struct then you needed | |
11477 | + * to keep N free descriptors where | |
11478 | + * N = MAX_PACKET_SIZE / MIN_FRAG_TRESHOLD | |
11479 | + * In this way you need just one and the 802.11 stack | |
11480 | + * will take care of buffering fragments and pass them to | |
11481 | + * to the driver later, when it wakes the queue. | |
11482 | + */ | |
11483 | + | |
11484 | +void ieee80211_softmac_xmit(struct ieee80211_txb *txb, struct ieee80211_device *ieee) | |
11485 | +{ | |
11486 | + | |
11487 | + | |
11488 | + unsigned long flags; | |
11489 | + int i; | |
11490 | +#ifdef _RTL8187_EXT_PATCH_ | |
11491 | + int rate = ieee->rate; | |
11492 | +#endif | |
11493 | + | |
11494 | + spin_lock_irqsave(&ieee->lock,flags); | |
11495 | + #if 0 | |
11496 | + if(ieee->queue_stop){ | |
11497 | + IEEE80211DMESG("EE: IEEE hard_start_xmit invoked when kernel queue should be stopped"); | |
11498 | + netif_stop_queue(ieee->dev); | |
11499 | + ieee->ieee_stats.swtxstop++; | |
11500 | + //dev_kfree_skb_any(skb); | |
11501 | + err = 1; | |
11502 | + goto exit; | |
11503 | + } | |
11504 | + | |
11505 | + ieee->stats.tx_bytes+=skb->len; | |
11506 | + | |
11507 | + | |
11508 | + txb=ieee80211_skb_to_txb(ieee,skb); | |
11509 | + | |
11510 | + | |
11511 | + if(txb==NULL){ | |
11512 | + IEEE80211DMESG("WW: IEEE stack failed to provide txb"); | |
11513 | + //dev_kfree_skb_any(skb); | |
11514 | + err = 1; | |
11515 | + goto exit; | |
11516 | + } | |
11517 | + #endif | |
11518 | + | |
11519 | +#ifdef _RTL8187_EXT_PATCH_ | |
11520 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_ieee80211_softmac_xmit_get_rate && txb->nr_frags) | |
11521 | + { | |
11522 | + rate = ieee->ext_patch_ieee80211_softmac_xmit_get_rate(ieee, txb->fragments[0]); | |
11523 | + } | |
11524 | +#endif | |
11525 | + /* called with 2nd parm 0, no tx mgmt lock required */ | |
11526 | + ieee80211_sta_wakeup(ieee,0); | |
11527 | + | |
11528 | + for(i = 0; i < txb->nr_frags; i++) { | |
11529 | + | |
11530 | + if (ieee->queue_stop){ | |
11531 | + ieee->tx_pending.txb = txb; | |
11532 | + ieee->tx_pending.frag = i; | |
11533 | + goto exit; | |
11534 | + }else{ | |
11535 | + ieee->softmac_data_hard_start_xmit( | |
11536 | + txb->fragments[i], | |
11537 | +#ifdef _RTL8187_EXT_PATCH_ | |
11538 | + ieee->dev, rate); | |
11539 | +#else | |
11540 | + ieee->dev,ieee->rate); | |
11541 | +#endif | |
11542 | + //(i+1)<txb->nr_frags); | |
11543 | + ieee->stats.tx_packets++; | |
11544 | + ieee->stats.tx_bytes += txb->fragments[i]->len; | |
11545 | + ieee->dev->trans_start = jiffies; | |
11546 | + } | |
11547 | + } | |
11548 | + | |
11549 | + ieee80211_txb_free(txb); | |
11550 | + | |
11551 | + exit: | |
11552 | + spin_unlock_irqrestore(&ieee->lock,flags); | |
11553 | + | |
11554 | +} | |
11555 | + | |
11556 | +/* called with ieee->lock acquired */ | |
11557 | +void ieee80211_resume_tx(struct ieee80211_device *ieee) | |
11558 | +{ | |
11559 | + int i; | |
11560 | + for(i = ieee->tx_pending.frag; i < ieee->tx_pending.txb->nr_frags; i++) { | |
11561 | + | |
11562 | + if (ieee->queue_stop){ | |
11563 | + ieee->tx_pending.frag = i; | |
11564 | + return; | |
11565 | + }else{ | |
11566 | + | |
11567 | + ieee->softmac_data_hard_start_xmit( | |
11568 | + ieee->tx_pending.txb->fragments[i], | |
11569 | + ieee->dev,ieee->rate); | |
11570 | + //(i+1)<ieee->tx_pending.txb->nr_frags); | |
11571 | + ieee->stats.tx_packets++; | |
11572 | + ieee->dev->trans_start = jiffies; | |
11573 | + } | |
11574 | + } | |
11575 | + | |
11576 | + | |
11577 | + ieee80211_txb_free(ieee->tx_pending.txb); | |
11578 | + ieee->tx_pending.txb = NULL; | |
11579 | +} | |
11580 | + | |
11581 | + | |
11582 | +void ieee80211_reset_queue(struct ieee80211_device *ieee) | |
11583 | +{ | |
11584 | + unsigned long flags; | |
11585 | + | |
11586 | + spin_lock_irqsave(&ieee->lock,flags); | |
11587 | + init_mgmt_queue(ieee); | |
11588 | + if (ieee->tx_pending.txb){ | |
11589 | + ieee80211_txb_free(ieee->tx_pending.txb); | |
11590 | + ieee->tx_pending.txb = NULL; | |
11591 | + } | |
11592 | + ieee->queue_stop = 0; | |
11593 | + spin_unlock_irqrestore(&ieee->lock,flags); | |
11594 | + | |
11595 | +} | |
11596 | + | |
11597 | +void ieee80211_wake_queue(struct ieee80211_device *ieee) | |
11598 | +{ | |
11599 | + | |
11600 | + unsigned long flags; | |
11601 | + struct sk_buff *skb; | |
11602 | + struct ieee80211_hdr_3addr *header; | |
11603 | + | |
11604 | + spin_lock_irqsave(&ieee->lock,flags); | |
11605 | + if (! ieee->queue_stop) goto exit; | |
11606 | + | |
11607 | + ieee->queue_stop = 0; | |
11608 | + | |
11609 | + if(ieee->softmac_features & IEEE_SOFTMAC_SINGLE_QUEUE){ | |
11610 | + while (!ieee->queue_stop && (skb = dequeue_mgmt(ieee))){ | |
11611 | + | |
11612 | + header = (struct ieee80211_hdr_3addr *) skb->data; | |
11613 | + | |
11614 | + header->seq_ctl = cpu_to_le16(ieee->seq_ctrl[0] << 4); | |
11615 | + | |
11616 | + if (ieee->seq_ctrl[0] == 0xFFF) | |
11617 | + ieee->seq_ctrl[0] = 0; | |
11618 | + else | |
11619 | + ieee->seq_ctrl[0]++; | |
11620 | + | |
11621 | + //printk(KERN_ALERT "ieee80211_wake_queue \n"); | |
11622 | + ieee->softmac_data_hard_start_xmit(skb,ieee->dev,ieee->basic_rate); | |
11623 | + dev_kfree_skb_any(skb);//edit by thomas | |
11624 | + } | |
11625 | + } | |
11626 | + if (!ieee->queue_stop && ieee->tx_pending.txb) | |
11627 | + ieee80211_resume_tx(ieee); | |
11628 | + | |
11629 | + if (!ieee->queue_stop && netif_queue_stopped(ieee->dev)){ | |
11630 | + ieee->softmac_stats.swtxawake++; | |
11631 | + netif_wake_queue(ieee->dev); | |
11632 | + } | |
11633 | + | |
11634 | +exit : | |
11635 | + spin_unlock_irqrestore(&ieee->lock,flags); | |
11636 | +} | |
11637 | + | |
11638 | + | |
11639 | +void ieee80211_stop_queue(struct ieee80211_device *ieee) | |
11640 | +{ | |
11641 | + //unsigned long flags; | |
11642 | + //spin_lock_irqsave(&ieee->lock,flags); | |
11643 | + | |
11644 | + if (! netif_queue_stopped(ieee->dev)){ | |
11645 | + netif_stop_queue(ieee->dev); | |
11646 | + ieee->softmac_stats.swtxstop++; | |
11647 | + } | |
11648 | + ieee->queue_stop = 1; | |
11649 | + //spin_unlock_irqrestore(&ieee->lock,flags); | |
11650 | + | |
11651 | +} | |
11652 | + | |
11653 | + | |
11654 | +inline void ieee80211_randomize_cell(struct ieee80211_device *ieee) | |
11655 | +{ | |
11656 | + | |
11657 | + get_random_bytes(ieee->current_network.bssid, ETH_ALEN); | |
11658 | + | |
11659 | + /* an IBSS cell address must have the two less significant | |
11660 | + * bits of the first byte = 2 | |
11661 | + */ | |
11662 | + ieee->current_network.bssid[0] &= ~0x01; | |
11663 | + ieee->current_network.bssid[0] |= 0x02; | |
11664 | +} | |
11665 | + | |
11666 | +/* called in user context only */ | |
11667 | +void ieee80211_start_master_bss(struct ieee80211_device *ieee) | |
11668 | +{ | |
11669 | + ieee->assoc_id = 1; | |
11670 | + | |
11671 | + if (ieee->current_network.ssid_len == 0){ | |
11672 | + strncpy(ieee->current_network.ssid, | |
11673 | + IEEE80211_DEFAULT_TX_ESSID, | |
11674 | + IW_ESSID_MAX_SIZE); | |
11675 | + | |
11676 | + ieee->current_network.ssid_len = strlen(IEEE80211_DEFAULT_TX_ESSID); | |
11677 | + ieee->ssid_set = 1; | |
11678 | + } | |
11679 | + | |
11680 | + memcpy(ieee->current_network.bssid, ieee->dev->dev_addr, ETH_ALEN); | |
11681 | + | |
11682 | + ieee->set_chan(ieee->dev, ieee->current_network.channel); | |
11683 | + ieee->state = IEEE80211_LINKED; | |
11684 | + ieee->link_change(ieee->dev); | |
11685 | + notify_wx_assoc_event(ieee); | |
11686 | + | |
11687 | + if (ieee->data_hard_resume) | |
11688 | + ieee->data_hard_resume(ieee->dev); | |
11689 | + | |
11690 | + netif_carrier_on(ieee->dev); | |
11691 | +} | |
11692 | + | |
11693 | +void ieee80211_start_monitor_mode(struct ieee80211_device *ieee) | |
11694 | +{ | |
11695 | + if(ieee->raw_tx){ | |
11696 | + | |
11697 | + if (ieee->data_hard_resume) | |
11698 | + ieee->data_hard_resume(ieee->dev); | |
11699 | + | |
11700 | + netif_carrier_on(ieee->dev); | |
11701 | + } | |
11702 | +} | |
11703 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
11704 | +void ieee80211_start_ibss_wq(struct work_struct *work) | |
11705 | +{ | |
11706 | + struct delayed_work *dwork = container_of(work, struct delayed_work, work); | |
11707 | + struct ieee80211_device *ieee = container_of(dwork, struct ieee80211_device, start_ibss_wq); | |
11708 | +#else | |
11709 | +void ieee80211_start_ibss_wq(struct ieee80211_device *ieee) | |
11710 | +{ | |
11711 | +#endif | |
11712 | + | |
11713 | + /* iwconfig mode ad-hoc will schedule this and return | |
11714 | + * on the other hand this will block further iwconfig SET | |
11715 | + * operations because of the wx_sem hold. | |
11716 | + * Anyway some most set operations set a flag to speed-up | |
11717 | + * (abort) this wq (when syncro scanning) before sleeping | |
11718 | + * on the semaphore | |
11719 | + */ | |
11720 | + | |
11721 | + down(&ieee->wx_sem); | |
11722 | + | |
11723 | + | |
11724 | + if (ieee->current_network.ssid_len == 0){ | |
11725 | + strcpy(ieee->current_network.ssid,IEEE80211_DEFAULT_TX_ESSID); | |
11726 | + ieee->current_network.ssid_len = strlen(IEEE80211_DEFAULT_TX_ESSID); | |
11727 | + ieee->ssid_set = 1; | |
11728 | + } | |
11729 | + | |
11730 | + /* check if we have this cell in our network list */ | |
11731 | + ieee80211_softmac_check_all_nets(ieee); | |
11732 | + | |
11733 | +#ifdef ENABLE_DOT11D | |
11734 | + if(ieee->state == IEEE80211_NOLINK) | |
11735 | + ieee->current_network.channel = 10; | |
11736 | +#endif | |
11737 | + /* if not then the state is not linked. Maybe the user swithced to | |
11738 | + * ad-hoc mode just after being in monitor mode, or just after | |
11739 | + * being very few time in managed mode (so the card have had no | |
11740 | + * time to scan all the chans..) or we have just run up the iface | |
11741 | + * after setting ad-hoc mode. So we have to give another try.. | |
11742 | + * Here, in ibss mode, should be safe to do this without extra care | |
11743 | + * (in bss mode we had to make sure no-one tryed to associate when | |
11744 | + * we had just checked the ieee->state and we was going to start the | |
11745 | + * scan) beacause in ibss mode the ieee80211_new_net function, when | |
11746 | + * finds a good net, just set the ieee->state to IEEE80211_LINKED, | |
11747 | + * so, at worst, we waste a bit of time to initiate an unneeded syncro | |
11748 | + * scan, that will stop at the first round because it sees the state | |
11749 | + * associated. | |
11750 | + */ | |
11751 | + if (ieee->state == IEEE80211_NOLINK) | |
11752 | + ieee80211_start_scan_syncro(ieee); | |
11753 | + | |
11754 | + /* the network definitively is not here.. create a new cell */ | |
11755 | + if (ieee->state == IEEE80211_NOLINK){ | |
11756 | + printk("creating new IBSS cell\n"); | |
11757 | + if(!ieee->wap_set) | |
11758 | + ieee80211_randomize_cell(ieee); | |
11759 | + | |
11760 | + if(ieee->modulation & IEEE80211_CCK_MODULATION){ | |
11761 | + | |
11762 | + ieee->current_network.rates_len = 4; | |
11763 | + | |
11764 | + ieee->current_network.rates[0] = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_1MB; | |
11765 | + ieee->current_network.rates[1] = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_2MB; | |
11766 | + ieee->current_network.rates[2] = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_5MB; | |
11767 | + ieee->current_network.rates[3] = IEEE80211_BASIC_RATE_MASK | IEEE80211_CCK_RATE_11MB; | |
11768 | + | |
11769 | + }else | |
11770 | + ieee->current_network.rates_len = 0; | |
11771 | + | |
11772 | + if(ieee->modulation & IEEE80211_OFDM_MODULATION){ | |
11773 | + ieee->current_network.rates_ex_len = 8; | |
11774 | + | |
11775 | + ieee->current_network.rates_ex[0] = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_6MB; | |
11776 | + ieee->current_network.rates_ex[1] = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_9MB; | |
11777 | + ieee->current_network.rates_ex[2] = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_12MB; | |
11778 | + ieee->current_network.rates_ex[3] = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_18MB; | |
11779 | + ieee->current_network.rates_ex[4] = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_24MB; | |
11780 | + ieee->current_network.rates_ex[5] = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_36MB; | |
11781 | + ieee->current_network.rates_ex[6] = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_48MB; | |
11782 | + ieee->current_network.rates_ex[7] = IEEE80211_BASIC_RATE_MASK | IEEE80211_OFDM_RATE_54MB; | |
11783 | + | |
11784 | + ieee->rate = 540; | |
11785 | + }else{ | |
11786 | + ieee->current_network.rates_ex_len = 0; | |
11787 | + ieee->rate = 110; | |
11788 | + } | |
11789 | + | |
11790 | + // By default, WMM function will be disabled in IBSS mode | |
11791 | + ieee->current_network.QoS_Enable = 0; | |
11792 | + | |
11793 | + ieee->current_network.atim_window = 0; | |
11794 | + ieee->current_network.capability = WLAN_CAPABILITY_IBSS; | |
11795 | + if(ieee->short_slot) | |
11796 | + ieee->current_network.capability |= WLAN_CAPABILITY_SHORT_SLOT; | |
11797 | + | |
11798 | + } | |
11799 | + | |
11800 | + ieee->state = IEEE80211_LINKED; | |
11801 | + ieee->set_chan(ieee->dev, ieee->current_network.channel); | |
11802 | + ieee->link_change(ieee->dev); | |
11803 | + | |
11804 | + notify_wx_assoc_event(ieee); | |
11805 | + | |
11806 | + ieee80211_start_send_beacons(ieee); | |
11807 | + printk(KERN_WARNING "after sending beacon packet!\n"); | |
11808 | + | |
11809 | + if (ieee->data_hard_resume) | |
11810 | + ieee->data_hard_resume(ieee->dev); | |
11811 | + | |
11812 | + netif_carrier_on(ieee->dev); | |
11813 | + | |
11814 | + up(&ieee->wx_sem); | |
11815 | +} | |
11816 | +inline void ieee80211_start_ibss(struct ieee80211_device *ieee) | |
11817 | +{ | |
11818 | + queue_delayed_work(ieee->wq, &ieee->start_ibss_wq, 100); | |
11819 | +} | |
11820 | + | |
11821 | +/* this is called only in user context, with wx_sem held */ | |
11822 | +void ieee80211_start_bss(struct ieee80211_device *ieee) | |
11823 | +{ | |
11824 | + unsigned long flags; | |
11825 | +#ifdef ENABLE_DOT11D | |
11826 | + // | |
11827 | + // Ref: 802.11d 11.1.3.3 | |
11828 | + // STA shall not start a BSS unless properly formed Beacon frame including a Country IE. | |
11829 | + // | |
11830 | + if(IS_DOT11D_ENABLE(ieee) && !IS_COUNTRY_IE_VALID(ieee)) | |
11831 | + { | |
11832 | + if(! ieee->bGlobalDomain) | |
11833 | + { | |
11834 | + return; | |
11835 | + } | |
11836 | + } | |
11837 | +#endif | |
11838 | + /* check if we have already found the net we | |
11839 | + * are interested in (if any). | |
11840 | + * if not (we are disassociated and we are not | |
11841 | + * in associating / authenticating phase) start the background scanning. | |
11842 | + */ | |
11843 | + ieee80211_softmac_check_all_nets(ieee); | |
11844 | + | |
11845 | + /* ensure no-one start an associating process (thus setting | |
11846 | + * the ieee->state to ieee80211_ASSOCIATING) while we | |
11847 | + * have just cheked it and we are going to enable scan. | |
11848 | + * The ieee80211_new_net function is always called with | |
11849 | + * lock held (from both ieee80211_softmac_check_all_nets and | |
11850 | + * the rx path), so we cannot be in the middle of such function | |
11851 | + */ | |
11852 | + spin_lock_irqsave(&ieee->lock, flags); | |
11853 | + | |
11854 | +//#ifdef ENABLE_IPS | |
11855 | +// printk("start bss ENABLE_IPS\n"); | |
11856 | +//#else | |
11857 | + if (ieee->state == IEEE80211_NOLINK){ | |
11858 | + ieee->actscanning = true; | |
11859 | + ieee80211_start_scan(ieee); | |
11860 | + } | |
11861 | +//#endif | |
11862 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
11863 | +} | |
11864 | + | |
11865 | +/* called only in userspace context */ | |
11866 | +void ieee80211_disassociate(struct ieee80211_device *ieee) | |
11867 | +{ | |
11868 | + netif_carrier_off(ieee->dev); | |
11869 | + | |
11870 | + if (ieee->softmac_features & IEEE_SOFTMAC_TX_QUEUE) | |
11871 | + ieee80211_reset_queue(ieee); | |
11872 | + | |
11873 | + if (ieee->data_hard_stop) | |
11874 | + ieee->data_hard_stop(ieee->dev); | |
11875 | + | |
11876 | +#ifdef ENABLE_DOT11D | |
11877 | + if(IS_DOT11D_ENABLE(ieee)) | |
11878 | + Dot11d_Reset(ieee); | |
11879 | +#endif | |
11880 | + ieee->state = IEEE80211_NOLINK; | |
11881 | + ieee->link_change(ieee->dev); | |
11882 | + notify_wx_assoc_event(ieee); | |
11883 | + | |
11884 | +} | |
11885 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
11886 | +void ieee80211_associate_retry_wq(struct work_struct *work) | |
11887 | +{ | |
11888 | + struct delayed_work *dwork = container_of(work, struct delayed_work, work); | |
11889 | + struct ieee80211_device *ieee = container_of(dwork, struct ieee80211_device, associate_retry_wq); | |
11890 | +#else | |
11891 | +void ieee80211_associate_retry_wq(struct ieee80211_device *ieee) | |
11892 | +{ | |
11893 | +#endif | |
11894 | + unsigned long flags; | |
11895 | + down(&ieee->wx_sem); | |
11896 | + if(!ieee->proto_started) | |
11897 | + goto exit; | |
11898 | + if(ieee->state != IEEE80211_ASSOCIATING_RETRY) | |
11899 | + goto exit; | |
11900 | + /* until we do not set the state to IEEE80211_NOLINK | |
11901 | + * there are no possibility to have someone else trying | |
11902 | + * to start an association procdure (we get here with | |
11903 | + * ieee->state = IEEE80211_ASSOCIATING). | |
11904 | + * When we set the state to IEEE80211_NOLINK it is possible | |
11905 | + * that the RX path run an attempt to associate, but | |
11906 | + * both ieee80211_softmac_check_all_nets and the | |
11907 | + * RX path works with ieee->lock held so there are no | |
11908 | + * problems. If we are still disassociated then start a scan. | |
11909 | + * the lock here is necessary to ensure no one try to start | |
11910 | + * an association procedure when we have just checked the | |
11911 | + * state and we are going to start the scan. | |
11912 | + */ | |
11913 | + ieee->state = IEEE80211_NOLINK; | |
11914 | + ieee->beinretry = true; | |
11915 | + ieee80211_softmac_check_all_nets(ieee); | |
11916 | + | |
11917 | + spin_lock_irqsave(&ieee->lock, flags); | |
11918 | + | |
11919 | + if(ieee->state == IEEE80211_NOLINK){ | |
11920 | + ieee->beinretry = false; | |
11921 | + ieee->actscanning = true; | |
11922 | + ieee80211_start_scan(ieee); | |
11923 | + } | |
11924 | + //YJ,add,080828, notify os here | |
11925 | + if(ieee->state == IEEE80211_NOLINK) | |
11926 | + { | |
11927 | + notify_wx_assoc_event(ieee); | |
11928 | + } | |
11929 | + //YJ,add,080828,end | |
11930 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
11931 | + | |
11932 | +exit: | |
11933 | + up(&ieee->wx_sem); | |
11934 | +} | |
11935 | + | |
11936 | +struct sk_buff *ieee80211_get_beacon_(struct ieee80211_device *ieee) | |
11937 | +{ | |
11938 | + u8 broadcast_addr[] = {0xff,0xff,0xff,0xff,0xff,0xff}; | |
11939 | + | |
11940 | + struct sk_buff *skb = NULL; | |
11941 | + struct ieee80211_probe_response *b; | |
11942 | + | |
11943 | +//rz | |
11944 | +#ifdef _RTL8187_EXT_PATCH_ | |
11945 | + if((ieee->iw_mode == ieee->iw_ext_mode) && ieee->ext_patch_get_beacon_get_probersp ) | |
11946 | + skb = ieee->ext_patch_get_beacon_get_probersp(ieee, broadcast_addr, &(ieee->current_network)); | |
11947 | + else | |
11948 | + skb = ieee80211_probe_resp(ieee, broadcast_addr); | |
11949 | +#else | |
11950 | + skb = ieee80211_probe_resp(ieee, broadcast_addr); | |
11951 | +#endif | |
11952 | +// | |
11953 | + if (!skb) | |
11954 | + return NULL; | |
11955 | + | |
11956 | + b = (struct ieee80211_probe_response *) skb->data; | |
11957 | + b->header.frame_ctl = cpu_to_le16(IEEE80211_STYPE_BEACON); | |
11958 | + | |
11959 | + return skb; | |
11960 | + | |
11961 | +} | |
11962 | + | |
11963 | +struct sk_buff *ieee80211_get_beacon(struct ieee80211_device *ieee) | |
11964 | +{ | |
11965 | + struct sk_buff *skb; | |
11966 | + struct ieee80211_probe_response *b; | |
11967 | + | |
11968 | + skb = ieee80211_get_beacon_(ieee); | |
11969 | + if(!skb) | |
11970 | + return NULL; | |
11971 | + | |
11972 | + b = (struct ieee80211_probe_response *) skb->data; | |
11973 | + b->header.seq_ctrl = cpu_to_le16(ieee->seq_ctrl[0] << 4); | |
11974 | + | |
11975 | + if (ieee->seq_ctrl[0] == 0xFFF) | |
11976 | + ieee->seq_ctrl[0] = 0; | |
11977 | + else | |
11978 | + ieee->seq_ctrl[0]++; | |
11979 | + | |
11980 | + return skb; | |
11981 | +} | |
11982 | + | |
11983 | +void ieee80211_softmac_stop_protocol(struct ieee80211_device *ieee) | |
11984 | +{ | |
11985 | + ieee->sync_scan_hurryup = 1; | |
11986 | + down(&ieee->wx_sem); | |
11987 | + ieee80211_stop_protocol(ieee); | |
11988 | + up(&ieee->wx_sem); | |
11989 | +} | |
11990 | + | |
11991 | + | |
11992 | +void ieee80211_stop_protocol(struct ieee80211_device *ieee) | |
11993 | +{ | |
11994 | + if (!ieee->proto_started) | |
11995 | + return; | |
11996 | + | |
11997 | + ieee->proto_started = 0; | |
11998 | + | |
11999 | +#ifdef _RTL8187_EXT_PATCH_ | |
12000 | + if(ieee->ext_patch_ieee80211_stop_protocol) | |
12001 | + ieee->ext_patch_ieee80211_stop_protocol(ieee); | |
12002 | +//if call queue_delayed_work,can call this,or do nothing.. | |
12003 | +//edit by lawrence,20071118 | |
12004 | +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0) | |
12005 | +// cancel_delayed_work(&ieee->ext_stop_scan_wq); | |
12006 | +// cancel_delayed_work(&ieee->ext_send_beacon_wq); | |
12007 | +#endif | |
12008 | +#endif // _RTL8187_EXT_PATCH_ | |
12009 | + | |
12010 | + ieee80211_stop_send_beacons(ieee); | |
12011 | + if((ieee->iw_mode == IW_MODE_INFRA)&&(ieee->state == IEEE80211_LINKED)) { | |
12012 | + SendDisassociation(ieee,NULL,WLAN_REASON_DISASSOC_STA_HAS_LEFT); | |
12013 | + } | |
12014 | + del_timer_sync(&ieee->associate_timer); | |
12015 | + cancel_delayed_work(&ieee->associate_retry_wq); | |
12016 | + cancel_delayed_work(&ieee->start_ibss_wq); | |
12017 | + ieee80211_stop_scan(ieee); | |
12018 | + | |
12019 | + ieee80211_disassociate(ieee); | |
12020 | +} | |
12021 | + | |
12022 | +void ieee80211_softmac_start_protocol(struct ieee80211_device *ieee) | |
12023 | +{ | |
12024 | + ieee->sync_scan_hurryup = 0; | |
12025 | + down(&ieee->wx_sem); | |
12026 | + ieee80211_start_protocol(ieee); | |
12027 | + up(&ieee->wx_sem); | |
12028 | +} | |
12029 | + | |
12030 | +void ieee80211_start_protocol(struct ieee80211_device *ieee) | |
12031 | +{ | |
12032 | + short ch = 0; | |
12033 | + int i = 0; | |
12034 | + | |
12035 | + if (ieee->proto_started) | |
12036 | + return; | |
12037 | + | |
12038 | + ieee->proto_started = 1; | |
12039 | + | |
12040 | + if (ieee->current_network.channel == 0){ | |
12041 | + do{ | |
12042 | + ch++; | |
12043 | + if (ch > MAX_CHANNEL_NUMBER) | |
12044 | + return; /* no channel found */ | |
12045 | + | |
12046 | +#ifdef ENABLE_DOT11D | |
12047 | + }while(!GET_DOT11D_INFO(ieee)->channel_map[ch]); | |
12048 | +#else | |
12049 | + }while(!ieee->channel_map[ch]); | |
12050 | +#endif | |
12051 | + | |
12052 | + ieee->current_network.channel = ch; | |
12053 | + } | |
12054 | + | |
12055 | + if (ieee->current_network.beacon_interval == 0) | |
12056 | + ieee->current_network.beacon_interval = 100; | |
12057 | + ieee->set_chan(ieee->dev,ieee->current_network.channel); | |
12058 | + | |
12059 | + for(i = 0; i < 17; i++) { | |
12060 | + ieee->last_rxseq_num[i] = -1; | |
12061 | + ieee->last_rxfrag_num[i] = -1; | |
12062 | + ieee->last_packet_time[i] = 0; | |
12063 | + } | |
12064 | + | |
12065 | + ieee->init_wmmparam_flag = 0;//reinitialize AC_xx_PARAM registers. | |
12066 | + | |
12067 | + | |
12068 | + /* if the user set the MAC of the ad-hoc cell and then | |
12069 | + * switch to managed mode, shall we make sure that association | |
12070 | + * attempts does not fail just because the user provide the essid | |
12071 | + * and the nic is still checking for the AP MAC ?? | |
12072 | + */ | |
12073 | + switch (ieee->iw_mode) { | |
12074 | + case IW_MODE_AUTO: | |
12075 | + ieee->iw_mode = IW_MODE_INFRA; | |
12076 | + //not set break here intentionly | |
12077 | + case IW_MODE_INFRA: | |
12078 | + ieee80211_start_bss(ieee); | |
12079 | + break; | |
12080 | + | |
12081 | + case IW_MODE_ADHOC: | |
12082 | + ieee80211_start_ibss(ieee); | |
12083 | + break; | |
12084 | + | |
12085 | + case IW_MODE_MASTER: | |
12086 | + ieee80211_start_master_bss(ieee); | |
12087 | + break; | |
12088 | + | |
12089 | + case IW_MODE_MONITOR: | |
12090 | + ieee80211_start_monitor_mode(ieee); | |
12091 | + break; | |
12092 | + | |
12093 | + default: | |
12094 | +#ifdef _RTL8187_EXT_PATCH_ | |
12095 | + if((ieee->iw_mode == ieee->iw_ext_mode) &&\ | |
12096 | + ieee->ext_patch_ieee80211_start_protocol &&\ | |
12097 | + ieee->ext_patch_ieee80211_start_protocol(ieee)) { | |
12098 | +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0) | |
12099 | + queue_work(ieee->wq, &ieee->ext_stop_scan_wq); | |
12100 | +#endif | |
12101 | + // By default, WMM function will be disabled in | |
12102 | + // EXTENSION mode | |
12103 | + ieee->current_network.QoS_Enable = 0; | |
12104 | + | |
12105 | + if(ieee->modulation & IEEE80211_CCK_MODULATION){ | |
12106 | + ieee->current_network.rates_len = 4; | |
12107 | + ieee->current_network.rates[0] = \ | |
12108 | + IEEE80211_BASIC_RATE_MASK | \ | |
12109 | + IEEE80211_CCK_RATE_1MB; | |
12110 | + ieee->current_network.rates[1] = \ | |
12111 | + IEEE80211_BASIC_RATE_MASK |\ | |
12112 | + IEEE80211_CCK_RATE_2MB; | |
12113 | + ieee->current_network.rates[2] = \ | |
12114 | + IEEE80211_BASIC_RATE_MASK |\ | |
12115 | + IEEE80211_CCK_RATE_5MB; | |
12116 | + ieee->current_network.rates[3] = \ | |
12117 | + IEEE80211_BASIC_RATE_MASK |\ | |
12118 | + IEEE80211_CCK_RATE_11MB; | |
12119 | + }else | |
12120 | + ieee->current_network.rates_len = 0; | |
12121 | + | |
12122 | + if(ieee->modulation & IEEE80211_OFDM_MODULATION){ | |
12123 | + ieee->current_network.rates_ex_len = 8; | |
12124 | + ieee->current_network.rates_ex[0] = \ | |
12125 | + IEEE80211_BASIC_RATE_MASK |\ | |
12126 | + IEEE80211_OFDM_RATE_6MB; | |
12127 | + ieee->current_network.rates_ex[1] = \ | |
12128 | + IEEE80211_BASIC_RATE_MASK |\ | |
12129 | + IEEE80211_OFDM_RATE_9MB; | |
12130 | + ieee->current_network.rates_ex[2] = \ | |
12131 | + IEEE80211_BASIC_RATE_MASK |\ | |
12132 | + IEEE80211_OFDM_RATE_12MB; | |
12133 | + ieee->current_network.rates_ex[3] = \ | |
12134 | + IEEE80211_BASIC_RATE_MASK | \ | |
12135 | + IEEE80211_OFDM_RATE_18MB; | |
12136 | + ieee->current_network.rates_ex[4] =\ | |
12137 | + IEEE80211_BASIC_RATE_MASK |\ | |
12138 | + IEEE80211_OFDM_RATE_24MB; | |
12139 | + ieee->current_network.rates_ex[5] =\ | |
12140 | + IEEE80211_BASIC_RATE_MASK |\ | |
12141 | + IEEE80211_OFDM_RATE_36MB; | |
12142 | + ieee->current_network.rates_ex[6] = \ | |
12143 | + IEEE80211_BASIC_RATE_MASK |\ | |
12144 | + IEEE80211_OFDM_RATE_48MB; | |
12145 | + ieee->current_network.rates_ex[7] =\ | |
12146 | + IEEE80211_BASIC_RATE_MASK |\ | |
12147 | + IEEE80211_OFDM_RATE_54MB; | |
12148 | + ieee->rate = 540; | |
12149 | + }else{ | |
12150 | + ieee->current_network.rates_ex_len = 0; | |
12151 | + ieee->rate = 110; | |
12152 | + } | |
12153 | + | |
12154 | + /* | |
12155 | + spin_lock_irqsave(&ieee->lock, flags); | |
12156 | + if (ieee->state == IEEE80211_NOLINK) | |
12157 | + ieee80211_start_scan(ieee); | |
12158 | + // ieee->set_chan(ieee->dev, 8); | |
12159 | + | |
12160 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
12161 | + */ | |
12162 | + memcpy(ieee->current_network.bssid, ieee->dev->dev_addr,\ | |
12163 | + ETH_ALEN); | |
12164 | + ieee->link_change(ieee->dev); | |
12165 | + notify_wx_assoc_event(ieee); | |
12166 | + | |
12167 | + if (ieee->data_hard_resume) | |
12168 | + ieee->data_hard_resume(ieee->dev); | |
12169 | + | |
12170 | + netif_carrier_on(ieee->dev); | |
12171 | + } else { | |
12172 | + ieee->iw_mode = IW_MODE_INFRA; | |
12173 | + ieee80211_start_bss(ieee); | |
12174 | + } | |
12175 | +#else | |
12176 | + ieee->iw_mode = IW_MODE_INFRA; | |
12177 | + ieee80211_start_bss(ieee); | |
12178 | + | |
12179 | +#endif | |
12180 | + break; | |
12181 | + } | |
12182 | +} | |
12183 | + | |
12184 | + | |
12185 | +#define DRV_NAME "Ieee80211" | |
12186 | +void ieee80211_softmac_init(struct ieee80211_device *ieee) | |
12187 | +{ | |
12188 | + int i; | |
12189 | + memset(&ieee->current_network, 0, sizeof(struct ieee80211_network)); | |
12190 | + | |
12191 | + ieee->state = IEEE80211_NOLINK; | |
12192 | + ieee->sync_scan_hurryup = 0; | |
12193 | + for(i = 0; i < 5; i++) { | |
12194 | + ieee->seq_ctrl[i] = 0; | |
12195 | + } | |
12196 | + | |
12197 | + ieee->assoc_id = 0; | |
12198 | + ieee->queue_stop = 0; | |
12199 | + ieee->scanning = 0; | |
12200 | + ieee->softmac_features = 0; //so IEEE2100-like driver are happy | |
12201 | + ieee->wap_set = 0; | |
12202 | + ieee->ssid_set = 0; | |
12203 | + ieee->proto_started = 0; | |
12204 | + ieee->basic_rate = IEEE80211_DEFAULT_BASIC_RATE; | |
12205 | + ieee->rate = 3; | |
12206 | +//#ifdef ENABLE_LPS | |
12207 | + ieee->ps = IEEE80211_PS_MBCAST|IEEE80211_PS_UNICAST; | |
12208 | +//#else | |
12209 | +// ieee->ps = IEEE80211_PS_DISABLED; | |
12210 | +//#endif | |
12211 | + ieee->sta_sleep = 0; | |
12212 | +//by amy | |
12213 | + ieee->bInactivePs = false; | |
12214 | + ieee->actscanning = false; | |
12215 | + ieee->ListenInterval = 2; | |
12216 | + ieee->NumRxDataInPeriod = 0; //YJ,add,080828 | |
12217 | + ieee->NumRxBcnInPeriod = 0; //YJ,add,080828 | |
12218 | + ieee->NumRxOkTotal = 0;//+by amy 080312 | |
12219 | + ieee->NumRxUnicast = 0;//YJ,add,080828,for keep alive | |
12220 | + ieee->beinretry = false; | |
12221 | + ieee->bHwRadioOff = false; | |
12222 | +//by amy | |
12223 | +#ifdef _RTL8187_EXT_PATCH_ | |
12224 | + ieee->iw_ext_mode = 999; | |
12225 | +#endif | |
12226 | + | |
12227 | + init_mgmt_queue(ieee); | |
12228 | +#if 0 | |
12229 | + init_timer(&ieee->scan_timer); | |
12230 | + ieee->scan_timer.data = (unsigned long)ieee; | |
12231 | + ieee->scan_timer.function = ieee80211_softmac_scan_cb; | |
12232 | +#endif | |
12233 | + ieee->tx_pending.txb = NULL; | |
12234 | + | |
12235 | + init_timer(&ieee->associate_timer); | |
12236 | + ieee->associate_timer.data = (unsigned long)ieee; | |
12237 | + ieee->associate_timer.function = ieee80211_associate_abort_cb; | |
12238 | + | |
12239 | + init_timer(&ieee->beacon_timer); | |
12240 | + ieee->beacon_timer.data = (unsigned long) ieee; | |
12241 | + ieee->beacon_timer.function = ieee80211_send_beacon_cb; | |
12242 | + | |
12243 | +#ifdef PF_SYNCTHREAD | |
12244 | + ieee->wq = create_workqueue(DRV_NAME,0); | |
12245 | +#else | |
12246 | + ieee->wq = create_workqueue(DRV_NAME); | |
12247 | +#endif | |
12248 | +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)//added by lawrence,070702 | |
12249 | + INIT_DELAYED_WORK(&ieee->start_ibss_wq,(void*) ieee80211_start_ibss_wq); | |
12250 | + INIT_WORK(&ieee->associate_complete_wq,(void*) ieee80211_associate_complete_wq); | |
12251 | + INIT_WORK(&ieee->associate_procedure_wq,(void*) ieee80211_associate_procedure_wq); | |
12252 | + INIT_DELAYED_WORK(&ieee->softmac_scan_wq,(void*) ieee80211_softmac_scan_wq); | |
12253 | + INIT_DELAYED_WORK(&ieee->associate_retry_wq,(void*) ieee80211_associate_retry_wq); | |
12254 | + INIT_WORK(&ieee->wx_sync_scan_wq,(void*) ieee80211_wx_sync_scan_wq); | |
12255 | +// INIT_WORK(&ieee->watch_dog_wq,(void*) ieee80211_watch_dog_wq); | |
12256 | +//added by lawrence,20071118 | |
12257 | +#ifdef _RTL8187_EXT_PATCH_ | |
12258 | + INIT_WORK(&ieee->ext_stop_scan_wq,(void*) ieee80211_ext_stop_scan_wq); | |
12259 | + //INIT_WORK(&ieee->ext_send_beacon_wq,(void*) ieee80211_beacons_start,ieee); | |
12260 | + INIT_WORK(&ieee->ext_send_beacon_wq,(void*) ext_ieee80211_send_beacon_wq); | |
12261 | +#endif //_RTL8187_EXT_PATCH_ | |
12262 | +#else | |
12263 | + INIT_WORK(&ieee->start_ibss_wq,(void*) ieee80211_start_ibss_wq,ieee); | |
12264 | + INIT_WORK(&ieee->associate_retry_wq,(void*) ieee80211_associate_retry_wq,ieee); | |
12265 | + INIT_WORK(&ieee->associate_complete_wq,(void*) ieee80211_associate_complete_wq,ieee); | |
12266 | + INIT_WORK(&ieee->associate_procedure_wq,(void*) ieee80211_associate_procedure_wq,ieee); | |
12267 | + INIT_WORK(&ieee->softmac_scan_wq,(void*) ieee80211_softmac_scan_wq,ieee); | |
12268 | + INIT_WORK(&ieee->wx_sync_scan_wq,(void*) ieee80211_wx_sync_scan_wq,ieee); | |
12269 | +// INIT_WORK(&ieee->watch_dog_wq,(void*) ieee80211_watch_dog_wq,ieee); | |
12270 | +#ifdef _RTL8187_EXT_PATCH_ | |
12271 | + INIT_WORK(&ieee->ext_stop_scan_wq,(void*) ieee80211_ext_stop_scan_wq,ieee); | |
12272 | + //INIT_WORK(&ieee->ext_send_beacon_wq,(void*) ieee80211_beacons_start,ieee); | |
12273 | + INIT_WORK(&ieee->ext_send_beacon_wq,(void*) ext_ieee80211_send_beacon_wq,ieee); | |
12274 | +#endif | |
12275 | +#endif | |
12276 | + sema_init(&ieee->wx_sem, 1); | |
12277 | + sema_init(&ieee->scan_sem, 1); | |
12278 | + | |
12279 | + spin_lock_init(&ieee->mgmt_tx_lock); | |
12280 | + spin_lock_init(&ieee->beacon_lock); | |
12281 | + | |
12282 | + tasklet_init(&ieee->ps_task, | |
12283 | + (void(*)(unsigned long)) ieee80211_sta_ps, | |
12284 | + (unsigned long)ieee); | |
12285 | +#ifdef ENABLE_DOT11D | |
12286 | + ieee->pDot11dInfo = kmalloc(sizeof(RT_DOT11D_INFO), GFP_ATOMIC); | |
12287 | +#endif | |
12288 | +} | |
12289 | + | |
12290 | +void ieee80211_softmac_free(struct ieee80211_device *ieee) | |
12291 | +{ | |
12292 | + down(&ieee->wx_sem); | |
12293 | + | |
12294 | + del_timer_sync(&ieee->associate_timer); | |
12295 | + cancel_delayed_work(&ieee->associate_retry_wq); | |
12296 | + | |
12297 | + | |
12298 | + //add for RF power on power of by lizhaoming 080512 | |
12299 | + cancel_delayed_work(&ieee->GPIOChangeRFWorkItem); | |
12300 | + | |
12301 | +#ifdef _RTL8187_EXT_PATCH_ | |
12302 | + cancel_delayed_work(&ieee->ext_stop_scan_wq); | |
12303 | + cancel_delayed_work(&ieee->ext_send_beacon_wq); | |
12304 | +#endif | |
12305 | + destroy_workqueue(ieee->wq); | |
12306 | +#ifdef ENABLE_DOT11D | |
12307 | + if(NULL != ieee->pDot11dInfo) | |
12308 | + kfree(ieee->pDot11dInfo); | |
12309 | +#endif | |
12310 | + up(&ieee->wx_sem); | |
12311 | +} | |
12312 | + | |
12313 | +/******************************************************** | |
12314 | + * Start of WPA code. * | |
12315 | + * this is stolen from the ipw2200 driver * | |
12316 | + ********************************************************/ | |
12317 | + | |
12318 | + | |
12319 | +static int ieee80211_wpa_enable(struct ieee80211_device *ieee, int value) | |
12320 | +{ | |
12321 | + /* This is called when wpa_supplicant loads and closes the driver | |
12322 | + * interface. */ | |
12323 | + printk("%s WPA\n",value ? "enabling" : "disabling"); | |
12324 | + ieee->wpa_enabled = value; | |
12325 | + return 0; | |
12326 | +} | |
12327 | + | |
12328 | + | |
12329 | +void ieee80211_wpa_assoc_frame(struct ieee80211_device *ieee, char *wpa_ie, int wpa_ie_len) | |
12330 | +{ | |
12331 | + /* make sure WPA is enabled */ | |
12332 | + ieee80211_wpa_enable(ieee, 1); | |
12333 | + | |
12334 | + ieee80211_disassociate(ieee); | |
12335 | +} | |
12336 | + | |
12337 | + | |
12338 | +static int ieee80211_wpa_mlme(struct ieee80211_device *ieee, int command, int reason) | |
12339 | +{ | |
12340 | + | |
12341 | + int ret = 0; | |
12342 | + | |
12343 | + switch (command) { | |
12344 | + case IEEE_MLME_STA_DEAUTH: | |
12345 | + // silently ignore | |
12346 | + break; | |
12347 | + | |
12348 | + case IEEE_MLME_STA_DISASSOC: | |
12349 | + ieee80211_disassociate(ieee); | |
12350 | + break; | |
12351 | + | |
12352 | + default: | |
12353 | + printk("Unknown MLME request: %d\n", command); | |
12354 | + ret = -EOPNOTSUPP; | |
12355 | + } | |
12356 | + | |
12357 | + return ret; | |
12358 | +} | |
12359 | + | |
12360 | + | |
12361 | +static int ieee80211_wpa_set_wpa_ie(struct ieee80211_device *ieee, | |
12362 | + struct ieee_param *param, int plen) | |
12363 | +{ | |
12364 | + u8 *buf; | |
12365 | + | |
12366 | + if (param->u.wpa_ie.len > MAX_WPA_IE_LEN || | |
12367 | + (param->u.wpa_ie.len && param->u.wpa_ie.data == NULL)) | |
12368 | + return -EINVAL; | |
12369 | + | |
12370 | + if (param->u.wpa_ie.len) { | |
12371 | + buf = kmalloc(param->u.wpa_ie.len, GFP_KERNEL); | |
12372 | + if (buf == NULL) | |
12373 | + return -ENOMEM; | |
12374 | + | |
12375 | + memcpy(buf, param->u.wpa_ie.data, param->u.wpa_ie.len); | |
12376 | + kfree(ieee->wpa_ie); | |
12377 | + ieee->wpa_ie = buf; | |
12378 | + ieee->wpa_ie_len = param->u.wpa_ie.len; | |
12379 | + } else { | |
12380 | + kfree(ieee->wpa_ie); | |
12381 | + ieee->wpa_ie = NULL; | |
12382 | + ieee->wpa_ie_len = 0; | |
12383 | + } | |
12384 | + | |
12385 | + ieee80211_wpa_assoc_frame(ieee, ieee->wpa_ie, ieee->wpa_ie_len); | |
12386 | + return 0; | |
12387 | +} | |
12388 | + | |
12389 | +#define AUTH_ALG_OPEN_SYSTEM 0x1 | |
12390 | +#define AUTH_ALG_SHARED_KEY 0x2 | |
12391 | + | |
12392 | +static int ieee80211_wpa_set_auth_algs(struct ieee80211_device *ieee, int value) | |
12393 | +{ | |
12394 | + | |
12395 | + struct ieee80211_security sec = { | |
12396 | + .flags = SEC_AUTH_MODE, | |
12397 | + }; | |
12398 | + int ret = 0; | |
12399 | + | |
12400 | + if (value & AUTH_ALG_SHARED_KEY) { | |
12401 | + sec.auth_mode = WLAN_AUTH_SHARED_KEY; | |
12402 | + ieee->open_wep = 0; | |
12403 | + } else { | |
12404 | + sec.auth_mode = WLAN_AUTH_OPEN; | |
12405 | + ieee->open_wep = 1; | |
12406 | + } | |
12407 | + | |
12408 | + if (ieee->set_security) | |
12409 | + ieee->set_security(ieee->dev, &sec); | |
12410 | + else | |
12411 | + ret = -EOPNOTSUPP; | |
12412 | + | |
12413 | + return ret; | |
12414 | +} | |
12415 | + | |
12416 | +static int ieee80211_wpa_set_param(struct ieee80211_device *ieee, u8 name, u32 value) | |
12417 | +{ | |
12418 | + int ret=0; | |
12419 | + unsigned long flags; | |
12420 | + | |
12421 | + switch (name) { | |
12422 | + case IEEE_PARAM_WPA_ENABLED: | |
12423 | + ret = ieee80211_wpa_enable(ieee, value); | |
12424 | + break; | |
12425 | + | |
12426 | + case IEEE_PARAM_TKIP_COUNTERMEASURES: | |
12427 | + ieee->tkip_countermeasures=value; | |
12428 | + break; | |
12429 | + | |
12430 | + case IEEE_PARAM_DROP_UNENCRYPTED: { | |
12431 | + /* HACK: | |
12432 | + * | |
12433 | + * wpa_supplicant calls set_wpa_enabled when the driver | |
12434 | + * is loaded and unloaded, regardless of if WPA is being | |
12435 | + * used. No other calls are made which can be used to | |
12436 | + * determine if encryption will be used or not prior to | |
12437 | + * association being expected. If encryption is not being | |
12438 | + * used, drop_unencrypted is set to false, else true -- we | |
12439 | + * can use this to determine if the CAP_PRIVACY_ON bit should | |
12440 | + * be set. | |
12441 | + */ | |
12442 | + struct ieee80211_security sec = { | |
12443 | + .flags = SEC_ENABLED, | |
12444 | + .enabled = value, | |
12445 | + }; | |
12446 | + ieee->drop_unencrypted = value; | |
12447 | + /* We only change SEC_LEVEL for open mode. Others | |
12448 | + * are set by ipw_wpa_set_encryption. | |
12449 | + */ | |
12450 | + if (!value) { | |
12451 | + sec.flags |= SEC_LEVEL; | |
12452 | + sec.level = SEC_LEVEL_0; | |
12453 | + } | |
12454 | + else { | |
12455 | + sec.flags |= SEC_LEVEL; | |
12456 | + sec.level = SEC_LEVEL_1; | |
12457 | + } | |
12458 | + if (ieee->set_security) | |
12459 | + ieee->set_security(ieee->dev, &sec); | |
12460 | + break; | |
12461 | + } | |
12462 | + | |
12463 | + case IEEE_PARAM_PRIVACY_INVOKED: | |
12464 | + ieee->privacy_invoked=value; | |
12465 | + break; | |
12466 | + | |
12467 | + case IEEE_PARAM_AUTH_ALGS: | |
12468 | + ret = ieee80211_wpa_set_auth_algs(ieee, value); | |
12469 | + break; | |
12470 | + | |
12471 | + case IEEE_PARAM_IEEE_802_1X: | |
12472 | + ieee->ieee802_1x=value; | |
12473 | + break; | |
12474 | + case IEEE_PARAM_WPAX_SELECT: | |
12475 | + // added for WPA2 mixed mode | |
12476 | + //printk(KERN_WARNING "------------------------>wpax value = %x\n", value); | |
12477 | + spin_lock_irqsave(&ieee->wpax_suitlist_lock,flags); | |
12478 | + ieee->wpax_type_set = 1; | |
12479 | + ieee->wpax_type_notify = value; | |
12480 | + spin_unlock_irqrestore(&ieee->wpax_suitlist_lock,flags); | |
12481 | + break; | |
12482 | + | |
12483 | + default: | |
12484 | + printk("Unknown WPA param: %d\n",name); | |
12485 | + ret = -EOPNOTSUPP; | |
12486 | + } | |
12487 | + | |
12488 | + return ret; | |
12489 | +} | |
12490 | + | |
12491 | +/* implementation borrowed from hostap driver */ | |
12492 | + | |
12493 | +static int ieee80211_wpa_set_encryption(struct ieee80211_device *ieee, | |
12494 | + struct ieee_param *param, int param_len) | |
12495 | +{ | |
12496 | + int ret = 0; | |
12497 | + | |
12498 | + struct ieee80211_crypto_ops *ops; | |
12499 | + struct ieee80211_crypt_data **crypt; | |
12500 | + | |
12501 | + struct ieee80211_security sec = { | |
12502 | + .flags = 0, | |
12503 | + }; | |
12504 | + | |
12505 | + param->u.crypt.err = 0; | |
12506 | + param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; | |
12507 | + | |
12508 | + if (param_len != | |
12509 | + (int) ((char *) param->u.crypt.key - (char *) param) + | |
12510 | + param->u.crypt.key_len) { | |
12511 | + printk("Len mismatch %d, %d\n", param_len, | |
12512 | + param->u.crypt.key_len); | |
12513 | + return -EINVAL; | |
12514 | + } | |
12515 | + if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && | |
12516 | + param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && | |
12517 | + param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) { | |
12518 | + if (param->u.crypt.idx >= WEP_KEYS) | |
12519 | + return -EINVAL; | |
12520 | + crypt = &ieee->crypt[param->u.crypt.idx]; | |
12521 | + } else { | |
12522 | + return -EINVAL; | |
12523 | + } | |
12524 | + | |
12525 | + if (strcmp(param->u.crypt.alg, "none") == 0) { | |
12526 | + if (crypt) { | |
12527 | + sec.enabled = 0; | |
12528 | + // FIXME FIXME | |
12529 | + //sec.encrypt = 0; | |
12530 | + sec.level = SEC_LEVEL_0; | |
12531 | + sec.flags |= SEC_ENABLED | SEC_LEVEL; | |
12532 | + ieee80211_crypt_delayed_deinit(ieee, crypt); | |
12533 | + } | |
12534 | + goto done; | |
12535 | + } | |
12536 | + sec.enabled = 1; | |
12537 | +// FIXME FIXME | |
12538 | +// sec.encrypt = 1; | |
12539 | + sec.flags |= SEC_ENABLED; | |
12540 | + | |
12541 | + /* IPW HW cannot build TKIP MIC, host decryption still needed. */ | |
12542 | + if (!(ieee->host_encrypt || ieee->host_decrypt) && | |
12543 | + strcmp(param->u.crypt.alg, "TKIP")) | |
12544 | + goto skip_host_crypt; | |
12545 | + | |
12546 | + ops = ieee80211_get_crypto_ops(param->u.crypt.alg); | |
12547 | + if (ops == NULL && strcmp(param->u.crypt.alg, "WEP") == 0) { | |
12548 | + request_module("ieee80211_crypt_wep"); | |
12549 | + ops = ieee80211_get_crypto_ops(param->u.crypt.alg); | |
12550 | + } else if (ops == NULL && strcmp(param->u.crypt.alg, "TKIP") == 0) { | |
12551 | + request_module("ieee80211_crypt_tkip"); | |
12552 | + ops = ieee80211_get_crypto_ops(param->u.crypt.alg); | |
12553 | + } else if (ops == NULL && strcmp(param->u.crypt.alg, "CCMP") == 0) { | |
12554 | + request_module("ieee80211_crypt_ccmp"); | |
12555 | + ops = ieee80211_get_crypto_ops(param->u.crypt.alg); | |
12556 | + } | |
12557 | + if (ops == NULL) { | |
12558 | + printk("unknown crypto alg '%s'\n", param->u.crypt.alg); | |
12559 | + param->u.crypt.err = IEEE_CRYPT_ERR_UNKNOWN_ALG; | |
12560 | + ret = -EINVAL; | |
12561 | + goto done; | |
12562 | + } | |
12563 | + | |
12564 | + if (*crypt == NULL || (*crypt)->ops != ops) { | |
12565 | + struct ieee80211_crypt_data *new_crypt; | |
12566 | + | |
12567 | + ieee80211_crypt_delayed_deinit(ieee, crypt); | |
12568 | + | |
12569 | + new_crypt = (struct ieee80211_crypt_data *) | |
12570 | + kmalloc(sizeof(*new_crypt), GFP_KERNEL); | |
12571 | + if (new_crypt == NULL) { | |
12572 | + ret = -ENOMEM; | |
12573 | + goto done; | |
12574 | + } | |
12575 | + memset(new_crypt, 0, sizeof(struct ieee80211_crypt_data)); | |
12576 | + new_crypt->ops = ops; | |
12577 | + if (new_crypt->ops && try_module_get(new_crypt->ops->owner)) | |
12578 | + new_crypt->priv = | |
12579 | + new_crypt->ops->init(param->u.crypt.idx); | |
12580 | + | |
12581 | + if (new_crypt->priv == NULL) { | |
12582 | + kfree(new_crypt); | |
12583 | + param->u.crypt.err = IEEE_CRYPT_ERR_CRYPT_INIT_FAILED; | |
12584 | + ret = -EINVAL; | |
12585 | + goto done; | |
12586 | + } | |
12587 | + | |
12588 | + *crypt = new_crypt; | |
12589 | + } | |
12590 | + | |
12591 | + if (param->u.crypt.key_len > 0 && (*crypt)->ops->set_key && | |
12592 | + (*crypt)->ops->set_key(param->u.crypt.key, | |
12593 | + param->u.crypt.key_len, param->u.crypt.seq, | |
12594 | + (*crypt)->priv) < 0) { | |
12595 | + printk("key setting failed\n"); | |
12596 | + param->u.crypt.err = IEEE_CRYPT_ERR_KEY_SET_FAILED; | |
12597 | + ret = -EINVAL; | |
12598 | + goto done; | |
12599 | + } | |
12600 | + | |
12601 | + skip_host_crypt: | |
12602 | + if (param->u.crypt.set_tx) { | |
12603 | + ieee->tx_keyidx = param->u.crypt.idx; | |
12604 | + sec.active_key = param->u.crypt.idx; | |
12605 | + sec.flags |= SEC_ACTIVE_KEY; | |
12606 | + } else | |
12607 | + sec.flags &= ~SEC_ACTIVE_KEY; | |
12608 | + | |
12609 | + if (param->u.crypt.alg != NULL) { | |
12610 | + memcpy(sec.keys[param->u.crypt.idx], | |
12611 | + param->u.crypt.key, | |
12612 | + param->u.crypt.key_len); | |
12613 | + sec.key_sizes[param->u.crypt.idx] = param->u.crypt.key_len; | |
12614 | + sec.flags |= (1 << param->u.crypt.idx); | |
12615 | + | |
12616 | + if (strcmp(param->u.crypt.alg, "WEP") == 0) { | |
12617 | + sec.flags |= SEC_LEVEL; | |
12618 | + sec.level = SEC_LEVEL_1; | |
12619 | + } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { | |
12620 | + sec.flags |= SEC_LEVEL; | |
12621 | + sec.level = SEC_LEVEL_2; | |
12622 | + } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { | |
12623 | + sec.flags |= SEC_LEVEL; | |
12624 | + sec.level = SEC_LEVEL_3; | |
12625 | + } | |
12626 | + } | |
12627 | + done: | |
12628 | + if (ieee->set_security) | |
12629 | + ieee->set_security(ieee->dev, &sec); | |
12630 | + | |
12631 | + /* Do not reset port if card is in Managed mode since resetting will | |
12632 | + * generate new IEEE 802.11 authentication which may end up in looping | |
12633 | + * with IEEE 802.1X. If your hardware requires a reset after WEP | |
12634 | + * configuration (for example... Prism2), implement the reset_port in | |
12635 | + * the callbacks structures used to initialize the 802.11 stack. */ | |
12636 | + if (ieee->reset_on_keychange && | |
12637 | + ieee->iw_mode != IW_MODE_INFRA && | |
12638 | + ieee->reset_port && | |
12639 | + ieee->reset_port(ieee->dev)) { | |
12640 | + printk("reset_port failed\n"); | |
12641 | + param->u.crypt.err = IEEE_CRYPT_ERR_CARD_CONF_FAILED; | |
12642 | + return -EINVAL; | |
12643 | + } | |
12644 | + | |
12645 | + return ret; | |
12646 | +} | |
12647 | + | |
12648 | +int ieee80211_wpa_supplicant_ioctl(struct ieee80211_device *ieee, struct iw_point *p) | |
12649 | +{ | |
12650 | + struct ieee_param *param; | |
12651 | + int ret=0; | |
12652 | + | |
12653 | + down(&ieee->wx_sem); | |
12654 | + //IEEE_DEBUG_INFO("wpa_supplicant: len=%d\n", p->length); | |
12655 | + | |
12656 | + if (p->length < sizeof(struct ieee_param) || !p->pointer){ | |
12657 | + ret = -EINVAL; | |
12658 | + goto out; | |
12659 | + } | |
12660 | + | |
12661 | + param = (struct ieee_param *)kmalloc(p->length, GFP_KERNEL); | |
12662 | + if (param == NULL){ | |
12663 | + ret = -ENOMEM; | |
12664 | + goto out; | |
12665 | + } | |
12666 | + if (copy_from_user(param, p->pointer, p->length)) { | |
12667 | + kfree(param); | |
12668 | + ret = -EFAULT; | |
12669 | + goto out; | |
12670 | + } | |
12671 | + | |
12672 | + switch (param->cmd) { | |
12673 | + | |
12674 | + case IEEE_CMD_SET_WPA_PARAM: | |
12675 | + ret = ieee80211_wpa_set_param(ieee, param->u.wpa_param.name, | |
12676 | + param->u.wpa_param.value); | |
12677 | + break; | |
12678 | + | |
12679 | + case IEEE_CMD_SET_WPA_IE: | |
12680 | + ret = ieee80211_wpa_set_wpa_ie(ieee, param, p->length); | |
12681 | + break; | |
12682 | + | |
12683 | + case IEEE_CMD_SET_ENCRYPTION: | |
12684 | + ret = ieee80211_wpa_set_encryption(ieee, param, p->length); | |
12685 | + break; | |
12686 | + | |
12687 | + case IEEE_CMD_MLME: | |
12688 | + ret = ieee80211_wpa_mlme(ieee, param->u.mlme.command, | |
12689 | + param->u.mlme.reason_code); | |
12690 | + break; | |
12691 | + | |
12692 | + default: | |
12693 | + printk("Unknown WPA supplicant request: %d\n",param->cmd); | |
12694 | + ret = -EOPNOTSUPP; | |
12695 | + break; | |
12696 | + } | |
12697 | + | |
12698 | + if (ret == 0 && copy_to_user(p->pointer, param, p->length)) | |
12699 | + ret = -EFAULT; | |
12700 | + | |
12701 | + kfree(param); | |
12702 | +out: | |
12703 | + up(&ieee->wx_sem); | |
12704 | + | |
12705 | + return ret; | |
12706 | +} | |
12707 | + | |
12708 | +void notify_wx_assoc_event(struct ieee80211_device *ieee) | |
12709 | +{ | |
12710 | + union iwreq_data wrqu; | |
12711 | + wrqu.ap_addr.sa_family = ARPHRD_ETHER; | |
12712 | + if (ieee->state == IEEE80211_LINKED) | |
12713 | + memcpy(wrqu.ap_addr.sa_data, ieee->current_network.bssid, ETH_ALEN); | |
12714 | + else | |
12715 | + memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN); | |
12716 | + wireless_send_event(ieee->dev, SIOCGIWAP, &wrqu, NULL); | |
12717 | +} | |
12718 | + | |
12719 | + | |
12720 | +#if 0 | |
12721 | +EXPORT_SYMBOL(ieee80211_get_beacon); | |
12722 | +EXPORT_SYMBOL(ieee80211_wake_queue); | |
12723 | +EXPORT_SYMBOL(ieee80211_stop_queue); | |
12724 | +EXPORT_SYMBOL(ieee80211_reset_queue); | |
12725 | +EXPORT_SYMBOL(ieee80211_softmac_stop_protocol); | |
12726 | +EXPORT_SYMBOL(ieee80211_softmac_start_protocol); | |
12727 | +EXPORT_SYMBOL(ieee80211_is_shortslot); | |
12728 | +EXPORT_SYMBOL(ieee80211_is_54g); | |
12729 | +EXPORT_SYMBOL(ieee80211_wpa_supplicant_ioctl); | |
12730 | +EXPORT_SYMBOL(ieee80211_ps_tx_ack); | |
12731 | +EXPORT_SYMBOL(ieee80211_start_protocol); | |
12732 | +EXPORT_SYMBOL(ieee80211_stop_protocol); | |
12733 | +EXPORT_SYMBOL(notify_wx_assoc_event); | |
12734 | +EXPORT_SYMBOL(ieee80211_stop_send_beacons); | |
12735 | +EXPORT_SYMBOL(SendDisassociation); | |
12736 | +EXPORT_SYMBOL(ieee80211_disassociate); | |
12737 | +EXPORT_SYMBOL(ieee80211_start_scan); | |
12738 | +EXPORT_SYMBOL(ieee80211_softmac_ips_scan_syncro); | |
12739 | +#ifdef _RTL8187_EXT_PATCH_ | |
12740 | +EXPORT_SYMBOL(ieee80211_ext_issue_assoc_req); | |
12741 | +EXPORT_SYMBOL(ieee80211_ext_issue_disassoc); | |
12742 | +EXPORT_SYMBOL(ieee80211_ext_issue_assoc_rsp); | |
12743 | +EXPORT_SYMBOL(softmac_mgmt_xmit); | |
12744 | +EXPORT_SYMBOL(ieee80211_ext_probe_resp_by_net); | |
12745 | +EXPORT_SYMBOL(ieee80211_start_scan); | |
12746 | +EXPORT_SYMBOL(ieee80211_stop_scan); | |
12747 | +EXPORT_SYMBOL(ieee80211_ext_send_11s_beacon); | |
12748 | +EXPORT_SYMBOL(ieee80211_rx_auth_rq); | |
12749 | +EXPORT_SYMBOL(ieee80211_associate_step1); | |
12750 | +#endif // _RTL8187_EXT_PATCH_ | |
12751 | +EXPORT_SYMBOL(ieee80211_sta_ps_send_null_frame); | |
12752 | +#endif | |
12753 | --- /dev/null | |
12754 | +++ b/drivers/staging/rtl8187se/ieee80211/ieee80211_softmac_wx.c | |
12755 | @@ -0,0 +1,602 @@ | |
12756 | +/* IEEE 802.11 SoftMAC layer | |
12757 | + * Copyright (c) 2005 Andrea Merello <andreamrl@tiscali.it> | |
12758 | + * | |
12759 | + * Mostly extracted from the rtl8180-sa2400 driver for the | |
12760 | + * in-kernel generic ieee802.11 stack. | |
12761 | + * | |
12762 | + * Some pieces of code might be stolen from ipw2100 driver | |
12763 | + * copyright of who own it's copyright ;-) | |
12764 | + * | |
12765 | + * PS wx handler mostly stolen from hostap, copyright who | |
12766 | + * own it's copyright ;-) | |
12767 | + * | |
12768 | + * released under the GPL | |
12769 | + */ | |
12770 | + | |
12771 | + | |
12772 | +#include "ieee80211.h" | |
12773 | + | |
12774 | +/* FIXME: add A freqs */ | |
12775 | + | |
12776 | +const long ieee80211_wlan_frequencies[] = { | |
12777 | + 2412, 2417, 2422, 2427, | |
12778 | + 2432, 2437, 2442, 2447, | |
12779 | + 2452, 2457, 2462, 2467, | |
12780 | + 2472, 2484 | |
12781 | +}; | |
12782 | + | |
12783 | + | |
12784 | +int ieee80211_wx_set_freq(struct ieee80211_device *ieee, struct iw_request_info *a, | |
12785 | + union iwreq_data *wrqu, char *b) | |
12786 | +{ | |
12787 | + int ret; | |
12788 | + struct iw_freq *fwrq = & wrqu->freq; | |
12789 | +// printk("in %s\n",__FUNCTION__); | |
12790 | + down(&ieee->wx_sem); | |
12791 | + | |
12792 | + if(ieee->iw_mode == IW_MODE_INFRA){ | |
12793 | + ret = -EOPNOTSUPP; | |
12794 | + goto out; | |
12795 | + } | |
12796 | + | |
12797 | + /* if setting by freq convert to channel */ | |
12798 | + if (fwrq->e == 1) { | |
12799 | + if ((fwrq->m >= (int) 2.412e8 && | |
12800 | + fwrq->m <= (int) 2.487e8)) { | |
12801 | + int f = fwrq->m / 100000; | |
12802 | + int c = 0; | |
12803 | + | |
12804 | + while ((c < 14) && (f != ieee80211_wlan_frequencies[c])) | |
12805 | + c++; | |
12806 | + | |
12807 | + /* hack to fall through */ | |
12808 | + fwrq->e = 0; | |
12809 | + fwrq->m = c + 1; | |
12810 | + } | |
12811 | + } | |
12812 | + | |
12813 | + if (fwrq->e > 0 || fwrq->m > 14 || fwrq->m < 1 ){ | |
12814 | + ret = -EOPNOTSUPP; | |
12815 | + goto out; | |
12816 | + | |
12817 | + }else { /* Set the channel */ | |
12818 | + | |
12819 | + | |
12820 | + ieee->current_network.channel = fwrq->m; | |
12821 | + ieee->set_chan(ieee->dev, ieee->current_network.channel); | |
12822 | + | |
12823 | + if(ieee->iw_mode == IW_MODE_ADHOC || ieee->iw_mode == IW_MODE_MASTER) | |
12824 | + if(ieee->state == IEEE80211_LINKED){ | |
12825 | + | |
12826 | + ieee80211_stop_send_beacons(ieee); | |
12827 | + ieee80211_start_send_beacons(ieee); | |
12828 | + } | |
12829 | + } | |
12830 | + | |
12831 | + ret = 0; | |
12832 | +out: | |
12833 | + up(&ieee->wx_sem); | |
12834 | + return ret; | |
12835 | +} | |
12836 | + | |
12837 | + | |
12838 | +int ieee80211_wx_get_freq(struct ieee80211_device *ieee, | |
12839 | + struct iw_request_info *a, | |
12840 | + union iwreq_data *wrqu, char *b) | |
12841 | +{ | |
12842 | + struct iw_freq *fwrq = & wrqu->freq; | |
12843 | + | |
12844 | + if (ieee->current_network.channel == 0) | |
12845 | + return -1; | |
12846 | + | |
12847 | + fwrq->m = ieee->current_network.channel; | |
12848 | + fwrq->e = 0; | |
12849 | + | |
12850 | + return 0; | |
12851 | +} | |
12852 | + | |
12853 | +int ieee80211_wx_get_wap(struct ieee80211_device *ieee, | |
12854 | + struct iw_request_info *info, | |
12855 | + union iwreq_data *wrqu, char *extra) | |
12856 | +{ | |
12857 | + unsigned long flags; | |
12858 | + | |
12859 | + wrqu->ap_addr.sa_family = ARPHRD_ETHER; | |
12860 | + | |
12861 | + if (ieee->iw_mode == IW_MODE_MONITOR) | |
12862 | + return -1; | |
12863 | + | |
12864 | + /* We want avoid to give to the user inconsistent infos*/ | |
12865 | + spin_lock_irqsave(&ieee->lock, flags); | |
12866 | + | |
12867 | + if (ieee->state != IEEE80211_LINKED && | |
12868 | + ieee->state != IEEE80211_LINKED_SCANNING && | |
12869 | + ieee->wap_set == 0) | |
12870 | + | |
12871 | + memset(wrqu->ap_addr.sa_data, 0, ETH_ALEN); | |
12872 | + else | |
12873 | + memcpy(wrqu->ap_addr.sa_data, | |
12874 | + ieee->current_network.bssid, ETH_ALEN); | |
12875 | + | |
12876 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
12877 | + | |
12878 | + return 0; | |
12879 | +} | |
12880 | + | |
12881 | + | |
12882 | +int ieee80211_wx_set_wap(struct ieee80211_device *ieee, | |
12883 | + struct iw_request_info *info, | |
12884 | + union iwreq_data *awrq, | |
12885 | + char *extra) | |
12886 | +{ | |
12887 | + | |
12888 | + int ret = 0; | |
12889 | + u8 zero[] = {0,0,0,0,0,0}; | |
12890 | + unsigned long flags; | |
12891 | + | |
12892 | + short ifup = ieee->proto_started;//dev->flags & IFF_UP; | |
12893 | + struct sockaddr *temp = (struct sockaddr *)awrq; | |
12894 | + | |
12895 | + //printk("=======Set WAP:"); | |
12896 | + ieee->sync_scan_hurryup = 1; | |
12897 | + | |
12898 | + down(&ieee->wx_sem); | |
12899 | + /* use ifconfig hw ether */ | |
12900 | + if (ieee->iw_mode == IW_MODE_MASTER){ | |
12901 | + ret = -1; | |
12902 | + goto out; | |
12903 | + } | |
12904 | + | |
12905 | + if (temp->sa_family != ARPHRD_ETHER){ | |
12906 | + ret = -EINVAL; | |
12907 | + goto out; | |
12908 | + } | |
12909 | + | |
12910 | + if (ifup) | |
12911 | + ieee80211_stop_protocol(ieee); | |
12912 | + | |
12913 | + /* just to avoid to give inconsistent infos in the | |
12914 | + * get wx method. not really needed otherwise | |
12915 | + */ | |
12916 | + spin_lock_irqsave(&ieee->lock, flags); | |
12917 | + | |
12918 | + memcpy(ieee->current_network.bssid, temp->sa_data, ETH_ALEN); | |
12919 | + ieee->wap_set = memcmp(temp->sa_data, zero,ETH_ALEN)!=0; | |
12920 | + //printk(" %x:%x:%x:%x:%x:%x\n", ieee->current_network.bssid[0],ieee->current_network.bssid[1],ieee->current_network.bssid[2],ieee->current_network.bssid[3],ieee->current_network.bssid[4],ieee->current_network.bssid[5]); | |
12921 | + | |
12922 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
12923 | + | |
12924 | + if (ifup) | |
12925 | + ieee80211_start_protocol(ieee); | |
12926 | + | |
12927 | +out: | |
12928 | + up(&ieee->wx_sem); | |
12929 | + return ret; | |
12930 | +} | |
12931 | + | |
12932 | + int ieee80211_wx_get_essid(struct ieee80211_device *ieee, struct iw_request_info *a,union iwreq_data *wrqu,char *b) | |
12933 | +{ | |
12934 | + int len,ret = 0; | |
12935 | + unsigned long flags; | |
12936 | + | |
12937 | + if (ieee->iw_mode == IW_MODE_MONITOR) | |
12938 | + return -1; | |
12939 | + | |
12940 | + /* We want avoid to give to the user inconsistent infos*/ | |
12941 | + spin_lock_irqsave(&ieee->lock, flags); | |
12942 | + | |
12943 | + if (ieee->current_network.ssid[0] == '\0' || | |
12944 | + ieee->current_network.ssid_len == 0){ | |
12945 | + ret = -1; | |
12946 | + goto out; | |
12947 | + } | |
12948 | + | |
12949 | + if (ieee->state != IEEE80211_LINKED && | |
12950 | + ieee->state != IEEE80211_LINKED_SCANNING && | |
12951 | + ieee->ssid_set == 0){ | |
12952 | + ret = -1; | |
12953 | + goto out; | |
12954 | + } | |
12955 | + len = ieee->current_network.ssid_len; | |
12956 | + wrqu->essid.length = len; | |
12957 | + strncpy(b,ieee->current_network.ssid,len); | |
12958 | + wrqu->essid.flags = 1; | |
12959 | + | |
12960 | +out: | |
12961 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
12962 | + | |
12963 | + return ret; | |
12964 | + | |
12965 | +} | |
12966 | + | |
12967 | +int ieee80211_wx_set_rate(struct ieee80211_device *ieee, | |
12968 | + struct iw_request_info *info, | |
12969 | + union iwreq_data *wrqu, char *extra) | |
12970 | +{ | |
12971 | + | |
12972 | + u32 target_rate = wrqu->bitrate.value; | |
12973 | + | |
12974 | + //added by lizhaoming for auto mode | |
12975 | + if(target_rate == -1){ | |
12976 | + ieee->rate = 110; | |
12977 | + } else { | |
12978 | + ieee->rate = target_rate/100000; | |
12979 | + } | |
12980 | + //FIXME: we might want to limit rate also in management protocols. | |
12981 | + return 0; | |
12982 | +} | |
12983 | + | |
12984 | + | |
12985 | + | |
12986 | +int ieee80211_wx_get_rate(struct ieee80211_device *ieee, | |
12987 | + struct iw_request_info *info, | |
12988 | + union iwreq_data *wrqu, char *extra) | |
12989 | +{ | |
12990 | + | |
12991 | + wrqu->bitrate.value = ieee->rate * 100000; | |
12992 | + | |
12993 | + return 0; | |
12994 | +} | |
12995 | + | |
12996 | +int ieee80211_wx_set_mode(struct ieee80211_device *ieee, struct iw_request_info *a, | |
12997 | + union iwreq_data *wrqu, char *b) | |
12998 | +{ | |
12999 | + | |
13000 | + ieee->sync_scan_hurryup = 1; | |
13001 | + | |
13002 | + down(&ieee->wx_sem); | |
13003 | + | |
13004 | + if (wrqu->mode == ieee->iw_mode) | |
13005 | + goto out; | |
13006 | + | |
13007 | + if (wrqu->mode == IW_MODE_MONITOR){ | |
13008 | + | |
13009 | + ieee->dev->type = ARPHRD_IEEE80211; | |
13010 | + }else{ | |
13011 | + ieee->dev->type = ARPHRD_ETHER; | |
13012 | + } | |
13013 | + | |
13014 | + if (!ieee->proto_started){ | |
13015 | + ieee->iw_mode = wrqu->mode; | |
13016 | + }else{ | |
13017 | + ieee80211_stop_protocol(ieee); | |
13018 | + ieee->iw_mode = wrqu->mode; | |
13019 | + ieee80211_start_protocol(ieee); | |
13020 | + } | |
13021 | + | |
13022 | +out: | |
13023 | + up(&ieee->wx_sem); | |
13024 | + return 0; | |
13025 | +} | |
13026 | + | |
13027 | + | |
13028 | +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20) | |
13029 | +void ieee80211_wx_sync_scan_wq(struct work_struct *work) | |
13030 | +{ | |
13031 | + struct ieee80211_device *ieee = container_of(work, struct ieee80211_device, wx_sync_scan_wq); | |
13032 | +#else | |
13033 | +void ieee80211_wx_sync_scan_wq(struct ieee80211_device *ieee) | |
13034 | +{ | |
13035 | +#endif | |
13036 | +//void ieee80211_wx_sync_scan_wq(struct ieee80211_device *ieee) | |
13037 | +//{ | |
13038 | + short chan; | |
13039 | + | |
13040 | + chan = ieee->current_network.channel; | |
13041 | + | |
13042 | + netif_carrier_off(ieee->dev); | |
13043 | + | |
13044 | + if (ieee->data_hard_stop) | |
13045 | + ieee->data_hard_stop(ieee->dev); | |
13046 | + | |
13047 | + ieee80211_stop_send_beacons(ieee); | |
13048 | + | |
13049 | + ieee->state = IEEE80211_LINKED_SCANNING; | |
13050 | + ieee->link_change(ieee->dev); | |
13051 | + | |
13052 | + ieee80211_start_scan_syncro(ieee); | |
13053 | + | |
13054 | + ieee->set_chan(ieee->dev, chan); | |
13055 | + | |
13056 | + ieee->state = IEEE80211_LINKED; | |
13057 | + ieee->link_change(ieee->dev); | |
13058 | + | |
13059 | + if (ieee->data_hard_resume) | |
13060 | + ieee->data_hard_resume(ieee->dev); | |
13061 | + | |
13062 | + if(ieee->iw_mode == IW_MODE_ADHOC || ieee->iw_mode == IW_MODE_MASTER) | |
13063 | + ieee80211_start_send_beacons(ieee); | |
13064 | + | |
13065 | + netif_carrier_on(ieee->dev); | |
13066 | + | |
13067 | + //YJ,add,080828, In prevent of lossing ping packet during scanning | |
13068 | + //ieee80211_sta_ps_send_null_frame(ieee, false); | |
13069 | + //YJ,add,080828,end | |
13070 | + | |
13071 | + up(&ieee->wx_sem); | |
13072 | + | |
13073 | +} | |
13074 | + | |
13075 | +int ieee80211_wx_set_scan(struct ieee80211_device *ieee, struct iw_request_info *a, | |
13076 | + union iwreq_data *wrqu, char *b) | |
13077 | +{ | |
13078 | + int ret = 0; | |
13079 | + | |
13080 | + down(&ieee->wx_sem); | |
13081 | + | |
13082 | + if (ieee->iw_mode == IW_MODE_MONITOR || !(ieee->proto_started)){ | |
13083 | + ret = -1; | |
13084 | + goto out; | |
13085 | + } | |
13086 | + //YJ,add,080828 | |
13087 | + //In prevent of lossing ping packet during scanning | |
13088 | + //ieee80211_sta_ps_send_null_frame(ieee, true); | |
13089 | + //YJ,add,080828,end | |
13090 | + | |
13091 | + if ( ieee->state == IEEE80211_LINKED){ | |
13092 | + queue_work(ieee->wq, &ieee->wx_sync_scan_wq); | |
13093 | + /* intentionally forget to up sem */ | |
13094 | + return 0; | |
13095 | + } | |
13096 | + | |
13097 | +out: | |
13098 | + up(&ieee->wx_sem); | |
13099 | + return ret; | |
13100 | +} | |
13101 | + | |
13102 | +int ieee80211_wx_set_essid(struct ieee80211_device *ieee, | |
13103 | + struct iw_request_info *a, | |
13104 | + union iwreq_data *wrqu, char *extra) | |
13105 | +{ | |
13106 | + | |
13107 | + int ret=0,len; | |
13108 | + short proto_started; | |
13109 | + unsigned long flags; | |
13110 | + | |
13111 | + ieee->sync_scan_hurryup = 1; | |
13112 | + | |
13113 | + down(&ieee->wx_sem); | |
13114 | + | |
13115 | + proto_started = ieee->proto_started; | |
13116 | + | |
13117 | + if (wrqu->essid.length > IW_ESSID_MAX_SIZE){ | |
13118 | + ret= -E2BIG; | |
13119 | + goto out; | |
13120 | + } | |
13121 | + | |
13122 | + if (ieee->iw_mode == IW_MODE_MONITOR){ | |
13123 | + ret= -1; | |
13124 | + goto out; | |
13125 | + } | |
13126 | + | |
13127 | + if(proto_started) | |
13128 | + ieee80211_stop_protocol(ieee); | |
13129 | + | |
13130 | + /* this is just to be sure that the GET wx callback | |
13131 | + * has consisten infos. not needed otherwise | |
13132 | + */ | |
13133 | + spin_lock_irqsave(&ieee->lock, flags); | |
13134 | + | |
13135 | + if (wrqu->essid.flags && wrqu->essid.length) { | |
13136 | +//YJ,modified,080819 | |
13137 | +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20) | |
13138 | + len = ((wrqu->essid.length-1) < IW_ESSID_MAX_SIZE) ? (wrqu->essid.length-1) : IW_ESSID_MAX_SIZE; | |
13139 | +#else | |
13140 | + len = (wrqu->essid.length < IW_ESSID_MAX_SIZE) ? (wrqu->essid.length) : IW_ESSID_MAX_SIZE; | |
13141 | +#endif | |
13142 | + memset(ieee->current_network.ssid, 0, ieee->current_network.ssid_len); //YJ,add,080819 | |
13143 | + strncpy(ieee->current_network.ssid, extra, len); | |
13144 | + ieee->current_network.ssid_len = len; | |
13145 | + ieee->ssid_set = 1; | |
13146 | +//YJ,modified,080819,end | |
13147 | + | |
13148 | + //YJ,add,080819,for hidden ap | |
13149 | + if(len == 0){ | |
13150 | + memset(ieee->current_network.bssid, 0, ETH_ALEN); | |
13151 | + ieee->current_network.capability = 0; | |
13152 | + } | |
13153 | + //YJ,add,080819,for hidden ap,end | |
13154 | + } | |
13155 | + else{ | |
13156 | + ieee->ssid_set = 0; | |
13157 | + ieee->current_network.ssid[0] = '\0'; | |
13158 | + ieee->current_network.ssid_len = 0; | |
13159 | + } | |
13160 | + //printk("==========set essid %s!\n",ieee->current_network.ssid); | |
13161 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
13162 | + | |
13163 | + if (proto_started) | |
13164 | + ieee80211_start_protocol(ieee); | |
13165 | +out: | |
13166 | + up(&ieee->wx_sem); | |
13167 | + return ret; | |
13168 | +} | |
13169 | + | |
13170 | + int ieee80211_wx_get_mode(struct ieee80211_device *ieee, struct iw_request_info *a, | |
13171 | + union iwreq_data *wrqu, char *b) | |
13172 | +{ | |
13173 | + | |
13174 | + wrqu->mode = ieee->iw_mode; | |
13175 | + return 0; | |
13176 | +} | |
13177 | + | |
13178 | + int ieee80211_wx_set_rawtx(struct ieee80211_device *ieee, | |
13179 | + struct iw_request_info *info, | |
13180 | + union iwreq_data *wrqu, char *extra) | |
13181 | +{ | |
13182 | + | |
13183 | + int *parms = (int *)extra; | |
13184 | + int enable = (parms[0] > 0); | |
13185 | + short prev = ieee->raw_tx; | |
13186 | + | |
13187 | + down(&ieee->wx_sem); | |
13188 | + | |
13189 | + if(enable) | |
13190 | + ieee->raw_tx = 1; | |
13191 | + else | |
13192 | + ieee->raw_tx = 0; | |
13193 | + | |
13194 | + printk(KERN_INFO"raw TX is %s\n", | |
13195 | + ieee->raw_tx ? "enabled" : "disabled"); | |
13196 | + | |
13197 | + if(ieee->iw_mode == IW_MODE_MONITOR) | |
13198 | + { | |
13199 | + if(prev == 0 && ieee->raw_tx){ | |
13200 | + if (ieee->data_hard_resume) | |
13201 | + ieee->data_hard_resume(ieee->dev); | |
13202 | + | |
13203 | + netif_carrier_on(ieee->dev); | |
13204 | + } | |
13205 | + | |
13206 | + if(prev && ieee->raw_tx == 1) | |
13207 | + netif_carrier_off(ieee->dev); | |
13208 | + } | |
13209 | + | |
13210 | + up(&ieee->wx_sem); | |
13211 | + | |
13212 | + return 0; | |
13213 | +} | |
13214 | + | |
13215 | +int ieee80211_wx_get_name(struct ieee80211_device *ieee, | |
13216 | + struct iw_request_info *info, | |
13217 | + union iwreq_data *wrqu, char *extra) | |
13218 | +{ | |
13219 | + strcpy(wrqu->name, "802.11"); | |
13220 | + if(ieee->modulation & IEEE80211_CCK_MODULATION){ | |
13221 | + strcat(wrqu->name, "b"); | |
13222 | + if(ieee->modulation & IEEE80211_OFDM_MODULATION) | |
13223 | + strcat(wrqu->name, "/g"); | |
13224 | + }else if(ieee->modulation & IEEE80211_OFDM_MODULATION) | |
13225 | + strcat(wrqu->name, "g"); | |
13226 | + | |
13227 | + if((ieee->state == IEEE80211_LINKED) || | |
13228 | + (ieee->state == IEEE80211_LINKED_SCANNING)) | |
13229 | + strcat(wrqu->name," linked"); | |
13230 | + else if(ieee->state != IEEE80211_NOLINK) | |
13231 | + strcat(wrqu->name," link.."); | |
13232 | + | |
13233 | + | |
13234 | + return 0; | |
13235 | +} | |
13236 | + | |
13237 | + | |
13238 | +/* this is mostly stolen from hostap */ | |
13239 | +int ieee80211_wx_set_power(struct ieee80211_device *ieee, | |
13240 | + struct iw_request_info *info, | |
13241 | + union iwreq_data *wrqu, char *extra) | |
13242 | +{ | |
13243 | + int ret = 0; | |
13244 | + | |
13245 | + if( | |
13246 | + (!ieee->sta_wake_up) || | |
13247 | + (!ieee->ps_request_tx_ack) || | |
13248 | + (!ieee->enter_sleep_state) || | |
13249 | + (!ieee->ps_is_queue_empty)){ | |
13250 | + | |
13251 | + printk("ERROR. PS mode is tryied to be use but\ | |
13252 | +driver missed a callback\n\n"); | |
13253 | + | |
13254 | + return -1; | |
13255 | + } | |
13256 | + | |
13257 | + down(&ieee->wx_sem); | |
13258 | + | |
13259 | + if (wrqu->power.disabled){ | |
13260 | + ieee->ps = IEEE80211_PS_DISABLED; | |
13261 | + | |
13262 | + goto exit; | |
13263 | + } | |
13264 | + switch (wrqu->power.flags & IW_POWER_MODE) { | |
13265 | + case IW_POWER_UNICAST_R: | |
13266 | + ieee->ps = IEEE80211_PS_UNICAST; | |
13267 | + | |
13268 | + break; | |
13269 | + case IW_POWER_ALL_R: | |
13270 | + ieee->ps = IEEE80211_PS_UNICAST | IEEE80211_PS_MBCAST; | |
13271 | + break; | |
13272 | + | |
13273 | + case IW_POWER_ON: | |
13274 | + ieee->ps = IEEE80211_PS_DISABLED; | |
13275 | + break; | |
13276 | + | |
13277 | + default: | |
13278 | + ret = -EINVAL; | |
13279 | + goto exit; | |
13280 | + } | |
13281 | + | |
13282 | + if (wrqu->power.flags & IW_POWER_TIMEOUT) { | |
13283 | + | |
13284 | + ieee->ps_timeout = wrqu->power.value / 1000; | |
13285 | + printk("Timeout %d\n",ieee->ps_timeout); | |
13286 | + } | |
13287 | + | |
13288 | + if (wrqu->power.flags & IW_POWER_PERIOD) { | |
13289 | + | |
13290 | + ret = -EOPNOTSUPP; | |
13291 | + goto exit; | |
13292 | + //wrq->value / 1024; | |
13293 | + | |
13294 | + } | |
13295 | +exit: | |
13296 | + up(&ieee->wx_sem); | |
13297 | + return ret; | |
13298 | + | |
13299 | +} | |
13300 | + | |
13301 | +/* this is stolen from hostap */ | |
13302 | +int ieee80211_wx_get_power(struct ieee80211_device *ieee, | |
13303 | + struct iw_request_info *info, | |
13304 | + union iwreq_data *wrqu, char *extra) | |
13305 | +{ | |
13306 | + int ret =0; | |
13307 | + | |
13308 | + down(&ieee->wx_sem); | |
13309 | + | |
13310 | + if(ieee->ps == IEEE80211_PS_DISABLED){ | |
13311 | + wrqu->power.disabled = 1; | |
13312 | + goto exit; | |
13313 | + } | |
13314 | + | |
13315 | + wrqu->power.disabled = 0; | |
13316 | + | |
13317 | +// if ((wrqu->power.flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) { | |
13318 | + wrqu->power.flags = IW_POWER_TIMEOUT; | |
13319 | + wrqu->power.value = ieee->ps_timeout * 1000; | |
13320 | +// } else { | |
13321 | +// ret = -EOPNOTSUPP; | |
13322 | +// goto exit; | |
13323 | + //wrqu->power.flags = IW_POWER_PERIOD; | |
13324 | + //wrqu->power.value = ieee->current_network.dtim_period * | |
13325 | + // ieee->current_network.beacon_interval * 1024; | |
13326 | +// } | |
13327 | + | |
13328 | + | |
13329 | + if (ieee->ps & IEEE80211_PS_MBCAST) | |
13330 | + wrqu->power.flags |= IW_POWER_ALL_R; | |
13331 | + else | |
13332 | + wrqu->power.flags |= IW_POWER_UNICAST_R; | |
13333 | + | |
13334 | +exit: | |
13335 | + up(&ieee->wx_sem); | |
13336 | + return ret; | |
13337 | + | |
13338 | +} | |
13339 | + | |
13340 | +#if 0 | |
13341 | +EXPORT_SYMBOL(ieee80211_wx_get_essid); | |
13342 | +EXPORT_SYMBOL(ieee80211_wx_set_essid); | |
13343 | +EXPORT_SYMBOL(ieee80211_wx_set_rate); | |
13344 | +EXPORT_SYMBOL(ieee80211_wx_get_rate); | |
13345 | +EXPORT_SYMBOL(ieee80211_wx_set_wap); | |
13346 | +EXPORT_SYMBOL(ieee80211_wx_get_wap); | |
13347 | +EXPORT_SYMBOL(ieee80211_wx_set_mode); | |
13348 | +EXPORT_SYMBOL(ieee80211_wx_get_mode); | |
13349 | +EXPORT_SYMBOL(ieee80211_wx_set_scan); | |
13350 | +EXPORT_SYMBOL(ieee80211_wx_get_freq); | |
13351 | +EXPORT_SYMBOL(ieee80211_wx_set_freq); | |
13352 | +EXPORT_SYMBOL(ieee80211_wx_set_rawtx); | |
13353 | +EXPORT_SYMBOL(ieee80211_wx_get_name); | |
13354 | +EXPORT_SYMBOL(ieee80211_wx_set_power); | |
13355 | +EXPORT_SYMBOL(ieee80211_wx_get_power); | |
13356 | +EXPORT_SYMBOL(ieee80211_wlan_frequencies); | |
13357 | +#endif | |
13358 | --- /dev/null | |
13359 | +++ b/drivers/staging/rtl8187se/ieee80211/ieee80211_tx.c | |
13360 | @@ -0,0 +1,828 @@ | |
13361 | +/****************************************************************************** | |
13362 | + | |
13363 | + Copyright(c) 2003 - 2004 Intel Corporation. All rights reserved. | |
13364 | + | |
13365 | + This program is free software; you can redistribute it and/or modify it | |
13366 | + under the terms of version 2 of the GNU General Public License as | |
13367 | + published by the Free Software Foundation. | |
13368 | + | |
13369 | + This program is distributed in the hope that it will be useful, but WITHOUT | |
13370 | + ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
13371 | + FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
13372 | + more details. | |
13373 | + | |
13374 | + You should have received a copy of the GNU General Public License along with | |
13375 | + this program; if not, write to the Free Software Foundation, Inc., 59 | |
13376 | + Temple Place - Suite 330, Boston, MA 02111-1307, USA. | |
13377 | + | |
13378 | + The full GNU General Public License is included in this distribution in the | |
13379 | + file called LICENSE. | |
13380 | + | |
13381 | + Contact Information: | |
13382 | + James P. Ketrenos <ipw2100-admin@linux.intel.com> | |
13383 | + Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 | |
13384 | + | |
13385 | +****************************************************************************** | |
13386 | + | |
13387 | + Few modifications for Realtek's Wi-Fi drivers by | |
13388 | + Andrea Merello <andreamrl@tiscali.it> | |
13389 | + | |
13390 | + A special thanks goes to Realtek for their support ! | |
13391 | + | |
13392 | +******************************************************************************/ | |
13393 | + | |
13394 | +#include <linux/compiler.h> | |
13395 | +//#include <linux/config.h> | |
13396 | +#include <linux/errno.h> | |
13397 | +#include <linux/if_arp.h> | |
13398 | +#include <linux/in6.h> | |
13399 | +#include <linux/in.h> | |
13400 | +#include <linux/ip.h> | |
13401 | +#include <linux/kernel.h> | |
13402 | +#include <linux/module.h> | |
13403 | +#include <linux/netdevice.h> | |
13404 | +#include <linux/pci.h> | |
13405 | +#include <linux/proc_fs.h> | |
13406 | +#include <linux/skbuff.h> | |
13407 | +#include <linux/slab.h> | |
13408 | +#include <linux/tcp.h> | |
13409 | +#include <linux/types.h> | |
13410 | +#include <linux/version.h> | |
13411 | +#include <linux/wireless.h> | |
13412 | +#include <linux/etherdevice.h> | |
13413 | +#include <asm/uaccess.h> | |
13414 | +#include <linux/if_vlan.h> | |
13415 | + | |
13416 | +#include "ieee80211.h" | |
13417 | + | |
13418 | + | |
13419 | +/* | |
13420 | + | |
13421 | + | |
13422 | +802.11 Data Frame | |
13423 | + | |
13424 | + | |
13425 | +802.11 frame_contorl for data frames - 2 bytes | |
13426 | + ,-----------------------------------------------------------------------------------------. | |
13427 | +bits | 0 | 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 | 9 | a | b | c | d | e | | |
13428 | + |----|-----|-----|-----|-----|-----|-----|-----|-----|-----|-----|-----|-----|-----|------| | |
13429 | +val | 0 | 0 | 0 | 1 | x | 0 | 0 | 0 | 1 | 0 | x | x | x | x | x | | |
13430 | + |----|-----|-----|-----|-----|-----|-----|-----|-----|-----|-----|-----|-----|-----|------| | |
13431 | +desc | ^-ver-^ | ^type-^ | ^-----subtype-----^ | to |from |more |retry| pwr |more |wep | | |
13432 | + | | | x=0 data,x=1 data+ack | DS | DS |frag | | mgm |data | | | |
13433 | + '-----------------------------------------------------------------------------------------' | |
13434 | + /\ | |
13435 | + | | |
13436 | +802.11 Data Frame | | |
13437 | + ,--------- 'ctrl' expands to >-----------' | |
13438 | + | | |
13439 | + ,--'---,-------------------------------------------------------------. | |
13440 | +Bytes | 2 | 2 | 6 | 6 | 6 | 2 | 0..2312 | 4 | | |
13441 | + |------|------|---------|---------|---------|------|---------|------| | |
13442 | +Desc. | ctrl | dura | DA/RA | TA | SA | Sequ | Frame | fcs | | |
13443 | + | | tion | (BSSID) | | | ence | data | | | |
13444 | + `--------------------------------------------------| |------' | |
13445 | +Total: 28 non-data bytes `----.----' | |
13446 | + | | |
13447 | + .- 'Frame data' expands to <---------------------------' | |
13448 | + | | |
13449 | + V | |
13450 | + ,---------------------------------------------------. | |
13451 | +Bytes | 1 | 1 | 1 | 3 | 2 | 0-2304 | | |
13452 | + |------|------|---------|----------|------|---------| | |
13453 | +Desc. | SNAP | SNAP | Control |Eth Tunnel| Type | IP | | |
13454 | + | DSAP | SSAP | | | | Packet | | |
13455 | + | 0xAA | 0xAA |0x03 (UI)|0x00-00-F8| | | | |
13456 | + `-----------------------------------------| | | |
13457 | +Total: 8 non-data bytes `----.----' | |
13458 | + | | |
13459 | + .- 'IP Packet' expands, if WEP enabled, to <--' | |
13460 | + | | |
13461 | + V | |
13462 | + ,-----------------------. | |
13463 | +Bytes | 4 | 0-2296 | 4 | | |
13464 | + |-----|-----------|-----| | |
13465 | +Desc. | IV | Encrypted | ICV | | |
13466 | + | | IP Packet | | | |
13467 | + `-----------------------' | |
13468 | +Total: 8 non-data bytes | |
13469 | + | |
13470 | + | |
13471 | +802.3 Ethernet Data Frame | |
13472 | + | |
13473 | + ,-----------------------------------------. | |
13474 | +Bytes | 6 | 6 | 2 | Variable | 4 | | |
13475 | + |-------|-------|------|-----------|------| | |
13476 | +Desc. | Dest. | Source| Type | IP Packet | fcs | | |
13477 | + | MAC | MAC | | | | | |
13478 | + `-----------------------------------------' | |
13479 | +Total: 18 non-data bytes | |
13480 | + | |
13481 | +In the event that fragmentation is required, the incoming payload is split into | |
13482 | +N parts of size ieee->fts. The first fragment contains the SNAP header and the | |
13483 | +remaining packets are just data. | |
13484 | + | |
13485 | +If encryption is enabled, each fragment payload size is reduced by enough space | |
13486 | +to add the prefix and postfix (IV and ICV totalling 8 bytes in the case of WEP) | |
13487 | +So if you have 1500 bytes of payload with ieee->fts set to 500 without | |
13488 | +encryption it will take 3 frames. With WEP it will take 4 frames as the | |
13489 | +payload of each frame is reduced to 492 bytes. | |
13490 | + | |
13491 | +* SKB visualization | |
13492 | +* | |
13493 | +* ,- skb->data | |
13494 | +* | | |
13495 | +* | ETHERNET HEADER ,-<-- PAYLOAD | |
13496 | +* | | 14 bytes from skb->data | |
13497 | +* | 2 bytes for Type --> ,T. | (sizeof ethhdr) | |
13498 | +* | | | | | |
13499 | +* |,-Dest.--. ,--Src.---. | | | | |
13500 | +* | 6 bytes| | 6 bytes | | | | | |
13501 | +* v | | | | | | | |
13502 | +* 0 | v 1 | v | v 2 | |
13503 | +* 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 | |
13504 | +* ^ | ^ | ^ | | |
13505 | +* | | | | | | | |
13506 | +* | | | | `T' <---- 2 bytes for Type | |
13507 | +* | | | | | |
13508 | +* | | '---SNAP--' <-------- 6 bytes for SNAP | |
13509 | +* | | | |
13510 | +* `-IV--' <-------------------- 4 bytes for IV (WEP) | |
13511 | +* | |
13512 | +* SNAP HEADER | |
13513 | +* | |
13514 | +*/ | |
13515 | + | |
13516 | +static u8 P802_1H_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0xf8 }; | |
13517 | +static u8 RFC1042_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0x00 }; | |
13518 | + | |
13519 | +static inline int ieee80211_put_snap(u8 *data, u16 h_proto) | |
13520 | +{ | |
13521 | + struct ieee80211_snap_hdr *snap; | |
13522 | + u8 *oui; | |
13523 | + | |
13524 | + snap = (struct ieee80211_snap_hdr *)data; | |
13525 | + snap->dsap = 0xaa; | |
13526 | + snap->ssap = 0xaa; | |
13527 | + snap->ctrl = 0x03; | |
13528 | + | |
13529 | + if (h_proto == 0x8137 || h_proto == 0x80f3) | |
13530 | + oui = P802_1H_OUI; | |
13531 | + else | |
13532 | + oui = RFC1042_OUI; | |
13533 | + snap->oui[0] = oui[0]; | |
13534 | + snap->oui[1] = oui[1]; | |
13535 | + snap->oui[2] = oui[2]; | |
13536 | + | |
13537 | + *(u16 *)(data + SNAP_SIZE) = htons(h_proto); | |
13538 | + | |
13539 | + return SNAP_SIZE + sizeof(u16); | |
13540 | +} | |
13541 | + | |
13542 | +int ieee80211_encrypt_fragment( | |
13543 | + struct ieee80211_device *ieee, | |
13544 | + struct sk_buff *frag, | |
13545 | + int hdr_len) | |
13546 | +{ | |
13547 | + struct ieee80211_crypt_data* crypt = ieee->crypt[ieee->tx_keyidx]; | |
13548 | + int res; | |
13549 | + | |
13550 | + /*added to care about null crypt condition, to solve that system hangs when shared keys error*/ | |
13551 | + if (!crypt || !crypt->ops) | |
13552 | + return -1; | |
13553 | + | |
13554 | +#ifdef CONFIG_IEEE80211_CRYPT_TKIP | |
13555 | + struct ieee80211_hdr *header; | |
13556 | + | |
13557 | + if (ieee->tkip_countermeasures && | |
13558 | + crypt && crypt->ops && strcmp(crypt->ops->name, "TKIP") == 0) { | |
13559 | + header = (struct ieee80211_hdr *) frag->data; | |
13560 | + if (net_ratelimit()) { | |
13561 | + printk(KERN_DEBUG "%s: TKIP countermeasures: dropped " | |
13562 | + "TX packet to " MAC_FMT "\n", | |
13563 | + ieee->dev->name, MAC_ARG(header->addr1)); | |
13564 | + } | |
13565 | + return -1; | |
13566 | + } | |
13567 | +#endif | |
13568 | + /* To encrypt, frame format is: | |
13569 | + * IV (4 bytes), clear payload (including SNAP), ICV (4 bytes) */ | |
13570 | + | |
13571 | + // PR: FIXME: Copied from hostap. Check fragmentation/MSDU/MPDU encryption. | |
13572 | + /* Host-based IEEE 802.11 fragmentation for TX is not yet supported, so | |
13573 | + * call both MSDU and MPDU encryption functions from here. */ | |
13574 | + atomic_inc(&crypt->refcnt); | |
13575 | + res = 0; | |
13576 | + if (crypt->ops->encrypt_msdu) | |
13577 | + res = crypt->ops->encrypt_msdu(frag, hdr_len, crypt->priv); | |
13578 | + if (res == 0 && crypt->ops->encrypt_mpdu) | |
13579 | + res = crypt->ops->encrypt_mpdu(frag, hdr_len, crypt->priv); | |
13580 | + | |
13581 | + atomic_dec(&crypt->refcnt); | |
13582 | + if (res < 0) { | |
13583 | + printk(KERN_INFO "%s: Encryption failed: len=%d.\n", | |
13584 | + ieee->dev->name, frag->len); | |
13585 | + ieee->ieee_stats.tx_discards++; | |
13586 | + return -1; | |
13587 | + } | |
13588 | + | |
13589 | + return 0; | |
13590 | +} | |
13591 | + | |
13592 | + | |
13593 | +void ieee80211_txb_free(struct ieee80211_txb *txb) { | |
13594 | + int i; | |
13595 | + if (unlikely(!txb)) | |
13596 | + return; | |
13597 | + for (i = 0; i < txb->nr_frags; i++) | |
13598 | + if (txb->fragments[i]) | |
13599 | + dev_kfree_skb_any(txb->fragments[i]); | |
13600 | + kfree(txb); | |
13601 | +} | |
13602 | + | |
13603 | +struct ieee80211_txb *ieee80211_alloc_txb(int nr_frags, int txb_size, | |
13604 | + int gfp_mask) | |
13605 | +{ | |
13606 | + struct ieee80211_txb *txb; | |
13607 | + int i; | |
13608 | + txb = kmalloc( | |
13609 | + sizeof(struct ieee80211_txb) + (sizeof(u8*) * nr_frags), | |
13610 | + gfp_mask); | |
13611 | + if (!txb) | |
13612 | + return NULL; | |
13613 | + | |
13614 | + memset(txb, 0, sizeof(struct ieee80211_txb)); | |
13615 | + txb->nr_frags = nr_frags; | |
13616 | + txb->frag_size = txb_size; | |
13617 | + | |
13618 | + for (i = 0; i < nr_frags; i++) { | |
13619 | + txb->fragments[i] = dev_alloc_skb(txb_size); | |
13620 | + if (unlikely(!txb->fragments[i])) { | |
13621 | + i--; | |
13622 | + break; | |
13623 | + } | |
13624 | + } | |
13625 | + if (unlikely(i != nr_frags)) { | |
13626 | + while (i >= 0) | |
13627 | + dev_kfree_skb_any(txb->fragments[i--]); | |
13628 | + kfree(txb); | |
13629 | + return NULL; | |
13630 | + } | |
13631 | + return txb; | |
13632 | +} | |
13633 | + | |
13634 | +// Classify the to-be send data packet | |
13635 | +// Need to acquire the sent queue index. | |
13636 | +static int | |
13637 | +ieee80211_classify(struct sk_buff *skb, struct ieee80211_network *network) | |
13638 | +{ | |
13639 | + struct ether_header *eh = (struct ether_header*)skb->data; | |
13640 | + unsigned int wme_UP = 0; | |
13641 | + | |
13642 | + if(!network->QoS_Enable) { | |
13643 | + skb->priority = 0; | |
13644 | + return(wme_UP); | |
13645 | + } | |
13646 | + | |
13647 | + if(eh->ether_type == __constant_htons(ETHERTYPE_IP)) { | |
13648 | + const struct iphdr *ih = (struct iphdr*)(skb->data + \ | |
13649 | + sizeof(struct ether_header)); | |
13650 | + wme_UP = (ih->tos >> 5)&0x07; | |
13651 | + } else if (vlan_tx_tag_present(skb)) {//vtag packet | |
13652 | +#ifndef VLAN_PRI_SHIFT | |
13653 | +#define VLAN_PRI_SHIFT 13 /* Shift to find VLAN user priority */ | |
13654 | +#define VLAN_PRI_MASK 7 /* Mask for user priority bits in VLAN */ | |
13655 | +#endif | |
13656 | + u32 tag = vlan_tx_tag_get(skb); | |
13657 | + wme_UP = (tag >> VLAN_PRI_SHIFT) & VLAN_PRI_MASK; | |
13658 | + } else if(ETH_P_PAE == ntohs(((struct ethhdr *)skb->data)->h_proto)) { | |
13659 | + //printk(KERN_WARNING "type = normal packet\n"); | |
13660 | + wme_UP = 7; | |
13661 | + } | |
13662 | + | |
13663 | + skb->priority = wme_UP; | |
13664 | + return(wme_UP); | |
13665 | +} | |
13666 | + | |
13667 | +#ifdef _RTL8187_EXT_PATCH_ | |
13668 | +// based on part of ieee80211_xmit. Mainly allocate txb. ieee->lock is held | |
13669 | +struct ieee80211_txb *ieee80211_ext_alloc_txb(struct sk_buff *skb, struct net_device *dev, struct ieee80211_hdr_3addr *header, int hdr_len, u8 isQoS, u16 *pQOS_ctl, int isEncrypt, struct ieee80211_crypt_data* crypt) | |
13670 | +{ | |
13671 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0)) | |
13672 | + struct ieee80211_device *ieee = netdev_priv(dev); | |
13673 | +#else | |
13674 | + struct ieee80211_device *ieee = (struct ieee80211_device *)dev->priv; | |
13675 | +#endif | |
13676 | + struct ieee80211_txb *txb = NULL; | |
13677 | + struct ieee80211_hdr_3addr *frag_hdr; | |
13678 | + int i, bytes_per_frag, nr_frags, bytes_last_frag, frag_size; | |
13679 | + int ether_type; | |
13680 | + int bytes, QOS_ctl; | |
13681 | + struct sk_buff *skb_frag; | |
13682 | + | |
13683 | + ether_type = ntohs(((struct ethhdr *)skb->data)->h_proto); | |
13684 | + | |
13685 | + /* Advance the SKB to the start of the payload */ | |
13686 | + skb_pull(skb, sizeof(struct ethhdr)); | |
13687 | + | |
13688 | + /* Determine total amount of storage required for TXB packets */ | |
13689 | + bytes = skb->len + SNAP_SIZE + sizeof(u16); | |
13690 | + | |
13691 | + /* Determine fragmentation size based on destination (multicast | |
13692 | + * and broadcast are not fragmented) */ | |
13693 | + // if (is_multicast_ether_addr(dest) || | |
13694 | + // is_broadcast_ether_addr(dest)) { | |
13695 | + if (is_multicast_ether_addr(header->addr1) || | |
13696 | + is_broadcast_ether_addr(header->addr1)) { | |
13697 | + frag_size = MAX_FRAG_THRESHOLD; | |
13698 | + QOS_ctl = QOS_CTL_NOTCONTAIN_ACK; | |
13699 | + } | |
13700 | + else { | |
13701 | + //printk(KERN_WARNING "&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&frag_size = %d\n", frag_size); | |
13702 | + frag_size = ieee->fts;//default:392 | |
13703 | + QOS_ctl = 0; | |
13704 | + } | |
13705 | + | |
13706 | + if(isQoS) { | |
13707 | + QOS_ctl |= skb->priority; //set in the ieee80211_classify | |
13708 | + *pQOS_ctl = cpu_to_le16(QOS_ctl); | |
13709 | + } | |
13710 | + //printk(KERN_WARNING "header size = %d, QOS_ctl = %x\n", hdr_len,QOS_ctl); | |
13711 | + /* Determine amount of payload per fragment. Regardless of if | |
13712 | + * this stack is providing the full 802.11 header, one will | |
13713 | + * eventually be affixed to this fragment -- so we must account for | |
13714 | + * it when determining the amount of payload space. */ | |
13715 | + //bytes_per_frag = frag_size - (IEEE80211_3ADDR_LEN + (ieee->current_network->QoS_Enable ? 2:0)); | |
13716 | + bytes_per_frag = frag_size - hdr_len; | |
13717 | + if (ieee->config & | |
13718 | + (CFG_IEEE80211_COMPUTE_FCS | CFG_IEEE80211_RESERVE_FCS)) | |
13719 | + bytes_per_frag -= IEEE80211_FCS_LEN; | |
13720 | + | |
13721 | + /* Each fragment may need to have room for encryptiong pre/postfix */ | |
13722 | + if (isEncrypt) | |
13723 | + bytes_per_frag -= crypt->ops->extra_prefix_len + | |
13724 | + crypt->ops->extra_postfix_len; | |
13725 | + | |
13726 | + /* Number of fragments is the total bytes_per_frag / | |
13727 | + * payload_per_fragment */ | |
13728 | + nr_frags = bytes / bytes_per_frag; | |
13729 | + bytes_last_frag = bytes % bytes_per_frag; | |
13730 | + if (bytes_last_frag) | |
13731 | + nr_frags++; | |
13732 | + else | |
13733 | + bytes_last_frag = bytes_per_frag; | |
13734 | + | |
13735 | + /* When we allocate the TXB we allocate enough space for the reserve | |
13736 | + * and full fragment bytes (bytes_per_frag doesn't include prefix, | |
13737 | + * postfix, header, FCS, etc.) */ | |
13738 | + txb = ieee80211_alloc_txb(nr_frags, frag_size, GFP_ATOMIC); | |
13739 | + if (unlikely(!txb)) { | |
13740 | + printk(KERN_WARNING "%s: Could not allocate TXB\n", | |
13741 | + ieee->dev->name); | |
13742 | + return NULL; | |
13743 | + } | |
13744 | + txb->encrypted = isEncrypt; | |
13745 | + txb->payload_size = bytes; | |
13746 | + | |
13747 | + for (i = 0; i < nr_frags; i++) { | |
13748 | + skb_frag = txb->fragments[i]; | |
13749 | + skb_frag->priority = UP2AC(skb->priority); | |
13750 | + if (isEncrypt) | |
13751 | + skb_reserve(skb_frag, crypt->ops->extra_prefix_len); | |
13752 | + | |
13753 | + frag_hdr = (struct ieee80211_hdr_3addr *)skb_put(skb_frag, hdr_len); | |
13754 | + memcpy(frag_hdr, (void *)header, hdr_len); | |
13755 | + | |
13756 | + /* If this is not the last fragment, then add the MOREFRAGS | |
13757 | + * bit to the frame control */ | |
13758 | + if (i != nr_frags - 1) { | |
13759 | + frag_hdr->frame_ctl = cpu_to_le16( | |
13760 | + header->frame_ctl | IEEE80211_FCTL_MOREFRAGS); | |
13761 | + bytes = bytes_per_frag; | |
13762 | + | |
13763 | + } else { | |
13764 | + /* The last fragment takes the remaining length */ | |
13765 | + bytes = bytes_last_frag; | |
13766 | + } | |
13767 | + | |
13768 | + frag_hdr->seq_ctl = cpu_to_le16(ieee->seq_ctrl[0]<<4 | i); | |
13769 | + //frag_hdr->seq_ctl = cpu_to_le16(ieee->seq_ctrl<<4 | i); | |
13770 | + // | |
13771 | + | |
13772 | + /* Put a SNAP header on the first fragment */ | |
13773 | + if (i == 0) { | |
13774 | + ieee80211_put_snap( | |
13775 | + skb_put(skb_frag, SNAP_SIZE + sizeof(u16)), ether_type); | |
13776 | + bytes -= SNAP_SIZE + sizeof(u16); | |
13777 | + } | |
13778 | + | |
13779 | + memcpy(skb_put(skb_frag, bytes), skb->data, bytes); | |
13780 | + | |
13781 | + /* Advance the SKB... */ | |
13782 | + skb_pull(skb, bytes); | |
13783 | + | |
13784 | + /* Encryption routine will move the header forward in order | |
13785 | + * to insert the IV between the header and the payload */ | |
13786 | + if (isEncrypt) | |
13787 | + ieee80211_encrypt_fragment(ieee, skb_frag, hdr_len); | |
13788 | + if (ieee->config & | |
13789 | + (CFG_IEEE80211_COMPUTE_FCS | CFG_IEEE80211_RESERVE_FCS)) | |
13790 | + skb_put(skb_frag, 4); | |
13791 | + } | |
13792 | + // Advance sequence number in data frame. | |
13793 | + //printk(KERN_WARNING "QoS Enalbed? %s\n", ieee->current_network.QoS_Enable?"Y":"N"); | |
13794 | + if (ieee->seq_ctrl[0] == 0xFFF) | |
13795 | + ieee->seq_ctrl[0] = 0; | |
13796 | + else | |
13797 | + ieee->seq_ctrl[0]++; | |
13798 | + // stanley, just for debug | |
13799 | +/* | |
13800 | +{ | |
13801 | + int j=0; | |
13802 | + for(j=0;j<nr_frags;j++) | |
13803 | + { | |
13804 | + int i; | |
13805 | + struct sk_buff *skb = txb->fragments[j]; | |
13806 | + printk("send(%d): ", j); | |
13807 | + for (i=0;i<skb->len;i++) | |
13808 | + printk("%02X ", skb->data[i]&0xff); | |
13809 | + printk("\n"); | |
13810 | + } | |
13811 | +} | |
13812 | +*/ | |
13813 | + | |
13814 | + return txb; | |
13815 | +} | |
13816 | + | |
13817 | + | |
13818 | +// based on part of ieee80211_xmit. Mainly allocate txb. ieee->lock is held | |
13819 | +// Assume no encryption, no FCS computing | |
13820 | +struct ieee80211_txb *ieee80211_ext_reuse_txb(struct sk_buff *skb, struct net_device *dev, struct ieee80211_hdr_3addr *header, int hdr_len, u8 isQoS, u16 *pQOS_ctl, int isEncrypt, struct ieee80211_crypt_data* crypt) | |
13821 | +{ | |
13822 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0)) | |
13823 | + struct ieee80211_device *ieee = netdev_priv(dev); | |
13824 | +#else | |
13825 | + struct ieee80211_device *ieee = (struct ieee80211_device *)dev->priv; | |
13826 | +#endif | |
13827 | + struct ieee80211_txb *txb = NULL; | |
13828 | + struct ieee80211_hdr_3addr *frag_hdr; | |
13829 | + int ether_type; | |
13830 | + int bytes, QOS_ctl; | |
13831 | + | |
13832 | + ether_type = ntohs(((struct ethhdr *)skb->data)->h_proto); | |
13833 | + | |
13834 | + /* Advance the SKB to the start of the payload */ | |
13835 | + skb_pull(skb, sizeof(struct ethhdr)); | |
13836 | + | |
13837 | + /* Determine total amount of storage required for TXB packets */ | |
13838 | + bytes = skb->len + SNAP_SIZE + sizeof(u16); | |
13839 | + | |
13840 | + if (is_multicast_ether_addr(header->addr1) || | |
13841 | + is_broadcast_ether_addr(header->addr1)) { | |
13842 | + QOS_ctl = QOS_CTL_NOTCONTAIN_ACK; | |
13843 | + } | |
13844 | + else { | |
13845 | + QOS_ctl = 0; | |
13846 | + } | |
13847 | + | |
13848 | + if(isQoS) { | |
13849 | + QOS_ctl |= skb->priority; //set in the ieee80211_classify | |
13850 | + *pQOS_ctl = cpu_to_le16(QOS_ctl); | |
13851 | + } | |
13852 | + | |
13853 | + txb = kmalloc( sizeof(struct ieee80211_txb) + sizeof(u8*), GFP_ATOMIC ); | |
13854 | + if (unlikely(!txb)) { | |
13855 | + printk(KERN_WARNING "%s: Could not allocate TXB\n", | |
13856 | + ieee->dev->name); | |
13857 | + return NULL; | |
13858 | + } | |
13859 | + | |
13860 | + txb->nr_frags = 1; | |
13861 | + txb->frag_size = bytes; | |
13862 | + txb->encrypted = isEncrypt; | |
13863 | + txb->payload_size = bytes; | |
13864 | + | |
13865 | + txb->fragments[0] = skb; | |
13866 | + ieee80211_put_snap( | |
13867 | + skb_push(skb, SNAP_SIZE + sizeof(u16)), ether_type); | |
13868 | + frag_hdr = (struct ieee80211_hdr_3addr *)skb_push(skb, hdr_len); | |
13869 | + memcpy(frag_hdr, (void *)header, hdr_len); | |
13870 | + frag_hdr->seq_ctl = cpu_to_le16(ieee->seq_ctrl[0]<<4 | 0); | |
13871 | + skb->priority = UP2AC(skb->priority); | |
13872 | + | |
13873 | + // Advance sequence number in data frame. | |
13874 | + //printk(KERN_WARNING "QoS Enalbed? %s\n", ieee->current_network.QoS_Enable?"Y":"N"); | |
13875 | + if (ieee->seq_ctrl[0] == 0xFFF) | |
13876 | + ieee->seq_ctrl[0] = 0; | |
13877 | + else | |
13878 | + ieee->seq_ctrl[0]++; | |
13879 | + | |
13880 | + return txb; | |
13881 | +} | |
13882 | + | |
13883 | +#endif // _RTL8187_EXT_PATCH_ | |
13884 | + | |
13885 | +/* SKBs are added to the ieee->tx_queue. */ | |
13886 | +int ieee80211_xmit(struct sk_buff *skb, | |
13887 | + struct net_device *dev) | |
13888 | +{ | |
13889 | + struct ieee80211_device *ieee = netdev_priv(dev); | |
13890 | + struct ieee80211_txb *txb = NULL; | |
13891 | + struct ieee80211_hdr_3addr_QOS *frag_hdr; | |
13892 | + int i, bytes_per_frag, nr_frags, bytes_last_frag, frag_size; | |
13893 | + unsigned long flags; | |
13894 | + struct net_device_stats *stats = &ieee->stats; | |
13895 | + int ether_type, encrypt; | |
13896 | + int bytes, fc, QOS_ctl, hdr_len; | |
13897 | + struct sk_buff *skb_frag; | |
13898 | + //struct ieee80211_hdr header = { /* Ensure zero initialized */ | |
13899 | + // .duration_id = 0, | |
13900 | + // .seq_ctl = 0 | |
13901 | + //}; | |
13902 | + struct ieee80211_hdr_3addr_QOS header = { /* Ensure zero initialized */ | |
13903 | + .duration_id = 0, | |
13904 | + .seq_ctl = 0, | |
13905 | + .QOS_ctl = 0 | |
13906 | + }; | |
13907 | + u8 dest[ETH_ALEN], src[ETH_ALEN]; | |
13908 | + | |
13909 | + struct ieee80211_crypt_data* crypt; | |
13910 | + | |
13911 | + //printk(KERN_WARNING "upper layer packet!\n"); | |
13912 | + spin_lock_irqsave(&ieee->lock, flags); | |
13913 | + | |
13914 | + /* If there is no driver handler to take the TXB, dont' bother | |
13915 | + * creating it... */ | |
13916 | + if ((!ieee->hard_start_xmit && !(ieee->softmac_features & IEEE_SOFTMAC_TX_QUEUE))|| | |
13917 | + ((!ieee->softmac_data_hard_start_xmit && (ieee->softmac_features & IEEE_SOFTMAC_TX_QUEUE)))) { | |
13918 | + printk(KERN_WARNING "%s: No xmit handler.\n", | |
13919 | + ieee->dev->name); | |
13920 | + goto success; | |
13921 | + } | |
13922 | + | |
13923 | + ieee80211_classify(skb,&ieee->current_network); | |
13924 | + if(likely(ieee->raw_tx == 0)){ | |
13925 | + | |
13926 | + if (unlikely(skb->len < SNAP_SIZE + sizeof(u16))) { | |
13927 | + printk(KERN_WARNING "%s: skb too small (%d).\n", | |
13928 | + ieee->dev->name, skb->len); | |
13929 | + goto success; | |
13930 | + } | |
13931 | + | |
13932 | + | |
13933 | +#ifdef _RTL8187_EXT_PATCH_ | |
13934 | + // note, skb->priority which was set by ieee80211_classify, and used by physical tx | |
13935 | + if((ieee->iw_mode == ieee->iw_ext_mode) && (ieee->ext_patch_ieee80211_xmit)) | |
13936 | + { | |
13937 | + txb = ieee->ext_patch_ieee80211_xmit(skb, dev); | |
13938 | + goto success; | |
13939 | + } | |
13940 | +#endif | |
13941 | + | |
13942 | + ether_type = ntohs(((struct ethhdr *)skb->data)->h_proto); | |
13943 | + | |
13944 | + crypt = ieee->crypt[ieee->tx_keyidx]; | |
13945 | + | |
13946 | + encrypt = !(ether_type == ETH_P_PAE && ieee->ieee802_1x) && | |
13947 | + ieee->host_encrypt && crypt && crypt->ops; | |
13948 | + | |
13949 | + if (!encrypt && ieee->ieee802_1x && | |
13950 | + ieee->drop_unencrypted && ether_type != ETH_P_PAE) { | |
13951 | + stats->tx_dropped++; | |
13952 | + goto success; | |
13953 | + } | |
13954 | + | |
13955 | + #ifdef CONFIG_IEEE80211_DEBUG | |
13956 | + if (crypt && !encrypt && ether_type == ETH_P_PAE) { | |
13957 | + struct eapol *eap = (struct eapol *)(skb->data + | |
13958 | + sizeof(struct ethhdr) - SNAP_SIZE - sizeof(u16)); | |
13959 | + IEEE80211_DEBUG_EAP("TX: IEEE 802.11 EAPOL frame: %s\n", | |
13960 | + eap_get_type(eap->type)); | |
13961 | + } | |
13962 | + #endif | |
13963 | + | |
13964 | + /* Save source and destination addresses */ | |
13965 | + memcpy(&dest, skb->data, ETH_ALEN); | |
13966 | + memcpy(&src, skb->data+ETH_ALEN, ETH_ALEN); | |
13967 | + | |
13968 | + /* Advance the SKB to the start of the payload */ | |
13969 | + skb_pull(skb, sizeof(struct ethhdr)); | |
13970 | + | |
13971 | + /* Determine total amount of storage required for TXB packets */ | |
13972 | + bytes = skb->len + SNAP_SIZE + sizeof(u16); | |
13973 | + | |
13974 | + if(ieee->current_network.QoS_Enable) { | |
13975 | + if (encrypt) | |
13976 | + fc = IEEE80211_FTYPE_DATA | IEEE80211_STYPE_QOS_DATA | | |
13977 | + IEEE80211_FCTL_WEP; | |
13978 | + else | |
13979 | + fc = IEEE80211_FTYPE_DATA | IEEE80211_STYPE_QOS_DATA; | |
13980 | + | |
13981 | + } else { | |
13982 | + if (encrypt) | |
13983 | + fc = IEEE80211_FTYPE_DATA | IEEE80211_STYPE_DATA | | |
13984 | + IEEE80211_FCTL_WEP; | |
13985 | + else | |
13986 | + fc = IEEE80211_FTYPE_DATA | IEEE80211_STYPE_DATA; | |
13987 | + } | |
13988 | + | |
13989 | + if (ieee->iw_mode == IW_MODE_INFRA) { | |
13990 | + fc |= IEEE80211_FCTL_TODS; | |
13991 | + /* To DS: Addr1 = BSSID, Addr2 = SA, | |
13992 | + Addr3 = DA */ | |
13993 | + memcpy(&header.addr1, ieee->current_network.bssid, ETH_ALEN); | |
13994 | + memcpy(&header.addr2, &src, ETH_ALEN); | |
13995 | + memcpy(&header.addr3, &dest, ETH_ALEN); | |
13996 | + } else if (ieee->iw_mode == IW_MODE_ADHOC) { | |
13997 | + /* not From/To DS: Addr1 = DA, Addr2 = SA, | |
13998 | + Addr3 = BSSID */ | |
13999 | + memcpy(&header.addr1, dest, ETH_ALEN); | |
14000 | + memcpy(&header.addr2, src, ETH_ALEN); | |
14001 | + memcpy(&header.addr3, ieee->current_network.bssid, ETH_ALEN); | |
14002 | + } | |
14003 | + // printk(KERN_WARNING "essid MAC address is "MAC_FMT, MAC_ARG(&header.addr1)); | |
14004 | + header.frame_ctl = cpu_to_le16(fc); | |
14005 | + //hdr_len = IEEE80211_3ADDR_LEN; | |
14006 | + | |
14007 | + /* Determine fragmentation size based on destination (multicast | |
14008 | + * and broadcast are not fragmented) */ | |
14009 | +// if (is_multicast_ether_addr(dest) || | |
14010 | +// is_broadcast_ether_addr(dest)) { | |
14011 | + if (is_multicast_ether_addr(header.addr1) || | |
14012 | + is_broadcast_ether_addr(header.addr1)) { | |
14013 | + frag_size = MAX_FRAG_THRESHOLD; | |
14014 | + QOS_ctl = QOS_CTL_NOTCONTAIN_ACK; | |
14015 | + } | |
14016 | + else { | |
14017 | + //printk(KERN_WARNING "&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&frag_size = %d\n", frag_size); | |
14018 | + frag_size = ieee->fts;//default:392 | |
14019 | + QOS_ctl = 0; | |
14020 | + } | |
14021 | + | |
14022 | + if (ieee->current_network.QoS_Enable) { | |
14023 | + hdr_len = IEEE80211_3ADDR_LEN + 2; | |
14024 | + QOS_ctl |= skb->priority; //set in the ieee80211_classify | |
14025 | + header.QOS_ctl = cpu_to_le16(QOS_ctl); | |
14026 | + } else { | |
14027 | + hdr_len = IEEE80211_3ADDR_LEN; | |
14028 | + } | |
14029 | + //printk(KERN_WARNING "header size = %d, QOS_ctl = %x\n", hdr_len,QOS_ctl); | |
14030 | + /* Determine amount of payload per fragment. Regardless of if | |
14031 | + * this stack is providing the full 802.11 header, one will | |
14032 | + * eventually be affixed to this fragment -- so we must account for | |
14033 | + * it when determining the amount of payload space. */ | |
14034 | + //bytes_per_frag = frag_size - (IEEE80211_3ADDR_LEN + (ieee->current_network->QoS_Enable ? 2:0)); | |
14035 | + bytes_per_frag = frag_size - hdr_len; | |
14036 | + if (ieee->config & | |
14037 | + (CFG_IEEE80211_COMPUTE_FCS | CFG_IEEE80211_RESERVE_FCS)) | |
14038 | + bytes_per_frag -= IEEE80211_FCS_LEN; | |
14039 | + | |
14040 | + /* Each fragment may need to have room for encryptiong pre/postfix */ | |
14041 | + if (encrypt) | |
14042 | + bytes_per_frag -= crypt->ops->extra_prefix_len + | |
14043 | + crypt->ops->extra_postfix_len; | |
14044 | + | |
14045 | + /* Number of fragments is the total bytes_per_frag / | |
14046 | + * payload_per_fragment */ | |
14047 | + nr_frags = bytes / bytes_per_frag; | |
14048 | + bytes_last_frag = bytes % bytes_per_frag; | |
14049 | + if (bytes_last_frag) | |
14050 | + nr_frags++; | |
14051 | + else | |
14052 | + bytes_last_frag = bytes_per_frag; | |
14053 | + | |
14054 | + /* When we allocate the TXB we allocate enough space for the reserve | |
14055 | + * and full fragment bytes (bytes_per_frag doesn't include prefix, | |
14056 | + * postfix, header, FCS, etc.) */ | |
14057 | + txb = ieee80211_alloc_txb(nr_frags, frag_size, GFP_ATOMIC); | |
14058 | + if (unlikely(!txb)) { | |
14059 | + printk(KERN_WARNING "%s: Could not allocate TXB\n", | |
14060 | + ieee->dev->name); | |
14061 | + goto failed; | |
14062 | + } | |
14063 | + txb->encrypted = encrypt; | |
14064 | + txb->payload_size = bytes; | |
14065 | + | |
14066 | + for (i = 0; i < nr_frags; i++) { | |
14067 | + skb_frag = txb->fragments[i]; | |
14068 | + skb_frag->priority = UP2AC(skb->priority); | |
14069 | + if (encrypt) | |
14070 | + skb_reserve(skb_frag, crypt->ops->extra_prefix_len); | |
14071 | + | |
14072 | + frag_hdr = (struct ieee80211_hdr_3addr_QOS *)skb_put(skb_frag, hdr_len); | |
14073 | + memcpy(frag_hdr, &header, hdr_len); | |
14074 | + | |
14075 | + /* If this is not the last fragment, then add the MOREFRAGS | |
14076 | + * bit to the frame control */ | |
14077 | + if (i != nr_frags - 1) { | |
14078 | + frag_hdr->frame_ctl = cpu_to_le16( | |
14079 | + fc | IEEE80211_FCTL_MOREFRAGS); | |
14080 | + bytes = bytes_per_frag; | |
14081 | + | |
14082 | + } else { | |
14083 | + /* The last fragment takes the remaining length */ | |
14084 | + bytes = bytes_last_frag; | |
14085 | + } | |
14086 | + if(ieee->current_network.QoS_Enable) { | |
14087 | + // add 1 only indicate to corresponding seq number control 2006/7/12 | |
14088 | + frag_hdr->seq_ctl = cpu_to_le16(ieee->seq_ctrl[UP2AC(skb->priority)+1]<<4 | i); | |
14089 | + //printk(KERN_WARNING "skb->priority = %d,", skb->priority); | |
14090 | + //printk(KERN_WARNING "type:%d: seq = %d\n",UP2AC(skb->priority),ieee->seq_ctrl[UP2AC(skb->priority)+1]); | |
14091 | + } else { | |
14092 | + frag_hdr->seq_ctl = cpu_to_le16(ieee->seq_ctrl[0]<<4 | i); | |
14093 | + } | |
14094 | + //frag_hdr->seq_ctl = cpu_to_le16(ieee->seq_ctrl<<4 | i); | |
14095 | + // | |
14096 | + | |
14097 | + /* Put a SNAP header on the first fragment */ | |
14098 | + if (i == 0) { | |
14099 | + ieee80211_put_snap( | |
14100 | + skb_put(skb_frag, SNAP_SIZE + sizeof(u16)), | |
14101 | + ether_type); | |
14102 | + bytes -= SNAP_SIZE + sizeof(u16); | |
14103 | + } | |
14104 | + | |
14105 | + memcpy(skb_put(skb_frag, bytes), skb->data, bytes); | |
14106 | + | |
14107 | + /* Advance the SKB... */ | |
14108 | + skb_pull(skb, bytes); | |
14109 | + | |
14110 | + /* Encryption routine will move the header forward in order | |
14111 | + * to insert the IV between the header and the payload */ | |
14112 | + if (encrypt) | |
14113 | + ieee80211_encrypt_fragment(ieee, skb_frag, hdr_len); | |
14114 | + if (ieee->config & | |
14115 | + (CFG_IEEE80211_COMPUTE_FCS | CFG_IEEE80211_RESERVE_FCS)) | |
14116 | + skb_put(skb_frag, 4); | |
14117 | + } | |
14118 | + // Advance sequence number in data frame. | |
14119 | + //printk(KERN_WARNING "QoS Enalbed? %s\n", ieee->current_network.QoS_Enable?"Y":"N"); | |
14120 | + if (ieee->current_network.QoS_Enable) { | |
14121 | + if (ieee->seq_ctrl[UP2AC(skb->priority) + 1] == 0xFFF) | |
14122 | + ieee->seq_ctrl[UP2AC(skb->priority) + 1] = 0; | |
14123 | + else | |
14124 | + ieee->seq_ctrl[UP2AC(skb->priority) + 1]++; | |
14125 | + } else { | |
14126 | + if (ieee->seq_ctrl[0] == 0xFFF) | |
14127 | + ieee->seq_ctrl[0] = 0; | |
14128 | + else | |
14129 | + ieee->seq_ctrl[0]++; | |
14130 | + } | |
14131 | + //--- | |
14132 | + }else{ | |
14133 | + if (unlikely(skb->len < sizeof(struct ieee80211_hdr_3addr))) { | |
14134 | + printk(KERN_WARNING "%s: skb too small (%d).\n", | |
14135 | + ieee->dev->name, skb->len); | |
14136 | + goto success; | |
14137 | + } | |
14138 | + | |
14139 | + txb = ieee80211_alloc_txb(1, skb->len, GFP_ATOMIC); | |
14140 | + if(!txb){ | |
14141 | + printk(KERN_WARNING "%s: Could not allocate TXB\n", | |
14142 | + ieee->dev->name); | |
14143 | + goto failed; | |
14144 | + } | |
14145 | + | |
14146 | + txb->encrypted = 0; | |
14147 | + txb->payload_size = skb->len; | |
14148 | + memcpy(skb_put(txb->fragments[0],skb->len), skb->data, skb->len); | |
14149 | + } | |
14150 | + | |
14151 | + success: | |
14152 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
14153 | +#ifdef _RTL8187_EXT_PATCH_ | |
14154 | + // Sometimes, extension mode can reuse skb (by txb->fragments[0]) | |
14155 | + if( ! ((ieee->iw_mode == ieee->iw_ext_mode) && txb && (txb->fragments[0] == skb)) ) | |
14156 | +#endif | |
14157 | + dev_kfree_skb_any(skb); | |
14158 | + if (txb) { | |
14159 | + if (ieee->softmac_features & IEEE_SOFTMAC_TX_QUEUE){ | |
14160 | + ieee80211_softmac_xmit(txb, ieee); | |
14161 | + }else{ | |
14162 | + if ((*ieee->hard_start_xmit)(txb, dev) == 0) { | |
14163 | + stats->tx_packets++; | |
14164 | + stats->tx_bytes += txb->payload_size; | |
14165 | + return 0; | |
14166 | + } | |
14167 | + ieee80211_txb_free(txb); | |
14168 | + } | |
14169 | + } | |
14170 | + | |
14171 | + return 0; | |
14172 | + | |
14173 | + failed: | |
14174 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
14175 | + netif_stop_queue(dev); | |
14176 | + stats->tx_errors++; | |
14177 | + return 1; | |
14178 | + | |
14179 | +} | |
14180 | + | |
14181 | +#if 0 | |
14182 | +EXPORT_SYMBOL(ieee80211_txb_free); | |
14183 | +#ifdef _RTL8187_EXT_PATCH_ | |
14184 | +EXPORT_SYMBOL(ieee80211_alloc_txb); | |
14185 | +EXPORT_SYMBOL(ieee80211_ext_alloc_txb); | |
14186 | +EXPORT_SYMBOL(ieee80211_ext_reuse_txb); | |
14187 | +#endif // _RTL8187_EXT_PATCH_ | |
14188 | +#endif | |
14189 | --- /dev/null | |
14190 | +++ b/drivers/staging/rtl8187se/ieee80211/ieee80211_wx.c | |
14191 | @@ -0,0 +1,884 @@ | |
14192 | +/****************************************************************************** | |
14193 | + | |
14194 | + Copyright(c) 2004 Intel Corporation. All rights reserved. | |
14195 | + | |
14196 | + Portions of this file are based on the WEP enablement code provided by the | |
14197 | + Host AP project hostap-drivers v0.1.3 | |
14198 | + Copyright (c) 2001-2002, SSH Communications Security Corp and Jouni Malinen | |
14199 | + <jkmaline@cc.hut.fi> | |
14200 | + Copyright (c) 2002-2003, Jouni Malinen <jkmaline@cc.hut.fi> | |
14201 | + | |
14202 | + This program is free software; you can redistribute it and/or modify it | |
14203 | + under the terms of version 2 of the GNU General Public License as | |
14204 | + published by the Free Software Foundation. | |
14205 | + | |
14206 | + This program is distributed in the hope that it will be useful, but WITHOUT | |
14207 | + ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
14208 | + FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
14209 | + more details. | |
14210 | + | |
14211 | + You should have received a copy of the GNU General Public License along with | |
14212 | + this program; if not, write to the Free Software Foundation, Inc., 59 | |
14213 | + Temple Place - Suite 330, Boston, MA 02111-1307, USA. | |
14214 | + | |
14215 | + The full GNU General Public License is included in this distribution in the | |
14216 | + file called LICENSE. | |
14217 | + | |
14218 | + Contact Information: | |
14219 | + James P. Ketrenos <ipw2100-admin@linux.intel.com> | |
14220 | + Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 | |
14221 | + | |
14222 | +******************************************************************************/ | |
14223 | +#include <linux/wireless.h> | |
14224 | +#include <linux/version.h> | |
14225 | +#include <linux/kmod.h> | |
14226 | +#include <linux/module.h> | |
14227 | + | |
14228 | +#include "ieee80211.h" | |
14229 | +static const char *ieee80211_modes[] = { | |
14230 | + "?", "a", "b", "ab", "g", "ag", "bg", "abg" | |
14231 | +}; | |
14232 | + | |
14233 | +#ifdef FEDORACORE_9 | |
14234 | +#define IN_FEDORACORE_9 1 | |
14235 | +#else | |
14236 | +#define IN_FEDORACORE_9 0 | |
14237 | +#endif | |
14238 | + | |
14239 | +#define MAX_CUSTOM_LEN 64 | |
14240 | +static inline char *rtl818x_translate_scan(struct ieee80211_device *ieee, | |
14241 | + char *start, char *stop, | |
14242 | + struct ieee80211_network *network, | |
14243 | + struct iw_request_info *info) | |
14244 | +{ | |
14245 | + char custom[MAX_CUSTOM_LEN]; | |
14246 | + char *p; | |
14247 | + struct iw_event iwe; | |
14248 | + int i, j; | |
14249 | + u8 max_rate, rate; | |
14250 | + | |
14251 | + /* First entry *MUST* be the AP MAC address */ | |
14252 | + iwe.cmd = SIOCGIWAP; | |
14253 | + iwe.u.ap_addr.sa_family = ARPHRD_ETHER; | |
14254 | + memcpy(iwe.u.ap_addr.sa_data, network->bssid, ETH_ALEN); | |
14255 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14256 | + start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_ADDR_LEN); | |
14257 | +#else | |
14258 | + start = iwe_stream_add_event(start, stop, &iwe, IW_EV_ADDR_LEN); | |
14259 | +#endif | |
14260 | + | |
14261 | + /* Remaining entries will be displayed in the order we provide them */ | |
14262 | + | |
14263 | + /* Add the ESSID */ | |
14264 | + iwe.cmd = SIOCGIWESSID; | |
14265 | + iwe.u.data.flags = 1; | |
14266 | + //YJ,modified,080903,for hidden ap | |
14267 | + //if (network->flags & NETWORK_EMPTY_ESSID) { | |
14268 | + if (network->ssid_len == 0) { | |
14269 | + //YJ,modified,080903,end | |
14270 | + iwe.u.data.length = sizeof("<hidden>"); | |
14271 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14272 | + start = iwe_stream_add_point(info, start, stop, &iwe, "<hidden>"); | |
14273 | +#else | |
14274 | + start = iwe_stream_add_point(start, stop, &iwe, "<hidden>"); | |
14275 | +#endif | |
14276 | + } else { | |
14277 | + iwe.u.data.length = min(network->ssid_len, (u8)32); | |
14278 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14279 | + start = iwe_stream_add_point(info, start, stop, &iwe, network->ssid); | |
14280 | +#else | |
14281 | + start = iwe_stream_add_point(start, stop, &iwe, network->ssid); | |
14282 | +#endif | |
14283 | + } | |
14284 | + //printk("ESSID: %s\n",network->ssid); | |
14285 | + /* Add the protocol name */ | |
14286 | + iwe.cmd = SIOCGIWNAME; | |
14287 | + snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11%s", ieee80211_modes[network->mode]); | |
14288 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14289 | + start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_CHAR_LEN); | |
14290 | +#else | |
14291 | + start = iwe_stream_add_event(start, stop, &iwe, IW_EV_CHAR_LEN); | |
14292 | +#endif | |
14293 | + | |
14294 | + /* Add mode */ | |
14295 | + iwe.cmd = SIOCGIWMODE; | |
14296 | + if (network->capability & | |
14297 | + (WLAN_CAPABILITY_BSS | WLAN_CAPABILITY_IBSS)) { | |
14298 | + if (network->capability & WLAN_CAPABILITY_BSS) | |
14299 | + iwe.u.mode = IW_MODE_MASTER; | |
14300 | + else | |
14301 | + iwe.u.mode = IW_MODE_ADHOC; | |
14302 | + | |
14303 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14304 | + start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_UINT_LEN); | |
14305 | +#else | |
14306 | + start = iwe_stream_add_event(start, stop, &iwe, IW_EV_UINT_LEN); | |
14307 | +#endif | |
14308 | + } | |
14309 | + | |
14310 | + /* Add frequency/channel */ | |
14311 | + iwe.cmd = SIOCGIWFREQ; | |
14312 | +/* iwe.u.freq.m = ieee80211_frequency(network->channel, network->mode); | |
14313 | + iwe.u.freq.e = 3; */ | |
14314 | + iwe.u.freq.m = network->channel; | |
14315 | + iwe.u.freq.e = 0; | |
14316 | + iwe.u.freq.i = 0; | |
14317 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14318 | + start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_FREQ_LEN); | |
14319 | +#else | |
14320 | + start = iwe_stream_add_event(start, stop, &iwe, IW_EV_FREQ_LEN); | |
14321 | +#endif | |
14322 | + | |
14323 | + /* Add encryption capability */ | |
14324 | + iwe.cmd = SIOCGIWENCODE; | |
14325 | + if (network->capability & WLAN_CAPABILITY_PRIVACY) | |
14326 | + iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; | |
14327 | + else | |
14328 | + iwe.u.data.flags = IW_ENCODE_DISABLED; | |
14329 | + iwe.u.data.length = 0; | |
14330 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14331 | + start = iwe_stream_add_point(info, start, stop, &iwe, network->ssid); | |
14332 | +#else | |
14333 | + start = iwe_stream_add_point(start, stop, &iwe, network->ssid); | |
14334 | +#endif | |
14335 | + | |
14336 | + /* Add basic and extended rates */ | |
14337 | + max_rate = 0; | |
14338 | + p = custom; | |
14339 | + p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): "); | |
14340 | + for (i = 0, j = 0; i < network->rates_len; ) { | |
14341 | + if (j < network->rates_ex_len && | |
14342 | + ((network->rates_ex[j] & 0x7F) < | |
14343 | + (network->rates[i] & 0x7F))) | |
14344 | + rate = network->rates_ex[j++] & 0x7F; | |
14345 | + else | |
14346 | + rate = network->rates[i++] & 0x7F; | |
14347 | + if (rate > max_rate) | |
14348 | + max_rate = rate; | |
14349 | + p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), | |
14350 | + "%d%s ", rate >> 1, (rate & 1) ? ".5" : ""); | |
14351 | + } | |
14352 | + for (; j < network->rates_ex_len; j++) { | |
14353 | + rate = network->rates_ex[j] & 0x7F; | |
14354 | + p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), | |
14355 | + "%d%s ", rate >> 1, (rate & 1) ? ".5" : ""); | |
14356 | + if (rate > max_rate) | |
14357 | + max_rate = rate; | |
14358 | + } | |
14359 | + | |
14360 | + iwe.cmd = SIOCGIWRATE; | |
14361 | + iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0; | |
14362 | + iwe.u.bitrate.value = max_rate * 500000; | |
14363 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14364 | + start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_PARAM_LEN); | |
14365 | +#else | |
14366 | + start = iwe_stream_add_event(start, stop, &iwe, IW_EV_PARAM_LEN); | |
14367 | +#endif | |
14368 | + | |
14369 | + iwe.cmd = IWEVCUSTOM; | |
14370 | + iwe.u.data.length = p - custom; | |
14371 | + if (iwe.u.data.length) | |
14372 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14373 | + start = iwe_stream_add_point(info, start, stop, &iwe, custom); | |
14374 | +#else | |
14375 | + start = iwe_stream_add_point(start, stop, &iwe, custom); | |
14376 | +#endif | |
14377 | + | |
14378 | + /* Add quality statistics */ | |
14379 | + /* TODO: Fix these values... */ | |
14380 | + if (network->stats.signal == 0 || network->stats.rssi == 0) | |
14381 | + printk("========>signal:%d, rssi:%d\n", network->stats.signal, network->stats.rssi); | |
14382 | + iwe.cmd = IWEVQUAL; | |
14383 | +// printk("SIGNAL: %d,RSSI: %d,NOISE: %d\n",network->stats.signal,network->stats.rssi,network->stats.noise); | |
14384 | + iwe.u.qual.qual = network->stats.signalstrength; | |
14385 | + iwe.u.qual.level = network->stats.signal; | |
14386 | + iwe.u.qual.noise = network->stats.noise; | |
14387 | + iwe.u.qual.updated = network->stats.mask & IEEE80211_STATMASK_WEMASK; | |
14388 | + if (!(network->stats.mask & IEEE80211_STATMASK_RSSI)) | |
14389 | + iwe.u.qual.updated |= IW_QUAL_LEVEL_INVALID; | |
14390 | + if (!(network->stats.mask & IEEE80211_STATMASK_NOISE)) | |
14391 | + iwe.u.qual.updated |= IW_QUAL_NOISE_INVALID; | |
14392 | + if (!(network->stats.mask & IEEE80211_STATMASK_SIGNAL)) | |
14393 | + iwe.u.qual.updated |= IW_QUAL_QUAL_INVALID; | |
14394 | + iwe.u.qual.updated = 7; | |
14395 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14396 | + start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_QUAL_LEN); | |
14397 | +#else | |
14398 | + start = iwe_stream_add_event(start, stop, &iwe, IW_EV_QUAL_LEN); | |
14399 | +#endif | |
14400 | + | |
14401 | + iwe.cmd = IWEVCUSTOM; | |
14402 | + p = custom; | |
14403 | + | |
14404 | + iwe.u.data.length = p - custom; | |
14405 | + if (iwe.u.data.length) | |
14406 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14407 | + start = iwe_stream_add_point(info, start, stop, &iwe, custom); | |
14408 | +#else | |
14409 | + start = iwe_stream_add_point(start, stop, &iwe, custom); | |
14410 | +#endif | |
14411 | + | |
14412 | +#if 0 | |
14413 | + if (ieee->wpa_enabled && network->wpa_ie_len){ | |
14414 | + char buf[MAX_WPA_IE_LEN * 2 + 30]; | |
14415 | + // printk("WPA IE\n"); | |
14416 | + u8 *p = buf; | |
14417 | + p += sprintf(p, "wpa_ie="); | |
14418 | + for (i = 0; i < network->wpa_ie_len; i++) { | |
14419 | + p += sprintf(p, "%02x", network->wpa_ie[i]); | |
14420 | + } | |
14421 | + | |
14422 | + memset(&iwe, 0, sizeof(iwe)); | |
14423 | + iwe.cmd = IWEVCUSTOM; | |
14424 | + iwe.u.data.length = strlen(buf); | |
14425 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14426 | + start = iwe_stream_add_point(info, start, stop, &iwe, buf); | |
14427 | +#else | |
14428 | + start = iwe_stream_add_point(start, stop, &iwe, buf); | |
14429 | +#endif | |
14430 | + } | |
14431 | + | |
14432 | + if (ieee->wpa_enabled && network->rsn_ie_len){ | |
14433 | + char buf[MAX_WPA_IE_LEN * 2 + 30]; | |
14434 | + | |
14435 | + u8 *p = buf; | |
14436 | + p += sprintf(p, "rsn_ie="); | |
14437 | + for (i = 0; i < network->rsn_ie_len; i++) { | |
14438 | + p += sprintf(p, "%02x", network->rsn_ie[i]); | |
14439 | + } | |
14440 | + | |
14441 | + | |
14442 | +#else | |
14443 | + memset(&iwe, 0, sizeof(iwe)); | |
14444 | + if (network->wpa_ie_len) { | |
14445 | + // printk("wpa_ie_len:%d\n", network->wpa_ie_len); | |
14446 | + char buf[MAX_WPA_IE_LEN]; | |
14447 | + memcpy(buf, network->wpa_ie, network->wpa_ie_len); | |
14448 | + iwe.cmd = IWEVGENIE; | |
14449 | + iwe.u.data.length = network->wpa_ie_len; | |
14450 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14451 | + start = iwe_stream_add_point(info, start, stop, &iwe, buf); | |
14452 | +#else | |
14453 | + start = iwe_stream_add_point(start, stop, &iwe, buf); | |
14454 | +#endif | |
14455 | + } | |
14456 | + | |
14457 | + memset(&iwe, 0, sizeof(iwe)); | |
14458 | + if (network->rsn_ie_len) { | |
14459 | + // printk("=====>rsn_ie_len:\n", network->rsn_ie_len); | |
14460 | + #if 0 | |
14461 | + { | |
14462 | + int i; | |
14463 | + for (i=0; i<network->rsn_ie_len; i++); | |
14464 | + printk("%2x ", network->rsn_ie[i]); | |
14465 | + printk("\n"); | |
14466 | + } | |
14467 | + #endif | |
14468 | + char buf[MAX_WPA_IE_LEN]; | |
14469 | + memcpy(buf, network->rsn_ie, network->rsn_ie_len); | |
14470 | + iwe.cmd = IWEVGENIE; | |
14471 | + iwe.u.data.length = network->rsn_ie_len; | |
14472 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14473 | + start = iwe_stream_add_point(info, start, stop, &iwe, buf); | |
14474 | +#else | |
14475 | + start = iwe_stream_add_point(start, stop, &iwe, buf); | |
14476 | +#endif | |
14477 | + } | |
14478 | + | |
14479 | +#endif | |
14480 | + | |
14481 | + /* Add EXTRA: Age to display seconds since last beacon/probe response | |
14482 | + * for given network. */ | |
14483 | + iwe.cmd = IWEVCUSTOM; | |
14484 | + p = custom; | |
14485 | + p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), | |
14486 | + " Last beacon: %lums ago", (jiffies - network->last_scanned) / (HZ / 100)); | |
14487 | + iwe.u.data.length = p - custom; | |
14488 | + if (iwe.u.data.length) | |
14489 | +#if((LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,27))||IN_FEDORACORE_9) | |
14490 | + start = iwe_stream_add_point(info, start, stop, &iwe, custom); | |
14491 | +#else | |
14492 | + start = iwe_stream_add_point(start, stop, &iwe, custom); | |
14493 | +#endif | |
14494 | + | |
14495 | + return start; | |
14496 | +} | |
14497 | + | |
14498 | +int ieee80211_wx_get_scan(struct ieee80211_device *ieee, | |
14499 | + struct iw_request_info *info, | |
14500 | + union iwreq_data *wrqu, char *extra) | |
14501 | +{ | |
14502 | + struct ieee80211_network *network; | |
14503 | + unsigned long flags; | |
14504 | + int err = 0; | |
14505 | + char *ev = extra; | |
14506 | + char *stop = ev + wrqu->data.length;//IW_SCAN_MAX_DATA; | |
14507 | + //char *stop = ev + IW_SCAN_MAX_DATA; | |
14508 | + int i = 0; | |
14509 | + | |
14510 | + IEEE80211_DEBUG_WX("Getting scan\n"); | |
14511 | + down(&ieee->wx_sem); | |
14512 | + spin_lock_irqsave(&ieee->lock, flags); | |
14513 | + | |
14514 | + if(!ieee->bHwRadioOff) | |
14515 | + { | |
14516 | + list_for_each_entry(network, &ieee->network_list, list) { | |
14517 | + i++; | |
14518 | + | |
14519 | + if((stop-ev)<200) | |
14520 | + { | |
14521 | + err = -E2BIG; | |
14522 | + break; | |
14523 | + } | |
14524 | + if (ieee->scan_age == 0 || | |
14525 | + time_after(network->last_scanned + ieee->scan_age, jiffies)) | |
14526 | + { | |
14527 | + ev = rtl818x_translate_scan(ieee, ev, stop, network, info); | |
14528 | + } | |
14529 | + else | |
14530 | + IEEE80211_DEBUG_SCAN( | |
14531 | + "Not showing network '%s (" | |
14532 | + MAC_FMT ")' due to age (%lums).\n", | |
14533 | + escape_essid(network->ssid, | |
14534 | + network->ssid_len), | |
14535 | + MAC_ARG(network->bssid), | |
14536 | + (jiffies - network->last_scanned) / (HZ / 100)); | |
14537 | + } | |
14538 | + } | |
14539 | + spin_unlock_irqrestore(&ieee->lock, flags); | |
14540 | + up(&ieee->wx_sem); | |
14541 | + wrqu->data.length = ev - extra; | |
14542 | + wrqu->data.flags = 0; | |
14543 | + IEEE80211_DEBUG_WX("exit: %d networks returned.\n", i); | |
14544 | + | |
14545 | + return err; | |
14546 | +} | |
14547 | + | |
14548 | +int ieee80211_wx_set_encode(struct ieee80211_device *ieee, | |
14549 | + struct iw_request_info *info, | |
14550 | + union iwreq_data *wrqu, char *keybuf) | |
14551 | +{ | |
14552 | + struct iw_point *erq = &(wrqu->encoding); | |
14553 | + struct net_device *dev = ieee->dev; | |
14554 | + struct ieee80211_security sec = { | |
14555 | + .flags = 0 | |
14556 | + }; | |
14557 | + int i, key, key_provided, len; | |
14558 | + struct ieee80211_crypt_data **crypt; | |
14559 | + | |
14560 | + IEEE80211_DEBUG_WX("SET_ENCODE\n"); | |
14561 | + | |
14562 | + key = erq->flags & IW_ENCODE_INDEX; | |
14563 | + if (key) { | |
14564 | + if (key > WEP_KEYS) | |
14565 | + return -EINVAL; | |
14566 | + key--; | |
14567 | + key_provided = 1; | |
14568 | + } else { | |
14569 | + key_provided = 0; | |
14570 | + key = ieee->tx_keyidx; | |
14571 | + } | |
14572 | + | |
14573 | + IEEE80211_DEBUG_WX("Key: %d [%s]\n", key, key_provided ? | |
14574 | + "provided" : "default"); | |
14575 | + | |
14576 | + crypt = &ieee->crypt[key]; | |
14577 | + | |
14578 | + if (erq->flags & IW_ENCODE_DISABLED) { | |
14579 | + if (key_provided && *crypt) { | |
14580 | + IEEE80211_DEBUG_WX("Disabling encryption on key %d.\n", | |
14581 | + key); | |
14582 | + ieee80211_crypt_delayed_deinit(ieee, crypt); | |
14583 | + } else | |
14584 | + IEEE80211_DEBUG_WX("Disabling encryption.\n"); | |
14585 | + | |
14586 | + /* Check all the keys to see if any are still configured, | |
14587 | + * and if no key index was provided, de-init them all */ | |
14588 | + for (i = 0; i < WEP_KEYS; i++) { | |
14589 | + if (ieee->crypt[i] != NULL) { | |
14590 | + if (key_provided) | |
14591 | + break; | |
14592 | + ieee80211_crypt_delayed_deinit( | |
14593 | + ieee, &ieee->crypt[i]); | |
14594 | + } | |
14595 | + } | |
14596 | + | |
14597 | + if (i == WEP_KEYS) { | |
14598 | + sec.enabled = 0; | |
14599 | + sec.level = SEC_LEVEL_0; | |
14600 | + sec.flags |= SEC_ENABLED | SEC_LEVEL; | |
14601 | + } | |
14602 | + | |
14603 | + goto done; | |
14604 | + } | |
14605 | + | |
14606 | + | |
14607 | + | |
14608 | + sec.enabled = 1; | |
14609 | + sec.flags |= SEC_ENABLED; | |
14610 | + | |
14611 | + if (*crypt != NULL && (*crypt)->ops != NULL && | |
14612 | + strcmp((*crypt)->ops->name, "WEP") != 0) { | |
14613 | + /* changing to use WEP; deinit previously used algorithm | |
14614 | + * on this key */ | |
14615 | + ieee80211_crypt_delayed_deinit(ieee, crypt); | |
14616 | + } | |
14617 | + | |
14618 | + if (*crypt == NULL) { | |
14619 | + struct ieee80211_crypt_data *new_crypt; | |
14620 | + | |
14621 | + /* take WEP into use */ | |
14622 | + new_crypt = kmalloc(sizeof(struct ieee80211_crypt_data), | |
14623 | + GFP_KERNEL); | |
14624 | + if (new_crypt == NULL) | |
14625 | + return -ENOMEM; | |
14626 | + memset(new_crypt, 0, sizeof(struct ieee80211_crypt_data)); | |
14627 | + new_crypt->ops = ieee80211_get_crypto_ops("WEP"); | |
14628 | + if (!new_crypt->ops) { | |
14629 | + request_module("ieee80211_crypt_wep"); | |
14630 | + new_crypt->ops = ieee80211_get_crypto_ops("WEP"); | |
14631 | + } | |
14632 | + | |
14633 | + if (new_crypt->ops && try_module_get(new_crypt->ops->owner)) | |
14634 | + new_crypt->priv = new_crypt->ops->init(key); | |
14635 | + | |
14636 | + if (!new_crypt->ops || !new_crypt->priv) { | |
14637 | + kfree(new_crypt); | |
14638 | + new_crypt = NULL; | |
14639 | + | |
14640 | + printk(KERN_WARNING "%s: could not initialize WEP: " | |
14641 | + "load module ieee80211_crypt_wep\n", | |
14642 | + dev->name); | |
14643 | + return -EOPNOTSUPP; | |
14644 | + } | |
14645 | + *crypt = new_crypt; | |
14646 | + } | |
14647 | + | |
14648 | + /* If a new key was provided, set it up */ | |
14649 | + if (erq->length > 0) { | |
14650 | + len = erq->length <= 5 ? 5 : 13; | |
14651 | + memcpy(sec.keys[key], keybuf, erq->length); | |
14652 | + if (len > erq->length) | |
14653 | + memset(sec.keys[key] + erq->length, 0, | |
14654 | + len - erq->length); | |
14655 | + IEEE80211_DEBUG_WX("Setting key %d to '%s' (%d:%d bytes)\n", | |
14656 | + key, escape_essid(sec.keys[key], len), | |
14657 | + erq->length, len); | |
14658 | + sec.key_sizes[key] = len; | |
14659 | + (*crypt)->ops->set_key(sec.keys[key], len, NULL, | |
14660 | + (*crypt)->priv); | |
14661 | + sec.flags |= (1 << key); | |
14662 | + /* This ensures a key will be activated if no key is | |
14663 | + * explicitely set */ | |
14664 | + if (key == sec.active_key) | |
14665 | + sec.flags |= SEC_ACTIVE_KEY; | |
14666 | + ieee->tx_keyidx = key;//by wb 080312 | |
14667 | + } else { | |
14668 | + len = (*crypt)->ops->get_key(sec.keys[key], WEP_KEY_LEN, | |
14669 | + NULL, (*crypt)->priv); | |
14670 | + if (len == 0) { | |
14671 | + /* Set a default key of all 0 */ | |
14672 | + IEEE80211_DEBUG_WX("Setting key %d to all zero.\n", | |
14673 | + key); | |
14674 | + memset(sec.keys[key], 0, 13); | |
14675 | + (*crypt)->ops->set_key(sec.keys[key], 13, NULL, | |
14676 | + (*crypt)->priv); | |
14677 | + sec.key_sizes[key] = 13; | |
14678 | + sec.flags |= (1 << key); | |
14679 | + } | |
14680 | + | |
14681 | + /* No key data - just set the default TX key index */ | |
14682 | + if (key_provided) { | |
14683 | + IEEE80211_DEBUG_WX( | |
14684 | + "Setting key %d to default Tx key.\n", key); | |
14685 | + ieee->tx_keyidx = key; | |
14686 | + sec.active_key = key; | |
14687 | + sec.flags |= SEC_ACTIVE_KEY; | |
14688 | + } | |
14689 | + } | |
14690 | + | |
14691 | + done: | |
14692 | + ieee->open_wep = !(erq->flags & IW_ENCODE_RESTRICTED); | |
14693 | + sec.auth_mode = ieee->open_wep ? WLAN_AUTH_OPEN : WLAN_AUTH_SHARED_KEY; | |
14694 | + sec.flags |= SEC_AUTH_MODE; | |
14695 | + IEEE80211_DEBUG_WX("Auth: %s\n", sec.auth_mode == WLAN_AUTH_OPEN ? | |
14696 | + "OPEN" : "SHARED KEY"); | |
14697 | + | |
14698 | + /* For now we just support WEP, so only set that security level... | |
14699 | + * TODO: When WPA is added this is one place that needs to change */ | |
14700 | + sec.flags |= SEC_LEVEL; | |
14701 | + sec.level = SEC_LEVEL_1; /* 40 and 104 bit WEP */ | |
14702 | + | |
14703 | + if (ieee->set_security) | |
14704 | + ieee->set_security(dev, &sec); | |
14705 | + | |
14706 | + /* Do not reset port if card is in Managed mode since resetting will | |
14707 | + * generate new IEEE 802.11 authentication which may end up in looping | |
14708 | + * with IEEE 802.1X. If your hardware requires a reset after WEP | |
14709 | + * configuration (for example... Prism2), implement the reset_port in | |
14710 | + * the callbacks structures used to initialize the 802.11 stack. */ | |
14711 | + if (ieee->reset_on_keychange && | |
14712 | + ieee->iw_mode != IW_MODE_INFRA && | |
14713 | + ieee->reset_port && ieee->reset_port(dev)) { | |
14714 | + printk(KERN_DEBUG "%s: reset_port failed\n", dev->name); | |
14715 | + return -EINVAL; | |
14716 | + } | |
14717 | + return 0; | |
14718 | +} | |
14719 | + | |
14720 | +int ieee80211_wx_get_encode(struct ieee80211_device *ieee, | |
14721 | + struct iw_request_info *info, | |
14722 | + union iwreq_data *wrqu, char *keybuf) | |
14723 | +{ | |
14724 | + struct iw_point *erq = &(wrqu->encoding); | |
14725 | + int len, key; | |
14726 | + struct ieee80211_crypt_data *crypt; | |
14727 | + | |
14728 | + IEEE80211_DEBUG_WX("GET_ENCODE\n"); | |
14729 | + | |
14730 | + if(ieee->iw_mode == IW_MODE_MONITOR) | |
14731 | + return -1; | |
14732 | + | |
14733 | + key = erq->flags & IW_ENCODE_INDEX; | |
14734 | + if (key) { | |
14735 | + if (key > WEP_KEYS) | |
14736 | + return -EINVAL; | |
14737 | + key--; | |
14738 | + } else | |
14739 | + key = ieee->tx_keyidx; | |
14740 | + | |
14741 | + crypt = ieee->crypt[key]; | |
14742 | + erq->flags = key + 1; | |
14743 | + | |
14744 | + if (crypt == NULL || crypt->ops == NULL) { | |
14745 | + erq->length = 0; | |
14746 | + erq->flags |= IW_ENCODE_DISABLED; | |
14747 | + return 0; | |
14748 | + } | |
14749 | + | |
14750 | + if (strcmp(crypt->ops->name, "WEP") != 0) { | |
14751 | + /* only WEP is supported with wireless extensions, so just | |
14752 | + * report that encryption is used */ | |
14753 | + erq->length = 0; | |
14754 | + erq->flags |= IW_ENCODE_ENABLED; | |
14755 | + return 0; | |
14756 | + } | |
14757 | + | |
14758 | + len = crypt->ops->get_key(keybuf, WEP_KEY_LEN, NULL, crypt->priv); | |
14759 | + erq->length = (len >= 0 ? len : 0); | |
14760 | + | |
14761 | + erq->flags |= IW_ENCODE_ENABLED; | |
14762 | + | |
14763 | + if (ieee->open_wep) | |
14764 | + erq->flags |= IW_ENCODE_OPEN; | |
14765 | + else | |
14766 | + erq->flags |= IW_ENCODE_RESTRICTED; | |
14767 | + | |
14768 | + return 0; | |
14769 | +} | |
14770 | + | |
14771 | +int ieee80211_wx_set_encode_ext(struct ieee80211_device *ieee, | |
14772 | + struct iw_request_info *info, | |
14773 | + union iwreq_data *wrqu, char *extra) | |
14774 | +{ | |
14775 | + struct net_device *dev = ieee->dev; | |
14776 | + struct iw_point *encoding = &wrqu->encoding; | |
14777 | + struct iw_encode_ext *ext = (struct iw_encode_ext *)extra; | |
14778 | + int i, idx, ret = 0; | |
14779 | + int group_key = 0; | |
14780 | + const char *alg, *module; | |
14781 | + struct ieee80211_crypto_ops *ops; | |
14782 | + struct ieee80211_crypt_data **crypt; | |
14783 | + | |
14784 | + struct ieee80211_security sec = { | |
14785 | + .flags = 0, | |
14786 | + }; | |
14787 | + //printk("======>encoding flag:%x,ext flag:%x, ext alg:%d\n", encoding->flags,ext->ext_flags, ext->alg); | |
14788 | + idx = encoding->flags & IW_ENCODE_INDEX; | |
14789 | + if (idx) { | |
14790 | + if (idx < 1 || idx > WEP_KEYS) | |
14791 | + return -EINVAL; | |
14792 | + idx--; | |
14793 | + } else | |
14794 | + idx = ieee->tx_keyidx; | |
14795 | + | |
14796 | + if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) { | |
14797 | + crypt = &ieee->crypt[idx]; | |
14798 | + group_key = 1; | |
14799 | + } else { | |
14800 | + /* some Cisco APs use idx>0 for unicast in dynamic WEP */ | |
14801 | + //printk("not group key, flags:%x, ext->alg:%d\n", ext->ext_flags, ext->alg); | |
14802 | + if (idx != 0 && ext->alg != IW_ENCODE_ALG_WEP) | |
14803 | + return -EINVAL; | |
14804 | + if (ieee->iw_mode == IW_MODE_INFRA) | |
14805 | + crypt = &ieee->crypt[idx]; | |
14806 | + else | |
14807 | + return -EINVAL; | |
14808 | + } | |
14809 | + | |
14810 | + sec.flags |= SEC_ENABLED;// | SEC_ENCRYPT; | |
14811 | + if ((encoding->flags & IW_ENCODE_DISABLED) || | |
14812 | + ext->alg == IW_ENCODE_ALG_NONE) { | |
14813 | + if (*crypt) | |
14814 | + ieee80211_crypt_delayed_deinit(ieee, crypt); | |
14815 | + | |
14816 | + for (i = 0; i < WEP_KEYS; i++) | |
14817 | + if (ieee->crypt[i] != NULL) | |
14818 | + break; | |
14819 | + | |
14820 | + if (i == WEP_KEYS) { | |
14821 | + sec.enabled = 0; | |
14822 | + // sec.encrypt = 0; | |
14823 | + sec.level = SEC_LEVEL_0; | |
14824 | + sec.flags |= SEC_LEVEL; | |
14825 | + } | |
14826 | + //printk("disabled: flag:%x\n", encoding->flags); | |
14827 | + goto done; | |
14828 | + } | |
14829 | + | |
14830 | + sec.enabled = 1; | |
14831 | + // sec.encrypt = 1; | |
14832 | +#if 0 | |
14833 | + if (group_key ? !ieee->host_mc_decrypt : | |
14834 | + !(ieee->host_encrypt || ieee->host_decrypt || | |
14835 | + ieee->host_encrypt_msdu)) | |
14836 | + goto skip_host_crypt; | |
14837 | +#endif | |
14838 | + switch (ext->alg) { | |
14839 | + case IW_ENCODE_ALG_WEP: | |
14840 | + alg = "WEP"; | |
14841 | + module = "ieee80211_crypt_wep"; | |
14842 | + break; | |
14843 | + case IW_ENCODE_ALG_TKIP: | |
14844 | + alg = "TKIP"; | |
14845 | + module = "ieee80211_crypt_tkip"; | |
14846 | + break; | |
14847 | + case IW_ENCODE_ALG_CCMP: | |
14848 | + alg = "CCMP"; | |
14849 | + module = "ieee80211_crypt_ccmp"; | |
14850 | + break; | |
14851 | + default: | |
14852 | + IEEE80211_DEBUG_WX("%s: unknown crypto alg %d\n", | |
14853 | + dev->name, ext->alg); | |
14854 | + ret = -EINVAL; | |
14855 | + goto done; | |
14856 | + } | |
14857 | +// printk("8-09-08-9=====>%s, alg name:%s\n",__FUNCTION__, alg); | |
14858 | + | |
14859 | + ops = ieee80211_get_crypto_ops(alg); | |
14860 | + if (ops == NULL) { | |
14861 | + request_module(module); | |
14862 | + ops = ieee80211_get_crypto_ops(alg); | |
14863 | + } | |
14864 | + if (ops == NULL) { | |
14865 | + IEEE80211_DEBUG_WX("%s: unknown crypto alg %d\n", | |
14866 | + dev->name, ext->alg); | |
14867 | + printk("========>unknown crypto alg %d\n", ext->alg); | |
14868 | + ret = -EINVAL; | |
14869 | + goto done; | |
14870 | + } | |
14871 | + | |
14872 | + if (*crypt == NULL || (*crypt)->ops != ops) { | |
14873 | + struct ieee80211_crypt_data *new_crypt; | |
14874 | + | |
14875 | + ieee80211_crypt_delayed_deinit(ieee, crypt); | |
14876 | + | |
14877 | + new_crypt = kzalloc(sizeof(*new_crypt), GFP_KERNEL); | |
14878 | + if (new_crypt == NULL) { | |
14879 | + ret = -ENOMEM; | |
14880 | + goto done; | |
14881 | + } | |
14882 | + new_crypt->ops = ops; | |
14883 | + if (new_crypt->ops && try_module_get(new_crypt->ops->owner)) | |
14884 | + new_crypt->priv = new_crypt->ops->init(idx); | |
14885 | + if (new_crypt->priv == NULL) { | |
14886 | + kfree(new_crypt); | |
14887 | + ret = -EINVAL; | |
14888 | + goto done; | |
14889 | + } | |
14890 | + *crypt = new_crypt; | |
14891 | + | |
14892 | + } | |
14893 | + | |
14894 | + if (ext->key_len > 0 && (*crypt)->ops->set_key && | |
14895 | + (*crypt)->ops->set_key(ext->key, ext->key_len, ext->rx_seq, | |
14896 | + (*crypt)->priv) < 0) { | |
14897 | + IEEE80211_DEBUG_WX("%s: key setting failed\n", dev->name); | |
14898 | + printk("key setting failed\n"); | |
14899 | + ret = -EINVAL; | |
14900 | + goto done; | |
14901 | + } | |
14902 | +#if 1 | |
14903 | + //skip_host_crypt: | |
14904 | + //printk("skip_host_crypt:ext_flags:%x\n", ext->ext_flags); | |
14905 | + if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) { | |
14906 | + ieee->tx_keyidx = idx; | |
14907 | + sec.active_key = idx; | |
14908 | + sec.flags |= SEC_ACTIVE_KEY; | |
14909 | + } | |
14910 | + | |
14911 | + if (ext->alg != IW_ENCODE_ALG_NONE) { | |
14912 | + memcpy(sec.keys[idx], ext->key, ext->key_len); | |
14913 | + sec.key_sizes[idx] = ext->key_len; | |
14914 | + sec.flags |= (1 << idx); | |
14915 | + if (ext->alg == IW_ENCODE_ALG_WEP) { | |
14916 | + // sec.encode_alg[idx] = SEC_ALG_WEP; | |
14917 | + sec.flags |= SEC_LEVEL; | |
14918 | + sec.level = SEC_LEVEL_1; | |
14919 | + } else if (ext->alg == IW_ENCODE_ALG_TKIP) { | |
14920 | + // sec.encode_alg[idx] = SEC_ALG_TKIP; | |
14921 | + sec.flags |= SEC_LEVEL; | |
14922 | + sec.level = SEC_LEVEL_2; | |
14923 | + } else if (ext->alg == IW_ENCODE_ALG_CCMP) { | |
14924 | + // sec.encode_alg[idx] = SEC_ALG_CCMP; | |
14925 | + sec.flags |= SEC_LEVEL; | |
14926 | + sec.level = SEC_LEVEL_3; | |
14927 | + } | |
14928 | + /* Don't set sec level for group keys. */ | |
14929 | + if (group_key) | |
14930 | + sec.flags &= ~SEC_LEVEL; | |
14931 | + } | |
14932 | +#endif | |
14933 | +done: | |
14934 | + if (ieee->set_security) | |
14935 | + ieee->set_security(ieee->dev, &sec); | |
14936 | + | |
14937 | + if (ieee->reset_on_keychange && | |
14938 | + ieee->iw_mode != IW_MODE_INFRA && | |
14939 | + ieee->reset_port && ieee->reset_port(dev)) { | |
14940 | + IEEE80211_DEBUG_WX("%s: reset_port failed\n", dev->name); | |
14941 | + return -EINVAL; | |
14942 | + } | |
14943 | + | |
14944 | + return ret; | |
14945 | +} | |
14946 | +int ieee80211_wx_set_mlme(struct ieee80211_device *ieee, | |
14947 | + struct iw_request_info *info, | |
14948 | + union iwreq_data *wrqu, char *extra) | |
14949 | +{ | |
14950 | + struct iw_mlme *mlme = (struct iw_mlme *) extra; | |
14951 | +// printk("\ndkgadfslkdjgalskdf===============>%s(), cmd:%x\n", __FUNCTION__, mlme->cmd); | |
14952 | +#if 1 | |
14953 | + switch (mlme->cmd) { | |
14954 | + case IW_MLME_DEAUTH: | |
14955 | + case IW_MLME_DISASSOC: | |
14956 | + // printk("disassoc now\n"); | |
14957 | + ieee80211_disassociate(ieee); | |
14958 | + break; | |
14959 | + default: | |
14960 | + return -EOPNOTSUPP; | |
14961 | + } | |
14962 | +#endif | |
14963 | + return 0; | |
14964 | +} | |
14965 | + | |
14966 | +int ieee80211_wx_set_auth(struct ieee80211_device *ieee, | |
14967 | + struct iw_request_info *info, | |
14968 | + struct iw_param *data, char *extra) | |
14969 | +{ | |
14970 | +/* | |
14971 | + struct ieee80211_security sec = { | |
14972 | + .flags = SEC_AUTH_MODE, | |
14973 | + } | |
14974 | +*/ | |
14975 | + //printk("set auth:flag:%x, data value:%x\n", data->flags, data->value); | |
14976 | + switch (data->flags & IW_AUTH_INDEX) { | |
14977 | + case IW_AUTH_WPA_VERSION: | |
14978 | + /*need to support wpa2 here*/ | |
14979 | + //printk("wpa version:%x\n", data->value); | |
14980 | + break; | |
14981 | + case IW_AUTH_CIPHER_PAIRWISE: | |
14982 | + case IW_AUTH_CIPHER_GROUP: | |
14983 | + case IW_AUTH_KEY_MGMT: | |
14984 | + /* | |
14985 | + * * Host AP driver does not use these parameters and allows | |
14986 | + * * wpa_supplicant to control them internally. | |
14987 | + * */ | |
14988 | + break; | |
14989 | + case IW_AUTH_TKIP_COUNTERMEASURES: | |
14990 | + ieee->tkip_countermeasures = data->value; | |
14991 | + break; | |
14992 | + case IW_AUTH_DROP_UNENCRYPTED: | |
14993 | + ieee->drop_unencrypted = data->value; | |
14994 | + break; | |
14995 | + | |
14996 | + case IW_AUTH_80211_AUTH_ALG: | |
14997 | + ieee->open_wep = (data->value&IW_AUTH_ALG_OPEN_SYSTEM)?1:0; | |
14998 | + //printk("open_wep:%d\n", ieee->open_wep); | |
14999 | + break; | |
15000 | + | |
15001 | +#if 1 | |
15002 | + case IW_AUTH_WPA_ENABLED: | |
15003 | + ieee->wpa_enabled = (data->value)?1:0; | |
15004 | + //printk("enalbe wpa:%d\n", ieee->wpa_enabled); | |
15005 | + break; | |
15006 | + | |
15007 | +#endif | |
15008 | + case IW_AUTH_RX_UNENCRYPTED_EAPOL: | |
15009 | + ieee->ieee802_1x = data->value; | |
15010 | + break; | |
15011 | + case IW_AUTH_PRIVACY_INVOKED: | |
15012 | + ieee->privacy_invoked = data->value; | |
15013 | + break; | |
15014 | + default: | |
15015 | + return -EOPNOTSUPP; | |
15016 | + } | |
15017 | + return 0; | |
15018 | +} | |
15019 | + | |
15020 | +#if 1 | |
15021 | +int ieee80211_wx_set_gen_ie(struct ieee80211_device *ieee, u8 *ie, size_t len) | |
15022 | +{ | |
15023 | +#if 0 | |
15024 | + printk("====>%s()\n", __FUNCTION__); | |
15025 | + { | |
15026 | + int i; | |
15027 | + for (i=0; i<len; i++) | |
15028 | + printk("%2x ", ie[i]&0xff); | |
15029 | + printk("\n"); | |
15030 | + } | |
15031 | +#endif | |
15032 | + u8 *buf = NULL; | |
15033 | + | |
15034 | + if (len>MAX_WPA_IE_LEN || (len && ie == NULL)) | |
15035 | + { | |
15036 | + printk("return error out, len:%d\n", len); | |
15037 | + return -EINVAL; | |
15038 | + } | |
15039 | + | |
15040 | + if (len) | |
15041 | + { | |
15042 | + if (len != ie[1]+2){ | |
15043 | + printk("len:%d, ie:%d\n", len, ie[1]); | |
15044 | + return -EINVAL; | |
15045 | + } | |
15046 | + buf = kmalloc(len, GFP_KERNEL); | |
15047 | + if (buf == NULL) | |
15048 | + return -ENOMEM; | |
15049 | + memcpy(buf, ie, len); | |
15050 | + kfree(ieee->wpa_ie); | |
15051 | + ieee->wpa_ie = buf; | |
15052 | + ieee->wpa_ie_len = len; | |
15053 | + } | |
15054 | + else{ | |
15055 | + if (ieee->wpa_ie) | |
15056 | + kfree(ieee->wpa_ie); | |
15057 | + ieee->wpa_ie = NULL; | |
15058 | + ieee->wpa_ie_len = 0; | |
15059 | + } | |
15060 | +// printk("<=====out %s()\n", __FUNCTION__); | |
15061 | + | |
15062 | + return 0; | |
15063 | + | |
15064 | +} | |
15065 | +#endif | |
15066 | + | |
15067 | +#if 0 | |
15068 | +EXPORT_SYMBOL(ieee80211_wx_set_gen_ie); | |
15069 | +EXPORT_SYMBOL(ieee80211_wx_set_mlme); | |
15070 | +EXPORT_SYMBOL(ieee80211_wx_set_auth); | |
15071 | +EXPORT_SYMBOL(ieee80211_wx_set_encode_ext); | |
15072 | +EXPORT_SYMBOL(ieee80211_wx_get_scan); | |
15073 | +EXPORT_SYMBOL(ieee80211_wx_set_encode); | |
15074 | +EXPORT_SYMBOL(ieee80211_wx_get_encode); | |
15075 | +#endif | |
15076 | --- /dev/null | |
15077 | +++ b/drivers/staging/rtl8187se/ieee80211/internal.h | |
15078 | @@ -0,0 +1,115 @@ | |
15079 | +/* | |
15080 | + * Cryptographic API. | |
15081 | + * | |
15082 | + * Copyright (c) 2002 James Morris <jmorris@intercode.com.au> | |
15083 | + * | |
15084 | + * This program is free software; you can redistribute it and/or modify it | |
15085 | + * under the terms of the GNU General Public License as published by the Free | |
15086 | + * Software Foundation; either version 2 of the License, or (at your option) | |
15087 | + * any later version. | |
15088 | + * | |
15089 | + */ | |
15090 | +#ifndef _CRYPTO_INTERNAL_H | |
15091 | +#define _CRYPTO_INTERNAL_H | |
15092 | + | |
15093 | + | |
15094 | +//#include <linux/crypto.h> | |
15095 | +#include "rtl_crypto.h" | |
15096 | +#include <linux/mm.h> | |
15097 | +#include <linux/highmem.h> | |
15098 | +#include <linux/init.h> | |
15099 | +#include <asm/hardirq.h> | |
15100 | +#include <asm/softirq.h> | |
15101 | +#include <asm/kmap_types.h> | |
15102 | + | |
15103 | +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,4,20)) | |
15104 | +#define list_for_each_entry(pos, head, member) \ | |
15105 | + for (pos = list_entry((head)->next, typeof(*pos), member), \ | |
15106 | + prefetch(pos->member.next); \ | |
15107 | + &pos->member != (head); \ | |
15108 | + pos = list_entry(pos->member.next, typeof(*pos), member), \ | |
15109 | + prefetch(pos->member.next)) | |
15110 | + | |
15111 | +static inline void cond_resched(void) | |
15112 | +{ | |
15113 | + if (need_resched()) { | |
15114 | + set_current_state(TASK_RUNNING); | |
15115 | + schedule(); | |
15116 | + } | |
15117 | +} | |
15118 | +#endif | |
15119 | + | |
15120 | +extern enum km_type crypto_km_types[]; | |
15121 | + | |
15122 | +static inline enum km_type crypto_kmap_type(int out) | |
15123 | +{ | |
15124 | + return crypto_km_types[(in_softirq() ? 2 : 0) + out]; | |
15125 | +} | |
15126 | + | |
15127 | +static inline void *crypto_kmap(struct page *page, int out) | |
15128 | +{ | |
15129 | + return kmap_atomic(page, crypto_kmap_type(out)); | |
15130 | +} | |
15131 | + | |
15132 | +static inline void crypto_kunmap(void *vaddr, int out) | |
15133 | +{ | |
15134 | + kunmap_atomic(vaddr, crypto_kmap_type(out)); | |
15135 | +} | |
15136 | + | |
15137 | +static inline void crypto_yield(struct crypto_tfm *tfm) | |
15138 | +{ | |
15139 | + if (!in_softirq()) | |
15140 | + cond_resched(); | |
15141 | +} | |
15142 | + | |
15143 | +static inline void *crypto_tfm_ctx(struct crypto_tfm *tfm) | |
15144 | +{ | |
15145 | + return (void *)&tfm[1]; | |
15146 | +} | |
15147 | + | |
15148 | +struct crypto_alg *crypto_alg_lookup(const char *name); | |
15149 | + | |
15150 | +#ifdef CONFIG_KMOD | |
15151 | +void crypto_alg_autoload(const char *name); | |
15152 | +struct crypto_alg *crypto_alg_mod_lookup(const char *name); | |
15153 | +#else | |
15154 | +static inline struct crypto_alg *crypto_alg_mod_lookup(const char *name) | |
15155 | +{ | |
15156 | + return crypto_alg_lookup(name); | |
15157 | +} | |
15158 | +#endif | |
15159 | + | |
15160 | +#ifdef CONFIG_CRYPTO_HMAC | |
15161 | +int crypto_alloc_hmac_block(struct crypto_tfm *tfm); | |
15162 | +void crypto_free_hmac_block(struct crypto_tfm *tfm); | |
15163 | +#else | |
15164 | +static inline int crypto_alloc_hmac_block(struct crypto_tfm *tfm) | |
15165 | +{ | |
15166 | + return 0; | |
15167 | +} | |
15168 | + | |
15169 | +static inline void crypto_free_hmac_block(struct crypto_tfm *tfm) | |
15170 | +{ } | |
15171 | +#endif | |
15172 | + | |
15173 | +#ifdef CONFIG_PROC_FS | |
15174 | +void __init crypto_init_proc(void); | |
15175 | +#else | |
15176 | +static inline void crypto_init_proc(void) | |
15177 | +{ } | |
15178 | +#endif | |
15179 | + | |
15180 | +int crypto_init_digest_flags(struct crypto_tfm *tfm, u32 flags); | |
15181 | +int crypto_init_cipher_flags(struct crypto_tfm *tfm, u32 flags); | |
15182 | +int crypto_init_compress_flags(struct crypto_tfm *tfm, u32 flags); | |
15183 | + | |
15184 | +int crypto_init_digest_ops(struct crypto_tfm *tfm); | |
15185 | +int crypto_init_cipher_ops(struct crypto_tfm *tfm); | |
15186 | +int crypto_init_compress_ops(struct crypto_tfm *tfm); | |
15187 | + | |
15188 | +void crypto_exit_digest_ops(struct crypto_tfm *tfm); | |
15189 | +void crypto_exit_cipher_ops(struct crypto_tfm *tfm); | |
15190 | +void crypto_exit_compress_ops(struct crypto_tfm *tfm); | |
15191 | + | |
15192 | +#endif /* _CRYPTO_INTERNAL_H */ | |
15193 | + | |
15194 | --- /dev/null | |
15195 | +++ b/drivers/staging/rtl8187se/ieee80211/rtl_crypto.h | |
15196 | @@ -0,0 +1,399 @@ | |
15197 | +/* | |
15198 | + * Scatterlist Cryptographic API. | |
15199 | + * | |
15200 | + * Copyright (c) 2002 James Morris <jmorris@intercode.com.au> | |
15201 | + * Copyright (c) 2002 David S. Miller (davem@redhat.com) | |
15202 | + * | |
15203 | + * Portions derived from Cryptoapi, by Alexander Kjeldaas <astor@fast.no> | |
15204 | + * and Nettle, by Niels Mé°ˆler. | |
15205 | + * | |
15206 | + * This program is free software; you can redistribute it and/or modify it | |
15207 | + * under the terms of the GNU General Public License as published by the Free | |
15208 | + * Software Foundation; either version 2 of the License, or (at your option) | |
15209 | + * any later version. | |
15210 | + * | |
15211 | + */ | |
15212 | +#ifndef _LINUX_CRYPTO_H | |
15213 | +#define _LINUX_CRYPTO_H | |
15214 | + | |
15215 | +#include <linux/module.h> | |
15216 | +#include <linux/kernel.h> | |
15217 | +#include <linux/types.h> | |
15218 | +#include <linux/list.h> | |
15219 | +#include <linux/string.h> | |
15220 | +#include <asm/page.h> | |
15221 | +#include <asm/errno.h> | |
15222 | + | |
15223 | +#define crypto_register_alg crypto_register_alg_rtl | |
15224 | +#define crypto_unregister_alg crypto_unregister_alg_rtl | |
15225 | +#define crypto_alloc_tfm crypto_alloc_tfm_rtl | |
15226 | +#define crypto_free_tfm crypto_free_tfm_rtl | |
15227 | +#define crypto_alg_available crypto_alg_available_rtl | |
15228 | + | |
15229 | +/* | |
15230 | + * Algorithm masks and types. | |
15231 | + */ | |
15232 | +#define CRYPTO_ALG_TYPE_MASK 0x000000ff | |
15233 | +#define CRYPTO_ALG_TYPE_CIPHER 0x00000001 | |
15234 | +#define CRYPTO_ALG_TYPE_DIGEST 0x00000002 | |
15235 | +#define CRYPTO_ALG_TYPE_COMPRESS 0x00000004 | |
15236 | + | |
15237 | +/* | |
15238 | + * Transform masks and values (for crt_flags). | |
15239 | + */ | |
15240 | +#define CRYPTO_TFM_MODE_MASK 0x000000ff | |
15241 | +#define CRYPTO_TFM_REQ_MASK 0x000fff00 | |
15242 | +#define CRYPTO_TFM_RES_MASK 0xfff00000 | |
15243 | + | |
15244 | +#define CRYPTO_TFM_MODE_ECB 0x00000001 | |
15245 | +#define CRYPTO_TFM_MODE_CBC 0x00000002 | |
15246 | +#define CRYPTO_TFM_MODE_CFB 0x00000004 | |
15247 | +#define CRYPTO_TFM_MODE_CTR 0x00000008 | |
15248 | + | |
15249 | +#define CRYPTO_TFM_REQ_WEAK_KEY 0x00000100 | |
15250 | +#define CRYPTO_TFM_RES_WEAK_KEY 0x00100000 | |
15251 | +#define CRYPTO_TFM_RES_BAD_KEY_LEN 0x00200000 | |
15252 | +#define CRYPTO_TFM_RES_BAD_KEY_SCHED 0x00400000 | |
15253 | +#define CRYPTO_TFM_RES_BAD_BLOCK_LEN 0x00800000 | |
15254 | +#define CRYPTO_TFM_RES_BAD_FLAGS 0x01000000 | |
15255 | + | |
15256 | +/* | |
15257 | + * Miscellaneous stuff. | |
15258 | + */ | |
15259 | +#define CRYPTO_UNSPEC 0 | |
15260 | +#define CRYPTO_MAX_ALG_NAME 64 | |
15261 | + | |
15262 | +struct scatterlist; | |
15263 | + | |
15264 | +/* | |
15265 | + * Algorithms: modular crypto algorithm implementations, managed | |
15266 | + * via crypto_register_alg() and crypto_unregister_alg(). | |
15267 | + */ | |
15268 | +struct cipher_alg { | |
15269 | + unsigned int cia_min_keysize; | |
15270 | + unsigned int cia_max_keysize; | |
15271 | + int (*cia_setkey)(void *ctx, const u8 *key, | |
15272 | + unsigned int keylen, u32 *flags); | |
15273 | + void (*cia_encrypt)(void *ctx, u8 *dst, const u8 *src); | |
15274 | + void (*cia_decrypt)(void *ctx, u8 *dst, const u8 *src); | |
15275 | +}; | |
15276 | + | |
15277 | +struct digest_alg { | |
15278 | + unsigned int dia_digestsize; | |
15279 | + void (*dia_init)(void *ctx); | |
15280 | + void (*dia_update)(void *ctx, const u8 *data, unsigned int len); | |
15281 | + void (*dia_final)(void *ctx, u8 *out); | |
15282 | + int (*dia_setkey)(void *ctx, const u8 *key, | |
15283 | + unsigned int keylen, u32 *flags); | |
15284 | +}; | |
15285 | + | |
15286 | +struct compress_alg { | |
15287 | + int (*coa_init)(void *ctx); | |
15288 | + void (*coa_exit)(void *ctx); | |
15289 | + int (*coa_compress)(void *ctx, const u8 *src, unsigned int slen, | |
15290 | + u8 *dst, unsigned int *dlen); | |
15291 | + int (*coa_decompress)(void *ctx, const u8 *src, unsigned int slen, | |
15292 | + u8 *dst, unsigned int *dlen); | |
15293 | +}; | |
15294 | + | |
15295 | +#define cra_cipher cra_u.cipher | |
15296 | +#define cra_digest cra_u.digest | |
15297 | +#define cra_compress cra_u.compress | |
15298 | + | |
15299 | +struct crypto_alg { | |
15300 | + struct list_head cra_list; | |
15301 | + u32 cra_flags; | |
15302 | + unsigned int cra_blocksize; | |
15303 | + unsigned int cra_ctxsize; | |
15304 | + const char cra_name[CRYPTO_MAX_ALG_NAME]; | |
15305 | + | |
15306 | + union { | |
15307 | + struct cipher_alg cipher; | |
15308 | + struct digest_alg digest; | |
15309 | + struct compress_alg compress; | |
15310 | + } cra_u; | |
15311 | + | |
15312 | + struct module *cra_module; | |
15313 | +}; | |
15314 | + | |
15315 | +/* | |
15316 | + * Algorithm registration interface. | |
15317 | + */ | |
15318 | +int crypto_register_alg(struct crypto_alg *alg); | |
15319 | +int crypto_unregister_alg(struct crypto_alg *alg); | |
15320 | + | |
15321 | +/* | |
15322 | + * Algorithm query interface. | |
15323 | + */ | |
15324 | +int crypto_alg_available(const char *name, u32 flags); | |
15325 | + | |
15326 | +/* | |
15327 | + * Transforms: user-instantiated objects which encapsulate algorithms | |
15328 | + * and core processing logic. Managed via crypto_alloc_tfm() and | |
15329 | + * crypto_free_tfm(), as well as the various helpers below. | |
15330 | + */ | |
15331 | +struct crypto_tfm; | |
15332 | + | |
15333 | +struct cipher_tfm { | |
15334 | + void *cit_iv; | |
15335 | + unsigned int cit_ivsize; | |
15336 | + u32 cit_mode; | |
15337 | + int (*cit_setkey)(struct crypto_tfm *tfm, | |
15338 | + const u8 *key, unsigned int keylen); | |
15339 | + int (*cit_encrypt)(struct crypto_tfm *tfm, | |
15340 | + struct scatterlist *dst, | |
15341 | + struct scatterlist *src, | |
15342 | + unsigned int nbytes); | |
15343 | + int (*cit_encrypt_iv)(struct crypto_tfm *tfm, | |
15344 | + struct scatterlist *dst, | |
15345 | + struct scatterlist *src, | |
15346 | + unsigned int nbytes, u8 *iv); | |
15347 | + int (*cit_decrypt)(struct crypto_tfm *tfm, | |
15348 | + struct scatterlist *dst, | |
15349 | + struct scatterlist *src, | |
15350 | + unsigned int nbytes); | |
15351 | + int (*cit_decrypt_iv)(struct crypto_tfm *tfm, | |
15352 | + struct scatterlist *dst, | |
15353 | + struct scatterlist *src, | |
15354 | + unsigned int nbytes, u8 *iv); | |
15355 | + void (*cit_xor_block)(u8 *dst, const u8 *src); | |
15356 | +}; | |
15357 | + | |
15358 | +struct digest_tfm { | |
15359 | + void (*dit_init)(struct crypto_tfm *tfm); | |
15360 | + void (*dit_update)(struct crypto_tfm *tfm, | |
15361 | + struct scatterlist *sg, unsigned int nsg); | |
15362 | + void (*dit_final)(struct crypto_tfm *tfm, u8 *out); | |
15363 | + void (*dit_digest)(struct crypto_tfm *tfm, struct scatterlist *sg, | |
15364 | + unsigned int nsg, u8 *out); | |
15365 | + int (*dit_setkey)(struct crypto_tfm *tfm, | |
15366 | + const u8 *key, unsigned int keylen); | |
15367 | +#ifdef CONFIG_CRYPTO_HMAC | |
15368 | + void *dit_hmac_block; | |
15369 | +#endif | |
15370 | +}; | |
15371 | + | |
15372 | +struct compress_tfm { | |
15373 | + int (*cot_compress)(struct crypto_tfm *tfm, | |
15374 | + const u8 *src, unsigned int slen, | |
15375 | + u8 *dst, unsigned int *dlen); | |
15376 | + int (*cot_decompress)(struct crypto_tfm *tfm, | |
15377 | + const u8 *src, unsigned int slen, | |
15378 | + u8 *dst, unsigned int *dlen); | |
15379 | +}; | |
15380 | + | |
15381 | +#define crt_cipher crt_u.cipher | |
15382 | +#define crt_digest crt_u.digest | |
15383 | +#define crt_compress crt_u.compress | |
15384 | + | |
15385 | +struct crypto_tfm { | |
15386 | + | |
15387 | + u32 crt_flags; | |
15388 | + | |
15389 | + union { | |
15390 | + struct cipher_tfm cipher; | |
15391 | + struct digest_tfm digest; | |
15392 | + struct compress_tfm compress; | |
15393 | + } crt_u; | |
15394 | + | |
15395 | + struct crypto_alg *__crt_alg; | |
15396 | +}; | |
15397 | + | |
15398 | +/* | |
15399 | + * Transform user interface. | |
15400 | + */ | |
15401 | + | |
15402 | +/* | |
15403 | + * crypto_alloc_tfm() will first attempt to locate an already loaded algorithm. | |
15404 | + * If that fails and the kernel supports dynamically loadable modules, it | |
15405 | + * will then attempt to load a module of the same name or alias. A refcount | |
15406 | + * is grabbed on the algorithm which is then associated with the new transform. | |
15407 | + * | |
15408 | + * crypto_free_tfm() frees up the transform and any associated resources, | |
15409 | + * then drops the refcount on the associated algorithm. | |
15410 | + */ | |
15411 | +struct crypto_tfm *crypto_alloc_tfm(const char *alg_name, u32 tfm_flags); | |
15412 | +void crypto_free_tfm(struct crypto_tfm *tfm); | |
15413 | + | |
15414 | +/* | |
15415 | + * Transform helpers which query the underlying algorithm. | |
15416 | + */ | |
15417 | +static inline const char *crypto_tfm_alg_name(struct crypto_tfm *tfm) | |
15418 | +{ | |
15419 | + return tfm->__crt_alg->cra_name; | |
15420 | +} | |
15421 | + | |
15422 | +static inline const char *crypto_tfm_alg_modname(struct crypto_tfm *tfm) | |
15423 | +{ | |
15424 | + struct crypto_alg *alg = tfm->__crt_alg; | |
15425 | + | |
15426 | + if (alg->cra_module) | |
15427 | + return alg->cra_module->name; | |
15428 | + else | |
15429 | + return NULL; | |
15430 | +} | |
15431 | + | |
15432 | +static inline u32 crypto_tfm_alg_type(struct crypto_tfm *tfm) | |
15433 | +{ | |
15434 | + return tfm->__crt_alg->cra_flags & CRYPTO_ALG_TYPE_MASK; | |
15435 | +} | |
15436 | + | |
15437 | +static inline unsigned int crypto_tfm_alg_min_keysize(struct crypto_tfm *tfm) | |
15438 | +{ | |
15439 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_CIPHER); | |
15440 | + return tfm->__crt_alg->cra_cipher.cia_min_keysize; | |
15441 | +} | |
15442 | + | |
15443 | +static inline unsigned int crypto_tfm_alg_max_keysize(struct crypto_tfm *tfm) | |
15444 | +{ | |
15445 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_CIPHER); | |
15446 | + return tfm->__crt_alg->cra_cipher.cia_max_keysize; | |
15447 | +} | |
15448 | + | |
15449 | +static inline unsigned int crypto_tfm_alg_ivsize(struct crypto_tfm *tfm) | |
15450 | +{ | |
15451 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_CIPHER); | |
15452 | + return tfm->crt_cipher.cit_ivsize; | |
15453 | +} | |
15454 | + | |
15455 | +static inline unsigned int crypto_tfm_alg_blocksize(struct crypto_tfm *tfm) | |
15456 | +{ | |
15457 | + return tfm->__crt_alg->cra_blocksize; | |
15458 | +} | |
15459 | + | |
15460 | +static inline unsigned int crypto_tfm_alg_digestsize(struct crypto_tfm *tfm) | |
15461 | +{ | |
15462 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_DIGEST); | |
15463 | + return tfm->__crt_alg->cra_digest.dia_digestsize; | |
15464 | +} | |
15465 | + | |
15466 | +/* | |
15467 | + * API wrappers. | |
15468 | + */ | |
15469 | +static inline void crypto_digest_init(struct crypto_tfm *tfm) | |
15470 | +{ | |
15471 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_DIGEST); | |
15472 | + tfm->crt_digest.dit_init(tfm); | |
15473 | +} | |
15474 | + | |
15475 | +static inline void crypto_digest_update(struct crypto_tfm *tfm, | |
15476 | + struct scatterlist *sg, | |
15477 | + unsigned int nsg) | |
15478 | +{ | |
15479 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_DIGEST); | |
15480 | + tfm->crt_digest.dit_update(tfm, sg, nsg); | |
15481 | +} | |
15482 | + | |
15483 | +static inline void crypto_digest_final(struct crypto_tfm *tfm, u8 *out) | |
15484 | +{ | |
15485 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_DIGEST); | |
15486 | + tfm->crt_digest.dit_final(tfm, out); | |
15487 | +} | |
15488 | + | |
15489 | +static inline void crypto_digest_digest(struct crypto_tfm *tfm, | |
15490 | + struct scatterlist *sg, | |
15491 | + unsigned int nsg, u8 *out) | |
15492 | +{ | |
15493 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_DIGEST); | |
15494 | + tfm->crt_digest.dit_digest(tfm, sg, nsg, out); | |
15495 | +} | |
15496 | + | |
15497 | +static inline int crypto_digest_setkey(struct crypto_tfm *tfm, | |
15498 | + const u8 *key, unsigned int keylen) | |
15499 | +{ | |
15500 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_DIGEST); | |
15501 | + if (tfm->crt_digest.dit_setkey == NULL) | |
15502 | + return -ENOSYS; | |
15503 | + return tfm->crt_digest.dit_setkey(tfm, key, keylen); | |
15504 | +} | |
15505 | + | |
15506 | +static inline int crypto_cipher_setkey(struct crypto_tfm *tfm, | |
15507 | + const u8 *key, unsigned int keylen) | |
15508 | +{ | |
15509 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_CIPHER); | |
15510 | + return tfm->crt_cipher.cit_setkey(tfm, key, keylen); | |
15511 | +} | |
15512 | + | |
15513 | +static inline int crypto_cipher_encrypt(struct crypto_tfm *tfm, | |
15514 | + struct scatterlist *dst, | |
15515 | + struct scatterlist *src, | |
15516 | + unsigned int nbytes) | |
15517 | +{ | |
15518 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_CIPHER); | |
15519 | + return tfm->crt_cipher.cit_encrypt(tfm, dst, src, nbytes); | |
15520 | +} | |
15521 | + | |
15522 | +static inline int crypto_cipher_encrypt_iv(struct crypto_tfm *tfm, | |
15523 | + struct scatterlist *dst, | |
15524 | + struct scatterlist *src, | |
15525 | + unsigned int nbytes, u8 *iv) | |
15526 | +{ | |
15527 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_CIPHER); | |
15528 | + BUG_ON(tfm->crt_cipher.cit_mode == CRYPTO_TFM_MODE_ECB); | |
15529 | + return tfm->crt_cipher.cit_encrypt_iv(tfm, dst, src, nbytes, iv); | |
15530 | +} | |
15531 | + | |
15532 | +static inline int crypto_cipher_decrypt(struct crypto_tfm *tfm, | |
15533 | + struct scatterlist *dst, | |
15534 | + struct scatterlist *src, | |
15535 | + unsigned int nbytes) | |
15536 | +{ | |
15537 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_CIPHER); | |
15538 | + return tfm->crt_cipher.cit_decrypt(tfm, dst, src, nbytes); | |
15539 | +} | |
15540 | + | |
15541 | +static inline int crypto_cipher_decrypt_iv(struct crypto_tfm *tfm, | |
15542 | + struct scatterlist *dst, | |
15543 | + struct scatterlist *src, | |
15544 | + unsigned int nbytes, u8 *iv) | |
15545 | +{ | |
15546 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_CIPHER); | |
15547 | + BUG_ON(tfm->crt_cipher.cit_mode == CRYPTO_TFM_MODE_ECB); | |
15548 | + return tfm->crt_cipher.cit_decrypt_iv(tfm, dst, src, nbytes, iv); | |
15549 | +} | |
15550 | + | |
15551 | +static inline void crypto_cipher_set_iv(struct crypto_tfm *tfm, | |
15552 | + const u8 *src, unsigned int len) | |
15553 | +{ | |
15554 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_CIPHER); | |
15555 | + memcpy(tfm->crt_cipher.cit_iv, src, len); | |
15556 | +} | |
15557 | + | |
15558 | +static inline void crypto_cipher_get_iv(struct crypto_tfm *tfm, | |
15559 | + u8 *dst, unsigned int len) | |
15560 | +{ | |
15561 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_CIPHER); | |
15562 | + memcpy(dst, tfm->crt_cipher.cit_iv, len); | |
15563 | +} | |
15564 | + | |
15565 | +static inline int crypto_comp_compress(struct crypto_tfm *tfm, | |
15566 | + const u8 *src, unsigned int slen, | |
15567 | + u8 *dst, unsigned int *dlen) | |
15568 | +{ | |
15569 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_COMPRESS); | |
15570 | + return tfm->crt_compress.cot_compress(tfm, src, slen, dst, dlen); | |
15571 | +} | |
15572 | + | |
15573 | +static inline int crypto_comp_decompress(struct crypto_tfm *tfm, | |
15574 | + const u8 *src, unsigned int slen, | |
15575 | + u8 *dst, unsigned int *dlen) | |
15576 | +{ | |
15577 | + BUG_ON(crypto_tfm_alg_type(tfm) != CRYPTO_ALG_TYPE_COMPRESS); | |
15578 | + return tfm->crt_compress.cot_decompress(tfm, src, slen, dst, dlen); | |
15579 | +} | |
15580 | + | |
15581 | +/* | |
15582 | + * HMAC support. | |
15583 | + */ | |
15584 | +#ifdef CONFIG_CRYPTO_HMAC | |
15585 | +void crypto_hmac_init(struct crypto_tfm *tfm, u8 *key, unsigned int *keylen); | |
15586 | +void crypto_hmac_update(struct crypto_tfm *tfm, | |
15587 | + struct scatterlist *sg, unsigned int nsg); | |
15588 | +void crypto_hmac_final(struct crypto_tfm *tfm, u8 *key, | |
15589 | + unsigned int *keylen, u8 *out); | |
15590 | +void crypto_hmac(struct crypto_tfm *tfm, u8 *key, unsigned int *keylen, | |
15591 | + struct scatterlist *sg, unsigned int nsg, u8 *out); | |
15592 | +#endif /* CONFIG_CRYPTO_HMAC */ | |
15593 | + | |
15594 | +#endif /* _LINUX_CRYPTO_H */ | |
15595 | + | |
15596 | --- /dev/null | |
15597 | +++ b/drivers/staging/rtl8187se/Kconfig | |
15598 | @@ -0,0 +1,5 @@ | |
15599 | +config RTL8187SE | |
15600 | + tristate "RealTek RTL8187SE Wireless LAN NIC driver" | |
15601 | + depends on PCI | |
15602 | + default N | |
15603 | + ---help--- | |
15604 | --- /dev/null | |
15605 | +++ b/drivers/staging/rtl8187se/Makefile | |
15606 | @@ -0,0 +1,55 @@ | |
15607 | + | |
15608 | +#EXTRA_CFLAGS += -DCONFIG_IEEE80211_NOWEP=y | |
15609 | +#EXTRA_CFLAGS += -DCONFIG_RTL8180_IOMAP | |
15610 | +#EXTRA_CFLAGS += -std=gnu89 | |
15611 | +#EXTRA_CFLAGS += -O2 | |
15612 | +#CC = gcc | |
15613 | +EXTRA_CFLAGS += -DTHOMAS_TURBO | |
15614 | +#CFLAGS += -DCONFIG_RTL8185B | |
15615 | +#CFLAGS += -DCONFIG_RTL818x_S | |
15616 | + | |
15617 | +#added for EeePC testing | |
15618 | +EXTRA_CFLAGS += -DENABLE_IPS | |
15619 | +EXTRA_CFLAGS += -DSW_ANTE | |
15620 | +EXTRA_CFLAGS += -DTX_TRACK | |
15621 | +EXTRA_CFLAGS += -DHIGH_POWER | |
15622 | +EXTRA_CFLAGS += -DSW_DIG | |
15623 | +EXTRA_CFLAGS += -DRATE_ADAPT | |
15624 | +EXTRA_CFLAGS += -DCONFIG_RTL8180_PM | |
15625 | + | |
15626 | +#+YJ,080626 | |
15627 | +EXTRA_CFLAGS += -DENABLE_DOT11D | |
15628 | + | |
15629 | +#enable it for legacy power save, disable it for leisure power save | |
15630 | +EXTRA_CFLAGS += -DENABLE_LPS | |
15631 | + | |
15632 | + | |
15633 | +#EXTRA_CFLAGS += -mhard-float -DCONFIG_FORCE_HARD_FLOAT=y | |
15634 | + | |
15635 | +rtl8187se-objs := \ | |
15636 | + r8180_core.o \ | |
15637 | + r8180_sa2400.o \ | |
15638 | + r8180_93cx6.o \ | |
15639 | + r8180_wx.o \ | |
15640 | + r8180_max2820.o \ | |
15641 | + r8180_gct.o \ | |
15642 | + r8180_rtl8225.o \ | |
15643 | + r8180_rtl8255.o \ | |
15644 | + r8180_rtl8225z2.o \ | |
15645 | + r8185b_init.o \ | |
15646 | + r8180_dm.o \ | |
15647 | + r8180_pm.o \ | |
15648 | + ieee80211/dot11d.o \ | |
15649 | + ieee80211/ieee80211_softmac.o \ | |
15650 | + ieee80211/ieee80211_rx.o \ | |
15651 | + ieee80211/ieee80211_tx.o \ | |
15652 | + ieee80211/ieee80211_wx.o \ | |
15653 | + ieee80211/ieee80211_module.o \ | |
15654 | + ieee80211/ieee80211_softmac_wx.o \ | |
15655 | + ieee80211/ieee80211_crypt.o \ | |
15656 | + ieee80211/ieee80211_crypt_tkip.o \ | |
15657 | + ieee80211/ieee80211_crypt_ccmp.o \ | |
15658 | + ieee80211/ieee80211_crypt_wep.o | |
15659 | + | |
15660 | +obj-$(CONFIG_RTL8187SE) += rtl8187se.o | |
15661 | + | |
15662 | --- /dev/null | |
15663 | +++ b/drivers/staging/rtl8187se/r8180_93cx6.c | |
15664 | @@ -0,0 +1,146 @@ | |
15665 | +/* | |
15666 | + This files contains card eeprom (93c46 or 93c56) programming routines, | |
15667 | + memory is addressed by 16 bits words. | |
15668 | + | |
15669 | + This is part of rtl8180 OpenSource driver. | |
15670 | + Copyright (C) Andrea Merello 2004 <andreamrl@tiscali.it> | |
15671 | + Released under the terms of GPL (General Public Licence) | |
15672 | + | |
15673 | + Parts of this driver are based on the GPL part of the | |
15674 | + official realtek driver. | |
15675 | + | |
15676 | + Parts of this driver are based on the rtl8180 driver skeleton | |
15677 | + from Patric Schenke & Andres Salomon. | |
15678 | + | |
15679 | + Parts of this driver are based on the Intel Pro Wireless 2100 GPL driver. | |
15680 | + | |
15681 | + We want to tanks the Authors of those projects and the Ndiswrapper | |
15682 | + project Authors. | |
15683 | +*/ | |
15684 | + | |
15685 | +#include "r8180_93cx6.h" | |
15686 | + | |
15687 | +void eprom_cs(struct net_device *dev, short bit) | |
15688 | +{ | |
15689 | + if(bit) | |
15690 | + write_nic_byte(dev, EPROM_CMD, | |
15691 | + (1<<EPROM_CS_SHIFT) | \ | |
15692 | + read_nic_byte(dev, EPROM_CMD)); //enable EPROM | |
15693 | + else | |
15694 | + write_nic_byte(dev, EPROM_CMD, read_nic_byte(dev, EPROM_CMD)\ | |
15695 | + &~(1<<EPROM_CS_SHIFT)); //disable EPROM | |
15696 | + | |
15697 | + force_pci_posting(dev); | |
15698 | + udelay(EPROM_DELAY); | |
15699 | +} | |
15700 | + | |
15701 | + | |
15702 | +void eprom_ck_cycle(struct net_device *dev) | |
15703 | +{ | |
15704 | + write_nic_byte(dev, EPROM_CMD, | |
15705 | + (1<<EPROM_CK_SHIFT) | read_nic_byte(dev,EPROM_CMD)); | |
15706 | + force_pci_posting(dev); | |
15707 | + udelay(EPROM_DELAY); | |
15708 | + write_nic_byte(dev, EPROM_CMD, | |
15709 | + read_nic_byte(dev, EPROM_CMD) &~ (1<<EPROM_CK_SHIFT)); | |
15710 | + force_pci_posting(dev); | |
15711 | + udelay(EPROM_DELAY); | |
15712 | +} | |
15713 | + | |
15714 | + | |
15715 | +void eprom_w(struct net_device *dev,short bit) | |
15716 | +{ | |
15717 | + if(bit) | |
15718 | + write_nic_byte(dev, EPROM_CMD, (1<<EPROM_W_SHIFT) | \ | |
15719 | + read_nic_byte(dev,EPROM_CMD)); | |
15720 | + else | |
15721 | + write_nic_byte(dev, EPROM_CMD, read_nic_byte(dev,EPROM_CMD)\ | |
15722 | + &~(1<<EPROM_W_SHIFT)); | |
15723 | + | |
15724 | + force_pci_posting(dev); | |
15725 | + udelay(EPROM_DELAY); | |
15726 | +} | |
15727 | + | |
15728 | + | |
15729 | +short eprom_r(struct net_device *dev) | |
15730 | +{ | |
15731 | + short bit; | |
15732 | + | |
15733 | + bit=(read_nic_byte(dev, EPROM_CMD) & (1<<EPROM_R_SHIFT) ); | |
15734 | + udelay(EPROM_DELAY); | |
15735 | + | |
15736 | + if(bit) return 1; | |
15737 | + return 0; | |
15738 | +} | |
15739 | + | |
15740 | + | |
15741 | +void eprom_send_bits_string(struct net_device *dev, short b[], int len) | |
15742 | +{ | |
15743 | + int i; | |
15744 | + | |
15745 | + for(i=0; i<len; i++){ | |
15746 | + eprom_w(dev, b[i]); | |
15747 | + eprom_ck_cycle(dev); | |
15748 | + } | |
15749 | +} | |
15750 | + | |
15751 | + | |
15752 | +u32 eprom_read(struct net_device *dev, u32 addr) | |
15753 | +{ | |
15754 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
15755 | + short read_cmd[]={1,1,0}; | |
15756 | + short addr_str[8]; | |
15757 | + int i; | |
15758 | + int addr_len; | |
15759 | + u32 ret; | |
15760 | + | |
15761 | + ret=0; | |
15762 | + //enable EPROM programming | |
15763 | + write_nic_byte(dev, EPROM_CMD, | |
15764 | + (EPROM_CMD_PROGRAM<<EPROM_CMD_OPERATING_MODE_SHIFT)); | |
15765 | + force_pci_posting(dev); | |
15766 | + udelay(EPROM_DELAY); | |
15767 | + | |
15768 | + if (priv->epromtype==EPROM_93c56){ | |
15769 | + addr_str[7]=addr & 1; | |
15770 | + addr_str[6]=addr & (1<<1); | |
15771 | + addr_str[5]=addr & (1<<2); | |
15772 | + addr_str[4]=addr & (1<<3); | |
15773 | + addr_str[3]=addr & (1<<4); | |
15774 | + addr_str[2]=addr & (1<<5); | |
15775 | + addr_str[1]=addr & (1<<6); | |
15776 | + addr_str[0]=addr & (1<<7); | |
15777 | + addr_len=8; | |
15778 | + }else{ | |
15779 | + addr_str[5]=addr & 1; | |
15780 | + addr_str[4]=addr & (1<<1); | |
15781 | + addr_str[3]=addr & (1<<2); | |
15782 | + addr_str[2]=addr & (1<<3); | |
15783 | + addr_str[1]=addr & (1<<4); | |
15784 | + addr_str[0]=addr & (1<<5); | |
15785 | + addr_len=6; | |
15786 | + } | |
15787 | + eprom_cs(dev, 1); | |
15788 | + eprom_ck_cycle(dev); | |
15789 | + eprom_send_bits_string(dev, read_cmd, 3); | |
15790 | + eprom_send_bits_string(dev, addr_str, addr_len); | |
15791 | + | |
15792 | + //keep chip pin D to low state while reading. | |
15793 | + //I'm unsure if it is necessary, but anyway shouldn't hurt | |
15794 | + eprom_w(dev, 0); | |
15795 | + | |
15796 | + for(i=0;i<16;i++){ | |
15797 | + //eeprom needs a clk cycle between writing opcode&adr | |
15798 | + //and reading data. (eeprom outs a dummy 0) | |
15799 | + eprom_ck_cycle(dev); | |
15800 | + ret |= (eprom_r(dev)<<(15-i)); | |
15801 | + } | |
15802 | + | |
15803 | + eprom_cs(dev, 0); | |
15804 | + eprom_ck_cycle(dev); | |
15805 | + | |
15806 | + //disable EPROM programming | |
15807 | + write_nic_byte(dev, EPROM_CMD, | |
15808 | + (EPROM_CMD_NORMAL<<EPROM_CMD_OPERATING_MODE_SHIFT)); | |
15809 | + return ret; | |
15810 | +} | |
15811 | --- /dev/null | |
15812 | +++ b/drivers/staging/rtl8187se/r8180_93cx6.h | |
15813 | @@ -0,0 +1,59 @@ | |
15814 | +/* | |
15815 | + This is part of rtl8180 OpenSource driver | |
15816 | + Copyright (C) Andrea Merello 2004-2005 <andreamrl@tiscali.it> | |
15817 | + Released under the terms of GPL (General Public Licence) | |
15818 | + | |
15819 | + Parts of this driver are based on the GPL part of the official realtek driver | |
15820 | + Parts of this driver are based on the rtl8180 driver skeleton from Patric Schenke & Andres Salomon | |
15821 | + Parts of this driver are based on the Intel Pro Wireless 2100 GPL driver | |
15822 | + | |
15823 | + We want to tanks the Authors of such projects and the Ndiswrapper project Authors. | |
15824 | +*/ | |
15825 | + | |
15826 | +/*This files contains card eeprom (93c46 or 93c56) programming routines*/ | |
15827 | +/*memory is addressed by WORDS*/ | |
15828 | + | |
15829 | +#include "r8180.h" | |
15830 | +#include "r8180_hw.h" | |
15831 | + | |
15832 | +#define EPROM_DELAY 10 | |
15833 | + | |
15834 | +#define EPROM_ANAPARAM_ADDRLWORD 0xd | |
15835 | +#define EPROM_ANAPARAM_ADDRHWORD 0xe | |
15836 | + | |
15837 | +#define RFCHIPID 0x6 | |
15838 | +#define RFCHIPID_INTERSIL 1 | |
15839 | +#define RFCHIPID_RFMD 2 | |
15840 | +#define RFCHIPID_PHILIPS 3 | |
15841 | +#define RFCHIPID_MAXIM 4 | |
15842 | +#define RFCHIPID_GCT 5 | |
15843 | +#define RFCHIPID_RTL8225 9 | |
15844 | +#ifdef CONFIG_RTL8185B | |
15845 | +#define RF_ZEBRA2 11 | |
15846 | +#define EPROM_TXPW_BASE 0x05 | |
15847 | +#define RF_ZEBRA4 12 | |
15848 | +#endif | |
15849 | +#define RFCHIPID_RTL8255 0xa | |
15850 | +#define RF_PARAM 0x19 | |
15851 | +#define RF_PARAM_DIGPHY_SHIFT 0 | |
15852 | +#define RF_PARAM_ANTBDEFAULT_SHIFT 1 | |
15853 | +#define RF_PARAM_CARRIERSENSE_SHIFT 2 | |
15854 | +#define RF_PARAM_CARRIERSENSE_MASK (3<<2) | |
15855 | +#define ENERGY_TRESHOLD 0x17 | |
15856 | +#define EPROM_VERSION 0x1E | |
15857 | +#define MAC_ADR 0x7 | |
15858 | + | |
15859 | +#define CIS 0x18 | |
15860 | + | |
15861 | +#define EPROM_TXPW_OFDM_CH1_2 0x20 | |
15862 | + | |
15863 | +//#define EPROM_TXPW_CH1_2 0x10 | |
15864 | +#define EPROM_TXPW_CH1_2 0x30 | |
15865 | +#define EPROM_TXPW_CH3_4 0x11 | |
15866 | +#define EPROM_TXPW_CH5_6 0x12 | |
15867 | +#define EPROM_TXPW_CH7_8 0x13 | |
15868 | +#define EPROM_TXPW_CH9_10 0x14 | |
15869 | +#define EPROM_TXPW_CH11_12 0x15 | |
15870 | +#define EPROM_TXPW_CH13_14 0x16 | |
15871 | + | |
15872 | +u32 eprom_read(struct net_device *dev,u32 addr); //reads a 16 bits word | |
15873 | --- /dev/null | |
15874 | +++ b/drivers/staging/rtl8187se/r8180_core.c | |
15875 | @@ -0,0 +1,6828 @@ | |
15876 | +/* | |
15877 | + This is part of rtl818x pci OpenSource driver - v 0.1 | |
15878 | + Copyright (C) Andrea Merello 2004-2005 <andreamrl@tiscali.it> | |
15879 | + Released under the terms of GPL (General Public License) | |
15880 | + | |
15881 | + Parts of this driver are based on the GPL part of the official | |
15882 | + Realtek driver. | |
15883 | + | |
15884 | + Parts of this driver are based on the rtl8180 driver skeleton | |
15885 | + from Patric Schenke & Andres Salomon. | |
15886 | + | |
15887 | + Parts of this driver are based on the Intel Pro Wireless 2100 GPL driver. | |
15888 | + | |
15889 | + Parts of BB/RF code are derived from David Young rtl8180 netbsd driver. | |
15890 | + | |
15891 | + RSSI calc function from 'The Deuce' | |
15892 | + | |
15893 | + Some ideas borrowed from the 8139too.c driver included in linux kernel. | |
15894 | + | |
15895 | + We (I?) want to thanks the Authors of those projecs and also the | |
15896 | + Ndiswrapper's project Authors. | |
15897 | + | |
15898 | + A big big thanks goes also to Realtek corp. for their help in my attempt to | |
15899 | + add RTL8185 and RTL8225 support, and to David Young also. | |
15900 | +*/ | |
15901 | + | |
15902 | +#if 0 | |
15903 | +double __floatsidf (int i) { return i; } | |
15904 | +unsigned int __fixunsdfsi (double d) { return d; } | |
15905 | +double __adddf3(double a, double b) { return a+b; } | |
15906 | +double __addsf3(float a, float b) { return a+b; } | |
15907 | +double __subdf3(double a, double b) { return a-b; } | |
15908 | +double __extendsfdf2(float a) {return a;} | |
15909 | +#endif | |
15910 | + | |
15911 | + | |
15912 | +#undef DEBUG_TX_DESC2 | |
15913 | +#undef RX_DONT_PASS_UL | |
15914 | +#undef DEBUG_EPROM | |
15915 | +#undef DEBUG_RX_VERBOSE | |
15916 | +#undef DUMMY_RX | |
15917 | +#undef DEBUG_ZERO_RX | |
15918 | +#undef DEBUG_RX_SKB | |
15919 | +#undef DEBUG_TX_FRAG | |
15920 | +#undef DEBUG_RX_FRAG | |
15921 | +#undef DEBUG_TX_FILLDESC | |
15922 | +#undef DEBUG_TX | |
15923 | +#undef DEBUG_IRQ | |
15924 | +#undef DEBUG_RX | |
15925 | +#undef DEBUG_RXALLOC | |
15926 | +#undef DEBUG_REGISTERS | |
15927 | +#undef DEBUG_RING | |
15928 | +#undef DEBUG_IRQ_TASKLET | |
15929 | +#undef DEBUG_TX_ALLOC | |
15930 | +#undef DEBUG_TX_DESC | |
15931 | + | |
15932 | +//#define DEBUG_TX | |
15933 | +//#define DEBUG_TX_DESC2 | |
15934 | +//#define DEBUG_RX | |
15935 | +//#define DEBUG_RX_SKB | |
15936 | + | |
15937 | +//#define CONFIG_RTL8180_IO_MAP | |
15938 | +#include <linux/syscalls.h> | |
15939 | +//#include <linux/fcntl.h> | |
15940 | +//#include <asm/uaccess.h> | |
15941 | +#include "r8180_hw.h" | |
15942 | +#include "r8180.h" | |
15943 | +#include "r8180_sa2400.h" /* PHILIPS Radio frontend */ | |
15944 | +#include "r8180_max2820.h" /* MAXIM Radio frontend */ | |
15945 | +#include "r8180_gct.h" /* GCT Radio frontend */ | |
15946 | +#include "r8180_rtl8225.h" /* RTL8225 Radio frontend */ | |
15947 | +#include "r8180_rtl8255.h" /* RTL8255 Radio frontend */ | |
15948 | +#include "r8180_93cx6.h" /* Card EEPROM */ | |
15949 | +#include "r8180_wx.h" | |
15950 | +#include "r8180_dm.h" | |
15951 | + | |
15952 | +#ifdef CONFIG_RTL8180_PM | |
15953 | +#include "r8180_pm.h" | |
15954 | +#endif | |
15955 | + | |
15956 | +#ifdef ENABLE_DOT11D | |
15957 | +#include "dot11d.h" | |
15958 | +#endif | |
15959 | + | |
15960 | +#ifdef CONFIG_RTL8185B | |
15961 | +//#define CONFIG_RTL8180_IO_MAP | |
15962 | +#endif | |
15963 | + | |
15964 | +#ifndef PCI_VENDOR_ID_BELKIN | |
15965 | + #define PCI_VENDOR_ID_BELKIN 0x1799 | |
15966 | +#endif | |
15967 | +#ifndef PCI_VENDOR_ID_DLINK | |
15968 | + #define PCI_VENDOR_ID_DLINK 0x1186 | |
15969 | +#endif | |
15970 | + | |
15971 | +static struct pci_device_id rtl8180_pci_id_tbl[] __devinitdata = { | |
15972 | + { | |
15973 | + .vendor = PCI_VENDOR_ID_REALTEK, | |
15974 | +// .device = 0x8180, | |
15975 | + .device = 0x8199, | |
15976 | + .subvendor = PCI_ANY_ID, | |
15977 | + .subdevice = PCI_ANY_ID, | |
15978 | + .driver_data = 0, | |
15979 | + }, | |
15980 | +#if 0 | |
15981 | + { | |
15982 | + .vendor = PCI_VENDOR_ID_BELKIN, | |
15983 | + .device = 0x6001, | |
15984 | + .subvendor = PCI_ANY_ID, | |
15985 | + .subdevice = PCI_ANY_ID, | |
15986 | + .driver_data = 1, | |
15987 | + }, | |
15988 | + { /* Belkin F5D6020 v3 */ | |
15989 | + .vendor = PCI_VENDOR_ID_BELKIN, | |
15990 | + .device = 0x6020, | |
15991 | + .subvendor = PCI_ANY_ID, | |
15992 | + .subdevice = PCI_ANY_ID, | |
15993 | + .driver_data = 2, | |
15994 | + }, | |
15995 | + { /* D-Link DWL-610 */ | |
15996 | + .vendor = PCI_VENDOR_ID_DLINK, | |
15997 | + .device = 0x3300, | |
15998 | + .subvendor = PCI_ANY_ID, | |
15999 | + .subdevice = PCI_ANY_ID, | |
16000 | + .driver_data = 3, | |
16001 | + }, | |
16002 | + { | |
16003 | + .vendor = PCI_VENDOR_ID_REALTEK, | |
16004 | + .device = 0x8185, | |
16005 | + .subvendor = PCI_ANY_ID, | |
16006 | + .subdevice = PCI_ANY_ID, | |
16007 | + .driver_data = 4, | |
16008 | + }, | |
16009 | +#endif | |
16010 | + { | |
16011 | + .vendor = 0, | |
16012 | + .device = 0, | |
16013 | + .subvendor = 0, | |
16014 | + .subdevice = 0, | |
16015 | + .driver_data = 0, | |
16016 | + } | |
16017 | +}; | |
16018 | + | |
16019 | + | |
16020 | +static char* ifname = "wlan%d"; | |
16021 | +static int hwseqnum = 0; | |
16022 | +//static char* ifname = "ath%d"; | |
16023 | +static int hwwep = 0; | |
16024 | +static int channels = 0x3fff; | |
16025 | + | |
16026 | +#define eqMacAddr(a,b) ( ((a)[0]==(b)[0] && (a)[1]==(b)[1] && (a)[2]==(b)[2] && (a)[3]==(b)[3] && (a)[4]==(b)[4] && (a)[5]==(b)[5]) ? 1:0 ) | |
16027 | +#define cpMacAddr(des,src) ((des)[0]=(src)[0],(des)[1]=(src)[1],(des)[2]=(src)[2],(des)[3]=(src)[3],(des)[4]=(src)[4],(des)[5]=(src)[5]) | |
16028 | +MODULE_LICENSE("GPL"); | |
16029 | +MODULE_DEVICE_TABLE(pci, rtl8180_pci_id_tbl); | |
16030 | +MODULE_AUTHOR("Andrea Merello <andreamrl@tiscali.it>"); | |
16031 | +MODULE_DESCRIPTION("Linux driver for Realtek RTL8180 / RTL8185 WiFi cards"); | |
16032 | + | |
16033 | + | |
16034 | + | |
16035 | +/* | |
16036 | +MODULE_PARM(ifname, "s"); | |
16037 | +MODULE_PARM_DESC(devname," Net interface name, wlan%d=default"); | |
16038 | + | |
16039 | +MODULE_PARM(hwseqnum,"i"); | |
16040 | +MODULE_PARM_DESC(hwseqnum," Try to use hardware 802.11 header sequence numbers. Zero=default"); | |
16041 | + | |
16042 | +MODULE_PARM(hwwep,"i"); | |
16043 | +MODULE_PARM_DESC(hwwep," Try to use hardware WEP support. Still broken and not available on all cards"); | |
16044 | + | |
16045 | +MODULE_PARM(channels,"i"); | |
16046 | +MODULE_PARM_DESC(channels," Channel bitmask for specific locales. NYI"); | |
16047 | +*/ | |
16048 | + | |
16049 | +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 9) | |
16050 | +module_param(ifname, charp, S_IRUGO|S_IWUSR ); | |
16051 | +module_param(hwseqnum,int, S_IRUGO|S_IWUSR); | |
16052 | +module_param(hwwep,int, S_IRUGO|S_IWUSR); | |
16053 | +module_param(channels,int, S_IRUGO|S_IWUSR); | |
16054 | +#else | |
16055 | +MODULE_PARM(ifname, "s"); | |
16056 | +MODULE_PARM(hwseqnum,"i"); | |
16057 | +MODULE_PARM(hwwep,"i"); | |
16058 | +MODULE_PARM(channels,"i"); | |
16059 | +#endif | |
16060 | + | |
16061 | +MODULE_PARM_DESC(devname," Net interface name, wlan%d=default"); | |
16062 | +//MODULE_PARM_DESC(devname," Net interface name, ath%d=default"); | |
16063 | +MODULE_PARM_DESC(hwseqnum," Try to use hardware 802.11 header sequence numbers. Zero=default"); | |
16064 | +MODULE_PARM_DESC(hwwep," Try to use hardware WEP support. Still broken and not available on all cards"); | |
16065 | +MODULE_PARM_DESC(channels," Channel bitmask for specific locales. NYI"); | |
16066 | + | |
16067 | + | |
16068 | +static int __devinit rtl8180_pci_probe(struct pci_dev *pdev, | |
16069 | + const struct pci_device_id *id); | |
16070 | + | |
16071 | +static void __devexit rtl8180_pci_remove(struct pci_dev *pdev); | |
16072 | + | |
16073 | +static void rtl8180_shutdown (struct pci_dev *pdev) | |
16074 | +{ | |
16075 | + struct net_device *dev = pci_get_drvdata(pdev); | |
16076 | + dev->stop(dev); | |
16077 | + pci_disable_device(pdev); | |
16078 | +} | |
16079 | + | |
16080 | +static struct pci_driver rtl8180_pci_driver = { | |
16081 | + .name = RTL8180_MODULE_NAME, /* Driver name */ | |
16082 | + .id_table = rtl8180_pci_id_tbl, /* PCI_ID table */ | |
16083 | + .probe = rtl8180_pci_probe, /* probe fn */ | |
16084 | + .remove = __devexit_p(rtl8180_pci_remove),/* remove fn */ | |
16085 | +#ifdef CONFIG_RTL8180_PM | |
16086 | + .suspend = rtl8180_suspend, /* PM suspend fn */ | |
16087 | + .resume = rtl8180_resume, /* PM resume fn */ | |
16088 | +#else | |
16089 | + .suspend = NULL, /* PM suspend fn */ | |
16090 | + .resume = NULL, /* PM resume fn */ | |
16091 | +#endif | |
16092 | + .shutdown = rtl8180_shutdown, | |
16093 | +}; | |
16094 | + | |
16095 | + | |
16096 | + | |
16097 | +#ifdef CONFIG_RTL8180_IO_MAP | |
16098 | + | |
16099 | +u8 read_nic_byte(struct net_device *dev, int x) | |
16100 | +{ | |
16101 | + return 0xff&inb(dev->base_addr +x); | |
16102 | +} | |
16103 | + | |
16104 | +u32 read_nic_dword(struct net_device *dev, int x) | |
16105 | +{ | |
16106 | + return inl(dev->base_addr +x); | |
16107 | +} | |
16108 | + | |
16109 | +u16 read_nic_word(struct net_device *dev, int x) | |
16110 | +{ | |
16111 | + return inw(dev->base_addr +x); | |
16112 | +} | |
16113 | + | |
16114 | +void write_nic_byte(struct net_device *dev, int x,u8 y) | |
16115 | +{ | |
16116 | + outb(y&0xff,dev->base_addr +x); | |
16117 | +} | |
16118 | + | |
16119 | +void write_nic_word(struct net_device *dev, int x,u16 y) | |
16120 | +{ | |
16121 | + outw(y,dev->base_addr +x); | |
16122 | +} | |
16123 | + | |
16124 | +void write_nic_dword(struct net_device *dev, int x,u32 y) | |
16125 | +{ | |
16126 | + outl(y,dev->base_addr +x); | |
16127 | +} | |
16128 | + | |
16129 | +#else /* RTL_IO_MAP */ | |
16130 | + | |
16131 | +u8 read_nic_byte(struct net_device *dev, int x) | |
16132 | +{ | |
16133 | + return 0xff&readb((u8*)dev->mem_start +x); | |
16134 | +} | |
16135 | + | |
16136 | +u32 read_nic_dword(struct net_device *dev, int x) | |
16137 | +{ | |
16138 | + return readl((u8*)dev->mem_start +x); | |
16139 | +} | |
16140 | + | |
16141 | +u16 read_nic_word(struct net_device *dev, int x) | |
16142 | +{ | |
16143 | + return readw((u8*)dev->mem_start +x); | |
16144 | +} | |
16145 | + | |
16146 | +void write_nic_byte(struct net_device *dev, int x,u8 y) | |
16147 | +{ | |
16148 | + writeb(y,(u8*)dev->mem_start +x); | |
16149 | + udelay(20); | |
16150 | +} | |
16151 | + | |
16152 | +void write_nic_dword(struct net_device *dev, int x,u32 y) | |
16153 | +{ | |
16154 | + writel(y,(u8*)dev->mem_start +x); | |
16155 | + udelay(20); | |
16156 | +} | |
16157 | + | |
16158 | +void write_nic_word(struct net_device *dev, int x,u16 y) | |
16159 | +{ | |
16160 | + writew(y,(u8*)dev->mem_start +x); | |
16161 | + udelay(20); | |
16162 | +} | |
16163 | + | |
16164 | +#endif /* RTL_IO_MAP */ | |
16165 | + | |
16166 | + | |
16167 | + | |
16168 | + | |
16169 | + | |
16170 | +inline void force_pci_posting(struct net_device *dev) | |
16171 | +{ | |
16172 | + read_nic_byte(dev,EPROM_CMD); | |
16173 | +#ifndef CONFIG_RTL8180_IO_MAP | |
16174 | + mb(); | |
16175 | +#endif | |
16176 | +} | |
16177 | + | |
16178 | + | |
16179 | +irqreturn_t rtl8180_interrupt(int irq, void *netdev, struct pt_regs *regs); | |
16180 | +void set_nic_rxring(struct net_device *dev); | |
16181 | +void set_nic_txring(struct net_device *dev); | |
16182 | +static struct net_device_stats *rtl8180_stats(struct net_device *dev); | |
16183 | +void rtl8180_commit(struct net_device *dev); | |
16184 | +void rtl8180_start_tx_beacon(struct net_device *dev); | |
16185 | + | |
16186 | +/**************************************************************************** | |
16187 | + -----------------------------PROCFS STUFF------------------------- | |
16188 | +*****************************************************************************/ | |
16189 | + | |
16190 | +static struct proc_dir_entry *rtl8180_proc = NULL; | |
16191 | + | |
16192 | +static int proc_get_registers(char *page, char **start, | |
16193 | + off_t offset, int count, | |
16194 | + int *eof, void *data) | |
16195 | +{ | |
16196 | + struct net_device *dev = data; | |
16197 | +// struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
16198 | + | |
16199 | + int len = 0; | |
16200 | + int i,n; | |
16201 | + | |
16202 | + int max=0xff; | |
16203 | + | |
16204 | + /* This dump the current register page */ | |
16205 | + for(n=0;n<=max;) | |
16206 | + { | |
16207 | + //printk( "\nD: %2x> ", n); | |
16208 | + len += snprintf(page + len, count - len, | |
16209 | + "\nD: %2x > ",n); | |
16210 | + | |
16211 | + for(i=0;i<16 && n<=max;i++,n++) | |
16212 | + len += snprintf(page + len, count - len, | |
16213 | + "%2x ",read_nic_byte(dev,n)); | |
16214 | + | |
16215 | + // printk("%2x ",read_nic_byte(dev,n)); | |
16216 | + } | |
16217 | + len += snprintf(page + len, count - len,"\n"); | |
16218 | + | |
16219 | + | |
16220 | + | |
16221 | + *eof = 1; | |
16222 | + return len; | |
16223 | + | |
16224 | +} | |
16225 | + | |
16226 | +int get_curr_tx_free_desc(struct net_device *dev, int priority); | |
16227 | + | |
16228 | +static int proc_get_stats_hw(char *page, char **start, | |
16229 | + off_t offset, int count, | |
16230 | + int *eof, void *data) | |
16231 | +{ | |
16232 | + //struct net_device *dev = data; | |
16233 | + //struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
16234 | + | |
16235 | + int len = 0; | |
16236 | +#ifdef CONFIG_RTL8185B | |
16237 | + | |
16238 | +#else | |
16239 | + len += snprintf(page + len, count - len, | |
16240 | + "NIC int: %lu\n" | |
16241 | + "Total int: %lu\n" | |
16242 | + "--------------------\n" | |
16243 | + "LP avail desc %d\n" | |
16244 | + "NP avail desc %d\n" | |
16245 | + "--------------------\n" | |
16246 | + "LP phys dma addr %x\n" | |
16247 | + "LP NIC ptr %x\n" | |
16248 | + "LP virt 32base %x\n" | |
16249 | + "LP virt 32tail %x\n" | |
16250 | + "--------------------\n" | |
16251 | + "NP phys dma addr %x\n" | |
16252 | + "NP NIC ptr %x\n" | |
16253 | + "NP virt 32base %x\n" | |
16254 | + "NP virt 32tail %x\n" | |
16255 | + "--------------------\n" | |
16256 | + "BP phys dma addr %x\n" | |
16257 | + "BP NIC ptr %x\n" | |
16258 | + "BP virt 32base %x\n" | |
16259 | + "BP virt 32tail %x\n", | |
16260 | + priv->stats.ints, | |
16261 | + priv->stats.shints, | |
16262 | + get_curr_tx_free_desc(dev,LOW_PRIORITY), | |
16263 | + get_curr_tx_free_desc(dev,NORM_PRIORITY), | |
16264 | + (u32)priv->txvipringdma, | |
16265 | + read_nic_dword(dev,TLPDA), | |
16266 | + (u32)priv->txvipring, | |
16267 | + (u32)priv->txvipringtail, | |
16268 | + (u32)priv->txvopringdma, | |
16269 | + read_nic_dword(dev,TNPDA), | |
16270 | + (u32)priv->txvopring, | |
16271 | + (u32)priv->txvopringtail, | |
16272 | + (u32)priv->txbeaconringdma, | |
16273 | + read_nic_dword(dev,TBDA), | |
16274 | + (u32)priv->txbeaconring, | |
16275 | + (u32)priv->txbeaconringtail); | |
16276 | +#endif | |
16277 | + *eof = 1; | |
16278 | + return len; | |
16279 | +} | |
16280 | + | |
16281 | + | |
16282 | +static int proc_get_stats_rx(char *page, char **start, | |
16283 | + off_t offset, int count, | |
16284 | + int *eof, void *data) | |
16285 | +{ | |
16286 | + struct net_device *dev = data; | |
16287 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
16288 | + | |
16289 | + int len = 0; | |
16290 | + | |
16291 | + len += snprintf(page + len, count - len, | |
16292 | + /* "RX descriptor not available: %lu\n" | |
16293 | + "RX incomplete (missing last descriptor): %lu\n" | |
16294 | + "RX not data: %lu\n" | |
16295 | + //"RX descriptor pointer reset: %lu\n" | |
16296 | + "RX descriptor pointer lost: %lu\n" | |
16297 | + //"RX pointer workaround: %lu\n" | |
16298 | + "RX error int: %lu\n" | |
16299 | + "RX fifo overflow: %lu\n" | |
16300 | + "RX int: %lu\n" | |
16301 | + "RX packet: %lu\n" | |
16302 | + "RX bytes: %lu\n" | |
16303 | + "RX DMA fail: %lu\n", | |
16304 | + priv->stats.rxrdu, | |
16305 | + priv->stats.rxnolast, | |
16306 | + priv->stats.rxnodata, | |
16307 | + //priv->stats.rxreset, | |
16308 | + priv->stats.rxnopointer, | |
16309 | + //priv->stats.rxwrkaround, | |
16310 | + priv->stats.rxerr, | |
16311 | + priv->stats.rxoverflow, | |
16312 | + priv->stats.rxint, | |
16313 | + priv->ieee80211->stats.rx_packets, | |
16314 | + priv->ieee80211->stats.rx_bytes, | |
16315 | + priv->stats.rxdmafail */ | |
16316 | + "RX OK: %lu\n" | |
16317 | + "RX Retry: %lu\n" | |
16318 | + "RX CRC Error(0-500): %lu\n" | |
16319 | + "RX CRC Error(500-1000): %lu\n" | |
16320 | + "RX CRC Error(>1000): %lu\n" | |
16321 | + "RX ICV Error: %lu\n", | |
16322 | + priv->stats.rxint, | |
16323 | + priv->stats.rxerr, | |
16324 | + priv->stats.rxcrcerrmin, | |
16325 | + priv->stats.rxcrcerrmid, | |
16326 | + priv->stats.rxcrcerrmax, | |
16327 | + priv->stats.rxicverr | |
16328 | + ); | |
16329 | + | |
16330 | + *eof = 1; | |
16331 | + return len; | |
16332 | +} | |
16333 | + | |
16334 | +#if 0 | |
16335 | +static int proc_get_stats_ieee(char *page, char **start, | |
16336 | + off_t offset, int count, | |
16337 | + int *eof, void *data) | |
16338 | +{ | |
16339 | + struct net_device *dev = data; | |
16340 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
16341 | + | |
16342 | + int len = 0; | |
16343 | + | |
16344 | + len += snprintf(page + len, count - len, | |
16345 | + "TXed association requests: %u\n" | |
16346 | + "TXed authentication requests: %u\n" | |
16347 | + "RXed successful association response: %u\n" | |
16348 | + "RXed failed association response: %u\n" | |
16349 | + "RXed successful authentication response: %u\n" | |
16350 | + "RXed failed authentication response: %u\n" | |
16351 | + "Association requests without response: %u\n" | |
16352 | + "Authentication requests without response: %u\n" | |
16353 | + "TX probe response: %u\n" | |
16354 | + "RX probe request: %u\n" | |
16355 | + "TX probe request: %lu\n" | |
16356 | + "RX authentication requests: %lu\n" | |
16357 | + "RX association requests: %lu\n" | |
16358 | + "Reassociations: %lu\n", | |
16359 | + priv->ieee80211->ieee_stats.tx_ass, | |
16360 | + priv->ieee80211->ieee_stats.tx_aut, | |
16361 | + priv->ieee80211->ieee_stats.rx_ass_ok, | |
16362 | + priv->ieee80211->ieee_stats.rx_ass_err, | |
16363 | + priv->ieee80211->ieee_stats.rx_aut_ok, | |
16364 | + priv->ieee80211->ieee_stats.rx_aut_err, | |
16365 | + priv->ieee80211->ieee_stats.ass_noresp, | |
16366 | + priv->ieee80211->ieee_stats.aut_noresp, | |
16367 | + priv->ieee80211->ieee_stats.tx_probe, | |
16368 | + priv->ieee80211->ieee_stats.rx_probe, | |
16369 | + priv->ieee80211->ieee_stats.tx_probe_rq, | |
16370 | + priv->ieee80211->ieee_stats.rx_auth_rq, | |
16371 | + priv->ieee80211->ieee_stats.rx_assoc_rq, | |
16372 | + priv->ieee80211->ieee_stats.reassoc); | |
16373 | + | |
16374 | + *eof = 1; | |
16375 | + return len; | |
16376 | +} | |
16377 | +#endif | |
16378 | +#if 0 | |
16379 | +static int proc_get_stats_ap(char *page, char **start, | |
16380 | + off_t offset, int count, | |
16381 | + int *eof, void *data) | |
16382 | +{ | |
16383 | + struct net_device *dev = data; | |
16384 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
16385 | + struct mac_htable_t *list; | |
16386 | + int i; | |
16387 | + int len = 0; | |
16388 | + | |
16389 | + if(priv->ieee80211->iw_mode != IW_MODE_MASTER){ | |
16390 | + len += snprintf(page + len, count - len, | |
16391 | + "Card is not acting as AP...\n" | |
16392 | + ); | |
16393 | + }else{ | |
16394 | + len += snprintf(page + len, count - len, | |
16395 | + "List of associated STA:\n" | |
16396 | + ); | |
16397 | + | |
16398 | + for(i=0;i<MAC_HTABLE_ENTRY;i++) | |
16399 | + for (list = priv->ieee80211->assoc_htable[i]; list!=NULL; list = list->next){ | |
16400 | + len += snprintf(page + len, count - len, | |
16401 | + MACSTR"\n",MAC2STR(list->adr)); | |
16402 | + } | |
16403 | + | |
16404 | + } | |
16405 | + *eof = 1; | |
16406 | + return len; | |
16407 | +} | |
16408 | +#endif | |
16409 | + | |
16410 | +static int proc_get_stats_tx(char *page, char **start, | |
16411 | + off_t offset, int count, | |
16412 | + int *eof, void *data) | |
16413 | +{ | |
16414 | + struct net_device *dev = data; | |
16415 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
16416 | + | |
16417 | + int len = 0; | |
16418 | + unsigned long totalOK; | |
16419 | + | |
16420 | + totalOK=priv->stats.txnpokint+priv->stats.txhpokint+priv->stats.txlpokint; | |
16421 | + len += snprintf(page + len, count - len, | |
16422 | + /* "TX normal priority ok int: %lu\n" | |
16423 | + "TX normal priority error int: %lu\n" | |
16424 | + "TX high priority ok int: %lu\n" | |
16425 | + "TX high priority failed error int: %lu\n" | |
16426 | + "TX low priority ok int: %lu\n" | |
16427 | + "TX low priority failed error int: %lu\n" | |
16428 | + "TX bytes: %lu\n" | |
16429 | + "TX packets: %lu\n" | |
16430 | + "TX queue resume: %lu\n" | |
16431 | + "TX queue stopped?: %d\n" | |
16432 | + "TX fifo overflow: %lu\n" | |
16433 | + //"SW TX stop: %lu\n" | |
16434 | + //"SW TX wake: %lu\n" | |
16435 | + "TX beacon: %lu\n" | |
16436 | + "TX beacon aborted: %lu\n", | |
16437 | + priv->stats.txnpokint, | |
16438 | + priv->stats.txnperr, | |
16439 | + priv->stats.txhpokint, | |
16440 | + priv->stats.txhperr, | |
16441 | + priv->stats.txlpokint, | |
16442 | + priv->stats.txlperr, | |
16443 | + priv->ieee80211->stats.tx_bytes, | |
16444 | + priv->ieee80211->stats.tx_packets, | |
16445 | + priv->stats.txresumed, | |
16446 | + netif_queue_stopped(dev), | |
16447 | + priv->stats.txoverflow, | |
16448 | + //priv->ieee80211->ieee_stats.swtxstop, | |
16449 | + //priv->ieee80211->ieee_stats.swtxawake, | |
16450 | + priv->stats.txbeacon, | |
16451 | + priv->stats.txbeaconerr */ | |
16452 | + "TX OK: %lu\n" | |
16453 | + "TX Error: %lu\n" | |
16454 | + "TX Retry: %lu\n" | |
16455 | + "TX beacon OK: %lu\n" | |
16456 | + "TX beacon error: %lu\n", | |
16457 | + totalOK, | |
16458 | + priv->stats.txnperr+priv->stats.txhperr+priv->stats.txlperr, | |
16459 | + priv->stats.txretry, | |
16460 | + priv->stats.txbeacon, | |
16461 | + priv->stats.txbeaconerr | |
16462 | + ); | |
16463 | + | |
16464 | + *eof = 1; | |
16465 | + return len; | |
16466 | +} | |
16467 | + | |
16468 | + | |
16469 | +#if WIRELESS_EXT < 17 | |
16470 | +static struct iw_statistics *r8180_get_wireless_stats(struct net_device *dev) | |
16471 | +{ | |
16472 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
16473 | + | |
16474 | + return &priv->wstats; | |
16475 | +} | |
16476 | +#endif | |
16477 | +void rtl8180_proc_module_init(void) | |
16478 | +{ | |
16479 | + DMESG("Initializing proc filesystem"); | |
16480 | +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24) | |
16481 | + rtl8180_proc=create_proc_entry(RTL8180_MODULE_NAME, S_IFDIR, proc_net); | |
16482 | +#else | |
16483 | + rtl8180_proc=create_proc_entry(RTL8180_MODULE_NAME, S_IFDIR, init_net.proc_net); | |
16484 | +#endif | |
16485 | +} | |
16486 | + | |
16487 | + | |
16488 | +void rtl8180_proc_module_remove(void) | |
16489 | +{ | |
16490 | +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24) | |
16491 | + remove_proc_entry(RTL8180_MODULE_NAME, proc_net); | |
16492 | +#else | |
16493 | + remove_proc_entry(RTL8180_MODULE_NAME, init_net.proc_net); | |
16494 | +#endif | |
16495 | +} | |
16496 | + | |
16497 | + | |
16498 | +void rtl8180_proc_remove_one(struct net_device *dev) | |
16499 | +{ | |
16500 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
16501 | + if (priv->dir_dev) { | |
16502 | + remove_proc_entry("stats-hw", priv->dir_dev); | |
16503 | + remove_proc_entry("stats-tx", priv->dir_dev); | |
16504 | + remove_proc_entry("stats-rx", priv->dir_dev); | |
16505 | +// remove_proc_entry("stats-ieee", priv->dir_dev); | |
16506 | +// remove_proc_entry("stats-ap", priv->dir_dev); | |
16507 | + remove_proc_entry("registers", priv->dir_dev); | |
16508 | + remove_proc_entry(dev->name, rtl8180_proc); | |
16509 | + priv->dir_dev = NULL; | |
16510 | + } | |
16511 | +} | |
16512 | + | |
16513 | + | |
16514 | +void rtl8180_proc_init_one(struct net_device *dev) | |
16515 | +{ | |
16516 | + struct proc_dir_entry *e; | |
16517 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
16518 | + priv->dir_dev = create_proc_entry(dev->name, | |
16519 | + S_IFDIR | S_IRUGO | S_IXUGO, | |
16520 | + rtl8180_proc); | |
16521 | + if (!priv->dir_dev) { | |
16522 | + DMESGE("Unable to initialize /proc/net/rtl8180/%s\n", | |
16523 | + dev->name); | |
16524 | + return; | |
16525 | + } | |
16526 | + | |
16527 | + e = create_proc_read_entry("stats-hw", S_IFREG | S_IRUGO, | |
16528 | + priv->dir_dev, proc_get_stats_hw, dev); | |
16529 | + | |
16530 | + if (!e) { | |
16531 | + DMESGE("Unable to initialize " | |
16532 | + "/proc/net/rtl8180/%s/stats-hw\n", | |
16533 | + dev->name); | |
16534 | + } | |
16535 | + | |
16536 | + e = create_proc_read_entry("stats-rx", S_IFREG | S_IRUGO, | |
16537 | + priv->dir_dev, proc_get_stats_rx, dev); | |
16538 | + | |
16539 | + if (!e) { | |
16540 | + DMESGE("Unable to initialize " | |
16541 | + "/proc/net/rtl8180/%s/stats-rx\n", | |
16542 | + dev->name); | |
16543 | + } | |
16544 | + | |
16545 | + | |
16546 | + e = create_proc_read_entry("stats-tx", S_IFREG | S_IRUGO, | |
16547 | + priv->dir_dev, proc_get_stats_tx, dev); | |
16548 | + | |
16549 | + if (!e) { | |
16550 | + DMESGE("Unable to initialize " | |
16551 | + "/proc/net/rtl8180/%s/stats-tx\n", | |
16552 | + dev->name); | |
16553 | + } | |
16554 | + #if 0 | |
16555 | + e = create_proc_read_entry("stats-ieee", S_IFREG | S_IRUGO, | |
16556 | + priv->dir_dev, proc_get_stats_ieee, dev); | |
16557 | + | |
16558 | + if (!e) { | |
16559 | + DMESGE("Unable to initialize " | |
16560 | + "/proc/net/rtl8180/%s/stats-ieee\n", | |
16561 | + dev->name); | |
16562 | + } | |
16563 | + #endif | |
16564 | + #if 0 | |
16565 | + e = create_proc_read_entry("stats-ap", S_IFREG | S_IRUGO, | |
16566 | + priv->dir_dev, proc_get_stats_ap, dev); | |
16567 | + | |
16568 | + if (!e) { | |
16569 | + DMESGE("Unable to initialize " | |
16570 | + "/proc/net/rtl8180/%s/stats-ap\n", | |
16571 | + dev->name); | |
16572 | + } | |
16573 | + #endif | |
16574 | + | |
16575 | + e = create_proc_read_entry("registers", S_IFREG | S_IRUGO, | |
16576 | + priv->dir_dev, proc_get_registers, dev); | |
16577 | + | |
16578 | + if (!e) { | |
16579 | + DMESGE("Unable to initialize " | |
16580 | + "/proc/net/rtl8180/%s/registers\n", | |
16581 | + dev->name); | |
16582 | + } | |
16583 | +} | |
16584 | +/**************************************************************************** | |
16585 | + -----------------------------MISC STUFF------------------------- | |
16586 | +*****************************************************************************/ | |
16587 | +/* | |
16588 | + FIXME: check if we can use some standard already-existent | |
16589 | + data type+functions in kernel | |
16590 | +*/ | |
16591 | + | |
16592 | +short buffer_add(struct buffer **buffer, u32 *buf, dma_addr_t dma, | |
16593 | + struct buffer **bufferhead) | |
16594 | +{ | |
16595 | +#ifdef DEBUG_RING | |
16596 | + DMESG("adding buffer to TX/RX struct"); | |
16597 | +#endif | |
16598 | + | |
16599 | + struct buffer *tmp; | |
16600 | + | |
16601 | + if(! *buffer){ | |
16602 | + | |
16603 | + *buffer = kmalloc(sizeof(struct buffer),GFP_KERNEL); | |
16604 | + | |
16605 | + if (*buffer == NULL) { | |
16606 | + DMESGE("Failed to kmalloc head of TX/RX struct"); | |
16607 | + return -1; | |
16608 | + } | |
16609 | + (*buffer)->next=*buffer; | |
16610 | + (*buffer)->buf=buf; | |
16611 | + (*buffer)->dma=dma; | |
16612 | + if(bufferhead !=NULL) | |
16613 | + (*bufferhead) = (*buffer); | |
16614 | + return 0; | |
16615 | + } | |
16616 | + tmp=*buffer; | |
16617 | + | |
16618 | + while(tmp->next!=(*buffer)) tmp=tmp->next; | |
16619 | + if ((tmp->next= kmalloc(sizeof(struct buffer),GFP_KERNEL)) == NULL){ | |
16620 | + DMESGE("Failed to kmalloc TX/RX struct"); | |
16621 | + return -1; | |
16622 | + } | |
16623 | + tmp->next->buf=buf; | |
16624 | + tmp->next->dma=dma; | |
16625 | + tmp->next->next=*buffer; | |
16626 | + | |
16627 | + return 0; | |
16628 | +} | |
16629 | + | |
16630 | + | |
16631 | +void buffer_free(struct net_device *dev,struct buffer **buffer,int len,short | |
16632 | +consistent) | |
16633 | +{ | |
16634 | + | |
16635 | + struct buffer *tmp,*next; | |
16636 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
16637 | + struct pci_dev *pdev=priv->pdev; | |
16638 | + //int i; | |
16639 | + | |
16640 | + if(! *buffer) return; | |
16641 | + | |
16642 | + /*for(tmp=*buffer; tmp->next != *buffer; tmp=tmp->next) | |
16643 | + | |
16644 | + */ | |
16645 | + tmp=*buffer; | |
16646 | + do{ | |
16647 | + next=tmp->next; | |
16648 | + if(consistent){ | |
16649 | + pci_free_consistent(pdev,len, | |
16650 | + tmp->buf,tmp->dma); | |
16651 | + }else{ | |
16652 | + pci_unmap_single(pdev, tmp->dma, | |
16653 | + len,PCI_DMA_FROMDEVICE); | |
16654 | + kfree(tmp->buf); | |
16655 | + } | |
16656 | + kfree(tmp); | |
16657 | + tmp = next; | |
16658 | + } | |
16659 | + while(next != *buffer); | |
16660 | + | |
16661 | + *buffer=NULL; | |
16662 | +} | |
16663 | + | |
16664 | + | |
16665 | +void print_buffer(u32 *buffer, int len) | |
16666 | +{ | |
16667 | + int i; | |
16668 | + u8 *buf =(u8*)buffer; | |
16669 | + | |
16670 | + printk("ASCII BUFFER DUMP (len: %x):\n",len); | |
16671 | + | |
16672 | + for(i=0;i<len;i++) | |
16673 | + printk("%c",buf[i]); | |
16674 | + | |
16675 | + printk("\nBINARY BUFFER DUMP (len: %x):\n",len); | |
16676 | + | |
16677 | + for(i=0;i<len;i++) | |
16678 | + printk("%02x",buf[i]); | |
16679 | + | |
16680 | + printk("\n"); | |
16681 | +} | |
16682 | + | |
16683 | + | |
16684 | +int get_curr_tx_free_desc(struct net_device *dev, int priority) | |
16685 | +{ | |
16686 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
16687 | + u32* tail; | |
16688 | + u32* head; | |
16689 | + int ret; | |
16690 | + | |
16691 | + switch (priority){ | |
16692 | + case MANAGE_PRIORITY: | |
16693 | + head = priv->txmapringhead; | |
16694 | + tail = priv->txmapringtail; | |
16695 | + break; | |
16696 | + case BK_PRIORITY: | |
16697 | + head = priv->txbkpringhead; | |
16698 | + tail = priv->txbkpringtail; | |
16699 | + break; | |
16700 | + case BE_PRIORITY: | |
16701 | + head = priv->txbepringhead; | |
16702 | + tail = priv->txbepringtail; | |
16703 | + break; | |
16704 | + case VI_PRIORITY: | |
16705 | + head = priv->txvipringhead; | |
16706 | + tail = priv->txvipringtail; | |
16707 | + break; | |
16708 | + case VO_PRIORITY: | |
16709 | + head = priv->txvopringhead; | |
16710 | + tail = priv->txvopringtail; | |
16711 | + break; | |
16712 | + case HI_PRIORITY: | |
16713 | + head = priv->txhpringhead; | |
16714 | + tail = priv->txhpringtail; | |
16715 | + break; | |
16716 | + default: | |
16717 | + return -1; | |
16718 | + } | |
16719 | + | |
16720 | + //DMESG("%x %x", head, tail); | |
16721 | + | |
16722 | + /* FIXME FIXME FIXME FIXME */ | |
16723 | + | |
16724 | +#if 0 | |
16725 | + if( head <= tail ) return priv->txringcount-1 - (tail - head)/8; | |
16726 | + return (head - tail)/8/4; | |
16727 | +#else | |
16728 | + if( head <= tail ) | |
16729 | + ret = priv->txringcount - (tail - head)/8; | |
16730 | + else | |
16731 | + ret = (head - tail)/8; | |
16732 | + | |
16733 | + if(ret > priv->txringcount ) DMESG("BUG"); | |
16734 | + return ret; | |
16735 | +#endif | |
16736 | +} | |
16737 | + | |
16738 | + | |
16739 | +short check_nic_enought_desc(struct net_device *dev, int priority) | |
16740 | +{ | |
16741 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
16742 | + struct ieee80211_device *ieee = netdev_priv(dev); | |
16743 | + | |
16744 | + int requiredbyte, required; | |
16745 | + requiredbyte = priv->ieee80211->fts + sizeof(struct ieee80211_header_data); | |
16746 | + | |
16747 | + if(ieee->current_network.QoS_Enable) { | |
16748 | + requiredbyte += 2; | |
16749 | + }; | |
16750 | + | |
16751 | + required = requiredbyte / (priv->txbuffsize-4); | |
16752 | + if (requiredbyte % priv->txbuffsize) required++; | |
16753 | + /* for now we keep two free descriptor as a safety boundary | |
16754 | + * between the tail and the head | |
16755 | + */ | |
16756 | + | |
16757 | + return (required+2 < get_curr_tx_free_desc(dev,priority)); | |
16758 | +} | |
16759 | + | |
16760 | + | |
16761 | +/* This function is only for debuging purpose */ | |
16762 | +void check_tx_ring(struct net_device *dev, int pri) | |
16763 | +{ | |
16764 | + static int maxlog =3; | |
16765 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
16766 | + u32* tmp; | |
16767 | + struct buffer *buf; | |
16768 | + int i; | |
16769 | + int nic; | |
16770 | + u32* tail; | |
16771 | + u32* head; | |
16772 | + u32* begin; | |
16773 | + u32 nicbegin; | |
16774 | + struct buffer* buffer; | |
16775 | + | |
16776 | + maxlog --; | |
16777 | + if (maxlog <0 ) return; | |
16778 | + | |
16779 | + switch(pri) { | |
16780 | + case MANAGE_PRIORITY: | |
16781 | + tail = priv->txmapringtail; | |
16782 | + begin = priv->txmapring; | |
16783 | + head = priv->txmapringhead; | |
16784 | + nic = read_nic_dword(dev,TX_MANAGEPRIORITY_RING_ADDR); | |
16785 | + buffer = priv->txmapbufs; | |
16786 | + nicbegin = priv->txmapringdma; | |
16787 | + break; | |
16788 | + | |
16789 | + | |
16790 | + case BK_PRIORITY: | |
16791 | + tail = priv->txbkpringtail; | |
16792 | + begin = priv->txbkpring; | |
16793 | + head = priv->txbkpringhead; | |
16794 | + nic = read_nic_dword(dev,TX_BKPRIORITY_RING_ADDR); | |
16795 | + buffer = priv->txbkpbufs; | |
16796 | + nicbegin = priv->txbkpringdma; | |
16797 | + break; | |
16798 | + | |
16799 | + case BE_PRIORITY: | |
16800 | + tail = priv->txbepringtail; | |
16801 | + begin = priv->txbepring; | |
16802 | + head = priv->txbepringhead; | |
16803 | + nic = read_nic_dword(dev,TX_BEPRIORITY_RING_ADDR); | |
16804 | + buffer = priv->txbepbufs; | |
16805 | + nicbegin = priv->txbepringdma; | |
16806 | + break; | |
16807 | + | |
16808 | + case VI_PRIORITY: | |
16809 | + tail = priv->txvipringtail; | |
16810 | + begin = priv->txvipring; | |
16811 | + head = priv->txvipringhead; | |
16812 | + nic = read_nic_dword(dev,TX_VIPRIORITY_RING_ADDR); | |
16813 | + buffer = priv->txvipbufs; | |
16814 | + nicbegin = priv->txvipringdma; | |
16815 | + break; | |
16816 | + | |
16817 | + | |
16818 | + case VO_PRIORITY: | |
16819 | + tail = priv->txvopringtail; | |
16820 | + begin = priv->txvopring; | |
16821 | + head = priv->txvopringhead; | |
16822 | + nic = read_nic_dword(dev,TX_VOPRIORITY_RING_ADDR); | |
16823 | + buffer = priv->txvopbufs; | |
16824 | + nicbegin = priv->txvopringdma; | |
16825 | + break; | |
16826 | + | |
16827 | + case HI_PRIORITY: | |
16828 | + tail = priv->txhpringtail; | |
16829 | + begin = priv->txhpring; | |
16830 | + head = priv->txhpringhead; | |
16831 | + nic = read_nic_dword(dev,TX_HIGHPRIORITY_RING_ADDR); | |
16832 | + buffer = priv->txhpbufs; | |
16833 | + nicbegin = priv->txhpringdma; | |
16834 | + break; | |
16835 | + | |
16836 | + default: | |
16837 | + return ; | |
16838 | + break; | |
16839 | + } | |
16840 | + | |
16841 | + if(!priv->txvopbufs) | |
16842 | + DMESGE ("NIC TX ack, but TX queue corrupted!"); | |
16843 | + else{ | |
16844 | + | |
16845 | + for(i=0,buf=buffer, tmp=begin; | |
16846 | + tmp<begin+(priv->txringcount)*8; | |
16847 | + tmp+=8,buf=buf->next,i++) | |
16848 | + | |
16849 | + DMESG("BUF%d %s %x %s. Next : %x",i, | |
16850 | + *tmp & (1<<31) ? "filled" : "empty", | |
16851 | + *(buf->buf), | |
16852 | + *tmp & (1<<15)? "ok": "err", *(tmp+4)); | |
16853 | + } | |
16854 | + | |
16855 | + DMESG("nic at %d", | |
16856 | + (nic-nicbegin) / 8 /4); | |
16857 | + DMESG("tail at %d", ((int)tail - (int)begin) /8 /4); | |
16858 | + DMESG("head at %d", ((int)head - (int)begin) /8 /4); | |
16859 | + DMESG("check free desc returns %d", check_nic_enought_desc(dev,pri)); | |
16860 | + DMESG("free desc is %d\n", get_curr_tx_free_desc(dev,pri)); | |
16861 | + //rtl8180_reset(dev); | |
16862 | + return; | |
16863 | +} | |
16864 | + | |
16865 | + | |
16866 | + | |
16867 | +/* this function is only for debugging purpose */ | |
16868 | +void check_rxbuf(struct net_device *dev) | |
16869 | +{ | |
16870 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
16871 | + u32* tmp; | |
16872 | + struct buffer *buf; | |
16873 | + u8 rx_desc_size; | |
16874 | + | |
16875 | +#ifdef CONFIG_RTL8185B | |
16876 | + rx_desc_size = 8; | |
16877 | +#else | |
16878 | + rx_desc_size = 4; | |
16879 | +#endif | |
16880 | + | |
16881 | + if(!priv->rxbuffer) | |
16882 | + DMESGE ("NIC RX ack, but RX queue corrupted!"); | |
16883 | + | |
16884 | + else{ | |
16885 | + | |
16886 | + for(buf=priv->rxbuffer, tmp=priv->rxring; | |
16887 | + tmp < priv->rxring+(priv->rxringcount)*rx_desc_size; | |
16888 | + tmp+=rx_desc_size, buf=buf->next) | |
16889 | + | |
16890 | + DMESG("BUF %s %x", | |
16891 | + *tmp & (1<<31) ? "empty" : "filled", | |
16892 | + *(buf->buf)); | |
16893 | + } | |
16894 | + | |
16895 | + return; | |
16896 | +} | |
16897 | + | |
16898 | + | |
16899 | +void dump_eprom(struct net_device *dev) | |
16900 | +{ | |
16901 | + int i; | |
16902 | + for(i=0; i<63; i++) | |
16903 | + DMESG("EEPROM addr %x : %x", i, eprom_read(dev,i)); | |
16904 | +} | |
16905 | + | |
16906 | + | |
16907 | +void rtl8180_dump_reg(struct net_device *dev) | |
16908 | +{ | |
16909 | + int i; | |
16910 | + int n; | |
16911 | + int max=0xff; | |
16912 | + | |
16913 | + DMESG("Dumping NIC register map"); | |
16914 | + | |
16915 | + for(n=0;n<=max;) | |
16916 | + { | |
16917 | + printk( "\nD: %2x> ", n); | |
16918 | + for(i=0;i<16 && n<=max;i++,n++) | |
16919 | + printk("%2x ",read_nic_byte(dev,n)); | |
16920 | + } | |
16921 | + printk("\n"); | |
16922 | +} | |
16923 | + | |
16924 | + | |
16925 | +void fix_tx_fifo(struct net_device *dev) | |
16926 | +{ | |
16927 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
16928 | + u32 *tmp; | |
16929 | + int i; | |
16930 | +#ifdef DEBUG_TX_ALLOC | |
16931 | + DMESG("FIXING TX FIFOs"); | |
16932 | +#endif | |
16933 | + for (tmp=priv->txmapring, i=0; | |
16934 | + i < priv->txringcount; | |
16935 | + tmp+=8, i++){ | |
16936 | + *tmp = *tmp &~ (1<<31); | |
16937 | + } | |
16938 | + | |
16939 | + for (tmp=priv->txbkpring, i=0; | |
16940 | + i < priv->txringcount; | |
16941 | + tmp+=8, i++) { | |
16942 | + *tmp = *tmp &~ (1<<31); | |
16943 | + } | |
16944 | + | |
16945 | + for (tmp=priv->txbepring, i=0; | |
16946 | + i < priv->txringcount; | |
16947 | + tmp+=8, i++){ | |
16948 | + *tmp = *tmp &~ (1<<31); | |
16949 | + } | |
16950 | + for (tmp=priv->txvipring, i=0; | |
16951 | + i < priv->txringcount; | |
16952 | + tmp+=8, i++) { | |
16953 | + *tmp = *tmp &~ (1<<31); | |
16954 | + } | |
16955 | + | |
16956 | + for (tmp=priv->txvopring, i=0; | |
16957 | + i < priv->txringcount; | |
16958 | + tmp+=8, i++){ | |
16959 | + *tmp = *tmp &~ (1<<31); | |
16960 | + } | |
16961 | + | |
16962 | + for (tmp=priv->txhpring, i=0; | |
16963 | + i < priv->txringcount; | |
16964 | + tmp+=8,i++){ | |
16965 | + *tmp = *tmp &~ (1<<31); | |
16966 | + } | |
16967 | + | |
16968 | + for (tmp=priv->txbeaconring, i=0; | |
16969 | + i < priv->txbeaconcount; | |
16970 | + tmp+=8, i++){ | |
16971 | + *tmp = *tmp &~ (1<<31); | |
16972 | + } | |
16973 | +#ifdef DEBUG_TX_ALLOC | |
16974 | + DMESG("TX FIFOs FIXED"); | |
16975 | +#endif | |
16976 | + priv->txmapringtail = priv->txmapring; | |
16977 | + priv->txmapringhead = priv->txmapring; | |
16978 | + priv->txmapbufstail = priv->txmapbufs; | |
16979 | + | |
16980 | + priv->txbkpringtail = priv->txbkpring; | |
16981 | + priv->txbkpringhead = priv->txbkpring; | |
16982 | + priv->txbkpbufstail = priv->txbkpbufs; | |
16983 | + | |
16984 | + priv->txbepringtail = priv->txbepring; | |
16985 | + priv->txbepringhead = priv->txbepring; | |
16986 | + priv->txbepbufstail = priv->txbepbufs; | |
16987 | + | |
16988 | + priv->txvipringtail = priv->txvipring; | |
16989 | + priv->txvipringhead = priv->txvipring; | |
16990 | + priv->txvipbufstail = priv->txvipbufs; | |
16991 | + | |
16992 | + priv->txvopringtail = priv->txvopring; | |
16993 | + priv->txvopringhead = priv->txvopring; | |
16994 | + priv->txvopbufstail = priv->txvopbufs; | |
16995 | + | |
16996 | + priv->txhpringtail = priv->txhpring; | |
16997 | + priv->txhpringhead = priv->txhpring; | |
16998 | + priv->txhpbufstail = priv->txhpbufs; | |
16999 | + | |
17000 | + priv->txbeaconringtail = priv->txbeaconring; | |
17001 | + priv->txbeaconbufstail = priv->txbeaconbufs; | |
17002 | + set_nic_txring(dev); | |
17003 | + | |
17004 | + ieee80211_reset_queue(priv->ieee80211); | |
17005 | + priv->ack_tx_to_ieee = 0; | |
17006 | +} | |
17007 | + | |
17008 | + | |
17009 | +void fix_rx_fifo(struct net_device *dev) | |
17010 | +{ | |
17011 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17012 | + u32 *tmp; | |
17013 | + struct buffer *rxbuf; | |
17014 | + u8 rx_desc_size; | |
17015 | + | |
17016 | +#ifdef CONFIG_RTL8185B | |
17017 | + rx_desc_size = 8; // 4*8 = 32 bytes | |
17018 | +#else | |
17019 | + rx_desc_size = 4; | |
17020 | +#endif | |
17021 | + | |
17022 | +#ifdef DEBUG_RXALLOC | |
17023 | + DMESG("FIXING RX FIFO"); | |
17024 | + check_rxbuf(dev); | |
17025 | +#endif | |
17026 | + | |
17027 | + for (tmp=priv->rxring, rxbuf=priv->rxbufferhead; | |
17028 | + (tmp < (priv->rxring)+(priv->rxringcount)*rx_desc_size); | |
17029 | + tmp+=rx_desc_size,rxbuf=rxbuf->next){ | |
17030 | + *(tmp+2) = rxbuf->dma; | |
17031 | + *tmp=*tmp &~ 0xfff; | |
17032 | + *tmp=*tmp | priv->rxbuffersize; | |
17033 | + *tmp |= (1<<31); | |
17034 | + } | |
17035 | + | |
17036 | +#ifdef DEBUG_RXALLOC | |
17037 | + DMESG("RX FIFO FIXED"); | |
17038 | + check_rxbuf(dev); | |
17039 | +#endif | |
17040 | + | |
17041 | + priv->rxringtail=priv->rxring; | |
17042 | + priv->rxbuffer=priv->rxbufferhead; | |
17043 | + priv->rx_skb_complete=1; | |
17044 | + set_nic_rxring(dev); | |
17045 | +} | |
17046 | + | |
17047 | + | |
17048 | +/**************************************************************************** | |
17049 | + ------------------------------HW STUFF--------------------------- | |
17050 | +*****************************************************************************/ | |
17051 | + | |
17052 | +unsigned char QUALITY_MAP[] = { | |
17053 | + 0x64, 0x64, 0x64, 0x63, 0x63, 0x62, 0x62, 0x61, | |
17054 | + 0x61, 0x60, 0x60, 0x5f, 0x5f, 0x5e, 0x5d, 0x5c, | |
17055 | + 0x5b, 0x5a, 0x59, 0x57, 0x56, 0x54, 0x52, 0x4f, | |
17056 | + 0x4c, 0x49, 0x45, 0x41, 0x3c, 0x37, 0x31, 0x29, | |
17057 | + 0x24, 0x22, 0x22, 0x22, 0x22, 0x22, 0x22, 0x22, | |
17058 | + 0x22, 0x22, 0x21, 0x21, 0x21, 0x21, 0x21, 0x20, | |
17059 | + 0x20, 0x20, 0x20, 0x1f, 0x1f, 0x1e, 0x1e, 0x1e, | |
17060 | + 0x1d, 0x1d, 0x1c, 0x1c, 0x1b, 0x1a, 0x19, 0x19, | |
17061 | + 0x18, 0x17, 0x16, 0x15, 0x14, 0x12, 0x11, 0x0f, | |
17062 | + 0x0e, 0x0c, 0x0a, 0x08, 0x06, 0x04, 0x01, 0x00 | |
17063 | +}; | |
17064 | + | |
17065 | +unsigned char STRENGTH_MAP[] = { | |
17066 | + 0x64, 0x64, 0x63, 0x62, 0x61, 0x60, 0x5f, 0x5e, | |
17067 | + 0x5d, 0x5c, 0x5b, 0x5a, 0x57, 0x54, 0x52, 0x50, | |
17068 | + 0x4e, 0x4c, 0x4a, 0x48, 0x46, 0x44, 0x41, 0x3f, | |
17069 | + 0x3c, 0x3a, 0x37, 0x36, 0x36, 0x1c, 0x1c, 0x1b, | |
17070 | + 0x1b, 0x1a, 0x1a, 0x19, 0x19, 0x18, 0x18, 0x17, | |
17071 | + 0x17, 0x16, 0x16, 0x15, 0x15, 0x14, 0x14, 0x13, | |
17072 | + 0x13, 0x12, 0x12, 0x11, 0x11, 0x10, 0x10, 0x0f, | |
17073 | + 0x0f, 0x0e, 0x0e, 0x0d, 0x0d, 0x0c, 0x0c, 0x0b, | |
17074 | + 0x0b, 0x0a, 0x0a, 0x09, 0x09, 0x08, 0x08, 0x07, | |
17075 | + 0x07, 0x06, 0x06, 0x05, 0x04, 0x03, 0x02, 0x00 | |
17076 | +}; | |
17077 | + | |
17078 | +void rtl8180_RSSI_calc(struct net_device *dev, u8 *rssi, u8 *qual){ | |
17079 | + //void Mlme_UpdateRssiSQ(struct net_device *dev, u8 *rssi, u8 *qual){ | |
17080 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17081 | + u32 temp; | |
17082 | + u32 temp2; | |
17083 | + u32 temp3; | |
17084 | + u32 lsb; | |
17085 | + u32 q; | |
17086 | + u32 orig_qual; | |
17087 | + u8 _rssi; | |
17088 | + | |
17089 | + q = *qual; | |
17090 | + orig_qual = *qual; | |
17091 | + _rssi = 0; // avoid gcc complains.. | |
17092 | + | |
17093 | + if (q <= 0x4e) { | |
17094 | + temp = QUALITY_MAP[q]; | |
17095 | + } else { | |
17096 | + if( q & 0x80 ) { | |
17097 | + temp = 0x32; | |
17098 | + } else { | |
17099 | + temp = 1; | |
17100 | + } | |
17101 | + } | |
17102 | + | |
17103 | + *qual = temp; | |
17104 | + temp2 = *rssi; | |
17105 | + | |
17106 | + switch(priv->rf_chip){ | |
17107 | + case RFCHIPID_RFMD: | |
17108 | + lsb = temp2 & 1; | |
17109 | + temp2 &= 0x7e; | |
17110 | + if ( !lsb || !(temp2 <= 0x3c) ) { | |
17111 | + temp2 = 0x64; | |
17112 | + } else { | |
17113 | + temp2 = 100 * temp2 / 0x3c; | |
17114 | + } | |
17115 | + *rssi = temp2 & 0xff; | |
17116 | + _rssi = temp2 & 0xff; | |
17117 | + break; | |
17118 | + case RFCHIPID_INTERSIL: | |
17119 | + lsb = temp2; | |
17120 | + temp2 &= 0xfffffffe; | |
17121 | + temp2 *= 251; | |
17122 | + temp3 = temp2; | |
17123 | + temp2 <<= 6; | |
17124 | + temp3 += temp2; | |
17125 | + temp3 <<= 1; | |
17126 | + temp2 = 0x4950df; | |
17127 | + temp2 -= temp3; | |
17128 | + lsb &= 1; | |
17129 | + if ( temp2 <= 0x3e0000 ) { | |
17130 | + if ( temp2 < 0xffef0000 ) | |
17131 | + temp2 = 0xffef0000; | |
17132 | + } else { | |
17133 | + temp2 = 0x3e0000; | |
17134 | + } | |
17135 | + if ( !lsb ) { | |
17136 | + temp2 -= 0xf0000; | |
17137 | + } else { | |
17138 | + temp2 += 0xf0000; | |
17139 | + } | |
17140 | + | |
17141 | + temp3 = 0x4d0000; | |
17142 | + temp3 -= temp2; | |
17143 | + temp3 *= 100; | |
17144 | + temp3 = temp3 / 0x6d; | |
17145 | + temp3 >>= 0x10; | |
17146 | + _rssi = temp3 & 0xff; | |
17147 | + *rssi = temp3 & 0xff; | |
17148 | + break; | |
17149 | + case RFCHIPID_GCT: | |
17150 | + lsb = temp2 & 1; | |
17151 | + temp2 &= 0x7e; | |
17152 | + if ( ! lsb || !(temp2 <= 0x3c) ){ | |
17153 | + temp2 = 0x64; | |
17154 | + } else { | |
17155 | + temp2 = (100 * temp2) / 0x3c; | |
17156 | + } | |
17157 | + *rssi = temp2 & 0xff; | |
17158 | + _rssi = temp2 & 0xff; | |
17159 | + break; | |
17160 | + case RFCHIPID_PHILIPS: | |
17161 | + if( orig_qual <= 0x4e ){ | |
17162 | + _rssi = STRENGTH_MAP[orig_qual]; | |
17163 | + *rssi = _rssi; | |
17164 | + } else { | |
17165 | + orig_qual -= 0x80; | |
17166 | + if ( !orig_qual ){ | |
17167 | + _rssi = 1; | |
17168 | + *rssi = 1; | |
17169 | + } else { | |
17170 | + _rssi = 0x32; | |
17171 | + *rssi = 0x32; | |
17172 | + } | |
17173 | + } | |
17174 | + break; | |
17175 | + | |
17176 | + /* case 4 */ | |
17177 | + case RFCHIPID_MAXIM: | |
17178 | + lsb = temp2 & 1; | |
17179 | + temp2 &= 0x7e; | |
17180 | + temp2 >>= 1; | |
17181 | + temp2 += 0x42; | |
17182 | + if( lsb != 0 ){ | |
17183 | + temp2 += 0xa; | |
17184 | + } | |
17185 | + *rssi = temp2 & 0xff; | |
17186 | + _rssi = temp2 & 0xff; | |
17187 | + break; | |
17188 | + } | |
17189 | + | |
17190 | + if ( _rssi < 0x64 ){ | |
17191 | + if ( _rssi == 0 ) { | |
17192 | + *rssi = 1; | |
17193 | + } | |
17194 | + } else { | |
17195 | + *rssi = 0x64; | |
17196 | + } | |
17197 | + | |
17198 | + return; | |
17199 | +} | |
17200 | + | |
17201 | + | |
17202 | +void rtl8180_irq_enable(struct net_device *dev) | |
17203 | +{ | |
17204 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17205 | + priv->irq_enabled = 1; | |
17206 | +/* | |
17207 | + write_nic_word(dev,INTA_MASK,INTA_RXOK | INTA_RXDESCERR | INTA_RXOVERFLOW |\ | |
17208 | + INTA_TXOVERFLOW | INTA_HIPRIORITYDESCERR | INTA_HIPRIORITYDESCOK |\ | |
17209 | + INTA_NORMPRIORITYDESCERR | INTA_NORMPRIORITYDESCOK |\ | |
17210 | + INTA_LOWPRIORITYDESCERR | INTA_LOWPRIORITYDESCOK | INTA_TIMEOUT); | |
17211 | +*/ | |
17212 | + write_nic_word(dev,INTA_MASK, priv->irq_mask); | |
17213 | +} | |
17214 | + | |
17215 | + | |
17216 | +void rtl8180_irq_disable(struct net_device *dev) | |
17217 | +{ | |
17218 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17219 | + | |
17220 | +#ifdef CONFIG_RTL8185B | |
17221 | + write_nic_dword(dev,IMR,0); | |
17222 | +#else | |
17223 | + write_nic_word(dev,INTA_MASK,0); | |
17224 | +#endif | |
17225 | + force_pci_posting(dev); | |
17226 | + priv->irq_enabled = 0; | |
17227 | +} | |
17228 | + | |
17229 | + | |
17230 | +void rtl8180_set_mode(struct net_device *dev,int mode) | |
17231 | +{ | |
17232 | + u8 ecmd; | |
17233 | + ecmd=read_nic_byte(dev, EPROM_CMD); | |
17234 | + ecmd=ecmd &~ EPROM_CMD_OPERATING_MODE_MASK; | |
17235 | + ecmd=ecmd | (mode<<EPROM_CMD_OPERATING_MODE_SHIFT); | |
17236 | + ecmd=ecmd &~ (1<<EPROM_CS_SHIFT); | |
17237 | + ecmd=ecmd &~ (1<<EPROM_CK_SHIFT); | |
17238 | + write_nic_byte(dev, EPROM_CMD, ecmd); | |
17239 | +} | |
17240 | + | |
17241 | +void rtl8180_adapter_start(struct net_device *dev); | |
17242 | +void rtl8180_beacon_tx_enable(struct net_device *dev); | |
17243 | + | |
17244 | +void rtl8180_update_msr(struct net_device *dev) | |
17245 | +{ | |
17246 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
17247 | + u8 msr; | |
17248 | + u32 rxconf; | |
17249 | + | |
17250 | + msr = read_nic_byte(dev, MSR); | |
17251 | + msr &= ~ MSR_LINK_MASK; | |
17252 | + | |
17253 | + rxconf=read_nic_dword(dev,RX_CONF); | |
17254 | + | |
17255 | + if(priv->ieee80211->state == IEEE80211_LINKED) | |
17256 | + { | |
17257 | + if(priv->ieee80211->iw_mode == IW_MODE_ADHOC) | |
17258 | + msr |= (MSR_LINK_ADHOC<<MSR_LINK_SHIFT); | |
17259 | + else if (priv->ieee80211->iw_mode == IW_MODE_MASTER) | |
17260 | + msr |= (MSR_LINK_MASTER<<MSR_LINK_SHIFT); | |
17261 | + else if (priv->ieee80211->iw_mode == IW_MODE_INFRA) | |
17262 | + msr |= (MSR_LINK_MANAGED<<MSR_LINK_SHIFT); | |
17263 | + else | |
17264 | + msr |= (MSR_LINK_NONE<<MSR_LINK_SHIFT); | |
17265 | + rxconf |= (1<<RX_CHECK_BSSID_SHIFT); | |
17266 | + | |
17267 | + }else { | |
17268 | + msr |= (MSR_LINK_NONE<<MSR_LINK_SHIFT); | |
17269 | + rxconf &= ~(1<<RX_CHECK_BSSID_SHIFT); | |
17270 | + } | |
17271 | + | |
17272 | + write_nic_byte(dev, MSR, msr); | |
17273 | + write_nic_dword(dev, RX_CONF, rxconf); | |
17274 | + | |
17275 | +} | |
17276 | + | |
17277 | + | |
17278 | + | |
17279 | +void rtl8180_set_chan(struct net_device *dev,short ch) | |
17280 | +{ | |
17281 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17282 | + | |
17283 | + if((ch > 14) || (ch < 1)) | |
17284 | + { | |
17285 | + printk("In %s: Invalid chnanel %d\n", __FUNCTION__, ch); | |
17286 | + return; | |
17287 | + } | |
17288 | + | |
17289 | + priv->chan=ch; | |
17290 | + //printk("in %s:channel is %d\n",__FUNCTION__,ch); | |
17291 | + priv->rf_set_chan(dev,priv->chan); | |
17292 | + | |
17293 | +} | |
17294 | + | |
17295 | + | |
17296 | +void rtl8180_rx_enable(struct net_device *dev) | |
17297 | +{ | |
17298 | + u8 cmd; | |
17299 | + u32 rxconf; | |
17300 | + /* for now we accept data, management & ctl frame*/ | |
17301 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17302 | + | |
17303 | + rxconf=read_nic_dword(dev,RX_CONF); | |
17304 | + rxconf = rxconf &~ MAC_FILTER_MASK; | |
17305 | + rxconf = rxconf | (1<<ACCEPT_MNG_FRAME_SHIFT); | |
17306 | + rxconf = rxconf | (1<<ACCEPT_DATA_FRAME_SHIFT); | |
17307 | + rxconf = rxconf | (1<<ACCEPT_BCAST_FRAME_SHIFT); | |
17308 | + rxconf = rxconf | (1<<ACCEPT_MCAST_FRAME_SHIFT); | |
17309 | +// rxconf = rxconf | (1<<ACCEPT_CRCERR_FRAME_SHIFT); | |
17310 | + if (dev->flags & IFF_PROMISC) DMESG ("NIC in promisc mode"); | |
17311 | + | |
17312 | + if(priv->ieee80211->iw_mode == IW_MODE_MONITOR || \ | |
17313 | + dev->flags & IFF_PROMISC){ | |
17314 | + rxconf = rxconf | (1<<ACCEPT_ALLMAC_FRAME_SHIFT); | |
17315 | + }else{ | |
17316 | + rxconf = rxconf | (1<<ACCEPT_NICMAC_FRAME_SHIFT); | |
17317 | + if(priv->card_8185 == 0) | |
17318 | + rxconf = rxconf | (1<<RX_CHECK_BSSID_SHIFT); | |
17319 | + } | |
17320 | + | |
17321 | + /*if(priv->ieee80211->iw_mode == IW_MODE_MASTER){ | |
17322 | + rxconf = rxconf | (1<<ACCEPT_ALLMAC_FRAME_SHIFT); | |
17323 | + rxconf = rxconf | (1<<RX_CHECK_BSSID_SHIFT); | |
17324 | + }*/ | |
17325 | + | |
17326 | + if(priv->ieee80211->iw_mode == IW_MODE_MONITOR){ | |
17327 | + rxconf = rxconf | (1<<ACCEPT_CTL_FRAME_SHIFT); | |
17328 | + rxconf = rxconf | (1<<ACCEPT_ICVERR_FRAME_SHIFT); | |
17329 | + rxconf = rxconf | (1<<ACCEPT_PWR_FRAME_SHIFT); | |
17330 | + } | |
17331 | + | |
17332 | + if( priv->crcmon == 1 && priv->ieee80211->iw_mode == IW_MODE_MONITOR) | |
17333 | + rxconf = rxconf | (1<<ACCEPT_CRCERR_FRAME_SHIFT); | |
17334 | + | |
17335 | + //if(!priv->card_8185){ | |
17336 | + rxconf = rxconf &~ RX_FIFO_THRESHOLD_MASK; | |
17337 | + rxconf = rxconf | (RX_FIFO_THRESHOLD_NONE<<RX_FIFO_THRESHOLD_SHIFT); | |
17338 | + //} | |
17339 | + | |
17340 | + rxconf = rxconf | (1<<RX_AUTORESETPHY_SHIFT); | |
17341 | + rxconf = rxconf &~ MAX_RX_DMA_MASK; | |
17342 | + rxconf = rxconf | (MAX_RX_DMA_2048<<MAX_RX_DMA_SHIFT); | |
17343 | + | |
17344 | + //if(!priv->card_8185) | |
17345 | + rxconf = rxconf | RCR_ONLYERLPKT; | |
17346 | + | |
17347 | + rxconf = rxconf &~ RCR_CS_MASK; | |
17348 | + if(!priv->card_8185) | |
17349 | + rxconf |= (priv->rcr_csense<<RCR_CS_SHIFT); | |
17350 | +// rxconf &=~ 0xfff00000; | |
17351 | +// rxconf |= 0x90100000;//9014f76f; | |
17352 | + write_nic_dword(dev, RX_CONF, rxconf); | |
17353 | + | |
17354 | + fix_rx_fifo(dev); | |
17355 | + | |
17356 | +#ifdef DEBUG_RX | |
17357 | + DMESG("rxconf: %x %x",rxconf ,read_nic_dword(dev,RX_CONF)); | |
17358 | +#endif | |
17359 | + cmd=read_nic_byte(dev,CMD); | |
17360 | + write_nic_byte(dev,CMD,cmd | (1<<CMD_RX_ENABLE_SHIFT)); | |
17361 | + | |
17362 | + /* In rtl8139 driver seems that DMA threshold has to be written | |
17363 | + * after enabling RX, so we rewrite RX_CONFIG register | |
17364 | + */ | |
17365 | + //mdelay(100); | |
17366 | +// write_nic_dword(dev, RX_CONF, rxconf); | |
17367 | + | |
17368 | +} | |
17369 | + | |
17370 | + | |
17371 | +void set_nic_txring(struct net_device *dev) | |
17372 | +{ | |
17373 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17374 | +// DMESG("ring %x %x", priv->txlpringdma,read_nic_dword(dev,TLPDA)); | |
17375 | + | |
17376 | + write_nic_dword(dev, TX_MANAGEPRIORITY_RING_ADDR, priv->txmapringdma); | |
17377 | +// DMESG("ring %x %x", priv->txlpringdma,read_nic_dword(dev,TLPDA)); | |
17378 | + write_nic_dword(dev, TX_BKPRIORITY_RING_ADDR, priv->txbkpringdma); | |
17379 | +// DMESG("ring %x %x", priv->txlpringdma,read_nic_dword(dev,TLPDA)); | |
17380 | + write_nic_dword(dev, TX_BEPRIORITY_RING_ADDR, priv->txbepringdma); | |
17381 | +// DMESG("ring %x %x", priv->txlpringdma,read_nic_dword(dev,TLPDA)); | |
17382 | + write_nic_dword(dev, TX_VIPRIORITY_RING_ADDR, priv->txvipringdma); | |
17383 | +// DMESG("ring %x %x", priv->txlpringdma,read_nic_dword(dev,TLPDA)); | |
17384 | + write_nic_dword(dev, TX_VOPRIORITY_RING_ADDR, priv->txvopringdma); | |
17385 | +// DMESG("ring %x %x", priv->txlpringdma,read_nic_dword(dev,TLPDA)); | |
17386 | + write_nic_dword(dev, TX_HIGHPRIORITY_RING_ADDR, priv->txhpringdma); | |
17387 | +// DMESG("ring %x %x", priv->txlpringdma,read_nic_dword(dev,TLPDA)); | |
17388 | + | |
17389 | + write_nic_dword(dev, TX_BEACON_RING_ADDR, priv->txbeaconringdma); | |
17390 | +} | |
17391 | + | |
17392 | + | |
17393 | +void rtl8180_conttx_enable(struct net_device *dev) | |
17394 | +{ | |
17395 | + u32 txconf; | |
17396 | + txconf = read_nic_dword(dev,TX_CONF); | |
17397 | + txconf = txconf &~ TX_LOOPBACK_MASK; | |
17398 | + txconf = txconf | (TX_LOOPBACK_CONTINUE <<TX_LOOPBACK_SHIFT); | |
17399 | + write_nic_dword(dev,TX_CONF,txconf); | |
17400 | +} | |
17401 | + | |
17402 | + | |
17403 | +void rtl8180_conttx_disable(struct net_device *dev) | |
17404 | +{ | |
17405 | + u32 txconf; | |
17406 | + txconf = read_nic_dword(dev,TX_CONF); | |
17407 | + txconf = txconf &~ TX_LOOPBACK_MASK; | |
17408 | + txconf = txconf | (TX_LOOPBACK_NONE <<TX_LOOPBACK_SHIFT); | |
17409 | + write_nic_dword(dev,TX_CONF,txconf); | |
17410 | +} | |
17411 | + | |
17412 | + | |
17413 | +void rtl8180_tx_enable(struct net_device *dev) | |
17414 | +{ | |
17415 | + u8 cmd; | |
17416 | + u8 tx_agc_ctl; | |
17417 | + u8 byte; | |
17418 | + u32 txconf; | |
17419 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17420 | + txconf= read_nic_dword(dev,TX_CONF); | |
17421 | + | |
17422 | + | |
17423 | + if(priv->card_8185){ | |
17424 | + | |
17425 | + | |
17426 | + byte = read_nic_byte(dev,CW_CONF); | |
17427 | + byte &= ~(1<<CW_CONF_PERPACKET_CW_SHIFT); | |
17428 | + byte &= ~(1<<CW_CONF_PERPACKET_RETRY_SHIFT); | |
17429 | + write_nic_byte(dev, CW_CONF, byte); | |
17430 | + | |
17431 | + tx_agc_ctl = read_nic_byte(dev, TX_AGC_CTL); | |
17432 | + tx_agc_ctl &= ~(1<<TX_AGC_CTL_PERPACKET_GAIN_SHIFT); | |
17433 | + tx_agc_ctl &= ~(1<<TX_AGC_CTL_PERPACKET_ANTSEL_SHIFT); | |
17434 | + tx_agc_ctl |=(1<<TX_AGC_CTL_FEEDBACK_ANT); | |
17435 | + write_nic_byte(dev, TX_AGC_CTL, tx_agc_ctl); | |
17436 | + /* | |
17437 | + write_nic_word(dev, 0x5e, 0x01); | |
17438 | + force_pci_posting(dev); | |
17439 | + mdelay(1); | |
17440 | + write_nic_word(dev, 0xfe, 0x10); | |
17441 | + force_pci_posting(dev); | |
17442 | + mdelay(1); | |
17443 | + write_nic_word(dev, 0x5e, 0x00); | |
17444 | + force_pci_posting(dev); | |
17445 | + mdelay(1); | |
17446 | + */ | |
17447 | + write_nic_byte(dev, 0xec, 0x3f); /* Disable early TX */ | |
17448 | + } | |
17449 | + | |
17450 | + if(priv->card_8185){ | |
17451 | + | |
17452 | + txconf = txconf &~ (1<<TCR_PROBE_NOTIMESTAMP_SHIFT); | |
17453 | + | |
17454 | + }else{ | |
17455 | + | |
17456 | + if(hwseqnum) | |
17457 | + txconf= txconf &~ (1<<TX_CONF_HEADER_AUTOICREMENT_SHIFT); | |
17458 | + else | |
17459 | + txconf= txconf | (1<<TX_CONF_HEADER_AUTOICREMENT_SHIFT); | |
17460 | + } | |
17461 | + | |
17462 | + txconf = txconf &~ TX_LOOPBACK_MASK; | |
17463 | + txconf = txconf | (TX_LOOPBACK_NONE <<TX_LOOPBACK_SHIFT); | |
17464 | + txconf = txconf &~ TCR_DPRETRY_MASK; | |
17465 | + txconf = txconf &~ TCR_RTSRETRY_MASK; | |
17466 | + txconf = txconf | (priv->retry_data<<TX_DPRETRY_SHIFT); | |
17467 | + txconf = txconf | (priv->retry_rts<<TX_RTSRETRY_SHIFT); | |
17468 | + txconf = txconf &~ (1<<TX_NOCRC_SHIFT); | |
17469 | + | |
17470 | + if(priv->card_8185){ | |
17471 | + if(priv->hw_plcp_len) | |
17472 | + txconf = txconf &~ TCR_PLCP_LEN; | |
17473 | + else | |
17474 | + txconf = txconf | TCR_PLCP_LEN; | |
17475 | + }else{ | |
17476 | + txconf = txconf &~ TCR_SAT; | |
17477 | + } | |
17478 | + txconf = txconf &~ TCR_MXDMA_MASK; | |
17479 | + txconf = txconf | (TCR_MXDMA_2048<<TCR_MXDMA_SHIFT); | |
17480 | + txconf = txconf | TCR_CWMIN; | |
17481 | + txconf = txconf | TCR_DISCW; | |
17482 | + | |
17483 | +// if(priv->ieee80211->hw_wep) | |
17484 | +// txconf=txconf &~ (1<<TX_NOICV_SHIFT); | |
17485 | +// else | |
17486 | + txconf=txconf | (1<<TX_NOICV_SHIFT); | |
17487 | + | |
17488 | + write_nic_dword(dev,TX_CONF,txconf); | |
17489 | + | |
17490 | + | |
17491 | + fix_tx_fifo(dev); | |
17492 | + | |
17493 | +#ifdef DEBUG_TX | |
17494 | + DMESG("txconf: %x %x",txconf,read_nic_dword(dev,TX_CONF)); | |
17495 | +#endif | |
17496 | + | |
17497 | + cmd=read_nic_byte(dev,CMD); | |
17498 | + write_nic_byte(dev,CMD,cmd | (1<<CMD_TX_ENABLE_SHIFT)); | |
17499 | + | |
17500 | +// mdelay(100); | |
17501 | + write_nic_dword(dev,TX_CONF,txconf); | |
17502 | +// #endif | |
17503 | +/* | |
17504 | + rtl8180_set_mode(dev,EPROM_CMD_CONFIG); | |
17505 | + write_nic_byte(dev, TX_DMA_POLLING, priv->dma_poll_mask); | |
17506 | + rtl8180_set_mode(dev,EPROM_CMD_NORMAL); | |
17507 | + */ | |
17508 | +} | |
17509 | + | |
17510 | + | |
17511 | +void rtl8180_beacon_tx_enable(struct net_device *dev) | |
17512 | +{ | |
17513 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17514 | + | |
17515 | + rtl8180_set_mode(dev,EPROM_CMD_CONFIG); | |
17516 | +#ifdef CONFIG_RTL8185B | |
17517 | + priv->dma_poll_stop_mask &= ~(TPPOLLSTOP_BQ); | |
17518 | + write_nic_byte(dev,TPPollStop, priv->dma_poll_mask); | |
17519 | +#else | |
17520 | + priv->dma_poll_mask &=~(1<<TX_DMA_STOP_BEACON_SHIFT); | |
17521 | + write_nic_byte(dev,TX_DMA_POLLING,priv->dma_poll_mask); | |
17522 | +#endif | |
17523 | + rtl8180_set_mode(dev,EPROM_CMD_NORMAL); | |
17524 | +} | |
17525 | + | |
17526 | + | |
17527 | +void rtl8180_beacon_tx_disable(struct net_device *dev) | |
17528 | +{ | |
17529 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17530 | + | |
17531 | + rtl8180_set_mode(dev,EPROM_CMD_CONFIG); | |
17532 | +#ifdef CONFIG_RTL8185B | |
17533 | + priv->dma_poll_stop_mask |= TPPOLLSTOP_BQ; | |
17534 | + write_nic_byte(dev,TPPollStop, priv->dma_poll_stop_mask); | |
17535 | +#else | |
17536 | + priv->dma_poll_mask |= (1<<TX_DMA_STOP_BEACON_SHIFT); | |
17537 | + write_nic_byte(dev,TX_DMA_POLLING,priv->dma_poll_mask); | |
17538 | +#endif | |
17539 | + rtl8180_set_mode(dev,EPROM_CMD_NORMAL); | |
17540 | + | |
17541 | +} | |
17542 | + | |
17543 | + | |
17544 | +void rtl8180_rtx_disable(struct net_device *dev) | |
17545 | +{ | |
17546 | + u8 cmd; | |
17547 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
17548 | + | |
17549 | + cmd=read_nic_byte(dev,CMD); | |
17550 | + write_nic_byte(dev, CMD, cmd &~ \ | |
17551 | + ((1<<CMD_RX_ENABLE_SHIFT)|(1<<CMD_TX_ENABLE_SHIFT))); | |
17552 | + force_pci_posting(dev); | |
17553 | + mdelay(10); | |
17554 | + /*while (read_nic_byte(dev,CMD) & (1<<CMD_RX_ENABLE_SHIFT)) | |
17555 | + udelay(10); | |
17556 | + */ | |
17557 | + | |
17558 | + if(!priv->rx_skb_complete) | |
17559 | + dev_kfree_skb_any(priv->rx_skb); | |
17560 | +} | |
17561 | + | |
17562 | +#if 0 | |
17563 | +int alloc_tx_beacon_desc_ring(struct net_device *dev, int count) | |
17564 | +{ | |
17565 | + int i; | |
17566 | + u32 *tmp; | |
17567 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17568 | + | |
17569 | + priv->txbeaconring = (u32*)pci_alloc_consistent(priv->pdev, | |
17570 | + sizeof(u32)*8*count, | |
17571 | + &priv->txbeaconringdma); | |
17572 | + if (!priv->txbeaconring) return -1; | |
17573 | + for (tmp=priv->txbeaconring,i=0;i<count;i++){ | |
17574 | + *tmp = *tmp &~ (1<<31); // descriptor empty, owned by the drv | |
17575 | + /* | |
17576 | + *(tmp+2) = (u32)dma_tmp; | |
17577 | + *(tmp+3) = bufsize; | |
17578 | + */ | |
17579 | + if(i+1<count) | |
17580 | + *(tmp+4) = (u32)priv->txbeaconringdma+((i+1)*8*4); | |
17581 | + else | |
17582 | + *(tmp+4) = (u32)priv->txbeaconringdma; | |
17583 | + | |
17584 | + tmp=tmp+8; | |
17585 | + } | |
17586 | + return 0; | |
17587 | +} | |
17588 | +#endif | |
17589 | + | |
17590 | +short alloc_tx_desc_ring(struct net_device *dev, int bufsize, int count, | |
17591 | + int addr) | |
17592 | +{ | |
17593 | + int i; | |
17594 | + u32 *desc; | |
17595 | + u32 *tmp; | |
17596 | + dma_addr_t dma_desc, dma_tmp; | |
17597 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17598 | + struct pci_dev *pdev = priv->pdev; | |
17599 | + void *buf; | |
17600 | + | |
17601 | + if((bufsize & 0xfff) != bufsize) { | |
17602 | + DMESGE ("TX buffer allocation too large"); | |
17603 | + return 0; | |
17604 | + } | |
17605 | + desc = (u32*)pci_alloc_consistent(pdev, | |
17606 | + sizeof(u32)*8*count+256, &dma_desc); | |
17607 | + if(desc==NULL) return -1; | |
17608 | + if(dma_desc & 0xff){ | |
17609 | + | |
17610 | + /* | |
17611 | + * descriptor's buffer must be 256 byte aligned | |
17612 | + * we shouldn't be here, since we set DMA mask ! | |
17613 | + */ | |
17614 | + DMESGW("Fixing TX alignment"); | |
17615 | + desc = (u32*)((u8*)desc + 256); | |
17616 | +#if (defined(CONFIG_HIGHMEM64G) || defined(CONFIG_64BIT_PHYS_ADDR)) | |
17617 | + desc = (u32*)((u64)desc &~ 0xff); | |
17618 | + dma_desc = (dma_addr_t)((u8*)dma_desc + 256); | |
17619 | + dma_desc = (dma_addr_t)((u64)dma_desc &~ 0xff); | |
17620 | +#else | |
17621 | + desc = (u32*)((u32)desc &~ 0xff); | |
17622 | + dma_desc = (dma_addr_t)((u8*)dma_desc + 256); | |
17623 | + dma_desc = (dma_addr_t)((u32)dma_desc &~ 0xff); | |
17624 | +#endif | |
17625 | + } | |
17626 | + tmp=desc; | |
17627 | + for (i=0;i<count;i++) | |
17628 | + { | |
17629 | + buf = (void*)pci_alloc_consistent(pdev,bufsize,&dma_tmp); | |
17630 | + if (buf == NULL) return -ENOMEM; | |
17631 | + | |
17632 | + switch(addr) { | |
17633 | +#if 0 | |
17634 | + case TX_NORMPRIORITY_RING_ADDR: | |
17635 | + if(-1 == buffer_add(&(priv->txnpbufs),buf,dma_tmp,NULL)){ | |
17636 | + DMESGE("Unable to allocate mem for buffer NP"); | |
17637 | + return -ENOMEM; | |
17638 | + } | |
17639 | + break; | |
17640 | + | |
17641 | + case TX_LOWPRIORITY_RING_ADDR: | |
17642 | + if(-1 == buffer_add(&(priv->txlpbufs),buf,dma_tmp,NULL)){ | |
17643 | + DMESGE("Unable to allocate mem for buffer LP"); | |
17644 | + return -ENOMEM; | |
17645 | + } | |
17646 | + break; | |
17647 | + | |
17648 | + case TX_HIGHPRIORITY_RING_ADDR: | |
17649 | + if(-1 == buffer_add(&(priv->txhpbufs),buf,dma_tmp,NULL)){ | |
17650 | + DMESGE("Unable to allocate mem for buffer HP"); | |
17651 | + return -ENOMEM; | |
17652 | + } | |
17653 | + break; | |
17654 | +#else | |
17655 | + case TX_MANAGEPRIORITY_RING_ADDR: | |
17656 | + if(-1 == buffer_add(&(priv->txmapbufs),buf,dma_tmp,NULL)){ | |
17657 | + DMESGE("Unable to allocate mem for buffer NP"); | |
17658 | + return -ENOMEM; | |
17659 | + } | |
17660 | + break; | |
17661 | + | |
17662 | + case TX_BKPRIORITY_RING_ADDR: | |
17663 | + if(-1 == buffer_add(&(priv->txbkpbufs),buf,dma_tmp,NULL)){ | |
17664 | + DMESGE("Unable to allocate mem for buffer LP"); | |
17665 | + return -ENOMEM; | |
17666 | + } | |
17667 | + break; | |
17668 | + case TX_BEPRIORITY_RING_ADDR: | |
17669 | + if(-1 == buffer_add(&(priv->txbepbufs),buf,dma_tmp,NULL)){ | |
17670 | + DMESGE("Unable to allocate mem for buffer NP"); | |
17671 | + return -ENOMEM; | |
17672 | + } | |
17673 | + break; | |
17674 | + | |
17675 | + case TX_VIPRIORITY_RING_ADDR: | |
17676 | + if(-1 == buffer_add(&(priv->txvipbufs),buf,dma_tmp,NULL)){ | |
17677 | + DMESGE("Unable to allocate mem for buffer LP"); | |
17678 | + return -ENOMEM; | |
17679 | + } | |
17680 | + break; | |
17681 | + case TX_VOPRIORITY_RING_ADDR: | |
17682 | + if(-1 == buffer_add(&(priv->txvopbufs),buf,dma_tmp,NULL)){ | |
17683 | + DMESGE("Unable to allocate mem for buffer NP"); | |
17684 | + return -ENOMEM; | |
17685 | + } | |
17686 | + break; | |
17687 | +#endif | |
17688 | + case TX_HIGHPRIORITY_RING_ADDR: | |
17689 | + if(-1 == buffer_add(&(priv->txhpbufs),buf,dma_tmp,NULL)){ | |
17690 | + DMESGE("Unable to allocate mem for buffer HP"); | |
17691 | + return -ENOMEM; | |
17692 | + } | |
17693 | + break; | |
17694 | + case TX_BEACON_RING_ADDR: | |
17695 | + if(-1 == buffer_add(&(priv->txbeaconbufs),buf,dma_tmp,NULL)){ | |
17696 | + DMESGE("Unable to allocate mem for buffer BP"); | |
17697 | + return -ENOMEM; | |
17698 | + } | |
17699 | + break; | |
17700 | + } | |
17701 | + *tmp = *tmp &~ (1<<31); // descriptor empty, owned by the drv | |
17702 | + *(tmp+2) = (u32)dma_tmp; | |
17703 | + *(tmp+3) = bufsize; | |
17704 | + | |
17705 | + if(i+1<count) | |
17706 | + *(tmp+4) = (u32)dma_desc+((i+1)*8*4); | |
17707 | + else | |
17708 | + *(tmp+4) = (u32)dma_desc; | |
17709 | + | |
17710 | + tmp=tmp+8; | |
17711 | + } | |
17712 | + | |
17713 | + switch(addr) { | |
17714 | + case TX_MANAGEPRIORITY_RING_ADDR: | |
17715 | + priv->txmapringdma=dma_desc; | |
17716 | + priv->txmapring=desc; | |
17717 | + break; | |
17718 | + | |
17719 | + case TX_BKPRIORITY_RING_ADDR: | |
17720 | + priv->txbkpringdma=dma_desc; | |
17721 | + priv->txbkpring=desc; | |
17722 | + break; | |
17723 | + | |
17724 | + case TX_BEPRIORITY_RING_ADDR: | |
17725 | + priv->txbepringdma=dma_desc; | |
17726 | + priv->txbepring=desc; | |
17727 | + break; | |
17728 | + | |
17729 | + case TX_VIPRIORITY_RING_ADDR: | |
17730 | + priv->txvipringdma=dma_desc; | |
17731 | + priv->txvipring=desc; | |
17732 | + break; | |
17733 | + | |
17734 | + case TX_VOPRIORITY_RING_ADDR: | |
17735 | + priv->txvopringdma=dma_desc; | |
17736 | + priv->txvopring=desc; | |
17737 | + break; | |
17738 | + | |
17739 | + case TX_HIGHPRIORITY_RING_ADDR: | |
17740 | + priv->txhpringdma=dma_desc; | |
17741 | + priv->txhpring=desc; | |
17742 | + break; | |
17743 | + | |
17744 | + case TX_BEACON_RING_ADDR: | |
17745 | + priv->txbeaconringdma=dma_desc; | |
17746 | + priv->txbeaconring=desc; | |
17747 | + break; | |
17748 | + | |
17749 | + } | |
17750 | + | |
17751 | +#ifdef DEBUG_TX | |
17752 | + DMESG("Tx dma physical address: %x",dma_desc); | |
17753 | +#endif | |
17754 | + | |
17755 | + return 0; | |
17756 | +} | |
17757 | + | |
17758 | + | |
17759 | +void free_tx_desc_rings(struct net_device *dev) | |
17760 | +{ | |
17761 | + | |
17762 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17763 | + struct pci_dev *pdev=priv->pdev; | |
17764 | + int count = priv->txringcount; | |
17765 | + | |
17766 | + pci_free_consistent(pdev, sizeof(u32)*8*count+256, | |
17767 | + priv->txmapring, priv->txmapringdma); | |
17768 | + buffer_free(dev,&(priv->txmapbufs),priv->txbuffsize,1); | |
17769 | + | |
17770 | + pci_free_consistent(pdev, sizeof(u32)*8*count+256, | |
17771 | + priv->txbkpring, priv->txbkpringdma); | |
17772 | + buffer_free(dev,&(priv->txbkpbufs),priv->txbuffsize,1); | |
17773 | + | |
17774 | + pci_free_consistent(pdev, sizeof(u32)*8*count+256, | |
17775 | + priv->txbepring, priv->txbepringdma); | |
17776 | + buffer_free(dev,&(priv->txbepbufs),priv->txbuffsize,1); | |
17777 | + | |
17778 | + pci_free_consistent(pdev, sizeof(u32)*8*count+256, | |
17779 | + priv->txvipring, priv->txvipringdma); | |
17780 | + buffer_free(dev,&(priv->txvipbufs),priv->txbuffsize,1); | |
17781 | + | |
17782 | + pci_free_consistent(pdev, sizeof(u32)*8*count+256, | |
17783 | + priv->txvopring, priv->txvopringdma); | |
17784 | + buffer_free(dev,&(priv->txvopbufs),priv->txbuffsize,1); | |
17785 | + | |
17786 | + pci_free_consistent(pdev, sizeof(u32)*8*count+256, | |
17787 | + priv->txhpring, priv->txhpringdma); | |
17788 | + buffer_free(dev,&(priv->txhpbufs),priv->txbuffsize,1); | |
17789 | + | |
17790 | + count = priv->txbeaconcount; | |
17791 | + pci_free_consistent(pdev, sizeof(u32)*8*count+256, | |
17792 | + priv->txbeaconring, priv->txbeaconringdma); | |
17793 | + buffer_free(dev,&(priv->txbeaconbufs),priv->txbuffsize,1); | |
17794 | +} | |
17795 | + | |
17796 | +#if 0 | |
17797 | +void free_beacon_desc_ring(struct net_device *dev,int count) | |
17798 | +{ | |
17799 | + | |
17800 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17801 | + struct pci_dev *pdev=priv->pdev; | |
17802 | + | |
17803 | + pci_free_consistent(pdev, sizeof(u32)*8*count+256, | |
17804 | + priv->txbeaconring, priv->txbeaconringdma); | |
17805 | + | |
17806 | + if (priv->beacon_buf) | |
17807 | + pci_free_consistent(priv->pdev, | |
17808 | + priv->master_beaconsize,priv->beacon_buf,priv->beacondmabuf); | |
17809 | + | |
17810 | +} | |
17811 | +#endif | |
17812 | +void free_rx_desc_ring(struct net_device *dev) | |
17813 | +{ | |
17814 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17815 | + struct pci_dev *pdev = priv->pdev; | |
17816 | + | |
17817 | + int count = priv->rxringcount; | |
17818 | + | |
17819 | +#ifdef CONFIG_RTL8185B | |
17820 | + pci_free_consistent(pdev, sizeof(u32)*8*count+256, | |
17821 | + priv->rxring, priv->rxringdma); | |
17822 | +#else | |
17823 | + pci_free_consistent(pdev, sizeof(u32)*4*count+256, | |
17824 | + priv->rxring, priv->rxringdma); | |
17825 | +#endif | |
17826 | + | |
17827 | + buffer_free(dev,&(priv->rxbuffer),priv->rxbuffersize,0); | |
17828 | +} | |
17829 | + | |
17830 | + | |
17831 | +short alloc_rx_desc_ring(struct net_device *dev, u16 bufsize, int count) | |
17832 | +{ | |
17833 | + int i; | |
17834 | + u32 *desc; | |
17835 | + u32 *tmp; | |
17836 | + dma_addr_t dma_desc,dma_tmp; | |
17837 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17838 | + struct pci_dev *pdev=priv->pdev; | |
17839 | + void *buf; | |
17840 | + u8 rx_desc_size; | |
17841 | + | |
17842 | +#ifdef CONFIG_RTL8185B | |
17843 | + rx_desc_size = 8; // 4*8 = 32 bytes | |
17844 | +#else | |
17845 | + rx_desc_size = 4; | |
17846 | +#endif | |
17847 | + | |
17848 | + if((bufsize & 0xfff) != bufsize){ | |
17849 | + DMESGE ("RX buffer allocation too large"); | |
17850 | + return -1; | |
17851 | + } | |
17852 | + | |
17853 | + desc = (u32*)pci_alloc_consistent(pdev,sizeof(u32)*rx_desc_size*count+256, | |
17854 | + &dma_desc); | |
17855 | + | |
17856 | + if(dma_desc & 0xff){ | |
17857 | + | |
17858 | + /* | |
17859 | + * descriptor's buffer must be 256 byte aligned | |
17860 | + * should never happen since we specify the DMA mask | |
17861 | + */ | |
17862 | + | |
17863 | + DMESGW("Fixing RX alignment"); | |
17864 | + desc = (u32*)((u8*)desc + 256); | |
17865 | +#if (defined(CONFIG_HIGHMEM64G) || defined(CONFIG_64BIT_PHYS_ADDR)) | |
17866 | + desc = (u32*)((u64)desc &~ 0xff); | |
17867 | + dma_desc = (dma_addr_t)((u8*)dma_desc + 256); | |
17868 | + dma_desc = (dma_addr_t)((u64)dma_desc &~ 0xff); | |
17869 | +#else | |
17870 | + desc = (u32*)((u32)desc &~ 0xff); | |
17871 | + dma_desc = (dma_addr_t)((u8*)dma_desc + 256); | |
17872 | + dma_desc = (dma_addr_t)((u32)dma_desc &~ 0xff); | |
17873 | +#endif | |
17874 | + } | |
17875 | + | |
17876 | + priv->rxring=desc; | |
17877 | + priv->rxringdma=dma_desc; | |
17878 | + tmp=desc; | |
17879 | + | |
17880 | + for (i=0;i<count;i++){ | |
17881 | + | |
17882 | + if ((buf= kmalloc(bufsize * sizeof(u8),GFP_ATOMIC)) == NULL){ | |
17883 | + DMESGE("Failed to kmalloc RX buffer"); | |
17884 | + return -1; | |
17885 | + } | |
17886 | + | |
17887 | + dma_tmp = pci_map_single(pdev,buf,bufsize * sizeof(u8), | |
17888 | + PCI_DMA_FROMDEVICE); | |
17889 | + | |
17890 | +#ifdef DEBUG_ZERO_RX | |
17891 | + int j; | |
17892 | + for(j=0;j<bufsize;j++) ((u8*)buf)[i] = 0; | |
17893 | +#endif | |
17894 | + | |
17895 | + //buf = (void*)pci_alloc_consistent(pdev,bufsize,&dma_tmp); | |
17896 | + if(-1 == buffer_add(&(priv->rxbuffer), buf,dma_tmp, | |
17897 | + &(priv->rxbufferhead))){ | |
17898 | + DMESGE("Unable to allocate mem RX buf"); | |
17899 | + return -1; | |
17900 | + } | |
17901 | + *tmp = 0; //zero pads the header of the descriptor | |
17902 | + *tmp = *tmp |( bufsize&0xfff); | |
17903 | + *(tmp+2) = (u32)dma_tmp; | |
17904 | + *tmp = *tmp |(1<<31); // descriptor void, owned by the NIC | |
17905 | + | |
17906 | +#ifdef DEBUG_RXALLOC | |
17907 | + DMESG("Alloc %x size buffer, DMA mem @ %x, virtual mem @ %x", | |
17908 | + (u32)(bufsize&0xfff), (u32)dma_tmp, (u32)buf); | |
17909 | +#endif | |
17910 | + | |
17911 | + tmp=tmp+rx_desc_size; | |
17912 | + } | |
17913 | + | |
17914 | + *(tmp-rx_desc_size) = *(tmp-rx_desc_size) | (1<<30); // this is the last descriptor | |
17915 | + | |
17916 | + | |
17917 | +#ifdef DEBUG_RXALLOC | |
17918 | + DMESG("RX DMA physical address: %x",dma_desc); | |
17919 | +#endif | |
17920 | + | |
17921 | + return 0; | |
17922 | +} | |
17923 | + | |
17924 | + | |
17925 | +void set_nic_rxring(struct net_device *dev) | |
17926 | +{ | |
17927 | + u8 pgreg; | |
17928 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
17929 | + | |
17930 | + //rtl8180_set_mode(dev, EPROM_CMD_CONFIG); | |
17931 | + | |
17932 | + pgreg=read_nic_byte(dev, PGSELECT); | |
17933 | + write_nic_byte(dev, PGSELECT, pgreg &~ (1<<PGSELECT_PG_SHIFT)); | |
17934 | + | |
17935 | + //rtl8180_set_mode(dev, EPROM_CMD_NORMAL); | |
17936 | + | |
17937 | + write_nic_dword(dev, RXRING_ADDR,priv->rxringdma); | |
17938 | +} | |
17939 | + | |
17940 | + | |
17941 | +void rtl8180_reset(struct net_device *dev) | |
17942 | +{ | |
17943 | + //u32 txconf = 0x80e00707; //FIXME: Make me understandable | |
17944 | + u8 cr; | |
17945 | + | |
17946 | + //write_nic_dword(dev,TX_CONF,txconf); | |
17947 | + | |
17948 | + rtl8180_irq_disable(dev); | |
17949 | + | |
17950 | + cr=read_nic_byte(dev,CMD); | |
17951 | + cr = cr & 2; | |
17952 | + cr = cr | (1<<CMD_RST_SHIFT); | |
17953 | + write_nic_byte(dev,CMD,cr); | |
17954 | + | |
17955 | + force_pci_posting(dev); | |
17956 | + | |
17957 | + mdelay(200); | |
17958 | + | |
17959 | + if(read_nic_byte(dev,CMD) & (1<<CMD_RST_SHIFT)) | |
17960 | + DMESGW("Card reset timeout!"); | |
17961 | + else | |
17962 | + DMESG("Card successfully reset"); | |
17963 | + | |
17964 | +//#ifndef CONFIG_RTL8185B | |
17965 | + rtl8180_set_mode(dev,EPROM_CMD_LOAD); | |
17966 | + force_pci_posting(dev); | |
17967 | + mdelay(200); | |
17968 | +//#endif | |
17969 | +} | |
17970 | + | |
17971 | +inline u16 ieeerate2rtlrate(int rate) | |
17972 | +{ | |
17973 | + switch(rate){ | |
17974 | + case 10: | |
17975 | + return 0; | |
17976 | + case 20: | |
17977 | + return 1; | |
17978 | + case 55: | |
17979 | + return 2; | |
17980 | + case 110: | |
17981 | + return 3; | |
17982 | + case 60: | |
17983 | + return 4; | |
17984 | + case 90: | |
17985 | + return 5; | |
17986 | + case 120: | |
17987 | + return 6; | |
17988 | + case 180: | |
17989 | + return 7; | |
17990 | + case 240: | |
17991 | + return 8; | |
17992 | + case 360: | |
17993 | + return 9; | |
17994 | + case 480: | |
17995 | + return 10; | |
17996 | + case 540: | |
17997 | + return 11; | |
17998 | + default: | |
17999 | + return 3; | |
18000 | + | |
18001 | + } | |
18002 | +} | |
18003 | + | |
18004 | +static u16 rtl_rate[] = {10,20,55,110,60,90,120,180,240,360,480,540,720}; | |
18005 | +inline u16 rtl8180_rate2rate(short rate) | |
18006 | +{ | |
18007 | + if (rate >12) return 10; | |
18008 | + return rtl_rate[rate]; | |
18009 | +} | |
18010 | +inline u8 rtl8180_IsWirelessBMode(u16 rate) | |
18011 | +{ | |
18012 | + if( ((rate <= 110) && (rate != 60) && (rate != 90)) || (rate == 220) ) | |
18013 | + return 1; | |
18014 | + else return 0; | |
18015 | +} | |
18016 | +u16 N_DBPSOfRate(u16 DataRate); | |
18017 | +u16 ComputeTxTime( | |
18018 | + u16 FrameLength, | |
18019 | + u16 DataRate, | |
18020 | + u8 bManagementFrame, | |
18021 | + u8 bShortPreamble | |
18022 | +) | |
18023 | +{ | |
18024 | + u16 FrameTime; | |
18025 | + u16 N_DBPS; | |
18026 | + u16 Ceiling; | |
18027 | + | |
18028 | + if( rtl8180_IsWirelessBMode(DataRate) ) | |
18029 | + { | |
18030 | + if( bManagementFrame || !bShortPreamble || DataRate == 10 ) | |
18031 | + { // long preamble | |
18032 | + FrameTime = (u16)(144+48+(FrameLength*8/(DataRate/10))); | |
18033 | + } | |
18034 | + else | |
18035 | + { // Short preamble | |
18036 | + FrameTime = (u16)(72+24+(FrameLength*8/(DataRate/10))); | |
18037 | + } | |
18038 | + if( ( FrameLength*8 % (DataRate/10) ) != 0 ) //Get the Ceilling | |
18039 | + FrameTime ++; | |
18040 | + } else { //802.11g DSSS-OFDM PLCP length field calculation. | |
18041 | + N_DBPS = N_DBPSOfRate(DataRate); | |
18042 | + Ceiling = (16 + 8*FrameLength + 6) / N_DBPS | |
18043 | + + (((16 + 8*FrameLength + 6) % N_DBPS) ? 1 : 0); | |
18044 | + FrameTime = (u16)(16 + 4 + 4*Ceiling + 6); | |
18045 | + } | |
18046 | + return FrameTime; | |
18047 | +} | |
18048 | +u16 N_DBPSOfRate(u16 DataRate) | |
18049 | +{ | |
18050 | + u16 N_DBPS = 24; | |
18051 | + | |
18052 | + switch(DataRate) | |
18053 | + { | |
18054 | + case 60: | |
18055 | + N_DBPS = 24; | |
18056 | + break; | |
18057 | + | |
18058 | + case 90: | |
18059 | + N_DBPS = 36; | |
18060 | + break; | |
18061 | + | |
18062 | + case 120: | |
18063 | + N_DBPS = 48; | |
18064 | + break; | |
18065 | + | |
18066 | + case 180: | |
18067 | + N_DBPS = 72; | |
18068 | + break; | |
18069 | + | |
18070 | + case 240: | |
18071 | + N_DBPS = 96; | |
18072 | + break; | |
18073 | + | |
18074 | + case 360: | |
18075 | + N_DBPS = 144; | |
18076 | + break; | |
18077 | + | |
18078 | + case 480: | |
18079 | + N_DBPS = 192; | |
18080 | + break; | |
18081 | + | |
18082 | + case 540: | |
18083 | + N_DBPS = 216; | |
18084 | + break; | |
18085 | + | |
18086 | + default: | |
18087 | + break; | |
18088 | + } | |
18089 | + | |
18090 | + return N_DBPS; | |
18091 | +} | |
18092 | + | |
18093 | +//{by amy 080312 | |
18094 | +// | |
18095 | +// Description: | |
18096 | +// For Netgear case, they want good-looking singal strength. | |
18097 | +// 2004.12.05, by rcnjko. | |
18098 | +// | |
18099 | +long | |
18100 | +NetgearSignalStrengthTranslate( | |
18101 | + long LastSS, | |
18102 | + long CurrSS | |
18103 | + ) | |
18104 | +{ | |
18105 | + long RetSS; | |
18106 | + | |
18107 | + // Step 1. Scale mapping. | |
18108 | + if(CurrSS >= 71 && CurrSS <= 100) | |
18109 | + { | |
18110 | + RetSS = 90 + ((CurrSS - 70) / 3); | |
18111 | + } | |
18112 | + else if(CurrSS >= 41 && CurrSS <= 70) | |
18113 | + { | |
18114 | + RetSS = 78 + ((CurrSS - 40) / 3); | |
18115 | + } | |
18116 | + else if(CurrSS >= 31 && CurrSS <= 40) | |
18117 | + { | |
18118 | + RetSS = 66 + (CurrSS - 30); | |
18119 | + } | |
18120 | + else if(CurrSS >= 21 && CurrSS <= 30) | |
18121 | + { | |
18122 | + RetSS = 54 + (CurrSS - 20); | |
18123 | + } | |
18124 | + else if(CurrSS >= 5 && CurrSS <= 20) | |
18125 | + { | |
18126 | + RetSS = 42 + (((CurrSS - 5) * 2) / 3); | |
18127 | + } | |
18128 | + else if(CurrSS == 4) | |
18129 | + { | |
18130 | + RetSS = 36; | |
18131 | + } | |
18132 | + else if(CurrSS == 3) | |
18133 | + { | |
18134 | + RetSS = 27; | |
18135 | + } | |
18136 | + else if(CurrSS == 2) | |
18137 | + { | |
18138 | + RetSS = 18; | |
18139 | + } | |
18140 | + else if(CurrSS == 1) | |
18141 | + { | |
18142 | + RetSS = 9; | |
18143 | + } | |
18144 | + else | |
18145 | + { | |
18146 | + RetSS = CurrSS; | |
18147 | + } | |
18148 | + //RT_TRACE(COMP_DBG, DBG_LOUD, ("##### After Mapping: LastSS: %d, CurrSS: %d, RetSS: %d\n", LastSS, CurrSS, RetSS)); | |
18149 | + | |
18150 | + // Step 2. Smoothing. | |
18151 | + if(LastSS > 0) | |
18152 | + { | |
18153 | + RetSS = ((LastSS * 5) + (RetSS)+ 5) / 6; | |
18154 | + } | |
18155 | + //RT_TRACE(COMP_DBG, DBG_LOUD, ("$$$$$ After Smoothing: LastSS: %d, CurrSS: %d, RetSS: %d\n", LastSS, CurrSS, RetSS)); | |
18156 | + | |
18157 | + return RetSS; | |
18158 | +} | |
18159 | +// | |
18160 | +// Description: | |
18161 | +// Translate 0-100 signal strength index into dBm. | |
18162 | +// | |
18163 | +long | |
18164 | +TranslateToDbm8185( | |
18165 | + u8 SignalStrengthIndex // 0-100 index. | |
18166 | + ) | |
18167 | +{ | |
18168 | + long SignalPower; // in dBm. | |
18169 | + | |
18170 | + // Translate to dBm (x=0.5y-95). | |
18171 | + SignalPower = (long)((SignalStrengthIndex + 1) >> 1); | |
18172 | + SignalPower -= 95; | |
18173 | + | |
18174 | + return SignalPower; | |
18175 | +} | |
18176 | +// | |
18177 | +// Description: | |
18178 | +// Perform signal smoothing for dynamic mechanism. | |
18179 | +// This is different with PerformSignalSmoothing8185 in smoothing fomula. | |
18180 | +// No dramatic adjustion is apply because dynamic mechanism need some degree | |
18181 | +// of correctness. Ported from 8187B. | |
18182 | +// 2007-02-26, by Bruce. | |
18183 | +// | |
18184 | +void | |
18185 | +PerformUndecoratedSignalSmoothing8185( | |
18186 | + struct r8180_priv *priv, | |
18187 | + bool bCckRate | |
18188 | + ) | |
18189 | +{ | |
18190 | + | |
18191 | + | |
18192 | + // Determin the current packet is CCK rate. | |
18193 | + priv->bCurCCKPkt = bCckRate; | |
18194 | + | |
18195 | + if(priv->UndecoratedSmoothedSS >= 0) | |
18196 | + { | |
18197 | + priv->UndecoratedSmoothedSS = ( (priv->UndecoratedSmoothedSS * 5) + (priv->SignalStrength * 10) ) / 6; | |
18198 | + } | |
18199 | + else | |
18200 | + { | |
18201 | + priv->UndecoratedSmoothedSS = priv->SignalStrength * 10; | |
18202 | + } | |
18203 | + | |
18204 | + priv->UndercorateSmoothedRxPower = ( (priv->UndercorateSmoothedRxPower * 50) + (priv->RxPower* 11)) / 60; | |
18205 | + | |
18206 | +// printk("Sommthing SignalSterngth (%d) => UndecoratedSmoothedSS (%d)\n", priv->SignalStrength, priv->UndecoratedSmoothedSS); | |
18207 | +// printk("Sommthing RxPower (%d) => UndecoratedRxPower (%d)\n", priv->RxPower, priv->UndercorateSmoothedRxPower); | |
18208 | + | |
18209 | + //if(priv->CurCCKRSSI >= 0 && bCckRate) | |
18210 | + if(bCckRate) | |
18211 | + { | |
18212 | + priv->CurCCKRSSI = priv->RSSI; | |
18213 | + } | |
18214 | + else | |
18215 | + { | |
18216 | + priv->CurCCKRSSI = 0; | |
18217 | + } | |
18218 | + | |
18219 | + // Boundary checking. | |
18220 | + // TODO: The overflow condition does happen, if we want to fix, | |
18221 | + // we shall recalculate thresholds first. | |
18222 | + if(priv->UndecoratedSmoothedSS > 100) | |
18223 | + { | |
18224 | +// printk("UndecoratedSmoothedSS(%d) overflow, SignalStrength(%d)\n", priv->UndecoratedSmoothedSS, priv->SignalStrength); | |
18225 | + } | |
18226 | + if(priv->UndecoratedSmoothedSS < 0) | |
18227 | + { | |
18228 | +// printk("UndecoratedSmoothedSS(%d) underflow, SignalStrength(%d)\n", priv->UndecoratedSmoothedSS, priv->SignalStrength); | |
18229 | + } | |
18230 | + | |
18231 | +} | |
18232 | + | |
18233 | +//by amy 080312} | |
18234 | + | |
18235 | +/* This is rough RX isr handling routine*/ | |
18236 | +void rtl8180_rx(struct net_device *dev) | |
18237 | +{ | |
18238 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
18239 | + struct sk_buff *tmp_skb; | |
18240 | + | |
18241 | + //struct sk_buff *skb; | |
18242 | + short first,last; | |
18243 | + u32 len; | |
18244 | + int lastlen; | |
18245 | + unsigned char quality, signal; | |
18246 | + u8 rate; | |
18247 | + //u32 *prism_hdr; | |
18248 | + u32 *tmp,*tmp2; | |
18249 | + u8 rx_desc_size; | |
18250 | + u8 padding; | |
18251 | + //u32 count=0; | |
18252 | + char rxpower = 0; | |
18253 | + u32 RXAGC = 0; | |
18254 | + long RxAGC_dBm = 0; | |
18255 | + u8 LNA=0, BB=0; | |
18256 | + u8 LNA_gain[4]={02, 17, 29, 39}; | |
18257 | + u8 Antenna = 0; | |
18258 | + struct ieee80211_hdr *hdr;//by amy | |
18259 | + u16 fc,type; | |
18260 | + u8 bHwError = 0,bCRC = 0,bICV = 0; | |
18261 | + //bHwError = 0; | |
18262 | + //bCRC = 0; | |
18263 | + //bICV = 0; | |
18264 | + bool bCckRate = false; | |
18265 | + u8 RSSI = 0; | |
18266 | + long SignalStrengthIndex = 0;//+by amy 080312 | |
18267 | +// u8 SignalStrength = 0; | |
18268 | + struct ieee80211_rx_stats stats = { | |
18269 | + .signal = 0, | |
18270 | + .noise = -98, | |
18271 | + .rate = 0, | |
18272 | + // .mac_time = jiffies, | |
18273 | + .freq = IEEE80211_24GHZ_BAND, | |
18274 | + }; | |
18275 | + | |
18276 | +#ifdef CONFIG_RTL8185B | |
18277 | + stats.nic_type = NIC_8185B; | |
18278 | + rx_desc_size = 8; | |
18279 | + | |
18280 | +#else | |
18281 | + stats.nic_type = NIC_8185; | |
18282 | + rx_desc_size = 4; | |
18283 | +#endif | |
18284 | + //printk("receive frame!%d\n",count++); | |
18285 | + //if (!priv->rxbuffer) DMESG ("EE: NIC RX ack, but RX queue corrupted!"); | |
18286 | + //else { | |
18287 | + | |
18288 | + if ((*(priv->rxringtail)) & (1<<31)) { | |
18289 | + | |
18290 | + /* we have got an RX int, but the descriptor | |
18291 | + * we are pointing is empty*/ | |
18292 | + | |
18293 | + priv->stats.rxnodata++; | |
18294 | + priv->ieee80211->stats.rx_errors++; | |
18295 | + | |
18296 | + /* if (! *(priv->rxring) & (1<<31)) { | |
18297 | + | |
18298 | + priv->stats.rxreset++; | |
18299 | + priv->rxringtail=priv->rxring; | |
18300 | + priv->rxbuffer=priv->rxbufferhead; | |
18301 | + | |
18302 | + }else{*/ | |
18303 | + | |
18304 | + #if 0 | |
18305 | + /* Maybe it is possible that the NIC has skipped some descriptors or | |
18306 | + * it has reset its internal pointer to the beginning of the ring | |
18307 | + * we search for the first filled descriptor in the ring, or we break | |
18308 | + * putting again the pointer in the old location if we do not found any. | |
18309 | + * This is quite dangerous, what does happen if the nic writes | |
18310 | + * two descriptor (say A and B) when we have just checked the descriptor | |
18311 | + * A and we are going to check the descriptor B..This might happen if the | |
18312 | + * interrupt was dummy, there was not really filled descriptors and | |
18313 | + * the NIC didn't lose pointer | |
18314 | + */ | |
18315 | + | |
18316 | + //priv->stats.rxwrkaround++; | |
18317 | + | |
18318 | + tmp = priv->rxringtail; | |
18319 | + while (*(priv->rxringtail) & (1<<31)){ | |
18320 | + | |
18321 | + priv->rxringtail+=4; | |
18322 | + | |
18323 | + if(priv->rxringtail >= | |
18324 | + (priv->rxring)+(priv->rxringcount )*4) | |
18325 | + priv->rxringtail=priv->rxring; | |
18326 | + | |
18327 | + priv->rxbuffer=(priv->rxbuffer->next); | |
18328 | + | |
18329 | + if(priv->rxringtail == tmp ){ | |
18330 | + //DMESG("EE: Could not find RX pointer"); | |
18331 | + priv->stats.rxnopointer++; | |
18332 | + break; | |
18333 | + } | |
18334 | + } | |
18335 | + #else | |
18336 | + | |
18337 | + tmp2 = NULL; | |
18338 | + tmp = priv->rxringtail; | |
18339 | + do{ | |
18340 | + if(tmp == priv->rxring) | |
18341 | + //tmp = priv->rxring + (priv->rxringcount )*rx_desc_size; xiong-2006-11-15 | |
18342 | + tmp = priv->rxring + (priv->rxringcount - 1)*rx_desc_size; | |
18343 | + else | |
18344 | + tmp -= rx_desc_size; | |
18345 | + | |
18346 | + if(! (*tmp & (1<<31))) | |
18347 | + tmp2 = tmp; | |
18348 | + }while(tmp != priv->rxring); | |
18349 | + | |
18350 | + if(tmp2) priv->rxringtail = tmp2; | |
18351 | + #endif | |
18352 | + //} | |
18353 | + } | |
18354 | + | |
18355 | + /* while there are filled descriptors */ | |
18356 | + while(!(*(priv->rxringtail) & (1<<31))){ | |
18357 | + if(*(priv->rxringtail) & (1<<26)) | |
18358 | + DMESGW("RX buffer overflow"); | |
18359 | + if(*(priv->rxringtail) & (1<<12)) | |
18360 | + priv->stats.rxicverr++; | |
18361 | + | |
18362 | + if(*(priv->rxringtail) & (1<<27)){ | |
18363 | + priv->stats.rxdmafail++; | |
18364 | + //DMESG("EE: RX DMA FAILED at buffer pointed by descriptor %x",(u32)priv->rxringtail); | |
18365 | + goto drop; | |
18366 | + } | |
18367 | + | |
18368 | + pci_dma_sync_single_for_cpu(priv->pdev, | |
18369 | + priv->rxbuffer->dma, | |
18370 | + priv->rxbuffersize * \ | |
18371 | + sizeof(u8), | |
18372 | + PCI_DMA_FROMDEVICE); | |
18373 | + | |
18374 | + first = *(priv->rxringtail) & (1<<29) ? 1:0; | |
18375 | + if(first) priv->rx_prevlen=0; | |
18376 | + | |
18377 | + last = *(priv->rxringtail) & (1<<28) ? 1:0; | |
18378 | + if(last){ | |
18379 | + lastlen=((*priv->rxringtail) &0xfff); | |
18380 | + | |
18381 | + /* if the last descriptor (that should | |
18382 | + * tell us the total packet len) tell | |
18383 | + * us something less than the descriptors | |
18384 | + * len we had until now, then there is some | |
18385 | + * problem.. | |
18386 | + * workaround to prevent kernel panic | |
18387 | + */ | |
18388 | + if(lastlen < priv->rx_prevlen) | |
18389 | + len=0; | |
18390 | + else | |
18391 | + len=lastlen-priv->rx_prevlen; | |
18392 | + | |
18393 | + if(*(priv->rxringtail) & (1<<13)) { | |
18394 | +//lastlen=((*priv->rxringtail) &0xfff); | |
18395 | + if ((*(priv->rxringtail) & 0xfff) <500) | |
18396 | + priv->stats.rxcrcerrmin++; | |
18397 | + else if ((*(priv->rxringtail) & 0x0fff) >1000) | |
18398 | + priv->stats.rxcrcerrmax++; | |
18399 | + else | |
18400 | + priv->stats.rxcrcerrmid++; | |
18401 | + | |
18402 | + } | |
18403 | + | |
18404 | + }else{ | |
18405 | + len = priv->rxbuffersize; | |
18406 | + } | |
18407 | + | |
18408 | +#ifdef CONFIG_RTL8185B | |
18409 | + if(first && last) { | |
18410 | + padding = ((*(priv->rxringtail+3))&(0x04000000))>>26; | |
18411 | + }else if(first) { | |
18412 | + padding = ((*(priv->rxringtail+3))&(0x04000000))>>26; | |
18413 | + if(padding) { | |
18414 | + len -= 2; | |
18415 | + } | |
18416 | + }else { | |
18417 | + padding = 0; | |
18418 | + } | |
18419 | +#ifdef CONFIG_RTL818X_S | |
18420 | + padding = 0; | |
18421 | +#endif | |
18422 | +#endif | |
18423 | + priv->rx_prevlen+=len; | |
18424 | + | |
18425 | + if(priv->rx_prevlen > MAX_FRAG_THRESHOLD + 100){ | |
18426 | + /* HW is probably passing several buggy frames | |
18427 | + * without FD or LD flag set. | |
18428 | + * Throw this garbage away to prevent skb | |
18429 | + * memory exausting | |
18430 | + */ | |
18431 | + if(!priv->rx_skb_complete) | |
18432 | + dev_kfree_skb_any(priv->rx_skb); | |
18433 | + priv->rx_skb_complete = 1; | |
18434 | + } | |
18435 | + | |
18436 | +#ifdef DEBUG_RX_FRAG | |
18437 | + DMESG("Iteration.. len %x",len); | |
18438 | + if(first) DMESG ("First descriptor"); | |
18439 | + if(last) DMESG("Last descriptor"); | |
18440 | + | |
18441 | +#endif | |
18442 | +#ifdef DEBUG_RX_VERBOSE | |
18443 | + print_buffer( priv->rxbuffer->buf, len); | |
18444 | +#endif | |
18445 | + | |
18446 | +#ifdef CONFIG_RTL8185B | |
18447 | + signal=(unsigned char)(((*(priv->rxringtail+3))& (0x00ff0000))>>16); | |
18448 | + signal=(signal&0xfe)>>1; // Modify by hikaru 6.6 | |
18449 | + | |
18450 | + quality=(unsigned char)((*(priv->rxringtail+3)) & (0xff)); | |
18451 | + | |
18452 | + stats.mac_time[0] = *(priv->rxringtail+1); | |
18453 | + stats.mac_time[1] = *(priv->rxringtail+2); | |
18454 | + rxpower =((char)(((*(priv->rxringtail+4))& (0x00ff0000))>>16))/2 - 42; | |
18455 | + RSSI = ((u8)(((*(priv->rxringtail+3)) & (0x0000ff00))>> 8)) & (0x7f); | |
18456 | + | |
18457 | +#else | |
18458 | + signal=((*(priv->rxringtail+1))& (0xff0000))>>16; | |
18459 | + signal=(signal&0xfe)>>1; // Modify by hikaru 6.6 | |
18460 | + | |
18461 | + quality=((*(priv->rxringtail+1)) & (0xff)); | |
18462 | + | |
18463 | + stats.mac_time[0] = *(priv->rxringtail+2); | |
18464 | + stats.mac_time[1] = *(priv->rxringtail+3); | |
18465 | +#endif | |
18466 | + rate=((*(priv->rxringtail)) & | |
18467 | + ((1<<23)|(1<<22)|(1<<21)|(1<<20)))>>20; | |
18468 | + | |
18469 | + stats.rate = rtl8180_rate2rate(rate); | |
18470 | + //DMESG("%d",rate); | |
18471 | + Antenna = (((*(priv->rxringtail +3))& (0x00008000)) == 0 )? 0:1 ; | |
18472 | +// printk("in rtl8180_rx():Antenna is %d\n",Antenna); | |
18473 | +//by amy for antenna | |
18474 | + if(!rtl8180_IsWirelessBMode(stats.rate)) | |
18475 | + { // OFDM rate. | |
18476 | + | |
18477 | + RxAGC_dBm = rxpower+1; //bias | |
18478 | + } | |
18479 | + else | |
18480 | + { // CCK rate. | |
18481 | + RxAGC_dBm = signal;//bit 0 discard | |
18482 | + | |
18483 | + LNA = (u8) (RxAGC_dBm & 0x60 ) >> 5 ; //bit 6~ bit 5 | |
18484 | + BB = (u8) (RxAGC_dBm & 0x1F); // bit 4 ~ bit 0 | |
18485 | + | |
18486 | + RxAGC_dBm = -( LNA_gain[LNA] + (BB *2) ); //Pin_11b=-(LNA_gain+BB_gain) (dBm) | |
18487 | + | |
18488 | + RxAGC_dBm +=4; //bias | |
18489 | + } | |
18490 | + | |
18491 | + if(RxAGC_dBm & 0x80) //absolute value | |
18492 | + RXAGC= ~(RxAGC_dBm)+1; | |
18493 | + bCckRate = rtl8180_IsWirelessBMode(stats.rate); | |
18494 | + // Translate RXAGC into 1-100. | |
18495 | + if(!rtl8180_IsWirelessBMode(stats.rate)) | |
18496 | + { // OFDM rate. | |
18497 | + if(RXAGC>90) | |
18498 | + RXAGC=90; | |
18499 | + else if(RXAGC<25) | |
18500 | + RXAGC=25; | |
18501 | + RXAGC=(90-RXAGC)*100/65; | |
18502 | + } | |
18503 | + else | |
18504 | + { // CCK rate. | |
18505 | + if(RXAGC>95) | |
18506 | + RXAGC=95; | |
18507 | + else if(RXAGC<30) | |
18508 | + RXAGC=30; | |
18509 | + RXAGC=(95-RXAGC)*100/65; | |
18510 | + } | |
18511 | + priv->SignalStrength = (u8)RXAGC; | |
18512 | + priv->RecvSignalPower = RxAGC_dBm ; // It can use directly by SD3 CMLin | |
18513 | + priv->RxPower = rxpower; | |
18514 | + priv->RSSI = RSSI; | |
18515 | +//{by amy 080312 | |
18516 | + // SQ translation formular is provided by SD3 DZ. 2006.06.27, by rcnjko. | |
18517 | + if(quality >= 127) | |
18518 | + quality = 1;//0; //0 will cause epc to show signal zero , walk aroud now; | |
18519 | + else if(quality < 27) | |
18520 | + quality = 100; | |
18521 | + else | |
18522 | + quality = 127 - quality; | |
18523 | + priv->SignalQuality = quality; | |
18524 | + if(!priv->card_8185) | |
18525 | + printk("check your card type\n"); | |
18526 | + | |
18527 | + stats.signal = (u8)quality;//priv->wstats.qual.level = priv->SignalStrength; | |
18528 | + stats.signalstrength = RXAGC; | |
18529 | + if(stats.signalstrength > 100) | |
18530 | + stats.signalstrength = 100; | |
18531 | + stats.signalstrength = (stats.signalstrength * 70)/100 + 30; | |
18532 | + // printk("==========================>rx : RXAGC is %d,signalstrength is %d\n",RXAGC,stats.signalstrength); | |
18533 | + stats.rssi = priv->wstats.qual.qual = priv->SignalQuality; | |
18534 | + stats.noise = priv->wstats.qual.noise = 100 - priv ->wstats.qual.qual; | |
18535 | +//by amy 080312} | |
18536 | + bHwError = (((*(priv->rxringtail))& (0x00000fff)) == 4080)| (((*(priv->rxringtail))& (0x04000000)) != 0 ) | |
18537 | + | (((*(priv->rxringtail))& (0x08000000)) != 0 )| (((~(*(priv->rxringtail)))& (0x10000000)) != 0 )| (((~(*(priv->rxringtail)))& (0x20000000)) != 0 ); | |
18538 | + bCRC = ((*(priv->rxringtail)) & (0x00002000)) >> 13; | |
18539 | + bICV = ((*(priv->rxringtail)) & (0x00001000)) >> 12; | |
18540 | + hdr = (struct ieee80211_hdr *)priv->rxbuffer->buf; | |
18541 | + fc = le16_to_cpu(hdr->frame_ctl); | |
18542 | + type = WLAN_FC_GET_TYPE(fc); | |
18543 | + | |
18544 | + if((IEEE80211_FTYPE_CTL != type) && | |
18545 | + (eqMacAddr(priv->ieee80211->current_network.bssid, (fc & IEEE80211_FCTL_TODS)? hdr->addr1 : (fc & IEEE80211_FCTL_FROMDS )? hdr->addr2 : hdr->addr3)) | |
18546 | + && (!bHwError) && (!bCRC)&& (!bICV)) | |
18547 | + { | |
18548 | +//by amy 080312 | |
18549 | + // Perform signal smoothing for dynamic mechanism on demand. | |
18550 | + // This is different with PerformSignalSmoothing8185 in smoothing fomula. | |
18551 | + // No dramatic adjustion is apply because dynamic mechanism need some degree | |
18552 | + // of correctness. 2007.01.23, by shien chang. | |
18553 | + PerformUndecoratedSignalSmoothing8185(priv,bCckRate); | |
18554 | + // | |
18555 | + // For good-looking singal strength. | |
18556 | + // | |
18557 | + SignalStrengthIndex = NetgearSignalStrengthTranslate( | |
18558 | + priv->LastSignalStrengthInPercent, | |
18559 | + priv->SignalStrength); | |
18560 | + | |
18561 | + priv->LastSignalStrengthInPercent = SignalStrengthIndex; | |
18562 | + priv->Stats_SignalStrength = TranslateToDbm8185((u8)SignalStrengthIndex); | |
18563 | + // | |
18564 | + // We need more correct power of received packets and the "SignalStrength" of RxStats is beautified, | |
18565 | + // so we record the correct power here. | |
18566 | + // | |
18567 | + priv->Stats_SignalQuality =(long) (priv->Stats_SignalQuality * 5 + (long)priv->SignalQuality + 5) / 6; | |
18568 | + priv->Stats_RecvSignalPower = (long)(priv->Stats_RecvSignalPower * 5 + priv->RecvSignalPower -1) / 6; | |
18569 | + | |
18570 | + // Figure out which antenna that received the lasted packet. | |
18571 | + priv->LastRxPktAntenna = Antenna ? 1 : 0; // 0: aux, 1: main. | |
18572 | +//by amy 080312 | |
18573 | + SwAntennaDiversityRxOk8185(dev, priv->SignalStrength); | |
18574 | + } | |
18575 | + | |
18576 | +//by amy for antenna | |
18577 | + | |
18578 | + | |
18579 | + | |
18580 | + | |
18581 | + | |
18582 | + | |
18583 | +#ifndef DUMMY_RX | |
18584 | + if(first){ | |
18585 | + if(!priv->rx_skb_complete){ | |
18586 | + /* seems that HW sometimes fails to reiceve and | |
18587 | + doesn't provide the last descriptor */ | |
18588 | +#ifdef DEBUG_RX_SKB | |
18589 | + DMESG("going to free incomplete skb"); | |
18590 | +#endif | |
18591 | + dev_kfree_skb_any(priv->rx_skb); | |
18592 | + priv->stats.rxnolast++; | |
18593 | +#ifdef DEBUG_RX_SKB | |
18594 | + DMESG("free incomplete skb OK"); | |
18595 | +#endif | |
18596 | + } | |
18597 | + /* support for prism header has been originally added by Christian */ | |
18598 | + if(priv->prism_hdr && priv->ieee80211->iw_mode == IW_MODE_MONITOR){ | |
18599 | + | |
18600 | +#if 0 | |
18601 | + priv->rx_skb = dev_alloc_skb(len+2+PRISM_HDR_SIZE); | |
18602 | + if(! priv->rx_skb) goto drop; | |
18603 | + | |
18604 | + prism_hdr = (u32*) skb_put(priv->rx_skb,PRISM_HDR_SIZE); | |
18605 | + prism_hdr[0]=htonl(0x80211001); //version | |
18606 | + prism_hdr[1]=htonl(0x40); //length | |
18607 | + prism_hdr[2]=htonl(stats.mac_time[1]); //mactime (HIGH) | |
18608 | + prism_hdr[3]=htonl(stats.mac_time[0]); //mactime (LOW) | |
18609 | + rdtsc(prism_hdr[5], prism_hdr[4]); //hostime (LOW+HIGH) | |
18610 | + prism_hdr[4]=htonl(prism_hdr[4]); //Byte-Order aendern | |
18611 | + prism_hdr[5]=htonl(prism_hdr[5]); //Byte-Order aendern | |
18612 | + prism_hdr[6]=0x00; //phytype | |
18613 | + prism_hdr[7]=htonl(priv->chan); //channel | |
18614 | + prism_hdr[8]=htonl(stats.rate); //datarate | |
18615 | + prism_hdr[9]=0x00; //antenna | |
18616 | + prism_hdr[10]=0x00; //priority | |
18617 | + prism_hdr[11]=0x00; //ssi_type | |
18618 | + prism_hdr[12]=htonl(stats.signal); //ssi_signal | |
18619 | + prism_hdr[13]=htonl(stats.noise); //ssi_noise | |
18620 | + prism_hdr[14]=0x00; //preamble | |
18621 | + prism_hdr[15]=0x00; //encoding | |
18622 | + | |
18623 | +#endif | |
18624 | + }else{ | |
18625 | + priv->rx_skb = dev_alloc_skb(len+2); | |
18626 | + if( !priv->rx_skb) goto drop; | |
18627 | +#ifdef DEBUG_RX_SKB | |
18628 | + DMESG("Alloc initial skb %x",len+2); | |
18629 | +#endif | |
18630 | + } | |
18631 | + | |
18632 | + priv->rx_skb_complete=0; | |
18633 | + priv->rx_skb->dev=dev; | |
18634 | + }else{ | |
18635 | + /* if we are here we should have already RXed | |
18636 | + * the first frame. | |
18637 | + * If we get here and the skb is not allocated then | |
18638 | + * we have just throw out garbage (skb not allocated) | |
18639 | + * and we are still rxing garbage.... | |
18640 | + */ | |
18641 | + if(!priv->rx_skb_complete){ | |
18642 | + | |
18643 | + tmp_skb= dev_alloc_skb(priv->rx_skb->len +len+2); | |
18644 | + | |
18645 | + if(!tmp_skb) goto drop; | |
18646 | + | |
18647 | + tmp_skb->dev=dev; | |
18648 | +#ifdef DEBUG_RX_SKB | |
18649 | + DMESG("Realloc skb %x",len+2); | |
18650 | +#endif | |
18651 | + | |
18652 | +#ifdef DEBUG_RX_SKB | |
18653 | + DMESG("going copy prev frag %x",priv->rx_skb->len); | |
18654 | +#endif | |
18655 | + memcpy(skb_put(tmp_skb,priv->rx_skb->len), | |
18656 | + priv->rx_skb->data, | |
18657 | + priv->rx_skb->len); | |
18658 | +#ifdef DEBUG_RX_SKB | |
18659 | + DMESG("skb copy prev frag complete"); | |
18660 | +#endif | |
18661 | + | |
18662 | + dev_kfree_skb_any(priv->rx_skb); | |
18663 | +#ifdef DEBUG_RX_SKB | |
18664 | + DMESG("prev skb free ok"); | |
18665 | +#endif | |
18666 | + | |
18667 | + priv->rx_skb=tmp_skb; | |
18668 | + } | |
18669 | + } | |
18670 | +#ifdef DEBUG_RX_SKB | |
18671 | + DMESG("going to copy current payload %x",len); | |
18672 | +#endif | |
18673 | + if(!priv->rx_skb_complete) { | |
18674 | +#ifdef CONFIG_RTL8185B | |
18675 | + if(padding) { | |
18676 | + memcpy(skb_put(priv->rx_skb,len), | |
18677 | + (((unsigned char *)priv->rxbuffer->buf) + 2),len); | |
18678 | + } else { | |
18679 | +#endif | |
18680 | + memcpy(skb_put(priv->rx_skb,len), | |
18681 | + priv->rxbuffer->buf,len); | |
18682 | +#ifdef CONFIG_RTL8185B | |
18683 | + } | |
18684 | +#endif | |
18685 | + } | |
18686 | +#ifdef DEBUG_RX_SKB | |
18687 | + DMESG("current fragment skb copy complete"); | |
18688 | +#endif | |
18689 | + | |
18690 | + if(last && !priv->rx_skb_complete){ | |
18691 | + | |
18692 | +#ifdef DEBUG_RX_SKB | |
18693 | + DMESG("Got last fragment"); | |
18694 | +#endif | |
18695 | + | |
18696 | + if(priv->rx_skb->len > 4) | |
18697 | + skb_trim(priv->rx_skb,priv->rx_skb->len-4); | |
18698 | +#ifdef DEBUG_RX_SKB | |
18699 | + DMESG("yanked out crc, passing to the upper layer"); | |
18700 | +#endif | |
18701 | + | |
18702 | +#ifndef RX_DONT_PASS_UL | |
18703 | + if(!ieee80211_rx(priv->ieee80211, | |
18704 | + priv->rx_skb, &stats)){ | |
18705 | +#ifdef DEBUG_RX | |
18706 | + DMESGW("Packet not consumed"); | |
18707 | +#endif | |
18708 | +#endif // RX_DONT_PASS_UL | |
18709 | + | |
18710 | + dev_kfree_skb_any(priv->rx_skb); | |
18711 | +#ifndef RX_DONT_PASS_UL | |
18712 | + } | |
18713 | +#endif | |
18714 | +#ifdef DEBUG_RX | |
18715 | + else{ | |
18716 | + DMESG("Rcv frag"); | |
18717 | + } | |
18718 | +#endif | |
18719 | + priv->rx_skb_complete=1; | |
18720 | + } | |
18721 | + | |
18722 | +#endif //DUMMY_RX | |
18723 | + | |
18724 | + pci_dma_sync_single_for_device(priv->pdev, | |
18725 | + priv->rxbuffer->dma, | |
18726 | + priv->rxbuffersize * \ | |
18727 | + sizeof(u8), | |
18728 | + PCI_DMA_FROMDEVICE); | |
18729 | + | |
18730 | + | |
18731 | +drop: // this is used when we have not enought mem | |
18732 | + | |
18733 | + /* restore the descriptor */ | |
18734 | + *(priv->rxringtail+2)=priv->rxbuffer->dma; | |
18735 | + *(priv->rxringtail)=*(priv->rxringtail) &~ 0xfff; | |
18736 | + *(priv->rxringtail)= | |
18737 | + *(priv->rxringtail) | priv->rxbuffersize; | |
18738 | + | |
18739 | + *(priv->rxringtail)= | |
18740 | + *(priv->rxringtail) | (1<<31); | |
18741 | + //^empty descriptor | |
18742 | + | |
18743 | + //wmb(); | |
18744 | + | |
18745 | +#ifdef DEBUG_RX | |
18746 | + DMESG("Current descriptor: %x",(u32)priv->rxringtail); | |
18747 | +#endif | |
18748 | + //unsigned long flags; | |
18749 | + //spin_lock_irqsave(&priv->irq_lock,flags); | |
18750 | + | |
18751 | + priv->rxringtail+=rx_desc_size; | |
18752 | + if(priv->rxringtail >= | |
18753 | + (priv->rxring)+(priv->rxringcount )*rx_desc_size) | |
18754 | + priv->rxringtail=priv->rxring; | |
18755 | + | |
18756 | + //spin_unlock_irqrestore(&priv->irq_lock,flags); | |
18757 | + | |
18758 | + | |
18759 | + priv->rxbuffer=(priv->rxbuffer->next); | |
18760 | + | |
18761 | + } | |
18762 | + | |
18763 | + | |
18764 | + | |
18765 | +// if(get_curr_tx_free_desc(dev,priority)) | |
18766 | +// ieee80211_sta_ps_sleep(priv->ieee80211, &tmp, &tmp2); | |
18767 | + | |
18768 | + | |
18769 | + | |
18770 | +} | |
18771 | + | |
18772 | + | |
18773 | +void rtl8180_dma_kick(struct net_device *dev, int priority) | |
18774 | +{ | |
18775 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
18776 | + | |
18777 | + rtl8180_set_mode(dev,EPROM_CMD_CONFIG); | |
18778 | +/* | |
18779 | + | |
18780 | + switch(priority){ | |
18781 | + | |
18782 | + case LOW_PRIORITY: | |
18783 | + | |
18784 | + write_nic_byte(dev,TX_DMA_POLLING, | |
18785 | + (1<< TX_DMA_POLLING_LOWPRIORITY_SHIFT) | | |
18786 | + priv->dma_poll_mask); | |
18787 | + break; | |
18788 | + | |
18789 | + case NORM_PRIORITY: | |
18790 | + | |
18791 | + write_nic_byte(dev,TX_DMA_POLLING, | |
18792 | + (1<< TX_DMA_POLLING_NORMPRIORITY_SHIFT) | | |
18793 | + priv->dma_poll_mask); | |
18794 | + break; | |
18795 | + | |
18796 | + case HI_PRIORITY: | |
18797 | + | |
18798 | + write_nic_byte(dev,TX_DMA_POLLING, | |
18799 | + (1<< TX_DMA_POLLING_HIPRIORITY_SHIFT) | | |
18800 | + priv->dma_poll_mask); | |
18801 | + break; | |
18802 | + | |
18803 | + } | |
18804 | +*/ | |
18805 | + write_nic_byte(dev, TX_DMA_POLLING, | |
18806 | + (1 << (priority + 1)) | priv->dma_poll_mask); | |
18807 | + rtl8180_set_mode(dev,EPROM_CMD_NORMAL); | |
18808 | + | |
18809 | + force_pci_posting(dev); | |
18810 | +} | |
18811 | + | |
18812 | +#if 0 | |
18813 | +void rtl8180_tx_queues_stop(struct net_device *dev) | |
18814 | +{ | |
18815 | + //struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
18816 | + u8 dma_poll_mask = (1<<TX_DMA_STOP_LOWPRIORITY_SHIFT); | |
18817 | + dma_poll_mask |= (1<<TX_DMA_STOP_HIPRIORITY_SHIFT); | |
18818 | + dma_poll_mask |= (1<<TX_DMA_STOP_NORMPRIORITY_SHIFT); | |
18819 | + dma_poll_mask |= (1<<TX_DMA_STOP_BEACON_SHIFT); | |
18820 | + | |
18821 | + rtl8180_set_mode(dev,EPROM_CMD_CONFIG); | |
18822 | + write_nic_byte(dev,TX_DMA_POLLING,dma_poll_mask); | |
18823 | + rtl8180_set_mode(dev,EPROM_CMD_NORMAL); | |
18824 | +} | |
18825 | +#endif | |
18826 | + | |
18827 | +void rtl8180_data_hard_stop(struct net_device *dev) | |
18828 | +{ | |
18829 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
18830 | + | |
18831 | + rtl8180_set_mode(dev,EPROM_CMD_CONFIG); | |
18832 | +#ifdef CONFIG_RTL8185B | |
18833 | + priv->dma_poll_stop_mask |= TPPOLLSTOP_AC_VIQ; | |
18834 | + write_nic_byte(dev,TPPollStop, priv->dma_poll_stop_mask); | |
18835 | +#else | |
18836 | + priv->dma_poll_mask |= (1<<TX_DMA_STOP_LOWPRIORITY_SHIFT); | |
18837 | + write_nic_byte(dev,TX_DMA_POLLING,priv->dma_poll_mask); | |
18838 | +#endif | |
18839 | + rtl8180_set_mode(dev,EPROM_CMD_NORMAL); | |
18840 | +} | |
18841 | + | |
18842 | + | |
18843 | +void rtl8180_data_hard_resume(struct net_device *dev) | |
18844 | +{ | |
18845 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
18846 | + | |
18847 | + rtl8180_set_mode(dev,EPROM_CMD_CONFIG); | |
18848 | +#ifdef CONFIG_RTL8185B | |
18849 | + priv->dma_poll_stop_mask &= ~(TPPOLLSTOP_AC_VIQ); | |
18850 | + write_nic_byte(dev,TPPollStop, priv->dma_poll_stop_mask); | |
18851 | +#else | |
18852 | + priv->dma_poll_mask &= ~(1<<TX_DMA_STOP_LOWPRIORITY_SHIFT); | |
18853 | + write_nic_byte(dev,TX_DMA_POLLING,priv->dma_poll_mask); | |
18854 | +#endif | |
18855 | + rtl8180_set_mode(dev,EPROM_CMD_NORMAL); | |
18856 | +} | |
18857 | + | |
18858 | + | |
18859 | +/* this function TX data frames when the ieee80211 stack requires this. | |
18860 | + * It checks also if we need to stop the ieee tx queue, eventually do it | |
18861 | + */ | |
18862 | +void rtl8180_hard_data_xmit(struct sk_buff *skb,struct net_device *dev, int | |
18863 | +rate) | |
18864 | +{ | |
18865 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
18866 | + int mode; | |
18867 | + struct ieee80211_hdr_3addr *h = (struct ieee80211_hdr_3addr *) skb->data; | |
18868 | + short morefrag = (h->frame_ctl) & IEEE80211_FCTL_MOREFRAGS; | |
18869 | + unsigned long flags; | |
18870 | + int priority; | |
18871 | + //static int count = 0; | |
18872 | + | |
18873 | + mode = priv->ieee80211->iw_mode; | |
18874 | + | |
18875 | + rate = ieeerate2rtlrate(rate); | |
18876 | + /* | |
18877 | + * This function doesn't require lock because we make | |
18878 | + * sure it's called with the tx_lock already acquired. | |
18879 | + * this come from the kernel's hard_xmit callback (trought | |
18880 | + * the ieee stack, or from the try_wake_queue (again trought | |
18881 | + * the ieee stack. | |
18882 | + */ | |
18883 | +#ifdef CONFIG_RTL8185B | |
18884 | + priority = AC2Q(skb->priority); | |
18885 | +#else | |
18886 | + priority = LOW_PRIORITY; | |
18887 | +#endif | |
18888 | + spin_lock_irqsave(&priv->tx_lock,flags); | |
18889 | + | |
18890 | + if(priv->ieee80211->bHwRadioOff) | |
18891 | + { | |
18892 | + spin_unlock_irqrestore(&priv->tx_lock,flags); | |
18893 | + | |
18894 | + return; | |
18895 | + } | |
18896 | + | |
18897 | + //printk(KERN_WARNING "priority = %d@%d\n", priority, count++); | |
18898 | + if (!check_nic_enought_desc(dev, priority)){ | |
18899 | + //DMESG("Error: no descriptor left by previous TX (avail %d) ", | |
18900 | + // get_curr_tx_free_desc(dev, priority)); | |
18901 | + DMESGW("Error: no descriptor left by previous TX (avail %d) ", | |
18902 | + get_curr_tx_free_desc(dev, priority)); | |
18903 | + //printk(KERN_WARNING "==============================================================> \n"); | |
18904 | + ieee80211_stop_queue(priv->ieee80211); | |
18905 | + } | |
18906 | + rtl8180_tx(dev, skb->data, skb->len, priority, morefrag,0,rate); | |
18907 | + if (!check_nic_enought_desc(dev, priority)) | |
18908 | + ieee80211_stop_queue(priv->ieee80211); | |
18909 | + | |
18910 | + //dev_kfree_skb_any(skb); | |
18911 | + spin_unlock_irqrestore(&priv->tx_lock,flags); | |
18912 | + | |
18913 | +} | |
18914 | + | |
18915 | +/* This is a rough attempt to TX a frame | |
18916 | + * This is called by the ieee 80211 stack to TX management frames. | |
18917 | + * If the ring is full packet are dropped (for data frame the queue | |
18918 | + * is stopped before this can happen). For this reason it is better | |
18919 | + * if the descriptors are larger than the largest management frame | |
18920 | + * we intend to TX: i'm unsure what the HW does if it will not found | |
18921 | + * the last fragment of a frame because it has been dropped... | |
18922 | + * Since queues for Management and Data frames are different we | |
18923 | + * might use a different lock than tx_lock (for example mgmt_tx_lock) | |
18924 | + */ | |
18925 | +/* these function may loops if invoked with 0 descriptors or 0 len buffer*/ | |
18926 | +int rtl8180_hard_start_xmit(struct sk_buff *skb,struct net_device *dev) | |
18927 | +{ | |
18928 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
18929 | + | |
18930 | + unsigned long flags; | |
18931 | + | |
18932 | + int priority; | |
18933 | + | |
18934 | +#ifdef CONFIG_RTL8185B | |
18935 | + priority = MANAGE_PRIORITY; | |
18936 | +#else | |
18937 | + priority = NORM_PRIORITY; | |
18938 | +#endif | |
18939 | + | |
18940 | + spin_lock_irqsave(&priv->tx_lock,flags); | |
18941 | + | |
18942 | + if(priv->ieee80211->bHwRadioOff) | |
18943 | + { | |
18944 | + spin_unlock_irqrestore(&priv->tx_lock,flags); | |
18945 | + | |
18946 | + dev_kfree_skb_any(skb); | |
18947 | + return 0; | |
18948 | + } | |
18949 | + | |
18950 | + rtl8180_tx(dev, skb->data, skb->len, priority, | |
18951 | + 0, 0,ieeerate2rtlrate(priv->ieee80211->basic_rate)); | |
18952 | + | |
18953 | + priv->ieee80211->stats.tx_bytes+=skb->len; | |
18954 | + priv->ieee80211->stats.tx_packets++; | |
18955 | + spin_unlock_irqrestore(&priv->tx_lock,flags); | |
18956 | + | |
18957 | + dev_kfree_skb_any(skb); | |
18958 | + return 0; | |
18959 | +} | |
18960 | + | |
18961 | +// longpre 144+48 shortpre 72+24 | |
18962 | +u16 rtl8180_len2duration(u32 len, short rate,short* ext) | |
18963 | +{ | |
18964 | + u16 duration; | |
18965 | + u16 drift; | |
18966 | + *ext=0; | |
18967 | + | |
18968 | + switch(rate){ | |
18969 | + case 0://1mbps | |
18970 | + *ext=0; | |
18971 | + duration = ((len+4)<<4) /0x2; | |
18972 | + drift = ((len+4)<<4) % 0x2; | |
18973 | + if(drift ==0 ) break; | |
18974 | + duration++; | |
18975 | + break; | |
18976 | + | |
18977 | + case 1://2mbps | |
18978 | + *ext=0; | |
18979 | + duration = ((len+4)<<4) /0x4; | |
18980 | + drift = ((len+4)<<4) % 0x4; | |
18981 | + if(drift ==0 ) break; | |
18982 | + duration++; | |
18983 | + break; | |
18984 | + | |
18985 | + case 2: //5.5mbps | |
18986 | + *ext=0; | |
18987 | + duration = ((len+4)<<4) /0xb; | |
18988 | + drift = ((len+4)<<4) % 0xb; | |
18989 | + if(drift ==0 ) | |
18990 | + break; | |
18991 | + duration++; | |
18992 | + break; | |
18993 | + | |
18994 | + default: | |
18995 | + case 3://11mbps | |
18996 | + *ext=0; | |
18997 | + duration = ((len+4)<<4) /0x16; | |
18998 | + drift = ((len+4)<<4) % 0x16; | |
18999 | + if(drift ==0 ) | |
19000 | + break; | |
19001 | + duration++; | |
19002 | + if(drift > 6) | |
19003 | + break; | |
19004 | + *ext=1; | |
19005 | + break; | |
19006 | + } | |
19007 | + | |
19008 | + return duration; | |
19009 | +} | |
19010 | + | |
19011 | + | |
19012 | +void rtl8180_prepare_beacon(struct net_device *dev) | |
19013 | +{ | |
19014 | + | |
19015 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
19016 | + | |
19017 | + struct sk_buff *skb; | |
19018 | + | |
19019 | + u16 word = read_nic_word(dev, BcnItv); | |
19020 | + word &= ~BcnItv_BcnItv; // clear Bcn_Itv | |
19021 | + word |= cpu_to_le16(priv->ieee80211->current_network.beacon_interval);//0x64; | |
19022 | + write_nic_word(dev, BcnItv, word); | |
19023 | + | |
19024 | + | |
19025 | + skb = ieee80211_get_beacon(priv->ieee80211); | |
19026 | + if(skb){ | |
19027 | + rtl8180_tx(dev,skb->data,skb->len,BEACON_PRIORITY, | |
19028 | + 0,0,ieeerate2rtlrate(priv->ieee80211->basic_rate)); | |
19029 | + dev_kfree_skb_any(skb); | |
19030 | + } | |
19031 | + #if 0 | |
19032 | + //DMESG("size %x",len); | |
19033 | + if(*tail & (1<<31)){ | |
19034 | + | |
19035 | + //DMESG("No more beacon TX desc"); | |
19036 | + return ; | |
19037 | + | |
19038 | + } | |
19039 | + //while(! *tail & (1<<31)){ | |
19040 | + *tail= 0; // zeroes header | |
19041 | + | |
19042 | + *tail = *tail| (1<<29) ; //fist segment of the packet | |
19043 | + *tail = (*tail) | (1<<28); // last segment | |
19044 | + // *tail = *tail | (1<<18); // this is a beacon frame | |
19045 | + *(tail+3)=*(tail+3) &~ 0xfff; | |
19046 | + *(tail+3)=*(tail+3) | len; // buffer lenght | |
19047 | + *tail = *tail |len; | |
19048 | + // zeroes the second 32-bits dword of the descriptor | |
19049 | + *(tail+1)= 0; | |
19050 | + *tail = *tail | (rate << 24); | |
19051 | + | |
19052 | + duration = rtl8180_len2duration(len,rate,&ext); | |
19053 | + | |
19054 | + *(tail+1) = *(tail+1) | ((duration & 0x7fff)<<16); | |
19055 | + | |
19056 | + *tail = *tail | (1<<31); | |
19057 | + //^ descriptor ready to be txed | |
19058 | + if((tail - begin)/8 == priv->txbeaconcount-1) | |
19059 | + tail=begin; | |
19060 | + else | |
19061 | + tail=tail+8; | |
19062 | + //} | |
19063 | +#endif | |
19064 | +} | |
19065 | + | |
19066 | +/* This function do the real dirty work: it enqueues a TX command | |
19067 | + * descriptor in the ring buffer, copyes the frame in a TX buffer | |
19068 | + * and kicks the NIC to ensure it does the DMA transfer. | |
19069 | + */ | |
19070 | +short rtl8180_tx(struct net_device *dev, u8* txbuf, int len, int priority, | |
19071 | + short morefrag, short descfrag, int rate) | |
19072 | +{ | |
19073 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
19074 | + u32 *tail,*temp_tail; | |
19075 | + u32 *begin; | |
19076 | + u32 *buf; | |
19077 | + int i; | |
19078 | + int remain; | |
19079 | + int buflen; | |
19080 | + int count; | |
19081 | + //u16 AckCtsTime; | |
19082 | + //u16 FrameTime; | |
19083 | + u16 duration; | |
19084 | + short ext; | |
19085 | + struct buffer* buflist; | |
19086 | + //unsigned long flags; | |
19087 | +#ifdef CONFIG_RTL8185B | |
19088 | + struct ieee80211_hdr_3addr *frag_hdr = (struct ieee80211_hdr_3addr *)txbuf; | |
19089 | + u8 dest[ETH_ALEN]; | |
19090 | + u8 bUseShortPreamble = 0; | |
19091 | + u8 bCTSEnable = 0; | |
19092 | + u8 bRTSEnable = 0; | |
19093 | + //u16 RTSRate = 22; | |
19094 | + //u8 RetryLimit = 0; | |
19095 | + u16 Duration = 0; | |
19096 | + u16 RtsDur = 0; | |
19097 | + u16 ThisFrameTime = 0; | |
19098 | + u16 TxDescDuration = 0; | |
19099 | + u8 ownbit_flag = false; //added by david woo for sync Tx, 2007.12.14 | |
19100 | +#endif | |
19101 | + | |
19102 | + switch(priority) { | |
19103 | + case MANAGE_PRIORITY: | |
19104 | + tail=priv->txmapringtail; | |
19105 | + begin=priv->txmapring; | |
19106 | + buflist = priv->txmapbufstail; | |
19107 | + count = priv->txringcount; | |
19108 | + break; | |
19109 | + | |
19110 | + case BK_PRIORITY: | |
19111 | + tail=priv->txbkpringtail; | |
19112 | + begin=priv->txbkpring; | |
19113 | + buflist = priv->txbkpbufstail; | |
19114 | + count = priv->txringcount; | |
19115 | + break; | |
19116 | + | |
19117 | + case BE_PRIORITY: | |
19118 | + tail=priv->txbepringtail; | |
19119 | + begin=priv->txbepring; | |
19120 | + buflist = priv->txbepbufstail; | |
19121 | + count = priv->txringcount; | |
19122 | + break; | |
19123 | + | |
19124 | + case VI_PRIORITY: | |
19125 | + tail=priv->txvipringtail; | |
19126 | + begin=priv->txvipring; | |
19127 | + buflist = priv->txvipbufstail; | |
19128 | + count = priv->txringcount; | |
19129 | + break; | |
19130 | + | |
19131 | + case VO_PRIORITY: | |
19132 | + tail=priv->txvopringtail; | |
19133 | + begin=priv->txvopring; | |
19134 | + buflist = priv->txvopbufstail; | |
19135 | + count = priv->txringcount; | |
19136 | + break; | |
19137 | + | |
19138 | + case HI_PRIORITY: | |
19139 | + tail=priv->txhpringtail; | |
19140 | + begin=priv->txhpring; | |
19141 | + buflist = priv->txhpbufstail; | |
19142 | + count = priv->txringcount; | |
19143 | + break; | |
19144 | + | |
19145 | + case BEACON_PRIORITY: | |
19146 | + tail=priv->txbeaconringtail; | |
19147 | + begin=priv->txbeaconring; | |
19148 | + buflist = priv->txbeaconbufstail; | |
19149 | + count = priv->txbeaconcount; | |
19150 | + break; | |
19151 | + | |
19152 | + default: | |
19153 | + return -1; | |
19154 | + break; | |
19155 | + } | |
19156 | + | |
19157 | + //printk("in rtl8180_tx(): rate is %d\n",priv->ieee80211->rate); | |
19158 | +#if 1 | |
19159 | + memcpy(&dest, frag_hdr->addr1, ETH_ALEN); | |
19160 | + if (is_multicast_ether_addr(dest) || | |
19161 | + is_broadcast_ether_addr(dest)) | |
19162 | + { | |
19163 | + Duration = 0; | |
19164 | + RtsDur = 0; | |
19165 | + bRTSEnable = 0; | |
19166 | + bCTSEnable = 0; | |
19167 | + | |
19168 | + ThisFrameTime = ComputeTxTime(len + sCrcLng, rtl8180_rate2rate(rate), 0, bUseShortPreamble); | |
19169 | + TxDescDuration = ThisFrameTime; | |
19170 | + } else {// Unicast packet | |
19171 | + //u8 AckRate; | |
19172 | + u16 AckTime; | |
19173 | + | |
19174 | + //YJ,add,080828,for Keep alive | |
19175 | + priv->NumTxUnicast++; | |
19176 | + | |
19177 | + // Figure out ACK rate according to BSS basic rate and Tx rate, 2006.03.08 by rcnjko. | |
19178 | + //AckRate = ComputeAckRate( pMgntInfo->mBrates, (u1Byte)(pTcb->DataRate) ); | |
19179 | + // Figure out ACK time according to the AckRate and assume long preamble is used on receiver, 2006.03.08, by rcnjko. | |
19180 | + //AckTime = ComputeTxTime( sAckCtsLng/8, AckRate, FALSE, FALSE); | |
19181 | + //For simplicity, just use the 1M basic rate | |
19182 | + //AckTime = ComputeTxTime(14, 540,0, 0); // AckCTSLng = 14 use 1M bps send | |
19183 | + AckTime = ComputeTxTime(14, 10,0, 0); // AckCTSLng = 14 use 1M bps send | |
19184 | + //AckTime = ComputeTxTime(14, 2,false, false); // AckCTSLng = 14 use 1M bps send | |
19185 | + | |
19186 | + if ( ((len + sCrcLng) > priv->rts) && priv->rts ) | |
19187 | + { // RTS/CTS. | |
19188 | + u16 RtsTime, CtsTime; | |
19189 | + //u16 CtsRate; | |
19190 | + bRTSEnable = 1; | |
19191 | + bCTSEnable = 0; | |
19192 | + | |
19193 | + // Rate and time required for RTS. | |
19194 | + RtsTime = ComputeTxTime( sAckCtsLng/8,priv->ieee80211->basic_rate, 0, 0); | |
19195 | + // Rate and time required for CTS. | |
19196 | + CtsTime = ComputeTxTime(14, 10,0, 0); // AckCTSLng = 14 use 1M bps send | |
19197 | + | |
19198 | + // Figure out time required to transmit this frame. | |
19199 | + ThisFrameTime = ComputeTxTime(len + sCrcLng, | |
19200 | + rtl8180_rate2rate(rate), | |
19201 | + 0, | |
19202 | + bUseShortPreamble); | |
19203 | + | |
19204 | + // RTS-CTS-ThisFrame-ACK. | |
19205 | + RtsDur = CtsTime + ThisFrameTime + AckTime + 3*aSifsTime; | |
19206 | + | |
19207 | + TxDescDuration = RtsTime + RtsDur; | |
19208 | + } | |
19209 | + else {// Normal case. | |
19210 | + bCTSEnable = 0; | |
19211 | + bRTSEnable = 0; | |
19212 | + RtsDur = 0; | |
19213 | + | |
19214 | + ThisFrameTime = ComputeTxTime(len + sCrcLng, rtl8180_rate2rate(rate), 0, bUseShortPreamble); | |
19215 | + TxDescDuration = ThisFrameTime + aSifsTime + AckTime; | |
19216 | + } | |
19217 | + | |
19218 | + if(!(frag_hdr->frame_ctl & IEEE80211_FCTL_MOREFRAGS)) { //no more fragment | |
19219 | + // ThisFrame-ACK. | |
19220 | + Duration = aSifsTime + AckTime; | |
19221 | + } else { // One or more fragments remained. | |
19222 | + u16 NextFragTime; | |
19223 | + NextFragTime = ComputeTxTime( len + sCrcLng, //pretend following packet length equal current packet | |
19224 | + rtl8180_rate2rate(rate), | |
19225 | + 0, | |
19226 | + bUseShortPreamble ); | |
19227 | + | |
19228 | + //ThisFrag-ACk-NextFrag-ACK. | |
19229 | + Duration = NextFragTime + 3*aSifsTime + 2*AckTime; | |
19230 | + } | |
19231 | + | |
19232 | + } // End of Unicast packet | |
19233 | + | |
19234 | + frag_hdr->duration_id = Duration; | |
19235 | +#endif | |
19236 | + | |
19237 | + buflen=priv->txbuffsize; | |
19238 | + remain=len; | |
19239 | + temp_tail = tail; | |
19240 | +//printk("================================>buflen = %d, remain = %d!\n", buflen,remain); | |
19241 | + while(remain!=0){ | |
19242 | +#ifdef DEBUG_TX_FRAG | |
19243 | + DMESG("TX iteration"); | |
19244 | +#endif | |
19245 | +#ifdef DEBUG_TX | |
19246 | + DMESG("TX: filling descriptor %x",(u32)tail); | |
19247 | +#endif | |
19248 | + mb(); | |
19249 | + if(!buflist){ | |
19250 | + DMESGE("TX buffer error, cannot TX frames. pri %d.", priority); | |
19251 | + //spin_unlock_irqrestore(&priv->tx_lock,flags); | |
19252 | + return -1; | |
19253 | + } | |
19254 | + buf=buflist->buf; | |
19255 | + | |
19256 | + if( (*tail & (1<<31)) && (priority != BEACON_PRIORITY)){ | |
19257 | + | |
19258 | + DMESGW("No more TX desc, returning %x of %x", | |
19259 | + remain,len); | |
19260 | + priv->stats.txrdu++; | |
19261 | +#ifdef DEBUG_TX_DESC | |
19262 | + check_tx_ring(dev,priority); | |
19263 | + // netif_stop_queue(dev); | |
19264 | + // netif_carrier_off(dev); | |
19265 | +#endif | |
19266 | + // spin_unlock_irqrestore(&priv->tx_lock,flags); | |
19267 | + | |
19268 | + return remain; | |
19269 | + | |
19270 | + } | |
19271 | + | |
19272 | + *tail= 0; // zeroes header | |
19273 | + *(tail+1) = 0; | |
19274 | + *(tail+3) = 0; | |
19275 | + *(tail+5) = 0; | |
19276 | + *(tail+6) = 0; | |
19277 | + *(tail+7) = 0; | |
19278 | + | |
19279 | + if(priv->card_8185){ | |
19280 | + //FIXME: this should be triggered by HW encryption parameters. | |
19281 | + *tail |= (1<<15); //no encrypt | |
19282 | +// *tail |= (1<<30); //raise int when completed | |
19283 | + } | |
19284 | + // *tail = *tail | (1<<16); | |
19285 | + if(remain==len && !descfrag) { | |
19286 | + ownbit_flag = false; //added by david woo,2007.12.14 | |
19287 | +#ifdef DEBUG_TX_FRAG | |
19288 | + DMESG("First descriptor"); | |
19289 | +#endif | |
19290 | + *tail = *tail| (1<<29) ; //fist segment of the packet | |
19291 | + *tail = *tail |(len); | |
19292 | + } else { | |
19293 | + ownbit_flag = true; | |
19294 | + } | |
19295 | + | |
19296 | + for(i=0;i<buflen&& remain >0;i++,remain--){ | |
19297 | + ((u8*)buf)[i]=txbuf[i]; //copy data into descriptor pointed DMAble buffer | |
19298 | + if(remain == 4 && i+4 >= buflen) break; | |
19299 | + /* ensure the last desc has at least 4 bytes payload */ | |
19300 | + | |
19301 | + } | |
19302 | + txbuf = txbuf + i; | |
19303 | + *(tail+3)=*(tail+3) &~ 0xfff; | |
19304 | + *(tail+3)=*(tail+3) | i; // buffer lenght | |
19305 | + // Use short preamble or not | |
19306 | + if (priv->ieee80211->current_network.capability&WLAN_CAPABILITY_SHORT_PREAMBLE) | |
19307 | + if (priv->plcp_preamble_mode==1 && rate!=0) // short mode now, not long! | |
19308 | + // *tail |= (1<<16); // enable short preamble mode. | |
19309 | + | |
19310 | +#ifdef CONFIG_RTL8185B | |
19311 | + if(bCTSEnable) { | |
19312 | + *tail |= (1<<18); | |
19313 | + } | |
19314 | + | |
19315 | + if(bRTSEnable) //rts enable | |
19316 | + { | |
19317 | + *tail |= ((ieeerate2rtlrate(priv->ieee80211->basic_rate))<<19);//RTS RATE | |
19318 | + *tail |= (1<<23);//rts enable | |
19319 | + *(tail+1) |=(RtsDur&0xffff);//RTS Duration | |
19320 | + } | |
19321 | + *(tail+3) |= ((TxDescDuration&0xffff)<<16); //DURATION | |
19322 | +// *(tail+3) |= (0xe6<<16); | |
19323 | + *(tail+5) |= (11<<8);//(priv->retry_data<<8); //retry lim ; | |
19324 | +#else | |
19325 | + //Use RTS or not | |
19326 | +#ifdef CONFIG_RTL8187B | |
19327 | + if ( (len>priv->rts) && priv->rts && priority!=MANAGE_PRIORITY){ | |
19328 | +#else | |
19329 | + if ( (len>priv->rts) && priv->rts && priority==LOW_PRIORITY){ | |
19330 | +#endif | |
19331 | + *tail |= (1<<23); //enalbe RTS function | |
19332 | + *tail |= (0<<19); //use 1M bps send RTS packet | |
19333 | + AckCtsTime = ComputeTxTime(14, 10,0, 0); // AckCTSLng = 14 use 1M bps send | |
19334 | + FrameTime = ComputeTxTime(len + 4, rtl8180_rate2rate(rate), 0, *tail&(1<<16)); | |
19335 | + // RTS/CTS time is calculate as follow | |
19336 | + duration = FrameTime + 3*10 + 2*AckCtsTime; //10us is the SifsTime; | |
19337 | + *(tail+1) |= duration; //Need to edit here! ----hikaru | |
19338 | + }else{ | |
19339 | + *(tail+1)= 0; // zeroes the second 32-bits dword of the descriptor | |
19340 | + } | |
19341 | +#endif | |
19342 | + | |
19343 | + *tail = *tail | ((rate&0xf) << 24); | |
19344 | + //DMESG("rate %d",rate); | |
19345 | + | |
19346 | + if(priv->card_8185){ | |
19347 | + | |
19348 | + #if 0 | |
19349 | + *(tail+5)&= ~(1<<24); /* tx ant 0 */ | |
19350 | + | |
19351 | + *(tail+5) &= ~(1<<23); /* random tx agc 23-16 */ | |
19352 | + *(tail+5) |= (1<<22)|(1<<21)|(1<<20)|(1<<19)|(1<<18)|(1<<17)|(1<<16); | |
19353 | + | |
19354 | + *(tail+5) &= | |
19355 | +~((1<<15)|(1<<14)|(1<<13)|(1<<12)|(1<<11)|(1<<10)|(1<<9)|(1<<8)); | |
19356 | + *(tail+5) |= (7<<8); // Max retry limit | |
19357 | + | |
19358 | + *(tail+5) &= ~((1<<7)|(1<<6)|(1<<5)|(1<<4)|(1<<3)|(1<<2)|(1<<1)|(1<<0)); | |
19359 | + *(tail+5) |= (8<<4); // Max contention window | |
19360 | + *(tail+6) |= 4; // Min contention window | |
19361 | + #endif | |
19362 | + // *(tail+5) = 0; | |
19363 | + } | |
19364 | + | |
19365 | + /* hw_plcp_len is not used for rtl8180 chip */ | |
19366 | + /* FIXME */ | |
19367 | + if(priv->card_8185 == 0 || !priv->hw_plcp_len){ | |
19368 | + | |
19369 | + duration = rtl8180_len2duration(len, | |
19370 | + rate,&ext); | |
19371 | + | |
19372 | + | |
19373 | +#ifdef DEBUG_TX | |
19374 | + DMESG("PLCP duration %d",duration ); | |
19375 | + //DMESG("drift %d",drift); | |
19376 | + DMESG("extension %s", (ext==1) ? "on":"off"); | |
19377 | +#endif | |
19378 | + *(tail+1) = *(tail+1) | ((duration & 0x7fff)<<16); | |
19379 | + if(ext) *(tail+1) = *(tail+1) |(1<<31); //plcp length extension | |
19380 | + } | |
19381 | + | |
19382 | + if(morefrag) *tail = (*tail) | (1<<17); // more fragment | |
19383 | + if(!remain) *tail = (*tail) | (1<<28); // last segment of frame | |
19384 | + | |
19385 | +#ifdef DEBUG_TX_FRAG | |
19386 | + if(!remain)DMESG("Last descriptor"); | |
19387 | + if(morefrag)DMESG("More frag"); | |
19388 | +#endif | |
19389 | + *(tail+5) = *(tail+5)|(2<<27); | |
19390 | + *(tail+7) = *(tail+7)|(1<<4); | |
19391 | + | |
19392 | + wmb(); | |
19393 | + if(ownbit_flag) | |
19394 | + { | |
19395 | + *tail = *tail | (1<<31); // descriptor ready to be txed | |
19396 | + } | |
19397 | + | |
19398 | +#ifdef DEBUG_TX_DESC2 | |
19399 | + printk("tx desc is:\n"); | |
19400 | + DMESG("%8x %8x %8x %8x %8x %8x %8x %8x", tail[0], tail[1], tail[2], tail[3], | |
19401 | + tail[4], tail[5], tail[6], tail[7]); | |
19402 | +#endif | |
19403 | + | |
19404 | + if((tail - begin)/8 == count-1) | |
19405 | + tail=begin; | |
19406 | + | |
19407 | + else | |
19408 | + tail=tail+8; | |
19409 | + | |
19410 | + buflist=buflist->next; | |
19411 | + | |
19412 | + mb(); | |
19413 | + | |
19414 | + switch(priority) { | |
19415 | + case MANAGE_PRIORITY: | |
19416 | + priv->txmapringtail=tail; | |
19417 | + priv->txmapbufstail=buflist; | |
19418 | + break; | |
19419 | + | |
19420 | + case BK_PRIORITY: | |
19421 | + priv->txbkpringtail=tail; | |
19422 | + priv->txbkpbufstail=buflist; | |
19423 | + break; | |
19424 | + | |
19425 | + case BE_PRIORITY: | |
19426 | + priv->txbepringtail=tail; | |
19427 | + priv->txbepbufstail=buflist; | |
19428 | + break; | |
19429 | + | |
19430 | + case VI_PRIORITY: | |
19431 | + priv->txvipringtail=tail; | |
19432 | + priv->txvipbufstail=buflist; | |
19433 | + break; | |
19434 | + | |
19435 | + case VO_PRIORITY: | |
19436 | + priv->txvopringtail=tail; | |
19437 | + priv->txvopbufstail=buflist; | |
19438 | + break; | |
19439 | + | |
19440 | + case HI_PRIORITY: | |
19441 | + priv->txhpringtail=tail; | |
19442 | + priv->txhpbufstail = buflist; | |
19443 | + break; | |
19444 | + | |
19445 | + case BEACON_PRIORITY: | |
19446 | + /* the HW seems to be happy with the 1st | |
19447 | + * descriptor filled and the 2nd empty... | |
19448 | + * So always update descriptor 1 and never | |
19449 | + * touch 2nd | |
19450 | + */ | |
19451 | + // priv->txbeaconringtail=tail; | |
19452 | + // priv->txbeaconbufstail=buflist; | |
19453 | + | |
19454 | + break; | |
19455 | + | |
19456 | + } | |
19457 | + | |
19458 | + //rtl8180_dma_kick(dev,priority); | |
19459 | + } | |
19460 | + *temp_tail = *temp_tail | (1<<31); // descriptor ready to be txed | |
19461 | + rtl8180_dma_kick(dev,priority); | |
19462 | + //spin_unlock_irqrestore(&priv->tx_lock,flags); | |
19463 | + | |
19464 | + return 0; | |
19465 | + | |
19466 | +} | |
19467 | + | |
19468 | + | |
19469 | +void rtl8180_irq_rx_tasklet(struct r8180_priv * priv); | |
19470 | + | |
19471 | + | |
19472 | +void rtl8180_link_change(struct net_device *dev) | |
19473 | +{ | |
19474 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
19475 | + u16 beacon_interval; | |
19476 | + | |
19477 | + struct ieee80211_network *net = &priv->ieee80211->current_network; | |
19478 | +// rtl8180_adapter_start(dev); | |
19479 | + rtl8180_update_msr(dev); | |
19480 | + | |
19481 | + | |
19482 | + rtl8180_set_mode(dev,EPROM_CMD_CONFIG); | |
19483 | + | |
19484 | + write_nic_dword(dev,BSSID,((u32*)net->bssid)[0]); | |
19485 | + write_nic_word(dev,BSSID+4,((u16*)net->bssid)[2]); | |
19486 | + | |
19487 | + | |
19488 | + beacon_interval = read_nic_dword(dev,BEACON_INTERVAL); | |
19489 | + beacon_interval &= ~ BEACON_INTERVAL_MASK; | |
19490 | + beacon_interval |= net->beacon_interval; | |
19491 | + write_nic_dword(dev, BEACON_INTERVAL, beacon_interval); | |
19492 | + | |
19493 | + rtl8180_set_mode(dev, EPROM_CMD_NORMAL); | |
19494 | + | |
19495 | + | |
19496 | + /* | |
19497 | + u16 atim = read_nic_dword(dev,ATIM); | |
19498 | + u16 = u16 &~ ATIM_MASK; | |
19499 | + u16 = u16 | beacon->atim; | |
19500 | + */ | |
19501 | +#if 0 | |
19502 | + if (net->capability & WLAN_CAPABILITY_PRIVACY) { | |
19503 | + if (priv->hw_wep) { | |
19504 | + DMESG("Enabling hardware WEP support"); | |
19505 | + rtl8180_set_hw_wep(dev); | |
19506 | + priv->ieee80211->host_encrypt=0; | |
19507 | + priv->ieee80211->host_decrypt=0; | |
19508 | + } | |
19509 | +#ifndef CONFIG_IEEE80211_NOWEP | |
19510 | + else { | |
19511 | + priv->ieee80211->host_encrypt=1; | |
19512 | + priv->ieee80211->host_decrypt=1; | |
19513 | + } | |
19514 | +#endif | |
19515 | + } | |
19516 | +#ifndef CONFIG_IEEE80211_NOWEP | |
19517 | + else{ | |
19518 | + priv->ieee80211->host_encrypt=0; | |
19519 | + priv->ieee80211->host_decrypt=0; | |
19520 | + } | |
19521 | +#endif | |
19522 | +#endif | |
19523 | + | |
19524 | + | |
19525 | + if(priv->card_8185) | |
19526 | + rtl8180_set_chan(dev, priv->chan); | |
19527 | + | |
19528 | + | |
19529 | +} | |
19530 | + | |
19531 | +void rtl8180_rq_tx_ack(struct net_device *dev){ | |
19532 | + | |
19533 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
19534 | +// printk("====================>%s\n",__FUNCTION__); | |
19535 | + write_nic_byte(dev,CONFIG4,read_nic_byte(dev,CONFIG4)|CONFIG4_PWRMGT); | |
19536 | + priv->ack_tx_to_ieee = 1; | |
19537 | +} | |
19538 | + | |
19539 | +short rtl8180_is_tx_queue_empty(struct net_device *dev){ | |
19540 | + | |
19541 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
19542 | + u32* d; | |
19543 | + | |
19544 | + for (d = priv->txmapring; | |
19545 | + d < priv->txmapring + priv->txringcount;d+=8) | |
19546 | + if(*d & (1<<31)) return 0; | |
19547 | + | |
19548 | + for (d = priv->txbkpring; | |
19549 | + d < priv->txbkpring + priv->txringcount;d+=8) | |
19550 | + if(*d & (1<<31)) return 0; | |
19551 | + | |
19552 | + for (d = priv->txbepring; | |
19553 | + d < priv->txbepring + priv->txringcount;d+=8) | |
19554 | + if(*d & (1<<31)) return 0; | |
19555 | + | |
19556 | + for (d = priv->txvipring; | |
19557 | + d < priv->txvipring + priv->txringcount;d+=8) | |
19558 | + if(*d & (1<<31)) return 0; | |
19559 | + | |
19560 | + for (d = priv->txvopring; | |
19561 | + d < priv->txvopring + priv->txringcount;d+=8) | |
19562 | + if(*d & (1<<31)) return 0; | |
19563 | + | |
19564 | + for (d = priv->txhpring; | |
19565 | + d < priv->txhpring + priv->txringcount;d+=8) | |
19566 | + if(*d & (1<<31)) return 0; | |
19567 | + return 1; | |
19568 | +} | |
19569 | +/* FIXME FIXME 5msecs is random */ | |
19570 | +#define HW_WAKE_DELAY 5 | |
19571 | + | |
19572 | +void rtl8180_hw_wakeup(struct net_device *dev) | |
19573 | +{ | |
19574 | + unsigned long flags; | |
19575 | + | |
19576 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
19577 | + | |
19578 | + spin_lock_irqsave(&priv->ps_lock,flags); | |
19579 | + //DMESG("Waken up!"); | |
19580 | + write_nic_byte(dev,CONFIG4,read_nic_byte(dev,CONFIG4)&~CONFIG4_PWRMGT); | |
19581 | + | |
19582 | + if(priv->rf_wakeup) | |
19583 | + priv->rf_wakeup(dev); | |
19584 | +// mdelay(HW_WAKE_DELAY); | |
19585 | + spin_unlock_irqrestore(&priv->ps_lock,flags); | |
19586 | +} | |
19587 | + | |
19588 | +void rtl8180_hw_sleep_down(struct net_device *dev) | |
19589 | +{ | |
19590 | + unsigned long flags; | |
19591 | + | |
19592 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
19593 | + | |
19594 | + spin_lock_irqsave(&priv->ps_lock,flags); | |
19595 | + //DMESG("Sleep!"); | |
19596 | + | |
19597 | + if(priv->rf_sleep) | |
19598 | + priv->rf_sleep(dev); | |
19599 | + spin_unlock_irqrestore(&priv->ps_lock,flags); | |
19600 | +} | |
19601 | + | |
19602 | + | |
19603 | +void rtl8180_hw_sleep(struct net_device *dev, u32 th, u32 tl) | |
19604 | +{ | |
19605 | + | |
19606 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
19607 | + | |
19608 | + u32 rb = jiffies; | |
19609 | + unsigned long flags; | |
19610 | + | |
19611 | + spin_lock_irqsave(&priv->ps_lock,flags); | |
19612 | + | |
19613 | + /* Writing HW register with 0 equals to disable | |
19614 | + * the timer, that is not really what we want | |
19615 | + */ | |
19616 | + tl -= MSECS(4+16+7); | |
19617 | + | |
19618 | + //if(tl == 0) tl = 1; | |
19619 | + | |
19620 | + /* FIXME HACK FIXME HACK */ | |
19621 | +// force_pci_posting(dev); | |
19622 | + //mdelay(1); | |
19623 | + | |
19624 | +// rb = read_nic_dword(dev, TSFTR); | |
19625 | + | |
19626 | + /* If the interval in witch we are requested to sleep is too | |
19627 | + * short then give up and remain awake | |
19628 | + */ | |
19629 | + if(((tl>=rb)&& (tl-rb) <= MSECS(MIN_SLEEP_TIME)) | |
19630 | + ||((rb>tl)&& (rb-tl) < MSECS(MIN_SLEEP_TIME))) { | |
19631 | + spin_unlock_irqrestore(&priv->ps_lock,flags); | |
19632 | + printk("too short to sleep\n"); | |
19633 | + return; | |
19634 | + } | |
19635 | + | |
19636 | +// write_nic_dword(dev, TimerInt, tl); | |
19637 | +// rb = read_nic_dword(dev, TSFTR); | |
19638 | + { | |
19639 | + u32 tmp = (tl>rb)?(tl-rb):(rb-tl); | |
19640 | + // if (tl<rb) | |
19641 | + | |
19642 | + //lzm,add,080828 | |
19643 | + priv->DozePeriodInPast2Sec += jiffies_to_msecs(tmp); | |
19644 | + | |
19645 | + queue_delayed_work(priv->ieee80211->wq, &priv->ieee80211->hw_wakeup_wq, tmp); //as tl may be less than rb | |
19646 | + } | |
19647 | + /* if we suspect the TimerInt is gone beyond tl | |
19648 | + * while setting it, then give up | |
19649 | + */ | |
19650 | +#if 1 | |
19651 | + if(((tl > rb) && ((tl-rb) > MSECS(MAX_SLEEP_TIME)))|| | |
19652 | + ((tl < rb) && ((rb-tl) > MSECS(MAX_SLEEP_TIME)))) { | |
19653 | + spin_unlock_irqrestore(&priv->ps_lock,flags); | |
19654 | + return; | |
19655 | + } | |
19656 | +#endif | |
19657 | +// if(priv->rf_sleep) | |
19658 | +// priv->rf_sleep(dev); | |
19659 | + | |
19660 | + queue_work(priv->ieee80211->wq, (void *)&priv->ieee80211->hw_sleep_wq); | |
19661 | + spin_unlock_irqrestore(&priv->ps_lock,flags); | |
19662 | +} | |
19663 | + | |
19664 | + | |
19665 | +//void rtl8180_wmm_param_update(struct net_device *dev,u8 *ac_param) | |
19666 | +#if LINUX_VERSION_CODE >=KERNEL_VERSION(2,6,20) | |
19667 | +void rtl8180_wmm_param_update(struct work_struct * work) | |
19668 | +{ | |
19669 | + struct ieee80211_device * ieee = container_of(work, struct ieee80211_device,wmm_param_update_wq); | |
19670 | + //struct r8180_priv *priv = (struct r8180_priv*)(ieee->priv); | |
19671 | + struct net_device *dev = ieee->dev; | |
19672 | +#else | |
19673 | +void rtl8180_wmm_param_update(struct ieee80211_device *ieee) | |
19674 | +{ | |
19675 | + struct net_device *dev = ieee->dev; | |
19676 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
19677 | +#endif | |
19678 | + u8 *ac_param = (u8 *)(ieee->current_network.wmm_param); | |
19679 | + u8 mode = ieee->current_network.mode; | |
19680 | + AC_CODING eACI; | |
19681 | + AC_PARAM AcParam; | |
19682 | + PAC_PARAM pAcParam; | |
19683 | + u8 i; | |
19684 | + | |
19685 | +#ifndef CONFIG_RTL8185B | |
19686 | + //for legacy 8185 keep the PARAM unchange. | |
19687 | + return; | |
19688 | +#else | |
19689 | + if(!ieee->current_network.QoS_Enable){ | |
19690 | + //legacy ac_xx_param update | |
19691 | + AcParam.longData = 0; | |
19692 | + AcParam.f.AciAifsn.f.AIFSN = 2; // Follow 802.11 DIFS. | |
19693 | + AcParam.f.AciAifsn.f.ACM = 0; | |
19694 | + AcParam.f.Ecw.f.ECWmin = 3; // Follow 802.11 CWmin. | |
19695 | + AcParam.f.Ecw.f.ECWmax = 7; // Follow 802.11 CWmax. | |
19696 | + AcParam.f.TXOPLimit = 0; | |
19697 | + for(eACI = 0; eACI < AC_MAX; eACI++){ | |
19698 | + AcParam.f.AciAifsn.f.ACI = (u8)eACI; | |
19699 | + { | |
19700 | + u8 u1bAIFS; | |
19701 | + u32 u4bAcParam; | |
19702 | + pAcParam = (PAC_PARAM)(&AcParam); | |
19703 | + // Retrive paramters to udpate. | |
19704 | + u1bAIFS = pAcParam->f.AciAifsn.f.AIFSN *(((mode&IEEE_G) == IEEE_G)?9:20) + aSifsTime; | |
19705 | + u4bAcParam = ((((u32)(pAcParam->f.TXOPLimit))<<AC_PARAM_TXOP_LIMIT_OFFSET)| | |
19706 | + (((u32)(pAcParam->f.Ecw.f.ECWmax))<<AC_PARAM_ECW_MAX_OFFSET)| | |
19707 | + (((u32)(pAcParam->f.Ecw.f.ECWmin))<<AC_PARAM_ECW_MIN_OFFSET)| | |
19708 | + (((u32)u1bAIFS) << AC_PARAM_AIFS_OFFSET)); | |
19709 | + switch(eACI){ | |
19710 | + case AC1_BK: | |
19711 | + write_nic_dword(dev, AC_BK_PARAM, u4bAcParam); | |
19712 | + break; | |
19713 | + | |
19714 | + case AC0_BE: | |
19715 | + write_nic_dword(dev, AC_BE_PARAM, u4bAcParam); | |
19716 | + break; | |
19717 | + | |
19718 | + case AC2_VI: | |
19719 | + write_nic_dword(dev, AC_VI_PARAM, u4bAcParam); | |
19720 | + break; | |
19721 | + | |
19722 | + case AC3_VO: | |
19723 | + write_nic_dword(dev, AC_VO_PARAM, u4bAcParam); | |
19724 | + break; | |
19725 | + | |
19726 | + default: | |
19727 | + printk(KERN_WARNING "SetHwReg8185():invalid ACI: %d!\n", eACI); | |
19728 | + break; | |
19729 | + } | |
19730 | + } | |
19731 | + } | |
19732 | + return; | |
19733 | + } | |
19734 | + | |
19735 | + for(i = 0; i < AC_MAX; i++){ | |
19736 | + //AcParam.longData = 0; | |
19737 | + pAcParam = (AC_PARAM * )ac_param; | |
19738 | + { | |
19739 | + AC_CODING eACI; | |
19740 | + u8 u1bAIFS; | |
19741 | + u32 u4bAcParam; | |
19742 | + | |
19743 | + // Retrive paramters to udpate. | |
19744 | + eACI = pAcParam->f.AciAifsn.f.ACI; | |
19745 | + //Mode G/A: slotTimeTimer = 9; Mode B: 20 | |
19746 | + u1bAIFS = pAcParam->f.AciAifsn.f.AIFSN * (((mode&IEEE_G) == IEEE_G)?9:20) + aSifsTime; | |
19747 | + u4bAcParam = ( (((u32)(pAcParam->f.TXOPLimit)) << AC_PARAM_TXOP_LIMIT_OFFSET) | | |
19748 | + (((u32)(pAcParam->f.Ecw.f.ECWmax)) << AC_PARAM_ECW_MAX_OFFSET) | | |
19749 | + (((u32)(pAcParam->f.Ecw.f.ECWmin)) << AC_PARAM_ECW_MIN_OFFSET) | | |
19750 | + (((u32)u1bAIFS) << AC_PARAM_AIFS_OFFSET)); | |
19751 | + | |
19752 | + switch(eACI){ | |
19753 | + case AC1_BK: | |
19754 | + write_nic_dword(dev, AC_BK_PARAM, u4bAcParam); | |
19755 | + break; | |
19756 | + | |
19757 | + case AC0_BE: | |
19758 | + write_nic_dword(dev, AC_BE_PARAM, u4bAcParam); | |
19759 | + break; | |
19760 | + | |
19761 | + case AC2_VI: | |
19762 | + write_nic_dword(dev, AC_VI_PARAM, u4bAcParam); | |
19763 | + break; | |
19764 | + | |
19765 | + case AC3_VO: | |
19766 | + write_nic_dword(dev, AC_VO_PARAM, u4bAcParam); | |
19767 | + break; | |
19768 | + | |
19769 | + default: | |
19770 | + printk(KERN_WARNING "SetHwReg8185(): invalid ACI: %d !\n", eACI); | |
19771 | + break; | |
19772 | + } | |
19773 | + } | |
19774 | + ac_param += (sizeof(AC_PARAM)); | |
19775 | + } | |
19776 | +#endif | |
19777 | +} | |
19778 | + | |
19779 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
19780 | +void rtl8180_tx_irq_wq(struct work_struct *work); | |
19781 | +#else | |
19782 | +void rtl8180_tx_irq_wq(struct net_device *dev); | |
19783 | +#endif | |
19784 | + | |
19785 | + | |
19786 | + | |
19787 | + | |
19788 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
19789 | +void rtl8180_restart_wq(struct work_struct *work); | |
19790 | +//void rtl8180_rq_tx_ack(struct work_struct *work); | |
19791 | +#else | |
19792 | + void rtl8180_restart_wq(struct net_device *dev); | |
19793 | +//void rtl8180_rq_tx_ack(struct net_device *dev); | |
19794 | +#endif | |
19795 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
19796 | +void rtl8180_watch_dog_wq(struct work_struct *work); | |
19797 | +#else | |
19798 | +void rtl8180_watch_dog_wq(struct net_device *dev); | |
19799 | +#endif | |
19800 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
19801 | +void rtl8180_hw_wakeup_wq(struct work_struct *work); | |
19802 | +#else | |
19803 | +void rtl8180_hw_wakeup_wq(struct net_device *dev); | |
19804 | +#endif | |
19805 | + | |
19806 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
19807 | +void rtl8180_hw_sleep_wq(struct work_struct *work); | |
19808 | +#else | |
19809 | +void rtl8180_hw_sleep_wq(struct net_device *dev); | |
19810 | +#endif | |
19811 | + | |
19812 | + | |
19813 | + | |
19814 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
19815 | +void rtl8180_sw_antenna_wq(struct work_struct *work); | |
19816 | +#else | |
19817 | +void rtl8180_sw_antenna_wq(struct net_device *dev); | |
19818 | +#endif | |
19819 | + void rtl8180_watch_dog(struct net_device *dev); | |
19820 | +void watch_dog_adaptive(unsigned long data) | |
19821 | +{ | |
19822 | + struct r8180_priv* priv = ieee80211_priv((struct net_device *)data); | |
19823 | +// DMESG("---->watch_dog_adaptive()\n"); | |
19824 | + if(!priv->up) | |
19825 | + { | |
19826 | + DMESG("<----watch_dog_adaptive():driver is not up!\n"); | |
19827 | + return; | |
19828 | + } | |
19829 | + | |
19830 | + // queue_work(priv->ieee80211->wq,&priv->ieee80211->watch_dog_wq); | |
19831 | +//{by amy 080312 | |
19832 | +#if 1 | |
19833 | + // Tx High Power Mechanism. | |
19834 | +#ifdef HIGH_POWER | |
19835 | + if(CheckHighPower((struct net_device *)data)) | |
19836 | + { | |
19837 | + queue_work(priv->ieee80211->wq, (void *)&priv->ieee80211->tx_pw_wq); | |
19838 | + } | |
19839 | +#endif | |
19840 | + | |
19841 | +#ifdef CONFIG_RTL818X_S | |
19842 | + // Tx Power Tracking on 87SE. | |
19843 | +#ifdef TX_TRACK | |
19844 | + //if( priv->bTxPowerTrack ) //lzm mod 080826 | |
19845 | + if( CheckTxPwrTracking((struct net_device *)data)); | |
19846 | + TxPwrTracking87SE((struct net_device *)data); | |
19847 | +#endif | |
19848 | +#endif | |
19849 | + | |
19850 | + // Perform DIG immediately. | |
19851 | +#ifdef SW_DIG | |
19852 | + if(CheckDig((struct net_device *)data) == true) | |
19853 | + { | |
19854 | + queue_work(priv->ieee80211->wq, (void *)&priv->ieee80211->hw_dig_wq); | |
19855 | + } | |
19856 | +#endif | |
19857 | +#endif | |
19858 | +//by amy 080312} | |
19859 | + rtl8180_watch_dog((struct net_device *)data); | |
19860 | + | |
19861 | + | |
19862 | + queue_work(priv->ieee80211->wq, (void *)&priv->ieee80211->GPIOChangeRFWorkItem); | |
19863 | + | |
19864 | + priv->watch_dog_timer.expires = jiffies + MSECS(IEEE80211_WATCH_DOG_TIME); | |
19865 | + add_timer(&priv->watch_dog_timer); | |
19866 | +// DMESG("<----watch_dog_adaptive()\n"); | |
19867 | +} | |
19868 | + | |
19869 | +#ifdef ENABLE_DOT11D | |
19870 | + | |
19871 | +static CHANNEL_LIST ChannelPlan[] = { | |
19872 | + {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,52,56,60,64},19}, //FCC | |
19873 | + {{1,2,3,4,5,6,7,8,9,10,11},11}, //IC | |
19874 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64},21}, //ETSI | |
19875 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64},21}, //Spain. Change to ETSI. | |
19876 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64},21}, //France. Change to ETSI. | |
19877 | + {{14,36,40,44,48,52,56,60,64},9}, //MKK | |
19878 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,14, 36,40,44,48,52,56,60,64},22},//MKK1 | |
19879 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64},21}, //Israel. | |
19880 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,34,38,42,46},17}, // For 11a , TELEC | |
19881 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,14},14}, //For Global Domain. 1-11:active scan, 12-14 passive scan. //+YJ, 080626 | |
19882 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13},13} //world wide 13: ch1~ch11 active scan, ch12~13 passive //lzm add 080826 | |
19883 | +}; | |
19884 | + | |
19885 | +static void rtl8180_set_channel_map(u8 channel_plan, struct ieee80211_device *ieee) | |
19886 | +{ | |
19887 | + int i; | |
19888 | + | |
19889 | + //lzm add 080826 | |
19890 | + ieee->MinPassiveChnlNum=MAX_CHANNEL_NUMBER+1; | |
19891 | + ieee->IbssStartChnl=0; | |
19892 | + | |
19893 | + switch (channel_plan) | |
19894 | + { | |
19895 | + case COUNTRY_CODE_FCC: | |
19896 | + case COUNTRY_CODE_IC: | |
19897 | + case COUNTRY_CODE_ETSI: | |
19898 | + case COUNTRY_CODE_SPAIN: | |
19899 | + case COUNTRY_CODE_FRANCE: | |
19900 | + case COUNTRY_CODE_MKK: | |
19901 | + case COUNTRY_CODE_MKK1: | |
19902 | + case COUNTRY_CODE_ISRAEL: | |
19903 | + case COUNTRY_CODE_TELEC: | |
19904 | + { | |
19905 | + Dot11d_Init(ieee); | |
19906 | + ieee->bGlobalDomain = false; | |
19907 | + if (ChannelPlan[channel_plan].Len != 0){ | |
19908 | + // Clear old channel map | |
19909 | + memset(GET_DOT11D_INFO(ieee)->channel_map, 0, sizeof(GET_DOT11D_INFO(ieee)->channel_map)); | |
19910 | + // Set new channel map | |
19911 | + for (i=0;i<ChannelPlan[channel_plan].Len;i++) | |
19912 | + { | |
19913 | + if(ChannelPlan[channel_plan].Channel[i] <= 14) | |
19914 | + GET_DOT11D_INFO(ieee)->channel_map[ChannelPlan[channel_plan].Channel[i]] = 1; | |
19915 | + } | |
19916 | + } | |
19917 | + break; | |
19918 | + } | |
19919 | + case COUNTRY_CODE_GLOBAL_DOMAIN: | |
19920 | + { | |
19921 | + GET_DOT11D_INFO(ieee)->bEnabled = 0; | |
19922 | + Dot11d_Reset(ieee); | |
19923 | + ieee->bGlobalDomain = true; | |
19924 | + break; | |
19925 | + } | |
19926 | + case COUNTRY_CODE_WORLD_WIDE_13_INDEX://lzm add 080826 | |
19927 | + { | |
19928 | + ieee->MinPassiveChnlNum=12; | |
19929 | + ieee->IbssStartChnl= 10; | |
19930 | + break; | |
19931 | + } | |
19932 | + default: | |
19933 | + { | |
19934 | + Dot11d_Init(ieee); | |
19935 | + ieee->bGlobalDomain = false; | |
19936 | + memset(GET_DOT11D_INFO(ieee)->channel_map, 0, sizeof(GET_DOT11D_INFO(ieee)->channel_map)); | |
19937 | + for (i=1;i<=14;i++) | |
19938 | + { | |
19939 | + GET_DOT11D_INFO(ieee)->channel_map[i] = 1; | |
19940 | + } | |
19941 | + break; | |
19942 | + } | |
19943 | + } | |
19944 | +} | |
19945 | +#endif | |
19946 | + | |
19947 | +//Add for RF power on power off by lizhaoming 080512 | |
19948 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
19949 | +void GPIOChangeRFWorkItemCallBack(struct work_struct *work); | |
19950 | +#else | |
19951 | +void GPIOChangeRFWorkItemCallBack(struct ieee80211_device *ieee); | |
19952 | +#endif | |
19953 | + | |
19954 | +//YJ,add,080828 | |
19955 | +static void rtl8180_statistics_init(struct Stats *pstats) | |
19956 | +{ | |
19957 | + memset(pstats, 0, sizeof(struct Stats)); | |
19958 | +} | |
19959 | +static void rtl8180_link_detect_init(plink_detect_t plink_detect) | |
19960 | +{ | |
19961 | + memset(plink_detect, 0, sizeof(link_detect_t)); | |
19962 | + plink_detect->SlotNum = DEFAULT_SLOT_NUM; | |
19963 | +} | |
19964 | +//YJ,add,080828,end | |
19965 | + | |
19966 | +short rtl8180_init(struct net_device *dev) | |
19967 | +{ | |
19968 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
19969 | + u16 word; | |
19970 | + u16 version; | |
19971 | + u8 hw_version; | |
19972 | + //u8 config3; | |
19973 | + u32 usValue; | |
19974 | + u16 tmpu16; | |
19975 | + int i, j; | |
19976 | + | |
19977 | +#ifdef ENABLE_DOT11D | |
19978 | +#if 0 | |
19979 | + for(i=0;i<0xFF;i++) { | |
19980 | + if(i%16 == 0) | |
19981 | + printk("\n[%x]: ", i/16); | |
19982 | + printk("\t%4.4x", eprom_read(dev,i)); | |
19983 | + } | |
19984 | +#endif | |
19985 | + priv->channel_plan = eprom_read(dev, EEPROM_COUNTRY_CODE>>1) & 0xFF; | |
19986 | + if(priv->channel_plan > COUNTRY_CODE_GLOBAL_DOMAIN){ | |
19987 | + printk("rtl8180_init:Error channel plan! Set to default.\n"); | |
19988 | + priv->channel_plan = 0; | |
19989 | + } | |
19990 | + //priv->channel_plan = 9; //Global Domain | |
19991 | + | |
19992 | + DMESG("Channel plan is %d\n",priv->channel_plan); | |
19993 | + rtl8180_set_channel_map(priv->channel_plan, priv->ieee80211); | |
19994 | +#else | |
19995 | + int ch; | |
19996 | + //Set Default Channel Plan | |
19997 | + if(!channels){ | |
19998 | + DMESG("No channels, aborting"); | |
19999 | + return -1; | |
20000 | + } | |
20001 | + ch=channels; | |
20002 | + priv->channel_plan = 0;//hikaru | |
20003 | + // set channels 1..14 allowed in given locale | |
20004 | + for (i=1; i<=14; i++) { | |
20005 | + (priv->ieee80211->channel_map)[i] = (u8)(ch & 0x01); | |
20006 | + ch >>= 1; | |
20007 | + } | |
20008 | +#endif | |
20009 | + | |
20010 | + //memcpy(priv->stats,0,sizeof(struct Stats)); | |
20011 | + | |
20012 | + //FIXME: these constants are placed in a bad pleace. | |
20013 | + priv->txbuffsize = 2048;//1024; | |
20014 | + priv->txringcount = 32;//32; | |
20015 | + priv->rxbuffersize = 2048;//1024; | |
20016 | + priv->rxringcount = 64;//32; | |
20017 | + priv->txbeaconcount = 2; | |
20018 | + priv->rx_skb_complete = 1; | |
20019 | + //priv->txnp_pending.ispending=0; | |
20020 | + /* ^^ the SKB does not containt a partial RXed | |
20021 | + * packet (is empty) | |
20022 | + */ | |
20023 | + | |
20024 | +#ifdef CONFIG_RTL8185B | |
20025 | +#ifdef CONFIG_RTL818X_S | |
20026 | + priv->RegThreeWireMode = HW_THREE_WIRE_SI; | |
20027 | +#else | |
20028 | + priv->RegThreeWireMode = SW_THREE_WIRE; | |
20029 | +#endif | |
20030 | +#endif | |
20031 | + | |
20032 | +//Add for RF power on power off by lizhaoming 080512 | |
20033 | + priv->RFChangeInProgress = false; | |
20034 | + priv->SetRFPowerStateInProgress = false; | |
20035 | + priv->RFProgType = 0; | |
20036 | + priv->bInHctTest = false; | |
20037 | + | |
20038 | + priv->irq_enabled=0; | |
20039 | + | |
20040 | +//YJ,modified,080828 | |
20041 | +#if 0 | |
20042 | + priv->stats.rxdmafail=0; | |
20043 | + priv->stats.txrdu=0; | |
20044 | + priv->stats.rxrdu=0; | |
20045 | + priv->stats.rxnolast=0; | |
20046 | + priv->stats.rxnodata=0; | |
20047 | + //priv->stats.rxreset=0; | |
20048 | + //priv->stats.rxwrkaround=0; | |
20049 | + priv->stats.rxnopointer=0; | |
20050 | + priv->stats.txnperr=0; | |
20051 | + priv->stats.txresumed=0; | |
20052 | + priv->stats.rxerr=0; | |
20053 | + priv->stats.rxoverflow=0; | |
20054 | + priv->stats.rxint=0; | |
20055 | + priv->stats.txnpokint=0; | |
20056 | + priv->stats.txhpokint=0; | |
20057 | + priv->stats.txhperr=0; | |
20058 | + priv->stats.ints=0; | |
20059 | + priv->stats.shints=0; | |
20060 | + priv->stats.txoverflow=0; | |
20061 | + priv->stats.txbeacon=0; | |
20062 | + priv->stats.txbeaconerr=0; | |
20063 | + priv->stats.txlperr=0; | |
20064 | + priv->stats.txlpokint=0; | |
20065 | + priv->stats.txretry=0;//tony 20060601 | |
20066 | + priv->stats.rxcrcerrmin=0; | |
20067 | + priv->stats.rxcrcerrmid=0; | |
20068 | + priv->stats.rxcrcerrmax=0; | |
20069 | + priv->stats.rxicverr=0; | |
20070 | +#else | |
20071 | + rtl8180_statistics_init(&priv->stats); | |
20072 | + rtl8180_link_detect_init(&priv->link_detect); | |
20073 | +#endif | |
20074 | +//YJ,modified,080828,end | |
20075 | + | |
20076 | + | |
20077 | + priv->ack_tx_to_ieee = 0; | |
20078 | + priv->ieee80211->current_network.beacon_interval = DEFAULT_BEACONINTERVAL; | |
20079 | + priv->ieee80211->iw_mode = IW_MODE_INFRA; | |
20080 | + priv->ieee80211->softmac_features = IEEE_SOFTMAC_SCAN | | |
20081 | + IEEE_SOFTMAC_ASSOCIATE | IEEE_SOFTMAC_PROBERQ | | |
20082 | + IEEE_SOFTMAC_PROBERS | IEEE_SOFTMAC_TX_QUEUE; | |
20083 | + priv->ieee80211->active_scan = 1; | |
20084 | + priv->ieee80211->rate = 110; //11 mbps | |
20085 | + priv->ieee80211->modulation = IEEE80211_CCK_MODULATION; | |
20086 | + priv->ieee80211->host_encrypt = 1; | |
20087 | + priv->ieee80211->host_decrypt = 1; | |
20088 | + priv->ieee80211->sta_wake_up = rtl8180_hw_wakeup; | |
20089 | + priv->ieee80211->ps_request_tx_ack = rtl8180_rq_tx_ack; | |
20090 | + priv->ieee80211->enter_sleep_state = rtl8180_hw_sleep; | |
20091 | + priv->ieee80211->ps_is_queue_empty = rtl8180_is_tx_queue_empty; | |
20092 | + | |
20093 | + priv->hw_wep = hwwep; | |
20094 | + priv->prism_hdr=0; | |
20095 | + priv->dev=dev; | |
20096 | + priv->retry_rts = DEFAULT_RETRY_RTS; | |
20097 | + priv->retry_data = DEFAULT_RETRY_DATA; | |
20098 | + priv->RFChangeInProgress = false; | |
20099 | + priv->SetRFPowerStateInProgress = false; | |
20100 | + priv->RFProgType = 0; | |
20101 | + priv->bInHctTest = false; | |
20102 | + priv->bInactivePs = true;//false; | |
20103 | + priv->ieee80211->bInactivePs = priv->bInactivePs; | |
20104 | + priv->bSwRfProcessing = false; | |
20105 | + priv->eRFPowerState = eRfOff; | |
20106 | + priv->RfOffReason = 0; | |
20107 | + priv->LedStrategy = SW_LED_MODE0; | |
20108 | + //priv->NumRxOkInPeriod = 0; //YJ,del,080828 | |
20109 | + //priv->NumTxOkInPeriod = 0; //YJ,del,080828 | |
20110 | + priv->TxPollingTimes = 0;//lzm add 080826 | |
20111 | + priv->bLeisurePs = true; | |
20112 | + priv->dot11PowerSaveMode = eActive; | |
20113 | +//by amy for antenna | |
20114 | + priv->AdMinCheckPeriod = 5; | |
20115 | + priv->AdMaxCheckPeriod = 10; | |
20116 | +// Lower signal strength threshold to fit the HW participation in antenna diversity. +by amy 080312 | |
20117 | + priv->AdMaxRxSsThreshold = 30;//60->30 | |
20118 | + priv->AdRxSsThreshold = 20;//50->20 | |
20119 | + priv->AdCheckPeriod = priv->AdMinCheckPeriod; | |
20120 | + priv->AdTickCount = 0; | |
20121 | + priv->AdRxSignalStrength = -1; | |
20122 | + priv->RegSwAntennaDiversityMechanism = 0; | |
20123 | + priv->RegDefaultAntenna = 0; | |
20124 | + priv->SignalStrength = 0; | |
20125 | + priv->AdRxOkCnt = 0; | |
20126 | + priv->CurrAntennaIndex = 0; | |
20127 | + priv->AdRxSsBeforeSwitched = 0; | |
20128 | + init_timer(&priv->SwAntennaDiversityTimer); | |
20129 | + priv->SwAntennaDiversityTimer.data = (unsigned long)dev; | |
20130 | + priv->SwAntennaDiversityTimer.function = (void *)SwAntennaDiversityTimerCallback; | |
20131 | +//by amy for antenna | |
20132 | +//{by amy 080312 | |
20133 | + priv->bDigMechanism = 1; | |
20134 | + priv->InitialGain = 6; | |
20135 | + priv->bXtalCalibration = false; | |
20136 | + priv->XtalCal_Xin = 0; | |
20137 | + priv->XtalCal_Xout = 0; | |
20138 | + priv->bTxPowerTrack = false; | |
20139 | + priv->ThermalMeter = 0; | |
20140 | + priv->FalseAlarmRegValue = 0; | |
20141 | + priv->RegDigOfdmFaUpTh = 0xc; // Upper threhold of OFDM false alarm, which is used in DIG. | |
20142 | + priv->DIG_NumberFallbackVote = 0; | |
20143 | + priv->DIG_NumberUpgradeVote = 0; | |
20144 | + priv->LastSignalStrengthInPercent = 0; | |
20145 | + priv->Stats_SignalStrength = 0; | |
20146 | + priv->LastRxPktAntenna = 0; | |
20147 | + priv->SignalQuality = 0; // in 0-100 index. | |
20148 | + priv->Stats_SignalQuality = 0; | |
20149 | + priv->RecvSignalPower = 0; // in dBm. | |
20150 | + priv->Stats_RecvSignalPower = 0; | |
20151 | + priv->AdMainAntennaRxOkCnt = 0; | |
20152 | + priv->AdAuxAntennaRxOkCnt = 0; | |
20153 | + priv->bHWAdSwitched = false; | |
20154 | + priv->bRegHighPowerMechanism = true; | |
20155 | + priv->RegHiPwrUpperTh = 77; | |
20156 | + priv->RegHiPwrLowerTh = 75; | |
20157 | + priv->RegRSSIHiPwrUpperTh = 70; | |
20158 | + priv->RegRSSIHiPwrLowerTh = 20; | |
20159 | + priv->bCurCCKPkt = false; | |
20160 | + priv->UndecoratedSmoothedSS = -1; | |
20161 | + priv->bToUpdateTxPwr = false; | |
20162 | + priv->CurCCKRSSI = 0; | |
20163 | + priv->RxPower = 0; | |
20164 | + priv->RSSI = 0; | |
20165 | + //YJ,add,080828 | |
20166 | + priv->NumTxOkTotal = 0; | |
20167 | + priv->NumTxUnicast = 0; | |
20168 | + priv->keepAliveLevel = DEFAULT_KEEP_ALIVE_LEVEL; | |
20169 | + priv->PowerProfile = POWER_PROFILE_AC; | |
20170 | + //YJ,add,080828,end | |
20171 | +//by amy for rate adaptive | |
20172 | + priv->CurrRetryCnt=0; | |
20173 | + priv->LastRetryCnt=0; | |
20174 | + priv->LastTxokCnt=0; | |
20175 | + priv->LastRxokCnt=0; | |
20176 | + priv->LastRetryRate=0; | |
20177 | + priv->bTryuping=0; | |
20178 | + priv->CurrTxRate=0; | |
20179 | + priv->CurrRetryRate=0; | |
20180 | + priv->TryupingCount=0; | |
20181 | + priv->TryupingCountNoData=0; | |
20182 | + priv->TryDownCountLowData=0; | |
20183 | + priv->LastTxOKBytes=0; | |
20184 | + priv->LastFailTxRate=0; | |
20185 | + priv->LastFailTxRateSS=0; | |
20186 | + priv->FailTxRateCount=0; | |
20187 | + priv->LastTxThroughput=0; | |
20188 | + priv->NumTxOkBytesTotal=0; | |
20189 | + priv->ForcedDataRate = 0; | |
20190 | + priv->RegBModeGainStage = 1; | |
20191 | + | |
20192 | +//by amy for rate adaptive | |
20193 | +//by amy 080312} | |
20194 | + priv->promisc = (dev->flags & IFF_PROMISC) ? 1:0; | |
20195 | + spin_lock_init(&priv->irq_lock); | |
20196 | + spin_lock_init(&priv->irq_th_lock); | |
20197 | + spin_lock_init(&priv->tx_lock); | |
20198 | + spin_lock_init(&priv->ps_lock); | |
20199 | + spin_lock_init(&priv->rf_ps_lock); | |
20200 | + sema_init(&priv->wx_sem,1); | |
20201 | + sema_init(&priv->rf_state,1); | |
20202 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
20203 | + INIT_WORK(&priv->reset_wq,(void*) rtl8180_restart_wq); | |
20204 | + INIT_WORK(&priv->tx_irq_wq,(void*) rtl8180_tx_irq_wq); | |
20205 | + INIT_DELAYED_WORK(&priv->ieee80211->hw_wakeup_wq,(void*) rtl8180_hw_wakeup_wq); | |
20206 | + INIT_DELAYED_WORK(&priv->ieee80211->hw_sleep_wq,(void*) rtl8180_hw_sleep_wq); | |
20207 | + //INIT_DELAYED_WORK(&priv->ieee80211->watch_dog_wq,(void*) rtl8180_watch_dog_wq); | |
20208 | + //INIT_DELAYED_WORK(&priv->ieee80211->sw_antenna_wq,(void*) rtl8180_sw_antenna_wq); | |
20209 | + INIT_WORK(&priv->ieee80211->wmm_param_update_wq,(void*) rtl8180_wmm_param_update); | |
20210 | + INIT_DELAYED_WORK(&priv->ieee80211->rate_adapter_wq,(void*)rtl8180_rate_adapter);//+by amy 080312 | |
20211 | + INIT_DELAYED_WORK(&priv->ieee80211->hw_dig_wq,(void*)rtl8180_hw_dig_wq);//+by amy 080312 | |
20212 | + INIT_DELAYED_WORK(&priv->ieee80211->tx_pw_wq,(void*)rtl8180_tx_pw_wq);//+by amy 080312 | |
20213 | + | |
20214 | + //add for RF power on power off by lizhaoming 080512 | |
20215 | + INIT_DELAYED_WORK(&priv->ieee80211->GPIOChangeRFWorkItem,(void*) GPIOChangeRFWorkItemCallBack); | |
20216 | +#else | |
20217 | + INIT_WORK(&priv->reset_wq,(void*) rtl8180_restart_wq,dev); | |
20218 | + INIT_WORK(&priv->tx_irq_wq,(void*) rtl8180_tx_irq_wq,dev); | |
20219 | + //INIT_WORK(&priv->ieee80211->watch_dog_wq,(void*) rtl8180_watch_dog_wq,dev); | |
20220 | + INIT_WORK(&priv->ieee80211->hw_wakeup_wq,(void*) rtl8180_hw_wakeup_wq,dev); | |
20221 | + INIT_WORK(&priv->ieee80211->hw_sleep_wq,(void*) rtl8180_hw_sleep_wq,dev); | |
20222 | + //INIT_WORK(&priv->ieee80211->sw_antenna_wq,(void*) rtl8180_sw_antenna_wq,dev); | |
20223 | + INIT_WORK(&priv->ieee80211->wmm_param_update_wq,(void*) rtl8180_wmm_param_update,priv->ieee80211); | |
20224 | + INIT_WORK(&priv->ieee80211->rate_adapter_wq,(void*)rtl8180_rate_adapter,dev);//+by amy 080312 | |
20225 | + INIT_WORK(&priv->ieee80211->hw_dig_wq,(void*)rtl8180_hw_dig_wq,dev);//+by amy 080312 | |
20226 | + INIT_WORK(&priv->ieee80211->tx_pw_wq,(void*)rtl8180_tx_pw_wq,dev);//+by amy 080312 | |
20227 | + | |
20228 | + //add for RF power on power off by lizhaoming 080512 | |
20229 | + INIT_WORK(&priv->ieee80211->GPIOChangeRFWorkItem,(void*) GPIOChangeRFWorkItemCallBack, priv->ieee80211); | |
20230 | +#endif | |
20231 | + //INIT_WORK(&priv->reset_wq,(void*) rtl8180_restart_wq,dev); | |
20232 | + | |
20233 | + tasklet_init(&priv->irq_rx_tasklet, | |
20234 | + (void(*)(unsigned long)) rtl8180_irq_rx_tasklet, | |
20235 | + (unsigned long)priv); | |
20236 | +//by amy | |
20237 | + init_timer(&priv->watch_dog_timer); | |
20238 | + priv->watch_dog_timer.data = (unsigned long)dev; | |
20239 | + priv->watch_dog_timer.function = watch_dog_adaptive; | |
20240 | +//by amy | |
20241 | + | |
20242 | +//{by amy 080312 | |
20243 | +//by amy for rate adaptive | |
20244 | + init_timer(&priv->rateadapter_timer); | |
20245 | + priv->rateadapter_timer.data = (unsigned long)dev; | |
20246 | + priv->rateadapter_timer.function = timer_rate_adaptive; | |
20247 | + priv->RateAdaptivePeriod= RATE_ADAPTIVE_TIMER_PERIOD; | |
20248 | + priv->bEnhanceTxPwr=false; | |
20249 | +//by amy for rate adaptive | |
20250 | +//by amy 080312} | |
20251 | + //priv->ieee80211->func = | |
20252 | + // kmalloc(sizeof(struct ieee80211_helper_functions),GFP_KERNEL); | |
20253 | + //memset(priv->ieee80211->func, 0, | |
20254 | + // sizeof(struct ieee80211_helper_functions)); | |
20255 | + | |
20256 | + priv->ieee80211->softmac_hard_start_xmit = rtl8180_hard_start_xmit; | |
20257 | + priv->ieee80211->set_chan = rtl8180_set_chan; | |
20258 | + priv->ieee80211->link_change = rtl8180_link_change; | |
20259 | + priv->ieee80211->softmac_data_hard_start_xmit = rtl8180_hard_data_xmit; | |
20260 | + priv->ieee80211->data_hard_stop = rtl8180_data_hard_stop; | |
20261 | + priv->ieee80211->data_hard_resume = rtl8180_data_hard_resume; | |
20262 | + | |
20263 | + priv->ieee80211->init_wmmparam_flag = 0; | |
20264 | + | |
20265 | + priv->ieee80211->start_send_beacons = rtl8180_start_tx_beacon; | |
20266 | + priv->ieee80211->stop_send_beacons = rtl8180_beacon_tx_disable; | |
20267 | + priv->ieee80211->fts = DEFAULT_FRAG_THRESHOLD; | |
20268 | + | |
20269 | +#ifdef CONFIG_RTL8185B | |
20270 | + priv->MWIEnable = 0; | |
20271 | + | |
20272 | + priv->ShortRetryLimit = 7; | |
20273 | + priv->LongRetryLimit = 7; | |
20274 | + priv->EarlyRxThreshold = 7; | |
20275 | + | |
20276 | + priv->CSMethod = (0x01 << 29); | |
20277 | + | |
20278 | + priv->TransmitConfig = | |
20279 | + 1<<TCR_DurProcMode_OFFSET | //for RTL8185B, duration setting by HW | |
20280 | + (7<<TCR_MXDMA_OFFSET) | // Max DMA Burst Size per Tx DMA Burst, 7: reservied. | |
20281 | + (priv->ShortRetryLimit<<TCR_SRL_OFFSET) | // Short retry limit | |
20282 | + (priv->LongRetryLimit<<TCR_LRL_OFFSET) | // Long retry limit | |
20283 | + (0 ? TCR_SAT : 0); // FALSE: HW provies PLCP length and LENGEXT, TURE: SW proiveds them | |
20284 | + | |
20285 | + priv->ReceiveConfig = | |
20286 | +#ifdef CONFIG_RTL818X_S | |
20287 | +#else | |
20288 | + priv->CSMethod | | |
20289 | +#endif | |
20290 | +// RCR_ENMARP | | |
20291 | + RCR_AMF | RCR_ADF | //accept management/data | |
20292 | + RCR_ACF | //accept control frame for SW AP needs PS-poll, 2005.07.07, by rcnjko. | |
20293 | + RCR_AB | RCR_AM | RCR_APM | //accept BC/MC/UC | |
20294 | + //RCR_AICV | RCR_ACRC32 | //accept ICV/CRC error packet | |
20295 | + (7<<RCR_MXDMA_OFFSET) | // Max DMA Burst Size per Rx DMA Burst, 7: unlimited. | |
20296 | + (priv->EarlyRxThreshold<<RCR_FIFO_OFFSET) | // Rx FIFO Threshold, 7: No Rx threshold. | |
20297 | + (priv->EarlyRxThreshold == 7 ? RCR_ONLYERLPKT:0); | |
20298 | + | |
20299 | + priv->IntrMask = IMR_TMGDOK | IMR_TBDER | IMR_THPDER | | |
20300 | + IMR_THPDER | IMR_THPDOK | | |
20301 | + IMR_TVODER | IMR_TVODOK | | |
20302 | + IMR_TVIDER | IMR_TVIDOK | | |
20303 | + IMR_TBEDER | IMR_TBEDOK | | |
20304 | + IMR_TBKDER | IMR_TBKDOK | | |
20305 | + IMR_RDU | // To handle the defragmentation not enough Rx descriptors case. Annie, 2006-03-27. | |
20306 | + IMR_RER | IMR_ROK | | |
20307 | + IMR_RQoSOK; // <NOTE> ROK and RQoSOK are mutually exclusive, so, we must handle RQoSOK interrupt to receive QoS frames, 2005.12.09, by rcnjko. | |
20308 | + | |
20309 | + priv->InitialGain = 6; | |
20310 | +#endif | |
20311 | + | |
20312 | + hw_version =( read_nic_dword(dev, TCR) & TCR_HWVERID_MASK)>>TCR_HWVERID_SHIFT; | |
20313 | + | |
20314 | + switch (hw_version){ | |
20315 | +#ifdef CONFIG_RTL8185B | |
20316 | + case HW_VERID_R8185B_B: | |
20317 | +#ifdef CONFIG_RTL818X_S | |
20318 | + priv->card_8185 = VERSION_8187S_C; | |
20319 | + DMESG("MAC controller is a RTL8187SE b/g"); | |
20320 | + priv->phy_ver = 2; | |
20321 | + break; | |
20322 | +#else | |
20323 | + DMESG("MAC controller is a RTL8185B b/g"); | |
20324 | + priv->card_8185 = 3; | |
20325 | + priv->phy_ver = 2; | |
20326 | + break; | |
20327 | +#endif | |
20328 | +#endif | |
20329 | + case HW_VERID_R8185_ABC: | |
20330 | + DMESG("MAC controller is a RTL8185 b/g"); | |
20331 | + priv->card_8185 = 1; | |
20332 | + /* you should not find a card with 8225 PHY ver < C*/ | |
20333 | + priv->phy_ver = 2; | |
20334 | + break; | |
20335 | + | |
20336 | + case HW_VERID_R8185_D: | |
20337 | + DMESG("MAC controller is a RTL8185 b/g (V. D)"); | |
20338 | + priv->card_8185 = 2; | |
20339 | + /* you should not find a card with 8225 PHY ver < C*/ | |
20340 | + priv->phy_ver = 2; | |
20341 | + break; | |
20342 | + | |
20343 | + case HW_VERID_R8180_ABCD: | |
20344 | + DMESG("MAC controller is a RTL8180"); | |
20345 | + priv->card_8185 = 0; | |
20346 | + break; | |
20347 | + | |
20348 | + case HW_VERID_R8180_F: | |
20349 | + DMESG("MAC controller is a RTL8180 (v. F)"); | |
20350 | + priv->card_8185 = 0; | |
20351 | + break; | |
20352 | + | |
20353 | + default: | |
20354 | + DMESGW("MAC chip not recognized: version %x. Assuming RTL8180",hw_version); | |
20355 | + priv->card_8185 = 0; | |
20356 | + break; | |
20357 | + } | |
20358 | + | |
20359 | + if(priv->card_8185){ | |
20360 | + priv->ieee80211->modulation |= IEEE80211_OFDM_MODULATION; | |
20361 | + priv->ieee80211->short_slot = 1; | |
20362 | + } | |
20363 | + /* you should not found any 8185 Ver B Card */ | |
20364 | + priv->card_8185_Bversion = 0; | |
20365 | + | |
20366 | +#ifdef CONFIG_RTL8185B | |
20367 | +#ifdef CONFIG_RTL818X_S | |
20368 | + // just for sync 85 | |
20369 | + priv->card_type = PCI; | |
20370 | + DMESG("This is a PCI NIC"); | |
20371 | +#else | |
20372 | + config3 = read_nic_byte(dev, CONFIG3); | |
20373 | + if(config3 & 0x8){ | |
20374 | + priv->card_type = CARDBUS; | |
20375 | + DMESG("This is a CARDBUS NIC"); | |
20376 | + } | |
20377 | + else if( config3 & 0x4){ | |
20378 | + priv->card_type = MINIPCI; | |
20379 | + DMESG("This is a MINI-PCI NIC"); | |
20380 | + }else{ | |
20381 | + priv->card_type = PCI; | |
20382 | + DMESG("This is a PCI NIC"); | |
20383 | + } | |
20384 | +#endif | |
20385 | +#endif | |
20386 | + priv->enable_gpio0 = 0; | |
20387 | + | |
20388 | +//by amy for antenna | |
20389 | +#ifdef CONFIG_RTL8185B | |
20390 | + usValue = eprom_read(dev, EEPROM_SW_REVD_OFFSET); | |
20391 | + DMESG("usValue is 0x%x\n",usValue); | |
20392 | +#ifdef CONFIG_RTL818X_S | |
20393 | + //3Read AntennaDiversity | |
20394 | + // SW Antenna Diversity. | |
20395 | + if( (usValue & EEPROM_SW_AD_MASK) != EEPROM_SW_AD_ENABLE ) | |
20396 | + { | |
20397 | + priv->EEPROMSwAntennaDiversity = false; | |
20398 | + //printk("EEPROM Disable SW Antenna Diversity\n"); | |
20399 | + } | |
20400 | + else | |
20401 | + { | |
20402 | + priv->EEPROMSwAntennaDiversity = true; | |
20403 | + //printk("EEPROM Enable SW Antenna Diversity\n"); | |
20404 | + } | |
20405 | + // Default Antenna to use. | |
20406 | + if( (usValue & EEPROM_DEF_ANT_MASK) != EEPROM_DEF_ANT_1 ) | |
20407 | + { | |
20408 | + priv->EEPROMDefaultAntenna1 = false; | |
20409 | + //printk("EEPROM Default Antenna 0\n"); | |
20410 | + } | |
20411 | + else | |
20412 | + { | |
20413 | + priv->EEPROMDefaultAntenna1 = true; | |
20414 | + //printk("EEPROM Default Antenna 1\n"); | |
20415 | + } | |
20416 | + | |
20417 | + // | |
20418 | + // Antenna diversity mechanism. Added by Roger, 2007.11.05. | |
20419 | + // | |
20420 | + if( priv->RegSwAntennaDiversityMechanism == 0 ) // Auto | |
20421 | + {// 0: default from EEPROM. | |
20422 | + priv->bSwAntennaDiverity = priv->EEPROMSwAntennaDiversity; | |
20423 | + } | |
20424 | + else | |
20425 | + {// 1:disable antenna diversity, 2: enable antenna diversity. | |
20426 | + priv->bSwAntennaDiverity = ((priv->RegSwAntennaDiversityMechanism == 1)? false : true); | |
20427 | + } | |
20428 | + //printk("bSwAntennaDiverity = %d\n", priv->bSwAntennaDiverity); | |
20429 | + | |
20430 | + | |
20431 | + // | |
20432 | + // Default antenna settings. Added by Roger, 2007.11.05. | |
20433 | + // | |
20434 | + if( priv->RegDefaultAntenna == 0) | |
20435 | + {// 0: default from EEPROM. | |
20436 | + priv->bDefaultAntenna1 = priv->EEPROMDefaultAntenna1; | |
20437 | + } | |
20438 | + else | |
20439 | + {// 1: main, 2: aux. | |
20440 | + priv->bDefaultAntenna1 = ((priv->RegDefaultAntenna== 2) ? true : false); | |
20441 | + } | |
20442 | + //printk("bDefaultAntenna1 = %d\n", priv->bDefaultAntenna1); | |
20443 | +#endif | |
20444 | +#endif | |
20445 | +//by amy for antenna | |
20446 | + /* rtl8185 can calc plcp len in HW.*/ | |
20447 | + priv->hw_plcp_len = 1; | |
20448 | + | |
20449 | + priv->plcp_preamble_mode = 2; | |
20450 | + /*the eeprom type is stored in RCR register bit #6 */ | |
20451 | + if (RCR_9356SEL & read_nic_dword(dev, RCR)){ | |
20452 | + priv->epromtype=EPROM_93c56; | |
20453 | + //DMESG("Reported EEPROM chip is a 93c56 (2Kbit)"); | |
20454 | + }else{ | |
20455 | + priv->epromtype=EPROM_93c46; | |
20456 | + //DMESG("Reported EEPROM chip is a 93c46 (1Kbit)"); | |
20457 | + } | |
20458 | + | |
20459 | + dev->get_stats = rtl8180_stats; | |
20460 | + | |
20461 | + dev->dev_addr[0]=eprom_read(dev,MAC_ADR) & 0xff; | |
20462 | + dev->dev_addr[1]=(eprom_read(dev,MAC_ADR) & 0xff00)>>8; | |
20463 | + dev->dev_addr[2]=eprom_read(dev,MAC_ADR+1) & 0xff; | |
20464 | + dev->dev_addr[3]=(eprom_read(dev,MAC_ADR+1) & 0xff00)>>8; | |
20465 | + dev->dev_addr[4]=eprom_read(dev,MAC_ADR+2) & 0xff; | |
20466 | + dev->dev_addr[5]=(eprom_read(dev,MAC_ADR+2) & 0xff00)>>8; | |
20467 | + //DMESG("Card MAC address is "MAC_FMT, MAC_ARG(dev->dev_addr)); | |
20468 | + | |
20469 | + | |
20470 | + for(i=1,j=0; i<14; i+=2,j++){ | |
20471 | + | |
20472 | + word = eprom_read(dev,EPROM_TXPW_CH1_2 + j); | |
20473 | + priv->chtxpwr[i]=word & 0xff; | |
20474 | + priv->chtxpwr[i+1]=(word & 0xff00)>>8; | |
20475 | +#ifdef DEBUG_EPROM | |
20476 | + DMESG("tx word %x:%x",j,word); | |
20477 | + DMESG("ch %d pwr %x",i,priv->chtxpwr[i]); | |
20478 | + DMESG("ch %d pwr %x",i+1,priv->chtxpwr[i+1]); | |
20479 | +#endif | |
20480 | + } | |
20481 | + if(priv->card_8185){ | |
20482 | + for(i=1,j=0; i<14; i+=2,j++){ | |
20483 | + | |
20484 | + word = eprom_read(dev,EPROM_TXPW_OFDM_CH1_2 + j); | |
20485 | + priv->chtxpwr_ofdm[i]=word & 0xff; | |
20486 | + priv->chtxpwr_ofdm[i+1]=(word & 0xff00)>>8; | |
20487 | +#ifdef DEBUG_EPROM | |
20488 | + DMESG("ofdm tx word %x:%x",j,word); | |
20489 | + DMESG("ofdm ch %d pwr %x",i,priv->chtxpwr_ofdm[i]); | |
20490 | + DMESG("ofdm ch %d pwr %x",i+1,priv->chtxpwr_ofdm[i+1]); | |
20491 | +#endif | |
20492 | + } | |
20493 | + } | |
20494 | +//{by amy 080312 | |
20495 | + //3Read crystal calibtration and thermal meter indication on 87SE. | |
20496 | + | |
20497 | + // By SD3 SY's request. Added by Roger, 2007.12.11. | |
20498 | + | |
20499 | + tmpu16 = eprom_read(dev, EEPROM_RSV>>1); | |
20500 | + | |
20501 | + //printk("ReadAdapterInfo8185(): EEPROM_RSV(%04x)\n", tmpu16); | |
20502 | + | |
20503 | + // Crystal calibration for Xin and Xout resp. | |
20504 | + priv->XtalCal_Xout = tmpu16 & EEPROM_XTAL_CAL_XOUT_MASK; // 0~7.5pF | |
20505 | + priv->XtalCal_Xin = (tmpu16 & EEPROM_XTAL_CAL_XIN_MASK)>>4; // 0~7.5pF | |
20506 | + if((tmpu16 & EEPROM_XTAL_CAL_ENABLE)>>12) | |
20507 | + priv->bXtalCalibration = true; | |
20508 | + | |
20509 | + // Thermal meter reference indication. | |
20510 | + priv->ThermalMeter = (u8)((tmpu16 & EEPROM_THERMAL_METER_MASK)>>8); | |
20511 | + if((tmpu16 & EEPROM_THERMAL_METER_ENABLE)>>13) | |
20512 | + priv->bTxPowerTrack = true; | |
20513 | + | |
20514 | +//by amy 080312} | |
20515 | +#ifdef CONFIG_RTL8185B | |
20516 | + word = eprom_read(dev,EPROM_TXPW_BASE); | |
20517 | + priv->cck_txpwr_base = word & 0xf; | |
20518 | + priv->ofdm_txpwr_base = (word>>4) & 0xf; | |
20519 | +#endif | |
20520 | + | |
20521 | + version = eprom_read(dev,EPROM_VERSION); | |
20522 | + DMESG("EEPROM version %x",version); | |
20523 | + if( (!priv->card_8185) && version < 0x0101){ | |
20524 | + DMESG ("EEPROM version too old, assuming defaults"); | |
20525 | + DMESG ("If you see this message *plase* send your \ | |
20526 | +DMESG output to andreamrl@tiscali.it THANKS"); | |
20527 | + priv->digphy=1; | |
20528 | + priv->antb=0; | |
20529 | + priv->diversity=1; | |
20530 | + priv->cs_treshold=0xc; | |
20531 | + priv->rcr_csense=1; | |
20532 | + priv->rf_chip=RFCHIPID_PHILIPS; | |
20533 | + }else{ | |
20534 | + if(!priv->card_8185){ | |
20535 | + u8 rfparam = eprom_read(dev,RF_PARAM); | |
20536 | + DMESG("RfParam: %x",rfparam); | |
20537 | + | |
20538 | + priv->digphy = rfparam & (1<<RF_PARAM_DIGPHY_SHIFT) ? 0:1; | |
20539 | + priv->antb = rfparam & (1<<RF_PARAM_ANTBDEFAULT_SHIFT) ? 1:0; | |
20540 | + | |
20541 | + priv->rcr_csense = (rfparam & RF_PARAM_CARRIERSENSE_MASK) >> | |
20542 | + RF_PARAM_CARRIERSENSE_SHIFT; | |
20543 | + | |
20544 | + priv->diversity = | |
20545 | + (read_nic_byte(dev,CONFIG2)&(1<<CONFIG2_ANTENNA_SHIFT)) ? 1:0; | |
20546 | + }else{ | |
20547 | + priv->rcr_csense = 3; | |
20548 | + } | |
20549 | + | |
20550 | + priv->cs_treshold = (eprom_read(dev,ENERGY_TRESHOLD)&0xff00) >>8; | |
20551 | + | |
20552 | + priv->rf_chip = 0xff & eprom_read(dev,RFCHIPID); | |
20553 | + } | |
20554 | + | |
20555 | +#ifdef CONFIG_RTL8185B | |
20556 | +#ifdef CONFIG_RTL818X_S | |
20557 | + priv->rf_chip = RF_ZEBRA4; | |
20558 | + priv->rf_sleep = rtl8225z4_rf_sleep; | |
20559 | + priv->rf_wakeup = rtl8225z4_rf_wakeup; | |
20560 | +#else | |
20561 | + priv->rf_chip = RF_ZEBRA2; | |
20562 | +#endif | |
20563 | + //DMESG("Card reports RF frontend Realtek 8225z2"); | |
20564 | + //DMESGW("This driver has EXPERIMENTAL support for this chipset."); | |
20565 | + //DMESGW("use it with care and at your own risk and"); | |
20566 | + DMESGW("**PLEASE** REPORT SUCCESSFUL/UNSUCCESSFUL TO Realtek!"); | |
20567 | + | |
20568 | + priv->rf_close = rtl8225z2_rf_close; | |
20569 | + priv->rf_init = rtl8225z2_rf_init; | |
20570 | + priv->rf_set_chan = rtl8225z2_rf_set_chan; | |
20571 | + priv->rf_set_sens = NULL; | |
20572 | + //priv->rf_sleep = rtl8225_rf_sleep; | |
20573 | + //priv->rf_wakeup = rtl8225_rf_wakeup; | |
20574 | + | |
20575 | +#else | |
20576 | + /* check RF frontend chipset */ | |
20577 | + switch (priv->rf_chip) { | |
20578 | + | |
20579 | + case RFCHIPID_RTL8225: | |
20580 | + | |
20581 | + if(priv->card_8185){ | |
20582 | + DMESG("Card reports RF frontend Realtek 8225"); | |
20583 | + DMESGW("This driver has EXPERIMENTAL support for this chipset."); | |
20584 | + DMESGW("use it with care and at your own risk and"); | |
20585 | + DMESGW("**PLEASE** REPORT SUCCESS/INSUCCESS TO andreamrl@tiscali.it"); | |
20586 | + | |
20587 | + priv->rf_close = rtl8225_rf_close; | |
20588 | + priv->rf_init = rtl8225_rf_init; | |
20589 | + priv->rf_set_chan = rtl8225_rf_set_chan; | |
20590 | + priv->rf_set_sens = NULL; | |
20591 | + priv->rf_sleep = rtl8225_rf_sleep; | |
20592 | + priv->rf_wakeup = rtl8225_rf_wakeup; | |
20593 | + | |
20594 | + }else{ | |
20595 | + DMESGW("Detected RTL8225 radio on a card recognized as RTL8180"); | |
20596 | + DMESGW("This could not be... something went wrong...."); | |
20597 | + return -ENODEV; | |
20598 | + } | |
20599 | + break; | |
20600 | + | |
20601 | + case RFCHIPID_RTL8255: | |
20602 | + if(priv->card_8185){ | |
20603 | + DMESG("Card reports RF frontend Realtek 8255"); | |
20604 | + DMESGW("This driver has EXPERIMENTAL support for this chipset."); | |
20605 | + DMESGW("use it with care and at your own risk and"); | |
20606 | + DMESGW("**PLEASE** REPORT SUCCESS/INSUCCESS TO andreamrl@tiscali.it"); | |
20607 | + | |
20608 | + priv->rf_close = rtl8255_rf_close; | |
20609 | + priv->rf_init = rtl8255_rf_init; | |
20610 | + priv->rf_set_chan = rtl8255_rf_set_chan; | |
20611 | + priv->rf_set_sens = NULL; | |
20612 | + priv->rf_sleep = NULL; | |
20613 | + priv->rf_wakeup = NULL; | |
20614 | + | |
20615 | + }else{ | |
20616 | + DMESGW("Detected RTL8255 radio on a card recognized as RTL8180"); | |
20617 | + DMESGW("This could not be... something went wrong...."); | |
20618 | + return -ENODEV; | |
20619 | + } | |
20620 | + break; | |
20621 | + | |
20622 | + | |
20623 | + case RFCHIPID_INTERSIL: | |
20624 | + DMESGW("Card reports RF frontend by Intersil."); | |
20625 | + DMESGW("This driver has NO support for this chipset."); | |
20626 | + return -ENODEV; | |
20627 | + break; | |
20628 | + | |
20629 | + case RFCHIPID_RFMD: | |
20630 | + DMESGW("Card reports RF frontend by RFMD."); | |
20631 | + DMESGW("This driver has NO support for this chipset."); | |
20632 | + return -ENODEV; | |
20633 | + break; | |
20634 | + | |
20635 | + case RFCHIPID_GCT: | |
20636 | + DMESGW("Card reports RF frontend by GCT."); | |
20637 | + DMESGW("This driver has EXPERIMENTAL support for this chipset."); | |
20638 | + DMESGW("use it with care and at your own risk and"); | |
20639 | + DMESGW("**PLEASE** REPORT SUCCESS/INSUCCESS TO andreamrl@tiscali.it"); | |
20640 | + priv->rf_close = gct_rf_close; | |
20641 | + priv->rf_init = gct_rf_init; | |
20642 | + priv->rf_set_chan = gct_rf_set_chan; | |
20643 | + priv->rf_set_sens = NULL; | |
20644 | + priv->rf_sleep = NULL; | |
20645 | + priv->rf_wakeup = NULL; | |
20646 | + break; | |
20647 | + | |
20648 | + case RFCHIPID_MAXIM: | |
20649 | + DMESGW("Card reports RF frontend by MAXIM."); | |
20650 | + DMESGW("This driver has EXPERIMENTAL support for this chipset."); | |
20651 | + DMESGW("use it with care and at your own risk and"); | |
20652 | + DMESGW("**PLEASE** REPORT SUCCESS/INSUCCESS TO andreamrl@tiscali.it"); | |
20653 | + priv->rf_close = maxim_rf_close; | |
20654 | + priv->rf_init = maxim_rf_init; | |
20655 | + priv->rf_set_chan = maxim_rf_set_chan; | |
20656 | + priv->rf_set_sens = NULL; | |
20657 | + priv->rf_sleep = NULL; | |
20658 | + priv->rf_wakeup = NULL; | |
20659 | + break; | |
20660 | + | |
20661 | + case RFCHIPID_PHILIPS: | |
20662 | + DMESG("Card reports RF frontend by Philips."); | |
20663 | + DMESG("OK! Philips SA2400 radio chipset is supported."); | |
20664 | + priv->rf_close = sa2400_rf_close; | |
20665 | + priv->rf_init = sa2400_rf_init; | |
20666 | + priv->rf_set_chan = sa2400_rf_set_chan; | |
20667 | + priv->rf_set_sens = sa2400_rf_set_sens; | |
20668 | + priv->sens = SA2400_RF_DEF_SENS; /* default sensitivity */ | |
20669 | + priv->max_sens = SA2400_RF_MAX_SENS; /* maximum sensitivity */ | |
20670 | + priv->rf_sleep = NULL; | |
20671 | + priv->rf_wakeup = NULL; | |
20672 | + | |
20673 | + if(priv->digphy){ | |
20674 | + DMESGW("Digital PHY found"); | |
20675 | + DMESGW("Philips DIGITAL PHY is untested! *Please*\ | |
20676 | + report success/failure to <andreamrl@tiscali.it>"); | |
20677 | + }else{ | |
20678 | + DMESG ("Analog PHY found"); | |
20679 | + } | |
20680 | + | |
20681 | + break; | |
20682 | + | |
20683 | + default: | |
20684 | + DMESGW("Unknown RF module %x",priv->rf_chip); | |
20685 | + DMESGW("Exiting..."); | |
20686 | + return -1; | |
20687 | + | |
20688 | + } | |
20689 | +#endif | |
20690 | + | |
20691 | + | |
20692 | + if(!priv->card_8185){ | |
20693 | + if(priv->antb) | |
20694 | + DMESG ("Antenna B is default antenna"); | |
20695 | + else | |
20696 | + DMESG ("Antenna A is default antenna"); | |
20697 | + | |
20698 | + if(priv->diversity) | |
20699 | + DMESG ("Antenna diversity is enabled"); | |
20700 | + else | |
20701 | + DMESG("Antenna diversity is disabled"); | |
20702 | + | |
20703 | + DMESG("Carrier sense %d",priv->rcr_csense); | |
20704 | + } | |
20705 | + | |
20706 | + if (0!=alloc_rx_desc_ring(dev, priv->rxbuffersize, priv->rxringcount)) | |
20707 | + return -ENOMEM; | |
20708 | + | |
20709 | + if (0!=alloc_tx_desc_ring(dev, priv->txbuffsize, priv->txringcount, | |
20710 | + TX_MANAGEPRIORITY_RING_ADDR)) | |
20711 | + return -ENOMEM; | |
20712 | + | |
20713 | + if (0!=alloc_tx_desc_ring(dev, priv->txbuffsize, priv->txringcount, | |
20714 | + TX_BKPRIORITY_RING_ADDR)) | |
20715 | + return -ENOMEM; | |
20716 | + | |
20717 | + if (0!=alloc_tx_desc_ring(dev, priv->txbuffsize, priv->txringcount, | |
20718 | + TX_BEPRIORITY_RING_ADDR)) | |
20719 | + return -ENOMEM; | |
20720 | + | |
20721 | + if (0!=alloc_tx_desc_ring(dev, priv->txbuffsize, priv->txringcount, | |
20722 | + TX_VIPRIORITY_RING_ADDR)) | |
20723 | + return -ENOMEM; | |
20724 | + | |
20725 | + if (0!=alloc_tx_desc_ring(dev, priv->txbuffsize, priv->txringcount, | |
20726 | + TX_VOPRIORITY_RING_ADDR)) | |
20727 | + return -ENOMEM; | |
20728 | + | |
20729 | + if (0!=alloc_tx_desc_ring(dev, priv->txbuffsize, priv->txringcount, | |
20730 | + TX_HIGHPRIORITY_RING_ADDR)) | |
20731 | + return -ENOMEM; | |
20732 | + | |
20733 | + if (0!=alloc_tx_desc_ring(dev, priv->txbuffsize, priv->txbeaconcount, | |
20734 | + TX_BEACON_RING_ADDR)) | |
20735 | + return -ENOMEM; | |
20736 | + | |
20737 | + | |
20738 | + //priv->beacon_buf=NULL; | |
20739 | + | |
20740 | + if(!priv->card_8185){ | |
20741 | + | |
20742 | + if(read_nic_byte(dev, CONFIG0) & (1<<CONFIG0_WEP40_SHIFT)) | |
20743 | + DMESG ("40-bit WEP is supported in hardware"); | |
20744 | + else | |
20745 | + DMESG ("40-bit WEP is NOT supported in hardware"); | |
20746 | + | |
20747 | + if(read_nic_byte(dev,CONFIG0) & (1<<CONFIG0_WEP104_SHIFT)) | |
20748 | + DMESG ("104-bit WEP is supported in hardware"); | |
20749 | + else | |
20750 | + DMESG ("104-bit WEP is NOT supported in hardware"); | |
20751 | + } | |
20752 | +#if !defined(SA_SHIRQ) | |
20753 | + if(request_irq(dev->irq, (void *)rtl8180_interrupt, IRQF_SHARED, dev->name, dev)){ | |
20754 | +#else | |
20755 | + if(request_irq(dev->irq, (void *)rtl8180_interrupt, SA_SHIRQ, dev->name, dev)){ | |
20756 | +#endif | |
20757 | + DMESGE("Error allocating IRQ %d",dev->irq); | |
20758 | + return -1; | |
20759 | + }else{ | |
20760 | + priv->irq=dev->irq; | |
20761 | + DMESG("IRQ %d",dev->irq); | |
20762 | + } | |
20763 | + | |
20764 | +#ifdef DEBUG_EPROM | |
20765 | + dump_eprom(dev); | |
20766 | +#endif | |
20767 | + | |
20768 | + return 0; | |
20769 | + | |
20770 | +} | |
20771 | + | |
20772 | + | |
20773 | +void rtl8180_no_hw_wep(struct net_device *dev) | |
20774 | +{ | |
20775 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
20776 | + | |
20777 | + if(!priv->card_8185) | |
20778 | + { | |
20779 | + u8 security; | |
20780 | + | |
20781 | + security = read_nic_byte(dev, SECURITY); | |
20782 | + security &=~(1<<SECURITY_WEP_TX_ENABLE_SHIFT); | |
20783 | + security &=~(1<<SECURITY_WEP_RX_ENABLE_SHIFT); | |
20784 | + | |
20785 | + write_nic_byte(dev, SECURITY, security); | |
20786 | + | |
20787 | + }else{ | |
20788 | + | |
20789 | + //FIXME!!! | |
20790 | + } | |
20791 | + /* | |
20792 | + write_nic_dword(dev,TX_CONF,read_nic_dword(dev,TX_CONF) | | |
20793 | + (1<<TX_NOICV_SHIFT) ); | |
20794 | + */ | |
20795 | +// priv->ieee80211->hw_wep=0; | |
20796 | +} | |
20797 | + | |
20798 | + | |
20799 | +void rtl8180_set_hw_wep(struct net_device *dev) | |
20800 | +{ | |
20801 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
20802 | + u8 pgreg; | |
20803 | + u8 security; | |
20804 | + u32 key0_word4; | |
20805 | + | |
20806 | + pgreg=read_nic_byte(dev, PGSELECT); | |
20807 | + write_nic_byte(dev, PGSELECT, pgreg &~ (1<<PGSELECT_PG_SHIFT)); | |
20808 | + | |
20809 | + key0_word4 = read_nic_dword(dev, KEY0+4+4+4); | |
20810 | + key0_word4 &= ~ 0xff; | |
20811 | + key0_word4 |= priv->key0[3]& 0xff; | |
20812 | + write_nic_dword(dev,KEY0,(priv->key0[0])); | |
20813 | + write_nic_dword(dev,KEY0+4,(priv->key0[1])); | |
20814 | + write_nic_dword(dev,KEY0+4+4,(priv->key0[2])); | |
20815 | + write_nic_dword(dev,KEY0+4+4+4,(key0_word4)); | |
20816 | + | |
20817 | + /* | |
20818 | + TX_CONF,read_nic_dword(dev,TX_CONF) &~(1<<TX_NOICV_SHIFT)); | |
20819 | + */ | |
20820 | + | |
20821 | + security = read_nic_byte(dev,SECURITY); | |
20822 | + security |= (1<<SECURITY_WEP_TX_ENABLE_SHIFT); | |
20823 | + security |= (1<<SECURITY_WEP_RX_ENABLE_SHIFT); | |
20824 | + security &= ~ SECURITY_ENCRYP_MASK; | |
20825 | + security |= (SECURITY_ENCRYP_104<<SECURITY_ENCRYP_SHIFT); | |
20826 | + | |
20827 | + write_nic_byte(dev, SECURITY, security); | |
20828 | + | |
20829 | + DMESG("key %x %x %x %x",read_nic_dword(dev,KEY0+4+4+4), | |
20830 | + read_nic_dword(dev,KEY0+4+4),read_nic_dword(dev,KEY0+4), | |
20831 | + read_nic_dword(dev,KEY0)); | |
20832 | + | |
20833 | + //priv->ieee80211->hw_wep=1; | |
20834 | +} | |
20835 | + | |
20836 | + | |
20837 | +void rtl8185_rf_pins_enable(struct net_device *dev) | |
20838 | +{ | |
20839 | +// u16 tmp; | |
20840 | +// tmp = read_nic_word(dev, RFPinsEnable); | |
20841 | + write_nic_word(dev, RFPinsEnable, 0x1fff);// | tmp); | |
20842 | +// write_nic_word(dev, RFPinsEnable,7 | tmp); | |
20843 | +} | |
20844 | + | |
20845 | + | |
20846 | +void rtl8185_set_anaparam2(struct net_device *dev, u32 a) | |
20847 | +{ | |
20848 | + u8 conf3; | |
20849 | + | |
20850 | + rtl8180_set_mode(dev, EPROM_CMD_CONFIG); | |
20851 | + | |
20852 | + conf3 = read_nic_byte(dev, CONFIG3); | |
20853 | + write_nic_byte(dev, CONFIG3, conf3 | (1<<CONFIG3_ANAPARAM_W_SHIFT)); | |
20854 | + write_nic_dword(dev, ANAPARAM2, a); | |
20855 | + | |
20856 | + conf3 = read_nic_byte(dev, CONFIG3); | |
20857 | + write_nic_byte(dev, CONFIG3, conf3 &~(1<<CONFIG3_ANAPARAM_W_SHIFT)); | |
20858 | + rtl8180_set_mode(dev, EPROM_CMD_NORMAL); | |
20859 | + | |
20860 | +} | |
20861 | + | |
20862 | + | |
20863 | +void rtl8180_set_anaparam(struct net_device *dev, u32 a) | |
20864 | +{ | |
20865 | + u8 conf3; | |
20866 | + | |
20867 | + rtl8180_set_mode(dev, EPROM_CMD_CONFIG); | |
20868 | + | |
20869 | + conf3 = read_nic_byte(dev, CONFIG3); | |
20870 | + write_nic_byte(dev, CONFIG3, conf3 | (1<<CONFIG3_ANAPARAM_W_SHIFT)); | |
20871 | + write_nic_dword(dev, ANAPARAM, a); | |
20872 | + | |
20873 | + conf3 = read_nic_byte(dev, CONFIG3); | |
20874 | + write_nic_byte(dev, CONFIG3, conf3 &~(1<<CONFIG3_ANAPARAM_W_SHIFT)); | |
20875 | + rtl8180_set_mode(dev, EPROM_CMD_NORMAL); | |
20876 | +} | |
20877 | + | |
20878 | + | |
20879 | +void rtl8185_tx_antenna(struct net_device *dev, u8 ant) | |
20880 | +{ | |
20881 | + write_nic_byte(dev, TX_ANTENNA, ant); | |
20882 | + force_pci_posting(dev); | |
20883 | + mdelay(1); | |
20884 | +} | |
20885 | + | |
20886 | + | |
20887 | +void rtl8185_write_phy(struct net_device *dev, u8 adr, u32 data) | |
20888 | +{ | |
20889 | + //u8 phyr; | |
20890 | + u32 phyw; | |
20891 | + //int i; | |
20892 | + | |
20893 | + adr |= 0x80; | |
20894 | + | |
20895 | + phyw= ((data<<8) | adr); | |
20896 | +#if 0 | |
20897 | + | |
20898 | + write_nic_dword(dev, PHY_ADR, phyw); | |
20899 | + | |
20900 | + //read_nic_dword(dev, PHY_ADR); | |
20901 | + for(i=0;i<10;i++){ | |
20902 | + write_nic_dword(dev, PHY_ADR, 0xffffff7f & phyw); | |
20903 | + phyr = read_nic_byte(dev, PHY_READ); | |
20904 | + if(phyr == (data&0xff)) break; | |
20905 | + | |
20906 | + } | |
20907 | +#else | |
20908 | + // Note that, we must write 0xff7c after 0x7d-0x7f to write BB register. | |
20909 | + write_nic_byte(dev, 0x7f, ((phyw & 0xff000000) >> 24)); | |
20910 | + write_nic_byte(dev, 0x7e, ((phyw & 0x00ff0000) >> 16)); | |
20911 | + write_nic_byte(dev, 0x7d, ((phyw & 0x0000ff00) >> 8)); | |
20912 | + write_nic_byte(dev, 0x7c, ((phyw & 0x000000ff) )); | |
20913 | +#endif | |
20914 | + /* this is ok to fail when we write AGC table. check for AGC table might be | |
20915 | + * done by masking with 0x7f instead of 0xff | |
20916 | + */ | |
20917 | + //if(phyr != (data&0xff)) DMESGW("Phy write timeout %x %x %x", phyr, data,adr); | |
20918 | +} | |
20919 | + | |
20920 | + | |
20921 | +inline void write_phy_ofdm (struct net_device *dev, u8 adr, u32 data) | |
20922 | +{ | |
20923 | + data = data & 0xff; | |
20924 | + rtl8185_write_phy(dev, adr, data); | |
20925 | +} | |
20926 | + | |
20927 | + | |
20928 | +void write_phy_cck (struct net_device *dev, u8 adr, u32 data) | |
20929 | +{ | |
20930 | + data = data & 0xff; | |
20931 | + rtl8185_write_phy(dev, adr, data | 0x10000); | |
20932 | +} | |
20933 | + | |
20934 | + | |
20935 | +/* 70*3 = 210 ms | |
20936 | + * I hope this is enougth | |
20937 | + */ | |
20938 | +#define MAX_PHY 70 | |
20939 | +void write_phy(struct net_device *dev, u8 adr, u8 data) | |
20940 | +{ | |
20941 | + u32 phy; | |
20942 | + int i; | |
20943 | + | |
20944 | + phy = 0xff0000; | |
20945 | + phy |= adr; | |
20946 | + phy |= 0x80; /* this should enable writing */ | |
20947 | + phy |= (data<<8); | |
20948 | + | |
20949 | + //PHY_ADR, PHY_R and PHY_W are contig and treated as one dword | |
20950 | + write_nic_dword(dev,PHY_ADR, phy); | |
20951 | + | |
20952 | + phy= 0xffff00; | |
20953 | + phy |= adr; | |
20954 | + | |
20955 | + write_nic_dword(dev,PHY_ADR, phy); | |
20956 | + for(i=0;i<MAX_PHY;i++){ | |
20957 | + phy=read_nic_dword(dev,PHY_ADR); | |
20958 | + phy= phy & 0xff0000; | |
20959 | + phy= phy >> 16; | |
20960 | + if(phy == data){ //SUCCESS! | |
20961 | + force_pci_posting(dev); | |
20962 | + mdelay(3); //random value | |
20963 | +#ifdef DEBUG_BB | |
20964 | + DMESG("Phy wr %x,%x",adr,data); | |
20965 | +#endif | |
20966 | + return; | |
20967 | + }else{ | |
20968 | + force_pci_posting(dev); | |
20969 | + mdelay(3); //random value | |
20970 | + } | |
20971 | + } | |
20972 | + DMESGW ("Phy writing %x %x failed!", adr,data); | |
20973 | +} | |
20974 | + | |
20975 | +void rtl8185_set_rate(struct net_device *dev) | |
20976 | +{ | |
20977 | + int i; | |
20978 | + u16 word; | |
20979 | + int basic_rate,min_rr_rate,max_rr_rate; | |
20980 | + | |
20981 | +// struct r8180_priv *priv = ieee80211_priv(dev); | |
20982 | + | |
20983 | + //if (ieee80211_is_54g(priv->ieee80211->current_network) && | |
20984 | +// priv->ieee80211->state == IEEE80211_LINKED){ | |
20985 | + basic_rate = ieeerate2rtlrate(240); | |
20986 | + min_rr_rate = ieeerate2rtlrate(60); | |
20987 | + max_rr_rate = ieeerate2rtlrate(240); | |
20988 | + | |
20989 | +// | |
20990 | +// }else{ | |
20991 | +// basic_rate = ieeerate2rtlrate(20); | |
20992 | +// min_rr_rate = ieeerate2rtlrate(10); | |
20993 | +// max_rr_rate = ieeerate2rtlrate(110); | |
20994 | +// } | |
20995 | + | |
20996 | + write_nic_byte(dev, RESP_RATE, | |
20997 | + max_rr_rate<<MAX_RESP_RATE_SHIFT| min_rr_rate<<MIN_RESP_RATE_SHIFT); | |
20998 | + | |
20999 | + word = read_nic_word(dev, BRSR); | |
21000 | + word &= ~BRSR_MBR_8185; | |
21001 | + | |
21002 | + | |
21003 | + for(i=0;i<=basic_rate;i++) | |
21004 | + word |= (1<<i); | |
21005 | + | |
21006 | + write_nic_word(dev, BRSR, word); | |
21007 | + //DMESG("RR:%x BRSR: %x", read_nic_byte(dev,RESP_RATE),read_nic_word(dev,BRSR)); | |
21008 | +} | |
21009 | + | |
21010 | + | |
21011 | + | |
21012 | +void rtl8180_adapter_start(struct net_device *dev) | |
21013 | +{ | |
21014 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21015 | + u32 anaparam; | |
21016 | + u16 word; | |
21017 | + u8 config3; | |
21018 | +// int i; | |
21019 | + | |
21020 | + rtl8180_rtx_disable(dev); | |
21021 | + rtl8180_reset(dev); | |
21022 | + | |
21023 | + /* seems that 0xffff or 0xafff will cause | |
21024 | + * HW interrupt line crash | |
21025 | + */ | |
21026 | + | |
21027 | + //priv->irq_mask = 0xafff; | |
21028 | +// priv->irq_mask = 0x4fcf; | |
21029 | + | |
21030 | + /* enable beacon timeout, beacon TX ok and err | |
21031 | + * LP tx ok and err, HP TX ok and err, NP TX ok and err, | |
21032 | + * RX ok and ERR, and GP timer */ | |
21033 | + priv->irq_mask = 0x6fcf; | |
21034 | + | |
21035 | + priv->dma_poll_mask = 0; | |
21036 | + | |
21037 | + rtl8180_beacon_tx_disable(dev); | |
21038 | + | |
21039 | + if(priv->card_type == CARDBUS ){ | |
21040 | + config3=read_nic_byte(dev, CONFIG3); | |
21041 | + write_nic_byte(dev,CONFIG3,config3 | CONFIG3_FuncRegEn); | |
21042 | + write_nic_word(dev,FEMR, FEMR_INTR | FEMR_WKUP | FEMR_GWAKE | | |
21043 | + read_nic_word(dev, FEMR)); | |
21044 | + } | |
21045 | + rtl8180_set_mode(dev, EPROM_CMD_CONFIG); | |
21046 | + write_nic_dword(dev, MAC0, ((u32*)dev->dev_addr)[0]); | |
21047 | + write_nic_word(dev, MAC4, ((u32*)dev->dev_addr)[1] & 0xffff ); | |
21048 | + rtl8180_set_mode(dev, EPROM_CMD_NORMAL); | |
21049 | + | |
21050 | + rtl8180_update_msr(dev); | |
21051 | + | |
21052 | + if(!priv->card_8185){ | |
21053 | + anaparam = eprom_read(dev,EPROM_ANAPARAM_ADDRLWORD); | |
21054 | + anaparam |= eprom_read(dev,EPROM_ANAPARAM_ADDRHWORD)<<16; | |
21055 | + | |
21056 | + rtl8180_set_anaparam(dev,anaparam); | |
21057 | + } | |
21058 | + /* These might be unnecessary since we do in rx_enable / tx_enable */ | |
21059 | + fix_rx_fifo(dev); | |
21060 | + fix_tx_fifo(dev); | |
21061 | + /*set_nic_rxring(dev); | |
21062 | + set_nic_txring(dev);*/ | |
21063 | + | |
21064 | + rtl8180_set_mode(dev, EPROM_CMD_CONFIG); | |
21065 | + | |
21066 | + /* | |
21067 | + The following is very strange. seems to be that 1 means test mode, | |
21068 | + but we need to acknolwledges the nic when a packet is ready | |
21069 | + altought we set it to 0 | |
21070 | + */ | |
21071 | + | |
21072 | + write_nic_byte(dev, | |
21073 | + CONFIG2, read_nic_byte(dev,CONFIG2) &~\ | |
21074 | + (1<<CONFIG2_DMA_POLLING_MODE_SHIFT)); | |
21075 | + //^the nic isn't in test mode | |
21076 | + if(priv->card_8185) | |
21077 | + write_nic_byte(dev, | |
21078 | + CONFIG2, read_nic_byte(dev,CONFIG2)|(1<<4)); | |
21079 | + | |
21080 | + rtl8180_set_mode(dev,EPROM_CMD_NORMAL); | |
21081 | + | |
21082 | + write_nic_dword(dev,INT_TIMEOUT,0); | |
21083 | +#ifdef DEBUG_REGISTERS | |
21084 | + rtl8180_dump_reg(dev); | |
21085 | +#endif | |
21086 | + | |
21087 | + if(!priv->card_8185) | |
21088 | + { | |
21089 | + /* | |
21090 | + experimental - this might be needed to calibrate AGC, | |
21091 | + anyway it shouldn't hurt | |
21092 | + */ | |
21093 | + write_nic_byte(dev, CONFIG5, | |
21094 | + read_nic_byte(dev, CONFIG5) | (1<<AGCRESET_SHIFT)); | |
21095 | + read_nic_byte(dev, CONFIG5); | |
21096 | + udelay(15); | |
21097 | + write_nic_byte(dev, CONFIG5, | |
21098 | + read_nic_byte(dev, CONFIG5) &~ (1<<AGCRESET_SHIFT)); | |
21099 | + }else{ | |
21100 | + | |
21101 | + write_nic_byte(dev, WPA_CONFIG, 0); | |
21102 | + //write_nic_byte(dev, TESTR, 0xd); | |
21103 | + } | |
21104 | + | |
21105 | + rtl8180_no_hw_wep(dev); | |
21106 | + | |
21107 | + if(priv->card_8185){ | |
21108 | + rtl8185_set_rate(dev); | |
21109 | + write_nic_byte(dev, RATE_FALLBACK, 0x81); | |
21110 | + // write_nic_byte(dev, 0xdf, 0x15); | |
21111 | + }else{ | |
21112 | + word = read_nic_word(dev, BRSR); | |
21113 | + word &= ~BRSR_MBR; | |
21114 | + word &= ~BRSR_BPLCP; | |
21115 | + word |= ieeerate2rtlrate(priv->ieee80211->basic_rate); | |
21116 | +//by amy | |
21117 | + word |= 0x0f; | |
21118 | +//by amy | |
21119 | + write_nic_word(dev, BRSR, word); | |
21120 | + } | |
21121 | + | |
21122 | + | |
21123 | + if(priv->card_8185){ | |
21124 | + write_nic_byte(dev, GP_ENABLE,read_nic_byte(dev, GP_ENABLE) & ~(1<<6)); | |
21125 | + | |
21126 | + //FIXME cfg 3 ClkRun enable - isn't it ReadOnly ? | |
21127 | + rtl8180_set_mode(dev, EPROM_CMD_CONFIG); | |
21128 | + write_nic_byte(dev,CONFIG3, read_nic_byte(dev, CONFIG3) | |
21129 | +|(1<<CONFIG3_CLKRUN_SHIFT)); | |
21130 | + rtl8180_set_mode(dev, EPROM_CMD_NORMAL); | |
21131 | + | |
21132 | + } | |
21133 | + | |
21134 | + priv->rf_init(dev); | |
21135 | + | |
21136 | + if(priv->rf_set_sens != NULL) | |
21137 | + priv->rf_set_sens(dev,priv->sens); | |
21138 | + rtl8180_irq_enable(dev); | |
21139 | + | |
21140 | + netif_start_queue(dev); | |
21141 | + /*DMESG ("lfree %d",get_curr_tx_free_desc(dev,LOW_PRIORITY)); | |
21142 | + | |
21143 | + DMESG ("nfree %d",get_curr_tx_free_desc(dev,NORM_PRIORITY)); | |
21144 | + | |
21145 | + DMESG ("hfree %d",get_curr_tx_free_desc(dev,HI_PRIORITY)); | |
21146 | + if(check_nic_enought_desc(dev,NORM_PRIORITY)) DMESG("NORM OK"); | |
21147 | + if(check_nic_enought_desc(dev,HI_PRIORITY)) DMESG("HI OK"); | |
21148 | + if(check_nic_enought_desc(dev,LOW_PRIORITY)) DMESG("LOW OK");*/ | |
21149 | +} | |
21150 | + | |
21151 | + | |
21152 | + | |
21153 | +/* this configures registers for beacon tx and enables it via | |
21154 | + * rtl8180_beacon_tx_enable(). rtl8180_beacon_tx_disable() might | |
21155 | + * be used to stop beacon transmission | |
21156 | + */ | |
21157 | +void rtl8180_start_tx_beacon(struct net_device *dev) | |
21158 | +{ | |
21159 | +// struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
21160 | + u16 word; | |
21161 | +// DMESG("ring %x %x", priv->txlpringdma,read_nic_dword(dev,TLPDA)); | |
21162 | + | |
21163 | + DMESG("Enabling beacon TX"); | |
21164 | + //write_nic_byte(dev, 0x42,0xe6);// TCR | |
21165 | +// set_nic_txring(dev); | |
21166 | +// fix_tx_fifo(dev); | |
21167 | + rtl8180_prepare_beacon(dev); | |
21168 | + rtl8180_irq_disable(dev); | |
21169 | + rtl8180_beacon_tx_enable(dev); | |
21170 | +#if 0 | |
21171 | + rtl8180_set_mode(dev,EPROM_CMD_CONFIG); | |
21172 | + //write_nic_byte(dev,0x9d,0x20); //DMA Poll | |
21173 | + //write_nic_word(dev,0x7a,0); | |
21174 | + //write_nic_word(dev,0x7a,0x8000); | |
21175 | + | |
21176 | +#if 0 | |
21177 | + word = read_nic_word(dev, BcnItv); | |
21178 | + word &= ~BcnItv_BcnItv; // clear Bcn_Itv | |
21179 | + word |= priv->ieee80211->current_network.beacon_interval;//0x64; | |
21180 | + write_nic_word(dev, BcnItv, word); | |
21181 | +#endif | |
21182 | +#endif | |
21183 | + word = read_nic_word(dev, AtimWnd) &~ AtimWnd_AtimWnd; | |
21184 | + write_nic_word(dev, AtimWnd,word);// word |= | |
21185 | +//priv->ieee80211->current_network.atim_window); | |
21186 | + | |
21187 | + word = read_nic_word(dev, BintrItv); | |
21188 | + word &= ~BintrItv_BintrItv; | |
21189 | + word |= 1000;/*priv->ieee80211->current_network.beacon_interval * | |
21190 | + ((priv->txbeaconcount > 1)?(priv->txbeaconcount-1):1); | |
21191 | + // FIXME: check if correct ^^ worked with 0x3e8; | |
21192 | + */ | |
21193 | + write_nic_word(dev, BintrItv, word); | |
21194 | + | |
21195 | + | |
21196 | + rtl8180_set_mode(dev, EPROM_CMD_NORMAL); | |
21197 | + | |
21198 | +// rtl8180_beacon_tx_enable(dev); | |
21199 | +#ifdef CONFIG_RTL8185B | |
21200 | + rtl8185b_irq_enable(dev); | |
21201 | +#else | |
21202 | + rtl8180_irq_enable(dev); | |
21203 | +#endif | |
21204 | + /* VV !!!!!!!!!! VV*/ | |
21205 | + /* | |
21206 | + rtl8180_set_mode(dev,EPROM_CMD_CONFIG); | |
21207 | + write_nic_byte(dev,0x9d,0x00); | |
21208 | + rtl8180_set_mode(dev,EPROM_CMD_NORMAL); | |
21209 | +*/ | |
21210 | +// DMESG("ring %x %x", priv->txlpringdma,read_nic_dword(dev,TLPDA)); | |
21211 | + | |
21212 | +} | |
21213 | + | |
21214 | + | |
21215 | + | |
21216 | +/*************************************************************************** | |
21217 | + -------------------------------NET STUFF--------------------------- | |
21218 | +***************************************************************************/ | |
21219 | +static struct net_device_stats *rtl8180_stats(struct net_device *dev) | |
21220 | +{ | |
21221 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21222 | + | |
21223 | + return &priv->ieee80211->stats; | |
21224 | +} | |
21225 | +// | |
21226 | +// Change current and default preamble mode. | |
21227 | +// 2005.01.06, by rcnjko. | |
21228 | +// | |
21229 | +bool | |
21230 | +MgntActSet_802_11_PowerSaveMode( | |
21231 | + struct r8180_priv *priv, | |
21232 | + RT_PS_MODE rtPsMode | |
21233 | +) | |
21234 | +{ | |
21235 | + | |
21236 | + // Currently, we do not change power save mode on IBSS mode. | |
21237 | + if(priv->ieee80211->iw_mode == IW_MODE_ADHOC) | |
21238 | + { | |
21239 | + return false; | |
21240 | + } | |
21241 | + | |
21242 | + // | |
21243 | + // <RJ_NOTE> If we make HW to fill up the PwrMgt bit for us, | |
21244 | + // some AP will not response to our mgnt frames with PwrMgt bit set, | |
21245 | + // e.g. cannot associate the AP. | |
21246 | + // So I commented out it. 2005.02.16, by rcnjko. | |
21247 | + // | |
21248 | +// // Change device's power save mode. | |
21249 | +// Adapter->HalFunc.SetPSModeHandler( Adapter, rtPsMode ); | |
21250 | + | |
21251 | + // Update power save mode configured. | |
21252 | +// priv->dot11PowerSaveMode = rtPsMode; | |
21253 | + priv->ieee80211->ps = rtPsMode; | |
21254 | + // Determine ListenInterval. | |
21255 | +#if 0 | |
21256 | + if(priv->dot11PowerSaveMode == eMaxPs) | |
21257 | + { | |
21258 | + priv->ieee80211->ListenInterval = 10; | |
21259 | + } | |
21260 | + else | |
21261 | + { | |
21262 | + priv->ieee80211->ListenInterval = 2; | |
21263 | + } | |
21264 | +#endif | |
21265 | + return true; | |
21266 | +} | |
21267 | + | |
21268 | +//================================================================================ | |
21269 | +// Leisure Power Save in linked state. | |
21270 | +//================================================================================ | |
21271 | + | |
21272 | +// | |
21273 | +// Description: | |
21274 | +// Enter the leisure power save mode. | |
21275 | +// | |
21276 | +void | |
21277 | +LeisurePSEnter( | |
21278 | + struct r8180_priv *priv | |
21279 | + ) | |
21280 | +{ | |
21281 | + if (priv->bLeisurePs) | |
21282 | + { | |
21283 | + if (priv->ieee80211->ps == IEEE80211_PS_DISABLED) | |
21284 | + { | |
21285 | + //printk("----Enter PS\n"); | |
21286 | + MgntActSet_802_11_PowerSaveMode(priv, IEEE80211_PS_MBCAST|IEEE80211_PS_UNICAST);//IEEE80211_PS_ENABLE | |
21287 | + } | |
21288 | + } | |
21289 | +} | |
21290 | + | |
21291 | + | |
21292 | +// | |
21293 | +// Description: | |
21294 | +// Leave the leisure power save mode. | |
21295 | +// | |
21296 | +void | |
21297 | +LeisurePSLeave( | |
21298 | + struct r8180_priv *priv | |
21299 | + ) | |
21300 | +{ | |
21301 | + if (priv->bLeisurePs) | |
21302 | + { | |
21303 | + if (priv->ieee80211->ps != IEEE80211_PS_DISABLED) | |
21304 | + { | |
21305 | + //printk("----Leave PS\n"); | |
21306 | + MgntActSet_802_11_PowerSaveMode(priv, IEEE80211_PS_DISABLED); | |
21307 | + } | |
21308 | + } | |
21309 | +} | |
21310 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
21311 | +void rtl8180_hw_wakeup_wq (struct work_struct *work) | |
21312 | +{ | |
21313 | +// struct r8180_priv *priv = container_of(work, struct r8180_priv, watch_dog_wq); | |
21314 | +// struct ieee80211_device * ieee = (struct ieee80211_device*) | |
21315 | +// container_of(work, struct ieee80211_device, watch_dog_wq); | |
21316 | + struct delayed_work *dwork = container_of(work,struct delayed_work,work); | |
21317 | + struct ieee80211_device *ieee = container_of(dwork,struct ieee80211_device,hw_wakeup_wq); | |
21318 | + struct net_device *dev = ieee->dev; | |
21319 | +#else | |
21320 | +void rtl8180_hw_wakeup_wq(struct net_device *dev) | |
21321 | +{ | |
21322 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21323 | +#endif | |
21324 | + | |
21325 | +// printk("dev is %d\n",dev); | |
21326 | +// printk("&*&(^*(&(&=========>%s()\n", __FUNCTION__); | |
21327 | + rtl8180_hw_wakeup(dev); | |
21328 | + | |
21329 | +} | |
21330 | + | |
21331 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
21332 | +void rtl8180_hw_sleep_wq (struct work_struct *work) | |
21333 | +{ | |
21334 | +// struct r8180_priv *priv = container_of(work, struct r8180_priv, watch_dog_wq); | |
21335 | +// struct ieee80211_device * ieee = (struct ieee80211_device*) | |
21336 | +// container_of(work, struct ieee80211_device, watch_dog_wq); | |
21337 | + struct delayed_work *dwork = container_of(work,struct delayed_work,work); | |
21338 | + struct ieee80211_device *ieee = container_of(dwork,struct ieee80211_device,hw_sleep_wq); | |
21339 | + struct net_device *dev = ieee->dev; | |
21340 | +#else | |
21341 | +void rtl8180_hw_sleep_wq(struct net_device *dev) | |
21342 | +{ | |
21343 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21344 | +#endif | |
21345 | + | |
21346 | + rtl8180_hw_sleep_down(dev); | |
21347 | +} | |
21348 | + | |
21349 | +//YJ,add,080828,for KeepAlive | |
21350 | +static void MgntLinkKeepAlive(struct r8180_priv *priv ) | |
21351 | +{ | |
21352 | + if (priv->keepAliveLevel == 0) | |
21353 | + return; | |
21354 | + | |
21355 | + if(priv->ieee80211->state == IEEE80211_LINKED) | |
21356 | + { | |
21357 | + // | |
21358 | + // Keep-Alive. | |
21359 | + // | |
21360 | + //printk("LastTx:%d Tx:%d LastRx:%d Rx:%ld Idle:%d\n",priv->link_detect.LastNumTxUnicast,priv->NumTxUnicast, priv->link_detect.LastNumRxUnicast, priv->ieee80211->NumRxUnicast, priv->link_detect.IdleCount); | |
21361 | + | |
21362 | + if ( (priv->keepAliveLevel== 2) || | |
21363 | + (priv->link_detect.LastNumTxUnicast == priv->NumTxUnicast && | |
21364 | + priv->link_detect.LastNumRxUnicast == priv->ieee80211->NumRxUnicast ) | |
21365 | + ) | |
21366 | + { | |
21367 | + priv->link_detect.IdleCount++; | |
21368 | + | |
21369 | + // | |
21370 | + // Send a Keep-Alive packet packet to AP if we had been idle for a while. | |
21371 | + // | |
21372 | + if(priv->link_detect.IdleCount >= ((KEEP_ALIVE_INTERVAL / CHECK_FOR_HANG_PERIOD)-1) ) | |
21373 | + { | |
21374 | + priv->link_detect.IdleCount = 0; | |
21375 | + ieee80211_sta_ps_send_null_frame(priv->ieee80211, false); | |
21376 | + } | |
21377 | + } | |
21378 | + else | |
21379 | + { | |
21380 | + priv->link_detect.IdleCount = 0; | |
21381 | + } | |
21382 | + priv->link_detect.LastNumTxUnicast = priv->NumTxUnicast; | |
21383 | + priv->link_detect.LastNumRxUnicast = priv->ieee80211->NumRxUnicast; | |
21384 | + } | |
21385 | +} | |
21386 | +//YJ,add,080828,for KeepAlive,end | |
21387 | + | |
21388 | +static u8 read_acadapter_file(char *filename); | |
21389 | +void rtl8180_watch_dog(struct net_device *dev) | |
21390 | +{ | |
21391 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21392 | + bool bEnterPS = false; | |
21393 | + bool bBusyTraffic = false; | |
21394 | + u32 TotalRxNum = 0; | |
21395 | + u16 SlotIndex = 0; | |
21396 | + u16 i = 0; | |
21397 | +#ifdef ENABLE_IPS | |
21398 | + if(priv->ieee80211->actscanning == false){ | |
21399 | + if((priv->ieee80211->iw_mode != IW_MODE_ADHOC) && (priv->ieee80211->state == IEEE80211_NOLINK) && (priv->ieee80211->beinretry == false) && (priv->eRFPowerState == eRfOn)){ | |
21400 | + IPSEnter(dev); | |
21401 | + } | |
21402 | + } | |
21403 | +#endif | |
21404 | + //YJ,add,080828,for link state check | |
21405 | + if((priv->ieee80211->state == IEEE80211_LINKED) && (priv->ieee80211->iw_mode == IW_MODE_INFRA)){ | |
21406 | + SlotIndex = (priv->link_detect.SlotIndex++) % priv->link_detect.SlotNum; | |
21407 | + priv->link_detect.RxFrameNum[SlotIndex] = priv->ieee80211->NumRxDataInPeriod + priv->ieee80211->NumRxBcnInPeriod; | |
21408 | + for( i=0; i<priv->link_detect.SlotNum; i++ ) | |
21409 | + TotalRxNum+= priv->link_detect.RxFrameNum[i]; | |
21410 | + //printk("&&&&&=== TotalRxNum = %d\n", TotalRxNum); | |
21411 | + if(TotalRxNum == 0){ | |
21412 | + priv->ieee80211->state = IEEE80211_ASSOCIATING; | |
21413 | + queue_work(priv->ieee80211->wq, &priv->ieee80211->associate_procedure_wq); | |
21414 | + } | |
21415 | + } | |
21416 | + | |
21417 | + //YJ,add,080828,for KeepAlive | |
21418 | + MgntLinkKeepAlive(priv); | |
21419 | + | |
21420 | + //YJ,add,080828,for LPS | |
21421 | +#ifdef ENABLE_LPS | |
21422 | + if(priv->PowerProfile == POWER_PROFILE_BATTERY ) | |
21423 | + { | |
21424 | + //Turn on LeisurePS on battery power | |
21425 | + //printk("!!!!!On battery power\n"); | |
21426 | + priv->bLeisurePs = true; | |
21427 | + } | |
21428 | + else if(priv->PowerProfile == POWER_PROFILE_AC ) | |
21429 | + { | |
21430 | + // Turn off LeisurePS on AC power | |
21431 | + //printk("----On AC power\n"); | |
21432 | + LeisurePSLeave(priv); | |
21433 | + priv->bLeisurePs= false; | |
21434 | + } | |
21435 | +#endif | |
21436 | + | |
21437 | +#if 0 | |
21438 | +#ifndef ENABLE_LPS | |
21439 | + if(priv->ieee80211->state == IEEE80211_LINKED){ | |
21440 | + if( priv->NumRxOkInPeriod> 666 || | |
21441 | + priv->NumTxOkInPeriod > 666 ) { | |
21442 | + bBusyTraffic = true; | |
21443 | + } | |
21444 | + if((priv->ieee80211->NumRxData + priv->NumTxOkInPeriod)<8) { | |
21445 | + bEnterPS= true; | |
21446 | + } | |
21447 | + if(bEnterPS) { | |
21448 | + LeisurePSEnter(priv); | |
21449 | + } | |
21450 | + else { | |
21451 | + LeisurePSLeave(priv); | |
21452 | + } | |
21453 | + } | |
21454 | + else { | |
21455 | + LeisurePSLeave(priv); | |
21456 | + } | |
21457 | +#endif | |
21458 | + priv->NumRxOkInPeriod = 0; | |
21459 | + priv->NumTxOkInPeriod = 0; | |
21460 | + priv->ieee80211->NumRxData = 0; | |
21461 | +#else | |
21462 | +#ifdef ENABLE_LPS | |
21463 | + if(priv->ieee80211->state == IEEE80211_LINKED){ | |
21464 | + priv->link_detect.NumRxOkInPeriod = priv->ieee80211->NumRxDataInPeriod; | |
21465 | + //printk("TxOk=%d RxOk=%d\n", priv->link_detect.NumTxOkInPeriod, priv->link_detect.NumRxOkInPeriod); | |
21466 | + if( priv->link_detect.NumRxOkInPeriod> 666 || | |
21467 | + priv->link_detect.NumTxOkInPeriod> 666 ) { | |
21468 | + bBusyTraffic = true; | |
21469 | + } | |
21470 | + if(((priv->link_detect.NumRxOkInPeriod + priv->link_detect.NumTxOkInPeriod) > 8) | |
21471 | + || (priv->link_detect.NumRxOkInPeriod > 2)) { | |
21472 | + bEnterPS= false; | |
21473 | + } | |
21474 | + else { | |
21475 | + bEnterPS= true; | |
21476 | + } | |
21477 | + | |
21478 | + if(bEnterPS) { | |
21479 | + LeisurePSEnter(priv); | |
21480 | + } | |
21481 | + else { | |
21482 | + LeisurePSLeave(priv); | |
21483 | + } | |
21484 | + } | |
21485 | + else{ | |
21486 | + LeisurePSLeave(priv); | |
21487 | + } | |
21488 | +#endif | |
21489 | + priv->link_detect.bBusyTraffic = bBusyTraffic; | |
21490 | + priv->link_detect.NumRxOkInPeriod = 0; | |
21491 | + priv->link_detect.NumTxOkInPeriod = 0; | |
21492 | + priv->ieee80211->NumRxDataInPeriod = 0; | |
21493 | + priv->ieee80211->NumRxBcnInPeriod = 0; | |
21494 | +#endif | |
21495 | +} | |
21496 | +int _rtl8180_up(struct net_device *dev) | |
21497 | +{ | |
21498 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21499 | + //int i; | |
21500 | + | |
21501 | + priv->up=1; | |
21502 | + | |
21503 | + DMESG("Bringing up iface"); | |
21504 | +#ifdef CONFIG_RTL8185B | |
21505 | + rtl8185b_adapter_start(dev); | |
21506 | + rtl8185b_rx_enable(dev); | |
21507 | + rtl8185b_tx_enable(dev); | |
21508 | +#else | |
21509 | + rtl8180_adapter_start(dev); | |
21510 | + rtl8180_rx_enable(dev); | |
21511 | + rtl8180_tx_enable(dev); | |
21512 | +#endif | |
21513 | +#ifdef ENABLE_IPS | |
21514 | + if(priv->bInactivePs){ | |
21515 | + if(priv->ieee80211->iw_mode == IW_MODE_ADHOC) | |
21516 | + IPSLeave(dev); | |
21517 | + } | |
21518 | +#endif | |
21519 | +//by amy 080312 | |
21520 | +#ifdef RATE_ADAPT | |
21521 | + timer_rate_adaptive((unsigned long)dev); | |
21522 | +#endif | |
21523 | +//by amy 080312 | |
21524 | + watch_dog_adaptive((unsigned long)dev); | |
21525 | +#ifdef SW_ANTE | |
21526 | + if(priv->bSwAntennaDiverity) | |
21527 | + SwAntennaDiversityTimerCallback(dev); | |
21528 | +#endif | |
21529 | +// IPSEnter(dev); | |
21530 | + ieee80211_softmac_start_protocol(priv->ieee80211); | |
21531 | + | |
21532 | +//Add for RF power on power off by lizhaoming 080512 | |
21533 | +// priv->eRFPowerState = eRfOn; | |
21534 | +// printk("\n--------Start queue_work:GPIOChangeRFWorkItem"); | |
21535 | +// queue_delayed_work(priv->ieee80211->wq,&priv->ieee80211->GPIOChangeRFWorkItem,1000); | |
21536 | + | |
21537 | + return 0; | |
21538 | +} | |
21539 | + | |
21540 | + | |
21541 | +int rtl8180_open(struct net_device *dev) | |
21542 | +{ | |
21543 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21544 | + int ret; | |
21545 | + | |
21546 | + down(&priv->wx_sem); | |
21547 | + ret = rtl8180_up(dev); | |
21548 | + up(&priv->wx_sem); | |
21549 | + return ret; | |
21550 | + | |
21551 | +} | |
21552 | + | |
21553 | + | |
21554 | +int rtl8180_up(struct net_device *dev) | |
21555 | +{ | |
21556 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21557 | + | |
21558 | + if (priv->up == 1) return -1; | |
21559 | + | |
21560 | + return _rtl8180_up(dev); | |
21561 | +} | |
21562 | + | |
21563 | + | |
21564 | +int rtl8180_close(struct net_device *dev) | |
21565 | +{ | |
21566 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21567 | + int ret; | |
21568 | + | |
21569 | + down(&priv->wx_sem); | |
21570 | + ret = rtl8180_down(dev); | |
21571 | + up(&priv->wx_sem); | |
21572 | + | |
21573 | + return ret; | |
21574 | + | |
21575 | +} | |
21576 | + | |
21577 | +int rtl8180_down(struct net_device *dev) | |
21578 | +{ | |
21579 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21580 | + | |
21581 | + if (priv->up == 0) return -1; | |
21582 | + | |
21583 | + priv->up=0; | |
21584 | + | |
21585 | + ieee80211_softmac_stop_protocol(priv->ieee80211); | |
21586 | + /* FIXME */ | |
21587 | + if (!netif_queue_stopped(dev)) | |
21588 | + netif_stop_queue(dev); | |
21589 | + rtl8180_rtx_disable(dev); | |
21590 | + rtl8180_irq_disable(dev); | |
21591 | + del_timer_sync(&priv->watch_dog_timer); | |
21592 | + //cancel_delayed_work(&priv->ieee80211->watch_dog_wq); | |
21593 | +//{by amy 080312 | |
21594 | + del_timer_sync(&priv->rateadapter_timer); | |
21595 | + cancel_delayed_work(&priv->ieee80211->rate_adapter_wq); | |
21596 | +//by amy 080312} | |
21597 | + cancel_delayed_work(&priv->ieee80211->hw_wakeup_wq); | |
21598 | + cancel_delayed_work(&priv->ieee80211->hw_sleep_wq); | |
21599 | + cancel_delayed_work(&priv->ieee80211->hw_dig_wq); | |
21600 | + cancel_delayed_work(&priv->ieee80211->tx_pw_wq); | |
21601 | + del_timer_sync(&priv->SwAntennaDiversityTimer); | |
21602 | + SetZebraRFPowerState8185(dev,eRfOff); | |
21603 | + //ieee80211_softmac_stop_protocol(priv->ieee80211); | |
21604 | + memset(&(priv->ieee80211->current_network),0,sizeof(struct ieee80211_network)); | |
21605 | + priv->ieee80211->state = IEEE80211_NOLINK; | |
21606 | + return 0; | |
21607 | +} | |
21608 | + | |
21609 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
21610 | +void rtl8180_restart_wq(struct work_struct *work) | |
21611 | +{ | |
21612 | + struct r8180_priv *priv = container_of(work, struct r8180_priv, reset_wq); | |
21613 | + struct net_device *dev = priv->dev; | |
21614 | +#else | |
21615 | +void rtl8180_restart_wq(struct net_device *dev) | |
21616 | +{ | |
21617 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21618 | +#endif | |
21619 | + down(&priv->wx_sem); | |
21620 | + | |
21621 | + rtl8180_commit(dev); | |
21622 | + | |
21623 | + up(&priv->wx_sem); | |
21624 | +} | |
21625 | + | |
21626 | +void rtl8180_restart(struct net_device *dev) | |
21627 | +{ | |
21628 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21629 | + //rtl8180_commit(dev); | |
21630 | + schedule_work(&priv->reset_wq); | |
21631 | + //DMESG("TXTIMEOUT"); | |
21632 | +} | |
21633 | + | |
21634 | + | |
21635 | +void rtl8180_commit(struct net_device *dev) | |
21636 | +{ | |
21637 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21638 | + | |
21639 | + if (priv->up == 0) return ; | |
21640 | +//+by amy 080312 | |
21641 | + del_timer_sync(&priv->watch_dog_timer); | |
21642 | + //cancel_delayed_work(&priv->ieee80211->watch_dog_wq); | |
21643 | +//{by amy 080312 | |
21644 | +//by amy for rate adaptive | |
21645 | + del_timer_sync(&priv->rateadapter_timer); | |
21646 | + cancel_delayed_work(&priv->ieee80211->rate_adapter_wq); | |
21647 | +//by amy for rate adaptive | |
21648 | +//by amy 080312} | |
21649 | + cancel_delayed_work(&priv->ieee80211->hw_wakeup_wq); | |
21650 | + cancel_delayed_work(&priv->ieee80211->hw_sleep_wq); | |
21651 | + cancel_delayed_work(&priv->ieee80211->hw_dig_wq); | |
21652 | + cancel_delayed_work(&priv->ieee80211->tx_pw_wq); | |
21653 | + del_timer_sync(&priv->SwAntennaDiversityTimer); | |
21654 | + ieee80211_softmac_stop_protocol(priv->ieee80211); | |
21655 | + rtl8180_irq_disable(dev); | |
21656 | + rtl8180_rtx_disable(dev); | |
21657 | + _rtl8180_up(dev); | |
21658 | +} | |
21659 | + | |
21660 | + | |
21661 | +static void r8180_set_multicast(struct net_device *dev) | |
21662 | +{ | |
21663 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21664 | + short promisc; | |
21665 | + | |
21666 | + //down(&priv->wx_sem); | |
21667 | + | |
21668 | + promisc = (dev->flags & IFF_PROMISC) ? 1:0; | |
21669 | + | |
21670 | + if (promisc != priv->promisc) | |
21671 | + rtl8180_restart(dev); | |
21672 | + | |
21673 | + priv->promisc = promisc; | |
21674 | + | |
21675 | + //up(&priv->wx_sem); | |
21676 | +} | |
21677 | + | |
21678 | +#if 0 | |
21679 | +/* this is called by the kernel when it needs to TX a 802.3 encapsulated frame*/ | |
21680 | +int rtl8180_8023_hard_start_xmit(struct sk_buff *skb, struct net_device *dev) | |
21681 | +{ | |
21682 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21683 | + int ret; | |
21684 | + unsigned long flags; | |
21685 | + | |
21686 | + spin_lock_irqsave(&priv->tx_lock,flags); | |
21687 | + ret = ieee80211_r8180_8023_hardstartxmit(skb,priv->ieee80211); | |
21688 | + spin_unlock_irqrestore(&priv->tx_lock,flags); | |
21689 | + return ret; | |
21690 | +} | |
21691 | +#endif | |
21692 | + | |
21693 | +int r8180_set_mac_adr(struct net_device *dev, void *mac) | |
21694 | +{ | |
21695 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
21696 | + struct sockaddr *addr = mac; | |
21697 | + | |
21698 | + down(&priv->wx_sem); | |
21699 | + | |
21700 | + memcpy(dev->dev_addr, addr->sa_data, ETH_ALEN); | |
21701 | + | |
21702 | + if(priv->ieee80211->iw_mode == IW_MODE_MASTER) | |
21703 | + memcpy(priv->ieee80211->current_network.bssid, dev->dev_addr, ETH_ALEN); | |
21704 | + | |
21705 | + if (priv->up) { | |
21706 | + rtl8180_down(dev); | |
21707 | + rtl8180_up(dev); | |
21708 | + } | |
21709 | + | |
21710 | + up(&priv->wx_sem); | |
21711 | + | |
21712 | + return 0; | |
21713 | +} | |
21714 | + | |
21715 | +/* based on ipw2200 driver */ | |
21716 | +int rtl8180_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) | |
21717 | +{ | |
21718 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
21719 | + | |
21720 | + struct iwreq *wrq = (struct iwreq *) rq; | |
21721 | + int ret=-1; | |
21722 | + switch (cmd) { | |
21723 | + case RTL_IOCTL_WPA_SUPPLICANT: | |
21724 | + ret = ieee80211_wpa_supplicant_ioctl(priv->ieee80211, &wrq->u.data); | |
21725 | + return ret; | |
21726 | + | |
21727 | + default: | |
21728 | + return -EOPNOTSUPP; | |
21729 | + } | |
21730 | + | |
21731 | + return -EOPNOTSUPP; | |
21732 | +} | |
21733 | + | |
21734 | + | |
21735 | + | |
21736 | +/**************************************************************************** | |
21737 | + -----------------------------PCI STUFF--------------------------- | |
21738 | +*****************************************************************************/ | |
21739 | + | |
21740 | + | |
21741 | +static int __devinit rtl8180_pci_probe(struct pci_dev *pdev, | |
21742 | + const struct pci_device_id *id) | |
21743 | +{ | |
21744 | + unsigned long ioaddr = 0; | |
21745 | + struct net_device *dev = NULL; | |
21746 | + struct r8180_priv *priv= NULL; | |
21747 | + //u8 *ptr; | |
21748 | + u8 unit = 0; | |
21749 | + | |
21750 | +#ifdef CONFIG_RTL8180_IO_MAP | |
21751 | + unsigned long pio_start, pio_len, pio_flags; | |
21752 | +#else | |
21753 | + unsigned long pmem_start, pmem_len, pmem_flags; | |
21754 | +#endif //end #ifdef RTL_IO_MAP | |
21755 | + | |
21756 | + DMESG("Configuring chip resources"); | |
21757 | + | |
21758 | + if( pci_enable_device (pdev) ){ | |
21759 | + DMESG("Failed to enable PCI device"); | |
21760 | + return -EIO; | |
21761 | + } | |
21762 | + | |
21763 | + pci_set_master(pdev); | |
21764 | + //pci_set_wmi(pdev); | |
21765 | + pci_set_dma_mask(pdev, 0xffffff00ULL); | |
21766 | + pci_set_consistent_dma_mask(pdev,0xffffff00ULL); | |
21767 | + dev = alloc_ieee80211(sizeof(struct r8180_priv)); | |
21768 | + if (!dev) | |
21769 | + return -ENOMEM; | |
21770 | + priv = ieee80211_priv(dev); | |
21771 | + priv->ieee80211 = netdev_priv(dev); | |
21772 | + | |
21773 | +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24) | |
21774 | + SET_MODULE_OWNER(dev); | |
21775 | +#endif | |
21776 | + pci_set_drvdata(pdev, dev); | |
21777 | + SET_NETDEV_DEV(dev, &pdev->dev); | |
21778 | + | |
21779 | + priv = ieee80211_priv(dev); | |
21780 | +// memset(priv,0,sizeof(struct r8180_priv)); | |
21781 | + priv->pdev=pdev; | |
21782 | + | |
21783 | + | |
21784 | +#ifdef CONFIG_RTL8180_IO_MAP | |
21785 | + | |
21786 | + pio_start = (unsigned long)pci_resource_start (pdev, 0); | |
21787 | + pio_len = (unsigned long)pci_resource_len (pdev, 0); | |
21788 | + pio_flags = (unsigned long)pci_resource_flags (pdev, 0); | |
21789 | + | |
21790 | + if (!(pio_flags & IORESOURCE_IO)) { | |
21791 | + DMESG("region #0 not a PIO resource, aborting"); | |
21792 | + goto fail; | |
21793 | + } | |
21794 | + | |
21795 | + //DMESG("IO space @ 0x%08lx", pio_start ); | |
21796 | + if( ! request_region( pio_start, pio_len, RTL8180_MODULE_NAME ) ){ | |
21797 | + DMESG("request_region failed!"); | |
21798 | + goto fail; | |
21799 | + } | |
21800 | + | |
21801 | + ioaddr = pio_start; | |
21802 | + dev->base_addr = ioaddr; // device I/O address | |
21803 | + | |
21804 | +#else | |
21805 | + | |
21806 | + pmem_start = pci_resource_start(pdev, 1); | |
21807 | + pmem_len = pci_resource_len(pdev, 1); | |
21808 | + pmem_flags = pci_resource_flags (pdev, 1); | |
21809 | + | |
21810 | + if (!(pmem_flags & IORESOURCE_MEM)) { | |
21811 | + DMESG("region #1 not a MMIO resource, aborting"); | |
21812 | + goto fail; | |
21813 | + } | |
21814 | + | |
21815 | + //DMESG("Memory mapped space @ 0x%08lx ", pmem_start); | |
21816 | + if( ! request_mem_region(pmem_start, pmem_len, RTL8180_MODULE_NAME)) { | |
21817 | + DMESG("request_mem_region failed!"); | |
21818 | + goto fail; | |
21819 | + } | |
21820 | + | |
21821 | + | |
21822 | + ioaddr = (unsigned long)ioremap_nocache( pmem_start, pmem_len); | |
21823 | + if( ioaddr == (unsigned long)NULL ){ | |
21824 | + DMESG("ioremap failed!"); | |
21825 | + // release_mem_region( pmem_start, pmem_len ); | |
21826 | + goto fail1; | |
21827 | + } | |
21828 | + | |
21829 | + dev->mem_start = ioaddr; // shared mem start | |
21830 | + dev->mem_end = ioaddr + pci_resource_len(pdev, 0); // shared mem end | |
21831 | + | |
21832 | +#endif //end #ifdef RTL_IO_MAP | |
21833 | + | |
21834 | +#ifdef CONFIG_RTL8185B | |
21835 | + //pci_read_config_byte(pdev, 0x05, ptr); | |
21836 | + //pci_write_config_byte(pdev, 0x05, (*ptr) & (~0x04)); | |
21837 | + pci_read_config_byte(pdev, 0x05, &unit); | |
21838 | + pci_write_config_byte(pdev, 0x05, unit & (~0x04)); | |
21839 | +#endif | |
21840 | + | |
21841 | + dev->irq = pdev->irq; | |
21842 | + priv->irq = 0; | |
21843 | + | |
21844 | + dev->open = rtl8180_open; | |
21845 | + dev->stop = rtl8180_close; | |
21846 | + //dev->hard_start_xmit = ieee80211_xmit; | |
21847 | + dev->tx_timeout = rtl8180_restart; | |
21848 | + dev->wireless_handlers = &r8180_wx_handlers_def; | |
21849 | + dev->do_ioctl = rtl8180_ioctl; | |
21850 | + dev->set_multicast_list = r8180_set_multicast; | |
21851 | + dev->set_mac_address = r8180_set_mac_adr; | |
21852 | + | |
21853 | +#if WIRELESS_EXT >= 12 | |
21854 | +#if WIRELESS_EXT < 17 | |
21855 | + dev->get_wireless_stats = r8180_get_wireless_stats; | |
21856 | +#endif | |
21857 | + dev->wireless_handlers = (struct iw_handler_def *) &r8180_wx_handlers_def; | |
21858 | +#endif | |
21859 | + | |
21860 | + dev->type=ARPHRD_ETHER; | |
21861 | + dev->watchdog_timeo = HZ*3; //added by david woo, 2007.12.13 | |
21862 | + | |
21863 | + if (dev_alloc_name(dev, ifname) < 0){ | |
21864 | + DMESG("Oops: devname already taken! Trying wlan%%d...\n"); | |
21865 | + ifname = "wlan%d"; | |
21866 | + // ifname = "ath%d"; | |
21867 | + dev_alloc_name(dev, ifname); | |
21868 | + } | |
21869 | + | |
21870 | + | |
21871 | + if(rtl8180_init(dev)!=0){ | |
21872 | + DMESG("Initialization failed"); | |
21873 | + goto fail1; | |
21874 | + } | |
21875 | + | |
21876 | + netif_carrier_off(dev); | |
21877 | + | |
21878 | + register_netdev(dev); | |
21879 | + | |
21880 | + rtl8180_proc_init_one(dev); | |
21881 | + | |
21882 | + DMESG("Driver probe completed\n"); | |
21883 | + return 0; | |
21884 | + | |
21885 | +fail1: | |
21886 | + | |
21887 | +#ifdef CONFIG_RTL8180_IO_MAP | |
21888 | + | |
21889 | + if( dev->base_addr != 0 ){ | |
21890 | + | |
21891 | + release_region(dev->base_addr, | |
21892 | + pci_resource_len(pdev, 0) ); | |
21893 | + } | |
21894 | +#else | |
21895 | + if( dev->mem_start != (unsigned long)NULL ){ | |
21896 | + iounmap( (void *)dev->mem_start ); | |
21897 | + release_mem_region( pci_resource_start(pdev, 1), | |
21898 | + pci_resource_len(pdev, 1) ); | |
21899 | + } | |
21900 | +#endif //end #ifdef RTL_IO_MAP | |
21901 | + | |
21902 | + | |
21903 | +fail: | |
21904 | + if(dev){ | |
21905 | + | |
21906 | + if (priv->irq) { | |
21907 | + free_irq(dev->irq, dev); | |
21908 | + dev->irq=0; | |
21909 | + } | |
21910 | + free_ieee80211(dev); | |
21911 | + } | |
21912 | + | |
21913 | + pci_disable_device(pdev); | |
21914 | + | |
21915 | + DMESG("wlan driver load failed\n"); | |
21916 | + pci_set_drvdata(pdev, NULL); | |
21917 | + return -ENODEV; | |
21918 | + | |
21919 | +} | |
21920 | + | |
21921 | + | |
21922 | +static void __devexit rtl8180_pci_remove(struct pci_dev *pdev) | |
21923 | +{ | |
21924 | + struct r8180_priv *priv; | |
21925 | + struct net_device *dev = pci_get_drvdata(pdev); | |
21926 | + if(dev){ | |
21927 | + | |
21928 | + unregister_netdev(dev); | |
21929 | + | |
21930 | + priv=ieee80211_priv(dev); | |
21931 | + | |
21932 | + rtl8180_proc_remove_one(dev); | |
21933 | + rtl8180_down(dev); | |
21934 | + priv->rf_close(dev); | |
21935 | + rtl8180_reset(dev); | |
21936 | + //rtl8180_rtx_disable(dev); | |
21937 | + //rtl8180_irq_disable(dev); | |
21938 | + mdelay(10); | |
21939 | + //write_nic_word(dev,INTA,read_nic_word(dev,INTA)); | |
21940 | + //force_pci_posting(dev); | |
21941 | + //mdelay(10); | |
21942 | + | |
21943 | + if(priv->irq){ | |
21944 | + | |
21945 | + DMESG("Freeing irq %d",dev->irq); | |
21946 | + free_irq(dev->irq, dev); | |
21947 | + priv->irq=0; | |
21948 | + | |
21949 | + } | |
21950 | + | |
21951 | + free_rx_desc_ring(dev); | |
21952 | + free_tx_desc_rings(dev); | |
21953 | + // free_beacon_desc_ring(dev,priv->txbeaconcount); | |
21954 | + | |
21955 | +#ifdef CONFIG_RTL8180_IO_MAP | |
21956 | + | |
21957 | + if( dev->base_addr != 0 ){ | |
21958 | + | |
21959 | + release_region(dev->base_addr, | |
21960 | + pci_resource_len(pdev, 0) ); | |
21961 | + } | |
21962 | +#else | |
21963 | + if( dev->mem_start != (unsigned long)NULL ){ | |
21964 | + iounmap( (void *)dev->mem_start ); | |
21965 | + release_mem_region( pci_resource_start(pdev, 1), | |
21966 | + pci_resource_len(pdev, 1) ); | |
21967 | + } | |
21968 | +#endif /*end #ifdef RTL_IO_MAP*/ | |
21969 | + | |
21970 | + free_ieee80211(dev); | |
21971 | + } | |
21972 | + pci_disable_device(pdev); | |
21973 | + | |
21974 | + DMESG("wlan driver removed\n"); | |
21975 | +} | |
21976 | + | |
21977 | + | |
21978 | +/* fun with the built-in ieee80211 stack... */ | |
21979 | +extern int ieee80211_crypto_init(void); | |
21980 | +extern void ieee80211_crypto_deinit(void); | |
21981 | +extern int ieee80211_crypto_tkip_init(void); | |
21982 | +extern void ieee80211_crypto_tkip_exit(void); | |
21983 | +extern int ieee80211_crypto_ccmp_init(void); | |
21984 | +extern void ieee80211_crypto_ccmp_exit(void); | |
21985 | +extern int ieee80211_crypto_wep_init(void); | |
21986 | +extern void ieee80211_crypto_wep_exit(void); | |
21987 | + | |
21988 | +static int __init rtl8180_pci_module_init(void) | |
21989 | +{ | |
21990 | + int ret; | |
21991 | + | |
21992 | + ret = ieee80211_crypto_init(); | |
21993 | + if (ret) { | |
21994 | + printk(KERN_ERR "ieee80211_crypto_init() failed %d\n", ret); | |
21995 | + return ret; | |
21996 | + } | |
21997 | + ret = ieee80211_crypto_tkip_init(); | |
21998 | + if (ret) { | |
21999 | + printk(KERN_ERR "ieee80211_crypto_tkip_init() failed %d\n", ret); | |
22000 | + return ret; | |
22001 | + } | |
22002 | + ret = ieee80211_crypto_ccmp_init(); | |
22003 | + if (ret) { | |
22004 | + printk(KERN_ERR "ieee80211_crypto_ccmp_init() failed %d\n", ret); | |
22005 | + return ret; | |
22006 | + } | |
22007 | + ret = ieee80211_crypto_wep_init(); | |
22008 | + if (ret) { | |
22009 | + printk(KERN_ERR "ieee80211_crypto_wep_init() failed %d\n", ret); | |
22010 | + return ret; | |
22011 | + } | |
22012 | + | |
22013 | + printk(KERN_INFO "\nLinux kernel driver for RTL8180 \ | |
22014 | +/ RTL8185 based WLAN cards\n"); | |
22015 | + printk(KERN_INFO "Copyright (c) 2004-2005, Andrea Merello\n"); | |
22016 | + DMESG("Initializing module"); | |
22017 | + DMESG("Wireless extensions version %d", WIRELESS_EXT); | |
22018 | + rtl8180_proc_module_init(); | |
22019 | + | |
22020 | +#if(LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22)) | |
22021 | + if(0!=pci_module_init(&rtl8180_pci_driver)) | |
22022 | +#else | |
22023 | + if(0!=pci_register_driver(&rtl8180_pci_driver)) | |
22024 | +#endif | |
22025 | + //if(0!=pci_module_init(&rtl8180_pci_driver)) | |
22026 | + { | |
22027 | + DMESG("No device found"); | |
22028 | + /*pci_unregister_driver (&rtl8180_pci_driver);*/ | |
22029 | + return -ENODEV; | |
22030 | + } | |
22031 | + return 0; | |
22032 | +} | |
22033 | + | |
22034 | + | |
22035 | +static void __exit rtl8180_pci_module_exit(void) | |
22036 | +{ | |
22037 | + pci_unregister_driver (&rtl8180_pci_driver); | |
22038 | + rtl8180_proc_module_remove(); | |
22039 | + ieee80211_crypto_deinit(); | |
22040 | + ieee80211_crypto_tkip_exit(); | |
22041 | + ieee80211_crypto_ccmp_exit(); | |
22042 | + ieee80211_crypto_wep_exit(); | |
22043 | + DMESG("Exiting"); | |
22044 | +} | |
22045 | + | |
22046 | + | |
22047 | +void rtl8180_try_wake_queue(struct net_device *dev, int pri) | |
22048 | +{ | |
22049 | + unsigned long flags; | |
22050 | + short enough_desc; | |
22051 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
22052 | + | |
22053 | + spin_lock_irqsave(&priv->tx_lock,flags); | |
22054 | + enough_desc = check_nic_enought_desc(dev,pri); | |
22055 | + spin_unlock_irqrestore(&priv->tx_lock,flags); | |
22056 | + | |
22057 | + if(enough_desc) | |
22058 | + ieee80211_wake_queue(priv->ieee80211); | |
22059 | +} | |
22060 | + | |
22061 | +/***************************************************************************** | |
22062 | + -----------------------------IRQ STUFF--------------------------- | |
22063 | +******************************************************************************/ | |
22064 | + | |
22065 | +void rtl8180_tx_isr(struct net_device *dev, int pri,short error) | |
22066 | +{ | |
22067 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
22068 | + | |
22069 | + u32 *tail; //tail virtual addr | |
22070 | + u32 *head; //head virtual addr | |
22071 | + u32 *begin;//start of ring virtual addr | |
22072 | + u32 *nicv; //nic pointer virtual addr | |
22073 | +// u32 *txdv; //packet just TXed | |
22074 | + u32 nic; //nic pointer physical addr | |
22075 | + u32 nicbegin;// start of ring physical addr | |
22076 | +// short txed; | |
22077 | + unsigned long flag; | |
22078 | + /* physical addr are ok on 32 bits since we set DMA mask*/ | |
22079 | + | |
22080 | + int offs; | |
22081 | + int j,i; | |
22082 | + int hd; | |
22083 | + if (error) priv->stats.txretry++; //tony 20060601 | |
22084 | + spin_lock_irqsave(&priv->tx_lock,flag); | |
22085 | + switch(pri) { | |
22086 | + case MANAGE_PRIORITY: | |
22087 | + tail = priv->txmapringtail; | |
22088 | + begin = priv->txmapring; | |
22089 | + head = priv->txmapringhead; | |
22090 | + nic = read_nic_dword(dev,TX_MANAGEPRIORITY_RING_ADDR); | |
22091 | + nicbegin = priv->txmapringdma; | |
22092 | + break; | |
22093 | + | |
22094 | + case BK_PRIORITY: | |
22095 | + tail = priv->txbkpringtail; | |
22096 | + begin = priv->txbkpring; | |
22097 | + head = priv->txbkpringhead; | |
22098 | + nic = read_nic_dword(dev,TX_BKPRIORITY_RING_ADDR); | |
22099 | + nicbegin = priv->txbkpringdma; | |
22100 | + break; | |
22101 | + | |
22102 | + case BE_PRIORITY: | |
22103 | + tail = priv->txbepringtail; | |
22104 | + begin = priv->txbepring; | |
22105 | + head = priv->txbepringhead; | |
22106 | + nic = read_nic_dword(dev,TX_BEPRIORITY_RING_ADDR); | |
22107 | + nicbegin = priv->txbepringdma; | |
22108 | + break; | |
22109 | + | |
22110 | + case VI_PRIORITY: | |
22111 | + tail = priv->txvipringtail; | |
22112 | + begin = priv->txvipring; | |
22113 | + head = priv->txvipringhead; | |
22114 | + nic = read_nic_dword(dev,TX_VIPRIORITY_RING_ADDR); | |
22115 | + nicbegin = priv->txvipringdma; | |
22116 | + break; | |
22117 | + | |
22118 | + case VO_PRIORITY: | |
22119 | + tail = priv->txvopringtail; | |
22120 | + begin = priv->txvopring; | |
22121 | + head = priv->txvopringhead; | |
22122 | + nic = read_nic_dword(dev,TX_VOPRIORITY_RING_ADDR); | |
22123 | + nicbegin = priv->txvopringdma; | |
22124 | + break; | |
22125 | + | |
22126 | + case HI_PRIORITY: | |
22127 | + tail = priv->txhpringtail; | |
22128 | + begin = priv->txhpring; | |
22129 | + head = priv->txhpringhead; | |
22130 | + nic = read_nic_dword(dev,TX_HIGHPRIORITY_RING_ADDR); | |
22131 | + nicbegin = priv->txhpringdma; | |
22132 | + break; | |
22133 | + | |
22134 | + default: | |
22135 | + spin_unlock_irqrestore(&priv->tx_lock,flag); | |
22136 | + return ; | |
22137 | + } | |
22138 | +/* DMESG("%x %s %x %x",((int)nic & 0xfff)/8/4, | |
22139 | + *(priv->txnpring + ((int)nic&0xfff)/4/8) & (1<<31) ? "filled" : "empty", | |
22140 | + (priv->txnpringtail - priv->txnpring)/8,(priv->txnpringhead - | |
22141 | +priv->txnpring)/8); | |
22142 | +*/ | |
22143 | + //nicv = (u32*) ((nic - nicbegin) + (int)begin); | |
22144 | + nicv = (u32*) ((nic - nicbegin) + (u8*)begin); | |
22145 | + if((head <= tail && (nicv > tail || nicv < head)) || | |
22146 | + (head > tail && (nicv > tail && nicv < head))){ | |
22147 | + | |
22148 | + DMESGW("nic has lost pointer"); | |
22149 | +#ifdef DEBUG_TX_DESC | |
22150 | + //check_tx_ring(dev,NORM_PRIORITY); | |
22151 | + check_tx_ring(dev,pri); | |
22152 | +#endif | |
22153 | + spin_unlock_irqrestore(&priv->tx_lock,flag); | |
22154 | + rtl8180_restart(dev); | |
22155 | + return; | |
22156 | + } | |
22157 | + | |
22158 | + /* we check all the descriptors between the head and the nic, | |
22159 | + * but not the currenly pointed by the nic (the next to be txed) | |
22160 | + * and the previous of the pointed (might be in process ??) | |
22161 | + */ | |
22162 | + //if (head == nic) return; | |
22163 | + //DMESG("%x %x",head,nic); | |
22164 | + offs = (nic - nicbegin); | |
22165 | + //DMESG("%x %x %x",nic ,(u32)nicbegin, (int)nic -nicbegin); | |
22166 | + | |
22167 | + offs = offs / 8 /4; | |
22168 | + | |
22169 | + hd = (head - begin) /8; | |
22170 | + | |
22171 | + if(offs >= hd) | |
22172 | + j = offs - hd; | |
22173 | + else | |
22174 | + j = offs + (priv->txringcount -1 -hd); | |
22175 | + // j= priv->txringcount -1- (hd - offs); | |
22176 | + | |
22177 | + j-=2; | |
22178 | + if(j<0) j=0; | |
22179 | + | |
22180 | + | |
22181 | + for(i=0;i<j;i++) | |
22182 | + { | |
22183 | +// printk("+++++++++++++check status desc\n"); | |
22184 | + if((*head) & (1<<31)) | |
22185 | + break; | |
22186 | + if(((*head)&(0x10000000)) != 0){ | |
22187 | +// printk("++++++++++++++last desc,retry count is %d\n",((*head) & (0x000000ff))); | |
22188 | + priv->CurrRetryCnt += (u16)((*head) & (0x000000ff)); | |
22189 | +#if 1 | |
22190 | + if(!error) | |
22191 | + { | |
22192 | + priv->NumTxOkTotal++; | |
22193 | +// printk("NumTxOkTotal is %d\n",priv->NumTxOkTotal++); | |
22194 | + } | |
22195 | +#endif | |
22196 | + // printk("in function %s:curr_retry_count is %d\n",__FUNCTION__,((*head) & (0x000000ff))); | |
22197 | + } | |
22198 | + if(!error){ | |
22199 | + priv->NumTxOkBytesTotal += (*(head+3)) & (0x00000fff); | |
22200 | + } | |
22201 | +// printk("in function %s:curr_txokbyte_count is %d\n",__FUNCTION__,(*(head+3)) & (0x00000fff)); | |
22202 | + *head = *head &~ (1<<31); | |
22203 | + | |
22204 | + if((head - begin)/8 == priv->txringcount-1) | |
22205 | + head=begin; | |
22206 | + | |
22207 | + else | |
22208 | + head+=8; | |
22209 | + } | |
22210 | +#if 0 | |
22211 | + if(nicv == begin) | |
22212 | + txdv = begin + (priv->txringcount -1)*8; | |
22213 | + else | |
22214 | + txdv = nicv - 8; | |
22215 | + | |
22216 | + txed = !(txdv[0] &(1<<31)); | |
22217 | + | |
22218 | + if(txed){ | |
22219 | + if(!(txdv[0] & (1<<15))) error = 1; | |
22220 | + //if(!(txdv[0] & (1<<30))) error = 1; | |
22221 | + if(error)DMESG("%x",txdv[0]); | |
22222 | + } | |
22223 | +#endif | |
22224 | + //DMESG("%x",txdv[0]); | |
22225 | + /* the head has been moved to the last certainly TXed | |
22226 | + * (or at least processed by the nic) packet. | |
22227 | + * The driver take forcefully owning of all these packets | |
22228 | + * If the packet previous of the nic pointer has been | |
22229 | + * processed this doesn't matter: it will be checked | |
22230 | + * here at the next round. Anyway if no more packet are | |
22231 | + * TXed no memory leak occour at all. | |
22232 | + */ | |
22233 | + | |
22234 | + switch(pri) { | |
22235 | + case MANAGE_PRIORITY: | |
22236 | + priv->txmapringhead = head; | |
22237 | + //printk("1==========================================> priority check!\n"); | |
22238 | + if(priv->ack_tx_to_ieee){ | |
22239 | + // try to implement power-save mode 2008.1.22 | |
22240 | + // printk("2==========================================> priority check!\n"); | |
22241 | +#if 1 | |
22242 | + if(rtl8180_is_tx_queue_empty(dev)){ | |
22243 | + // printk("tx queue empty, after send null sleep packet, try to sleep !\n"); | |
22244 | + priv->ack_tx_to_ieee = 0; | |
22245 | + ieee80211_ps_tx_ack(priv->ieee80211,!error); | |
22246 | + } | |
22247 | +#endif | |
22248 | + } | |
22249 | + break; | |
22250 | + | |
22251 | + case BK_PRIORITY: | |
22252 | + priv->txbkpringhead = head; | |
22253 | + break; | |
22254 | + | |
22255 | + case BE_PRIORITY: | |
22256 | + priv->txbepringhead = head; | |
22257 | + break; | |
22258 | + | |
22259 | + case VI_PRIORITY: | |
22260 | + priv->txvipringhead = head; | |
22261 | + break; | |
22262 | + | |
22263 | + case VO_PRIORITY: | |
22264 | + priv->txvopringhead = head; | |
22265 | + break; | |
22266 | + | |
22267 | + case HI_PRIORITY: | |
22268 | + priv->txhpringhead = head; | |
22269 | + break; | |
22270 | + } | |
22271 | + | |
22272 | + /*DMESG("%x %x %x", (priv->txnpringhead - priv->txnpring) /8 , | |
22273 | + (priv->txnpringtail - priv->txnpring) /8, | |
22274 | + offs ); | |
22275 | + */ | |
22276 | + | |
22277 | + spin_unlock_irqrestore(&priv->tx_lock,flag); | |
22278 | + | |
22279 | +} | |
22280 | + | |
22281 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
22282 | +void rtl8180_tx_irq_wq(struct work_struct *work) | |
22283 | +{ | |
22284 | + //struct r8180_priv *priv = container_of(work, struct r8180_priv, reset_wq); | |
22285 | + struct delayed_work *dwork = container_of(work,struct delayed_work,work); | |
22286 | + struct ieee80211_device * ieee = (struct ieee80211_device*) | |
22287 | + container_of(dwork, struct ieee80211_device, watch_dog_wq); | |
22288 | + struct net_device *dev = ieee->dev; | |
22289 | +#else | |
22290 | +void rtl8180_tx_irq_wq(struct net_device *dev) | |
22291 | +{ | |
22292 | + //struct r8180_priv *priv = ieee80211_priv(dev); | |
22293 | +#endif | |
22294 | + rtl8180_tx_isr(dev,MANAGE_PRIORITY,0); | |
22295 | +} | |
22296 | +irqreturn_t rtl8180_interrupt(int irq, void *netdev, struct pt_regs *regs) | |
22297 | +{ | |
22298 | + struct net_device *dev = (struct net_device *) netdev; | |
22299 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
22300 | + unsigned long flags; | |
22301 | + u32 inta; | |
22302 | + | |
22303 | + /* We should return IRQ_NONE, but for now let me keep this */ | |
22304 | + if(priv->irq_enabled == 0) return IRQ_HANDLED; | |
22305 | + | |
22306 | + spin_lock_irqsave(&priv->irq_th_lock,flags); | |
22307 | + | |
22308 | +#ifdef CONFIG_RTL8185B | |
22309 | + //ISR: 4bytes | |
22310 | + inta = read_nic_dword(dev, ISR);// & priv->IntrMask; | |
22311 | + write_nic_dword(dev,ISR,inta); // reset int situation | |
22312 | +#else | |
22313 | + inta = read_nic_word(dev,INTA) & priv->irq_mask; | |
22314 | + write_nic_word(dev,INTA,inta); // reset int situation | |
22315 | +#endif | |
22316 | + | |
22317 | + priv->stats.shints++; | |
22318 | + | |
22319 | + //DMESG("Enter interrupt, ISR value = 0x%08x", inta); | |
22320 | + | |
22321 | + if(!inta){ | |
22322 | + spin_unlock_irqrestore(&priv->irq_th_lock,flags); | |
22323 | + return IRQ_HANDLED; | |
22324 | + /* | |
22325 | + most probably we can safely return IRQ_NONE, | |
22326 | + but for now is better to avoid problems | |
22327 | + */ | |
22328 | + } | |
22329 | + | |
22330 | + if(inta == 0xffff){ | |
22331 | + /* HW disappared */ | |
22332 | + spin_unlock_irqrestore(&priv->irq_th_lock,flags); | |
22333 | + return IRQ_HANDLED; | |
22334 | + } | |
22335 | + | |
22336 | + priv->stats.ints++; | |
22337 | +#ifdef DEBUG_IRQ | |
22338 | + DMESG("NIC irq %x",inta); | |
22339 | +#endif | |
22340 | + //priv->irqpending = inta; | |
22341 | + | |
22342 | + | |
22343 | + if(!netif_running(dev)) { | |
22344 | + spin_unlock_irqrestore(&priv->irq_th_lock,flags); | |
22345 | + return IRQ_HANDLED; | |
22346 | + } | |
22347 | + | |
22348 | + if(inta & ISR_TimeOut){ | |
22349 | + write_nic_dword(dev, TimerInt, 0); | |
22350 | + //DMESG("=================>waking up"); | |
22351 | +// rtl8180_hw_wakeup(dev); | |
22352 | + } | |
22353 | + | |
22354 | + if(inta & ISR_TBDOK){ | |
22355 | + priv->stats.txbeacon++; | |
22356 | + } | |
22357 | + | |
22358 | + if(inta & ISR_TBDER){ | |
22359 | + priv->stats.txbeaconerr++; | |
22360 | + } | |
22361 | + | |
22362 | + if(inta & IMR_TMGDOK ) { | |
22363 | +// priv->NumTxOkTotal++; | |
22364 | + rtl8180_tx_isr(dev,MANAGE_PRIORITY,0); | |
22365 | +// schedule_work(&priv->tx_irq_wq); | |
22366 | + | |
22367 | + } | |
22368 | + | |
22369 | + if(inta & ISR_THPDER){ | |
22370 | +#ifdef DEBUG_TX | |
22371 | + DMESG ("TX high priority ERR"); | |
22372 | +#endif | |
22373 | + priv->stats.txhperr++; | |
22374 | + rtl8180_tx_isr(dev,HI_PRIORITY,1); | |
22375 | + priv->ieee80211->stats.tx_errors++; | |
22376 | + } | |
22377 | + | |
22378 | + if(inta & ISR_THPDOK){ //High priority tx ok | |
22379 | +#ifdef DEBUG_TX | |
22380 | + DMESG ("TX high priority OK"); | |
22381 | +#endif | |
22382 | +// priv->NumTxOkTotal++; | |
22383 | + //priv->NumTxOkInPeriod++; //YJ,del,080828 | |
22384 | + priv->link_detect.NumTxOkInPeriod++; //YJ,add,080828 | |
22385 | + priv->stats.txhpokint++; | |
22386 | + rtl8180_tx_isr(dev,HI_PRIORITY,0); | |
22387 | + } | |
22388 | + | |
22389 | + if(inta & ISR_RER) { | |
22390 | + priv->stats.rxerr++; | |
22391 | +#ifdef DEBUG_RX | |
22392 | + DMESGW("RX error int"); | |
22393 | +#endif | |
22394 | + } | |
22395 | +#ifdef CONFIG_RTL8185B | |
22396 | + if(inta & ISR_TBKDER){ //corresponding to BK_PRIORITY | |
22397 | + priv->stats.txbkperr++; | |
22398 | + priv->ieee80211->stats.tx_errors++; | |
22399 | +#ifdef DEBUG_TX | |
22400 | + DMESGW("TX bkp error int"); | |
22401 | +#endif | |
22402 | + //tasklet_schedule(&priv->irq_tx_tasklet); | |
22403 | + rtl8180_tx_isr(dev,BK_PRIORITY,1); | |
22404 | + rtl8180_try_wake_queue(dev, BE_PRIORITY); | |
22405 | + } | |
22406 | + | |
22407 | + if(inta & ISR_TBEDER){ //corresponding to BE_PRIORITY | |
22408 | + priv->stats.txbeperr++; | |
22409 | + priv->ieee80211->stats.tx_errors++; | |
22410 | +#ifdef DEBUG_TX | |
22411 | + DMESGW("TX bep error int"); | |
22412 | +#endif | |
22413 | + rtl8180_tx_isr(dev,BE_PRIORITY,1); | |
22414 | + //tasklet_schedule(&priv->irq_tx_tasklet); | |
22415 | + rtl8180_try_wake_queue(dev, BE_PRIORITY); | |
22416 | + } | |
22417 | +#endif | |
22418 | + if(inta & ISR_TNPDER){ //corresponding to VO_PRIORITY | |
22419 | + priv->stats.txnperr++; | |
22420 | + priv->ieee80211->stats.tx_errors++; | |
22421 | +#ifdef DEBUG_TX | |
22422 | + DMESGW("TX np error int"); | |
22423 | +#endif | |
22424 | + //tasklet_schedule(&priv->irq_tx_tasklet); | |
22425 | + rtl8180_tx_isr(dev,NORM_PRIORITY,1); | |
22426 | +#ifdef CONFIG_RTL8185B | |
22427 | + rtl8180_try_wake_queue(dev, NORM_PRIORITY); | |
22428 | +#endif | |
22429 | + } | |
22430 | + | |
22431 | + if(inta & ISR_TLPDER){ //corresponding to VI_PRIORITY | |
22432 | + priv->stats.txlperr++; | |
22433 | + priv->ieee80211->stats.tx_errors++; | |
22434 | +#ifdef DEBUG_TX | |
22435 | + DMESGW("TX lp error int"); | |
22436 | +#endif | |
22437 | + rtl8180_tx_isr(dev,LOW_PRIORITY,1); | |
22438 | + //tasklet_schedule(&priv->irq_tx_tasklet); | |
22439 | + rtl8180_try_wake_queue(dev, LOW_PRIORITY); | |
22440 | + } | |
22441 | + | |
22442 | + if(inta & ISR_ROK){ | |
22443 | +#ifdef DEBUG_RX | |
22444 | + DMESG("Frame arrived !"); | |
22445 | +#endif | |
22446 | + //priv->NumRxOkInPeriod++; //YJ,del,080828 | |
22447 | + priv->stats.rxint++; | |
22448 | + tasklet_schedule(&priv->irq_rx_tasklet); | |
22449 | + } | |
22450 | + | |
22451 | + if(inta & ISR_RQoSOK ){ | |
22452 | +#ifdef DEBUG_RX | |
22453 | + DMESG("QoS Frame arrived !"); | |
22454 | +#endif | |
22455 | + //priv->NumRxOkInPeriod++; //YJ,del,080828 | |
22456 | + priv->stats.rxint++; | |
22457 | + tasklet_schedule(&priv->irq_rx_tasklet); | |
22458 | + } | |
22459 | + if(inta & ISR_BcnInt) { | |
22460 | + //DMESG("Preparing Beacons"); | |
22461 | + rtl8180_prepare_beacon(dev); | |
22462 | + } | |
22463 | + | |
22464 | + if(inta & ISR_RDU){ | |
22465 | +//#ifdef DEBUG_RX | |
22466 | + DMESGW("No RX descriptor available"); | |
22467 | + priv->stats.rxrdu++; | |
22468 | +//#endif | |
22469 | + tasklet_schedule(&priv->irq_rx_tasklet); | |
22470 | + /*queue_work(priv->workqueue ,&priv->restart_work);*/ | |
22471 | + | |
22472 | + } | |
22473 | + if(inta & ISR_RXFOVW){ | |
22474 | +#ifdef DEBUG_RX | |
22475 | + DMESGW("RX fifo overflow"); | |
22476 | +#endif | |
22477 | + priv->stats.rxoverflow++; | |
22478 | + tasklet_schedule(&priv->irq_rx_tasklet); | |
22479 | + //queue_work(priv->workqueue ,&priv->restart_work); | |
22480 | + } | |
22481 | + | |
22482 | + if(inta & ISR_TXFOVW) priv->stats.txoverflow++; | |
22483 | + | |
22484 | + if(inta & ISR_TNPDOK){ //Normal priority tx ok | |
22485 | +#ifdef DEBUG_TX | |
22486 | + DMESG ("TX normal priority OK"); | |
22487 | +#endif | |
22488 | +// priv->NumTxOkTotal++; | |
22489 | + //priv->NumTxOkInPeriod++; //YJ,del,080828 | |
22490 | + priv->link_detect.NumTxOkInPeriod++; //YJ,add,080828 | |
22491 | + // priv->ieee80211->stats.tx_packets++; | |
22492 | + priv->stats.txnpokint++; | |
22493 | + rtl8180_tx_isr(dev,NORM_PRIORITY,0); | |
22494 | + } | |
22495 | + | |
22496 | + if(inta & ISR_TLPDOK){ //Low priority tx ok | |
22497 | +#ifdef DEBUG_TX | |
22498 | + DMESG ("TX low priority OK"); | |
22499 | +#endif | |
22500 | +// priv->NumTxOkTotal++; | |
22501 | + //priv->NumTxOkInPeriod++; //YJ,del,080828 | |
22502 | + priv->link_detect.NumTxOkInPeriod++; //YJ,add,080828 | |
22503 | + // priv->ieee80211->stats.tx_packets++; | |
22504 | + priv->stats.txlpokint++; | |
22505 | + rtl8180_tx_isr(dev,LOW_PRIORITY,0); | |
22506 | + rtl8180_try_wake_queue(dev, LOW_PRIORITY); | |
22507 | + } | |
22508 | + | |
22509 | +#ifdef CONFIG_RTL8185B | |
22510 | + if(inta & ISR_TBKDOK){ //corresponding to BK_PRIORITY | |
22511 | + priv->stats.txbkpokint++; | |
22512 | +#ifdef DEBUG_TX | |
22513 | + DMESGW("TX bk priority ok"); | |
22514 | +#endif | |
22515 | +// priv->NumTxOkTotal++; | |
22516 | + //priv->NumTxOkInPeriod++; //YJ,del,080828 | |
22517 | + priv->link_detect.NumTxOkInPeriod++; //YJ,add,080828 | |
22518 | + rtl8180_tx_isr(dev,BK_PRIORITY,0); | |
22519 | + rtl8180_try_wake_queue(dev, BE_PRIORITY); | |
22520 | + } | |
22521 | + | |
22522 | + if(inta & ISR_TBEDOK){ //corresponding to BE_PRIORITY | |
22523 | + priv->stats.txbeperr++; | |
22524 | +#ifdef DEBUG_TX | |
22525 | + DMESGW("TX be priority ok"); | |
22526 | +#endif | |
22527 | +// priv->NumTxOkTotal++; | |
22528 | + //priv->NumTxOkInPeriod++; //YJ,del,080828 | |
22529 | + priv->link_detect.NumTxOkInPeriod++; //YJ,add,080828 | |
22530 | + rtl8180_tx_isr(dev,BE_PRIORITY,0); | |
22531 | + rtl8180_try_wake_queue(dev, BE_PRIORITY); | |
22532 | + } | |
22533 | +#endif | |
22534 | + force_pci_posting(dev); | |
22535 | + spin_unlock_irqrestore(&priv->irq_th_lock,flags); | |
22536 | + | |
22537 | + return IRQ_HANDLED; | |
22538 | +} | |
22539 | + | |
22540 | + | |
22541 | +void rtl8180_irq_rx_tasklet(struct r8180_priv* priv) | |
22542 | +{ | |
22543 | +// unsigned long flags; | |
22544 | + | |
22545 | +/* spin_lock_irqsave(&priv->irq_lock, flags); | |
22546 | + priv->irq_mask &=~IMR_ROK; | |
22547 | + priv->irq_mask &=~IMR_RDU; | |
22548 | + | |
22549 | + rtl8180_irq_enable(priv->dev); | |
22550 | + spin_unlock_irqrestore(&priv->irq_lock, flags); | |
22551 | +*/ | |
22552 | + rtl8180_rx(priv->dev); | |
22553 | + | |
22554 | +/* spin_lock_irqsave(&priv->irq_lock, flags); | |
22555 | + priv->irq_mask |= IMR_ROK; | |
22556 | + priv->irq_mask |= IMR_RDU; | |
22557 | + rtl8180_irq_enable(priv->dev); | |
22558 | + spin_unlock_irqrestore(&priv->irq_lock, flags); | |
22559 | +*/ | |
22560 | +} | |
22561 | + | |
22562 | +/**************************************************************************** | |
22563 | +lizhaoming--------------------------- RF power on/power off ----------------- | |
22564 | +*****************************************************************************/ | |
22565 | + | |
22566 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20)) | |
22567 | +void GPIOChangeRFWorkItemCallBack(struct work_struct *work) | |
22568 | +{ | |
22569 | + //struct delayed_work *dwork = container_of(work, struct delayed_work, work); | |
22570 | + struct ieee80211_device *ieee = container_of(work, struct ieee80211_device, GPIOChangeRFWorkItem.work); | |
22571 | + struct net_device *dev = ieee->dev; | |
22572 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
22573 | +#else | |
22574 | +void GPIOChangeRFWorkItemCallBack(struct ieee80211_device *ieee) | |
22575 | +{ | |
22576 | + struct net_device *dev = ieee->dev; | |
22577 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
22578 | +#endif | |
22579 | + | |
22580 | + //u16 tmp2byte; | |
22581 | + u8 btPSR; | |
22582 | + u8 btConfig0; | |
22583 | + RT_RF_POWER_STATE eRfPowerStateToSet; | |
22584 | + bool bActuallySet=false; | |
22585 | + | |
22586 | + char *argv[3]; | |
22587 | + static char *RadioPowerPath = "/etc/acpi/events/RadioPower.sh"; | |
22588 | + static char *envp[] = {"HOME=/", "TERM=linux", "PATH=/usr/bin:/bin", NULL}; | |
22589 | + static int readf_count = 0; | |
22590 | + //printk("============>%s in \n", __func__); | |
22591 | + | |
22592 | +#ifdef ENABLE_LPS | |
22593 | + if(readf_count % 10 == 0) | |
22594 | + priv->PowerProfile = read_acadapter_file("/proc/acpi/ac_adapter/AC0/state"); | |
22595 | + | |
22596 | + readf_count = (readf_count+1)%0xffff; | |
22597 | +#endif | |
22598 | +#if 0 | |
22599 | + if(priv->up == 0)//driver stopped | |
22600 | + { | |
22601 | + printk("\nDo nothing..."); | |
22602 | + goto out; | |
22603 | + } | |
22604 | + else | |
22605 | +#endif | |
22606 | + { | |
22607 | + // We should turn off LED before polling FF51[4]. | |
22608 | + | |
22609 | + //Turn off LED. | |
22610 | + btPSR = read_nic_byte(dev, PSR); | |
22611 | + write_nic_byte(dev, PSR, (btPSR & ~BIT3)); | |
22612 | + | |
22613 | + //It need to delay 4us suggested by Jong, 2008-01-16 | |
22614 | + udelay(4); | |
22615 | + | |
22616 | + //HW radio On/Off according to the value of FF51[4](config0) | |
22617 | + btConfig0 = btPSR = read_nic_byte(dev, CONFIG0); | |
22618 | + | |
22619 | + //Turn on LED. | |
22620 | + write_nic_byte(dev, PSR, btPSR| BIT3); | |
22621 | + | |
22622 | + eRfPowerStateToSet = (btConfig0 & BIT4) ? eRfOn : eRfOff; | |
22623 | + | |
22624 | + if((priv->ieee80211->bHwRadioOff == true) && (eRfPowerStateToSet == eRfOn)) | |
22625 | + { | |
22626 | + priv->ieee80211->bHwRadioOff = false; | |
22627 | + bActuallySet = true; | |
22628 | + } | |
22629 | + else if((priv->ieee80211->bHwRadioOff == false) && (eRfPowerStateToSet == eRfOff)) | |
22630 | + { | |
22631 | + priv->ieee80211->bHwRadioOff = true; | |
22632 | + bActuallySet = true; | |
22633 | + } | |
22634 | + | |
22635 | + if(bActuallySet) | |
22636 | + { | |
22637 | + MgntActSet_RF_State(dev, eRfPowerStateToSet, RF_CHANGE_BY_HW); | |
22638 | + | |
22639 | + /* To update the UI status for Power status changed */ | |
22640 | + if(priv->ieee80211->bHwRadioOff == true) | |
22641 | + argv[1] = "RFOFF"; | |
22642 | + else{ | |
22643 | + //if(!priv->RfOffReason) | |
22644 | + argv[1] = "RFON"; | |
22645 | + //else | |
22646 | + // argv[1] = "RFOFF"; | |
22647 | + } | |
22648 | + argv[0] = RadioPowerPath; | |
22649 | + argv[2] = NULL; | |
22650 | + | |
22651 | + call_usermodehelper(RadioPowerPath,argv,envp,1); | |
22652 | + } | |
22653 | + | |
22654 | + } | |
22655 | + | |
22656 | +} | |
22657 | + | |
22658 | +static u8 read_acadapter_file(char *filename) | |
22659 | +{ | |
22660 | +//#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,21)) | |
22661 | +#if 0 | |
22662 | + int fd; | |
22663 | + char buf[1]; | |
22664 | + char ret[50]; | |
22665 | + int i = 0; | |
22666 | + int n = 0; | |
22667 | + mm_segment_t old_fs = get_fs(); | |
22668 | + set_fs(KERNEL_DS); | |
22669 | + | |
22670 | + fd = sys_open(filename, O_RDONLY, 0); | |
22671 | + if (fd >= 0) { | |
22672 | + while (sys_read(fd, buf, 1) == 1) | |
22673 | + { | |
22674 | + i++; | |
22675 | + if(i>10) | |
22676 | + { | |
22677 | + if(buf[0]!=' ') | |
22678 | + { | |
22679 | + ret[n]=buf[0]; | |
22680 | + n++; | |
22681 | + } | |
22682 | + } | |
22683 | + } | |
22684 | + sys_close(fd); | |
22685 | + } | |
22686 | + ret[n]='\0'; | |
22687 | +// printk("%s \n", ret); | |
22688 | + set_fs(old_fs); | |
22689 | + | |
22690 | + if(strncmp(ret, "off-line",8) == 0) | |
22691 | + { | |
22692 | + return 1; | |
22693 | + } | |
22694 | +#endif | |
22695 | + return 0; | |
22696 | +} | |
22697 | + | |
22698 | +/*************************************************************************** | |
22699 | + ------------------- module init / exit stubs ---------------- | |
22700 | +****************************************************************************/ | |
22701 | +module_init(rtl8180_pci_module_init); | |
22702 | +module_exit(rtl8180_pci_module_exit); | |
22703 | + | |
22704 | --- /dev/null | |
22705 | +++ b/drivers/staging/rtl8187se/r8180_dm.c | |
22706 | @@ -0,0 +1,1725 @@ | |
22707 | +//#include "r8180.h"\r | |
22708 | +#include "r8180_dm.h"\r | |
22709 | +#include "r8180_hw.h"\r | |
22710 | +#include "r8180_93cx6.h"\r | |
22711 | +//{by amy 080312\r | |
22712 | +\r | |
22713 | +//\r | |
22714 | +// Description:\r | |
22715 | +// Return TRUE if we shall perform High Power Mecahnism, FALSE otherwise. \r | |
22716 | +//\r | |
22717 | +//+by amy 080312\r | |
22718 | +#define RATE_ADAPTIVE_TIMER_PERIOD 300\r | |
22719 | +\r | |
22720 | +bool CheckHighPower(struct net_device *dev)\r | |
22721 | +{\r | |
22722 | + struct r8180_priv *priv = ieee80211_priv(dev);\r | |
22723 | + struct ieee80211_device *ieee = priv->ieee80211;\r | |
22724 | +\r | |
22725 | + if(!priv->bRegHighPowerMechanism)\r | |
22726 | + {\r | |
22727 | + return false;\r | |
22728 | + }\r | |
22729 | + \r | |
22730 | + if(ieee->state == IEEE80211_LINKED_SCANNING)\r | |
22731 | + {\r | |
22732 | + return false;\r | |
22733 | + }\r | |
22734 | +\r | |
22735 | + return true;\r | |
22736 | +}\r | |
22737 | +\r | |
22738 | +//\r | |
22739 | +// Description:\r | |
22740 | +// Update Tx power level if necessary.\r | |
22741 | +// See also DoRxHighPower() and SetTxPowerLevel8185() for reference.\r | |
22742 | +//\r | |
22743 | +// Note:\r | |
22744 | +// The reason why we udpate Tx power level here instead of DoRxHighPower() \r | |
22745 | +// is the number of IO to change Tx power is much more than chane TR switch \r | |
22746 | +// and they are related to OFDM and MAC registers. \r | |
22747 | +// So, we don't want to update it so frequently in per-Rx packet base. \r | |
22748 | +//\r | |
22749 | +void\r | |
22750 | +DoTxHighPower(\r | |
22751 | + struct net_device *dev\r | |
22752 | + )\r | |
22753 | +{\r | |
22754 | + struct r8180_priv *priv = ieee80211_priv(dev);\r | |
22755 | + u16 HiPwrUpperTh = 0;\r | |
22756 | + u16 HiPwrLowerTh = 0;\r | |
22757 | + u8 RSSIHiPwrUpperTh;\r | |
22758 | + u8 RSSIHiPwrLowerTh;\r | |
22759 | + u8 u1bTmp;\r | |
22760 | + char OfdmTxPwrIdx, CckTxPwrIdx;\r | |
22761 | +\r | |
22762 | + //printk("----> DoTxHighPower()\n");\r | |
22763 | +\r | |
22764 | + HiPwrUpperTh = priv->RegHiPwrUpperTh;\r | |
22765 | + HiPwrLowerTh = priv->RegHiPwrLowerTh; \r | |
22766 | + \r | |
22767 | + HiPwrUpperTh = HiPwrUpperTh * 10;\r | |
22768 | + HiPwrLowerTh = HiPwrLowerTh * 10;\r | |
22769 | + RSSIHiPwrUpperTh = priv->RegRSSIHiPwrUpperTh;\r | |
22770 | + RSSIHiPwrLowerTh = priv->RegRSSIHiPwrLowerTh;\r | |
22771 | +\r | |
22772 | + //lzm add 080826\r | |
22773 | + OfdmTxPwrIdx = priv->chtxpwr_ofdm[priv->ieee80211->current_network.channel]; \r | |
22774 | + CckTxPwrIdx = priv->chtxpwr[priv->ieee80211->current_network.channel]; \r | |
22775 | +\r | |
22776 | + // printk("DoTxHighPower() - UndecoratedSmoothedSS:%d, CurCCKRSSI = %d , bCurCCKPkt= %d \n", priv->UndecoratedSmoothedSS, priv->CurCCKRSSI, priv->bCurCCKPkt );\r | |
22777 | + \r | |
22778 | + if((priv->UndecoratedSmoothedSS > HiPwrUpperTh) ||\r | |
22779 | + (priv->bCurCCKPkt && (priv->CurCCKRSSI > RSSIHiPwrUpperTh)))\r | |
22780 | + {\r | |
22781 | + // Stevenl suggested that degrade 8dbm in high power sate. 2007-12-04 Isaiah \r | |
22782 | + \r | |
22783 | + // printk("=====>DoTxHighPower() - High Power - UndecoratedSmoothedSS:%d, HiPwrUpperTh = %d \n", priv->UndecoratedSmoothedSS, HiPwrUpperTh );\r | |
22784 | + priv->bToUpdateTxPwr = true;\r | |
22785 | + u1bTmp= read_nic_byte(dev, CCK_TXAGC);\r | |
22786 | +\r | |
22787 | + // If it never enter High Power.\r | |
22788 | + if( CckTxPwrIdx == u1bTmp)\r | |
22789 | + {\r | |
22790 | + u1bTmp = (u1bTmp > 16) ? (u1bTmp -16): 0; // 8dbm\r | |
22791 | + write_nic_byte(dev, CCK_TXAGC, u1bTmp);\r | |
22792 | +\r | |
22793 | + u1bTmp= read_nic_byte(dev, OFDM_TXAGC);\r | |
22794 | + u1bTmp = (u1bTmp > 16) ? (u1bTmp -16): 0; // 8dbm\r | |
22795 | + write_nic_byte(dev, OFDM_TXAGC, u1bTmp);\r | |
22796 | + }\r | |
22797 | + \r | |
22798 | + }\r | |
22799 | + else if((priv->UndecoratedSmoothedSS < HiPwrLowerTh) &&\r | |
22800 | + (!priv->bCurCCKPkt || priv->CurCCKRSSI < RSSIHiPwrLowerTh))\r | |
22801 | + {\r | |
22802 | + // printk("DoTxHighPower() - lower Power - UndecoratedSmoothedSS:%d, HiPwrUpperTh = %d \n", priv->UndecoratedSmoothedSS, HiPwrLowerTh );\r | |
22803 | + if(priv->bToUpdateTxPwr)\r | |
22804 | + {\r | |
22805 | + priv->bToUpdateTxPwr = false;\r | |
22806 | + //SD3 required.\r | |
22807 | + u1bTmp= read_nic_byte(dev, CCK_TXAGC); \r | |
22808 | + if(u1bTmp < CckTxPwrIdx)\r | |
22809 | + {\r | |
22810 | + //u1bTmp = ((u1bTmp+16) > 35) ? 35: (u1bTmp+16); // 8dbm\r | |
22811 | + //write_nic_byte(dev, CCK_TXAGC, u1bTmp);\r | |
22812 | + write_nic_byte(dev, CCK_TXAGC, CckTxPwrIdx);\r | |
22813 | + }\r | |
22814 | +\r | |
22815 | + u1bTmp= read_nic_byte(dev, OFDM_TXAGC);\r | |
22816 | + if(u1bTmp < OfdmTxPwrIdx)\r | |
22817 | + {\r | |
22818 | + //u1bTmp = ((u1bTmp+16) > 35) ? 35: (u1bTmp+16); // 8dbm\r | |
22819 | + //write_nic_byte(dev, OFDM_TXAGC, u1bTmp);\r | |
22820 | + write_nic_byte(dev, OFDM_TXAGC, OfdmTxPwrIdx);\r | |
22821 | + }\r | |
22822 | + }\r | |
22823 | + }\r | |
22824 | +\r | |
22825 | + //printk("<---- DoTxHighPower()\n");\r | |
22826 | +}\r | |
22827 | +\r | |
22828 | +\r | |
22829 | +//\r | |
22830 | +// Description:\r | |
22831 | +// Callback function of UpdateTxPowerWorkItem.\r | |
22832 | +// Because of some event happend, e.g. CCX TPC, High Power Mechanism, \r | |
22833 | +// We update Tx power of current channel again. \r | |
22834 | +//\r | |
22835 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20))\r | |
22836 | +void rtl8180_tx_pw_wq (struct work_struct *work)\r | |
22837 | +{\r | |
22838 | +// struct r8180_priv *priv = container_of(work, struct r8180_priv, watch_dog_wq);\r | |
22839 | +// struct ieee80211_device * ieee = (struct ieee80211_device*)\r | |
22840 | +// container_of(work, struct ieee80211_device, watch_dog_wq);\r | |
22841 | + struct delayed_work *dwork = container_of(work,struct delayed_work,work);\r | |
22842 | + struct ieee80211_device *ieee = container_of(dwork,struct ieee80211_device,tx_pw_wq);\r | |
22843 | + struct net_device *dev = ieee->dev;\r | |
22844 | +#else\r | |
22845 | +void rtl8180_tx_pw_wq(struct net_device *dev)\r | |
22846 | +{\r | |
22847 | + // struct r8180_priv *priv = ieee80211_priv(dev);\r | |
22848 | +#endif\r | |
22849 | +\r | |
22850 | +// printk("----> UpdateTxPowerWorkItemCallback()\n");\r | |
22851 | + \r | |
22852 | + DoTxHighPower(dev); \r | |
22853 | + \r | |
22854 | +// printk("<---- UpdateTxPowerWorkItemCallback()\n");\r | |
22855 | +}\r | |
22856 | +\r | |
22857 | +\r | |
22858 | +//\r | |
22859 | +// Description:\r | |
22860 | +// Return TRUE if we shall perform DIG Mecahnism, FALSE otherwise. \r | |
22861 | +//\r | |
22862 | +bool\r | |
22863 | +CheckDig(\r | |
22864 | + struct net_device *dev\r | |
22865 | + )\r | |
22866 | +{\r | |
22867 | + struct r8180_priv *priv = ieee80211_priv(dev);\r | |
22868 | + struct ieee80211_device *ieee = priv->ieee80211;\r | |
22869 | +\r | |
22870 | + if(!priv->bDigMechanism)\r | |
22871 | + return false;\r | |
22872 | +\r | |
22873 | + if(ieee->state != IEEE80211_LINKED)\r | |
22874 | + return false;\r | |
22875 | +\r | |
22876 | + //if(priv->CurrentOperaRate < 36) // Schedule Dig under all OFDM rates. By Bruce, 2007-06-01.\r | |
22877 | + if((priv->ieee80211->rate/5) < 36) // Schedule Dig under all OFDM rates. By Bruce, 2007-06-01.\r | |
22878 | + return false;\r | |
22879 | + return true;\r | |
22880 | +}\r | |
22881 | +//\r | |
22882 | +// Description:\r | |
22883 | +// Implementation of DIG for Zebra and Zebra2. \r | |
22884 | +//\r | |
22885 | +void\r | |
22886 | +DIG_Zebra(\r | |
22887 | + struct net_device *dev\r | |
22888 | + )\r | |
22889 | +{\r | |
22890 | + struct r8180_priv *priv = ieee80211_priv(dev);\r | |
22891 | + u16 CCKFalseAlarm, OFDMFalseAlarm;\r | |
22892 | + u16 OfdmFA1, OfdmFA2;\r | |
22893 | + int InitialGainStep = 7; // The number of initial gain stages.\r | |
22894 | + int LowestGainStage = 4; // The capable lowest stage of performing dig workitem.\r | |
22895 | + u32 AwakePeriodIn2Sec=0;\r | |
22896 | +\r | |
22897 | + //printk("---------> DIG_Zebra()\n");\r | |
22898 | +\r | |
22899 | + CCKFalseAlarm = (u16)(priv->FalseAlarmRegValue & 0x0000ffff);\r | |
22900 | + OFDMFalseAlarm = (u16)((priv->FalseAlarmRegValue >> 16) & 0x0000ffff);\r | |
22901 | + OfdmFA1 = 0x15;\r | |
22902 | + OfdmFA2 = ((u16)(priv->RegDigOfdmFaUpTh)) << 8;\r | |
22903 | +\r | |
22904 | +// printk("DIG**********CCK False Alarm: %#X \n",CCKFalseAlarm);\r | |
22905 | +// printk("DIG**********OFDM False Alarm: %#X \n",OFDMFalseAlarm);\r | |
22906 | +\r | |
22907 | + // The number of initial gain steps is different, by Bruce, 2007-04-13.\r | |
22908 | + if (priv->InitialGain == 0 ) //autoDIG\r | |
22909 | + { // Advised from SD3 DZ\r | |
22910 | + priv->InitialGain = 4; // In 87B, m74dBm means State 4 (m82dBm)\r | |
22911 | + }\r | |
22912 | + //if(pHalData->VersionID != VERSION_8187B_B)\r | |
22913 | + { // Advised from SD3 DZ\r | |
22914 | + OfdmFA1 = 0x20;\r | |
22915 | + }\r | |
22916 | + \r | |
22917 | +#if 1 //lzm reserved 080826\r | |
22918 | + AwakePeriodIn2Sec = (2000-priv ->DozePeriodInPast2Sec);\r | |
22919 | + //printk("&&& DozePeriod=%d AwakePeriod=%d\n", priv->DozePeriodInPast2Sec, AwakePeriodIn2Sec);\r | |
22920 | + priv ->DozePeriodInPast2Sec=0;\r | |
22921 | + \r | |
22922 | + if(AwakePeriodIn2Sec)\r | |
22923 | + { \r | |
22924 | + //RT_TRACE(COMP_DIG, DBG_TRACE, ("DIG: AwakePeriodIn2Sec(%d) - FATh(0x%X , 0x%X) ->",AwakePeriodIn2Sec, OfdmFA1, OfdmFA2));\r | |
22925 | + // adjuest DIG threshold.\r | |
22926 | + OfdmFA1 = (u16)((OfdmFA1*AwakePeriodIn2Sec) / 2000) ; \r | |
22927 | + OfdmFA2 = (u16)((OfdmFA2*AwakePeriodIn2Sec) / 2000) ;\r | |
22928 | + //RT_TRACE(COMP_DIG, DBG_TRACE, ("( 0x%X , 0x%X)\n", OfdmFA1, OfdmFA2));\r | |
22929 | + }\r | |
22930 | + else\r | |
22931 | + {\r | |
22932 | + ;//RT_TRACE(COMP_DIG, DBG_WARNING, ("ERROR!! AwakePeriodIn2Sec should not be ZERO!!\n"));\r | |
22933 | + }\r | |
22934 | +#endif\r | |
22935 | +\r | |
22936 | + InitialGainStep = 8;\r | |
22937 | + LowestGainStage = priv->RegBModeGainStage; // Lowest gain stage.\r | |
22938 | +\r | |
22939 | + if (OFDMFalseAlarm > OfdmFA1)\r | |
22940 | + {\r | |
22941 | + if (OFDMFalseAlarm > OfdmFA2)\r | |
22942 | + {\r | |
22943 | + priv->DIG_NumberFallbackVote++;\r | |
22944 | + if (priv->DIG_NumberFallbackVote >1)\r | |
22945 | + {\r | |
22946 | + //serious OFDM False Alarm, need fallback\r | |
22947 | + if (priv->InitialGain < InitialGainStep)\r | |
22948 | + {\r | |
22949 | + priv->InitialGainBackUp= priv->InitialGain;\r | |
22950 | +\r | |
22951 | + priv->InitialGain = (priv->InitialGain + 1);\r | |
22952 | +// printk("DIG**********OFDM False Alarm: %#X, OfdmFA1: %#X, OfdmFA2: %#X\n", OFDMFalseAlarm, OfdmFA1, OfdmFA2);\r | |
22953 | +// printk("DIG+++++++ fallback OFDM:%d \n", priv->InitialGain);\r | |
22954 | + UpdateInitialGain(dev); \r | |
22955 | + }\r | |
22956 | + priv->DIG_NumberFallbackVote = 0;\r | |
22957 | + priv->DIG_NumberUpgradeVote=0;\r | |
22958 | + }\r | |
22959 | + }\r | |
22960 | + else\r | |
22961 | + {\r | |
22962 | + if (priv->DIG_NumberFallbackVote)\r | |
22963 | + priv->DIG_NumberFallbackVote--;\r | |
22964 | + }\r | |
22965 | + priv->DIG_NumberUpgradeVote=0; \r | |
22966 | + }\r | |
22967 | + else \r | |
22968 | + {\r | |
22969 | + if (priv->DIG_NumberFallbackVote)\r | |
22970 | + priv->DIG_NumberFallbackVote--;\r | |
22971 | + priv->DIG_NumberUpgradeVote++;\r | |
22972 | +\r | |
22973 | + if (priv->DIG_NumberUpgradeVote>9)\r | |
22974 | + {\r | |
22975 | + if (priv->InitialGain > LowestGainStage) // In 87B, m78dBm means State 4 (m864dBm)\r | |
22976 | + {\r | |
22977 | + priv->InitialGainBackUp= priv->InitialGain;\r | |
22978 | +\r | |
22979 | + priv->InitialGain = (priv->InitialGain - 1);\r | |
22980 | +// printk("DIG**********OFDM False Alarm: %#X, OfdmFA1: %#X, OfdmFA2: %#X\n", OFDMFalseAlarm, OfdmFA1, OfdmFA2);\r | |
22981 | +// printk("DIG--------- Upgrade OFDM:%d \n", priv->InitialGain);\r | |
22982 | + UpdateInitialGain(dev); \r | |
22983 | + }\r | |
22984 | + priv->DIG_NumberFallbackVote = 0;\r | |
22985 | + priv->DIG_NumberUpgradeVote=0;\r | |
22986 | + }\r | |
22987 | + }\r | |
22988 | +\r | |
22989 | +// printk("DIG+++++++ OFDM:%d\n", priv->InitialGain); \r | |
22990 | + //printk("<--------- DIG_Zebra()\n");\r | |
22991 | +}\r | |
22992 | +\r | |
22993 | +//\r | |
22994 | +// Description:\r | |
22995 | +// Dispatch DIG implementation according to RF. \r | |
22996 | +//\r | |
22997 | +void\r | |
22998 | +DynamicInitGain(\r | |
22999 | + struct net_device *dev\r | |
23000 | + )\r | |
23001 | +{\r | |
23002 | + struct r8180_priv *priv = ieee80211_priv(dev);\r | |
23003 | +\r | |
23004 | + switch(priv->rf_chip)\r | |
23005 | + {\r | |
23006 | + case RF_ZEBRA2: // [AnnieWorkaround] For Zebra2, 2005-08-01.\r | |
23007 | + case RF_ZEBRA4:\r | |
23008 | + DIG_Zebra( dev );\r | |
23009 | + break;\r | |
23010 | + \r | |
23011 | + default:\r | |
23012 | + printk("DynamicInitGain(): unknown RFChipID(%d) !!!\n", priv->rf_chip);\r | |
23013 | + break;\r | |
23014 | + }\r | |
23015 | +}\r | |
23016 | +\r | |
23017 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20))\r | |
23018 | +void rtl8180_hw_dig_wq (struct work_struct *work)\r | |
23019 | +{\r | |
23020 | +// struct r8180_priv *priv = container_of(work, struct r8180_priv, watch_dog_wq);\r | |
23021 | +// struct ieee80211_device * ieee = (struct ieee80211_device*)\r | |
23022 | +// container_of(work, struct ieee80211_device, watch_dog_wq);\r | |
23023 | + struct delayed_work *dwork = container_of(work,struct delayed_work,work);\r | |
23024 | + struct ieee80211_device *ieee = container_of(dwork,struct ieee80211_device,hw_dig_wq);\r | |
23025 | + struct net_device *dev = ieee->dev;\r | |
23026 | +#else\r | |
23027 | +void rtl8180_hw_dig_wq(struct net_device *dev)\r | |
23028 | +{\r | |
23029 | + \r | |
23030 | +#endif\r | |
23031 | + struct r8180_priv *priv = ieee80211_priv(dev);\r | |
23032 | +\r | |
23033 | + // Read CCK and OFDM False Alarm.\r | |
23034 | + priv->FalseAlarmRegValue = read_nic_dword(dev, CCK_FALSE_ALARM);\r | |
23035 | + \r | |
23036 | +\r | |
23037 | + // Adjust Initial Gain dynamically.\r | |
23038 | + DynamicInitGain(dev);\r | |
23039 | + \r | |
23040 | +}\r | |
23041 | +\r | |
23042 | +int\r | |
23043 | +IncludedInSupportedRates(\r | |
23044 | + struct r8180_priv *priv,\r | |
23045 | + u8 TxRate )\r | |
23046 | +{\r | |
23047 | + u8 rate_len;\r | |
23048 | + u8 rate_ex_len;\r | |
23049 | + u8 RateMask = 0x7F;\r | |
23050 | + u8 idx;\r | |
23051 | + unsigned short Found = 0;\r | |
23052 | + u8 NaiveTxRate = TxRate&RateMask;\r | |
23053 | +\r | |
23054 | + rate_len = priv->ieee80211->current_network.rates_len;\r | |
23055 | + rate_ex_len = priv->ieee80211->current_network.rates_ex_len;\r | |
23056 | + for( idx=0; idx< rate_len; idx++ )\r | |
23057 | + {\r | |
23058 | + if( (priv->ieee80211->current_network.rates[idx] & RateMask) == NaiveTxRate )\r | |
23059 | + {\r | |
23060 | + Found = 1;\r | |
23061 | + goto found_rate;\r | |
23062 | + }\r | |
23063 | + }\r | |
23064 | + for( idx=0; idx< rate_ex_len; idx++ )\r | |
23065 | + {\r | |
23066 | + if( (priv->ieee80211->current_network.rates_ex[idx] & RateMask) == NaiveTxRate )\r | |
23067 | + {\r | |
23068 | + Found = 1;\r | |
23069 | + goto found_rate;\r | |
23070 | + }\r | |
23071 | + }\r | |
23072 | + return Found;\r | |
23073 | + found_rate:\r | |
23074 | + return Found;\r | |
23075 | +}\r | |
23076 | +\r | |
23077 | +//\r | |
23078 | +// Description:\r | |
23079 | +// Get the Tx rate one degree up form the input rate in the supported rates.\r | |
23080 | +// Return the upgrade rate if it is successed, otherwise return the input rate.\r | |
23081 | +// By Bruce, 2007-06-05.\r | |
23082 | +// \r | |
23083 | +u8\r | |
23084 | +GetUpgradeTxRate(\r | |
23085 | + struct net_device *dev,\r | |
23086 | + u8 rate\r | |
23087 | + )\r | |
23088 | +{\r | |
23089 | + struct r8180_priv *priv = ieee80211_priv(dev);\r | |
23090 | + u8 UpRate;\r | |
23091 | +\r | |
23092 | + // Upgrade 1 degree.\r | |
23093 | + switch(rate)\r | |
23094 | + {\r | |
23095 | + case 108: // Up to 54Mbps.\r | |
23096 | + UpRate = 108;\r | |
23097 | + break;\r | |
23098 | +\r | |
23099 | + case 96: // Up to 54Mbps.\r | |
23100 | + UpRate = 108;\r | |
23101 | + break;\r | |
23102 | +\r | |
23103 | + case 72: // Up to 48Mbps.\r | |
23104 | + UpRate = 96;\r | |
23105 | + break;\r | |
23106 | +\r | |
23107 | + case 48: // Up to 36Mbps.\r | |
23108 | + UpRate = 72;\r | |
23109 | + break;\r | |
23110 | +\r | |
23111 | + case 36: // Up to 24Mbps.\r | |
23112 | + UpRate = 48;\r | |
23113 | + break;\r | |
23114 | +\r | |
23115 | + case 22: // Up to 18Mbps.\r | |
23116 | + UpRate = 36;\r | |
23117 | + break;\r | |
23118 | +\r | |
23119 | + case 11: // Up to 11Mbps.\r | |
23120 | + UpRate = 22;\r | |
23121 | + break;\r | |
23122 | +\r | |
23123 | + case 4: // Up to 5.5Mbps.\r | |
23124 | + UpRate = 11;\r | |
23125 | + break;\r | |
23126 | +\r | |
23127 | + case 2: // Up to 2Mbps.\r | |
23128 | + UpRate = 4;\r | |
23129 | + break;\r | |
23130 | +\r | |
23131 | + default:\r | |
23132 | + printk("GetUpgradeTxRate(): Input Tx Rate(%d) is undefined!\n", rate);\r | |
23133 | + return rate;\r | |
23134 | + }\r | |
23135 | + // Check if the rate is valid.\r | |
23136 | + if(IncludedInSupportedRates(priv, UpRate))\r | |
23137 | + {\r | |
23138 | +// printk("GetUpgradeTxRate(): GetUpgrade Tx rate(%d) from %d !\n", UpRate, priv->CurrentOperaRate);\r | |
23139 | + return UpRate;\r | |
23140 | + }\r | |
23141 | + else\r | |
23142 | + {\r | |
23143 | + //printk("GetUpgradeTxRate(): Tx rate (%d) is not in supported rates\n", UpRate);\r | |
23144 | + return rate;\r | |
23145 | + }\r | |
23146 | + return rate;\r | |
23147 | +}\r | |
23148 | +//\r | |
23149 | +// Description:\r | |
23150 | +// Get the Tx rate one degree down form the input rate in the supported rates.\r | |
23151 | +// Return the degrade rate if it is successed, otherwise return the input rate.\r | |
23152 | +// By Bruce, 2007-06-05.\r | |
23153 | +// \r | |
23154 | +u8\r | |
23155 | +GetDegradeTxRate(\r | |
23156 | + struct net_device *dev,\r | |
23157 | + u8 rate\r | |
23158 | + )\r | |
23159 | +{\r | |
23160 | + struct r8180_priv *priv = ieee80211_priv(dev);\r | |
23161 | + u8 DownRate;\r | |
23162 | +\r | |
23163 | + // Upgrade 1 degree.\r | |
23164 | + switch(rate)\r | |
23165 | + {\r | |
23166 | + case 108: // Down to 48Mbps.\r | |
23167 | + DownRate = 96;\r | |
23168 | + break;\r | |
23169 | +\r | |
23170 | + case 96: // Down to 36Mbps.\r | |
23171 | + DownRate = 72;\r | |
23172 | + break;\r | |
23173 | +\r | |
23174 | + case 72: // Down to 24Mbps.\r | |
23175 | + DownRate = 48;\r | |
23176 | + break;\r | |
23177 | +\r | |
23178 | + case 48: // Down to 18Mbps.\r | |
23179 | + DownRate = 36;\r | |
23180 | + break;\r | |
23181 | +\r | |
23182 | + case 36: // Down to 11Mbps.\r | |
23183 | + DownRate = 22;\r | |
23184 | + break;\r | |
23185 | +\r | |
23186 | + case 22: // Down to 5.5Mbps.\r | |
23187 | + DownRate = 11;\r | |
23188 | + break;\r | |
23189 | +\r | |
23190 | + case 11: // Down to 2Mbps.\r | |
23191 | + DownRate = 4;\r | |
23192 | + break;\r | |
23193 | +\r | |
23194 | + case 4: // Down to 1Mbps.\r | |
23195 | + DownRate = 2;\r | |
23196 | + break;\r | |
23197 | +\r | |
23198 | + case 2: // Down to 1Mbps.\r | |
23199 | + DownRate = 2;\r | |
23200 | + break;\r | |
23201 | +\r | |
23202 | + default:\r | |
23203 | + printk("GetDegradeTxRate(): Input Tx Rate(%d) is undefined!\n", rate);\r | |
23204 | + return rate;\r | |
23205 | + }\r | |
23206 | + // Check if the rate is valid.\r | |
23207 | + if(IncludedInSupportedRates(priv, DownRate))\r | |
23208 | + {\r | |
23209 | +// printk("GetDegradeTxRate(): GetDegrade Tx rate(%d) from %d!\n", DownRate, priv->CurrentOperaRate);\r | |
23210 | + return DownRate;\r | |
23211 | + }\r | |
23212 | + else\r | |
23213 | + {\r | |
23214 | + //printk("GetDegradeTxRate(): Tx rate (%d) is not in supported rates\n", DownRate);\r | |
23215 | + return rate;\r | |
23216 | + }\r | |
23217 | + return rate;\r | |
23218 | +}\r | |
23219 | +//\r | |
23220 | +// Helper function to determine if specified data rate is \r | |
23221 | +// CCK rate.\r | |
23222 | +// 2005.01.25, by rcnjko.\r | |
23223 | +//\r | |
23224 | +bool\r | |
23225 | +MgntIsCckRate(\r | |
23226 | + u16 rate\r | |
23227 | + )\r | |
23228 | +{\r | |
23229 | + bool bReturn = false;\r | |
23230 | +\r | |
23231 | + if((rate <= 22) && (rate != 12) && (rate != 18))\r | |
23232 | + {\r | |
23233 | + bReturn = true;\r | |
23234 | + }\r | |
23235 | +\r | |
23236 | + return bReturn;\r | |
23237 | +}\r | |
23238 | +#ifdef CONFIG_RTL818X_S\r | |
23239 | +//\r | |
23240 | +// Description:\r | |
23241 | +// Tx Power tracking mechanism routine on 87SE.\r | |
23242 | +// Created by Roger, 2007.12.11.\r | |
23243 | +//\r | |
23244 | +void\r | |
23245 | +TxPwrTracking87SE(\r | |
23246 | + struct net_device *dev\r | |
23247 | +)\r | |
23248 | +{ \r | |
23249 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev);\r | |
23250 | + u8 tmpu1Byte, CurrentThermal, Idx; \r | |
23251 | + char CckTxPwrIdx, OfdmTxPwrIdx; \r | |
23252 | + //u32 u4bRfReg;\r | |
23253 | + \r | |
23254 | + tmpu1Byte = read_nic_byte(dev, EN_LPF_CAL);\r | |
23255 | + CurrentThermal = (tmpu1Byte & 0xf0)>>4; //[ 7:4]: thermal meter indication.\r | |
23256 | + CurrentThermal = (CurrentThermal>0x0c)? 0x0c:CurrentThermal;//lzm add 080826\r | |
23257 | +\r | |
23258 | + //printk("TxPwrTracking87SE(): CurrentThermal(%d)\n", CurrentThermal);\r | |
23259 | + \r | |
23260 | + if( CurrentThermal != priv->ThermalMeter)\r | |
23261 | + { \r | |
23262 | +// printk("TxPwrTracking87SE(): Thermal meter changed!!!\n");\r | |
23263 | +\r | |
23264 | + // Update Tx Power level on each channel.\r | |
23265 | + for(Idx = 1; Idx<15; Idx++)\r | |
23266 | + { \r | |
23267 | + CckTxPwrIdx = priv->chtxpwr[Idx];\r | |
23268 | + OfdmTxPwrIdx = priv->chtxpwr_ofdm[Idx]; \r | |
23269 | + \r | |
23270 | + if( CurrentThermal > priv->ThermalMeter )\r | |
23271 | + { // higher thermal meter. \r | |
23272 | + CckTxPwrIdx += (CurrentThermal - priv->ThermalMeter)*2;\r | |
23273 | + OfdmTxPwrIdx += (CurrentThermal - priv->ThermalMeter)*2;\r | |
23274 | + \r | |
23275 | + if(CckTxPwrIdx >35)\r | |
23276 | + CckTxPwrIdx = 35; // Force TxPower to maximal index.\r | |
23277 | + if(OfdmTxPwrIdx >35)\r | |
23278 | + OfdmTxPwrIdx = 35; \r | |
23279 | + }\r | |
23280 | + else\r | |
23281 | + { // lower thermal meter. \r | |
23282 | + CckTxPwrIdx -= (priv->ThermalMeter - CurrentThermal)*2;\r | |
23283 | + OfdmTxPwrIdx -= (priv->ThermalMeter - CurrentThermal)*2;\r | |
23284 | +\r | |
23285 | + if(CckTxPwrIdx <0)\r | |
23286 | + CckTxPwrIdx = 0; \r | |
23287 | + if(OfdmTxPwrIdx <0)\r | |
23288 | + OfdmTxPwrIdx = 0; \r | |
23289 | + } \r | |
23290 | + \r | |
23291 | + // Update TxPower level on CCK and OFDM resp.\r | |
23292 | + priv->chtxpwr[Idx] = CckTxPwrIdx;\r | |
23293 | + priv->chtxpwr_ofdm[Idx] = OfdmTxPwrIdx; \r | |
23294 | + } \r | |
23295 | +\r | |
23296 | + // Update TxPower level immediately.\r | |
23297 | + rtl8225z2_SetTXPowerLevel(dev, priv->ieee80211->current_network.channel);\r | |
23298 | + } \r | |
23299 | + priv->ThermalMeter = CurrentThermal; \r | |
23300 | +}\r | |
23301 | +void\r | |
23302 | +StaRateAdaptive87SE(\r | |
23303 | + struct net_device *dev\r | |
23304 | + )\r | |
23305 | +{\r | |
23306 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev);\r | |
23307 | + unsigned long CurrTxokCnt;\r | |
23308 | + u16 CurrRetryCnt;\r | |
23309 | + u16 CurrRetryRate;\r | |
23310 | + //u16 i,idx;\r | |
23311 | + unsigned long CurrRxokCnt;\r | |
23312 | + bool bTryUp = false;\r | |
23313 | + bool bTryDown = false;\r | |
23314 | + u8 TryUpTh = 1;\r | |
23315 | + u8 TryDownTh = 2;\r | |
23316 | + u32 TxThroughput;\r | |
23317 | + long CurrSignalStrength;\r | |
23318 | + bool bUpdateInitialGain = false;\r | |
23319 | + u8 u1bOfdm=0, u1bCck = 0;\r | |
23320 | + char OfdmTxPwrIdx, CckTxPwrIdx; \r | |
23321 | +\r | |
23322 | + priv->RateAdaptivePeriod= RATE_ADAPTIVE_TIMER_PERIOD;\r | |
23323 | +\r | |
23324 | +\r | |
23325 | + CurrRetryCnt = priv->CurrRetryCnt;\r | |
23326 | + CurrTxokCnt = priv->NumTxOkTotal - priv->LastTxokCnt;\r | |
23327 | + CurrRxokCnt = priv->ieee80211->NumRxOkTotal - priv->LastRxokCnt;\r | |
23328 | + CurrSignalStrength = priv->Stats_RecvSignalPower;\r | |
23329 | + TxThroughput = (u32)(priv->NumTxOkBytesTotal - priv->LastTxOKBytes);\r | |
23330 | + priv->LastTxOKBytes = priv->NumTxOkBytesTotal;\r | |
23331 | + priv->CurrentOperaRate = priv->ieee80211->rate/5;\r | |
23332 | + //printk("priv->CurrentOperaRate is %d\n",priv->CurrentOperaRate);\r | |
23333 | + //2 Compute retry ratio.\r | |
23334 | + if (CurrTxokCnt>0)\r | |
23335 | + {\r | |
23336 | + CurrRetryRate = (u16)(CurrRetryCnt*100/CurrTxokCnt);\r | |
23337 | + }\r | |
23338 | + else\r | |
23339 | + { // It may be serious retry. To distinguish serious retry or no packets modified by Bruce\r | |
23340 | + CurrRetryRate = (u16)(CurrRetryCnt*100/1);\r | |
23341 | + }\r | |
23342 | +\r | |
23343 | +\r | |
23344 | + //\r | |
23345 | + // Added by Roger, 2007.01.02.\r | |
23346 | + // For debug information.\r | |
23347 | + //\r | |
23348 | + //printk("\n(1) pHalData->LastRetryRate: %d \n",priv->LastRetryRate);\r | |
23349 | + //printk("(2) RetryCnt = %d \n", CurrRetryCnt); \r | |
23350 | + //printk("(3) TxokCnt = %d \n", CurrTxokCnt);\r | |
23351 | + //printk("(4) CurrRetryRate = %d \n", CurrRetryRate); \r | |
23352 | + //printk("(5) CurrSignalStrength = %d \n",CurrSignalStrength);\r | |
23353 | + //printk("(6) TxThroughput is %d\n",TxThroughput);\r | |
23354 | + //printk("priv->NumTxOkBytesTotal is %d\n",priv->NumTxOkBytesTotal); \r | |
23355 | +\r | |
23356 | + priv->LastRetryCnt = priv->CurrRetryCnt;\r | |
23357 | + priv->LastTxokCnt = priv->NumTxOkTotal;\r | |
23358 | + priv->LastRxokCnt = priv->ieee80211->NumRxOkTotal;\r | |
23359 | + priv->CurrRetryCnt = 0;\r | |
23360 | +\r | |
23361 | + //2No Tx packets, return to init_rate or not?\r | |
23362 | + if (CurrRetryRate==0 && CurrTxokCnt == 0)\r | |
23363 | + { \r | |
23364 | + //\r | |
23365 | + //After 9 (30*300ms) seconds in this condition, we try to raise rate.\r | |
23366 | + //\r | |
23367 | + priv->TryupingCountNoData++;\r | |
23368 | + \r | |
23369 | +// printk("No Tx packets, TryupingCountNoData(%d)\n", priv->TryupingCountNoData);\r | |
23370 | + //[TRC Dell Lab] Extend raised period from 4.5sec to 9sec, Isaiah 2008-02-15 18:00 \r | |
23371 | + if (priv->TryupingCountNoData>30)\r | |
23372 | + {\r | |
23373 | + priv->TryupingCountNoData = 0;\r | |
23374 | + priv->CurrentOperaRate = GetUpgradeTxRate(dev, priv->CurrentOperaRate); \r | |
23375 | + // Reset Fail Record\r | |
23376 | + priv->LastFailTxRate = 0;\r | |
23377 | + priv->LastFailTxRateSS = -200;\r | |
23378 | + priv->FailTxRateCount = 0;\r | |
23379 | + }\r | |
23380 | + goto SetInitialGain;\r | |
23381 | + }\r | |
23382 | + else\r | |
23383 | + {\r | |
23384 | + priv->TryupingCountNoData=0; //Reset trying up times.\r | |
23385 | + }\r | |
23386 | +\r | |
23387 | +\r | |
23388 | + //\r | |
23389 | + // For Netgear case, I comment out the following signal strength estimation,\r | |
23390 | + // which can results in lower rate to transmit when sample is NOT enough (e.g. PING request). \r | |
23391 | + // 2007.04.09, by Roger. \r | |
23392 | + // \r | |
23393 | +\r | |
23394 | + //\r | |
23395 | + // Restructure rate adaptive as the following main stages:\r | |
23396 | + // (1) Add retry threshold in 54M upgrading condition with signal strength.\r | |
23397 | + // (2) Add the mechanism to degrade to CCK rate according to signal strength \r | |
23398 | + // and retry rate.\r | |
23399 | + // (3) Remove all Initial Gain Updates over OFDM rate. To avoid the complicated \r | |
23400 | + // situation, Initial Gain Update is upon on DIG mechanism except CCK rate.\r | |
23401 | + // (4) Add the mehanism of trying to upgrade tx rate.\r | |
23402 | + // (5) Record the information of upping tx rate to avoid trying upping tx rate constantly.\r | |
23403 | + // By Bruce, 2007-06-05.\r | |
23404 | + // \r | |
23405 | + //\r | |
23406 | +\r | |
23407 | + // 11Mbps or 36Mbps\r | |
23408 | + // Check more times in these rate(key rates).\r | |
23409 | + //\r | |
23410 | + if(priv->CurrentOperaRate == 22 || priv->CurrentOperaRate == 72)\r | |
23411 | + { \r | |
23412 | + TryUpTh += 9;\r | |
23413 | + }\r | |
23414 | + //\r | |
23415 | + // Let these rates down more difficult.\r | |
23416 | + //\r | |
23417 | + if(MgntIsCckRate(priv->CurrentOperaRate) || priv->CurrentOperaRate == 36)\r | |
23418 | + {\r | |
23419 | + TryDownTh += 1;\r | |
23420 | + }\r | |
23421 | +\r | |
23422 | + //1 Adjust Rate.\r | |
23423 | + if (priv->bTryuping == true)\r | |
23424 | + { \r | |
23425 | + //2 For Test Upgrading mechanism\r | |
23426 | + // Note:\r | |
23427 | + // Sometimes the throughput is upon on the capability bwtween the AP and NIC,\r | |
23428 | + // thus the low data rate does not improve the performance.\r | |
23429 | + // We randomly upgrade the data rate and check if the retry rate is improved.\r | |
23430 | + \r | |
23431 | + // Upgrading rate did not improve the retry rate, fallback to the original rate.\r | |
23432 | + if ( (CurrRetryRate > 25) && TxThroughput < priv->LastTxThroughput)\r | |
23433 | + {\r | |
23434 | + //Not necessary raising rate, fall back rate.\r | |
23435 | + bTryDown = true;\r | |
23436 | + //printk("case1-1: Not necessary raising rate, fall back rate....\n");\r | |
23437 | + //printk("case1-1: pMgntInfo->CurrentOperaRate =%d, TxThroughput = %d, LastThroughput = %d\n",\r | |
23438 | + // priv->CurrentOperaRate, TxThroughput, priv->LastTxThroughput); \r | |
23439 | + }\r | |
23440 | + else\r | |
23441 | + {\r | |
23442 | + priv->bTryuping = false;\r | |
23443 | + }\r | |
23444 | + } \r | |
23445 | + else if (CurrSignalStrength > -47 && (CurrRetryRate < 50))\r | |
23446 | + {\r | |
23447 | + //2For High Power\r | |
23448 | + //\r | |
23449 | + // Added by Roger, 2007.04.09.\r | |
23450 | + // Return to highest data rate, if signal strength is good enough.\r | |
23451 | + // SignalStrength threshold(-50dbm) is for RTL8186.\r | |
23452 | + // Revise SignalStrength threshold to -51dbm. \r | |
23453 | + //\r | |
23454 | + // Also need to check retry rate for safety, by Bruce, 2007-06-05.\r | |
23455 | + if(priv->CurrentOperaRate != priv->ieee80211->current_network.HighestOperaRate )\r | |
23456 | + {\r | |
23457 | + bTryUp = true;\r | |
23458 | + // Upgrade Tx Rate directly.\r | |
23459 | + priv->TryupingCount += TryUpTh;\r | |
23460 | + }\r | |
23461 | +// printk("case2: StaRateAdaptive87SE: Power(%d) is high enough!!. \n", CurrSignalStrength); \r | |
23462 | + \r | |
23463 | + }\r | |
23464 | + else if(CurrTxokCnt > 9 && CurrTxokCnt< 100 && CurrRetryRate >= 600) \r | |
23465 | + {\r | |
23466 | + //2 For Serious Retry\r | |
23467 | + //\r | |
23468 | + // Traffic is not busy but our Tx retry is serious. \r | |
23469 | + //\r | |
23470 | + bTryDown = true;\r | |
23471 | + // Let Rate Mechanism to degrade tx rate directly.\r | |
23472 | + priv->TryDownCountLowData += TryDownTh;\r | |
23473 | +// printk("case3: RA: Tx Retry is serious. Degrade Tx Rate to %d directly...\n", priv->CurrentOperaRate); \r | |
23474 | + }\r | |
23475 | + else if ( priv->CurrentOperaRate == 108 )\r | |
23476 | + {\r | |
23477 | + //2For 54Mbps\r | |
23478 | + // Air Link\r | |
23479 | + if ( (CurrRetryRate>26)&&(priv->LastRetryRate>25))\r | |
23480 | +// if ( (CurrRetryRate>40)&&(priv->LastRetryRate>39))\r | |
23481 | + {\r | |
23482 | + //Down to rate 48Mbps.\r | |
23483 | + bTryDown = true;\r | |
23484 | + }\r | |
23485 | + // Cable Link\r | |
23486 | + else if ( (CurrRetryRate>17)&&(priv->LastRetryRate>16) && (CurrSignalStrength > -72)) \r | |
23487 | +// else if ( (CurrRetryRate>17)&&(priv->LastRetryRate>16) && (CurrSignalStrength > -72))\r | |
23488 | + {\r | |
23489 | + //Down to rate 48Mbps.\r | |
23490 | + bTryDown = true;\r | |
23491 | + }\r | |
23492 | +\r | |
23493 | + if(bTryDown && (CurrSignalStrength < -75)) //cable link\r | |
23494 | + {\r | |
23495 | + priv->TryDownCountLowData += TryDownTh;\r | |
23496 | + }\r | |
23497 | + //printk("case4---54M \n"); \r | |
23498 | +\r | |
23499 | + }\r | |
23500 | + else if ( priv->CurrentOperaRate == 96 )\r | |
23501 | + {\r | |
23502 | + //2For 48Mbps\r | |
23503 | + //Air Link\r | |
23504 | + if ( ((CurrRetryRate>48) && (priv->LastRetryRate>47)))\r | |
23505 | +// if ( ((CurrRetryRate>65) && (priv->LastRetryRate>64)))\r | |
23506 | +\r | |
23507 | + { \r | |
23508 | + //Down to rate 36Mbps.\r | |
23509 | + bTryDown = true;\r | |
23510 | + }\r | |
23511 | + //Cable Link\r | |
23512 | + else if ( ((CurrRetryRate>21) && (priv->LastRetryRate>20)) && (CurrSignalStrength > -74))\r | |
23513 | + {\r | |
23514 | + //Down to rate 36Mbps.\r | |
23515 | + bTryDown = true;\r | |
23516 | + }\r | |
23517 | + else if((CurrRetryRate> (priv->LastRetryRate + 50 )) && (priv->FailTxRateCount >2 ))\r | |
23518 | +// else if((CurrRetryRate> (priv->LastRetryRate + 70 )) && (priv->FailTxRateCount >2 ))\r | |
23519 | + {\r | |
23520 | + bTryDown = true;\r | |
23521 | + priv->TryDownCountLowData += TryDownTh;\r | |
23522 | + }\r | |
23523 | + else if ( (CurrRetryRate<8) && (priv->LastRetryRate<8) ) //TO DO: need to consider (RSSI)\r | |
23524 | +// else if ( (CurrRetryRate<28) && (priv->LastRetryRate<8) ) \r | |
23525 | + {\r | |
23526 | + bTryUp = true;\r | |
23527 | + }\r | |
23528 | +\r | |
23529 | + if(bTryDown && (CurrSignalStrength < -75))\r | |
23530 | + {\r | |
23531 | + priv->TryDownCountLowData += TryDownTh;\r | |
23532 | + }\r | |
23533 | + //printk("case5---48M \n"); \r | |
23534 | + }\r | |
23535 | + else if ( priv->CurrentOperaRate == 72 )\r | |
23536 | + {\r | |
23537 | + //2For 36Mbps\r | |
23538 | + if ( (CurrRetryRate>43) && (priv->LastRetryRate>41)) \r | |
23539 | +// if ( (CurrRetryRate>60) && (priv->LastRetryRate>59))\r | |
23540 | + { \r | |
23541 | + //Down to rate 24Mbps.\r | |
23542 | + bTryDown = true;\r | |
23543 | + }\r | |
23544 | + else if((CurrRetryRate> (priv->LastRetryRate + 50 )) && (priv->FailTxRateCount >2 ))\r | |
23545 | +// else if((CurrRetryRate> (priv->LastRetryRate + 70 )) && (priv->FailTxRateCount >2 ))\r | |
23546 | + {\r | |
23547 | + bTryDown = true;\r | |
23548 | + priv->TryDownCountLowData += TryDownTh;\r | |
23549 | + }\r | |
23550 | + else if ( (CurrRetryRate<15) && (priv->LastRetryRate<16)) //TO DO: need to consider (RSSI)\r | |
23551 | +// else if ( (CurrRetryRate<35) && (priv->LastRetryRate<36))\r | |
23552 | + {\r | |
23553 | + bTryUp = true;\r | |
23554 | + }\r | |
23555 | +\r | |
23556 | + if(bTryDown && (CurrSignalStrength < -80))\r | |
23557 | + {\r | |
23558 | + priv->TryDownCountLowData += TryDownTh;\r | |
23559 | + }\r | |
23560 | + //printk("case6---36M \n"); \r | |
23561 | + }\r | |
23562 | + else if ( priv->CurrentOperaRate == 48 )\r | |
23563 | + {\r | |
23564 | + //2For 24Mbps\r | |
23565 | + // Air Link\r | |
23566 | + if ( ((CurrRetryRate>63) && (priv->LastRetryRate>62)))\r | |
23567 | +// if ( ((CurrRetryRate>83) && (priv->LastRetryRate>82)))\r | |
23568 | + { \r | |
23569 | + //Down to rate 18Mbps.\r | |
23570 | + bTryDown = true;\r | |
23571 | + }\r | |
23572 | + //Cable Link\r | |
23573 | + else if ( ((CurrRetryRate>33) && (priv->LastRetryRate>32)) && (CurrSignalStrength > -82) )\r | |
23574 | +// else if ( ((CurrRetryRate>50) && (priv->LastRetryRate>49)) && (CurrSignalStrength > -82) )\r | |
23575 | + {\r | |
23576 | + //Down to rate 18Mbps.\r | |
23577 | + bTryDown = true;\r | |
23578 | + }\r | |
23579 | + else if((CurrRetryRate> (priv->LastRetryRate + 50 )) && (priv->FailTxRateCount >2 ))\r | |
23580 | +// else if((CurrRetryRate> (priv->LastRetryRate + 70 )) && (priv->FailTxRateCount >2 ))\r | |
23581 | +\r | |
23582 | + {\r | |
23583 | + bTryDown = true;\r | |
23584 | + priv->TryDownCountLowData += TryDownTh;\r | |
23585 | + }\r | |
23586 | + else if ( (CurrRetryRate<20) && (priv->LastRetryRate<21)) //TO DO: need to consider (RSSI)\r | |
23587 | +// else if ( (CurrRetryRate<40) && (priv->LastRetryRate<41))\r | |
23588 | + { \r | |
23589 | + bTryUp = true; \r | |
23590 | + }\r | |
23591 | +\r | |
23592 | + if(bTryDown && (CurrSignalStrength < -82))\r | |
23593 | + {\r | |
23594 | + priv->TryDownCountLowData += TryDownTh;\r | |
23595 | + }\r | |
23596 | + //printk("case7---24M \n"); \r | |
23597 | + }\r | |
23598 | + else if ( priv->CurrentOperaRate == 36 )\r | |
23599 | + {\r | |
23600 | + //2For 18Mbps\r | |
23601 | + // original (109, 109) \r | |
23602 | + //[TRC Dell Lab] (90, 91), Isaiah 2008-02-18 23:24\r | |
23603 | + // (85, 86), Isaiah 2008-02-18 24:00\r | |
23604 | + if ( ((CurrRetryRate>85) && (priv->LastRetryRate>86)))\r | |
23605 | +// if ( ((CurrRetryRate>115) && (priv->LastRetryRate>116)))\r | |
23606 | + {\r | |
23607 | + //Down to rate 11Mbps.\r | |
23608 | + bTryDown = true;\r | |
23609 | + }\r | |
23610 | + //[TRC Dell Lab] Isaiah 2008-02-18 23:24\r | |
23611 | + else if((CurrRetryRate> (priv->LastRetryRate + 50 )) && (priv->FailTxRateCount >2 ))\r | |
23612 | +// else if((CurrRetryRate> (priv->LastRetryRate + 70 )) && (priv->FailTxRateCount >2 ))\r | |
23613 | + {\r | |
23614 | + bTryDown = true;\r | |
23615 | + priv->TryDownCountLowData += TryDownTh;\r | |
23616 | + }\r | |
23617 | + else if ( (CurrRetryRate<22) && (priv->LastRetryRate<23)) //TO DO: need to consider (RSSI)\r | |
23618 | +// else if ( (CurrRetryRate<42) && (priv->LastRetryRate<43))\r | |
23619 | + { \r | |
23620 | + bTryUp = true; \r | |
23621 | + }\r | |
23622 | + //printk("case8---18M \n"); \r | |
23623 | + }\r | |
23624 | + else if ( priv->CurrentOperaRate == 22 )\r | |
23625 | + {\r | |
23626 | + //2For 11Mbps\r | |
23627 | + if (CurrRetryRate>95)\r | |
23628 | +// if (CurrRetryRate>155)\r | |
23629 | + {\r | |
23630 | + bTryDown = true;\r | |
23631 | + }\r | |
23632 | + else if ( (CurrRetryRate<29) && (priv->LastRetryRate <30) )//TO DO: need to consider (RSSI)\r | |
23633 | +// else if ( (CurrRetryRate<49) && (priv->LastRetryRate <50) )\r | |
23634 | + {\r | |
23635 | + bTryUp = true;\r | |
23636 | + }\r | |
23637 | + //printk("case9---11M \n"); \r | |
23638 | + } \r | |
23639 | + else if ( priv->CurrentOperaRate == 11 )\r | |
23640 | + {\r | |
23641 | + //2For 5.5Mbps\r | |
23642 | + if (CurrRetryRate>149) \r | |
23643 | +// if (CurrRetryRate>189)\r | |
23644 | + { \r | |
23645 | + bTryDown = true; \r | |
23646 | + }\r | |
23647 | + else if ( (CurrRetryRate<60) && (priv->LastRetryRate < 65))\r | |
23648 | +// else if ( (CurrRetryRate<80) && (priv->LastRetryRate < 85))\r | |
23649 | +\r | |
23650 | + {\r | |
23651 | + bTryUp = true;\r | |
23652 | + } \r | |
23653 | + //printk("case10---5.5M \n"); \r | |
23654 | + }\r | |
23655 | + else if ( priv->CurrentOperaRate == 4 )\r | |
23656 | + {\r | |
23657 | + //2For 2 Mbps\r | |
23658 | + if((CurrRetryRate>99) && (priv->LastRetryRate>99))\r | |
23659 | +// if((CurrRetryRate>199) && (priv->LastRetryRate>199))\r | |
23660 | + {\r | |
23661 | + bTryDown = true; \r | |
23662 | + }\r | |
23663 | + else if ( (CurrRetryRate < 65) && (priv->LastRetryRate < 70))\r | |
23664 | +// else if ( (CurrRetryRate < 85) && (priv->LastRetryRate < 90))\r | |
23665 | + {\r | |
23666 | + bTryUp = true;\r | |
23667 | + }\r | |
23668 | + //printk("case11---2M \n"); \r | |
23669 | + }\r | |
23670 | + else if ( priv->CurrentOperaRate == 2 )\r | |
23671 | + {\r | |
23672 | + //2For 1 Mbps\r | |
23673 | + if( (CurrRetryRate<70) && (priv->LastRetryRate<75))\r | |
23674 | +// if( (CurrRetryRate<90) && (priv->LastRetryRate<95))\r | |
23675 | + {\r | |
23676 | + bTryUp = true;\r | |
23677 | + }\r | |
23678 | + //printk("case12---1M \n"); \r | |
23679 | + }\r | |
23680 | +\r | |
23681 | + if(bTryUp && bTryDown)\r | |
23682 | + printk("StaRateAdaptive87B(): Tx Rate tried upping and downing simultaneously!\n");\r | |
23683 | + \r | |
23684 | + //1 Test Upgrading Tx Rate\r | |
23685 | + // Sometimes the cause of the low throughput (high retry rate) is the compatibility between the AP and NIC.\r | |
23686 | + // To test if the upper rate may cause lower retry rate, this mechanism randomly occurs to test upgrading tx rate.\r | |
23687 | + if(!bTryUp && !bTryDown && (priv->TryupingCount == 0) && (priv->TryDownCountLowData == 0)\r | |
23688 | + && priv->CurrentOperaRate != priv->ieee80211->current_network.HighestOperaRate && priv->FailTxRateCount < 2)\r | |
23689 | + {\r | |
23690 | + if(jiffies% (CurrRetryRate + 101) == 0)\r | |
23691 | + {\r | |
23692 | + bTryUp = true; \r | |
23693 | + priv->bTryuping = true;\r | |
23694 | + //printk("StaRateAdaptive87SE(): Randomly try upgrading...\n");\r | |
23695 | + }\r | |
23696 | + }\r | |
23697 | +\r | |
23698 | + //1 Rate Mechanism\r | |
23699 | + if(bTryUp)\r | |
23700 | + {\r | |
23701 | + priv->TryupingCount++;\r | |
23702 | + priv->TryDownCountLowData = 0;\r | |
23703 | + \r | |
23704 | + {\r | |
23705 | +// printk("UP: pHalData->TryupingCount = %d\n", priv->TryupingCount);\r | |
23706 | +// printk("UP: TryUpTh(%d)+ (FailTxRateCount(%d))^2 =%d\n", \r | |
23707 | +// TryUpTh, priv->FailTxRateCount, (TryUpTh + priv->FailTxRateCount * priv->FailTxRateCount) );\r | |
23708 | +// printk("UP: pHalData->bTryuping=%d\n", priv->bTryuping);\r | |
23709 | +\r | |
23710 | + }\r | |
23711 | + \r | |
23712 | + //\r | |
23713 | + // Check more times if we need to upgrade indeed.\r | |
23714 | + // Because the largest value of pHalData->TryupingCount is 0xFFFF and \r | |
23715 | + // the largest value of pHalData->FailTxRateCount is 0x14,\r | |
23716 | + // this condition will be satisfied at most every 2 min.\r | |
23717 | + //\r | |
23718 | +\r | |
23719 | + if((priv->TryupingCount > (TryUpTh + priv->FailTxRateCount * priv->FailTxRateCount)) ||\r | |
23720 | + (CurrSignalStrength > priv->LastFailTxRateSS) || priv->bTryuping)\r | |
23721 | + {\r | |
23722 | + priv->TryupingCount = 0;\r | |
23723 | + // \r | |
23724 | + // When transfering from CCK to OFDM, DIG is an important issue.\r | |
23725 | + //\r | |
23726 | + if(priv->CurrentOperaRate == 22)\r | |
23727 | + bUpdateInitialGain = true;\r | |
23728 | +\r | |
23729 | + // The difference in throughput between 48Mbps and 36Mbps is 8M.\r | |
23730 | + // So, we must be carefully in this rate scale. Isaiah 2008-02-15.\r | |
23731 | + //\r | |
23732 | + if( ((priv->CurrentOperaRate == 72) || (priv->CurrentOperaRate == 48) || (priv->CurrentOperaRate == 36)) &&\r | |
23733 | + (priv->FailTxRateCount > 2) )\r | |
23734 | + priv->RateAdaptivePeriod= (RATE_ADAPTIVE_TIMER_PERIOD/2);\r | |
23735 | + \r | |
23736 | + // (1)To avoid upgrade frequently to the fail tx rate, add the FailTxRateCount into the threshold.\r | |
23737 | + // (2)If the signal strength is increased, it may be able to upgrade.\r | |
23738 | +\r | |
23739 | + priv->CurrentOperaRate = GetUpgradeTxRate(dev, priv->CurrentOperaRate);\r | |
23740 | +// printk("StaRateAdaptive87SE(): Upgrade Tx Rate to %d\n", priv->CurrentOperaRate);\r | |
23741 | +\r | |
23742 | + //[TRC Dell Lab] Bypass 12/9/6, Isaiah 2008-02-18 20:00 \r | |
23743 | + if(priv->CurrentOperaRate ==36)\r | |
23744 | + {\r | |
23745 | + priv->bUpdateARFR=true;\r | |
23746 | + write_nic_word(dev, ARFR, 0x0F8F); //bypass 12/9/6\r | |
23747 | +// printk("UP: ARFR=0xF8F\n");\r | |
23748 | + }\r | |
23749 | + else if(priv->bUpdateARFR)\r | |
23750 | + {\r | |
23751 | + priv->bUpdateARFR=false;\r | |
23752 | + write_nic_word(dev, ARFR, 0x0FFF); //set 1M ~ 54Mbps.\r | |
23753 | +// printk("UP: ARFR=0xFFF\n");\r | |
23754 | + }\r | |
23755 | + \r | |
23756 | + // Update Fail Tx rate and count.\r | |
23757 | + if(priv->LastFailTxRate != priv->CurrentOperaRate)\r | |
23758 | + {\r | |
23759 | + priv->LastFailTxRate = priv->CurrentOperaRate;\r | |
23760 | + priv->FailTxRateCount = 0;\r | |
23761 | + priv->LastFailTxRateSS = -200; // Set lowest power.\r | |
23762 | + }\r | |
23763 | + }\r | |
23764 | + }\r | |
23765 | + else\r | |
23766 | + { \r | |
23767 | + if(priv->TryupingCount > 0)\r | |
23768 | + priv->TryupingCount --;\r | |
23769 | + }\r | |
23770 | + \r | |
23771 | + if(bTryDown)\r | |
23772 | + {\r | |
23773 | + priv->TryDownCountLowData++;\r | |
23774 | + priv->TryupingCount = 0;\r | |
23775 | + {\r | |
23776 | +// printk("DN: pHalData->TryDownCountLowData = %d\n",priv->TryDownCountLowData);\r | |
23777 | +// printk("DN: TryDownTh =%d\n", TryDownTh);\r | |
23778 | +// printk("DN: pHalData->bTryuping=%d\n", priv->bTryuping);\r | |
23779 | + }\r | |
23780 | + \r | |
23781 | + //Check if Tx rate can be degraded or Test trying upgrading should fallback.\r | |
23782 | + if(priv->TryDownCountLowData > TryDownTh || priv->bTryuping)\r | |
23783 | + {\r | |
23784 | + priv->TryDownCountLowData = 0;\r | |
23785 | + priv->bTryuping = false;\r | |
23786 | + // Update fail information.\r | |
23787 | + if(priv->LastFailTxRate == priv->CurrentOperaRate)\r | |
23788 | + {\r | |
23789 | + priv->FailTxRateCount ++;\r | |
23790 | + // Record the Tx fail rate signal strength.\r | |
23791 | + if(CurrSignalStrength > priv->LastFailTxRateSS)\r | |
23792 | + {\r | |
23793 | + priv->LastFailTxRateSS = CurrSignalStrength;\r | |
23794 | + }\r | |
23795 | + }\r | |
23796 | + else\r | |
23797 | + {\r | |
23798 | + priv->LastFailTxRate = priv->CurrentOperaRate;\r | |
23799 | + priv->FailTxRateCount = 1;\r | |
23800 | + priv->LastFailTxRateSS = CurrSignalStrength;\r | |
23801 | + }\r | |
23802 | + priv->CurrentOperaRate = GetDegradeTxRate(dev, priv->CurrentOperaRate);\r | |
23803 | +\r | |
23804 | + // Reduce chariot training time at weak signal strength situation. SD3 ED demand. \r | |
23805 | + //[TRC Dell Lab] Revise Signal Threshold from -75 to -80 , Isaiah 2008-02-18 20:00 \r | |
23806 | + if( (CurrSignalStrength < -80) && (priv->CurrentOperaRate > 72 ))\r | |
23807 | + {\r | |
23808 | + priv->CurrentOperaRate = 72;\r | |
23809 | +// printk("DN: weak signal strength (%d), degrade to 36Mbps\n", CurrSignalStrength);\r | |
23810 | + }\r | |
23811 | +\r | |
23812 | + //[TRC Dell Lab] Bypass 12/9/6, Isaiah 2008-02-18 20:00 \r | |
23813 | + if(priv->CurrentOperaRate ==36)\r | |
23814 | + {\r | |
23815 | + priv->bUpdateARFR=true;\r | |
23816 | + write_nic_word(dev, ARFR, 0x0F8F); //bypass 12/9/6\r | |
23817 | +// printk("DN: ARFR=0xF8F\n");\r | |
23818 | + }\r | |
23819 | + else if(priv->bUpdateARFR)\r | |
23820 | + {\r | |
23821 | + priv->bUpdateARFR=false;\r | |
23822 | + write_nic_word(dev, ARFR, 0x0FFF); //set 1M ~ 54Mbps.\r | |
23823 | +// printk("DN: ARFR=0xFFF\n");\r | |
23824 | + }\r | |
23825 | + \r | |
23826 | + //\r | |
23827 | + // When it is CCK rate, it may need to update initial gain to receive lower power packets.\r | |
23828 | + //\r | |
23829 | + if(MgntIsCckRate(priv->CurrentOperaRate))\r | |
23830 | + {\r | |
23831 | + bUpdateInitialGain = true;\r | |
23832 | + }\r | |
23833 | +// printk("StaRateAdaptive87SE(): Degrade Tx Rate to %d\n", priv->CurrentOperaRate);\r | |
23834 | + }\r | |
23835 | + }\r | |
23836 | + else\r | |
23837 | + {\r | |
23838 | + if(priv->TryDownCountLowData > 0)\r | |
23839 | + priv->TryDownCountLowData --;\r | |
23840 | + }\r | |
23841 | + \r | |
23842 | + // Keep the Tx fail rate count to equal to 0x15 at most.\r | |
23843 | + // Reduce the fail count at least to 10 sec if tx rate is tending stable.\r | |
23844 | + if(priv->FailTxRateCount >= 0x15 || \r | |
23845 | + (!bTryUp && !bTryDown && priv->TryDownCountLowData == 0 && priv->TryupingCount && priv->FailTxRateCount > 0x6))\r | |
23846 | + {\r | |
23847 | + priv->FailTxRateCount --;\r | |
23848 | + } \r | |
23849 | +\r | |
23850 | +\r | |
23851 | + OfdmTxPwrIdx = priv->chtxpwr_ofdm[priv->ieee80211->current_network.channel]; \r | |
23852 | + CckTxPwrIdx = priv->chtxpwr[priv->ieee80211->current_network.channel]; \r | |
23853 | + \r | |
23854 | + //[TRC Dell Lab] Mac0x9e increase 2 level in 36M~18M situation, Isaiah 2008-02-18 24:00 \r | |
23855 | + if((priv->CurrentOperaRate < 96) &&(priv->CurrentOperaRate > 22))\r | |
23856 | + {\r | |
23857 | + u1bCck = read_nic_byte(dev, CCK_TXAGC);\r | |
23858 | + u1bOfdm = read_nic_byte(dev, OFDM_TXAGC);\r | |
23859 | +\r | |
23860 | + // case 1: Never enter High power\r | |
23861 | + if(u1bCck == CckTxPwrIdx )\r | |
23862 | + {\r | |
23863 | + if(u1bOfdm != (OfdmTxPwrIdx+2) )\r | |
23864 | + {\r | |
23865 | + priv->bEnhanceTxPwr= true;\r | |
23866 | + u1bOfdm = ((u1bOfdm+2) > 35) ? 35: (u1bOfdm+2);\r | |
23867 | + write_nic_byte(dev, OFDM_TXAGC, u1bOfdm);\r | |
23868 | +// printk("Enhance OFDM_TXAGC : +++++ u1bOfdm= 0x%x\n", u1bOfdm);\r | |
23869 | + }\r | |
23870 | + }\r | |
23871 | + // case 2: enter high power\r | |
23872 | + else if(u1bCck < CckTxPwrIdx)\r | |
23873 | + {\r | |
23874 | + if(!priv->bEnhanceTxPwr)\r | |
23875 | + {\r | |
23876 | + priv->bEnhanceTxPwr= true;\r | |
23877 | + u1bOfdm = ((u1bOfdm+2) > 35) ? 35: (u1bOfdm+2);\r | |
23878 | + write_nic_byte(dev, OFDM_TXAGC, u1bOfdm);\r | |
23879 | + //RT_TRACE(COMP_RATE, DBG_TRACE, ("Enhance OFDM_TXAGC(2) : +++++ u1bOfdm= 0x%x\n", u1bOfdm));\r | |
23880 | + }\r | |
23881 | + }\r | |
23882 | + }\r | |
23883 | + else if(priv->bEnhanceTxPwr) //54/48/11/5.5/2/1\r | |
23884 | + {\r | |
23885 | + u1bCck = read_nic_byte(dev, CCK_TXAGC);\r | |
23886 | + u1bOfdm = read_nic_byte(dev, OFDM_TXAGC);\r | |
23887 | +\r | |
23888 | + // case 1: Never enter High power\r | |
23889 | + if(u1bCck == CckTxPwrIdx )\r | |
23890 | + {\r | |
23891 | + priv->bEnhanceTxPwr= false;\r | |
23892 | + write_nic_byte(dev, OFDM_TXAGC, OfdmTxPwrIdx);\r | |
23893 | + //printk("Recover OFDM_TXAGC : ===== u1bOfdm= 0x%x\n", OfdmTxPwrIdx);\r | |
23894 | + }\r | |
23895 | + // case 2: enter high power\r | |
23896 | + else if(u1bCck < CckTxPwrIdx)\r | |
23897 | + {\r | |
23898 | + priv->bEnhanceTxPwr= false;\r | |
23899 | + u1bOfdm = ((u1bOfdm-2) > 0) ? (u1bOfdm-2): 0;\r | |
23900 | + write_nic_byte(dev, OFDM_TXAGC, u1bOfdm);\r | |
23901 | + //RT_TRACE(COMP_RATE, DBG_TRACE, ("Recover OFDM_TXAGC(2): ===== u1bOfdm= 0x%x\n", u1bOfdm));\r | |
23902 | +\r | |
23903 | + }\r | |
23904 | + }\r | |
23905 | +\r | |
23906 | + //\r | |
23907 | + // We need update initial gain when we set tx rate "from OFDM to CCK" or\r | |
23908 | + // "from CCK to OFDM". \r | |
23909 | + //\r | |
23910 | +SetInitialGain:\r | |
23911 | + if(bUpdateInitialGain)\r | |
23912 | + {\r | |
23913 | + if(MgntIsCckRate(priv->CurrentOperaRate)) // CCK\r | |
23914 | + {\r | |
23915 | + if(priv->InitialGain > priv->RegBModeGainStage)\r | |
23916 | + {\r | |
23917 | + priv->InitialGainBackUp= priv->InitialGain;\r | |
23918 | +\r | |
23919 | + if(CurrSignalStrength < -85) // Low power, OFDM [0x17] = 26.\r | |
23920 | + {\r | |
23921 | + //SD3 SYs suggest that CurrSignalStrength < -65, ofdm 0x17=26.\r | |
23922 | + priv->InitialGain = priv->RegBModeGainStage;\r | |
23923 | + }\r | |
23924 | + else if(priv->InitialGain > priv->RegBModeGainStage + 1)\r | |
23925 | + {\r | |
23926 | + priv->InitialGain -= 2;\r | |
23927 | + }\r | |
23928 | + else\r | |
23929 | + {\r | |
23930 | + priv->InitialGain --;\r | |
23931 | + }\r | |
23932 | + printk("StaRateAdaptive87SE(): update init_gain to index %d for date rate %d\n",priv->InitialGain, priv->CurrentOperaRate); \r | |
23933 | + UpdateInitialGain(dev);\r | |
23934 | + }\r | |
23935 | + }\r | |
23936 | + else // OFDM\r | |
23937 | + { \r | |
23938 | + if(priv->InitialGain < 4)\r | |
23939 | + {\r | |
23940 | + priv->InitialGainBackUp= priv->InitialGain;\r | |
23941 | +\r | |
23942 | + priv->InitialGain ++;\r | |
23943 | + printk("StaRateAdaptive87SE(): update init_gain to index %d for date rate %d\n",priv->InitialGain, priv->CurrentOperaRate); \r | |
23944 | + UpdateInitialGain(dev);\r | |
23945 | + } \r | |
23946 | + }\r | |
23947 | + }\r | |
23948 | +\r | |
23949 | + //Record the related info\r | |
23950 | + priv->LastRetryRate = CurrRetryRate;\r | |
23951 | + priv->LastTxThroughput = TxThroughput;\r | |
23952 | + priv->ieee80211->rate = priv->CurrentOperaRate * 5;\r | |
23953 | +}\r | |
23954 | +\r | |
23955 | +#endif\r | |
23956 | +#if LINUX_VERSION_CODE >=KERNEL_VERSION(2,6,20)\r | |
23957 | +void rtl8180_rate_adapter(struct work_struct * work)\r | |
23958 | +{\r | |
23959 | + struct delayed_work *dwork = container_of(work,struct delayed_work,work);\r | |
23960 | + struct ieee80211_device *ieee = container_of(dwork,struct ieee80211_device,rate_adapter_wq);\r | |
23961 | + struct net_device *dev = ieee->dev;\r | |
23962 | +#else\r | |
23963 | +void rtl8180_rate_adapter(struct net_device *dev)\r | |
23964 | +{\r | |
23965 | +\r | |
23966 | +#endif\r | |
23967 | + //struct r8180_priv *priv = ieee80211_priv(dev);\r | |
23968 | +// DMESG("---->rtl8180_rate_adapter");\r | |
23969 | + StaRateAdaptive87SE(dev);\r | |
23970 | +// DMESG("<----rtl8180_rate_adapter");\r | |
23971 | +}\r | |
23972 | +void timer_rate_adaptive(unsigned long data)\r | |
23973 | +{\r | |
23974 | + struct r8180_priv* priv = ieee80211_priv((struct net_device *)data);\r | |
23975 | + //DMESG("---->timer_rate_adaptive()\n");\r | |
23976 | + if(!priv->up)\r | |
23977 | + {\r | |
23978 | +// DMESG("<----timer_rate_adaptive():driver is not up!\n");\r | |
23979 | + return;\r | |
23980 | + }\r | |
23981 | + if((priv->ieee80211->iw_mode != IW_MODE_MASTER)\r | |
23982 | + && (priv->ieee80211->state == IEEE80211_LINKED) &&\r | |
23983 | + (priv->ForcedDataRate == 0) )\r | |
23984 | + {\r | |
23985 | +// DMESG("timer_rate_adaptive():schedule rate_adapter_wq\n");\r | |
23986 | +#ifdef CONFIG_RTL818X_S\r | |
23987 | + queue_work(priv->ieee80211->wq, (void *)&priv->ieee80211->rate_adapter_wq);\r | |
23988 | +// StaRateAdaptive87SE((struct net_device *)data);\r | |
23989 | +#endif\r | |
23990 | + }\r | |
23991 | + priv->rateadapter_timer.expires = jiffies + MSECS(priv->RateAdaptivePeriod);\r | |
23992 | + add_timer(&priv->rateadapter_timer);\r | |
23993 | + //DMESG("<----timer_rate_adaptive()\n");\r | |
23994 | +}\r | |
23995 | +//by amy 080312}\r | |
23996 | +void\r | |
23997 | +SwAntennaDiversityRxOk8185(\r | |
23998 | + struct net_device *dev, \r | |
23999 | + u8 SignalStrength\r | |
24000 | + )\r | |
24001 | +{\r | |
24002 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev);\r | |
24003 | +\r | |
24004 | +// printk("+SwAntennaDiversityRxOk8185: RxSs: %d\n", SignalStrength);\r | |
24005 | +\r | |
24006 | + priv->AdRxOkCnt++;\r | |
24007 | +\r | |
24008 | + if( priv->AdRxSignalStrength != -1)\r | |
24009 | + {\r | |
24010 | + priv->AdRxSignalStrength = ((priv->AdRxSignalStrength*7) + (SignalStrength*3)) / 10;\r | |
24011 | + }\r | |
24012 | + else\r | |
24013 | + { // Initialization case.\r | |
24014 | + priv->AdRxSignalStrength = SignalStrength;\r | |
24015 | + }\r | |
24016 | +//{+by amy 080312\r | |
24017 | + if( priv->LastRxPktAntenna ) //Main antenna. \r | |
24018 | + priv->AdMainAntennaRxOkCnt++; \r | |
24019 | + else // Aux antenna.\r | |
24020 | + priv->AdAuxAntennaRxOkCnt++;\r | |
24021 | +//+by amy 080312\r | |
24022 | +// printk("-SwAntennaDiversityRxOk8185: AdRxOkCnt: %d AdRxSignalStrength: %d\n", priv->AdRxOkCnt, priv->AdRxSignalStrength);\r | |
24023 | +}\r | |
24024 | +//\r | |
24025 | +// Description:\r | |
24026 | +// Change Antenna Switch.\r | |
24027 | +//\r | |
24028 | +bool\r | |
24029 | +SetAntenna8185(\r | |
24030 | + struct net_device *dev,\r | |
24031 | + u8 u1bAntennaIndex\r | |
24032 | + )\r | |
24033 | +{\r | |
24034 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev);\r | |
24035 | + bool bAntennaSwitched = false;\r | |
24036 | +\r | |
24037 | +// printk("+SetAntenna8185(): Antenna is switching to: %d \n", u1bAntennaIndex);\r | |
24038 | +\r | |
24039 | + switch(u1bAntennaIndex)\r | |
24040 | + {\r | |
24041 | + case 0:\r | |
24042 | + switch(priv->rf_chip)\r | |
24043 | + {\r | |
24044 | + case RF_ZEBRA2:\r | |
24045 | + case RF_ZEBRA4:\r | |
24046 | +#ifdef CONFIG_RTL8185B\r | |
24047 | +#ifdef CONFIG_RTL818X_S\r | |
24048 | + // Mac register, main antenna\r | |
24049 | + write_nic_byte(dev, ANTSEL, 0x03); \r | |
24050 | + //base band\r | |
24051 | + write_phy_cck(dev,0x11, 0x9b); // Config CCK RX antenna.\r | |
24052 | + write_phy_ofdm(dev, 0x0d, 0x5c); // Config OFDM RX antenna.\r | |
24053 | +\r | |
24054 | +#else\r | |
24055 | + // Mac register, main antenna\r | |
24056 | + write_nic_byte(dev, ANTSEL, 0x03); \r | |
24057 | + //base band\r | |
24058 | + write_phy_cck(dev, 0x10, 0x9b); // Config CCK RX antenna.\r | |
24059 | + write_phy_ofdm(dev, 0x0d, 0x5c); // Config OFDM RX antenna.\r | |
24060 | +#endif\r | |
24061 | +#endif\r | |
24062 | +\r | |
24063 | + bAntennaSwitched = true;\r | |
24064 | + break;\r | |
24065 | +\r | |
24066 | + default:\r | |
24067 | + printk("SetAntenna8185: unkown RFChipID(%d)\n", priv->rf_chip);\r | |
24068 | + break;\r | |
24069 | + }\r | |
24070 | + break;\r | |
24071 | +\r | |
24072 | + case 1:\r | |
24073 | + switch(priv->rf_chip)\r | |
24074 | + {\r | |
24075 | + case RF_ZEBRA2:\r | |
24076 | + case RF_ZEBRA4:\r | |
24077 | +#ifdef CONFIG_RTL8185B\r | |
24078 | +#ifdef CONFIG_RTL818X_S\r | |
24079 | + // Mac register, aux antenna\r | |
24080 | + write_nic_byte(dev, ANTSEL, 0x00); \r | |
24081 | + //base band\r | |
24082 | + write_phy_cck(dev, 0x11, 0xbb); // Config CCK RX antenna.\r | |
24083 | + write_phy_ofdm(dev, 0x0d, 0x54); // Config OFDM RX antenna.\r | |
24084 | +#else\r | |
24085 | + // Mac register, aux antenna\r | |
24086 | + write_nic_byte(dev, ANTSEL, 0x00); \r | |
24087 | + //base band\r | |
24088 | + write_phy_cck(dev, 0x10, 0xbb); // Config CCK RX antenna.\r | |
24089 | + write_phy_ofdm(dev, 0x0d, 0x54); // Config OFDM RX antenna.\r | |
24090 | +#endif\r | |
24091 | +#endif\r | |
24092 | +\r | |
24093 | + bAntennaSwitched = true;\r | |
24094 | + break;\r | |
24095 | +\r | |
24096 | + default:\r | |
24097 | + printk("SetAntenna8185: unkown RFChipID(%d)\n", priv->rf_chip);\r | |
24098 | + break;\r | |
24099 | + }\r | |
24100 | + break;\r | |
24101 | +\r | |
24102 | + default:\r | |
24103 | + printk("SetAntenna8185: unkown u1bAntennaIndex(%d)\n", u1bAntennaIndex);\r | |
24104 | + break;\r | |
24105 | + }\r | |
24106 | +\r | |
24107 | + if(bAntennaSwitched)\r | |
24108 | + {\r | |
24109 | + priv->CurrAntennaIndex = u1bAntennaIndex;\r | |
24110 | + }\r | |
24111 | +\r | |
24112 | +// printk("-SetAntenna8185(): return (%#X)\n", bAntennaSwitched);\r | |
24113 | +\r | |
24114 | + return bAntennaSwitched;\r | |
24115 | +}\r | |
24116 | +//\r | |
24117 | +// Description:\r | |
24118 | +// Toggle Antenna switch.\r | |
24119 | +//\r | |
24120 | +bool\r | |
24121 | +SwitchAntenna(\r | |
24122 | + struct net_device *dev\r | |
24123 | + )\r | |
24124 | +{\r | |
24125 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev);\r | |
24126 | +\r | |
24127 | + bool bResult;\r | |
24128 | +\r | |
24129 | + if(priv->CurrAntennaIndex == 0)\r | |
24130 | + {\r | |
24131 | +#if 0//lzm del 080826\r | |
24132 | +//by amy 080312\r | |
24133 | +#ifdef CONFIG_RTL818X_S\r | |
24134 | + if(priv->bSwAntennaDiverity)\r | |
24135 | + bResult = SetAntennaConfig87SE(dev, 1, true);\r | |
24136 | + else \r | |
24137 | +#endif\r | |
24138 | +#endif\r | |
24139 | + bResult = SetAntenna8185(dev, 1);\r | |
24140 | +//by amy 080312\r | |
24141 | +// printk("SwitchAntenna(): switching to antenna 1 ......\n");\r | |
24142 | +// bResult = SetAntenna8185(dev, 1);//-by amy 080312\r | |
24143 | + }\r | |
24144 | + else\r | |
24145 | + {\r | |
24146 | +#if 0//lzm del 080826\r | |
24147 | +//by amy 080312\r | |
24148 | +#ifdef CONFIG_RTL818X_S\r | |
24149 | + if(priv->bSwAntennaDiverity)\r | |
24150 | + bResult = SetAntennaConfig87SE(dev, 0, true);\r | |
24151 | + else \r | |
24152 | +#endif\r | |
24153 | +#endif\r | |
24154 | + bResult = SetAntenna8185(dev, 0);\r | |
24155 | +//by amy 080312\r | |
24156 | +// printk("SwitchAntenna(): switching to antenna 0 ......\n");\r | |
24157 | +// bResult = SetAntenna8185(dev, 0);//-by amy 080312\r | |
24158 | + }\r | |
24159 | +\r | |
24160 | + return bResult;\r | |
24161 | +}\r | |
24162 | +//\r | |
24163 | +// Description:\r | |
24164 | +// Engine of SW Antenna Diversity mechanism.\r | |
24165 | +// Since 8187 has no Tx part information, \r | |
24166 | +// this implementation is only dependend on Rx part information. \r | |
24167 | +//\r | |
24168 | +// 2006.04.17, by rcnjko.\r | |
24169 | +//\r | |
24170 | +void\r | |
24171 | +SwAntennaDiversity(\r | |
24172 | + struct net_device *dev\r | |
24173 | + )\r | |
24174 | +{\r | |
24175 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev);\r | |
24176 | + bool bSwCheckSS=false;\r | |
24177 | +// printk("+SwAntennaDiversity(): CurrAntennaIndex: %d\n", priv->CurrAntennaIndex);\r | |
24178 | +// printk("AdTickCount is %d\n",priv->AdTickCount);\r | |
24179 | +//by amy 080312\r | |
24180 | + if(bSwCheckSS)\r | |
24181 | + {\r | |
24182 | + priv->AdTickCount++;\r | |
24183 | + \r | |
24184 | + printk("(1) AdTickCount: %d, AdCheckPeriod: %d\n", \r | |
24185 | + priv->AdTickCount, priv->AdCheckPeriod);\r | |
24186 | + printk("(2) AdRxSignalStrength: %ld, AdRxSsThreshold: %ld\n", \r | |
24187 | + priv->AdRxSignalStrength, priv->AdRxSsThreshold);\r | |
24188 | + }\r | |
24189 | +// priv->AdTickCount++;//-by amy 080312\r | |
24190 | + \r | |
24191 | + // Case 1. No Link.\r | |
24192 | + if(priv->ieee80211->state != IEEE80211_LINKED)\r | |
24193 | + {\r | |
24194 | + // printk("SwAntennaDiversity(): Case 1. No Link.\n");\r | |
24195 | +\r | |
24196 | + priv->bAdSwitchedChecking = false;\r | |
24197 | + // I switch antenna here to prevent any one of antenna is broken before link established, 2006.04.18, by rcnjko..\r | |
24198 | + SwitchAntenna(dev);\r | |
24199 | + }\r | |
24200 | + // Case 2. Linked but no packet received.\r | |
24201 | + else if(priv->AdRxOkCnt == 0)\r | |
24202 | + {\r | |
24203 | + // printk("SwAntennaDiversity(): Case 2. Linked but no packet received.\n");\r | |
24204 | +\r | |
24205 | + priv->bAdSwitchedChecking = false;\r | |
24206 | + SwitchAntenna(dev);\r | |
24207 | + }\r | |
24208 | + // Case 3. Evaluate last antenna switch action and undo it if necessary.\r | |
24209 | + else if(priv->bAdSwitchedChecking == true)\r | |
24210 | + {\r | |
24211 | + // printk("SwAntennaDiversity(): Case 3. Evaluate last antenna switch action.\n");\r | |
24212 | +\r | |
24213 | + priv->bAdSwitchedChecking = false;\r | |
24214 | +\r | |
24215 | + // Adjust Rx signal strength threashold.\r | |
24216 | + priv->AdRxSsThreshold = (priv->AdRxSignalStrength + priv->AdRxSsBeforeSwitched) / 2;\r | |
24217 | +\r | |
24218 | + priv->AdRxSsThreshold = (priv->AdRxSsThreshold > priv->AdMaxRxSsThreshold) ? \r | |
24219 | + priv->AdMaxRxSsThreshold: priv->AdRxSsThreshold;\r | |
24220 | + if(priv->AdRxSignalStrength < priv->AdRxSsBeforeSwitched)\r | |
24221 | + { // Rx signal strength is not improved after we swtiched antenna. => Swich back.\r | |
24222 | +// printk("SwAntennaDiversity(): Rx Signal Strength is not improved, CurrRxSs: %d, LastRxSs: %d\n", \r | |
24223 | +// priv->AdRxSignalStrength, priv->AdRxSsBeforeSwitched);\r | |
24224 | +//by amy 080312\r | |
24225 | + // Increase Antenna Diversity checking period due to bad decision.\r | |
24226 | + priv->AdCheckPeriod *= 2;\r | |
24227 | +//by amy 080312\r | |
24228 | + // Increase Antenna Diversity checking period.\r | |
24229 | + if(priv->AdCheckPeriod > priv->AdMaxCheckPeriod)\r | |
24230 | + priv->AdCheckPeriod = priv->AdMaxCheckPeriod;\r | |
24231 | + \r | |
24232 | + // Wrong deceision => switch back.\r | |
24233 | + SwitchAntenna(dev);\r | |
24234 | + }\r | |
24235 | + else\r | |
24236 | + { // Rx Signal Strength is improved. \r | |
24237 | +// printk("SwAntennaDiversity(): Rx Signal Strength is improved, CurrRxSs: %d, LastRxSs: %d\n", \r | |
24238 | +// priv->AdRxSignalStrength, priv->AdRxSsBeforeSwitched);\r | |
24239 | +\r | |
24240 | + // Reset Antenna Diversity checking period to its min value.\r | |
24241 | + priv->AdCheckPeriod = priv->AdMinCheckPeriod;\r | |
24242 | + }\r | |
24243 | +\r | |
24244 | +// printk("SwAntennaDiversity(): AdRxSsThreshold: %d, AdCheckPeriod: %d\n",\r | |
24245 | +// priv->AdRxSsThreshold, priv->AdCheckPeriod);\r | |
24246 | + }\r | |
24247 | + // Case 4. Evaluate if we shall switch antenna now.\r | |
24248 | + // Cause Table Speed is very fast in TRC Dell Lab, we check it every time. \r | |
24249 | + else// if(priv->AdTickCount >= priv->AdCheckPeriod)//-by amy 080312\r | |
24250 | + {\r | |
24251 | +// printk("SwAntennaDiversity(): Case 4. Evaluate if we shall switch antenna now.\n");\r | |
24252 | +\r | |
24253 | + priv->AdTickCount = 0;\r | |
24254 | +\r | |
24255 | + //\r | |
24256 | + // <Roger_Notes> We evaluate RxOk counts for each antenna first and than \r | |
24257 | + // evaluate signal strength. \r | |
24258 | + // The following operation can overcome the disability of CCA on both two antennas\r | |
24259 | + // When signal strength was extremely low or high.\r | |
24260 | + // 2008.01.30.\r | |
24261 | + // \r | |
24262 | + \r | |
24263 | + //\r | |
24264 | + // Evaluate RxOk count from each antenna if we shall switch default antenna now.\r | |
24265 | + // Added by Roger, 2008.02.21.\r | |
24266 | +//{by amy 080312\r | |
24267 | + if((priv->AdMainAntennaRxOkCnt < priv->AdAuxAntennaRxOkCnt) \r | |
24268 | + && (priv->CurrAntennaIndex == 0))\r | |
24269 | + { // We set Main antenna as default but RxOk count was less than Aux ones.\r | |
24270 | +\r | |
24271 | + // printk("SwAntennaDiversity(): Main antenna RxOK is poor, AdMainAntennaRxOkCnt: %d, AdAuxAntennaRxOkCnt: %d\n", \r | |
24272 | + // priv->AdMainAntennaRxOkCnt, priv->AdAuxAntennaRxOkCnt);\r | |
24273 | + \r | |
24274 | + // Switch to Aux antenna.\r | |
24275 | + SwitchAntenna(dev); \r | |
24276 | + priv->bHWAdSwitched = true;\r | |
24277 | + }\r | |
24278 | + else if((priv->AdAuxAntennaRxOkCnt < priv->AdMainAntennaRxOkCnt) \r | |
24279 | + && (priv->CurrAntennaIndex == 1))\r | |
24280 | + { // We set Aux antenna as default but RxOk count was less than Main ones.\r | |
24281 | +\r | |
24282 | + // printk("SwAntennaDiversity(): Aux antenna RxOK is poor, AdMainAntennaRxOkCnt: %d, AdAuxAntennaRxOkCnt: %d\n", \r | |
24283 | + // priv->AdMainAntennaRxOkCnt, priv->AdAuxAntennaRxOkCnt);\r | |
24284 | + \r | |
24285 | + // Switch to Main antenna.\r | |
24286 | + SwitchAntenna(dev);\r | |
24287 | + priv->bHWAdSwitched = true;\r | |
24288 | + }\r | |
24289 | + else\r | |
24290 | + {// Default antenna is better.\r | |
24291 | +\r | |
24292 | + // printk("SwAntennaDiversity(): Default antenna is better., AdMainAntennaRxOkCnt: %d, AdAuxAntennaRxOkCnt: %d\n", \r | |
24293 | + // priv->AdMainAntennaRxOkCnt, priv->AdAuxAntennaRxOkCnt);\r | |
24294 | +\r | |
24295 | + // Still need to check current signal strength.\r | |
24296 | + priv->bHWAdSwitched = false; \r | |
24297 | + }\r | |
24298 | + //\r | |
24299 | + // <Roger_Notes> We evaluate Rx signal strength ONLY when default antenna \r | |
24300 | + // didn't changed by HW evaluation. \r | |
24301 | + // 2008.02.27.\r | |
24302 | + //\r | |
24303 | + // [TRC Dell Lab] SignalStrength is inaccuracy. Isaiah 2008-03-05 \r | |
24304 | + // For example, Throughput of aux is better than main antenna(about 10M v.s 2M), \r | |
24305 | + // but AdRxSignalStrength is less than main. \r | |
24306 | + // Our guess is that main antenna have lower throughput and get many change \r | |
24307 | + // to receive more CCK packets(ex.Beacon) which have stronger SignalStrength.\r | |
24308 | + //\r | |
24309 | + if( (!priv->bHWAdSwitched) && (bSwCheckSS))\r | |
24310 | + {\r | |
24311 | +//by amy 080312}\r | |
24312 | + // Evaluate Rx signal strength if we shall switch antenna now.\r | |
24313 | + if(priv->AdRxSignalStrength < priv->AdRxSsThreshold)\r | |
24314 | + { // Rx signal strength is weak => Switch Antenna.\r | |
24315 | +// printk("SwAntennaDiversity(): Rx Signal Strength is weak, CurrRxSs: %d, RxSsThreshold: %d\n", \r | |
24316 | +// priv->AdRxSignalStrength, priv->AdRxSsThreshold); \r | |
24317 | +\r | |
24318 | + priv->AdRxSsBeforeSwitched = priv->AdRxSignalStrength; \r | |
24319 | + priv->bAdSwitchedChecking = true;\r | |
24320 | +\r | |
24321 | + SwitchAntenna(dev);\r | |
24322 | + }\r | |
24323 | + else\r | |
24324 | + { // Rx signal strength is OK. \r | |
24325 | +// printk("SwAntennaDiversity(): Rx Signal Strength is OK, CurrRxSs: %d, RxSsThreshold: %d\n", \r | |
24326 | +// priv->AdRxSignalStrength, priv->AdRxSsThreshold);\r | |
24327 | +\r | |
24328 | + priv->bAdSwitchedChecking = false;\r | |
24329 | + // Increase Rx signal strength threashold if necessary.\r | |
24330 | + if( (priv->AdRxSignalStrength > (priv->AdRxSsThreshold + 10)) && // Signal is much stronger than current threshold\r | |
24331 | + priv->AdRxSsThreshold <= priv->AdMaxRxSsThreshold) // Current threhold is not yet reach upper limit.\r | |
24332 | + {\r | |
24333 | + priv->AdRxSsThreshold = (priv->AdRxSsThreshold + priv->AdRxSignalStrength) / 2;\r | |
24334 | + priv->AdRxSsThreshold = (priv->AdRxSsThreshold > priv->AdMaxRxSsThreshold) ?\r | |
24335 | + priv->AdMaxRxSsThreshold: priv->AdRxSsThreshold;//+by amy 080312\r | |
24336 | + }\r | |
24337 | +\r | |
24338 | + // Reduce Antenna Diversity checking period if possible. \r | |
24339 | + if( priv->AdCheckPeriod > priv->AdMinCheckPeriod )\r | |
24340 | + {\r | |
24341 | + priv->AdCheckPeriod /= 2; \r | |
24342 | + }\r | |
24343 | + }\r | |
24344 | + }\r | |
24345 | + }\r | |
24346 | +//by amy 080312\r | |
24347 | + // Reset antenna diversity Rx related statistics.\r | |
24348 | + priv->AdRxOkCnt = 0;\r | |
24349 | + priv->AdMainAntennaRxOkCnt = 0;\r | |
24350 | + priv->AdAuxAntennaRxOkCnt = 0;\r | |
24351 | +//by amy 080312\r | |
24352 | +\r | |
24353 | +// priv->AdRxOkCnt = 0;//-by amy 080312\r | |
24354 | +\r | |
24355 | +// printk("-SwAntennaDiversity()\n");\r | |
24356 | +}\r | |
24357 | +\r | |
24358 | +//\r | |
24359 | +// Description:\r | |
24360 | +// Return TRUE if we shall perform Tx Power Tracking Mecahnism, FALSE otherwise. \r | |
24361 | +//\r | |
24362 | +bool\r | |
24363 | +CheckTxPwrTracking( struct net_device *dev)\r | |
24364 | +{\r | |
24365 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev);\r | |
24366 | +\r | |
24367 | + if(!priv->bTxPowerTrack)\r | |
24368 | + {\r | |
24369 | + return false;\r | |
24370 | + }\r | |
24371 | +\r | |
24372 | +//lzm reserved 080826\r | |
24373 | + //if(priv->bScanInProgress)\r | |
24374 | + //{\r | |
24375 | + // return false;\r | |
24376 | + //}\r | |
24377 | +\r | |
24378 | + //if 87SE is in High Power , don't do Tx Power Tracking. asked by SD3 ED. 2008-08-08 Isaiah \r | |
24379 | + if(priv->bToUpdateTxPwr)\r | |
24380 | + {\r | |
24381 | + return false;\r | |
24382 | + }\r | |
24383 | + \r | |
24384 | + return true;\r | |
24385 | +}\r | |
24386 | +\r | |
24387 | +\r | |
24388 | +//\r | |
24389 | +// Description:\r | |
24390 | +// Timer callback function of SW Antenna Diversity.\r | |
24391 | +//\r | |
24392 | +void\r | |
24393 | +SwAntennaDiversityTimerCallback(\r | |
24394 | + struct net_device *dev\r | |
24395 | + )\r | |
24396 | +{\r | |
24397 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev);\r | |
24398 | + RT_RF_POWER_STATE rtState;\r | |
24399 | + \r | |
24400 | + //printk("+SwAntennaDiversityTimerCallback()\n");\r | |
24401 | +\r | |
24402 | + //\r | |
24403 | + // We do NOT need to switch antenna while RF is off.\r | |
24404 | + // 2007.05.09, added by Roger.\r | |
24405 | + //\r | |
24406 | + rtState = priv->eRFPowerState;\r | |
24407 | + do{\r | |
24408 | + if (rtState == eRfOff)\r | |
24409 | + { \r | |
24410 | +// printk("SwAntennaDiversityTimer - RF is OFF.\n");\r | |
24411 | + break;\r | |
24412 | + } \r | |
24413 | + else if (rtState == eRfSleep)\r | |
24414 | + { \r | |
24415 | + // Don't access BB/RF under Disable PLL situation.\r | |
24416 | + //RT_TRACE((COMP_RF|COMP_ANTENNA), DBG_LOUD, ("SwAntennaDiversityTimerCallback(): RF is Sleep => skip it\n"));\r | |
24417 | + break;\r | |
24418 | + } \r | |
24419 | + SwAntennaDiversity(dev);\r | |
24420 | +\r | |
24421 | + }while(false);\r | |
24422 | +\r | |
24423 | + if(priv->up)\r | |
24424 | + {\r | |
24425 | + priv->SwAntennaDiversityTimer.expires = jiffies + MSECS(ANTENNA_DIVERSITY_TIMER_PERIOD);\r | |
24426 | + add_timer(&priv->SwAntennaDiversityTimer);\r | |
24427 | + }\r | |
24428 | +\r | |
24429 | + //printk("-SwAntennaDiversityTimerCallback()\n");\r | |
24430 | +}\r | |
24431 | +\r | |
24432 | --- /dev/null | |
24433 | +++ b/drivers/staging/rtl8187se/r8180_dm.h | |
24434 | @@ -0,0 +1,41 @@ | |
24435 | +#ifndef R8180_DM_H \r | |
24436 | +#define R8180_DM_H\r | |
24437 | +\r | |
24438 | +#include "r8180.h"\r | |
24439 | +//#include "r8180_hw.h"\r | |
24440 | +//#include "r8180_93cx6.h"\r | |
24441 | +void SwAntennaDiversityRxOk8185(struct net_device *dev, u8 SignalStrength);\r | |
24442 | +bool SetAntenna8185(struct net_device *dev, u8 u1bAntennaIndex);\r | |
24443 | +bool SwitchAntenna( struct net_device *dev);\r | |
24444 | +void SwAntennaDiversity(struct net_device *dev );\r | |
24445 | +void SwAntennaDiversityTimerCallback(struct net_device *dev);\r | |
24446 | +bool CheckDig(struct net_device *dev);\r | |
24447 | +bool CheckHighPower(struct net_device *dev);\r | |
24448 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20))\r | |
24449 | +void rtl8180_hw_dig_wq (struct work_struct *work);\r | |
24450 | +#else\r | |
24451 | +void rtl8180_hw_dig_wq(struct net_device *dev);\r | |
24452 | +#endif\r | |
24453 | +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,20))\r | |
24454 | +void rtl8180_tx_pw_wq (struct work_struct *work);\r | |
24455 | +#else\r | |
24456 | +void rtl8180_tx_pw_wq(struct net_device *dev);\r | |
24457 | +#endif\r | |
24458 | +#if LINUX_VERSION_CODE >=KERNEL_VERSION(2,6,20)\r | |
24459 | +void rtl8180_rate_adapter(struct work_struct * work);\r | |
24460 | +\r | |
24461 | +#else\r | |
24462 | +void rtl8180_rate_adapter(struct net_device *dev);\r | |
24463 | +\r | |
24464 | +#endif\r | |
24465 | +void TxPwrTracking87SE(struct net_device *dev);\r | |
24466 | +bool CheckTxPwrTracking(struct net_device *dev);\r | |
24467 | +#if LINUX_VERSION_CODE >=KERNEL_VERSION(2,6,20)\r | |
24468 | +void rtl8180_rate_adapter(struct work_struct * work);\r | |
24469 | +#else\r | |
24470 | +void rtl8180_rate_adapter(struct net_device *dev);\r | |
24471 | +#endif\r | |
24472 | +void timer_rate_adaptive(unsigned long data);\r | |
24473 | +\r | |
24474 | +\r | |
24475 | +#endif\r | |
24476 | --- /dev/null | |
24477 | +++ b/drivers/staging/rtl8187se/r8180_gct.c | |
24478 | @@ -0,0 +1,296 @@ | |
24479 | +/* | |
24480 | + This files contains GCT radio frontend programming routines. | |
24481 | + | |
24482 | + This is part of rtl8180 OpenSource driver | |
24483 | + Copyright (C) Andrea Merello 2004-2005 <andreamrl@tiscali.it> | |
24484 | + Released under the terms of GPL (General Public Licence) | |
24485 | + | |
24486 | + Parts of this driver are based on the GPL part of the | |
24487 | + official realtek driver | |
24488 | + | |
24489 | + Parts of this driver are based on the rtl8180 driver skeleton | |
24490 | + from Patric Schenke & Andres Salomon | |
24491 | + | |
24492 | + Parts of this driver are based on the Intel Pro Wireless 2100 GPL driver. | |
24493 | + | |
24494 | + Code from Rtw8180 NetBSD driver by David Young has been really useful to | |
24495 | + understand some things and gets some ideas | |
24496 | + | |
24497 | + Code from rtl8181 project has been useful to me to understand some things. | |
24498 | + | |
24499 | + Some code from 'Deuce' work | |
24500 | + | |
24501 | + We want to tanks the Authors of such projects and the Ndiswrapper | |
24502 | + project Authors. | |
24503 | +*/ | |
24504 | + | |
24505 | + | |
24506 | +#include "r8180.h" | |
24507 | +#include "r8180_hw.h" | |
24508 | +#include "r8180_gct.h" | |
24509 | + | |
24510 | + | |
24511 | +//#define DEBUG_GCT | |
24512 | + | |
24513 | +/* the following experiment are just experiments. | |
24514 | + * this means if you enable them you can have every kind | |
24515 | + * of result, included damage the RF chip, so don't | |
24516 | + * touch them if you don't know what you are doing. | |
24517 | + * In any case, if you do it, do at your own risk | |
24518 | + */ | |
24519 | + | |
24520 | +//#define GCT_EXPERIMENT1 //improve RX sensivity | |
24521 | + | |
24522 | +//#define GCT_EXPERIMENT2 | |
24523 | + | |
24524 | +//#define GCT_EXPERIMENT3 //iprove a bit RX signal quality ? | |
24525 | + | |
24526 | +//#define GCT_EXPERIMENT4 //maybe solve some brokeness with experiment1 ? | |
24527 | + | |
24528 | +//#define GCT_EXPERIMENT5 | |
24529 | + | |
24530 | +//#define GCT_EXPERIMENT6 //not good | |
24531 | + | |
24532 | + | |
24533 | +u32 gct_chan[] = { | |
24534 | + 0x0, //dummy channel 0 | |
24535 | + 0x0, //1 | |
24536 | + 0x1, //2 | |
24537 | + 0x2, //3 | |
24538 | + 0x3, //4 | |
24539 | + 0x4, //5 | |
24540 | + 0x5, //6 | |
24541 | + 0x6, //7 | |
24542 | + 0x7, //8 | |
24543 | + 0x8, //9 | |
24544 | + 0x9, //10 | |
24545 | + 0xa, //11 | |
24546 | + 0xb, //12 | |
24547 | + 0xc, //13 | |
24548 | + 0xd, //14 | |
24549 | +}; | |
24550 | + | |
24551 | +int gct_encode[16] = { | |
24552 | + 0, 8, 4, 0xC, | |
24553 | + 2, 0xA, 6, 0xE, | |
24554 | + 1, 9, 5, 0xD, | |
24555 | + 3, 0xB, 7, 0xF | |
24556 | +}; | |
24557 | + | |
24558 | +void gct_rf_stabilize(struct net_device *dev) | |
24559 | +{ | |
24560 | + force_pci_posting(dev); | |
24561 | + mdelay(3); //for now use a great value.. we may optimize in future | |
24562 | +} | |
24563 | + | |
24564 | + | |
24565 | +void write_gct(struct net_device *dev, u8 adr, u32 data) | |
24566 | +{ | |
24567 | +// struct r8180_priv *priv = ieee80211_priv(dev); | |
24568 | + u32 phy_config; | |
24569 | + | |
24570 | + phy_config = gct_encode[(data & 0xf00) >> 8]; | |
24571 | + phy_config |= gct_encode[(data & 0xf0) >> 4 ] << 4; | |
24572 | + phy_config |= gct_encode[(data & 0xf) ] << 8; | |
24573 | + phy_config |= gct_encode[(adr >> 1) & 0xf ] << 12; | |
24574 | + phy_config |= (adr & 1 ) << 16; | |
24575 | + phy_config |= gct_encode[(data & 0xf000)>>12] << 24; | |
24576 | + | |
24577 | + phy_config |= 0x90000000; // MAC will bang bits to the chip | |
24578 | + | |
24579 | + | |
24580 | + write_nic_dword(dev,PHY_CONFIG,phy_config); | |
24581 | +#ifdef DEBUG_GCT | |
24582 | + DMESG("Writing GCT: %x (adr %x)",phy_config,adr); | |
24583 | +#endif | |
24584 | + gct_rf_stabilize(dev); | |
24585 | +} | |
24586 | + | |
24587 | + | |
24588 | + | |
24589 | +void gct_write_phy_antenna(struct net_device *dev,short ch) | |
24590 | +{ | |
24591 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
24592 | + u8 ant; | |
24593 | + | |
24594 | + ant = GCT_ANTENNA; | |
24595 | + if(priv->antb) /*default antenna is antenna B */ | |
24596 | + ant |= BB_ANTENNA_B; | |
24597 | + if(ch == 14) | |
24598 | + ant |= BB_ANTATTEN_CHAN14; | |
24599 | + write_phy(dev,0x10,ant); | |
24600 | + //DMESG("BB antenna %x ",ant); | |
24601 | +} | |
24602 | + | |
24603 | + | |
24604 | +void gct_rf_set_chan(struct net_device *dev, short ch) | |
24605 | +{ | |
24606 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
24607 | + u32 txpw = 0xff & priv->chtxpwr[ch]; | |
24608 | + u32 chan = gct_chan[ch]; | |
24609 | + | |
24610 | + //write_phy(dev,3,txpw); | |
24611 | +#ifdef DEBUG_GCT | |
24612 | + DMESG("Gct set channel"); | |
24613 | +#endif | |
24614 | + /* set TX power */ | |
24615 | + write_gct(dev,0x15,0); | |
24616 | + write_gct(dev,6, txpw); | |
24617 | + write_gct(dev,0x15, 0x10); | |
24618 | + write_gct(dev,0x15,0); | |
24619 | + | |
24620 | + /*set frequency*/ | |
24621 | + write_gct(dev,7, 0); | |
24622 | + write_gct(dev,0xB, chan); | |
24623 | + write_gct(dev,7, 0x1000); | |
24624 | + | |
24625 | +#ifdef DEBUG_GCT | |
24626 | + DMESG("Gct set channel > write phy antenna"); | |
24627 | +#endif | |
24628 | + | |
24629 | + | |
24630 | + gct_write_phy_antenna(dev,ch); | |
24631 | + | |
24632 | +} | |
24633 | + | |
24634 | + | |
24635 | +void gct_rf_close(struct net_device *dev) | |
24636 | +{ | |
24637 | + u32 anaparam; | |
24638 | + | |
24639 | + anaparam = read_nic_dword(dev,ANAPARAM); | |
24640 | + anaparam &= 0x000fffff; | |
24641 | + anaparam |= 0x3f900000; | |
24642 | + rtl8180_set_anaparam(dev, anaparam); | |
24643 | + | |
24644 | + write_gct(dev, 0x7, 0); | |
24645 | + write_gct(dev, 0x1f, 0x45); | |
24646 | + write_gct(dev, 0x1f, 0x5); | |
24647 | + write_gct(dev, 0x0, 0x8e4); | |
24648 | +} | |
24649 | + | |
24650 | + | |
24651 | +void gct_rf_init(struct net_device *dev) | |
24652 | +{ | |
24653 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
24654 | + //u32 anaparam; | |
24655 | + | |
24656 | + | |
24657 | + write_nic_byte(dev,PHY_DELAY,0x6); //this is general | |
24658 | + write_nic_byte(dev,CARRIER_SENSE_COUNTER,0x4c); //this is general | |
24659 | + | |
24660 | + //DMESG("%x", read_nic_dword(dev,ANAPARAM)); | |
24661 | + /* we should set anaparm here*/ | |
24662 | + //rtl8180_set_anaparam(dev,anaparam); | |
24663 | + | |
24664 | + write_gct(dev,0x1f,0); | |
24665 | + write_gct(dev,0x1f,0); | |
24666 | + write_gct(dev,0x1f,0x40); | |
24667 | + write_gct(dev,0x1f,0x60); | |
24668 | + write_gct(dev,0x1f,0x61); | |
24669 | + write_gct(dev,0x1f,0x61); | |
24670 | + write_gct(dev,0x0,0xae4); | |
24671 | + write_gct(dev,0x1f,0x1); | |
24672 | + write_gct(dev,0x1f,0x41); | |
24673 | + write_gct(dev,0x1f,0x61); | |
24674 | + write_gct(dev,0x1,0x1a23); | |
24675 | + write_gct(dev,0x2,0x4971); | |
24676 | + write_gct(dev,0x3,0x41de); | |
24677 | + write_gct(dev,0x4,0x2d80); | |
24678 | +#ifdef GCT_EXPERIMENT1 | |
24679 | + //write_gct(dev,0x5,0x6810); // from zydas driver. sens+ but quite slow | |
24680 | + //write_gct(dev,0x5,0x681f); //good+ (somewhat stable, better sens, performance decent) | |
24681 | + write_gct(dev,0x5,0x685f); //good performances, not sure sens is really so beeter | |
24682 | + //write_gct(dev,0x5,0x687f); //good performances, maybe sens is not improved | |
24683 | + //write_gct(dev,0x5,0x689f); //like above | |
24684 | + //write_gct(dev,0x5,0x685e); //bad | |
24685 | + //write_gct(dev,0x5,0x68ff); //good+ (somewhat stable, better sens(?), performance decent) | |
24686 | + //write_gct(dev,0x5,0x68f0); //bad | |
24687 | + //write_gct(dev,0x5,0x6cff); //sens+ but not so good | |
24688 | + //write_gct(dev,0x5,0x6dff); //sens+,apparentely very good but broken | |
24689 | + //write_gct(dev,0x5,0x65ff); //sens+,good | |
24690 | + //write_gct(dev,0x5,0x78ff); //sens + but almost broken | |
24691 | + //write_gct(dev,0x5,0x7810); //- //snes + but broken | |
24692 | + //write_gct(dev,0x5,0x781f); //-- //sens + | |
24693 | + //write_gct(dev,0x5,0x78f0); //low sens | |
24694 | +#else | |
24695 | + write_gct(dev,0x5,0x61ff); //best performance but weak sensitivity | |
24696 | +#endif | |
24697 | +#ifdef GCT_EXPERIMENT2 | |
24698 | + write_gct(dev,0x6,0xe); | |
24699 | +#else | |
24700 | + write_gct(dev,0x6,0x0); | |
24701 | +#endif | |
24702 | + write_gct(dev,0x7,0x0); | |
24703 | + write_gct(dev,0x8,0x7533); | |
24704 | + write_gct(dev,0x9,0xc401); | |
24705 | + write_gct(dev,0xa,0x0); | |
24706 | + write_gct(dev,0xc,0x1c7); | |
24707 | + write_gct(dev,0xd,0x29d3); | |
24708 | + write_gct(dev,0xe,0x2e8); | |
24709 | + write_gct(dev,0x10,0x192); | |
24710 | +#ifdef GCT_EXPERIMENT3 | |
24711 | + write_gct(dev,0x11,0x246); | |
24712 | +#else | |
24713 | + write_gct(dev,0x11,0x248); | |
24714 | +#endif | |
24715 | + write_gct(dev,0x12,0x0); | |
24716 | + write_gct(dev,0x13,0x20c4); | |
24717 | +#ifdef GCT_EXPERIMENT4 | |
24718 | + write_gct(dev,0x14,0xf488); | |
24719 | +#else | |
24720 | + write_gct(dev,0x14,0xf4fc); | |
24721 | +#endif | |
24722 | +#ifdef GCT_EXPERIMENT5 | |
24723 | + write_gct(dev,0x15,0xb152); | |
24724 | +#else | |
24725 | + write_gct(dev,0x15,0x0); | |
24726 | +#endif | |
24727 | +#ifdef GCT_EXPERIMENT6 | |
24728 | + write_gct(dev,0x1e,0x1); | |
24729 | +#endif | |
24730 | + write_gct(dev,0x16,0x1500); | |
24731 | + | |
24732 | + write_gct(dev,0x7,0x1000); | |
24733 | + /*write_gct(dev,0x15,0x0); | |
24734 | + write_gct(dev,0x6,0x15); | |
24735 | + write_gct(dev,0x15,0x8); | |
24736 | + write_gct(dev,0x15,0x0); | |
24737 | +*/ | |
24738 | + write_phy(dev,0,0xa8); | |
24739 | + | |
24740 | +/* write_gct(dev,0x15,0x0); | |
24741 | + write_gct(dev,0x6,0x12); | |
24742 | + write_gct(dev,0x15,0x8); | |
24743 | + write_gct(dev,0x15,0x0); | |
24744 | +*/ | |
24745 | + write_phy(dev,3,0x0); | |
24746 | + write_phy(dev,4,0xc0); /* lna det*/ | |
24747 | + write_phy(dev,5,0x90); | |
24748 | + write_phy(dev,6,0x1e); | |
24749 | + write_phy(dev,7,0x64); | |
24750 | + | |
24751 | +#ifdef DEBUG_GCT | |
24752 | + DMESG("Gct init> write phy antenna"); | |
24753 | +#endif | |
24754 | + | |
24755 | + gct_write_phy_antenna(dev,priv->chan); | |
24756 | + | |
24757 | + write_phy(dev,0x11,0x88); | |
24758 | + if(!priv->diversity) | |
24759 | + write_phy(dev,0x12,0xc0); | |
24760 | + else | |
24761 | + write_phy(dev,0x12,0x40); | |
24762 | + | |
24763 | + write_phy(dev,0x13,0x90 | priv->cs_treshold ); | |
24764 | + | |
24765 | + write_phy(dev,0x19,0x0); | |
24766 | + write_phy(dev,0x1a,0xa0); | |
24767 | + write_phy(dev,0x1b,0x44); | |
24768 | + | |
24769 | +#ifdef DEBUG_GCT | |
24770 | + DMESG("Gct init > set channel2"); | |
24771 | +#endif | |
24772 | + | |
24773 | + gct_rf_set_chan(dev,priv->chan); | |
24774 | +} | |
24775 | --- /dev/null | |
24776 | +++ b/drivers/staging/rtl8187se/r8180_gct.h | |
24777 | @@ -0,0 +1,25 @@ | |
24778 | +/* | |
24779 | + This is part of rtl8180 OpenSource driver - v 0.20 | |
24780 | + Copyright (C) Andrea Merello 2004 <andreamrl@tiscali.it> | |
24781 | + Released under the terms of GPL (General Public Licence) | |
24782 | + | |
24783 | + Parts of this driver are based on the GPL part of the official realtek driver | |
24784 | + Parts of this driver are based on the rtl8180 driver skeleton from Patric Schenke & Andres Salomon | |
24785 | + Parts of this driver are based on the Intel Pro Wireless 2100 GPL driver | |
24786 | + | |
24787 | + We want to tanks the Authors of such projects and the Ndiswrapper project Authors. | |
24788 | +*/ | |
24789 | + | |
24790 | +#define GCT_ANTENNA 0xA3 | |
24791 | + | |
24792 | + | |
24793 | +// we use the untouched eeprom value- cross your finger ;-) | |
24794 | +#define GCT_ANAPARAM_PWR1_ON ?? | |
24795 | +#define GCT_ANAPARAM_PWR0_ON ?? | |
24796 | + | |
24797 | + | |
24798 | + | |
24799 | +void gct_rf_init(struct net_device *dev); | |
24800 | +void gct_rf_set_chan(struct net_device *dev,short ch); | |
24801 | + | |
24802 | +void gct_rf_close(struct net_device *dev); | |
24803 | --- /dev/null | |
24804 | +++ b/drivers/staging/rtl8187se/r8180.h | |
24805 | @@ -0,0 +1,761 @@ | |
24806 | +/* | |
24807 | + This is part of rtl8180 OpenSource driver. | |
24808 | + Copyright (C) Andrea Merello 2004-2005 <andreamrl@tiscali.it> | |
24809 | + Released under the terms of GPL (General Public Licence) | |
24810 | + | |
24811 | + Parts of this driver are based on the GPL part of the | |
24812 | + official realtek driver | |
24813 | + | |
24814 | + Parts of this driver are based on the rtl8180 driver skeleton | |
24815 | + from Patric Schenke & Andres Salomon | |
24816 | + | |
24817 | + Parts of this driver are based on the Intel Pro Wireless 2100 GPL driver | |
24818 | + | |
24819 | + We want to tanks the Authors of those projects and the Ndiswrapper | |
24820 | + project Authors. | |
24821 | +*/ | |
24822 | + | |
24823 | +#ifndef R8180H | |
24824 | +#define R8180H | |
24825 | + | |
24826 | + | |
24827 | +#define RTL8180_MODULE_NAME "rtl8180" | |
24828 | +#define DMESG(x,a...) printk(KERN_INFO RTL8180_MODULE_NAME ": " x "\n", ## a) | |
24829 | +#define DMESGW(x,a...) printk(KERN_WARNING RTL8180_MODULE_NAME ": WW:" x "\n", ## a) | |
24830 | +#define DMESGE(x,a...) printk(KERN_WARNING RTL8180_MODULE_NAME ": EE:" x "\n", ## a) | |
24831 | + | |
24832 | +#include <linux/module.h> | |
24833 | +#include <linux/kernel.h> | |
24834 | +//#include <linux/config.h> | |
24835 | +#include <linux/init.h> | |
24836 | +#include <linux/ioport.h> | |
24837 | +#include <linux/sched.h> | |
24838 | +#include <linux/types.h> | |
24839 | +#include <linux/slab.h> | |
24840 | +#include <linux/netdevice.h> | |
24841 | +#include <linux/pci.h> | |
24842 | +#include <linux/etherdevice.h> | |
24843 | +#include <linux/delay.h> | |
24844 | +#include <linux/rtnetlink.h> //for rtnl_lock() | |
24845 | +#include <linux/wireless.h> | |
24846 | +#include <linux/timer.h> | |
24847 | +#include <linux/proc_fs.h> // Necessary because we use the proc fs | |
24848 | +#include <linux/if_arp.h> | |
24849 | +#include "ieee80211.h" | |
24850 | +#include <asm/io.h> | |
24851 | +//#include <asm/semaphore.h> | |
24852 | + | |
24853 | +#define EPROM_93c46 0 | |
24854 | +#define EPROM_93c56 1 | |
24855 | + | |
24856 | +#define RTL_IOCTL_WPA_SUPPLICANT SIOCIWFIRSTPRIV+30 | |
24857 | + | |
24858 | +#define DEFAULT_FRAG_THRESHOLD 2342U | |
24859 | +#define MIN_FRAG_THRESHOLD 256U | |
24860 | +//#define MAX_FRAG_THRESHOLD 2342U | |
24861 | +#define DEFAULT_RTS_THRESHOLD 2342U | |
24862 | +#define MIN_RTS_THRESHOLD 0U | |
24863 | +#define MAX_RTS_THRESHOLD 2342U | |
24864 | +#define DEFAULT_BEACONINTERVAL 0x64U | |
24865 | +#define DEFAULT_BEACON_ESSID "Rtl8180" | |
24866 | + | |
24867 | +#define DEFAULT_SSID "" | |
24868 | +#define DEFAULT_RETRY_RTS 7 | |
24869 | +#define DEFAULT_RETRY_DATA 7 | |
24870 | +#define PRISM_HDR_SIZE 64 | |
24871 | + | |
24872 | +#ifdef CONFIG_RTL8185B | |
24873 | + | |
24874 | +#define MGNT_QUEUE 0 | |
24875 | +#define BK_QUEUE 1 | |
24876 | +#define BE_QUEUE 2 | |
24877 | +#define VI_QUEUE 3 | |
24878 | +#define VO_QUEUE 4 | |
24879 | +#define HIGH_QUEUE 5 | |
24880 | +#define BEACON_QUEUE 6 | |
24881 | + | |
24882 | +#define LOW_QUEUE BE_QUEUE | |
24883 | +#define NORMAL_QUEUE MGNT_QUEUE | |
24884 | + | |
24885 | +#define aSifsTime 10 | |
24886 | + | |
24887 | +#define sCrcLng 4 | |
24888 | +#define sAckCtsLng 112 // bits in ACK and CTS frames | |
24889 | +//+by amy 080312 | |
24890 | +#define RATE_ADAPTIVE_TIMER_PERIOD 300 | |
24891 | + | |
24892 | +typedef enum _WIRELESS_MODE { | |
24893 | + WIRELESS_MODE_UNKNOWN = 0x00, | |
24894 | + WIRELESS_MODE_A = 0x01, | |
24895 | + WIRELESS_MODE_B = 0x02, | |
24896 | + WIRELESS_MODE_G = 0x04, | |
24897 | + WIRELESS_MODE_AUTO = 0x08, | |
24898 | +} WIRELESS_MODE; | |
24899 | + | |
24900 | +typedef enum _VERSION_8185{ | |
24901 | + // RTL8185 | |
24902 | + VERSION_8185_UNKNOWN, | |
24903 | + VERSION_8185_C, // C-cut | |
24904 | + VERSION_8185_D, // D-cut | |
24905 | + // RTL8185B | |
24906 | + VERSION_8185B_B, // B-cut | |
24907 | + VERSION_8185B_D, // D-cut | |
24908 | + VERSION_8185B_E, // E-cut | |
24909 | + //RTL8187S-PCIE | |
24910 | + VERSION_8187S_B, // B-cut | |
24911 | + VERSION_8187S_C, // C-cut | |
24912 | + VERSION_8187S_D, // D-cut | |
24913 | + | |
24914 | +}VERSION_8185,*PVERSION_8185; | |
24915 | +typedef struct ChnlAccessSetting { | |
24916 | + u16 SIFS_Timer; | |
24917 | + u16 DIFS_Timer; | |
24918 | + u16 SlotTimeTimer; | |
24919 | + u16 EIFS_Timer; | |
24920 | + u16 CWminIndex; | |
24921 | + u16 CWmaxIndex; | |
24922 | +}*PCHANNEL_ACCESS_SETTING,CHANNEL_ACCESS_SETTING; | |
24923 | + | |
24924 | +typedef enum{ | |
24925 | + NIC_8185 = 1, | |
24926 | + NIC_8185B | |
24927 | + } nic_t; | |
24928 | + | |
24929 | +typedef u32 AC_CODING; | |
24930 | +#define AC0_BE 0 // ACI: 0x00 // Best Effort | |
24931 | +#define AC1_BK 1 // ACI: 0x01 // Background | |
24932 | +#define AC2_VI 2 // ACI: 0x10 // Video | |
24933 | +#define AC3_VO 3 // ACI: 0x11 // Voice | |
24934 | +#define AC_MAX 4 // Max: define total number; Should not to be used as a real enum. | |
24935 | + | |
24936 | +// | |
24937 | +// ECWmin/ECWmax field. | |
24938 | +// Ref: WMM spec 2.2.2: WME Parameter Element, p.13. | |
24939 | +// | |
24940 | +typedef union _ECW{ | |
24941 | + u8 charData; | |
24942 | + struct | |
24943 | + { | |
24944 | + u8 ECWmin:4; | |
24945 | + u8 ECWmax:4; | |
24946 | + }f; // Field | |
24947 | +}ECW, *PECW; | |
24948 | + | |
24949 | +// | |
24950 | +// ACI/AIFSN Field. | |
24951 | +// Ref: WMM spec 2.2.2: WME Parameter Element, p.12. | |
24952 | +// | |
24953 | +typedef union _ACI_AIFSN{ | |
24954 | + u8 charData; | |
24955 | + | |
24956 | + struct | |
24957 | + { | |
24958 | + u8 AIFSN:4; | |
24959 | + u8 ACM:1; | |
24960 | + u8 ACI:2; | |
24961 | + u8 Reserved:1; | |
24962 | + }f; // Field | |
24963 | +}ACI_AIFSN, *PACI_AIFSN; | |
24964 | + | |
24965 | +// | |
24966 | +// AC Parameters Record Format. | |
24967 | +// Ref: WMM spec 2.2.2: WME Parameter Element, p.12. | |
24968 | +// | |
24969 | +typedef union _AC_PARAM{ | |
24970 | + u32 longData; | |
24971 | + u8 charData[4]; | |
24972 | + | |
24973 | + struct | |
24974 | + { | |
24975 | + ACI_AIFSN AciAifsn; | |
24976 | + ECW Ecw; | |
24977 | + u16 TXOPLimit; | |
24978 | + }f; // Field | |
24979 | +}AC_PARAM, *PAC_PARAM; | |
24980 | + | |
24981 | +/* it is a wrong definition. -xiong-2006-11-17 | |
24982 | +typedef struct ThreeWireReg { | |
24983 | + u16 longData; | |
24984 | + struct { | |
24985 | + u8 enableB; | |
24986 | + u8 data; | |
24987 | + u8 clk; | |
24988 | + u8 read_write; | |
24989 | + } struc; | |
24990 | +} ThreeWireReg; | |
24991 | +*/ | |
24992 | + | |
24993 | +typedef union _ThreeWire{ | |
24994 | + struct _ThreeWireStruc{ | |
24995 | + u16 data:1; | |
24996 | + u16 clk:1; | |
24997 | + u16 enableB:1; | |
24998 | + u16 read_write:1; | |
24999 | + u16 resv1:12; | |
25000 | +// u2Byte resv2:14; | |
25001 | +// u2Byte ThreeWireEnable:1; | |
25002 | +// u2Byte resv3:1; | |
25003 | + }struc; | |
25004 | + u16 longData; | |
25005 | +}ThreeWireReg; | |
25006 | + | |
25007 | +#endif | |
25008 | + | |
25009 | +typedef struct buffer | |
25010 | +{ | |
25011 | + struct buffer *next; | |
25012 | + u32 *buf; | |
25013 | + dma_addr_t dma; | |
25014 | +} buffer; | |
25015 | + | |
25016 | +//YJ,modified,080828 | |
25017 | +typedef struct Stats | |
25018 | +{ | |
25019 | + unsigned long txrdu; | |
25020 | + unsigned long rxrdu; | |
25021 | + unsigned long rxnolast; | |
25022 | + unsigned long rxnodata; | |
25023 | +// unsigned long rxreset; | |
25024 | +// unsigned long rxwrkaround; | |
25025 | + unsigned long rxnopointer; | |
25026 | + unsigned long txnperr; | |
25027 | + unsigned long txresumed; | |
25028 | + unsigned long rxerr; | |
25029 | + unsigned long rxoverflow; | |
25030 | + unsigned long rxint; | |
25031 | + unsigned long txbkpokint; | |
25032 | + unsigned long txbepoking; | |
25033 | + unsigned long txbkperr; | |
25034 | + unsigned long txbeperr; | |
25035 | + unsigned long txnpokint; | |
25036 | + unsigned long txhpokint; | |
25037 | + unsigned long txhperr; | |
25038 | + unsigned long ints; | |
25039 | + unsigned long shints; | |
25040 | + unsigned long txoverflow; | |
25041 | + unsigned long rxdmafail; | |
25042 | + unsigned long txbeacon; | |
25043 | + unsigned long txbeaconerr; | |
25044 | + unsigned long txlpokint; | |
25045 | + unsigned long txlperr; | |
25046 | + unsigned long txretry;//retry number tony 20060601 | |
25047 | + unsigned long rxcrcerrmin;//crc error (0-500) | |
25048 | + unsigned long rxcrcerrmid;//crc error (500-1000) | |
25049 | + unsigned long rxcrcerrmax;//crc error (>1000) | |
25050 | + unsigned long rxicverr;//ICV error | |
25051 | +} Stats; | |
25052 | + | |
25053 | +#define MAX_LD_SLOT_NUM 10 | |
25054 | +#define KEEP_ALIVE_INTERVAL 20 // in seconds. | |
25055 | +#define CHECK_FOR_HANG_PERIOD 2 //be equal to watchdog check time | |
25056 | +#define DEFAULT_KEEP_ALIVE_LEVEL 1 | |
25057 | +#define DEFAULT_SLOT_NUM 2 | |
25058 | +#define POWER_PROFILE_AC 0 | |
25059 | +#define POWER_PROFILE_BATTERY 1 | |
25060 | + | |
25061 | +typedef struct _link_detect_t | |
25062 | +{ | |
25063 | + u32 RxFrameNum[MAX_LD_SLOT_NUM]; // number of Rx Frame / CheckForHang_period to determine link status | |
25064 | + u16 SlotNum; // number of CheckForHang period to determine link status, default is 2 | |
25065 | + u16 SlotIndex; | |
25066 | + | |
25067 | + u32 NumTxOkInPeriod; //number of packet transmitted during CheckForHang | |
25068 | + u32 NumRxOkInPeriod; //number of packet received during CheckForHang | |
25069 | + | |
25070 | + u8 IdleCount; // (KEEP_ALIVE_INTERVAL / CHECK_FOR_HANG_PERIOD) | |
25071 | + u32 LastNumTxUnicast; | |
25072 | + u32 LastNumRxUnicast; | |
25073 | + | |
25074 | + bool bBusyTraffic; //when it is set to 1, UI cann't scan at will. | |
25075 | +}link_detect_t, *plink_detect_t; | |
25076 | + | |
25077 | +//YJ,modified,080828,end | |
25078 | + | |
25079 | +//by amy for led | |
25080 | +//================================================================================ | |
25081 | +// LED customization. | |
25082 | +//================================================================================ | |
25083 | + | |
25084 | +typedef enum _LED_STRATEGY_8185{ | |
25085 | + SW_LED_MODE0, // | |
25086 | + SW_LED_MODE1, // | |
25087 | + HW_LED, // HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes) | |
25088 | +}LED_STRATEGY_8185, *PLED_STRATEGY_8185; | |
25089 | +//by amy for led | |
25090 | +//by amy for power save | |
25091 | +typedef enum _LED_CTL_MODE{ | |
25092 | + LED_CTL_POWER_ON = 1, | |
25093 | + LED_CTL_LINK = 2, | |
25094 | + LED_CTL_NO_LINK = 3, | |
25095 | + LED_CTL_TX = 4, | |
25096 | + LED_CTL_RX = 5, | |
25097 | + LED_CTL_SITE_SURVEY = 6, | |
25098 | + LED_CTL_POWER_OFF = 7 | |
25099 | +}LED_CTL_MODE; | |
25100 | + | |
25101 | +typedef enum _RT_RF_POWER_STATE | |
25102 | +{ | |
25103 | + eRfOn, | |
25104 | + eRfSleep, | |
25105 | + eRfOff | |
25106 | +}RT_RF_POWER_STATE; | |
25107 | + | |
25108 | +enum _ReasonCode{ | |
25109 | + unspec_reason = 0x1, | |
25110 | + auth_not_valid = 0x2, | |
25111 | + deauth_lv_ss = 0x3, | |
25112 | + inactivity = 0x4, | |
25113 | + ap_overload = 0x5, | |
25114 | + class2_err = 0x6, | |
25115 | + class3_err = 0x7, | |
25116 | + disas_lv_ss = 0x8, | |
25117 | + asoc_not_auth = 0x9, | |
25118 | + | |
25119 | + //----MIC_CHECK | |
25120 | + mic_failure = 0xe, | |
25121 | + //----END MIC_CHECK | |
25122 | + | |
25123 | + // Reason code defined in 802.11i D10.0 p.28. | |
25124 | + invalid_IE = 0x0d, | |
25125 | + four_way_tmout = 0x0f, | |
25126 | + two_way_tmout = 0x10, | |
25127 | + IE_dismatch = 0x11, | |
25128 | + invalid_Gcipher = 0x12, | |
25129 | + invalid_Pcipher = 0x13, | |
25130 | + invalid_AKMP = 0x14, | |
25131 | + unsup_RSNIEver = 0x15, | |
25132 | + invalid_RSNIE = 0x16, | |
25133 | + auth_802_1x_fail= 0x17, | |
25134 | + ciper_reject = 0x18, | |
25135 | + | |
25136 | + // Reason code defined in 7.3.1.7, 802.1e D13.0, p.42. Added by Annie, 2005-11-15. | |
25137 | + QoS_unspec = 0x20, // 32 | |
25138 | + QAP_bandwidth = 0x21, // 33 | |
25139 | + poor_condition = 0x22, // 34 | |
25140 | + no_facility = 0x23, // 35 | |
25141 | + // Where is 36??? | |
25142 | + req_declined = 0x25, // 37 | |
25143 | + invalid_param = 0x26, // 38 | |
25144 | + req_not_honored= 0x27, // 39 | |
25145 | + TS_not_created = 0x2F, // 47 | |
25146 | + DL_not_allowed = 0x30, // 48 | |
25147 | + dest_not_exist = 0x31, // 49 | |
25148 | + dest_not_QSTA = 0x32, // 50 | |
25149 | +}; | |
25150 | +typedef enum _RT_PS_MODE | |
25151 | +{ | |
25152 | + eActive, // Active/Continuous access. | |
25153 | + eMaxPs, // Max power save mode. | |
25154 | + eFastPs // Fast power save mode. | |
25155 | +}RT_PS_MODE; | |
25156 | +//by amy for power save | |
25157 | +typedef struct r8180_priv | |
25158 | +{ | |
25159 | + struct pci_dev *pdev; | |
25160 | + | |
25161 | + short epromtype; | |
25162 | + int irq; | |
25163 | + struct ieee80211_device *ieee80211; | |
25164 | + | |
25165 | + short card_8185; /* O: rtl8180, 1:rtl8185 V B/C, 2:rtl8185 V D, 3:rtl8185B */ | |
25166 | + short card_8185_Bversion; /* if TCR reports card V B/C this discriminates */ | |
25167 | + short phy_ver; /* meaningful for rtl8225 1:A 2:B 3:C */ | |
25168 | + short enable_gpio0; | |
25169 | + enum card_type {PCI,MINIPCI,CARDBUS,USB/*rtl8187*/}card_type; | |
25170 | + short hw_plcp_len; | |
25171 | + short plcp_preamble_mode; // 0:auto 1:short 2:long | |
25172 | + | |
25173 | + spinlock_t irq_lock; | |
25174 | + spinlock_t irq_th_lock; | |
25175 | + spinlock_t tx_lock; | |
25176 | + spinlock_t ps_lock; | |
25177 | + spinlock_t rf_ps_lock; | |
25178 | + | |
25179 | + u16 irq_mask; | |
25180 | + short irq_enabled; | |
25181 | + struct net_device *dev; | |
25182 | + short chan; | |
25183 | + short sens; | |
25184 | + short max_sens; | |
25185 | + u8 chtxpwr[15]; //channels from 1 to 14, 0 not used | |
25186 | + u8 chtxpwr_ofdm[15]; //channels from 1 to 14, 0 not used | |
25187 | + //u8 challow[15]; //channels from 1 to 14, 0 not used | |
25188 | + u8 channel_plan; // it's the channel plan index | |
25189 | + short up; | |
25190 | + short crcmon; //if 1 allow bad crc frame reception in monitor mode | |
25191 | + short prism_hdr; | |
25192 | + | |
25193 | + struct timer_list scan_timer; | |
25194 | + /*short scanpending; | |
25195 | + short stopscan;*/ | |
25196 | + spinlock_t scan_lock; | |
25197 | + u8 active_probe; | |
25198 | + //u8 active_scan_num; | |
25199 | + struct semaphore wx_sem; | |
25200 | + struct semaphore rf_state; | |
25201 | + short hw_wep; | |
25202 | + | |
25203 | + short digphy; | |
25204 | + short antb; | |
25205 | + short diversity; | |
25206 | + u8 cs_treshold; | |
25207 | + short rcr_csense; | |
25208 | + short rf_chip; | |
25209 | + u32 key0[4]; | |
25210 | + short (*rf_set_sens)(struct net_device *dev,short sens); | |
25211 | + void (*rf_set_chan)(struct net_device *dev,short ch); | |
25212 | + void (*rf_close)(struct net_device *dev); | |
25213 | + void (*rf_init)(struct net_device *dev); | |
25214 | + void (*rf_sleep)(struct net_device *dev); | |
25215 | + void (*rf_wakeup)(struct net_device *dev); | |
25216 | + //short rate; | |
25217 | + short promisc; | |
25218 | + /*stats*/ | |
25219 | + struct Stats stats; | |
25220 | + struct _link_detect_t link_detect; //YJ,add,080828 | |
25221 | + struct iw_statistics wstats; | |
25222 | + struct proc_dir_entry *dir_dev; | |
25223 | + | |
25224 | + /*RX stuff*/ | |
25225 | + u32 *rxring; | |
25226 | + u32 *rxringtail; | |
25227 | + dma_addr_t rxringdma; | |
25228 | + struct buffer *rxbuffer; | |
25229 | + struct buffer *rxbufferhead; | |
25230 | + int rxringcount; | |
25231 | + u16 rxbuffersize; | |
25232 | + | |
25233 | + struct sk_buff *rx_skb; | |
25234 | + | |
25235 | + short rx_skb_complete; | |
25236 | + | |
25237 | + u32 rx_prevlen; | |
25238 | + | |
25239 | + /*TX stuff*/ | |
25240 | +/* | |
25241 | + u32 *txlpring; | |
25242 | + u32 *txhpring; | |
25243 | + u32 *txnpring; | |
25244 | + dma_addr_t txlpringdma; | |
25245 | + dma_addr_t txhpringdma; | |
25246 | + dma_addr_t txnpringdma; | |
25247 | + u32 *txlpringtail; | |
25248 | + u32 *txhpringtail; | |
25249 | + u32 *txnpringtail; | |
25250 | + u32 *txlpringhead; | |
25251 | + u32 *txhpringhead; | |
25252 | + u32 *txnpringhead; | |
25253 | + struct buffer *txlpbufs; | |
25254 | + struct buffer *txhpbufs; | |
25255 | + struct buffer *txnpbufs; | |
25256 | + struct buffer *txlpbufstail; | |
25257 | + struct buffer *txhpbufstail; | |
25258 | + struct buffer *txnpbufstail; | |
25259 | +*/ | |
25260 | + u32 *txmapring; | |
25261 | + u32 *txbkpring; | |
25262 | + u32 *txbepring; | |
25263 | + u32 *txvipring; | |
25264 | + u32 *txvopring; | |
25265 | + u32 *txhpring; | |
25266 | + dma_addr_t txmapringdma; | |
25267 | + dma_addr_t txbkpringdma; | |
25268 | + dma_addr_t txbepringdma; | |
25269 | + dma_addr_t txvipringdma; | |
25270 | + dma_addr_t txvopringdma; | |
25271 | + dma_addr_t txhpringdma; | |
25272 | + u32 *txmapringtail; | |
25273 | + u32 *txbkpringtail; | |
25274 | + u32 *txbepringtail; | |
25275 | + u32 *txvipringtail; | |
25276 | + u32 *txvopringtail; | |
25277 | + u32 *txhpringtail; | |
25278 | + u32 *txmapringhead; | |
25279 | + u32 *txbkpringhead; | |
25280 | + u32 *txbepringhead; | |
25281 | + u32 *txvipringhead; | |
25282 | + u32 *txvopringhead; | |
25283 | + u32 *txhpringhead; | |
25284 | + struct buffer *txmapbufs; | |
25285 | + struct buffer *txbkpbufs; | |
25286 | + struct buffer *txbepbufs; | |
25287 | + struct buffer *txvipbufs; | |
25288 | + struct buffer *txvopbufs; | |
25289 | + struct buffer *txhpbufs; | |
25290 | + struct buffer *txmapbufstail; | |
25291 | + struct buffer *txbkpbufstail; | |
25292 | + struct buffer *txbepbufstail; | |
25293 | + struct buffer *txvipbufstail; | |
25294 | + struct buffer *txvopbufstail; | |
25295 | + struct buffer *txhpbufstail; | |
25296 | + | |
25297 | + int txringcount; | |
25298 | + int txbuffsize; | |
25299 | + //struct tx_pendingbuf txnp_pending; | |
25300 | + //struct tasklet_struct irq_tx_tasklet; | |
25301 | + struct tasklet_struct irq_rx_tasklet; | |
25302 | + u8 dma_poll_mask; | |
25303 | + //short tx_suspend; | |
25304 | + | |
25305 | + /* adhoc/master mode stuff */ | |
25306 | + u32 *txbeaconringtail; | |
25307 | + dma_addr_t txbeaconringdma; | |
25308 | + u32 *txbeaconring; | |
25309 | + int txbeaconcount; | |
25310 | + struct buffer *txbeaconbufs; | |
25311 | + struct buffer *txbeaconbufstail; | |
25312 | + //char *master_essid; | |
25313 | + //u16 master_beaconinterval; | |
25314 | + //u32 master_beaconsize; | |
25315 | + //u16 beacon_interval; | |
25316 | + | |
25317 | + u8 retry_data; | |
25318 | + u8 retry_rts; | |
25319 | + u16 rts; | |
25320 | + | |
25321 | +//add for RF power on power off by lizhaoming 080512 | |
25322 | + u8 RegThreeWireMode; // See "Three wire mode" defined above, 2006.05.31, by rcnjko. | |
25323 | + | |
25324 | +//by amy for led | |
25325 | + LED_STRATEGY_8185 LedStrategy; | |
25326 | +//by amy for led | |
25327 | + | |
25328 | +//by amy for power save | |
25329 | + struct timer_list watch_dog_timer; | |
25330 | + bool bInactivePs; | |
25331 | + bool bSwRfProcessing; | |
25332 | + RT_RF_POWER_STATE eInactivePowerState; | |
25333 | + RT_RF_POWER_STATE eRFPowerState; | |
25334 | + u32 RfOffReason; | |
25335 | + bool RFChangeInProgress; | |
25336 | + bool bInHctTest; | |
25337 | + bool SetRFPowerStateInProgress; | |
25338 | + u8 RFProgType; | |
25339 | + bool bLeisurePs; | |
25340 | + RT_PS_MODE dot11PowerSaveMode; | |
25341 | + //u32 NumRxOkInPeriod; //YJ,del,080828 | |
25342 | + //u32 NumTxOkInPeriod; //YJ,del,080828 | |
25343 | + u8 TxPollingTimes; | |
25344 | + | |
25345 | + bool bApBufOurFrame;// TRUE if AP buffer our unicast data , we will keep eAwake untill receive data or timeout. | |
25346 | + u8 WaitBufDataBcnCount; | |
25347 | + u8 WaitBufDataTimeOut; | |
25348 | + | |
25349 | +//by amy for power save | |
25350 | +//by amy for antenna | |
25351 | + u8 EEPROMSwAntennaDiversity; | |
25352 | + bool EEPROMDefaultAntenna1; | |
25353 | + u8 RegSwAntennaDiversityMechanism; | |
25354 | + bool bSwAntennaDiverity; | |
25355 | + u8 RegDefaultAntenna; | |
25356 | + bool bDefaultAntenna1; | |
25357 | + u8 SignalStrength; | |
25358 | + long Stats_SignalStrength; | |
25359 | + long LastSignalStrengthInPercent; // In percentange, used for smoothing, e.g. Moving Average. | |
25360 | + u8 SignalQuality; // in 0-100 index. | |
25361 | + long Stats_SignalQuality; | |
25362 | + long RecvSignalPower; // in dBm. | |
25363 | + long Stats_RecvSignalPower; | |
25364 | + u8 LastRxPktAntenna; // +by amy 080312 Antenn which received the lasted packet. 0: Aux, 1:Main. Added by Roger, 2008.01.25. | |
25365 | + u32 AdRxOkCnt; | |
25366 | + long AdRxSignalStrength; | |
25367 | + u8 CurrAntennaIndex; // Index to current Antenna (both Tx and Rx). | |
25368 | + u8 AdTickCount; // Times of SwAntennaDiversityTimer happened. | |
25369 | + u8 AdCheckPeriod; // # of period SwAntennaDiversityTimer to check Rx signal strength for SW Antenna Diversity. | |
25370 | + u8 AdMinCheckPeriod; // Min value of AdCheckPeriod. | |
25371 | + u8 AdMaxCheckPeriod; // Max value of AdCheckPeriod. | |
25372 | + long AdRxSsThreshold; // Signal strength threshold to switch antenna. | |
25373 | + long AdMaxRxSsThreshold; // Max value of AdRxSsThreshold. | |
25374 | + bool bAdSwitchedChecking; // TRUE if we shall shall check Rx signal strength for last time switching antenna. | |
25375 | + long AdRxSsBeforeSwitched; // Rx signal strength before we swithed antenna. | |
25376 | + struct timer_list SwAntennaDiversityTimer; | |
25377 | +//by amy for antenna | |
25378 | +//{by amy 080312 | |
25379 | +// | |
25380 | + // Crystal calibration. | |
25381 | + // Added by Roger, 2007.12.11. | |
25382 | + // | |
25383 | + bool bXtalCalibration; // Crystal calibration. | |
25384 | + u8 XtalCal_Xin; // Crystal calibration for Xin. 0~7.5pF | |
25385 | + u8 XtalCal_Xout; // Crystal calibration for Xout. 0~7.5pF | |
25386 | + // | |
25387 | + // Tx power tracking with thermal meter indication. | |
25388 | + // Added by Roger, 2007.12.11. | |
25389 | + // | |
25390 | + bool bTxPowerTrack; // Tx Power tracking. | |
25391 | + u8 ThermalMeter; // Thermal meter reference indication. | |
25392 | + // | |
25393 | + // Dynamic Initial Gain Adjustment Mechanism. Added by Bruce, 2007-02-14. | |
25394 | + // | |
25395 | + bool bDigMechanism; // TRUE if DIG is enabled, FALSE ow. | |
25396 | + bool bRegHighPowerMechanism; // For High Power Mechanism. 061010, by rcnjko. | |
25397 | + u32 FalseAlarmRegValue; | |
25398 | + u8 RegDigOfdmFaUpTh; // Upper threhold of OFDM false alarm, which is used in DIG. | |
25399 | + u8 DIG_NumberFallbackVote; | |
25400 | + u8 DIG_NumberUpgradeVote; | |
25401 | + // For HW antenna diversity, added by Roger, 2008.01.30. | |
25402 | + u32 AdMainAntennaRxOkCnt; // Main antenna Rx OK count. | |
25403 | + u32 AdAuxAntennaRxOkCnt; // Aux antenna Rx OK count. | |
25404 | + bool bHWAdSwitched; // TRUE if we has switched default antenna by HW evaluation. | |
25405 | + // RF High Power upper/lower threshold. | |
25406 | + u8 RegHiPwrUpperTh; | |
25407 | + u8 RegHiPwrLowerTh; | |
25408 | + // RF RSSI High Power upper/lower Threshold. | |
25409 | + u8 RegRSSIHiPwrUpperTh; | |
25410 | + u8 RegRSSIHiPwrLowerTh; | |
25411 | + // Current CCK RSSI value to determine CCK high power, asked by SD3 DZ, by Bruce, 2007-04-12. | |
25412 | + u8 CurCCKRSSI; | |
25413 | + bool bCurCCKPkt; | |
25414 | + // | |
25415 | + // High Power Mechanism. Added by amy, 080312. | |
25416 | + // | |
25417 | + bool bToUpdateTxPwr; | |
25418 | + long UndecoratedSmoothedSS; | |
25419 | + long UndercorateSmoothedRxPower; | |
25420 | + u8 RSSI; | |
25421 | + char RxPower; | |
25422 | + u8 InitialGain; | |
25423 | + //For adjust Dig Threshhold during Legacy/Leisure Power Save Mode | |
25424 | + u32 DozePeriodInPast2Sec; | |
25425 | + // Don't access BB/RF under disable PLL situation. | |
25426 | + u8 InitialGainBackUp; | |
25427 | + u8 RegBModeGainStage; | |
25428 | +//by amy for rate adaptive | |
25429 | + struct timer_list rateadapter_timer; | |
25430 | + u32 RateAdaptivePeriod; | |
25431 | + bool bEnhanceTxPwr; | |
25432 | + bool bUpdateARFR; | |
25433 | + int ForcedDataRate; // Force Data Rate. 0: Auto, 0x02: 1M ~ 0x6C: 54M.) | |
25434 | + u32 NumTxUnicast; //YJ,add,080828,for keep alive | |
25435 | + u8 keepAliveLevel; //YJ,add,080828,for KeepAlive | |
25436 | + unsigned long NumTxOkTotal; | |
25437 | + u16 LastRetryCnt; | |
25438 | + u16 LastRetryRate; | |
25439 | + unsigned long LastTxokCnt; | |
25440 | + unsigned long LastRxokCnt; | |
25441 | + u16 CurrRetryCnt; | |
25442 | + unsigned long LastTxOKBytes; | |
25443 | + unsigned long NumTxOkBytesTotal; | |
25444 | + u8 LastFailTxRate; | |
25445 | + long LastFailTxRateSS; | |
25446 | + u8 FailTxRateCount; | |
25447 | + u32 LastTxThroughput; | |
25448 | + //for up rate | |
25449 | + unsigned short bTryuping; | |
25450 | + u8 CurrTxRate; //the rate before up | |
25451 | + u16 CurrRetryRate; | |
25452 | + u16 TryupingCount; | |
25453 | + u8 TryDownCountLowData; | |
25454 | + u8 TryupingCountNoData; | |
25455 | + | |
25456 | + u8 CurrentOperaRate; | |
25457 | +//by amy for rate adaptive | |
25458 | +//by amy 080312} | |
25459 | +// short wq_hurryup; | |
25460 | +// struct workqueue_struct *workqueue; | |
25461 | + struct work_struct reset_wq; | |
25462 | + struct work_struct watch_dog_wq; | |
25463 | + struct work_struct tx_irq_wq; | |
25464 | + short ack_tx_to_ieee; | |
25465 | + | |
25466 | + u8 PowerProfile; | |
25467 | +#ifdef CONFIG_RTL8185B | |
25468 | + u32 CSMethod; | |
25469 | + u8 cck_txpwr_base; | |
25470 | + u8 ofdm_txpwr_base; | |
25471 | + u8 dma_poll_stop_mask; | |
25472 | + | |
25473 | + //u8 RegThreeWireMode; | |
25474 | + u8 MWIEnable; | |
25475 | + u16 ShortRetryLimit; | |
25476 | + u16 LongRetryLimit; | |
25477 | + u16 EarlyRxThreshold; | |
25478 | + u32 TransmitConfig; | |
25479 | + u32 ReceiveConfig; | |
25480 | + u32 IntrMask; | |
25481 | + | |
25482 | + struct ChnlAccessSetting ChannelAccessSetting; | |
25483 | +#endif | |
25484 | +}r8180_priv; | |
25485 | + | |
25486 | +#define MANAGE_PRIORITY 0 | |
25487 | +#define BK_PRIORITY 1 | |
25488 | +#define BE_PRIORITY 2 | |
25489 | +#define VI_PRIORITY 3 | |
25490 | +#define VO_PRIORITY 4 | |
25491 | +#define HI_PRIORITY 5 | |
25492 | +#define BEACON_PRIORITY 6 | |
25493 | + | |
25494 | +#define LOW_PRIORITY VI_PRIORITY | |
25495 | +#define NORM_PRIORITY VO_PRIORITY | |
25496 | +//AC2Queue mapping | |
25497 | +#define AC2Q(_ac) (((_ac) == WME_AC_VO) ? VO_PRIORITY : \ | |
25498 | + ((_ac) == WME_AC_VI) ? VI_PRIORITY : \ | |
25499 | + ((_ac) == WME_AC_BK) ? BK_PRIORITY : \ | |
25500 | + BE_PRIORITY) | |
25501 | + | |
25502 | +short rtl8180_tx(struct net_device *dev,u8* skbuf, int len,int priority, | |
25503 | + short morefrag,short fragdesc,int rate); | |
25504 | + | |
25505 | +u8 read_nic_byte(struct net_device *dev, int x); | |
25506 | +u32 read_nic_dword(struct net_device *dev, int x); | |
25507 | +u16 read_nic_word(struct net_device *dev, int x) ; | |
25508 | +void write_nic_byte(struct net_device *dev, int x,u8 y); | |
25509 | +void write_nic_word(struct net_device *dev, int x,u16 y); | |
25510 | +void write_nic_dword(struct net_device *dev, int x,u32 y); | |
25511 | +void force_pci_posting(struct net_device *dev); | |
25512 | + | |
25513 | +void rtl8180_rtx_disable(struct net_device *); | |
25514 | +void rtl8180_rx_enable(struct net_device *); | |
25515 | +void rtl8180_tx_enable(struct net_device *); | |
25516 | +void rtl8180_start_scanning(struct net_device *dev); | |
25517 | +void rtl8180_start_scanning_s(struct net_device *dev); | |
25518 | +void rtl8180_stop_scanning(struct net_device *dev); | |
25519 | +void rtl8180_disassociate(struct net_device *dev); | |
25520 | +//void fix_rx_fifo(struct net_device *dev); | |
25521 | +void rtl8180_set_anaparam(struct net_device *dev,u32 a); | |
25522 | +void rtl8185_set_anaparam2(struct net_device *dev,u32 a); | |
25523 | +void rtl8180_set_hw_wep(struct net_device *dev); | |
25524 | +void rtl8180_no_hw_wep(struct net_device *dev); | |
25525 | +void rtl8180_update_msr(struct net_device *dev); | |
25526 | +//void rtl8180_BSS_create(struct net_device *dev); | |
25527 | +void rtl8180_beacon_tx_disable(struct net_device *dev); | |
25528 | +void rtl8180_beacon_rx_disable(struct net_device *dev); | |
25529 | +void rtl8180_conttx_enable(struct net_device *dev); | |
25530 | +void rtl8180_conttx_disable(struct net_device *dev); | |
25531 | +int rtl8180_down(struct net_device *dev); | |
25532 | +int rtl8180_up(struct net_device *dev); | |
25533 | +void rtl8180_commit(struct net_device *dev); | |
25534 | +void rtl8180_set_chan(struct net_device *dev,short ch); | |
25535 | +void rtl8180_set_master_essid(struct net_device *dev,char *essid); | |
25536 | +void rtl8180_update_beacon_security(struct net_device *dev); | |
25537 | +void write_phy(struct net_device *dev, u8 adr, u8 data); | |
25538 | +void write_phy_cck(struct net_device *dev, u8 adr, u32 data); | |
25539 | +void write_phy_ofdm(struct net_device *dev, u8 adr, u32 data); | |
25540 | +void rtl8185_tx_antenna(struct net_device *dev, u8 ant); | |
25541 | +void rtl8185_rf_pins_enable(struct net_device *dev); | |
25542 | +void IBSS_randomize_cell(struct net_device *dev); | |
25543 | +void IPSEnter(struct net_device *dev); | |
25544 | +void IPSLeave(struct net_device *dev); | |
25545 | +int get_curr_tx_free_desc(struct net_device *dev, int priority); | |
25546 | +void UpdateInitialGain(struct net_device *dev); | |
25547 | +bool SetAntennaConfig87SE(struct net_device *dev, u8 DefaultAnt, bool bAntDiversity); | |
25548 | + | |
25549 | +//#ifdef CONFIG_RTL8185B | |
25550 | +void rtl8185b_adapter_start(struct net_device *dev); | |
25551 | +void rtl8185b_rx_enable(struct net_device *dev); | |
25552 | +void rtl8185b_tx_enable(struct net_device *dev); | |
25553 | +void rtl8180_reset(struct net_device *dev); | |
25554 | +void rtl8185b_irq_enable(struct net_device *dev); | |
25555 | +void fix_rx_fifo(struct net_device *dev); | |
25556 | +void fix_tx_fifo(struct net_device *dev); | |
25557 | +void rtl8225z2_SetTXPowerLevel(struct net_device *dev, short ch); | |
25558 | +#if LINUX_VERSION_CODE >=KERNEL_VERSION(2,6,20) | |
25559 | +void rtl8180_rate_adapter(struct work_struct * work); | |
25560 | +#else | |
25561 | +void rtl8180_rate_adapter(struct net_device *dev); | |
25562 | +#endif | |
25563 | +//#endif | |
25564 | +bool MgntActSet_RF_State(struct net_device *dev, RT_RF_POWER_STATE StateToSet, u32 ChangeSource); | |
25565 | + | |
25566 | +#endif | |
25567 | --- /dev/null | |
25568 | +++ b/drivers/staging/rtl8187se/r8180_hw.h | |
25569 | @@ -0,0 +1,956 @@ | |
25570 | +/* | |
25571 | + This is part of rtl8180 OpenSource driver. | |
25572 | + Copyright (C) Andrea Merello 2004-2005 <andreamrl@tiscali.it> | |
25573 | + Released under the terms of GPL (General Public Licence) | |
25574 | + | |
25575 | + Parts of this driver are based on the GPL part of the | |
25576 | + official Realtek driver. | |
25577 | + Parts of this driver are based on the rtl8180 driver skeleton | |
25578 | + from Patric Schenke & Andres Salomon. | |
25579 | + Parts of this driver are based on the Intel Pro Wireless | |
25580 | + 2100 GPL driver. | |
25581 | + | |
25582 | + We want to tanks the Authors of those projects | |
25583 | + and the Ndiswrapper project Authors. | |
25584 | +*/ | |
25585 | + | |
25586 | +/* Mariusz Matuszek added full registers definition with Realtek's name */ | |
25587 | + | |
25588 | +/* this file contains register definitions for the rtl8180 MAC controller */ | |
25589 | +#ifndef R8180_HW | |
25590 | +#define R8180_HW | |
25591 | + | |
25592 | +#define CONFIG_RTL8185B //support for rtl8185B, xiong-2006-11-15 | |
25593 | +#define CONFIG_RTL818X_S | |
25594 | + | |
25595 | +#define BIT0 0x00000001 | |
25596 | +#define BIT1 0x00000002 | |
25597 | +#define BIT2 0x00000004 | |
25598 | +#define BIT3 0x00000008 | |
25599 | +#define BIT4 0x00000010 | |
25600 | +#define BIT5 0x00000020 | |
25601 | +#define BIT6 0x00000040 | |
25602 | +#define BIT7 0x00000080 | |
25603 | +#define BIT8 0x00000100 | |
25604 | +#define BIT9 0x00000200 | |
25605 | +#define BIT10 0x00000400 | |
25606 | +#define BIT11 0x00000800 | |
25607 | +#define BIT12 0x00001000 | |
25608 | +#define BIT13 0x00002000 | |
25609 | +#define BIT14 0x00004000 | |
25610 | +#define BIT15 0x00008000 | |
25611 | +#define BIT16 0x00010000 | |
25612 | +#define BIT17 0x00020000 | |
25613 | +#define BIT18 0x00040000 | |
25614 | +#define BIT19 0x00080000 | |
25615 | +#define BIT20 0x00100000 | |
25616 | +#define BIT21 0x00200000 | |
25617 | +#define BIT22 0x00400000 | |
25618 | +#define BIT23 0x00800000 | |
25619 | +#define BIT24 0x01000000 | |
25620 | +#define BIT25 0x02000000 | |
25621 | +#define BIT26 0x04000000 | |
25622 | +#define BIT27 0x08000000 | |
25623 | +#define BIT28 0x10000000 | |
25624 | +#define BIT29 0x20000000 | |
25625 | +#define BIT30 0x40000000 | |
25626 | +#define BIT31 0x80000000 | |
25627 | + | |
25628 | +#define MAX_SLEEP_TIME (10000) | |
25629 | +#define MIN_SLEEP_TIME (50) | |
25630 | + | |
25631 | +#define BB_ANTATTEN_CHAN14 0x0c | |
25632 | +#define BB_ANTENNA_B 0x40 | |
25633 | + | |
25634 | +#define BB_HOST_BANG (1<<30) | |
25635 | +#define BB_HOST_BANG_EN (1<<2) | |
25636 | +#define BB_HOST_BANG_CLK (1<<1) | |
25637 | +#define BB_HOST_BANG_DATA 1 | |
25638 | + | |
25639 | +#define ANAPARAM_TXDACOFF_SHIFT 27 | |
25640 | +#define ANAPARAM_PWR0_MASK ((1<<30)|(1<<29)|(1<<28)) | |
25641 | +#define ANAPARAM_PWR0_SHIFT 28 | |
25642 | +#define ANAPARAM_PWR1_MASK ((1<<26)|(1<<25)|(1<<24)|(1<<23)|(1<<22)|(1<<21)|(1<<20)) | |
25643 | +#define ANAPARAM_PWR1_SHIFT 20 | |
25644 | + | |
25645 | +#define MAC0 0 | |
25646 | +#define MAC1 1 | |
25647 | +#define MAC2 2 | |
25648 | +#define MAC3 3 | |
25649 | +#define MAC4 4 | |
25650 | +#define MAC5 5 | |
25651 | +#define CMD 0x37 | |
25652 | +#define CMD_RST_SHIFT 4 | |
25653 | +#define CMD_RESERVED_MASK ((1<<1) | (1<<5) | (1<<6) | (1<<7)) | |
25654 | +#define CMD_RX_ENABLE_SHIFT 3 | |
25655 | +#define CMD_TX_ENABLE_SHIFT 2 | |
25656 | + | |
25657 | +#define EPROM_CMD 0x50 | |
25658 | +#define EPROM_CMD_RESERVED_MASK ((1<<5)|(1<<4)) | |
25659 | +#define EPROM_CMD_OPERATING_MODE_SHIFT 6 | |
25660 | +#define EPROM_CMD_OPERATING_MODE_MASK ((1<<7)|(1<<6)) | |
25661 | +#define EPROM_CMD_CONFIG 0x3 | |
25662 | +#define EPROM_CMD_NORMAL 0 | |
25663 | +#define EPROM_CMD_LOAD 1 | |
25664 | +#define EPROM_CMD_PROGRAM 2 | |
25665 | +#define EPROM_CS_SHIFT 3 | |
25666 | +#define EPROM_CK_SHIFT 2 | |
25667 | +#define EPROM_W_SHIFT 1 | |
25668 | +#define EPROM_R_SHIFT 0 | |
25669 | +#define CONFIG2_DMA_POLLING_MODE_SHIFT 3 | |
25670 | +#define INTA 0x3e | |
25671 | +#define INTA_TXOVERFLOW (1<<15) | |
25672 | +#define INTA_TIMEOUT (1<<14) | |
25673 | +#define INTA_BEACONTIMEOUT (1<<13) | |
25674 | +#define INTA_ATIM (1<<12) | |
25675 | +#define INTA_BEACONDESCERR (1<<11) | |
25676 | +#define INTA_BEACONDESCOK (1<<10) | |
25677 | +#define INTA_HIPRIORITYDESCERR (1<<9) | |
25678 | +#define INTA_HIPRIORITYDESCOK (1<<8) | |
25679 | +#define INTA_NORMPRIORITYDESCERR (1<<7) | |
25680 | +#define INTA_NORMPRIORITYDESCOK (1<<6) | |
25681 | +#define INTA_RXOVERFLOW (1<<5) | |
25682 | +#define INTA_RXDESCERR (1<<4) | |
25683 | +#define INTA_LOWPRIORITYDESCERR (1<<3) | |
25684 | +#define INTA_LOWPRIORITYDESCOK (1<<2) | |
25685 | +#define INTA_RXCRCERR (1<<1) | |
25686 | +#define INTA_RXOK (1) | |
25687 | +#define INTA_MASK 0x3c | |
25688 | +#define RXRING_ADDR 0xe4 // page 0 | |
25689 | +#define PGSELECT 0x5e | |
25690 | +#define PGSELECT_PG_SHIFT 0 | |
25691 | +#define RX_CONF 0x44 | |
25692 | +#define MAC_FILTER_MASK ((1<<0) | (1<<1) | (1<<2) | (1<<3) | (1<<5) | \ | |
25693 | +(1<<12) | (1<<18) | (1<<19) | (1<<20) | (1<<21) | (1<<22) | (1<<23)) | |
25694 | +#define RX_CHECK_BSSID_SHIFT 23 | |
25695 | +#define ACCEPT_PWR_FRAME_SHIFT 22 | |
25696 | +#define ACCEPT_MNG_FRAME_SHIFT 20 | |
25697 | +#define ACCEPT_CTL_FRAME_SHIFT 19 | |
25698 | +#define ACCEPT_DATA_FRAME_SHIFT 18 | |
25699 | +#define ACCEPT_ICVERR_FRAME_SHIFT 12 | |
25700 | +#define ACCEPT_CRCERR_FRAME_SHIFT 5 | |
25701 | +#define ACCEPT_BCAST_FRAME_SHIFT 3 | |
25702 | +#define ACCEPT_MCAST_FRAME_SHIFT 2 | |
25703 | +#define ACCEPT_ALLMAC_FRAME_SHIFT 0 | |
25704 | +#define ACCEPT_NICMAC_FRAME_SHIFT 1 | |
25705 | +#define RX_FIFO_THRESHOLD_MASK ((1<<13) | (1<<14) | (1<<15)) | |
25706 | +#define RX_FIFO_THRESHOLD_SHIFT 13 | |
25707 | +#define RX_FIFO_THRESHOLD_128 3 | |
25708 | +#define RX_FIFO_THRESHOLD_256 4 | |
25709 | +#define RX_FIFO_THRESHOLD_512 5 | |
25710 | +#define RX_FIFO_THRESHOLD_1024 6 | |
25711 | +#define RX_FIFO_THRESHOLD_NONE 7 | |
25712 | +#define RX_AUTORESETPHY_SHIFT 28 | |
25713 | +#define EPROM_TYPE_SHIFT 6 | |
25714 | +#define TX_CONF 0x40 | |
25715 | +#define TX_CONF_HEADER_AUTOICREMENT_SHIFT 30 | |
25716 | +#define TX_LOOPBACK_SHIFT 17 | |
25717 | +#define TX_LOOPBACK_MAC 1 | |
25718 | +#define TX_LOOPBACK_BASEBAND 2 | |
25719 | +#define TX_LOOPBACK_NONE 0 | |
25720 | +#define TX_LOOPBACK_CONTINUE 3 | |
25721 | +#define TX_LOOPBACK_MASK ((1<<17)|(1<<18)) | |
25722 | +#define TX_DPRETRY_SHIFT 0 | |
25723 | +#define R8180_MAX_RETRY 255 | |
25724 | +#define TX_RTSRETRY_SHIFT 8 | |
25725 | +#define TX_NOICV_SHIFT 19 | |
25726 | +#define TX_NOCRC_SHIFT 16 | |
25727 | +#define TX_DMA_POLLING 0xd9 | |
25728 | +#define TX_DMA_POLLING_BEACON_SHIFT 7 | |
25729 | +#define TX_DMA_POLLING_HIPRIORITY_SHIFT 6 | |
25730 | +#define TX_DMA_POLLING_NORMPRIORITY_SHIFT 5 | |
25731 | +#define TX_DMA_POLLING_LOWPRIORITY_SHIFT 4 | |
25732 | +#define TX_DMA_STOP_BEACON_SHIFT 3 | |
25733 | +#define TX_DMA_STOP_HIPRIORITY_SHIFT 2 | |
25734 | +#define TX_DMA_STOP_NORMPRIORITY_SHIFT 1 | |
25735 | +#define TX_DMA_STOP_LOWPRIORITY_SHIFT 0 | |
25736 | +#define TX_MANAGEPRIORITY_RING_ADDR 0x0C | |
25737 | +#define TX_BKPRIORITY_RING_ADDR 0x10 | |
25738 | +#define TX_BEPRIORITY_RING_ADDR 0x14 | |
25739 | +#define TX_VIPRIORITY_RING_ADDR 0x20 | |
25740 | +#define TX_VOPRIORITY_RING_ADDR 0x24 | |
25741 | +#define TX_HIGHPRIORITY_RING_ADDR 0x28 | |
25742 | +//AC_VI and Low priority share the sane queue | |
25743 | +#define TX_LOWPRIORITY_RING_ADDR TX_VIPRIORITY_RING_ADDR | |
25744 | +//AC_VO and Norm priority share the same queue | |
25745 | +#define TX_NORMPRIORITY_RING_ADDR TX_VOPRIORITY_RING_ADDR | |
25746 | + | |
25747 | +#define MAX_RX_DMA_MASK ((1<<8) | (1<<9) | (1<<10)) | |
25748 | +#define MAX_RX_DMA_2048 7 | |
25749 | +#define MAX_RX_DMA_1024 6 | |
25750 | +#define MAX_RX_DMA_SHIFT 10 | |
25751 | +#define INT_TIMEOUT 0x48 | |
25752 | +#define CONFIG3_CLKRUN_SHIFT 2 | |
25753 | +#define CONFIG3_ANAPARAM_W_SHIFT 6 | |
25754 | +#define ANAPARAM 0x54 | |
25755 | +#define BEACON_INTERVAL 0x70 | |
25756 | +#define BEACON_INTERVAL_MASK ((1<<0)|(1<<1)|(1<<2)|(1<<3)|(1<<4)|(1<<5)| \ | |
25757 | +(1<<6)|(1<<7)|(1<<8)|(1<<9)) | |
25758 | +#define ATIM_MASK ((1<<0)|(1<<1)|(1<<2)|(1<<3)|(1<<4)|(1<<5)|(1<<6)|(1<<7)| \ | |
25759 | +(1<<8)|(1<<9)) | |
25760 | +#define ATIM 0x72 | |
25761 | +#define EPROM_CS_SHIFT 3 | |
25762 | +#define EPROM_CK_SHIFT 2 | |
25763 | +#define PHY_DELAY 0x78 | |
25764 | +#define PHY_CONFIG 0x80 | |
25765 | +#define PHY_ADR 0x7c | |
25766 | +#define PHY_READ 0x7e | |
25767 | +#define CARRIER_SENSE_COUNTER 0x79 //byte | |
25768 | +#define SECURITY 0x5f //1209 this is sth wrong | |
25769 | +#define SECURITY_WEP_TX_ENABLE_SHIFT 1 | |
25770 | +#define SECURITY_WEP_RX_ENABLE_SHIFT 0 | |
25771 | +#define SECURITY_ENCRYP_104 1 | |
25772 | +#define SECURITY_ENCRYP_SHIFT 4 | |
25773 | +#define SECURITY_ENCRYP_MASK ((1<<4)|(1<<5)) | |
25774 | +#define KEY0 0x90 //1209 this is sth wrong | |
25775 | +#define CONFIG2_ANTENNA_SHIFT 6 | |
25776 | +#define TX_BEACON_RING_ADDR 0x4c | |
25777 | +#define CONFIG0_WEP40_SHIFT 7 | |
25778 | +#define CONFIG0_WEP104_SHIFT 6 | |
25779 | +#define AGCRESET_SHIFT 5 | |
25780 | + | |
25781 | + | |
25782 | + | |
25783 | +/* | |
25784 | + * Operational registers offsets in PCI (I/O) space. | |
25785 | + * RealTek names are used. | |
25786 | + */ | |
25787 | + | |
25788 | +#define IDR0 0x0000 | |
25789 | +#define IDR1 0x0001 | |
25790 | +#define IDR2 0x0002 | |
25791 | +#define IDR3 0x0003 | |
25792 | +#define IDR4 0x0004 | |
25793 | +#define IDR5 0x0005 | |
25794 | + | |
25795 | +/* 0x0006 - 0x0007 - reserved */ | |
25796 | + | |
25797 | +#define MAR0 0x0008 | |
25798 | +#define MAR1 0x0009 | |
25799 | +#define MAR2 0x000A | |
25800 | +#define MAR3 0x000B | |
25801 | +#define MAR4 0x000C | |
25802 | +#define MAR5 0x000D | |
25803 | +#define MAR6 0x000E | |
25804 | +#define MAR7 0x000F | |
25805 | + | |
25806 | +/* 0x0010 - 0x0017 - reserved */ | |
25807 | + | |
25808 | +#define TSFTR 0x0018 | |
25809 | +#define TSFTR_END 0x001F | |
25810 | + | |
25811 | +#define TLPDA 0x0020 | |
25812 | +#define TLPDA_END 0x0023 | |
25813 | +#define TNPDA 0x0024 | |
25814 | +#define TNPDA_END 0x0027 | |
25815 | +#define THPDA 0x0028 | |
25816 | +#define THPDA_END 0x002B | |
25817 | + | |
25818 | +#define BSSID 0x002E | |
25819 | +#define BSSID_END 0x0033 | |
25820 | + | |
25821 | +#define CR 0x0037 | |
25822 | + | |
25823 | +#ifdef CONFIG_RTL8185B | |
25824 | +#define RF_SW_CONFIG 0x8 // store data which is transmitted to RF for driver | |
25825 | +#define RF_SW_CFG_SI BIT1 | |
25826 | +#define PIFS 0x2C // PCF InterFrame Spacing Timer Setting. | |
25827 | +#define EIFS 0x2D // Extended InterFrame Space Timer, in unit of 4 us. | |
25828 | + | |
25829 | +#define BRSR 0x34 // Basic rate set | |
25830 | + | |
25831 | +#define IMR 0x006C | |
25832 | +#define ISR 0x003C | |
25833 | +#else | |
25834 | +#define BRSR 0x002C | |
25835 | +#define BRSR_END 0x002D | |
25836 | + | |
25837 | +/* 0x0034 - 0x0034 - reserved */ | |
25838 | +#define EIFS 0x0035 | |
25839 | + | |
25840 | +#define IMR 0x003C | |
25841 | +#define IMR_END 0x003D | |
25842 | +#define ISR 0x003E | |
25843 | +#define ISR_END 0x003F | |
25844 | +#endif | |
25845 | + | |
25846 | +#define TCR 0x0040 | |
25847 | +#define TCR_END 0x0043 | |
25848 | + | |
25849 | +#define RCR 0x0044 | |
25850 | +#define RCR_END 0x0047 | |
25851 | + | |
25852 | +#define TimerInt 0x0048 | |
25853 | +#define TimerInt_END 0x004B | |
25854 | + | |
25855 | +#define TBDA 0x004C | |
25856 | +#define TBDA_END 0x004F | |
25857 | + | |
25858 | +#define CR9346 0x0050 | |
25859 | + | |
25860 | +#define CONFIG0 0x0051 | |
25861 | +#define CONFIG1 0x0052 | |
25862 | +#define CONFIG2 0x0053 | |
25863 | + | |
25864 | +#define ANA_PARM 0x0054 | |
25865 | +#define ANA_PARM_END 0x0x0057 | |
25866 | + | |
25867 | +#define MSR 0x0058 | |
25868 | + | |
25869 | +#define CONFIG3 0x0059 | |
25870 | +#define CONFIG4 0x005A | |
25871 | +#ifdef CONFIG_RTL8185B | |
25872 | +#ifdef CONFIG_RTL818X_S | |
25873 | + // SD3 szuyitasi: Mac0x57= CC -> B0 Mac0x60= D1 -> C6 | |
25874 | + // Mac0x60 = 0x000004C6 power save parameters | |
25875 | + #define ANAPARM_ASIC_ON 0xB0054D00 | |
25876 | + #define ANAPARM2_ASIC_ON 0x000004C6 | |
25877 | + | |
25878 | + #define ANAPARM_ON ANAPARM_ASIC_ON | |
25879 | + #define ANAPARM2_ON ANAPARM2_ASIC_ON | |
25880 | +#else | |
25881 | + // SD3 CMLin: | |
25882 | + #define ANAPARM_ASIC_ON 0x45090658 | |
25883 | + #define ANAPARM2_ASIC_ON 0x727f3f52 | |
25884 | + | |
25885 | + #define ANAPARM_ON ANAPARM_ASIC_ON | |
25886 | + #define ANAPARM2_ON ANAPARM2_ASIC_ON | |
25887 | +#endif | |
25888 | +#endif | |
25889 | + | |
25890 | +#define TESTR 0x005B | |
25891 | + | |
25892 | +/* 0x005C - 0x005D - reserved */ | |
25893 | + | |
25894 | +#define PSR 0x005E | |
25895 | + | |
25896 | +/* 0x0060 - 0x006F - reserved */ | |
25897 | + | |
25898 | +#define BcnItv 0x0070 | |
25899 | +#define BcnItv_END 0x0071 | |
25900 | + | |
25901 | +#define AtimWnd 0x0072 | |
25902 | +#define AtimWnd_END 0x0073 | |
25903 | + | |
25904 | +#define BintrItv 0x0074 | |
25905 | +#define BintrItv_END 0x0075 | |
25906 | + | |
25907 | +#define AtimtrItv 0x0076 | |
25908 | +#define AtimtrItv_END 0x0077 | |
25909 | + | |
25910 | +#define PhyDelay 0x0078 | |
25911 | + | |
25912 | +#define CRCount 0x0079 | |
25913 | + | |
25914 | +/* 0x007A - 0x007B - reserved */ | |
25915 | + | |
25916 | +#define PhyAddr 0x007C | |
25917 | +#define PhyDataW 0x007D | |
25918 | +#define PhyDataR 0x007E | |
25919 | + | |
25920 | +#define PhyCFG 0x0080 | |
25921 | +#define PhyCFG_END 0x0083 | |
25922 | + | |
25923 | +/* following are for rtl8185 */ | |
25924 | +#define RFPinsOutput 0x80 | |
25925 | +#define RFPinsEnable 0x82 | |
25926 | +#define RF_TIMING 0x8c | |
25927 | +#define RFPinsSelect 0x84 | |
25928 | +#define ANAPARAM2 0x60 | |
25929 | +#define RF_PARA 0x88 | |
25930 | +#define RFPinsInput 0x86 | |
25931 | +#define GP_ENABLE 0x90 | |
25932 | +#define GPIO 0x91 | |
25933 | +#define SW_CONTROL_GPIO 0x400 | |
25934 | +#define TX_ANTENNA 0x9f | |
25935 | +#define TX_GAIN_OFDM 0x9e | |
25936 | +#define TX_GAIN_CCK 0x9d | |
25937 | +#define WPA_CONFIG 0xb0 | |
25938 | +#define TX_AGC_CTL 0x9c | |
25939 | +#define TX_AGC_CTL_PERPACKET_GAIN_SHIFT 0 | |
25940 | +#define TX_AGC_CTL_PERPACKET_ANTSEL_SHIFT 1 | |
25941 | +#define TX_AGC_CTL_FEEDBACK_ANT 2 | |
25942 | +#define RESP_RATE 0x34 | |
25943 | +#define SIFS 0xb4 | |
25944 | +#define DIFS 0xb5 | |
25945 | + | |
25946 | +#define SLOT 0xb6 | |
25947 | +#define CW_CONF 0xbc | |
25948 | +#define CW_CONF_PERPACKET_RETRY_SHIFT 1 | |
25949 | +#define CW_CONF_PERPACKET_CW_SHIFT 0 | |
25950 | +#define CW_VAL 0xbd | |
25951 | +#define MAX_RESP_RATE_SHIFT 4 | |
25952 | +#define MIN_RESP_RATE_SHIFT 0 | |
25953 | +#define RATE_FALLBACK 0xbe | |
25954 | +/* | |
25955 | + * 0x0084 - 0x00D3 is selected to page 1 when PSEn bit (bit0, PSR) | |
25956 | + * is set to 1 | |
25957 | + */ | |
25958 | + | |
25959 | +#define Wakeup0 0x0084 | |
25960 | +#define Wakeup0_END 0x008B | |
25961 | + | |
25962 | +#define Wakeup1 0x008C | |
25963 | +#define Wakeup1_END 0x0093 | |
25964 | + | |
25965 | +#define Wakeup2LD 0x0094 | |
25966 | +#define Wakeup2LD_END 0x009B | |
25967 | +#define Wakeup2HD 0x009C | |
25968 | +#define Wakeup2HD_END 0x00A3 | |
25969 | + | |
25970 | +#define Wakeup3LD 0x00A4 | |
25971 | +#define Wakeup3LD_END 0x00AB | |
25972 | +#define Wakeup3HD 0x00AC | |
25973 | +#define Wakeup3HD_END 0x00B3 | |
25974 | + | |
25975 | +#define Wakeup4LD 0x00B4 | |
25976 | +#define Wakeup4LD_END 0x00BB | |
25977 | +#define Wakeup4HD 0x00BC | |
25978 | +#define Wakeup4HD_END 0x00C3 | |
25979 | + | |
25980 | +#define CRC0 0x00C4 | |
25981 | +#define CRC0_END 0x00C5 | |
25982 | +#define CRC1 0x00C6 | |
25983 | +#define CRC1_END 0x00C7 | |
25984 | +#define CRC2 0x00C8 | |
25985 | +#define CRC2_END 0x00C9 | |
25986 | +#define CRC3 0x00CA | |
25987 | +#define CRC3_END 0x00CB | |
25988 | +#define CRC4 0x00CC | |
25989 | +#define CRC4_END 0x00CD | |
25990 | + | |
25991 | +/* 0x00CE - 0x00D3 - reserved */ | |
25992 | + | |
25993 | + | |
25994 | + | |
25995 | +/* | |
25996 | + * 0x0084 - 0x00D3 is selected to page 0 when PSEn bit (bit0, PSR) | |
25997 | + * is set to 0 | |
25998 | + */ | |
25999 | + | |
26000 | +/* 0x0084 - 0x008F - reserved */ | |
26001 | + | |
26002 | +#define DK0 0x0090 | |
26003 | +#define DK0_END 0x009F | |
26004 | +#define DK1 0x00A0 | |
26005 | +#define DK1_END 0x00AF | |
26006 | +#define DK2 0x00B0 | |
26007 | +#define DK2_END 0x00BF | |
26008 | +#define DK3 0x00C0 | |
26009 | +#define DK3_END 0x00CF | |
26010 | + | |
26011 | +/* 0x00D0 - 0x00D3 - reserved */ | |
26012 | + | |
26013 | + | |
26014 | + | |
26015 | + | |
26016 | + | |
26017 | +/* 0x00D4 - 0x00D7 - reserved */ | |
26018 | + | |
26019 | +#define CONFIG5 0x00D8 | |
26020 | + | |
26021 | +#define TPPoll 0x00D9 | |
26022 | + | |
26023 | +/* 0x00DA - 0x00DB - reserved */ | |
26024 | + | |
26025 | +#ifdef CONFIG_RTL818X_S | |
26026 | +#define PHYPR 0xDA //0xDA - 0x0B PHY Parameter Register. | |
26027 | +#endif | |
26028 | + | |
26029 | +#define CWR 0x00DC | |
26030 | +#define CWR_END 0x00DD | |
26031 | + | |
26032 | +#define RetryCTR 0x00DE | |
26033 | + | |
26034 | +/* 0x00DF - 0x00E3 - reserved */ | |
26035 | + | |
26036 | +#define RDSAR 0x00E4 | |
26037 | +#define RDSAR_END 0x00E7 | |
26038 | + | |
26039 | +/* 0x00E8 - 0x00EF - reserved */ | |
26040 | +#ifdef CONFIG_RTL818X_S | |
26041 | +#define LED_CONTROL 0xED | |
26042 | +#endif | |
26043 | + | |
26044 | +#define FER 0x00F0 | |
26045 | +#define FER_END 0x00F3 | |
26046 | + | |
26047 | +#ifdef CONFIG_RTL8185B | |
26048 | +#define FEMR 0x1D4 // Function Event Mask register | |
26049 | +#else | |
26050 | +#define FEMR 0x00F4 | |
26051 | +#define FEMR_END 0x00F7 | |
26052 | +#endif | |
26053 | + | |
26054 | +#define FPSR 0x00F8 | |
26055 | +#define FPSR_END 0x00FB | |
26056 | + | |
26057 | +#define FFER 0x00FC | |
26058 | +#define FFER_END 0x00FF | |
26059 | + | |
26060 | + | |
26061 | + | |
26062 | +/* | |
26063 | + * Bitmasks for specific register functions. | |
26064 | + * Names are derived from the register name and function name. | |
26065 | + * | |
26066 | + * <REGISTER>_<FUNCTION>[<bit>] | |
26067 | + * | |
26068 | + * this leads to some awkward names... | |
26069 | + */ | |
26070 | + | |
26071 | +#define BRSR_BPLCP ((1<< 8)) | |
26072 | +#define BRSR_MBR ((1<< 1)|(1<< 0)) | |
26073 | +#define BRSR_MBR_8185 ((1<< 11)|(1<< 10)|(1<< 9)|(1<< 8)|(1<< 7)|(1<< 6)|(1<< 5)|(1<< 4)|(1<< 3)|(1<< 2)|(1<< 1)|(1<< 0)) | |
26074 | +#define BRSR_MBR0 ((1<< 0)) | |
26075 | +#define BRSR_MBR1 ((1<< 1)) | |
26076 | + | |
26077 | +#define CR_RST ((1<< 4)) | |
26078 | +#define CR_RE ((1<< 3)) | |
26079 | +#define CR_TE ((1<< 2)) | |
26080 | +#define CR_MulRW ((1<< 0)) | |
26081 | + | |
26082 | +#ifdef CONFIG_RTL8185B | |
26083 | +#define IMR_Dot11hInt ((1<< 25)) // 802.11h Measurement Interrupt | |
26084 | +#define IMR_BcnDmaInt ((1<< 24)) // Beacon DMA Interrupt // What differenct between BcnDmaInt and BcnInt??? | |
26085 | +#define IMR_WakeInt ((1<< 23)) // Wake Up Interrupt | |
26086 | +#define IMR_TXFOVW ((1<< 22)) // Tx FIFO Overflow Interrupt | |
26087 | +#define IMR_TimeOut1 ((1<< 21)) // Time Out Interrupt 1 | |
26088 | +#define IMR_BcnInt ((1<< 20)) // Beacon Time out Interrupt | |
26089 | +#define IMR_ATIMInt ((1<< 19)) // ATIM Time Out Interrupt | |
26090 | +#define IMR_TBDER ((1<< 18)) // Tx Beacon Descriptor Error Interrupt | |
26091 | +#define IMR_TBDOK ((1<< 17)) // Tx Beacon Descriptor OK Interrupt | |
26092 | +#define IMR_THPDER ((1<< 16)) // Tx High Priority Descriptor Error Interrupt | |
26093 | +#define IMR_THPDOK ((1<< 15)) // Tx High Priority Descriptor OK Interrupt | |
26094 | +#define IMR_TVODER ((1<< 14)) // Tx AC_VO Descriptor Error Interrupt | |
26095 | +#define IMR_TVODOK ((1<< 13)) // Tx AC_VO Descriptor OK Interrupt | |
26096 | +#define IMR_FOVW ((1<< 12)) // Rx FIFO Overflow Interrupt | |
26097 | +#define IMR_RDU ((1<< 11)) // Rx Descriptor Unavailable Interrupt | |
26098 | +#define IMR_TVIDER ((1<< 10)) // Tx AC_VI Descriptor Error Interrupt | |
26099 | +#define IMR_TVIDOK ((1<< 9)) // Tx AC_VI Descriptor OK Interrupt | |
26100 | +#define IMR_RER ((1<< 8)) // Rx Error Interrupt | |
26101 | +#define IMR_ROK ((1<< 7)) // Receive OK Interrupt | |
26102 | +#define IMR_TBEDER ((1<< 6)) // Tx AC_BE Descriptor Error Interrupt | |
26103 | +#define IMR_TBEDOK ((1<< 5)) // Tx AC_BE Descriptor OK Interrupt | |
26104 | +#define IMR_TBKDER ((1<< 4)) // Tx AC_BK Descriptor Error Interrupt | |
26105 | +#define IMR_TBKDOK ((1<< 3)) // Tx AC_BK Descriptor OK Interrupt | |
26106 | +#define IMR_RQoSOK ((1<< 2)) // Rx QoS OK Interrupt | |
26107 | +#define IMR_TimeOut2 ((1<< 1)) // Time Out Interrupt 2 | |
26108 | +#define IMR_TimeOut3 ((1<< 0)) // Time Out Interrupt 3 | |
26109 | +#define IMR_TMGDOK ((1<<30)) | |
26110 | +#define ISR_Dot11hInt ((1<< 25)) // 802.11h Measurement Interrupt | |
26111 | +#define ISR_BcnDmaInt ((1<< 24)) // Beacon DMA Interrupt // What differenct between BcnDmaInt and BcnInt??? | |
26112 | +#define ISR_WakeInt ((1<< 23)) // Wake Up Interrupt | |
26113 | +#define ISR_TXFOVW ((1<< 22)) // Tx FIFO Overflow Interrupt | |
26114 | +#define ISR_TimeOut1 ((1<< 21)) // Time Out Interrupt 1 | |
26115 | +#define ISR_BcnInt ((1<< 20)) // Beacon Time out Interrupt | |
26116 | +#define ISR_ATIMInt ((1<< 19)) // ATIM Time Out Interrupt | |
26117 | +#define ISR_TBDER ((1<< 18)) // Tx Beacon Descriptor Error Interrupt | |
26118 | +#define ISR_TBDOK ((1<< 17)) // Tx Beacon Descriptor OK Interrupt | |
26119 | +#define ISR_THPDER ((1<< 16)) // Tx High Priority Descriptor Error Interrupt | |
26120 | +#define ISR_THPDOK ((1<< 15)) // Tx High Priority Descriptor OK Interrupt | |
26121 | +#define ISR_TVODER ((1<< 14)) // Tx AC_VO Descriptor Error Interrupt | |
26122 | +#define ISR_TVODOK ((1<< 13)) // Tx AC_VO Descriptor OK Interrupt | |
26123 | +#define ISR_FOVW ((1<< 12)) // Rx FIFO Overflow Interrupt | |
26124 | +#define ISR_RDU ((1<< 11)) // Rx Descriptor Unavailable Interrupt | |
26125 | +#define ISR_TVIDER ((1<< 10)) // Tx AC_VI Descriptor Error Interrupt | |
26126 | +#define ISR_TVIDOK ((1<< 9)) // Tx AC_VI Descriptor OK Interrupt | |
26127 | +#define ISR_RER ((1<< 8)) // Rx Error Interrupt | |
26128 | +#define ISR_ROK ((1<< 7)) // Receive OK Interrupt | |
26129 | +#define ISR_TBEDER ((1<< 6)) // Tx AC_BE Descriptor Error Interrupt | |
26130 | +#define ISR_TBEDOK ((1<< 5)) // Tx AC_BE Descriptor OK Interrupt | |
26131 | +#define ISR_TBKDER ((1<< 4)) // Tx AC_BK Descriptor Error Interrupt | |
26132 | +#define ISR_TBKDOK ((1<< 3)) // Tx AC_BK Descriptor OK Interrupt | |
26133 | +#define ISR_RQoSOK ((1<< 2)) // Rx QoS OK Interrupt | |
26134 | +#define ISR_TimeOut2 ((1<< 1)) // Time Out Interrupt 2 | |
26135 | +#define ISR_TimeOut3 ((1<< 0)) // Time Out Interrupt 3 | |
26136 | + | |
26137 | +//these definition is used for Tx/Rx test temporarily | |
26138 | +#define ISR_TLPDER ISR_TVIDER | |
26139 | +#define ISR_TLPDOK ISR_TVIDOK | |
26140 | +#define ISR_TNPDER ISR_TVODER | |
26141 | +#define ISR_TNPDOK ISR_TVODOK | |
26142 | +#define ISR_TimeOut ISR_TimeOut1 | |
26143 | +#define ISR_RXFOVW ISR_FOVW | |
26144 | + | |
26145 | +#else | |
26146 | +#define IMR_TXFOVW ((1<<15)) | |
26147 | +#define IMR_TimeOut ((1<<14)) | |
26148 | +#define IMR_BcnInt ((1<<13)) | |
26149 | +#define IMR_ATIMInt ((1<<12)) | |
26150 | +#define IMR_TBDER ((1<<11)) | |
26151 | +#define IMR_TBDOK ((1<<10)) | |
26152 | +#define IMR_THPDER ((1<< 9)) | |
26153 | +#define IMR_THPDOK ((1<< 8)) | |
26154 | +#define IMR_TNPDER ((1<< 7)) | |
26155 | +#define IMR_TNPDOK ((1<< 6)) | |
26156 | +#define IMR_RXFOVW ((1<< 5)) | |
26157 | +#define IMR_RDU ((1<< 4)) | |
26158 | +#define IMR_TLPDER ((1<< 3)) | |
26159 | +#define IMR_TLPDOK ((1<< 2)) | |
26160 | +#define IMR_RER ((1<< 1)) | |
26161 | +#define IMR_ROK ((1<< 0)) | |
26162 | + | |
26163 | +#define ISR_TXFOVW ((1<<15)) | |
26164 | +#define ISR_TimeOut ((1<<14)) | |
26165 | +#define ISR_BcnInt ((1<<13)) | |
26166 | +#define ISR_ATIMInt ((1<<12)) | |
26167 | +#define ISR_TBDER ((1<<11)) | |
26168 | +#define ISR_TBDOK ((1<<10)) | |
26169 | +#define ISR_THPDER ((1<< 9)) | |
26170 | +#define ISR_THPDOK ((1<< 8)) | |
26171 | +#define ISR_TNPDER ((1<< 7)) | |
26172 | +#define ISR_TNPDOK ((1<< 6)) | |
26173 | +#define ISR_RXFOVW ((1<< 5)) | |
26174 | +#define ISR_RDU ((1<< 4)) | |
26175 | +#define ISR_TLPDER ((1<< 3)) | |
26176 | +#define ISR_TLPDOK ((1<< 2)) | |
26177 | +#define ISR_RER ((1<< 1)) | |
26178 | +#define ISR_ROK ((1<< 0)) | |
26179 | +#endif | |
26180 | + | |
26181 | +#define HW_VERID_R8180_F 3 | |
26182 | +#define HW_VERID_R8180_ABCD 2 | |
26183 | +#define HW_VERID_R8185_ABC 4 | |
26184 | +#define HW_VERID_R8185_D 5 | |
26185 | +#ifdef CONFIG_RTL8185B | |
26186 | +#define HW_VERID_R8185B_B 6 | |
26187 | +#endif | |
26188 | + | |
26189 | +#define TCR_CWMIN ((1<<31)) | |
26190 | +#define TCR_SWSEQ ((1<<30)) | |
26191 | +#define TCR_HWVERID_MASK ((1<<27)|(1<<26)|(1<<25)) | |
26192 | +#define TCR_HWVERID_SHIFT 25 | |
26193 | +#define TCR_SAT ((1<<24)) | |
26194 | +#define TCR_PLCP_LEN TCR_SAT // rtl8180 | |
26195 | +#define TCR_MXDMA_MASK ((1<<23)|(1<<22)|(1<<21)) | |
26196 | +#define TCR_MXDMA_1024 6 | |
26197 | +#define TCR_MXDMA_2048 7 | |
26198 | +#define TCR_MXDMA_SHIFT 21 | |
26199 | +#define TCR_DISCW ((1<<20)) | |
26200 | +#define TCR_ICV ((1<<19)) | |
26201 | +#define TCR_LBK ((1<<18)|(1<<17)) | |
26202 | +#define TCR_LBK1 ((1<<18)) | |
26203 | +#define TCR_LBK0 ((1<<17)) | |
26204 | +#define TCR_CRC ((1<<16)) | |
26205 | +#define TCR_DPRETRY_MASK ((1<<15)|(1<<14)|(1<<13)|(1<<12)|(1<<11)|(1<<10)|(1<<9)|(1<<8)) | |
26206 | +#define TCR_RTSRETRY_MASK ((1<<0)|(1<<1)|(1<<2)|(1<<3)|(1<<4)|(1<<5)|(1<<6)|(1<<7)) | |
26207 | +#define TCR_PROBE_NOTIMESTAMP_SHIFT 29 //rtl8185 | |
26208 | + | |
26209 | +#define RCR_ONLYERLPKT ((1<<31)) | |
26210 | +#define RCR_CS_SHIFT 29 | |
26211 | +#define RCR_CS_MASK ((1<<30) | (1<<29)) | |
26212 | +#define RCR_ENMARP ((1<<28)) | |
26213 | +#define RCR_CBSSID ((1<<23)) | |
26214 | +#define RCR_APWRMGT ((1<<22)) | |
26215 | +#define RCR_ADD3 ((1<<21)) | |
26216 | +#define RCR_AMF ((1<<20)) | |
26217 | +#define RCR_ACF ((1<<19)) | |
26218 | +#define RCR_ADF ((1<<18)) | |
26219 | +#define RCR_RXFTH ((1<<15)|(1<<14)|(1<<13)) | |
26220 | +#define RCR_RXFTH2 ((1<<15)) | |
26221 | +#define RCR_RXFTH1 ((1<<14)) | |
26222 | +#define RCR_RXFTH0 ((1<<13)) | |
26223 | +#define RCR_AICV ((1<<12)) | |
26224 | +#define RCR_MXDMA ((1<<10)|(1<< 9)|(1<< 8)) | |
26225 | +#define RCR_MXDMA2 ((1<<10)) | |
26226 | +#define RCR_MXDMA1 ((1<< 9)) | |
26227 | +#define RCR_MXDMA0 ((1<< 8)) | |
26228 | +#define RCR_9356SEL ((1<< 6)) | |
26229 | +#define RCR_ACRC32 ((1<< 5)) | |
26230 | +#define RCR_AB ((1<< 3)) | |
26231 | +#define RCR_AM ((1<< 2)) | |
26232 | +#define RCR_APM ((1<< 1)) | |
26233 | +#define RCR_AAP ((1<< 0)) | |
26234 | + | |
26235 | +#define CR9346_EEM ((1<<7)|(1<<6)) | |
26236 | +#define CR9346_EEM1 ((1<<7)) | |
26237 | +#define CR9346_EEM0 ((1<<6)) | |
26238 | +#define CR9346_EECS ((1<<3)) | |
26239 | +#define CR9346_EESK ((1<<2)) | |
26240 | +#define CR9346_EED1 ((1<<1)) | |
26241 | +#define CR9346_EED0 ((1<<0)) | |
26242 | + | |
26243 | +#define CONFIG0_WEP104 ((1<<6)) | |
26244 | +#define CONFIG0_LEDGPO_En ((1<<4)) | |
26245 | +#define CONFIG0_Aux_Status ((1<<3)) | |
26246 | +#define CONFIG0_GL ((1<<1)|(1<<0)) | |
26247 | +#define CONFIG0_GL1 ((1<<1)) | |
26248 | +#define CONFIG0_GL0 ((1<<0)) | |
26249 | + | |
26250 | +#define CONFIG1_LEDS ((1<<7)|(1<<6)) | |
26251 | +#define CONFIG1_LEDS1 ((1<<7)) | |
26252 | +#define CONFIG1_LEDS0 ((1<<6)) | |
26253 | +#define CONFIG1_LWACT ((1<<4)) | |
26254 | +#define CONFIG1_MEMMAP ((1<<3)) | |
26255 | +#define CONFIG1_IOMAP ((1<<2)) | |
26256 | +#define CONFIG1_VPD ((1<<1)) | |
26257 | +#define CONFIG1_PMEn ((1<<0)) | |
26258 | + | |
26259 | +#define CONFIG2_LCK ((1<<7)) | |
26260 | +#define CONFIG2_ANT ((1<<6)) | |
26261 | +#define CONFIG2_DPS ((1<<3)) | |
26262 | +#define CONFIG2_PAPE_sign ((1<<2)) | |
26263 | +#define CONFIG2_PAPE_time ((1<<1)|(1<<0)) | |
26264 | +#define CONFIG2_PAPE_time1 ((1<<1)) | |
26265 | +#define CONFIG2_PAPE_time0 ((1<<0)) | |
26266 | + | |
26267 | +#define CONFIG3_GNTSel ((1<<7)) | |
26268 | +#define CONFIG3_PARM_En ((1<<6)) | |
26269 | +#define CONFIG3_Magic ((1<<5)) | |
26270 | +#define CONFIG3_CardB_En ((1<<3)) | |
26271 | +#define CONFIG3_CLKRUN_En ((1<<2)) | |
26272 | +#define CONFIG3_FuncRegEn ((1<<1)) | |
26273 | +#define CONFIG3_FBtbEn ((1<<0)) | |
26274 | + | |
26275 | +#define CONFIG4_VCOPDN ((1<<7)) | |
26276 | +#define CONFIG4_PWROFF ((1<<6)) | |
26277 | +#define CONFIG4_PWRMGT ((1<<5)) | |
26278 | +#define CONFIG4_LWPME ((1<<4)) | |
26279 | +#define CONFIG4_LWPTN ((1<<2)) | |
26280 | +#define CONFIG4_RFTYPE ((1<<1)|(1<<0)) | |
26281 | +#define CONFIG4_RFTYPE1 ((1<<1)) | |
26282 | +#define CONFIG4_RFTYPE0 ((1<<0)) | |
26283 | + | |
26284 | +#define CONFIG5_TX_FIFO_OK ((1<<7)) | |
26285 | +#define CONFIG5_RX_FIFO_OK ((1<<6)) | |
26286 | +#define CONFIG5_CALON ((1<<5)) | |
26287 | +#define CONFIG5_EACPI ((1<<2)) | |
26288 | +#define CONFIG5_LANWake ((1<<1)) | |
26289 | +#define CONFIG5_PME_STS ((1<<0)) | |
26290 | + | |
26291 | +#define MSR_LINK_MASK ((1<<2)|(1<<3)) | |
26292 | +#define MSR_LINK_MANAGED 2 | |
26293 | +#define MSR_LINK_NONE 0 | |
26294 | +#define MSR_LINK_SHIFT 2 | |
26295 | +#define MSR_LINK_ADHOC 1 | |
26296 | +#define MSR_LINK_MASTER 3 | |
26297 | + | |
26298 | +#define PSR_GPO ((1<<7)) | |
26299 | +#define PSR_GPI ((1<<6)) | |
26300 | +#define PSR_LEDGPO1 ((1<<5)) | |
26301 | +#define PSR_LEDGPO0 ((1<<4)) | |
26302 | +#define PSR_UWF ((1<<1)) | |
26303 | +#define PSR_PSEn ((1<<0)) | |
26304 | + | |
26305 | +#define SCR_KM ((1<<5)|(1<<4)) | |
26306 | +#define SCR_KM1 ((1<<5)) | |
26307 | +#define SCR_KM0 ((1<<4)) | |
26308 | +#define SCR_TXSECON ((1<<1)) | |
26309 | +#define SCR_RXSECON ((1<<0)) | |
26310 | + | |
26311 | +#define BcnItv_BcnItv (0x01FF) | |
26312 | + | |
26313 | +#define AtimWnd_AtimWnd (0x01FF) | |
26314 | + | |
26315 | +#define BintrItv_BintrItv (0x01FF) | |
26316 | + | |
26317 | +#define AtimtrItv_AtimtrItv (0x01FF) | |
26318 | + | |
26319 | +#define PhyDelay_PhyDelay ((1<<2)|(1<<1)|(1<<0)) | |
26320 | + | |
26321 | +#define TPPoll_BQ ((1<<7)) | |
26322 | +#define TPPoll_HPQ ((1<<6)) | |
26323 | +#define TPPoll_NPQ ((1<<5)) | |
26324 | +#define TPPoll_LPQ ((1<<4)) | |
26325 | +#define TPPoll_SBQ ((1<<3)) | |
26326 | +#define TPPoll_SHPQ ((1<<2)) | |
26327 | +#define TPPoll_SNPQ ((1<<1)) | |
26328 | +#define TPPoll_SLPQ ((1<<0)) | |
26329 | + | |
26330 | +#define CWR_CW (0x01FF) | |
26331 | + | |
26332 | +#define FER_INTR ((1<<15)) | |
26333 | +#define FER_GWAKE ((1<< 4)) | |
26334 | + | |
26335 | +#define FEMR_INTR ((1<<15)) | |
26336 | +#define FEMR_WKUP ((1<<14)) | |
26337 | +#define FEMR_GWAKE ((1<< 4)) | |
26338 | + | |
26339 | +#define FPSR_INTR ((1<<15)) | |
26340 | +#define FPSR_GWAKE ((1<< 4)) | |
26341 | + | |
26342 | +#define FFER_INTR ((1<<15)) | |
26343 | +#define FFER_GWAKE ((1<< 4)) | |
26344 | + | |
26345 | +#ifdef CONFIG_RTL8185B | |
26346 | +// Three wire mode. | |
26347 | +#define SW_THREE_WIRE 0 | |
26348 | +#define HW_THREE_WIRE 2 | |
26349 | +//RTL8187S by amy | |
26350 | +#define HW_THREE_WIRE_PI 5 | |
26351 | +#define HW_THREE_WIRE_SI 6 | |
26352 | +//by amy | |
26353 | +#define TCR_LRL_OFFSET 0 | |
26354 | +#define TCR_SRL_OFFSET 8 | |
26355 | +#define TCR_MXDMA_OFFSET 21 | |
26356 | +#define TCR_DISReqQsize_OFFSET 28 | |
26357 | +#define TCR_DurProcMode_OFFSET 30 | |
26358 | + | |
26359 | +#define RCR_MXDMA_OFFSET 8 | |
26360 | +#define RCR_FIFO_OFFSET 13 | |
26361 | + | |
26362 | +#define TMGDS 0x0C // Tx Management Descriptor Address | |
26363 | +#define TBKDS 0x10 // Tx AC_BK Descriptor Address | |
26364 | +#define TBEDS 0x14 // Tx AC_BE Descriptor Address | |
26365 | +#define TLPDS 0x20 // Tx AC_VI Descriptor Address | |
26366 | +#define TNPDS 0x24 // Tx AC_VO Descriptor Address | |
26367 | +#define THPDS 0x28 // Tx Hign Priority Descriptor Address | |
26368 | + | |
26369 | +#define TBDS 0x4c // Beacon descriptor queue start address | |
26370 | + | |
26371 | +#define RDSA 0xE4 // Receive descriptor queue start address | |
26372 | + | |
26373 | +#define AckTimeOutReg 0x79 // ACK timeout register, in unit of 4 us. | |
26374 | + | |
26375 | +#define RFTiming 0x8C | |
26376 | + | |
26377 | +#define TPPollStop 0x93 | |
26378 | + | |
26379 | +#define TXAGC_CTL 0x9C // <RJ_TODO_8185B> TX_AGC_CONTROL (0x9C seems be removed at 8185B, see p37). | |
26380 | +#define CCK_TXAGC 0x9D | |
26381 | +#define OFDM_TXAGC 0x9E | |
26382 | +#define ANTSEL 0x9F | |
26383 | + | |
26384 | +#define ACM_CONTROL 0x00BF // ACM Control Registe | |
26385 | + | |
26386 | +#define RTL8185B_VER_REG 0xE1 | |
26387 | + | |
26388 | +#define IntMig 0xE2 // Interrupt Migration (0xE2 ~ 0xE3) | |
26389 | + | |
26390 | +#define TID_AC_MAP 0xE8 // TID to AC Mapping Register | |
26391 | + | |
26392 | +#define ANAPARAM3 0xEE // <RJ_TODO_8185B> How to use it? | |
26393 | + | |
26394 | +#define AC_VO_PARAM 0xF0 // AC_VO Parameters Record | |
26395 | +#define AC_VI_PARAM 0xF4 // AC_VI Parameters Record | |
26396 | +#define AC_BE_PARAM 0xF8 // AC_BE Parameters Record | |
26397 | +#define AC_BK_PARAM 0xFC // AC_BK Parameters Record | |
26398 | + | |
26399 | +#ifdef CONFIG_RTL818X_S | |
26400 | +#define BcnTimingAdjust 0x16A // Beacon Timing Adjust Register. | |
26401 | +#define GPIOCtrl 0x16B // GPIO Control Register. | |
26402 | +#define PSByGC 0x180 // 0x180 - 0x183 Power Saving by Gated Clock. | |
26403 | +#endif | |
26404 | +#define ARFR 0x1E0 // Auto Rate Fallback Register (0x1e0 ~ 0x1e2) | |
26405 | + | |
26406 | +#define RFSW_CTRL 0x272 // 0x272-0x273. | |
26407 | +#define SW_3W_DB0 0x274 // Software 3-wire data buffer bit 31~0. | |
26408 | +#define SW_3W_DB1 0x278 // Software 3-wire data buffer bit 63~32. | |
26409 | +#define SW_3W_CMD0 0x27C // Software 3-wire Control/Status Register. | |
26410 | +#define SW_3W_CMD1 0x27D // Software 3-wire Control/Status Register. | |
26411 | + | |
26412 | +#ifdef CONFIG_RTL818X_S | |
26413 | +#define PI_DATA_READ 0X360 // 0x360 - 0x361 Parallel Interface Data Register. | |
26414 | +#define SI_DATA_READ 0x362 // 0x362 - 0x363 Serial Interface Data Register. | |
26415 | +#endif | |
26416 | + | |
26417 | +//---------------------------------------------------------------------------- | |
26418 | +// 8185B TPPoll bits (offset 0xd9, 1 byte) | |
26419 | +//---------------------------------------------------------------------------- | |
26420 | +#define TPPOLL_BQ (0x01 << 7) | |
26421 | +#define TPPOLL_HPQ (0x01 << 6) | |
26422 | +#define TPPOLL_AC_VOQ (0x01 << 5) | |
26423 | +#define TPPOLL_AC_VIQ (0x01 << 4) | |
26424 | +#define TPPOLL_AC_BEQ (0x01 << 3) | |
26425 | +#define TPPOLL_AC_BKQ (0x01 << 2) | |
26426 | +#define TPPOLL_AC_MGQ (0x01 << 1) | |
26427 | + | |
26428 | +//---------------------------------------------------------------------------- | |
26429 | +// 8185B TPPollStop bits (offset 0x93, 1 byte) | |
26430 | +//---------------------------------------------------------------------------- | |
26431 | +#define TPPOLLSTOP_BQ (0x01 << 7) | |
26432 | +#define TPPOLLSTOP_HPQ (0x01 << 6) | |
26433 | +#define TPPOLLSTOP_AC_VOQ (0x01 << 5) | |
26434 | +#define TPPOLLSTOP_AC_VIQ (0x01 << 4) | |
26435 | +#define TPPOLLSTOP_AC_BEQ (0x01 << 3) | |
26436 | +#define TPPOLLSTOP_AC_BKQ (0x01 << 2) | |
26437 | +#define TPPOLLSTOP_AC_MGQ (0x01 << 1) | |
26438 | + | |
26439 | + | |
26440 | +#define MSR_LINK_ENEDCA (1<<4) | |
26441 | + | |
26442 | +//---------------------------------------------------------------------------- | |
26443 | +// 8187B AC_XX_PARAM bits | |
26444 | +//---------------------------------------------------------------------------- | |
26445 | +#define AC_PARAM_TXOP_LIMIT_OFFSET 16 | |
26446 | +#define AC_PARAM_ECW_MAX_OFFSET 12 | |
26447 | +#define AC_PARAM_ECW_MIN_OFFSET 8 | |
26448 | +#define AC_PARAM_AIFS_OFFSET 0 | |
26449 | + | |
26450 | +//---------------------------------------------------------------------------- | |
26451 | +// 8187B ACM_CONTROL bits (Offset 0xBF, 1 Byte) | |
26452 | +//---------------------------------------------------------------------------- | |
26453 | +#define VOQ_ACM_EN (0x01 << 7) //BIT7 | |
26454 | +#define VIQ_ACM_EN (0x01 << 6) //BIT6 | |
26455 | +#define BEQ_ACM_EN (0x01 << 5) //BIT5 | |
26456 | +#define ACM_HW_EN (0x01 << 4) //BIT4 | |
26457 | +#define TXOPSEL (0x01 << 3) //BIT3 | |
26458 | +#define VOQ_ACM_CTL (0x01 << 2) //BIT2 // Set to 1 when AC_VO used time reaches or exceeds the admitted time | |
26459 | +#define VIQ_ACM_CTL (0x01 << 1) //BIT1 // Set to 1 when AC_VI used time reaches or exceeds the admitted time | |
26460 | +#define BEQ_ACM_CTL (0x01 << 0) //BIT0 // Set to 1 when AC_BE used time reaches or exceeds the admitted time | |
26461 | + | |
26462 | + | |
26463 | +//---------------------------------------------------------------------------- | |
26464 | +// 8185B SW_3W_CMD bits (Offset 0x27C-0x27D, 16bit) | |
26465 | +//---------------------------------------------------------------------------- | |
26466 | +#define SW_3W_CMD0_HOLD ((1<< 7)) | |
26467 | +#define SW_3W_CMD1_RE ((1<< 0)) // BIT8 | |
26468 | +#define SW_3W_CMD1_WE ((1<< 1)) // BIT9 | |
26469 | +#define SW_3W_CMD1_DONE ((1<< 2)) // BIT10 | |
26470 | + | |
26471 | +#define BB_HOST_BANG_RW (1<<3) | |
26472 | + | |
26473 | +//---------------------------------------------------------------------------- | |
26474 | +// 8185B RATE_FALLBACK_CTL bits (Offset 0xBE, 8bit) | |
26475 | +//---------------------------------------------------------------------------- | |
26476 | +#define RATE_FALLBACK_CTL_ENABLE ((1<< 7)) | |
26477 | +#define RATE_FALLBACK_CTL_ENABLE_RTSCTS ((1<< 6)) | |
26478 | +// Auto rate fallback per 2^n retry. | |
26479 | +#define RATE_FALLBACK_CTL_AUTO_STEP0 0x00 | |
26480 | +#define RATE_FALLBACK_CTL_AUTO_STEP1 0x01 | |
26481 | +#define RATE_FALLBACK_CTL_AUTO_STEP2 0x02 | |
26482 | +#define RATE_FALLBACK_CTL_AUTO_STEP3 0x03 | |
26483 | + | |
26484 | + | |
26485 | +#define RTL8225z2_ANAPARAM_OFF 0x55480658 | |
26486 | +#define RTL8225z2_ANAPARAM2_OFF 0x72003f70 | |
26487 | +//by amy for power save | |
26488 | +#define RF_CHANGE_BY_SW BIT31 | |
26489 | +#define RF_CHANGE_BY_HW BIT30 | |
26490 | +#define RF_CHANGE_BY_PS BIT29 | |
26491 | +#define RF_CHANGE_BY_IPS BIT28 | |
26492 | +//by amy for power save | |
26493 | +//by amy for antenna | |
26494 | +#define EEPROM_SW_REVD_OFFSET 0x3f | |
26495 | +// BIT[8-9] is for SW Antenna Diversity. Only the value EEPROM_SW_AD_ENABLE means enable, other values are diable. | |
26496 | +#define EEPROM_SW_AD_MASK 0x0300 | |
26497 | +#define EEPROM_SW_AD_ENABLE 0x0100 | |
26498 | + | |
26499 | +// BIT[10-11] determine if Antenna 1 is the Default Antenna. Only the value EEPROM_DEF_ANT_1 means TRUE, other values are FALSE. | |
26500 | +#define EEPROM_DEF_ANT_MASK 0x0C00 | |
26501 | +#define EEPROM_DEF_ANT_1 0x0400 | |
26502 | +//by amy for antenna | |
26503 | +//{by amy 080312 | |
26504 | +//0x7C, 0x7D Crystal calibration and Tx Power tracking mechanism. Added by Roger. 2007.12.10. | |
26505 | +#define EEPROM_RSV 0x7C | |
26506 | +#define EEPROM_XTAL_CAL_MASK 0x00FF // 0x7C[7:0], Crystal calibration mask. | |
26507 | +#define EEPROM_XTAL_CAL_XOUT_MASK 0x0F // 0x7C[3:0], Crystal calibration for Xout. | |
26508 | +#define EEPROM_XTAL_CAL_XIN_MASK 0xF0 // 0x7C[7:4], Crystal calibration for Xin. | |
26509 | +#define EEPROM_THERMAL_METER_MASK 0x0F00 // 0x7D[3:0], Thermal meter reference level. | |
26510 | +#define EEPROM_XTAL_CAL_ENABLE 0x1000 // 0x7D[4], Crystal calibration enabled/disabled BIT. | |
26511 | +#define EEPROM_THERMAL_METER_ENABLE 0x2000 // 0x7D[5], Thermal meter enabled/disabled BIT. | |
26512 | +#define EEPROM_CID_RSVD1 0x3F | |
26513 | +#define EN_LPF_CAL 0x238 // Enable LPF Calibration. | |
26514 | +#define PWR_METER_EN BIT1 | |
26515 | +// <RJ_TODO_8185B> where are false alarm counters in 8185B? | |
26516 | +#define CCK_FALSE_ALARM 0xD0 | |
26517 | +#define OFDM_FALSE_ALARM 0xD2 | |
26518 | +//by amy 080312} | |
26519 | + | |
26520 | +//YJ,add for Country IE, 080630 | |
26521 | +#define EEPROM_COUNTRY_CODE 0x2E | |
26522 | +//YJ,add,080630,end | |
26523 | +#endif | |
26524 | + | |
26525 | +#endif | |
26526 | --- /dev/null | |
26527 | +++ b/drivers/staging/rtl8187se/r8180_max2820.c | |
26528 | @@ -0,0 +1,240 @@ | |
26529 | +/* | |
26530 | + This files contains MAXIM MAX2820 radio frontend programming routines. | |
26531 | + | |
26532 | + This is part of rtl8180 OpenSource driver | |
26533 | + Copyright (C) Andrea Merello 2004-2005 <andreamrl@tiscali.it> | |
26534 | + Released under the terms of GPL (General Public Licence) | |
26535 | + | |
26536 | + Parts of this driver are based on the GPL part of the | |
26537 | + official realtek driver | |
26538 | + | |
26539 | + Parts of this driver are based on the rtl8180 driver skeleton | |
26540 | + from Patric Schenke & Andres Salomon | |
26541 | + | |
26542 | + Parts of this driver are based on the Intel Pro Wireless 2100 GPL driver. | |
26543 | + | |
26544 | + NetBSD rtl8180 driver from Dave Young has been really useful to | |
26545 | + understand how to program the MAXIM radio. Thanks a lot!!! | |
26546 | + | |
26547 | + 'The Deuce' tested this and fixed some bugs. | |
26548 | + | |
26549 | + Code from rtl8181 project has been useful to me to understand some things. | |
26550 | + | |
26551 | + We want to tanks the Authors of such projects and the Ndiswrapper | |
26552 | + project Authors. | |
26553 | +*/ | |
26554 | + | |
26555 | + | |
26556 | +#include "r8180.h" | |
26557 | +#include "r8180_hw.h" | |
26558 | +#include "r8180_max2820.h" | |
26559 | + | |
26560 | + | |
26561 | +//#define DEBUG_MAXIM | |
26562 | + | |
26563 | +u32 maxim_chan[] = { | |
26564 | + 0, //dummy channel 0 | |
26565 | + 12, //1 | |
26566 | + 17, //2 | |
26567 | + 22, //3 | |
26568 | + 27, //4 | |
26569 | + 32, //5 | |
26570 | + 37, //6 | |
26571 | + 42, //7 | |
26572 | + 47, //8 | |
26573 | + 52, //9 | |
26574 | + 57, //10 | |
26575 | + 62, //11 | |
26576 | + 67, //12 | |
26577 | + 72, //13 | |
26578 | + 84, //14 | |
26579 | +}; | |
26580 | + | |
26581 | +#if 0 | |
26582 | +/* maxim expects 4 bit address MSF, then 12 bit data MSF*/ | |
26583 | +void write_maxim(struct net_device *dev,u8 adr, u32 data) | |
26584 | +{ | |
26585 | + | |
26586 | + int shift; | |
26587 | + short bit; | |
26588 | + u16 word; | |
26589 | + | |
26590 | + adr = adr &0xf; | |
26591 | + word = (u16)data & 0xfff; | |
26592 | + word |= (adr<<12); | |
26593 | + /*write_nic_dword(dev,PHY_CONFIG,BB_HOST_BANG | BB_HOST_BANG_EN); | |
26594 | + read_nic_dword(dev,PHY_CONFIG); | |
26595 | + mdelay(1); | |
26596 | + | |
26597 | + write_nic_dword(dev,PHY_CONFIG,BB_HOST_BANG | BB_HOST_BANG_EN | BB_HOST_BANG_CLK); | |
26598 | + read_nic_dword(dev,PHY_CONFIG); | |
26599 | + mdelay(1); | |
26600 | + */ | |
26601 | + | |
26602 | + /* MAX2820 will sample data on rising edge of clock */ | |
26603 | + for(shift = 15;shift >=0; shift--){ | |
26604 | + bit = word>>shift & 1; | |
26605 | + | |
26606 | + write_nic_dword(dev,PHY_CONFIG,BB_HOST_BANG | (bit<<BB_HOST_BANG_DATA)); | |
26607 | + | |
26608 | + read_nic_dword(dev,PHY_CONFIG); | |
26609 | + mdelay(2); | |
26610 | + | |
26611 | + write_nic_dword(dev,PHY_CONFIG,BB_HOST_BANG | | |
26612 | + (bit<<BB_HOST_BANG_DATA) | BB_HOST_BANG_CLK); /* sample data */ | |
26613 | + | |
26614 | + read_nic_dword(dev,PHY_CONFIG); | |
26615 | + mdelay(1); | |
26616 | + | |
26617 | + write_nic_dword(dev,PHY_CONFIG,BB_HOST_BANG | | |
26618 | + (bit<<BB_HOST_BANG_DATA)); | |
26619 | + | |
26620 | + read_nic_dword(dev,PHY_CONFIG); | |
26621 | + mdelay(2); | |
26622 | + | |
26623 | + } | |
26624 | + write_nic_dword(dev,PHY_CONFIG,BB_HOST_BANG | (bit<<BB_HOST_BANG_DATA)| | |
26625 | + BB_HOST_BANG_EN); | |
26626 | + read_nic_dword(dev,PHY_CONFIG); | |
26627 | + mdelay(2); | |
26628 | + | |
26629 | + /* The shift register fill flush to the requested register the | |
26630 | + * last 12 bits data shifted in | |
26631 | + */ | |
26632 | + write_nic_dword(dev,PHY_CONFIG,BB_HOST_BANG | (bit<<BB_HOST_BANG_DATA)| | |
26633 | + BB_HOST_BANG_EN | BB_HOST_BANG_CLK); | |
26634 | + read_nic_dword(dev,PHY_CONFIG); | |
26635 | + mdelay(2); | |
26636 | + | |
26637 | + write_nic_dword(dev,PHY_CONFIG,BB_HOST_BANG | (bit<<BB_HOST_BANG_DATA)| | |
26638 | + BB_HOST_BANG_EN); | |
26639 | + read_nic_dword(dev,PHY_CONFIG); | |
26640 | + mdelay(2); | |
26641 | + | |
26642 | + | |
26643 | +#ifdef DEBUG_MAXIM | |
26644 | + DMESG("Writing maxim: %x (adr %x)",phy_config,adr); | |
26645 | +#endif | |
26646 | + | |
26647 | +} | |
26648 | +#endif | |
26649 | + | |
26650 | +void write_maxim(struct net_device *dev,u8 adr, u32 data) { | |
26651 | + u32 temp; | |
26652 | + temp = 0x90 + (data & 0xf); | |
26653 | + temp <<= 16; | |
26654 | + temp += adr; | |
26655 | + temp <<= 8; | |
26656 | + temp += (data >> 4) & 0xff; | |
26657 | +#ifdef DEBUG_MAXIM | |
26658 | + DMESG("write_maxim: %08x", temp); | |
26659 | +#endif | |
26660 | + write_nic_dword(dev, PHY_CONFIG, temp); | |
26661 | + force_pci_posting(dev); | |
26662 | + mdelay(1); | |
26663 | +} | |
26664 | + | |
26665 | + | |
26666 | +void maxim_write_phy_antenna(struct net_device *dev,short ch) | |
26667 | +{ | |
26668 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
26669 | + u8 ant; | |
26670 | + | |
26671 | + ant = MAXIM_ANTENNA; | |
26672 | + if(priv->antb) /*default antenna is antenna B */ | |
26673 | + ant |= BB_ANTENNA_B; | |
26674 | + if(ch == 14) | |
26675 | + ant |= BB_ANTATTEN_CHAN14; | |
26676 | + write_phy(dev,0x10,ant); | |
26677 | + //DMESG("BB antenna %x ",ant); | |
26678 | +} | |
26679 | + | |
26680 | + | |
26681 | +void maxim_rf_set_chan(struct net_device *dev, short ch) | |
26682 | +{ | |
26683 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
26684 | + u32 txpw = 0xff & priv->chtxpwr[ch]; | |
26685 | + u32 chan = maxim_chan[ch]; | |
26686 | + | |
26687 | + /*While philips SA2400 drive the PA bias | |
26688 | + *seems that for MAXIM we delegate this | |
26689 | + *to the BB | |
26690 | + */ | |
26691 | + | |
26692 | + //write_maxim(dev,5,txpw); | |
26693 | + write_phy(dev,3,txpw); | |
26694 | + | |
26695 | + maxim_write_phy_antenna(dev,ch); | |
26696 | + write_maxim(dev,3,chan); | |
26697 | +} | |
26698 | + | |
26699 | + | |
26700 | +void maxim_rf_close(struct net_device *dev) | |
26701 | +{ | |
26702 | + write_phy(dev, 3, 0x8); | |
26703 | + write_maxim(dev, 1, 0); | |
26704 | +} | |
26705 | + | |
26706 | + | |
26707 | +void maxim_rf_init(struct net_device *dev) | |
26708 | +{ | |
26709 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
26710 | + u32 anaparam; | |
26711 | + | |
26712 | + write_nic_byte(dev,PHY_DELAY,0x6); //this is general | |
26713 | + write_nic_byte(dev,CARRIER_SENSE_COUNTER,0x4c); //this is general | |
26714 | + | |
26715 | + /*these are maxim specific*/ | |
26716 | + anaparam = read_nic_dword(dev,ANAPARAM); | |
26717 | + anaparam = anaparam &~ (ANAPARAM_TXDACOFF_SHIFT); | |
26718 | + anaparam = anaparam &~ANAPARAM_PWR1_MASK; | |
26719 | + anaparam = anaparam &~ANAPARAM_PWR0_MASK; | |
26720 | + anaparam |= (MAXIM_ANAPARAM_PWR1_ON<<ANAPARAM_PWR1_SHIFT); | |
26721 | + anaparam |= (MAXIM_ANAPARAM_PWR0_ON<<ANAPARAM_PWR0_SHIFT); | |
26722 | + | |
26723 | + //rtl8180_set_anaparam(dev,anaparam); | |
26724 | + | |
26725 | + /* MAXIM from netbsd driver */ | |
26726 | + | |
26727 | + write_maxim(dev,0, 7); /* test mode as indicated in datasheet*/ | |
26728 | + write_maxim(dev,1, 0x1e); /* enable register*/ | |
26729 | + write_maxim(dev,2, 1); /* synt register */ | |
26730 | + | |
26731 | + | |
26732 | + maxim_rf_set_chan(dev,priv->chan); | |
26733 | + | |
26734 | + write_maxim(dev,4, 0x313); /* rx register*/ | |
26735 | + | |
26736 | + /* PA is driven directly by the BB, we keep the MAXIM bias | |
26737 | + * at the highest value in the boubt tha pleacing it to lower | |
26738 | + * values may introduce some further attenuation somewhere.. | |
26739 | + */ | |
26740 | + | |
26741 | + write_maxim(dev,5, 0xf); | |
26742 | + | |
26743 | + | |
26744 | + /*baseband configuration*/ | |
26745 | + write_phy(dev,0,0x88); //sys1 | |
26746 | + write_phy(dev,3,0x8); //txagc | |
26747 | + write_phy(dev,4,0xf8); // lnadet | |
26748 | + write_phy(dev,5,0x90); // ifagcinit | |
26749 | + write_phy(dev,6,0x1a); // ifagclimit | |
26750 | + write_phy(dev,7,0x64); // ifagcdet | |
26751 | + | |
26752 | + /*Should be done something more here??*/ | |
26753 | + | |
26754 | + maxim_write_phy_antenna(dev,priv->chan); | |
26755 | + | |
26756 | + write_phy(dev,0x11,0x88); //trl | |
26757 | + if(priv->diversity) | |
26758 | + write_phy(dev,0x12,0xc7); | |
26759 | + else | |
26760 | + write_phy(dev,0x12,0x47); | |
26761 | + | |
26762 | + write_phy(dev,0x13,0x9b); | |
26763 | + | |
26764 | + write_phy(dev,0x19,0x0); //CHESTLIM | |
26765 | + write_phy(dev,0x1a,0x9f); //CHSQLIM | |
26766 | + | |
26767 | + maxim_rf_set_chan(dev,priv->chan); | |
26768 | +} | |
26769 | --- /dev/null | |
26770 | +++ b/drivers/staging/rtl8187se/r8180_max2820.h | |
26771 | @@ -0,0 +1,21 @@ | |
26772 | +/* | |
26773 | + This is part of rtl8180 OpenSource driver | |
26774 | + Copyright (C) Andrea Merello 2004-2005 <andreamrl@tiscali.it> | |
26775 | + Released under the terms of GPL (General Public Licence) | |
26776 | + | |
26777 | + Parts of this driver are based on the GPL part of the official realtek driver | |
26778 | + Parts of this driver are based on the rtl8180 driver skeleton from Patric Schenke & Andres Salomon | |
26779 | + Parts of this driver are based on the Intel Pro Wireless 2100 GPL driver | |
26780 | + | |
26781 | + We want to tanks the Authors of such projects and the Ndiswrapper project Authors. | |
26782 | +*/ | |
26783 | + | |
26784 | +#define MAXIM_ANTENNA 0xb3 | |
26785 | +#define MAXIM_ANAPARAM_PWR1_ON 0x8 | |
26786 | +#define MAXIM_ANAPARAM_PWR0_ON 0x0 | |
26787 | + | |
26788 | + | |
26789 | +void maxim_rf_init(struct net_device *dev); | |
26790 | +void maxim_rf_set_chan(struct net_device *dev,short ch); | |
26791 | + | |
26792 | +void maxim_rf_close(struct net_device *dev); | |
26793 | --- /dev/null | |
26794 | +++ b/drivers/staging/rtl8187se/r8180_pm.c | |
26795 | @@ -0,0 +1,90 @@ | |
26796 | +/* | |
26797 | + Power management interface routines. | |
26798 | + Written by Mariusz Matuszek. | |
26799 | + This code is currently just a placeholder for later work and | |
26800 | + does not do anything useful. | |
26801 | + | |
26802 | + This is part of rtl8180 OpenSource driver. | |
26803 | + Copyright (C) Andrea Merello 2004 <andreamrl@tiscali.it> | |
26804 | + Released under the terms of GPL (General Public Licence) | |
26805 | +*/ | |
26806 | + | |
26807 | +#ifdef CONFIG_RTL8180_PM | |
26808 | + | |
26809 | + | |
26810 | +#include "r8180_hw.h" | |
26811 | +#include "r8180_pm.h" | |
26812 | +#include "r8180.h" | |
26813 | + | |
26814 | +int rtl8180_save_state (struct pci_dev *dev, u32 state) | |
26815 | +{ | |
26816 | + printk(KERN_NOTICE "r8180 save state call (state %u).\n", state); | |
26817 | + return(-EAGAIN); | |
26818 | +} | |
26819 | + | |
26820 | +int rtl8180_suspend (struct pci_dev *pdev, pm_message_t state) | |
26821 | +{ | |
26822 | + struct net_device *dev = pci_get_drvdata(pdev); | |
26823 | +// struct r8180_priv *priv = ieee80211_priv(dev); | |
26824 | + | |
26825 | + if (!netif_running(dev)) | |
26826 | + goto out_pci_suspend; | |
26827 | + | |
26828 | + dev->stop(dev); | |
26829 | + | |
26830 | + netif_device_detach(dev); | |
26831 | + | |
26832 | +out_pci_suspend: | |
26833 | + pci_save_state(pdev); | |
26834 | + pci_disable_device(pdev); | |
26835 | + pci_set_power_state(pdev,pci_choose_state(pdev,state)); | |
26836 | + return 0; | |
26837 | +} | |
26838 | + | |
26839 | +int rtl8180_resume (struct pci_dev *pdev) | |
26840 | +{ | |
26841 | + struct net_device *dev = pci_get_drvdata(pdev); | |
26842 | +// struct r8180_priv *priv = ieee80211_priv(dev); | |
26843 | + int err; | |
26844 | + u32 val; | |
26845 | + | |
26846 | + pci_set_power_state(pdev, PCI_D0); | |
26847 | + | |
26848 | + err = pci_enable_device(pdev); | |
26849 | + if(err) { | |
26850 | + printk(KERN_ERR "%s: pci_enable_device failed on resume\n", | |
26851 | + dev->name); | |
26852 | + | |
26853 | + return err; | |
26854 | + } | |
26855 | + pci_restore_state(pdev); | |
26856 | + /* | |
26857 | + * Suspend/Resume resets the PCI configuration space, so we have to | |
26858 | + * re-disable the RETRY_TIMEOUT register (0x41) to keep PCI Tx retries | |
26859 | + * from interfering with C3 CPU state. pci_restore_state won't help | |
26860 | + * here since it only restores the first 64 bytes pci config header. | |
26861 | + */ | |
26862 | + pci_read_config_dword(pdev, 0x40, &val); | |
26863 | + if ((val & 0x0000ff00) != 0) | |
26864 | + pci_write_config_dword(pdev, 0x40, val & 0xffff00ff); | |
26865 | + | |
26866 | + if(!netif_running(dev)) | |
26867 | + goto out; | |
26868 | + | |
26869 | + dev->open(dev); | |
26870 | + netif_device_attach(dev); | |
26871 | +out: | |
26872 | + return 0; | |
26873 | +} | |
26874 | + | |
26875 | + | |
26876 | +int rtl8180_enable_wake (struct pci_dev *dev, u32 state, int enable) | |
26877 | +{ | |
26878 | + printk(KERN_NOTICE "r8180 enable wake call (state %u, enable %d).\n", | |
26879 | + state, enable); | |
26880 | + return(-EAGAIN); | |
26881 | +} | |
26882 | + | |
26883 | + | |
26884 | + | |
26885 | +#endif //CONFIG_RTL8180_PM | |
26886 | --- /dev/null | |
26887 | +++ b/drivers/staging/rtl8187se/r8180_pm.h | |
26888 | @@ -0,0 +1,28 @@ | |
26889 | +/* | |
26890 | + Power management interface routines. | |
26891 | + Written by Mariusz Matuszek. | |
26892 | + This code is currently just a placeholder for later work and | |
26893 | + does not do anything useful. | |
26894 | + | |
26895 | + This is part of rtl8180 OpenSource driver. | |
26896 | + Copyright (C) Andrea Merello 2004 <andreamrl@tiscali.it> | |
26897 | + Released under the terms of GPL (General Public Licence) | |
26898 | + | |
26899 | +*/ | |
26900 | + | |
26901 | +#ifdef CONFIG_RTL8180_PM | |
26902 | + | |
26903 | +#ifndef R8180_PM_H | |
26904 | +#define R8180_PM_H | |
26905 | + | |
26906 | +#include <linux/types.h> | |
26907 | +#include <linux/pci.h> | |
26908 | + | |
26909 | +int rtl8180_save_state (struct pci_dev *dev, u32 state); | |
26910 | +int rtl8180_suspend (struct pci_dev *pdev, pm_message_t state); | |
26911 | +int rtl8180_resume (struct pci_dev *pdev); | |
26912 | +int rtl8180_enable_wake (struct pci_dev *dev, u32 state, int enable); | |
26913 | + | |
26914 | +#endif //R8180_PM_H | |
26915 | + | |
26916 | +#endif // CONFIG_RTL8180_PM | |
26917 | --- /dev/null | |
26918 | +++ b/drivers/staging/rtl8187se/r8180_rtl8225.c | |
26919 | @@ -0,0 +1,933 @@ | |
26920 | +/* | |
26921 | + This is part of the rtl8180-sa2400 driver | |
26922 | + released under the GPL (See file COPYING for details). | |
26923 | + Copyright (c) 2005 Andrea Merello <andreamrl@tiscali.it> | |
26924 | + | |
26925 | + This files contains programming code for the rtl8225 | |
26926 | + radio frontend. | |
26927 | + | |
26928 | + *Many* thanks to Realtek Corp. for their great support! | |
26929 | + | |
26930 | +*/ | |
26931 | + | |
26932 | + | |
26933 | + | |
26934 | +#include "r8180_hw.h" | |
26935 | +#include "r8180_rtl8225.h" | |
26936 | + | |
26937 | + | |
26938 | +u8 rtl8225_gain[]={ | |
26939 | + 0x23,0x88,0x7c,0xa5,// -82dbm | |
26940 | + 0x23,0x88,0x7c,0xb5,// -82dbm | |
26941 | + 0x23,0x88,0x7c,0xc5,// -82dbm | |
26942 | + 0x33,0x80,0x79,0xc5,// -78dbm | |
26943 | + 0x43,0x78,0x76,0xc5,// -74dbm | |
26944 | + 0x53,0x60,0x73,0xc5,// -70dbm | |
26945 | + 0x63,0x58,0x70,0xc5,// -66dbm | |
26946 | +}; | |
26947 | + | |
26948 | +#if 0 | |
26949 | +u8 rtl8225_init_gain[]={ | |
26950 | + //0x00,0x00,0x00,0x00,//0x00,0x00,0x00,0x00, | |
26951 | + 0x33,0x80,0x6c,0xc5,//0x00,0x49,0x06,0xb5,//Gain = 0 ~ -78dbm | |
26952 | + 0x43,0x78,0x69,0xc5,//0x00,0x45,0x06,0xb1,//Gain = 1 ~ -74dbm | |
26953 | + 0x53,0x60,0x66,0xc5,//0x00,0x41,0x06,0xab,//Gain = 2 ~ -70dbm | |
26954 | + 0x63,0x58,0x63,0xc5,//0x00,0x3d,0x06,0xa5,//Gain = 3 ~ -66dbm | |
26955 | + 0x73,0x50,0x62,0xc5,//0x00,0x39,0x06,0xa1,//Gain = 4 ~ -62dbm | |
26956 | + 0x83,0x43,0x61,0xc5,//0x00,0x35,0x06,0x9b,//Gain = 5 ~ -58dbm | |
26957 | + 0x93,0x38,0x5a,0xc5,//0x00,0x31,0x06,0x99,//Gain = 6 ~ -54dbm | |
26958 | +}; | |
26959 | +#endif | |
26960 | +#ifdef CONFIG_RTL818X_S | |
26961 | +u32 rtl8225_chan[] ={ | |
26962 | + 0, | |
26963 | + 0x0080, //ch1 | |
26964 | + 0x0100, //ch2 | |
26965 | + 0x0180, //ch3 | |
26966 | + 0x0200, //ch4 | |
26967 | + 0x0280, | |
26968 | + 0x0300, | |
26969 | + 0x0380, | |
26970 | + 0x0400, | |
26971 | + 0x0480, | |
26972 | + 0x0500, | |
26973 | + 0x0580, | |
26974 | + 0x0600, | |
26975 | + 0x0680, | |
26976 | + 0x074A, //ch14 | |
26977 | +}; | |
26978 | +#else | |
26979 | +u32 rtl8225_chan[] = { | |
26980 | + 0, //dummy channel 0 | |
26981 | + 0x085c, //1 | |
26982 | + 0x08dc, //2 | |
26983 | + 0x095c, //3 | |
26984 | + 0x09dc, //4 | |
26985 | + 0x0a5c, //5 | |
26986 | + 0x0adc, //6 | |
26987 | + 0x0b5c, //7 | |
26988 | + 0x0bdc, //8 | |
26989 | + 0x0c5c, //9 | |
26990 | + 0x0cdc, //10 | |
26991 | + 0x0d5c, //11 | |
26992 | + 0x0ddc, //12 | |
26993 | + 0x0e5c, //13 | |
26994 | + //0x0f5c, //14 | |
26995 | + 0x0f72, // 14 | |
26996 | +}; | |
26997 | +#endif | |
26998 | + | |
26999 | +u16 rtl8225bcd_rxgain[]={ | |
27000 | + 0x0400, 0x0401, 0x0402, 0x0403, 0x0404, 0x0405, 0x0408, 0x0409, | |
27001 | + 0x040a, 0x040b, 0x0502, 0x0503, 0x0504, 0x0505, 0x0540, 0x0541, | |
27002 | + 0x0542, 0x0543, 0x0544, 0x0545, 0x0580, 0x0581, 0x0582, 0x0583, | |
27003 | + 0x0584, 0x0585, 0x0588, 0x0589, 0x058a, 0x058b, 0x0643, 0x0644, | |
27004 | + 0x0645, 0x0680, 0x0681, 0x0682, 0x0683, 0x0684, 0x0685, 0x0688, | |
27005 | + 0x0689, 0x068a, 0x068b, 0x068c, 0x0742, 0x0743, 0x0744, 0x0745, | |
27006 | + 0x0780, 0x0781, 0x0782, 0x0783, 0x0784, 0x0785, 0x0788, 0x0789, | |
27007 | + 0x078a, 0x078b, 0x078c, 0x078d, 0x0790, 0x0791, 0x0792, 0x0793, | |
27008 | + 0x0794, 0x0795, 0x0798, 0x0799, 0x079a, 0x079b, 0x079c, 0x079d, | |
27009 | + 0x07a0, 0x07a1, 0x07a2, 0x07a3, 0x07a4, 0x07a5, 0x07a8, 0x07a9, | |
27010 | + 0x07aa, 0x07ab, 0x07ac, 0x07ad, 0x07b0, 0x07b1, 0x07b2, 0x07b3, | |
27011 | + 0x07b4, 0x07b5, 0x07b8, 0x07b9, 0x07ba, 0x07bb, 0x07bb | |
27012 | + | |
27013 | +}; | |
27014 | + | |
27015 | + | |
27016 | +#if 0 | |
27017 | +u16 rtl8225bc_rxgain[]={ | |
27018 | + 0x0400, 0x0401, 0x0402, 0x0403, 0x0404, 0x0405, 0x0408, 0x0409, | |
27019 | + 0x040a, 0x040b, 0x0502, 0x0503, 0x0504, 0x0505, 0x0540, 0x0541, | |
27020 | + 0x0542, 0x0543, 0x0544, 0x0545, 0x0580, 0x0581, 0x0582, 0x0583, | |
27021 | + 0x0584, 0x0585, 0x0588, 0x0589, 0x058a, 0x058b, 0x0643, 0x0644, | |
27022 | + 0x0645, 0x0680, 0x0681, 0x0682, 0x0683, 0x0684, 0x0685, 0x0688, | |
27023 | + 0x0689, 0x068a, 0x068b, 0x068c, 0x0742, 0x0743, 0x0744, 0x0745, | |
27024 | + 0x0780, 0x0781, 0x0782, 0x0783, 0x0784, 0x0785, 0x0788, 0x0789, | |
27025 | + 0x078a, 0x078b, 0x078c, 0x078d, 0x0790, 0x0791, 0x0792, 0x0793, | |
27026 | + 0x0794, 0x0795, 0x0798, 0x0799, 0x039a, 0x039b, 0x039c, 0x039d, | |
27027 | + 0x03a0, 0x03a1, 0x03a2, 0x03a3, 0x03a4, 0x03a5, 0x03a8, 0x03a9, | |
27028 | + 0x03aa, 0x03ab, 0x03ac, 0x03ad, 0x03b0, 0x03b1, 0x03b2, 0x03b3, | |
27029 | + 0x03b4, 0x03b5, 0x03b8, 0x03b9, 0x03ba, 0x03bb, 0x03bb | |
27030 | + | |
27031 | +}; | |
27032 | + | |
27033 | + | |
27034 | +u16 rtl8225a_rxgain[]={ | |
27035 | + 0x0400, 0x0401, 0x0402, 0x0403, 0x0404, 0x0405, 0x0408, 0x0409, | |
27036 | + 0x040a, 0x040b, 0x0502, 0x0503, 0x0504, 0x0505, 0x0540, 0x0541, | |
27037 | + 0x0542, 0x0543, 0x0544, 0x0545, 0x0580, 0x0581, 0x0582, 0x0583, | |
27038 | + 0x0584, 0x0585, 0x0588, 0x0589, 0x058a, 0x058b, 0x0643, 0x0644, | |
27039 | + 0x0645, 0x0680, 0x0681, 0x0682, 0x0683, 0x0684, 0x0685, 0x0688, | |
27040 | + 0x0689, 0x068a, 0x068b, 0x068c, 0x0742, 0x0743, 0x0744, 0x0745, | |
27041 | + 0x0780, 0x0781, 0x0782, 0x0783, 0x0784, 0x0785, 0x0788, 0x0789, | |
27042 | + 0x078a, 0x078b, 0x078c, 0x078d, 0x0790, 0x0791, 0x0792, 0x0793, | |
27043 | + 0x0794, 0x0795, 0x0798, 0x0799, 0x079a, 0x079b, 0x079c, 0x079d, | |
27044 | + 0x07a0, 0x07a1, 0x07a2, 0x07a3, 0x07a4, 0x07a5, 0x07a8, 0x07a9, | |
27045 | + 0x07aa, 0x07ab, 0x07ac, 0x07ad, 0x07ad, 0x07ad, 0x07ad, 0x07ad, | |
27046 | + 0x07ad, 0x07ad, 0x07ad, 0x07ad, 0x07ad, 0x07ad, 0x07ad | |
27047 | +}; | |
27048 | +#endif | |
27049 | + | |
27050 | +u8 rtl8225_agc[]={ | |
27051 | + 0x9e,0x9e,0x9e,0x9e,0x9e,0x9e,0x9e,0x9e,0x9d,0x9c,0x9b,0x9a,0x99,0x98,0x97,0x96, | |
27052 | + 0x95,0x94,0x93,0x92,0x91,0x90,0x8f,0x8e,0x8d,0x8c,0x8b,0x8a,0x89,0x88,0x87,0x86, | |
27053 | + 0x85,0x84,0x83,0x82,0x81,0x80,0x3f,0x3e,0x3d,0x3c,0x3b,0x3a,0x39,0x38,0x37,0x36, | |
27054 | + 0x35,0x34,0x33,0x32,0x31,0x30,0x2f,0x2e,0x2d,0x2c,0x2b,0x2a,0x29,0x28,0x27,0x26, | |
27055 | + 0x25,0x24,0x23,0x22,0x21,0x20,0x1f,0x1e,0x1d,0x1c,0x1b,0x1a,0x19,0x18,0x17,0x16, | |
27056 | + 0x15,0x14,0x13,0x12,0x11,0x10,0x0f,0x0e,0x0d,0x0c,0x0b,0x0a,0x09,0x08,0x07,0x06, | |
27057 | + 0x05,0x04,0x03,0x02,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01, | |
27058 | + 0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01, | |
27059 | +}; | |
27060 | + | |
27061 | + | |
27062 | +u8 rtl8225_tx_gain_cck_ofdm[]={ | |
27063 | + 0x02,0x06,0x0e,0x1e,0x3e,0x7e | |
27064 | +}; | |
27065 | + | |
27066 | + | |
27067 | +u8 rtl8225_tx_power_ofdm[]={ | |
27068 | + 0x80,0x90,0xa2,0xb5,0xcb,0xe4 | |
27069 | +}; | |
27070 | + | |
27071 | + | |
27072 | +u8 rtl8225_tx_power_cck_ch14[]={ | |
27073 | + 0x18,0x17,0x15,0x0c,0x00,0x00,0x00,0x00, | |
27074 | + 0x1b,0x1a,0x17,0x0e,0x00,0x00,0x00,0x00, | |
27075 | + 0x1f,0x1e,0x1a,0x0f,0x00,0x00,0x00,0x00, | |
27076 | + 0x22,0x21,0x1d,0x11,0x00,0x00,0x00,0x00, | |
27077 | + 0x26,0x25,0x21,0x13,0x00,0x00,0x00,0x00, | |
27078 | + 0x2b,0x2a,0x25,0x15,0x00,0x00,0x00,0x00 | |
27079 | +}; | |
27080 | + | |
27081 | + | |
27082 | +u8 rtl8225_tx_power_cck[]={ | |
27083 | + 0x18,0x17,0x15,0x11,0x0c,0x08,0x04,0x02, | |
27084 | + 0x1b,0x1a,0x17,0x13,0x0e,0x09,0x04,0x02, | |
27085 | + 0x1f,0x1e,0x1a,0x15,0x10,0x0a,0x05,0x02, | |
27086 | + 0x22,0x21,0x1d,0x18,0x11,0x0b,0x06,0x02, | |
27087 | + 0x26,0x25,0x21,0x1b,0x14,0x0d,0x06,0x03, | |
27088 | + 0x2b,0x2a,0x25,0x1e,0x16,0x0e,0x07,0x03 | |
27089 | +}; | |
27090 | + | |
27091 | + | |
27092 | +void rtl8225_set_gain(struct net_device *dev, short gain) | |
27093 | +{ | |
27094 | + write_phy_ofdm(dev, 0x0d, rtl8225_gain[gain * 4]); | |
27095 | + write_phy_ofdm(dev, 0x23, rtl8225_gain[gain * 4 + 1]); | |
27096 | + write_phy_ofdm(dev, 0x1b, rtl8225_gain[gain * 4 + 2]); | |
27097 | + write_phy_ofdm(dev, 0x1d, rtl8225_gain[gain * 4 + 3]); | |
27098 | +} | |
27099 | +#if 0 | |
27100 | + | |
27101 | +void rtl8225_set_gain(struct net_device *dev, short gain) | |
27102 | +{ | |
27103 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
27104 | + | |
27105 | + rtl8180_set_anaparam(dev, RTL8225_ANAPARAM_ON); | |
27106 | + | |
27107 | + if(priv->card_8185 == 2) | |
27108 | + write_phy_ofdm(dev, 0x21, 0x27); | |
27109 | + else | |
27110 | + write_phy_ofdm(dev, 0x21, 0x37); | |
27111 | + | |
27112 | + write_phy_ofdm(dev, 0x25, 0x20); | |
27113 | + write_phy_ofdm(dev, 0x11, 0x6); | |
27114 | + | |
27115 | + if(priv->card_8185 == 1 && priv->card_8185_Bversion) | |
27116 | + write_phy_ofdm(dev, 0x27, 0x8); | |
27117 | + else | |
27118 | + write_phy_ofdm(dev, 0x27, 0x88); | |
27119 | + | |
27120 | + write_phy_ofdm(dev, 0x14, 0); | |
27121 | + write_phy_ofdm(dev, 0x16, 0); | |
27122 | + write_phy_ofdm(dev, 0x15, 0x40); | |
27123 | + write_phy_ofdm(dev, 0x17, 0x40); | |
27124 | + | |
27125 | + write_phy_ofdm(dev, 0x0d, rtl8225_gain[gain * 4]); | |
27126 | + write_phy_ofdm(dev, 0x23, rtl8225_gain[gain * 4 + 1]); | |
27127 | + write_phy_ofdm(dev, 0x1b, rtl8225_gain[gain * 4 + 2]); | |
27128 | + write_phy_ofdm(dev, 0x1d, rtl8225_gain[gain * 4 + 3]); | |
27129 | + //rtl8225_set_gain_usb(dev, gain); | |
27130 | +} | |
27131 | +#endif | |
27132 | + | |
27133 | + | |
27134 | +void write_rtl8225(struct net_device *dev, u8 adr, u16 data) | |
27135 | +{ | |
27136 | + int i; | |
27137 | + u16 out,select; | |
27138 | + u8 bit; | |
27139 | + u32 bangdata = (data << 4) | (adr & 0xf); | |
27140 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
27141 | + | |
27142 | + out = read_nic_word(dev, RFPinsOutput) & 0xfff3; | |
27143 | + | |
27144 | + write_nic_word(dev,RFPinsEnable, | |
27145 | + (read_nic_word(dev,RFPinsEnable) | 0x7)); | |
27146 | + | |
27147 | + select = read_nic_word(dev, RFPinsSelect); | |
27148 | + | |
27149 | + write_nic_word(dev, RFPinsSelect, select | 0x7 | | |
27150 | + ((priv->card_type == USB) ? 0 : SW_CONTROL_GPIO)); | |
27151 | + | |
27152 | + force_pci_posting(dev); | |
27153 | + udelay(10); | |
27154 | + | |
27155 | + write_nic_word(dev, RFPinsOutput, out | BB_HOST_BANG_EN );//| 0x1fff); | |
27156 | + | |
27157 | + force_pci_posting(dev); | |
27158 | + udelay(2); | |
27159 | + | |
27160 | + write_nic_word(dev, RFPinsOutput, out); | |
27161 | + | |
27162 | + force_pci_posting(dev); | |
27163 | + udelay(10); | |
27164 | + | |
27165 | + | |
27166 | + for(i=15; i>=0;i--){ | |
27167 | + | |
27168 | + bit = (bangdata & (1<<i)) >> i; | |
27169 | + | |
27170 | + write_nic_word(dev, RFPinsOutput, bit | out); | |
27171 | + | |
27172 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
27173 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
27174 | + | |
27175 | + i--; | |
27176 | + bit = (bangdata & (1<<i)) >> i; | |
27177 | + | |
27178 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
27179 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
27180 | + | |
27181 | + write_nic_word(dev, RFPinsOutput, bit | out); | |
27182 | + | |
27183 | + } | |
27184 | + | |
27185 | + write_nic_word(dev, RFPinsOutput, out | BB_HOST_BANG_EN); | |
27186 | + | |
27187 | + force_pci_posting(dev); | |
27188 | + udelay(10); | |
27189 | + | |
27190 | + write_nic_word(dev, RFPinsOutput, out | | |
27191 | + ((priv->card_type == USB) ? 4 : BB_HOST_BANG_EN)); | |
27192 | + | |
27193 | + write_nic_word(dev, RFPinsSelect, select | | |
27194 | + ((priv->card_type == USB) ? 0 : SW_CONTROL_GPIO)); | |
27195 | + | |
27196 | + if(priv->card_type == USB) | |
27197 | + mdelay(2); | |
27198 | + else | |
27199 | + rtl8185_rf_pins_enable(dev); | |
27200 | +} | |
27201 | + | |
27202 | +void rtl8225_rf_close(struct net_device *dev) | |
27203 | +{ | |
27204 | + write_rtl8225(dev, 0x4, 0x1f); | |
27205 | + | |
27206 | + force_pci_posting(dev); | |
27207 | + mdelay(1); | |
27208 | + | |
27209 | + rtl8180_set_anaparam(dev, RTL8225_ANAPARAM_OFF); | |
27210 | + rtl8185_set_anaparam2(dev, RTL8225_ANAPARAM2_OFF); | |
27211 | +} | |
27212 | + | |
27213 | +void rtl8225_SetTXPowerLevel(struct net_device *dev, short ch) | |
27214 | +{ | |
27215 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
27216 | + | |
27217 | + int GainIdx; | |
27218 | + int GainSetting; | |
27219 | + int i; | |
27220 | + u8 power; | |
27221 | + u8 *cck_power_table; | |
27222 | + u8 max_cck_power_level; | |
27223 | + u8 max_ofdm_power_level; | |
27224 | + u8 min_ofdm_power_level; | |
27225 | + u8 cck_power_level = 0xff & priv->chtxpwr[ch]; | |
27226 | + u8 ofdm_power_level = 0xff & priv->chtxpwr_ofdm[ch]; | |
27227 | + | |
27228 | + if(priv->card_type == USB){ | |
27229 | + max_cck_power_level = 11; | |
27230 | + max_ofdm_power_level = 25; // 12 -> 25 | |
27231 | + min_ofdm_power_level = 10; | |
27232 | + }else{ | |
27233 | + max_cck_power_level = 35; | |
27234 | + max_ofdm_power_level = 35; | |
27235 | + min_ofdm_power_level = 0; | |
27236 | + } | |
27237 | + /* CCK power setting */ | |
27238 | + if(cck_power_level > max_cck_power_level) | |
27239 | + cck_power_level = max_cck_power_level; | |
27240 | + GainIdx=cck_power_level % 6; | |
27241 | + GainSetting=cck_power_level / 6; | |
27242 | + | |
27243 | + if(ch == 14) | |
27244 | + cck_power_table = rtl8225_tx_power_cck_ch14; | |
27245 | + else | |
27246 | + cck_power_table = rtl8225_tx_power_cck; | |
27247 | + | |
27248 | +// if(priv->card_8185 == 1 && priv->card_8185_Bversion ){ | |
27249 | + /*Ver B*/ | |
27250 | +// write_nic_byte(dev, TX_GAIN_CCK, rtl8225_tx_gain_cck_ofdm[GainSetting]); | |
27251 | +// }else{ | |
27252 | + /*Ver C - D */ | |
27253 | + write_nic_byte(dev, TX_GAIN_CCK, rtl8225_tx_gain_cck_ofdm[GainSetting]>>1); | |
27254 | +// } | |
27255 | + | |
27256 | + for(i=0;i<8;i++){ | |
27257 | + | |
27258 | + power = cck_power_table[GainIdx * 8 + i]; | |
27259 | + write_phy_cck(dev, 0x44 + i, power); | |
27260 | + } | |
27261 | + | |
27262 | + /* FIXME Is this delay really needeed ? */ | |
27263 | + force_pci_posting(dev); | |
27264 | + mdelay(1); | |
27265 | + | |
27266 | + /* OFDM power setting */ | |
27267 | +// Old: | |
27268 | +// if(ofdm_power_level > max_ofdm_power_level) | |
27269 | +// ofdm_power_level = 35; | |
27270 | +// ofdm_power_level += min_ofdm_power_level; | |
27271 | +// Latest: | |
27272 | + if(ofdm_power_level > (max_ofdm_power_level - min_ofdm_power_level)) | |
27273 | + ofdm_power_level = max_ofdm_power_level; | |
27274 | + else | |
27275 | + ofdm_power_level += min_ofdm_power_level; | |
27276 | + if(ofdm_power_level > 35) | |
27277 | + ofdm_power_level = 35; | |
27278 | +// | |
27279 | + | |
27280 | + GainIdx=ofdm_power_level % 6; | |
27281 | + GainSetting=ofdm_power_level / 6; | |
27282 | +#if 1 | |
27283 | +// if(priv->card_type == USB){ | |
27284 | + rtl8185_set_anaparam2(dev,RTL8225_ANAPARAM2_ON); | |
27285 | + | |
27286 | + write_phy_ofdm(dev,2,0x42); | |
27287 | + write_phy_ofdm(dev,6,0); | |
27288 | + write_phy_ofdm(dev,8,0); | |
27289 | +// } | |
27290 | +#endif | |
27291 | +// if(priv->card_8185 == 1 && priv->card_8185_Bversion){ | |
27292 | +// /*Ver B*/ | |
27293 | +// write_nic_byte(dev, TX_GAIN_OFDM, rtl8225_tx_gain_cck_ofdm[GainSetting]); | |
27294 | +// }else{ | |
27295 | + /*Ver C - D */ | |
27296 | + write_nic_byte(dev, TX_GAIN_OFDM, rtl8225_tx_gain_cck_ofdm[GainSetting]>>1); | |
27297 | +// } | |
27298 | + | |
27299 | + | |
27300 | + power = rtl8225_tx_power_ofdm[GainIdx]; | |
27301 | + | |
27302 | + write_phy_ofdm(dev, 0x5, power); | |
27303 | + write_phy_ofdm(dev, 0x7, power); | |
27304 | + | |
27305 | + force_pci_posting(dev); | |
27306 | + mdelay(1); | |
27307 | + //write_nic_byte(dev, TX_AGC_CONTROL,4); | |
27308 | +} | |
27309 | +#if 0 | |
27310 | +/* switch between mode B and G */ | |
27311 | +void rtl8225_set_mode(struct net_device *dev, short modeb) | |
27312 | +{ | |
27313 | + write_phy_ofdm(dev, 0x15, (modeb ? 0x0 : 0x40)); | |
27314 | + write_phy_ofdm(dev, 0x17, (modeb ? 0x0 : 0x40)); | |
27315 | +} | |
27316 | +#endif | |
27317 | +void rtl8225_rf_set_chan(struct net_device *dev, short ch) | |
27318 | +{ | |
27319 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
27320 | + short gset = (priv->ieee80211->state == IEEE80211_LINKED && | |
27321 | + ieee80211_is_54g(priv->ieee80211->current_network)) || | |
27322 | + priv->ieee80211->iw_mode == IW_MODE_MONITOR; | |
27323 | + | |
27324 | + rtl8225_SetTXPowerLevel(dev, ch); | |
27325 | + | |
27326 | + write_rtl8225(dev, 0x7, rtl8225_chan[ch]); | |
27327 | + | |
27328 | + force_pci_posting(dev); | |
27329 | + mdelay(10); | |
27330 | + | |
27331 | + // A mode sifs 0x44, difs 34-14, slot 9, eifs 23, cwm 3, cwM 7, ctstoself 0x10 | |
27332 | + if(gset){ | |
27333 | + write_nic_byte(dev,SIFS,0x22);// SIFS: 0x22 | |
27334 | + write_nic_byte(dev,DIFS,0x14); //DIFS: 20 | |
27335 | + //write_nic_byte(dev,DIFS,20); //DIFS: 20 | |
27336 | + }else{ | |
27337 | + write_nic_byte(dev,SIFS,0x44);// SIFS: 0x22 | |
27338 | + write_nic_byte(dev,DIFS,50 - 14); //DIFS: 36 | |
27339 | + } | |
27340 | + if(priv->ieee80211->state == IEEE80211_LINKED && | |
27341 | + ieee80211_is_shortslot(priv->ieee80211->current_network)) | |
27342 | + write_nic_byte(dev,SLOT,0x9); //SLOT: 9 | |
27343 | + | |
27344 | + else | |
27345 | + write_nic_byte(dev,SLOT,0x14); //SLOT: 20 (0x14) | |
27346 | + | |
27347 | + | |
27348 | + if(gset){ | |
27349 | + write_nic_byte(dev,EIFS,81);//91 - 20); // EIFS: 91 (0x5B) | |
27350 | + write_nic_byte(dev,CW_VAL,0x73); //CW VALUE: 0x37 | |
27351 | + //DMESG("using G net params"); | |
27352 | + }else{ | |
27353 | + write_nic_byte(dev,EIFS,81); // EIFS: 91 (0x5B) | |
27354 | + write_nic_byte(dev,CW_VAL,0xa5); //CW VALUE: 0x37 | |
27355 | + //DMESG("using B net params"); | |
27356 | + } | |
27357 | + | |
27358 | + | |
27359 | +} | |
27360 | + | |
27361 | +void rtl8225_host_pci_init(struct net_device *dev) | |
27362 | +{ | |
27363 | + write_nic_word(dev, RFPinsOutput, 0x480); | |
27364 | + | |
27365 | + rtl8185_rf_pins_enable(dev); | |
27366 | + | |
27367 | + //if(priv->card_8185 == 2 && priv->enable_gpio0 ) /* version D */ | |
27368 | + //write_nic_word(dev, RFPinsSelect, 0x88); | |
27369 | + //else | |
27370 | + write_nic_word(dev, RFPinsSelect, 0x88 | SW_CONTROL_GPIO); /* 0x488 | SW_CONTROL_GPIO */ | |
27371 | + | |
27372 | + write_nic_byte(dev, GP_ENABLE, 0); | |
27373 | + | |
27374 | + force_pci_posting(dev); | |
27375 | + mdelay(200); | |
27376 | + | |
27377 | + write_nic_word(dev, GP_ENABLE, 0xff & (~(1<<6))); /* bit 6 is for RF on/off detection */ | |
27378 | + | |
27379 | + | |
27380 | +} | |
27381 | + | |
27382 | +void rtl8225_host_usb_init(struct net_device *dev) | |
27383 | +{ | |
27384 | + #if 0 | |
27385 | + write_nic_byte(dev,RFPinsSelect+1,0); | |
27386 | + | |
27387 | + write_nic_byte(dev,GPIO,0); | |
27388 | + | |
27389 | + write_nic_byte_E(dev,0x53,read_nic_byte_E(dev,0x53) | (1<<7)); | |
27390 | + | |
27391 | + write_nic_byte(dev,RFPinsSelect+1,4); | |
27392 | + | |
27393 | + write_nic_byte(dev,GPIO,0x20); | |
27394 | + | |
27395 | + write_nic_byte(dev,GP_ENABLE,0); | |
27396 | + | |
27397 | + | |
27398 | + /* Config BB & RF */ | |
27399 | + write_nic_word(dev, RFPinsOutput, 0x80); | |
27400 | + | |
27401 | + write_nic_word(dev, RFPinsSelect, 0x80); | |
27402 | + | |
27403 | + write_nic_word(dev, RFPinsEnable, 0x80); | |
27404 | + | |
27405 | + | |
27406 | + mdelay(100); | |
27407 | + | |
27408 | + mdelay(1000); | |
27409 | +#endif | |
27410 | + | |
27411 | +} | |
27412 | + | |
27413 | +void rtl8225_rf_sleep(struct net_device *dev) | |
27414 | +{ | |
27415 | + write_rtl8225(dev,0x4,0xdff); | |
27416 | + force_pci_posting(dev); | |
27417 | + mdelay(1); | |
27418 | + rtl8180_set_anaparam(dev, RTL8225_ANAPARAM_SLEEP); | |
27419 | + rtl8185_set_anaparam2(dev, RTL8225_ANAPARAM2_SLEEP); | |
27420 | + force_pci_posting(dev); | |
27421 | +} | |
27422 | + | |
27423 | +void rtl8225_rf_wakeup(struct net_device *dev) | |
27424 | +{ | |
27425 | + write_rtl8225(dev,0x4,0x9ff); | |
27426 | + rtl8180_set_anaparam(dev, RTL8225_ANAPARAM_ON); | |
27427 | + rtl8185_set_anaparam2(dev, RTL8225_ANAPARAM2_ON); | |
27428 | + force_pci_posting(dev); | |
27429 | +} | |
27430 | + | |
27431 | +void rtl8225_rf_init(struct net_device *dev) | |
27432 | +{ | |
27433 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
27434 | + int i; | |
27435 | + short channel = 1; | |
27436 | + u16 brsr; | |
27437 | + | |
27438 | + priv->chan = channel; | |
27439 | + | |
27440 | + rtl8180_set_anaparam(dev, RTL8225_ANAPARAM_ON); | |
27441 | + | |
27442 | + | |
27443 | + if(priv->card_type == USB) | |
27444 | + rtl8225_host_usb_init(dev); | |
27445 | + else | |
27446 | + rtl8225_host_pci_init(dev); | |
27447 | + | |
27448 | + write_nic_dword(dev, RF_TIMING, 0x000a8008); | |
27449 | + | |
27450 | + brsr = read_nic_word(dev, BRSR); | |
27451 | + | |
27452 | + write_nic_word(dev, BRSR, 0xffff); | |
27453 | + | |
27454 | + #if 0 | |
27455 | + if(priv->card_8185 == 1){/* version C or B */ | |
27456 | + if(priv->card_8185_Bversion) /* version B*/ | |
27457 | + write_nic_dword(dev, RF_PARA, 0x44); | |
27458 | + else /* version C */ | |
27459 | + write_nic_dword(dev, RF_PARA, 0x100044); | |
27460 | + }else{ /* version D */ | |
27461 | + if(priv->enable_gpio0) | |
27462 | + write_nic_dword(dev, RF_PARA, 0x20100044); | |
27463 | + else /* also USB */ | |
27464 | + write_nic_dword(dev, RF_PARA, 0x100044); | |
27465 | + } | |
27466 | + #endif | |
27467 | + | |
27468 | + write_nic_dword(dev, RF_PARA, 0x100044); | |
27469 | + | |
27470 | + #if 1 //0->1 | |
27471 | + rtl8180_set_mode(dev, EPROM_CMD_CONFIG); | |
27472 | + write_nic_byte(dev, CONFIG3, 0x44); | |
27473 | + rtl8180_set_mode(dev, EPROM_CMD_NORMAL); | |
27474 | + #endif | |
27475 | + | |
27476 | + if(priv->card_type == USB){ | |
27477 | + rtl8185_rf_pins_enable(dev); | |
27478 | + | |
27479 | + mdelay(1000); | |
27480 | + } | |
27481 | + | |
27482 | + write_rtl8225(dev, 0x0, 0x67); mdelay(1); | |
27483 | + | |
27484 | + | |
27485 | + write_rtl8225(dev, 0x1, 0xfe0); mdelay(1); | |
27486 | + | |
27487 | + write_rtl8225(dev, 0x2, 0x44d); mdelay(1); | |
27488 | + | |
27489 | + write_rtl8225(dev, 0x3, 0x441); mdelay(1); | |
27490 | + | |
27491 | + if(priv->card_type == USB) | |
27492 | + write_rtl8225(dev, 0x4, 0x486); | |
27493 | + else | |
27494 | + write_rtl8225(dev, 0x4, 0x8be); | |
27495 | + | |
27496 | + mdelay(1); | |
27497 | + | |
27498 | + | |
27499 | + #if 0 | |
27500 | + }else if(priv->phy_ver == 1){ | |
27501 | + /* version A */ | |
27502 | + write_rtl8225(dev, 0x5, 0xbc0 + 2); | |
27503 | + }else{ | |
27504 | + #endif | |
27505 | + /* version B & C */ | |
27506 | + | |
27507 | + if(priv->card_type == USB) | |
27508 | + write_rtl8225(dev, 0x5, 0xbc0); | |
27509 | + else if(priv->card_type == MINIPCI) | |
27510 | + write_rtl8225(dev, 0x5, 0xbc0 + 3 +(6<<3)); | |
27511 | + else | |
27512 | + write_rtl8225(dev, 0x5, 0xbc0 + (6<<3)); | |
27513 | + | |
27514 | + mdelay(1); | |
27515 | +// } | |
27516 | + | |
27517 | + write_rtl8225(dev, 0x6, 0xae6); mdelay(1); | |
27518 | + | |
27519 | + write_rtl8225(dev, 0x7, ((priv->card_type == USB)? 0x82a : rtl8225_chan[channel])); mdelay(1); | |
27520 | + | |
27521 | + write_rtl8225(dev, 0x8, 0x1f); mdelay(1); | |
27522 | + | |
27523 | + write_rtl8225(dev, 0x9, 0x334); mdelay(1); | |
27524 | + | |
27525 | + write_rtl8225(dev, 0xa, 0xfd4); mdelay(1); | |
27526 | + | |
27527 | + write_rtl8225(dev, 0xb, 0x391); mdelay(1); | |
27528 | + | |
27529 | + write_rtl8225(dev, 0xc, 0x50); mdelay(1); | |
27530 | + | |
27531 | + | |
27532 | + write_rtl8225(dev, 0xd, 0x6db); mdelay(1); | |
27533 | + | |
27534 | + write_rtl8225(dev, 0xe, 0x29); mdelay(1); | |
27535 | + | |
27536 | + write_rtl8225(dev, 0xf, 0x914); | |
27537 | + | |
27538 | + if(priv->card_type == USB){ | |
27539 | + //force_pci_posting(dev); | |
27540 | + mdelay(100); | |
27541 | + } | |
27542 | + | |
27543 | + write_rtl8225(dev, 0x2, 0xc4d); | |
27544 | + | |
27545 | + if(priv->card_type == USB){ | |
27546 | + // force_pci_posting(dev); | |
27547 | + mdelay(200); | |
27548 | + | |
27549 | + write_rtl8225(dev, 0x2, 0x44d); | |
27550 | + | |
27551 | + // force_pci_posting(dev); | |
27552 | + mdelay(100); | |
27553 | + | |
27554 | + }//End of if(priv->card_type == USB) | |
27555 | + /* FIXME!! rtl8187 we have to check if calibrarion | |
27556 | + * is successful and eventually cal. again (repeat | |
27557 | + * the two write on reg 2) | |
27558 | + */ | |
27559 | + force_pci_posting(dev); | |
27560 | + | |
27561 | + mdelay(100); //200 for 8187 | |
27562 | + | |
27563 | + //if(priv->card_type != USB) /* maybe not needed even for 8185 */ | |
27564 | +// write_rtl8225(dev, 0x7, rtl8225_chan[channel]); | |
27565 | + | |
27566 | + write_rtl8225(dev, 0x0, 0x127); | |
27567 | + | |
27568 | + for(i=0;i<95;i++){ | |
27569 | + write_rtl8225(dev, 0x1, (u8)(i+1)); | |
27570 | + | |
27571 | + #if 0 | |
27572 | + if(priv->phy_ver == 1) | |
27573 | + /* version A */ | |
27574 | + write_rtl8225(dev, 0x2, rtl8225a_rxgain[i]); | |
27575 | + else | |
27576 | + #endif | |
27577 | + /* version B & C & D*/ | |
27578 | + | |
27579 | + write_rtl8225(dev, 0x2, rtl8225bcd_rxgain[i]); | |
27580 | + } | |
27581 | + | |
27582 | + write_rtl8225(dev, 0x0, 0x27); | |
27583 | + | |
27584 | + | |
27585 | +// //if(priv->card_type != USB){ | |
27586 | +// write_rtl8225(dev, 0x2, 0x44d); | |
27587 | +// write_rtl8225(dev, 0x7, rtl8225_chan[channel]); | |
27588 | +// write_rtl8225(dev, 0x2, 0x47d); | |
27589 | +// | |
27590 | +// force_pci_posting(dev); | |
27591 | +// mdelay(100); | |
27592 | +// | |
27593 | +// write_rtl8225(dev, 0x2, 0x44d); | |
27594 | +// //} | |
27595 | + | |
27596 | + write_rtl8225(dev, 0x0, 0x22f); | |
27597 | + | |
27598 | + if(priv->card_type != USB) | |
27599 | + rtl8185_rf_pins_enable(dev); | |
27600 | + | |
27601 | + for(i=0;i<128;i++){ | |
27602 | + write_phy_ofdm(dev, 0xb, rtl8225_agc[i]); | |
27603 | + | |
27604 | + mdelay(1); | |
27605 | + write_phy_ofdm(dev, 0xa, (u8)i+ 0x80); | |
27606 | + | |
27607 | + mdelay(1); | |
27608 | + } | |
27609 | + | |
27610 | + force_pci_posting(dev); | |
27611 | + mdelay(1); | |
27612 | + | |
27613 | + write_phy_ofdm(dev, 0x0, 0x1); mdelay(1); | |
27614 | + write_phy_ofdm(dev, 0x1, 0x2); mdelay(1); | |
27615 | + write_phy_ofdm(dev, 0x2, ((priv->card_type == USB)? 0x42 : 0x62)); mdelay(1); | |
27616 | + write_phy_ofdm(dev, 0x3, 0x0); mdelay(1); | |
27617 | + write_phy_ofdm(dev, 0x4, 0x0); mdelay(1); | |
27618 | + write_phy_ofdm(dev, 0x5, 0x0); mdelay(1); | |
27619 | + write_phy_ofdm(dev, 0x6, 0x40); mdelay(1); | |
27620 | + write_phy_ofdm(dev, 0x7, 0x0); mdelay(1); | |
27621 | + write_phy_ofdm(dev, 0x8, 0x40); mdelay(1); | |
27622 | + write_phy_ofdm(dev, 0x9, 0xfe); mdelay(1); | |
27623 | + | |
27624 | + #if 0 | |
27625 | + if(priv->card_type == USB){ | |
27626 | + write_phy_ofdm(dev, 0xa, 0x9); | |
27627 | + }else{ | |
27628 | + if(priv->card_8185 == 1 && priv->card_8185_Bversion){ | |
27629 | + /* Ver B | |
27630 | + * maybe later version can accept this also? | |
27631 | + */ | |
27632 | + write_phy_ofdm(dev, 0xa, 0x6); | |
27633 | + write_phy_ofdm(dev, 0x18, 0x6f); | |
27634 | + }else{ | |
27635 | + #endif | |
27636 | + /* ver C & D */ | |
27637 | + write_phy_ofdm(dev, 0xa, 0x9); mdelay(1); | |
27638 | + | |
27639 | + //write_phy_ofdm(dev, 0x18, 0xef); | |
27640 | + // } | |
27641 | + //} | |
27642 | + write_phy_ofdm(dev, 0xb, 0x80); mdelay(1); | |
27643 | + | |
27644 | + write_phy_ofdm(dev, 0xc, 0x1);mdelay(1); | |
27645 | + | |
27646 | + | |
27647 | + //if(priv->card_type != USB) | |
27648 | + //write_phy_ofdm(dev, 0xd, 0x33); // <> | |
27649 | + | |
27650 | + write_phy_ofdm(dev, 0xe, 0xd3);mdelay(1); | |
27651 | + | |
27652 | + | |
27653 | + #if 0 | |
27654 | + if(priv->card_8185 == 1){ | |
27655 | + if(priv->card_8185_Bversion) | |
27656 | + write_phy_ofdm(dev, 0xf, 0x20);/*ver B*/ | |
27657 | + else | |
27658 | + write_phy_ofdm(dev, 0xf, 0x28);/*ver C*/ | |
27659 | + }else{ | |
27660 | + #endif | |
27661 | + write_phy_ofdm(dev, 0xf, 0x38);mdelay(1); | |
27662 | +/*ver D & 8187*/ | |
27663 | +// } | |
27664 | + | |
27665 | +// if(priv->card_8185 == 1 && priv->card_8185_Bversion) | |
27666 | +// write_phy_ofdm(dev, 0x10, 0x04);/*ver B*/ | |
27667 | +// else | |
27668 | + write_phy_ofdm(dev, 0x10, 0x84);mdelay(1); | |
27669 | +/*ver C & D & 8187*/ | |
27670 | + | |
27671 | + write_phy_ofdm(dev, 0x11, 0x06);mdelay(1); | |
27672 | +/*agc resp time 700*/ | |
27673 | + | |
27674 | + | |
27675 | +// if(priv->card_8185 == 2){ | |
27676 | + /* Ver D & 8187*/ | |
27677 | + write_phy_ofdm(dev, 0x12, 0x20);mdelay(1); | |
27678 | + | |
27679 | + write_phy_ofdm(dev, 0x13, 0x20);mdelay(1); | |
27680 | + | |
27681 | +#if 0 | |
27682 | + }else{ | |
27683 | + /* Ver B & C*/ | |
27684 | + write_phy_ofdm(dev, 0x12, 0x0); | |
27685 | + write_phy_ofdm(dev, 0x13, 0x0); | |
27686 | + } | |
27687 | +#endif | |
27688 | + write_phy_ofdm(dev, 0x14, 0x0); mdelay(1); | |
27689 | + write_phy_ofdm(dev, 0x15, 0x40); mdelay(1); | |
27690 | + write_phy_ofdm(dev, 0x16, 0x0); mdelay(1); | |
27691 | + write_phy_ofdm(dev, 0x17, 0x40); mdelay(1); | |
27692 | + | |
27693 | +// if (priv->card_type == USB) | |
27694 | +// write_phy_ofdm(dev, 0x18, 0xef); | |
27695 | + | |
27696 | + write_phy_ofdm(dev, 0x18, 0xef);mdelay(1); | |
27697 | + | |
27698 | + | |
27699 | + write_phy_ofdm(dev, 0x19, 0x19); mdelay(1); | |
27700 | + write_phy_ofdm(dev, 0x1a, 0x20); mdelay(1); | |
27701 | + | |
27702 | +// if (priv->card_type != USB){ | |
27703 | +// if(priv->card_8185 == 1 && priv->card_8185_Bversion) | |
27704 | +// write_phy_ofdm(dev, 0x1b, 0x66); /* Ver B */ | |
27705 | +// else | |
27706 | + write_phy_ofdm(dev, 0x1b, 0x76);mdelay(1); | |
27707 | + /* Ver C & D */ //FIXME:MAYBE not needed | |
27708 | +// } | |
27709 | + | |
27710 | + write_phy_ofdm(dev, 0x1c, 0x4);mdelay(1); | |
27711 | + | |
27712 | +#if 0 | |
27713 | + if(priv->card_8185 == 1){ | |
27714 | + if(priv->card_8185_Bversion){ | |
27715 | + /*ver B*/ | |
27716 | + write_phy_ofdm(dev, 0x1e, 0x95); | |
27717 | + write_phy_ofdm(dev, 0x1f, 0x55); | |
27718 | + }else{ | |
27719 | + /*ver C*/ | |
27720 | + write_phy_ofdm(dev, 0x1e, 0x90); | |
27721 | + write_phy_ofdm(dev, 0x1f, 0x34); | |
27722 | + | |
27723 | + } | |
27724 | + }else{ | |
27725 | +#endif | |
27726 | + /*ver D & 8187*/ | |
27727 | + write_phy_ofdm(dev, 0x1e, 0x95);mdelay(1); | |
27728 | + | |
27729 | + write_phy_ofdm(dev, 0x1f, 0x75); mdelay(1); | |
27730 | + | |
27731 | +// } | |
27732 | + | |
27733 | + write_phy_ofdm(dev, 0x20, 0x1f);mdelay(1); | |
27734 | + | |
27735 | + write_phy_ofdm(dev, 0x21, 0x27);mdelay(1); | |
27736 | + | |
27737 | + write_phy_ofdm(dev, 0x22, 0x16);mdelay(1); | |
27738 | + | |
27739 | +// if(priv->card_type != USB) | |
27740 | + //write_phy_ofdm(dev, 0x23, 0x43); //FIXME maybe not needed // <> | |
27741 | + | |
27742 | + write_phy_ofdm(dev, 0x24, 0x46); mdelay(1); | |
27743 | + write_phy_ofdm(dev, 0x25, 0x20); mdelay(1); | |
27744 | + write_phy_ofdm(dev, 0x26, 0x90); mdelay(1); | |
27745 | +#if 0 | |
27746 | + if(priv->card_8185 == 1 && priv->card_8185_Bversion) | |
27747 | + write_phy_ofdm(dev, 0x27, 0x08); /* Ver B. might work also fo ver C&D ?*/ | |
27748 | + else | |
27749 | +#endif | |
27750 | + write_phy_ofdm(dev, 0x27, 0x88); mdelay(1); | |
27751 | +/* Ver C & D & 8187*/ | |
27752 | + | |
27753 | + // <> Set init. gain to m74dBm. | |
27754 | + write_phy_ofdm(dev, 0x0d, 0x43); mdelay(1); | |
27755 | + write_phy_ofdm(dev, 0x1b, 0x76); mdelay(1); | |
27756 | + write_phy_ofdm(dev, 0x1d, 0xc5); mdelay(1); | |
27757 | + write_phy_ofdm(dev, 0x23, 0x78); mdelay(1); | |
27758 | + | |
27759 | + //if(priv->card_type == USB); | |
27760 | + // rtl8225_set_gain_usb(dev, 1); /* FIXME this '2' is random */ | |
27761 | + | |
27762 | + write_phy_cck(dev, 0x0, 0x98); mdelay(1); | |
27763 | + write_phy_cck(dev, 0x3, 0x20); mdelay(1); | |
27764 | + write_phy_cck(dev, 0x4, 0x7e); mdelay(1); | |
27765 | + write_phy_cck(dev, 0x5, 0x12); mdelay(1); | |
27766 | + write_phy_cck(dev, 0x6, 0xfc); mdelay(1); | |
27767 | +#if 0 | |
27768 | + if(priv->card_8185 == 1 && priv->card_8185_Bversion) | |
27769 | + write_phy_cck(dev, 0x7, 0xd8); /* Ver B */ | |
27770 | + else | |
27771 | +#endif | |
27772 | + write_phy_cck(dev, 0x7, 0x78);mdelay(1); | |
27773 | + /* Ver C & D & 8187*/ | |
27774 | + | |
27775 | + write_phy_cck(dev, 0x8, 0x2e);mdelay(1); | |
27776 | + | |
27777 | + write_phy_cck(dev, 0x10, ((priv->card_type == USB) ? 0x9b: 0x93)); mdelay(1); | |
27778 | + write_phy_cck(dev, 0x11, 0x88); mdelay(1); | |
27779 | + write_phy_cck(dev, 0x12, 0x47); mdelay(1); | |
27780 | +#if 0 | |
27781 | + if(priv->card_8185 == 1 && priv->card_8185_Bversion) | |
27782 | + write_phy_cck(dev, 0x13, 0x98); /* Ver B */ | |
27783 | + else | |
27784 | +#endif | |
27785 | + write_phy_cck(dev, 0x13, 0xd0); /* Ver C & D & 8187*/ | |
27786 | + | |
27787 | + write_phy_cck(dev, 0x19, 0x0); | |
27788 | + write_phy_cck(dev, 0x1a, 0xa0); | |
27789 | + write_phy_cck(dev, 0x1b, 0x8); | |
27790 | + write_phy_cck(dev, 0x40, 0x86); /* CCK Carrier Sense Threshold */ | |
27791 | + | |
27792 | + write_phy_cck(dev, 0x41, 0x8d);mdelay(1); | |
27793 | + | |
27794 | + | |
27795 | + write_phy_cck(dev, 0x42, 0x15); mdelay(1); | |
27796 | + write_phy_cck(dev, 0x43, 0x18); mdelay(1); | |
27797 | + write_phy_cck(dev, 0x44, 0x1f); mdelay(1); | |
27798 | + write_phy_cck(dev, 0x45, 0x1e); mdelay(1); | |
27799 | + write_phy_cck(dev, 0x46, 0x1a); mdelay(1); | |
27800 | + write_phy_cck(dev, 0x47, 0x15); mdelay(1); | |
27801 | + write_phy_cck(dev, 0x48, 0x10); mdelay(1); | |
27802 | + write_phy_cck(dev, 0x49, 0xa); mdelay(1); | |
27803 | + write_phy_cck(dev, 0x4a, 0x5); mdelay(1); | |
27804 | + write_phy_cck(dev, 0x4b, 0x2); mdelay(1); | |
27805 | + write_phy_cck(dev, 0x4c, 0x5);mdelay(1); | |
27806 | + | |
27807 | + | |
27808 | + write_nic_byte(dev, 0x5b, 0x0d); mdelay(1); | |
27809 | + | |
27810 | + | |
27811 | + | |
27812 | +// <> | |
27813 | +// // TESTR 0xb 8187 | |
27814 | +// write_phy_cck(dev, 0x10, 0x93);// & 0xfb); | |
27815 | +// | |
27816 | +// //if(priv->card_type != USB){ | |
27817 | +// write_phy_ofdm(dev, 0x2, 0x62); | |
27818 | +// write_phy_ofdm(dev, 0x6, 0x0); | |
27819 | +// write_phy_ofdm(dev, 0x8, 0x0); | |
27820 | +// //} | |
27821 | + | |
27822 | + rtl8225_SetTXPowerLevel(dev, channel); | |
27823 | + | |
27824 | + write_phy_cck(dev, 0x10, 0x9b); mdelay(1); /* Rx ant A, 0xdb for B */ | |
27825 | + write_phy_ofdm(dev, 0x26, 0x90); mdelay(1); /* Rx ant A, 0x10 for B */ | |
27826 | + | |
27827 | + rtl8185_tx_antenna(dev, 0x3); /* TX ant A, 0x0 for B */ | |
27828 | + | |
27829 | + /* switch to high-speed 3-wire | |
27830 | + * last digit. 2 for both cck and ofdm | |
27831 | + */ | |
27832 | + if(priv->card_type == USB) | |
27833 | + write_nic_dword(dev, 0x94, 0x3dc00002); | |
27834 | + else{ | |
27835 | + write_nic_dword(dev, 0x94, 0x15c00002); | |
27836 | + rtl8185_rf_pins_enable(dev); | |
27837 | + } | |
27838 | + | |
27839 | +// if(priv->card_type != USB) | |
27840 | +// rtl8225_set_gain(dev, 4); /* FIXME this '1' is random */ // <> | |
27841 | +// rtl8225_set_mode(dev, 1); /* FIXME start in B mode */ // <> | |
27842 | +// | |
27843 | +// /* make sure is waken up! */ | |
27844 | +// write_rtl8225(dev,0x4, 0x9ff); | |
27845 | +// rtl8180_set_anaparam(dev, RTL8225_ANAPARAM_ON); | |
27846 | +// rtl8185_set_anaparam2(dev, RTL8225_ANAPARAM2_ON); | |
27847 | + | |
27848 | + rtl8225_rf_set_chan(dev, priv->chan); | |
27849 | + | |
27850 | + write_nic_word(dev,BRSR,brsr); | |
27851 | + | |
27852 | +} | |
27853 | --- /dev/null | |
27854 | +++ b/drivers/staging/rtl8187se/r8180_rtl8225.h | |
27855 | @@ -0,0 +1,44 @@ | |
27856 | +/* | |
27857 | + This is part of the rtl8180-sa2400 driver | |
27858 | + released under the GPL (See file COPYING for details). | |
27859 | + Copyright (c) 2005 Andrea Merello <andreamrl@tiscali.it> | |
27860 | + | |
27861 | + This files contains programming code for the rtl8225 | |
27862 | + radio frontend. | |
27863 | + | |
27864 | + *Many* thanks to Realtek Corp. for their great support! | |
27865 | + | |
27866 | +*/ | |
27867 | + | |
27868 | +#include "r8180.h" | |
27869 | + | |
27870 | +#define RTL8225_ANAPARAM_ON 0xa0000b59 | |
27871 | +#define RTL8225_ANAPARAM_OFF 0xa00beb59 | |
27872 | +#define RTL8225_ANAPARAM2_OFF 0x840dec11 | |
27873 | +#define RTL8225_ANAPARAM2_ON 0x860dec11 | |
27874 | +#define RTL8225_ANAPARAM_SLEEP 0xa00bab59 | |
27875 | +#define RTL8225_ANAPARAM2_SLEEP 0x840dec11 | |
27876 | + | |
27877 | +#ifdef CONFIG_RTL8185B | |
27878 | +void rtl8225z2_rf_init(struct net_device *dev); | |
27879 | +void rtl8225z2_rf_set_chan(struct net_device *dev,short ch); | |
27880 | +void rtl8225z2_rf_close(struct net_device *dev); | |
27881 | + | |
27882 | +void rtl8225_host_pci_init(struct net_device *dev); | |
27883 | +void rtl8225_host_usb_init(struct net_device *dev); | |
27884 | + | |
27885 | +void write_rtl8225(struct net_device *dev, u8 adr, u16 data); | |
27886 | +void RF_WriteReg(struct net_device *dev, u8 offset, u32 data); | |
27887 | +u32 RF_ReadReg(struct net_device *dev, u8 offset); | |
27888 | +#endif | |
27889 | +void rtl8225_rf_init(struct net_device *dev); | |
27890 | +void rtl8225_rf_set_chan(struct net_device *dev,short ch); | |
27891 | +void rtl8225_rf_close(struct net_device *dev); | |
27892 | +void rtl8225_rf_sleep(struct net_device *dev); | |
27893 | +void rtl8225_rf_wakeup(struct net_device *dev); | |
27894 | +void rtl8180_set_mode(struct net_device *dev,int mode); | |
27895 | +void rtl8180_set_mode(struct net_device *dev,int mode); | |
27896 | +bool SetZebraRFPowerState8185(struct net_device *dev,RT_RF_POWER_STATE eRFPowerState); | |
27897 | +void rtl8225z4_rf_sleep(struct net_device *dev); | |
27898 | +void rtl8225z4_rf_wakeup(struct net_device *dev); | |
27899 | + | |
27900 | --- /dev/null | |
27901 | +++ b/drivers/staging/rtl8187se/r8180_rtl8225z2.c | |
27902 | @@ -0,0 +1,1587 @@ | |
27903 | +/* | |
27904 | + This is part of the rtl8180-sa2400 driver | |
27905 | + released under the GPL (See file COPYING for details). | |
27906 | + Copyright (c) 2005 Andrea Merello <andreamrl@tiscali.it> | |
27907 | + | |
27908 | + This files contains programming code for the rtl8225 | |
27909 | + radio frontend. | |
27910 | + | |
27911 | + *Many* thanks to Realtek Corp. for their great support! | |
27912 | + | |
27913 | +*/ | |
27914 | + | |
27915 | +#include "r8180_hw.h" | |
27916 | +#include "r8180_rtl8225.h" | |
27917 | +#include "r8180_93cx6.h" | |
27918 | + | |
27919 | +#ifdef ENABLE_DOT11D | |
27920 | +#include "dot11d.h" | |
27921 | +#endif | |
27922 | + | |
27923 | +#ifdef CONFIG_RTL8185B | |
27924 | + | |
27925 | +extern u8 rtl8225_agc[]; | |
27926 | + | |
27927 | +extern u32 rtl8225_chan[]; | |
27928 | + | |
27929 | +//2005.11.16 | |
27930 | +u8 rtl8225z2_threshold[]={ | |
27931 | + 0x8d, 0x8d, 0x8d, 0x8d, 0x9d, 0xad, 0xbd, | |
27932 | +}; | |
27933 | + | |
27934 | +// 0xd 0x19 0x1b 0x21 | |
27935 | +u8 rtl8225z2_gain_bg[]={ | |
27936 | + 0x23, 0x15, 0xa5, // -82-1dbm | |
27937 | + 0x23, 0x15, 0xb5, // -82-2dbm | |
27938 | + 0x23, 0x15, 0xc5, // -82-3dbm | |
27939 | + 0x33, 0x15, 0xc5, // -78dbm | |
27940 | + 0x43, 0x15, 0xc5, // -74dbm | |
27941 | + 0x53, 0x15, 0xc5, // -70dbm | |
27942 | + 0x63, 0x15, 0xc5, // -66dbm | |
27943 | +}; | |
27944 | + | |
27945 | +u8 rtl8225z2_gain_a[]={ | |
27946 | + 0x13,0x27,0x5a,//,0x37,// -82dbm | |
27947 | + 0x23,0x23,0x58,//,0x37,// -82dbm | |
27948 | + 0x33,0x1f,0x56,//,0x37,// -82dbm | |
27949 | + 0x43,0x1b,0x54,//,0x37,// -78dbm | |
27950 | + 0x53,0x17,0x51,//,0x37,// -74dbm | |
27951 | + 0x63,0x24,0x4f,//,0x37,// -70dbm | |
27952 | + 0x73,0x0f,0x4c,//,0x37,// -66dbm | |
27953 | +}; | |
27954 | +#if 0 | |
27955 | +u32 rtl8225_chan[] = { | |
27956 | + 0, //dummy channel 0 | |
27957 | + 0x085c, //1 | |
27958 | + 0x08dc, //2 | |
27959 | + 0x095c, //3 | |
27960 | + 0x09dc, //4 | |
27961 | + 0x0a5c, //5 | |
27962 | + 0x0adc, //6 | |
27963 | + 0x0b5c, //7 | |
27964 | + 0x0bdc, //8 | |
27965 | + 0x0c5c, //9 | |
27966 | + 0x0cdc, //10 | |
27967 | + 0x0d5c, //11 | |
27968 | + 0x0ddc, //12 | |
27969 | + 0x0e5c, //13 | |
27970 | + //0x0f5c, //14 | |
27971 | + 0x0f72, // 14 | |
27972 | +}; | |
27973 | +#endif | |
27974 | + | |
27975 | +//- | |
27976 | +u16 rtl8225z2_rxgain[]={ | |
27977 | + 0x0400, 0x0401, 0x0402, 0x0403, 0x0404, 0x0405, 0x0408, 0x0409, | |
27978 | + 0x040a, 0x040b, 0x0502, 0x0503, 0x0504, 0x0505, 0x0540, 0x0541, | |
27979 | + 0x0542, 0x0543, 0x0544, 0x0545, 0x0580, 0x0581, 0x0582, 0x0583, | |
27980 | + 0x0584, 0x0585, 0x0588, 0x0589, 0x058a, 0x058b, 0x0643, 0x0644, | |
27981 | + 0x0645, 0x0680, 0x0681, 0x0682, 0x0683, 0x0684, 0x0685, 0x0688, | |
27982 | + 0x0689, 0x068a, 0x068b, 0x068c, 0x0742, 0x0743, 0x0744, 0x0745, | |
27983 | + 0x0780, 0x0781, 0x0782, 0x0783, 0x0784, 0x0785, 0x0788, 0x0789, | |
27984 | + 0x078a, 0x078b, 0x078c, 0x078d, 0x0790, 0x0791, 0x0792, 0x0793, | |
27985 | + 0x0794, 0x0795, 0x0798, 0x0799, 0x079a, 0x079b, 0x079c, 0x079d, | |
27986 | + 0x07a0, 0x07a1, 0x07a2, 0x07a3, 0x07a4, 0x07a5, 0x07a8, 0x07a9, | |
27987 | + 0x03aa, 0x03ab, 0x03ac, 0x03ad, 0x03b0, 0x03b1, 0x03b2, 0x03b3, | |
27988 | + 0x03b4, 0x03b5, 0x03b8, 0x03b9, 0x03ba, 0x03bb, 0x03bb | |
27989 | + | |
27990 | +}; | |
27991 | + | |
27992 | +//2005.11.16, | |
27993 | +u8 ZEBRA2_CCK_OFDM_GAIN_SETTING[]={ | |
27994 | + 0x00,0x01,0x02,0x03,0x04,0x05, | |
27995 | + 0x06,0x07,0x08,0x09,0x0a,0x0b, | |
27996 | + 0x0c,0x0d,0x0e,0x0f,0x10,0x11, | |
27997 | + 0x12,0x13,0x14,0x15,0x16,0x17, | |
27998 | + 0x18,0x19,0x1a,0x1b,0x1c,0x1d, | |
27999 | + 0x1e,0x1f,0x20,0x21,0x22,0x23, | |
28000 | +}; | |
28001 | + | |
28002 | +#if 0 | |
28003 | +//- | |
28004 | +u8 rtl8225_agc[]={ | |
28005 | + 0x9e,0x9e,0x9e,0x9e,0x9e,0x9e,0x9e,0x9e,0x9d,0x9c,0x9b,0x9a,0x99,0x98,0x97,0x96, | |
28006 | + 0x95,0x94,0x93,0x92,0x91,0x90,0x8f,0x8e,0x8d,0x8c,0x8b,0x8a,0x89,0x88,0x87,0x86, | |
28007 | + 0x85,0x84,0x83,0x82,0x81,0x80,0x3f,0x3e,0x3d,0x3c,0x3b,0x3a,0x39,0x38,0x37,0x36, | |
28008 | + 0x35,0x34,0x33,0x32,0x31,0x30,0x2f,0x2e,0x2d,0x2c,0x2b,0x2a,0x29,0x28,0x27,0x26, | |
28009 | + 0x25,0x24,0x23,0x22,0x21,0x20,0x1f,0x1e,0x1d,0x1c,0x1b,0x1a,0x19,0x18,0x17,0x16, | |
28010 | + 0x15,0x14,0x13,0x12,0x11,0x10,0x0f,0x0e,0x0d,0x0c,0x0b,0x0a,0x09,0x08,0x07,0x06, | |
28011 | + 0x05,0x04,0x03,0x02,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01, | |
28012 | + 0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01, | |
28013 | +}; | |
28014 | +#endif | |
28015 | +/* | |
28016 | + from 0 to 0x23 | |
28017 | +u8 rtl8225_tx_gain_cck_ofdm[]={ | |
28018 | + 0x02,0x06,0x0e,0x1e,0x3e,0x7e | |
28019 | +}; | |
28020 | +*/ | |
28021 | + | |
28022 | +//- | |
28023 | +u8 rtl8225z2_tx_power_ofdm[]={ | |
28024 | + 0x42,0x00,0x40,0x00,0x40 | |
28025 | +}; | |
28026 | + | |
28027 | + | |
28028 | +//- | |
28029 | +u8 rtl8225z2_tx_power_cck_ch14[]={ | |
28030 | + 0x36,0x35,0x2e,0x1b,0x00,0x00,0x00,0x00 | |
28031 | +}; | |
28032 | + | |
28033 | + | |
28034 | +//- | |
28035 | +u8 rtl8225z2_tx_power_cck[]={ | |
28036 | + 0x36,0x35,0x2e,0x25,0x1c,0x12,0x09,0x04 | |
28037 | +}; | |
28038 | + | |
28039 | + | |
28040 | +void rtl8225z2_set_gain(struct net_device *dev, short gain) | |
28041 | +{ | |
28042 | + u8* rtl8225_gain; | |
28043 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
28044 | + | |
28045 | + u8 mode = priv->ieee80211->mode; | |
28046 | + | |
28047 | + if(mode == IEEE_B || mode == IEEE_G) | |
28048 | + rtl8225_gain = rtl8225z2_gain_bg; | |
28049 | + else | |
28050 | + rtl8225_gain = rtl8225z2_gain_a; | |
28051 | + | |
28052 | + //write_phy_ofdm(dev, 0x0d, rtl8225_gain[gain * 3]); | |
28053 | + //write_phy_ofdm(dev, 0x19, rtl8225_gain[gain * 3 + 1]); | |
28054 | + //write_phy_ofdm(dev, 0x1b, rtl8225_gain[gain * 3 + 2]); | |
28055 | + //2005.11.17, by ch-hsu | |
28056 | + write_phy_ofdm(dev, 0x0b, rtl8225_gain[gain * 3]); | |
28057 | + write_phy_ofdm(dev, 0x1b, rtl8225_gain[gain * 3 + 1]); | |
28058 | + write_phy_ofdm(dev, 0x1d, rtl8225_gain[gain * 3 + 2]); | |
28059 | + write_phy_ofdm(dev, 0x21, 0x37); | |
28060 | + | |
28061 | +} | |
28062 | + | |
28063 | +#if 0 | |
28064 | + | |
28065 | +void rtl8225_set_gain(struct net_device *dev, short gain) | |
28066 | +{ | |
28067 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
28068 | + | |
28069 | + rtl8180_set_anaparam(dev, RTL8225_ANAPARAM_ON); | |
28070 | + | |
28071 | + if(priv->card_8185 == 2) | |
28072 | + write_phy_ofdm(dev, 0x21, 0x27); | |
28073 | + else | |
28074 | + write_phy_ofdm(dev, 0x21, 0x37); | |
28075 | + | |
28076 | + write_phy_ofdm(dev, 0x25, 0x20); | |
28077 | + write_phy_ofdm(dev, 0x11, 0x6); | |
28078 | + | |
28079 | + if(priv->card_8185 == 1 && priv->card_8185_Bversion) | |
28080 | + write_phy_ofdm(dev, 0x27, 0x8); | |
28081 | + else | |
28082 | + write_phy_ofdm(dev, 0x27, 0x88); | |
28083 | + | |
28084 | + write_phy_ofdm(dev, 0x14, 0); | |
28085 | + write_phy_ofdm(dev, 0x16, 0); | |
28086 | + write_phy_ofdm(dev, 0x15, 0x40); | |
28087 | + write_phy_ofdm(dev, 0x17, 0x40); | |
28088 | + | |
28089 | + write_phy_ofdm(dev, 0x0d, rtl8225_gain[gain * 4]); | |
28090 | + write_phy_ofdm(dev, 0x23, rtl8225_gain[gain * 4 + 1]); | |
28091 | + write_phy_ofdm(dev, 0x1b, rtl8225_gain[gain * 4 + 2]); | |
28092 | + write_phy_ofdm(dev, 0x1d, rtl8225_gain[gain * 4 + 3]); | |
28093 | + //rtl8225_set_gain_usb(dev, gain); | |
28094 | +} | |
28095 | +#endif | |
28096 | + | |
28097 | +u32 read_rtl8225(struct net_device *dev, u8 adr) | |
28098 | +{ | |
28099 | + u32 data2Write = ((u32)(adr & 0x1f)) << 27; | |
28100 | + u32 dataRead; | |
28101 | + u32 mask; | |
28102 | + u16 oval,oval2,oval3,tmp; | |
28103 | +// ThreeWireReg twreg; | |
28104 | +// ThreeWireReg tdata; | |
28105 | + int i; | |
28106 | + short bit, rw; | |
28107 | + | |
28108 | + u8 wLength = 6; | |
28109 | + u8 rLength = 12; | |
28110 | + u8 low2high = 0; | |
28111 | + | |
28112 | + oval = read_nic_word(dev, RFPinsOutput); | |
28113 | + oval2 = read_nic_word(dev, RFPinsEnable); | |
28114 | + oval3 = read_nic_word(dev, RFPinsSelect); | |
28115 | + | |
28116 | + write_nic_word(dev, RFPinsEnable, (oval2|0xf)); | |
28117 | + write_nic_word(dev, RFPinsSelect, (oval3|0xf)); | |
28118 | + | |
28119 | + dataRead = 0; | |
28120 | + | |
28121 | + oval &= ~0xf; | |
28122 | + | |
28123 | + write_nic_word(dev, RFPinsOutput, oval | BB_HOST_BANG_EN ); udelay(4); | |
28124 | + | |
28125 | + write_nic_word(dev, RFPinsOutput, oval ); udelay(5); | |
28126 | + | |
28127 | + rw = 0; | |
28128 | + | |
28129 | + mask = (low2high) ? 0x01 : (((u32)0x01)<<(32-1)); | |
28130 | + for(i = 0; i < wLength/2; i++) | |
28131 | + { | |
28132 | + bit = ((data2Write&mask) != 0) ? 1 : 0; | |
28133 | + write_nic_word(dev, RFPinsOutput, bit|oval | rw); udelay(1); | |
28134 | + | |
28135 | + write_nic_word(dev, RFPinsOutput, bit|oval | BB_HOST_BANG_CLK | rw); udelay(2); | |
28136 | + write_nic_word(dev, RFPinsOutput, bit|oval | BB_HOST_BANG_CLK | rw); udelay(2); | |
28137 | + | |
28138 | + mask = (low2high) ? (mask<<1): (mask>>1); | |
28139 | + | |
28140 | + if(i == 2) | |
28141 | + { | |
28142 | + rw = BB_HOST_BANG_RW; | |
28143 | + write_nic_word(dev, RFPinsOutput, bit|oval | BB_HOST_BANG_CLK | rw); udelay(2); | |
28144 | + write_nic_word(dev, RFPinsOutput, bit|oval | rw); udelay(2); | |
28145 | + break; | |
28146 | + } | |
28147 | + | |
28148 | + bit = ((data2Write&mask) != 0) ? 1: 0; | |
28149 | + | |
28150 | + write_nic_word(dev, RFPinsOutput, oval|bit|rw| BB_HOST_BANG_CLK); udelay(2); | |
28151 | + write_nic_word(dev, RFPinsOutput, oval|bit|rw| BB_HOST_BANG_CLK); udelay(2); | |
28152 | + | |
28153 | + write_nic_word(dev, RFPinsOutput, oval| bit |rw); udelay(1); | |
28154 | + | |
28155 | + mask = (low2high) ? (mask<<1) : (mask>>1); | |
28156 | + } | |
28157 | + | |
28158 | + //twreg.struc.clk = 0; | |
28159 | + //twreg.struc.data = 0; | |
28160 | + write_nic_word(dev, RFPinsOutput, rw|oval); udelay(2); | |
28161 | + mask = (low2high) ? 0x01 : (((u32)0x01) << (12-1)); | |
28162 | + | |
28163 | + // We must set data pin to HW controled, otherwise RF can't driver it and | |
28164 | + // value RF register won't be able to read back properly. 2006.06.13, by rcnjko. | |
28165 | + write_nic_word(dev, RFPinsEnable, (oval2 & (~0x01))); | |
28166 | + | |
28167 | + for(i = 0; i < rLength; i++) | |
28168 | + { | |
28169 | + write_nic_word(dev, RFPinsOutput, rw|oval); udelay(1); | |
28170 | + | |
28171 | + write_nic_word(dev, RFPinsOutput, rw|oval|BB_HOST_BANG_CLK); udelay(2); | |
28172 | + write_nic_word(dev, RFPinsOutput, rw|oval|BB_HOST_BANG_CLK); udelay(2); | |
28173 | + write_nic_word(dev, RFPinsOutput, rw|oval|BB_HOST_BANG_CLK); udelay(2); | |
28174 | + tmp = read_nic_word(dev, RFPinsInput); | |
28175 | + | |
28176 | + dataRead |= (tmp & BB_HOST_BANG_CLK ? mask : 0); | |
28177 | + | |
28178 | + write_nic_word(dev, RFPinsOutput, (rw|oval)); udelay(2); | |
28179 | + | |
28180 | + mask = (low2high) ? (mask<<1) : (mask>>1); | |
28181 | + } | |
28182 | + | |
28183 | + write_nic_word(dev, RFPinsOutput, BB_HOST_BANG_EN|BB_HOST_BANG_RW|oval); udelay(2); | |
28184 | + | |
28185 | + write_nic_word(dev, RFPinsEnable, oval2); | |
28186 | + write_nic_word(dev, RFPinsSelect, oval3); // Set To SW Switch | |
28187 | + write_nic_word(dev, RFPinsOutput, 0x3a0); | |
28188 | + | |
28189 | + return dataRead; | |
28190 | + | |
28191 | +} | |
28192 | +#if 0 | |
28193 | +void write_rtl8225(struct net_device *dev, u8 adr, u16 data) | |
28194 | +{ | |
28195 | + int i; | |
28196 | + u16 out,select; | |
28197 | + u8 bit; | |
28198 | + u32 bangdata = (data << 4) | (adr & 0xf); | |
28199 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
28200 | + | |
28201 | + out = read_nic_word(dev, RFPinsOutput) & 0xfff3; | |
28202 | + | |
28203 | + write_nic_word(dev,RFPinsEnable, | |
28204 | + (read_nic_word(dev,RFPinsEnable) | 0x7)); | |
28205 | + | |
28206 | + select = read_nic_word(dev, RFPinsSelect); | |
28207 | + | |
28208 | + write_nic_word(dev, RFPinsSelect, select | 0x7 | | |
28209 | + ((priv->card_type == USB) ? 0 : SW_CONTROL_GPIO)); | |
28210 | + | |
28211 | + force_pci_posting(dev); | |
28212 | + udelay(10); | |
28213 | + | |
28214 | + write_nic_word(dev, RFPinsOutput, out | BB_HOST_BANG_EN );//| 0x1fff); | |
28215 | + | |
28216 | + force_pci_posting(dev); | |
28217 | + udelay(2); | |
28218 | + | |
28219 | + write_nic_word(dev, RFPinsOutput, out); | |
28220 | + | |
28221 | + force_pci_posting(dev); | |
28222 | + udelay(10); | |
28223 | + | |
28224 | + | |
28225 | + for(i=15; i>=0;i--){ | |
28226 | + | |
28227 | + bit = (bangdata & (1<<i)) >> i; | |
28228 | + | |
28229 | + write_nic_word(dev, RFPinsOutput, bit | out); | |
28230 | + | |
28231 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
28232 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
28233 | + | |
28234 | + i--; | |
28235 | + bit = (bangdata & (1<<i)) >> i; | |
28236 | + | |
28237 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
28238 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
28239 | + | |
28240 | + write_nic_word(dev, RFPinsOutput, bit | out); | |
28241 | + | |
28242 | + } | |
28243 | + | |
28244 | + write_nic_word(dev, RFPinsOutput, out | BB_HOST_BANG_EN); | |
28245 | + | |
28246 | + force_pci_posting(dev); | |
28247 | + udelay(10); | |
28248 | + | |
28249 | + write_nic_word(dev, RFPinsOutput, out | | |
28250 | + ((priv->card_type == USB) ? 4 : BB_HOST_BANG_EN)); | |
28251 | + | |
28252 | + write_nic_word(dev, RFPinsSelect, select | | |
28253 | + ((priv->card_type == USB) ? 0 : SW_CONTROL_GPIO)); | |
28254 | + | |
28255 | + if(priv->card_type == USB) | |
28256 | + mdelay(2); | |
28257 | + else | |
28258 | + rtl8185_rf_pins_enable(dev); | |
28259 | +} | |
28260 | + | |
28261 | +#endif | |
28262 | +short rtl8225_is_V_z2(struct net_device *dev) | |
28263 | +{ | |
28264 | + short vz2 = 1; | |
28265 | + //int i; | |
28266 | + /* sw to reg pg 1 */ | |
28267 | + //write_rtl8225(dev, 0, 0x1b7); | |
28268 | + //write_rtl8225(dev, 0, 0x0b7); | |
28269 | + | |
28270 | + /* reg 8 pg 1 = 23*/ | |
28271 | + //printk(KERN_WARNING "RF Rigisters:\n"); | |
28272 | +#if 0 | |
28273 | + for(i = 0; i <= 0xf; i++) | |
28274 | + printk(KERN_WARNING "%08x,", read_rtl8225(dev, i)); | |
28275 | + //printk(KERN_WARNING "reg[9]@pg1 = 0x%x\n", read_rtl8225(dev, 0x0F)); | |
28276 | + | |
28277 | +// printk(KERN_WARNING "RF:\n"); | |
28278 | +#endif | |
28279 | + if( read_rtl8225(dev, 8) != 0x588) | |
28280 | + vz2 = 0; | |
28281 | + | |
28282 | + else /* reg 9 pg 1 = 24 */ | |
28283 | + if( read_rtl8225(dev, 9) != 0x700) | |
28284 | + vz2 = 0; | |
28285 | + | |
28286 | + /* sw back to pg 0 */ | |
28287 | + write_rtl8225(dev, 0, 0xb7); | |
28288 | + | |
28289 | + return vz2; | |
28290 | + | |
28291 | +} | |
28292 | + | |
28293 | +#if 0 | |
28294 | +void rtl8225_rf_close(struct net_device *dev) | |
28295 | +{ | |
28296 | + write_rtl8225(dev, 0x4, 0x1f); | |
28297 | + | |
28298 | + force_pci_posting(dev); | |
28299 | + mdelay(1); | |
28300 | + | |
28301 | + rtl8180_set_anaparam(dev, RTL8225_ANAPARAM_OFF); | |
28302 | + rtl8185_set_anaparam2(dev, RTL8225_ANAPARAM2_OFF); | |
28303 | +} | |
28304 | +#endif | |
28305 | +#if 0 | |
28306 | +short rtl8225_rf_set_sens(struct net_device *dev, short sens) | |
28307 | +{ | |
28308 | + if (sens <0 || sens > 6) return -1; | |
28309 | + | |
28310 | + if(sens > 4) | |
28311 | + write_rtl8225(dev, 0x0c, 0x850); | |
28312 | + else | |
28313 | + write_rtl8225(dev, 0x0c, 0x50); | |
28314 | + | |
28315 | + sens= 6-sens; | |
28316 | + rtl8225_set_gain(dev, sens); | |
28317 | + | |
28318 | + write_phy_cck(dev, 0x41, rtl8225_threshold[sens]); | |
28319 | + return 0; | |
28320 | + | |
28321 | +} | |
28322 | +#endif | |
28323 | + | |
28324 | + | |
28325 | +void rtl8225z2_rf_close(struct net_device *dev) | |
28326 | +{ | |
28327 | + RF_WriteReg(dev, 0x4, 0x1f); | |
28328 | + | |
28329 | + force_pci_posting(dev); | |
28330 | + mdelay(1); | |
28331 | + | |
28332 | + rtl8180_set_anaparam(dev, RTL8225z2_ANAPARAM_OFF); | |
28333 | + rtl8185_set_anaparam2(dev, RTL8225z2_ANAPARAM2_OFF); | |
28334 | +} | |
28335 | + | |
28336 | +#ifdef ENABLE_DOT11D | |
28337 | +// | |
28338 | +// Description: | |
28339 | +// Map dBm into Tx power index according to | |
28340 | +// current HW model, for example, RF and PA, and | |
28341 | +// current wireless mode. | |
28342 | +// | |
28343 | +s8 | |
28344 | +DbmToTxPwrIdx( | |
28345 | + struct r8180_priv *priv, | |
28346 | + WIRELESS_MODE WirelessMode, | |
28347 | + s32 PowerInDbm | |
28348 | + ) | |
28349 | +{ | |
28350 | + bool bUseDefault = true; | |
28351 | + s8 TxPwrIdx = 0; | |
28352 | + | |
28353 | +#ifdef CONFIG_RTL818X_S | |
28354 | + // | |
28355 | + // 071011, SD3 SY: | |
28356 | + // OFDM Power in dBm = Index * 0.5 + 0 | |
28357 | + // CCK Power in dBm = Index * 0.25 + 13 | |
28358 | + // | |
28359 | + if(priv->card_8185 >= VERSION_8187S_B) | |
28360 | + { | |
28361 | + s32 tmp = 0; | |
28362 | + | |
28363 | + if(WirelessMode == WIRELESS_MODE_G) | |
28364 | + { | |
28365 | + bUseDefault = false; | |
28366 | + tmp = (2 * PowerInDbm); | |
28367 | + | |
28368 | + if(tmp < 0) | |
28369 | + TxPwrIdx = 0; | |
28370 | + else if(tmp > 40) // 40 means 20 dBm. | |
28371 | + TxPwrIdx = 40; | |
28372 | + else | |
28373 | + TxPwrIdx = (s8)tmp; | |
28374 | + } | |
28375 | + else if(WirelessMode == WIRELESS_MODE_B) | |
28376 | + { | |
28377 | + bUseDefault = false; | |
28378 | + tmp = (4 * PowerInDbm) - 52; | |
28379 | + | |
28380 | + if(tmp < 0) | |
28381 | + TxPwrIdx = 0; | |
28382 | + else if(tmp > 28) // 28 means 20 dBm. | |
28383 | + TxPwrIdx = 28; | |
28384 | + else | |
28385 | + TxPwrIdx = (s8)tmp; | |
28386 | + } | |
28387 | + } | |
28388 | +#endif | |
28389 | + | |
28390 | + // | |
28391 | + // TRUE if we want to use a default implementation. | |
28392 | + // We shall set it to FALSE when we have exact translation formular | |
28393 | + // for target IC. 070622, by rcnjko. | |
28394 | + // | |
28395 | + if(bUseDefault) | |
28396 | + { | |
28397 | + if(PowerInDbm < 0) | |
28398 | + TxPwrIdx = 0; | |
28399 | + else if(PowerInDbm > 35) | |
28400 | + TxPwrIdx = 35; | |
28401 | + else | |
28402 | + TxPwrIdx = (u8)PowerInDbm; | |
28403 | + } | |
28404 | + | |
28405 | + return TxPwrIdx; | |
28406 | +} | |
28407 | +#endif | |
28408 | + | |
28409 | +void rtl8225z2_SetTXPowerLevel(struct net_device *dev, short ch) | |
28410 | +{ | |
28411 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
28412 | + | |
28413 | +// int GainIdx; | |
28414 | +// int GainSetting; | |
28415 | + //int i; | |
28416 | + //u8 power; | |
28417 | + //u8 *cck_power_table; | |
28418 | + u8 max_cck_power_level; | |
28419 | + //u8 min_cck_power_level; | |
28420 | + u8 max_ofdm_power_level; | |
28421 | + u8 min_ofdm_power_level; | |
28422 | +// u8 cck_power_level = 0xff & priv->chtxpwr[ch];//-by amy 080312 | |
28423 | +// u8 ofdm_power_level = 0xff & priv->chtxpwr_ofdm[ch];//-by amy 080312 | |
28424 | + char cck_power_level = (char)(0xff & priv->chtxpwr[ch]);//+by amy 080312 | |
28425 | + char ofdm_power_level = (char)(0xff & priv->chtxpwr_ofdm[ch]);//+by amy 080312 | |
28426 | +#if 0 | |
28427 | + // | |
28428 | + // CCX 2 S31, AP control of client transmit power: | |
28429 | + // 1. We shall not exceed Cell Power Limit as possible as we can. | |
28430 | + // 2. Tolerance is +/- 5dB. | |
28431 | + // 3. 802.11h Power Contraint takes higher precedence over CCX Cell Power Limit. | |
28432 | + // | |
28433 | + // TODO: | |
28434 | + // 1. 802.11h power contraint | |
28435 | + // | |
28436 | + // 071011, by rcnjko. | |
28437 | + // | |
28438 | + if( priv->OpMode == RT_OP_MODE_INFRASTRUCTURE && | |
28439 | + priv->bWithCcxCellPwr && | |
28440 | + ch == priv->dot11CurrentChannelNumber) | |
28441 | + { | |
28442 | + u8 CckCellPwrIdx = DbmToTxPwrIdx(dev, WIRELESS_MODE_B, pMgntInfo->CcxCellPwr); | |
28443 | + u8 OfdmCellPwrIdx = DbmToTxPwrIdx(dev, WIRELESS_MODE_G, pMgntInfo->CcxCellPwr); | |
28444 | + | |
28445 | + printk("CCX Cell Limit: %d dBm => CCK Tx power index : %d, OFDM Tx power index: %d\n", | |
28446 | + priv->CcxCellPwr, CckCellPwrIdx, OfdmCellPwrIdx); | |
28447 | + printk("EEPROM channel(%d) => CCK Tx power index: %d, OFDM Tx power index: %d\n", | |
28448 | + channel, CckTxPwrIdx, OfdmTxPwrIdx); | |
28449 | + | |
28450 | + if(cck_power_level > CckCellPwrIdx) | |
28451 | + cck_power_level = CckCellPwrIdx; | |
28452 | + if(ofdm_power_level > OfdmCellPwrIdx) | |
28453 | + ofdm_power_level = OfdmCellPwrIdx; | |
28454 | + | |
28455 | + printk("Altered CCK Tx power index : %d, OFDM Tx power index: %d\n", | |
28456 | + CckTxPwrIdx, OfdmTxPwrIdx); | |
28457 | + } | |
28458 | +#endif | |
28459 | +#ifdef ENABLE_DOT11D | |
28460 | + if(IS_DOT11D_ENABLE(priv->ieee80211) && | |
28461 | + IS_DOT11D_STATE_DONE(priv->ieee80211) ) | |
28462 | + { | |
28463 | + //PRT_DOT11D_INFO pDot11dInfo = GET_DOT11D_INFO(priv->ieee80211); | |
28464 | + u8 MaxTxPwrInDbm = DOT11D_GetMaxTxPwrInDbm(priv->ieee80211, ch); | |
28465 | + u8 CckMaxPwrIdx = DbmToTxPwrIdx(priv, WIRELESS_MODE_B, MaxTxPwrInDbm); | |
28466 | + u8 OfdmMaxPwrIdx = DbmToTxPwrIdx(priv, WIRELESS_MODE_G, MaxTxPwrInDbm); | |
28467 | + | |
28468 | + //printk("Max Tx Power dBm (%d) => CCK Tx power index : %d, OFDM Tx power index: %d\n", MaxTxPwrInDbm, CckMaxPwrIdx, OfdmMaxPwrIdx); | |
28469 | + | |
28470 | + //printk("EEPROM channel(%d) => CCK Tx power index: %d, OFDM Tx power index: %d\n", | |
28471 | + // ch, cck_power_level, ofdm_power_level); | |
28472 | + | |
28473 | + if(cck_power_level > CckMaxPwrIdx) | |
28474 | + cck_power_level = CckMaxPwrIdx; | |
28475 | + if(ofdm_power_level > OfdmMaxPwrIdx) | |
28476 | + ofdm_power_level = OfdmMaxPwrIdx; | |
28477 | + } | |
28478 | + | |
28479 | + //priv->CurrentCckTxPwrIdx = cck_power_level; | |
28480 | + //priv->CurrentOfdmTxPwrIdx = ofdm_power_level; | |
28481 | +#endif | |
28482 | + | |
28483 | + max_cck_power_level = 15; | |
28484 | + max_ofdm_power_level = 25; // 12 -> 25 | |
28485 | + min_ofdm_power_level = 10; | |
28486 | + | |
28487 | +#ifdef CONFIG_RTL8185B | |
28488 | +#ifdef CONFIG_RTL818X_S | |
28489 | + | |
28490 | + if(cck_power_level > 35) | |
28491 | + { | |
28492 | + cck_power_level = 35; | |
28493 | + } | |
28494 | + // | |
28495 | + // Set up CCK TXAGC. suggested by SD3 SY. | |
28496 | + // | |
28497 | + write_nic_byte(dev, CCK_TXAGC, (ZEBRA2_CCK_OFDM_GAIN_SETTING[(u8)cck_power_level]) ); | |
28498 | + //printk("CCK TX power is %x\n", (ZEBRA2_CCK_OFDM_GAIN_SETTING[cck_power_level])); | |
28499 | + force_pci_posting(dev); | |
28500 | + mdelay(1); | |
28501 | +#else | |
28502 | + | |
28503 | + /* CCK power setting */ | |
28504 | + if(cck_power_level > max_cck_power_level) | |
28505 | + cck_power_level = max_cck_power_level; | |
28506 | + | |
28507 | + cck_power_level += priv->cck_txpwr_base; | |
28508 | + | |
28509 | + if(cck_power_level > 35) | |
28510 | + cck_power_level = 35; | |
28511 | + | |
28512 | + if(ch == 14) | |
28513 | + cck_power_table = rtl8225z2_tx_power_cck_ch14; | |
28514 | + else | |
28515 | + cck_power_table = rtl8225z2_tx_power_cck; | |
28516 | + | |
28517 | + | |
28518 | + for(i=0;i<8;i++){ | |
28519 | + | |
28520 | + power = cck_power_table[i]; | |
28521 | + write_phy_cck(dev, 0x44 + i, power); | |
28522 | + } | |
28523 | + | |
28524 | + //write_nic_byte(dev, TX_GAIN_CCK, power); | |
28525 | + //2005.11.17, | |
28526 | + write_nic_byte(dev, CCK_TXAGC, ZEBRA2_CCK_OFDM_GAIN_SETTING[(u8)cck_power_level]); | |
28527 | + | |
28528 | + force_pci_posting(dev); | |
28529 | + mdelay(1); | |
28530 | +#endif | |
28531 | +#endif | |
28532 | + /* OFDM power setting */ | |
28533 | +// Old: | |
28534 | +// if(ofdm_power_level > max_ofdm_power_level) | |
28535 | +// ofdm_power_level = 35; | |
28536 | +// ofdm_power_level += min_ofdm_power_level; | |
28537 | +// Latest: | |
28538 | +/* if(ofdm_power_level > (max_ofdm_power_level - min_ofdm_power_level)) | |
28539 | + ofdm_power_level = max_ofdm_power_level; | |
28540 | + else | |
28541 | + ofdm_power_level += min_ofdm_power_level; | |
28542 | + | |
28543 | + ofdm_power_level += priv->ofdm_txpwr_base; | |
28544 | +*/ | |
28545 | + if(ofdm_power_level > 35) | |
28546 | + ofdm_power_level = 35; | |
28547 | + | |
28548 | +// rtl8185_set_anaparam2(dev,RTL8225_ANAPARAM2_ON); | |
28549 | + | |
28550 | + //rtl8185_set_anaparam2(dev, ANAPARM2_ASIC_ON); | |
28551 | + | |
28552 | + if (priv->up == 0) { | |
28553 | + //must add these for rtl8185B down, xiong-2006-11-21 | |
28554 | + write_phy_ofdm(dev,2,0x42); | |
28555 | + write_phy_ofdm(dev,5,0); | |
28556 | + write_phy_ofdm(dev,6,0x40); | |
28557 | + write_phy_ofdm(dev,7,0); | |
28558 | + write_phy_ofdm(dev,8,0x40); | |
28559 | + } | |
28560 | + | |
28561 | + //write_nic_byte(dev, TX_GAIN_OFDM, ofdm_power_level); | |
28562 | + //2005.11.17, | |
28563 | +#ifdef CONFIG_RTL818X_S | |
28564 | + write_nic_byte(dev, OFDM_TXAGC, ZEBRA2_CCK_OFDM_GAIN_SETTING[(u8)ofdm_power_level]); | |
28565 | +#else | |
28566 | + write_nic_byte(dev, OFDM_TXAGC, ZEBRA2_CCK_OFDM_GAIN_SETTING[(u8)ofdm_power_level]*2); | |
28567 | +#endif | |
28568 | + if(ofdm_power_level<=11) | |
28569 | + { | |
28570 | +// write_nic_dword(dev,PHY_ADR,0x00005c87); | |
28571 | +// write_nic_dword(dev,PHY_ADR,0x00005c89); | |
28572 | + write_phy_ofdm(dev,0x07,0x5c); | |
28573 | + write_phy_ofdm(dev,0x09,0x5c); | |
28574 | + } | |
28575 | + if(ofdm_power_level<=17) | |
28576 | + { | |
28577 | +// write_nic_dword(dev,PHY_ADR,0x00005487); | |
28578 | +// write_nic_dword(dev,PHY_ADR,0x00005489); | |
28579 | + write_phy_ofdm(dev,0x07,0x54); | |
28580 | + write_phy_ofdm(dev,0x09,0x54); | |
28581 | + } | |
28582 | + else | |
28583 | + { | |
28584 | +// write_nic_dword(dev,PHY_ADR,0x00005087); | |
28585 | +// write_nic_dword(dev,PHY_ADR,0x00005089); | |
28586 | + write_phy_ofdm(dev,0x07,0x50); | |
28587 | + write_phy_ofdm(dev,0x09,0x50); | |
28588 | + } | |
28589 | + force_pci_posting(dev); | |
28590 | + mdelay(1); | |
28591 | + | |
28592 | +} | |
28593 | +#if 0 | |
28594 | +/* switch between mode B and G */ | |
28595 | +void rtl8225_set_mode(struct net_device *dev, short modeb) | |
28596 | +{ | |
28597 | + write_phy_ofdm(dev, 0x15, (modeb ? 0x0 : 0x40)); | |
28598 | + write_phy_ofdm(dev, 0x17, (modeb ? 0x0 : 0x40)); | |
28599 | +} | |
28600 | +#endif | |
28601 | + | |
28602 | +void rtl8225z2_rf_set_chan(struct net_device *dev, short ch) | |
28603 | +{ | |
28604 | +/* | |
28605 | + short gset = (priv->ieee80211->state == IEEE80211_LINKED && | |
28606 | + ieee80211_is_54g(priv->ieee80211->current_network)) || | |
28607 | + priv->ieee80211->iw_mode == IW_MODE_MONITOR; | |
28608 | +*/ | |
28609 | + rtl8225z2_SetTXPowerLevel(dev, ch); | |
28610 | + | |
28611 | + RF_WriteReg(dev, 0x7, rtl8225_chan[ch]); | |
28612 | + | |
28613 | + //YJ,add,080828, if set channel failed, write again | |
28614 | + if((RF_ReadReg(dev, 0x7) & 0x0F80) != rtl8225_chan[ch]) | |
28615 | + { | |
28616 | + RF_WriteReg(dev, 0x7, rtl8225_chan[ch]); | |
28617 | + } | |
28618 | + | |
28619 | + mdelay(1); | |
28620 | + | |
28621 | + force_pci_posting(dev); | |
28622 | + mdelay(10); | |
28623 | +//deleted by David : 2006/8/9 | |
28624 | +#if 0 | |
28625 | + write_nic_byte(dev,SIFS,0x22);// SIFS: 0x22 | |
28626 | + | |
28627 | + if(gset) | |
28628 | + write_nic_byte(dev,DIFS,20); //DIFS: 20 | |
28629 | + else | |
28630 | + write_nic_byte(dev,DIFS,0x24); //DIFS: 36 | |
28631 | + | |
28632 | + if(priv->ieee80211->state == IEEE80211_LINKED && | |
28633 | + ieee80211_is_shortslot(priv->ieee80211->current_network)) | |
28634 | + write_nic_byte(dev,SLOT,0x9); //SLOT: 9 | |
28635 | + | |
28636 | + else | |
28637 | + write_nic_byte(dev,SLOT,0x14); //SLOT: 20 (0x14) | |
28638 | + | |
28639 | + | |
28640 | + if(gset){ | |
28641 | + write_nic_byte(dev,EIFS,91 - 20); // EIFS: 91 (0x5B) | |
28642 | + write_nic_byte(dev,CW_VAL,0x73); //CW VALUE: 0x37 | |
28643 | + //DMESG("using G net params"); | |
28644 | + }else{ | |
28645 | + write_nic_byte(dev,EIFS,91 - 0x24); // EIFS: 91 (0x5B) | |
28646 | + write_nic_byte(dev,CW_VAL,0xa5); //CW VALUE: 0x37 | |
28647 | + //DMESG("using B net params"); | |
28648 | + } | |
28649 | +#endif | |
28650 | + | |
28651 | +} | |
28652 | +#if 0 | |
28653 | +void rtl8225_host_pci_init(struct net_device *dev) | |
28654 | +{ | |
28655 | + write_nic_word(dev, RFPinsOutput, 0x480); | |
28656 | + | |
28657 | + rtl8185_rf_pins_enable(dev); | |
28658 | + | |
28659 | + //if(priv->card_8185 == 2 && priv->enable_gpio0 ) /* version D */ | |
28660 | + //write_nic_word(dev, RFPinsSelect, 0x88); | |
28661 | + //else | |
28662 | + write_nic_word(dev, RFPinsSelect, 0x88 | SW_CONTROL_GPIO); /* 0x488 | SW_CONTROL_GPIO */ | |
28663 | + | |
28664 | + write_nic_byte(dev, GP_ENABLE, 0); | |
28665 | + | |
28666 | + force_pci_posting(dev); | |
28667 | + mdelay(200); | |
28668 | + | |
28669 | + write_nic_word(dev, GP_ENABLE, 0xff & (~(1<<6))); /* bit 6 is for RF on/off detection */ | |
28670 | + | |
28671 | + | |
28672 | +} | |
28673 | + | |
28674 | +void rtl8225_host_usb_init(struct net_device *dev) | |
28675 | +{ | |
28676 | + write_nic_byte(dev,RFPinsSelect+1,0); | |
28677 | + | |
28678 | + write_nic_byte(dev,GPIO,0); | |
28679 | + | |
28680 | + write_nic_byte_E(dev,0x53,read_nic_byte_E(dev,0x53) | (1<<7)); | |
28681 | + | |
28682 | + write_nic_byte(dev,RFPinsSelect+1,4); | |
28683 | + | |
28684 | + write_nic_byte(dev,GPIO,0x20); | |
28685 | + | |
28686 | + write_nic_byte(dev,GP_ENABLE,0); | |
28687 | + | |
28688 | + | |
28689 | + /* Config BB & RF */ | |
28690 | + write_nic_word(dev, RFPinsOutput, 0x80); | |
28691 | + | |
28692 | + write_nic_word(dev, RFPinsSelect, 0x80); | |
28693 | + | |
28694 | + write_nic_word(dev, RFPinsEnable, 0x80); | |
28695 | + | |
28696 | + | |
28697 | + mdelay(100); | |
28698 | + | |
28699 | + mdelay(1000); | |
28700 | + | |
28701 | +} | |
28702 | +#endif | |
28703 | +void rtl8225z2_rf_init(struct net_device *dev) | |
28704 | +{ | |
28705 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
28706 | + int i; | |
28707 | + short channel = 1; | |
28708 | + u16 brsr; | |
28709 | + u32 data,addr; | |
28710 | + | |
28711 | + priv->chan = channel; | |
28712 | + | |
28713 | +// rtl8180_set_anaparam(dev, RTL8225_ANAPARAM_ON); | |
28714 | + | |
28715 | + | |
28716 | + if(priv->card_type == USB) | |
28717 | + rtl8225_host_usb_init(dev); | |
28718 | + else | |
28719 | + rtl8225_host_pci_init(dev); | |
28720 | + | |
28721 | + write_nic_dword(dev, RF_TIMING, 0x000a8008); | |
28722 | + | |
28723 | + brsr = read_nic_word(dev, BRSR); | |
28724 | + | |
28725 | + write_nic_word(dev, BRSR, 0xffff); | |
28726 | + | |
28727 | + | |
28728 | + write_nic_dword(dev, RF_PARA, 0x100044); | |
28729 | + | |
28730 | + #if 1 //0->1 | |
28731 | + rtl8180_set_mode(dev, EPROM_CMD_CONFIG); | |
28732 | + write_nic_byte(dev, CONFIG3, 0x44); | |
28733 | + rtl8180_set_mode(dev, EPROM_CMD_NORMAL); | |
28734 | + #endif | |
28735 | + | |
28736 | + | |
28737 | + rtl8185_rf_pins_enable(dev); | |
28738 | + | |
28739 | +// mdelay(1000); | |
28740 | + | |
28741 | + write_rtl8225(dev, 0x0, 0x2bf); mdelay(1); | |
28742 | + | |
28743 | + | |
28744 | + write_rtl8225(dev, 0x1, 0xee0); mdelay(1); | |
28745 | + | |
28746 | + write_rtl8225(dev, 0x2, 0x44d); mdelay(1); | |
28747 | + | |
28748 | + write_rtl8225(dev, 0x3, 0x441); mdelay(1); | |
28749 | + | |
28750 | + | |
28751 | + write_rtl8225(dev, 0x4, 0x8c3);mdelay(1); | |
28752 | + | |
28753 | + | |
28754 | + | |
28755 | + write_rtl8225(dev, 0x5, 0xc72);mdelay(1); | |
28756 | +// } | |
28757 | + | |
28758 | + write_rtl8225(dev, 0x6, 0xe6); mdelay(1); | |
28759 | + | |
28760 | + write_rtl8225(dev, 0x7, ((priv->card_type == USB)? 0x82a : rtl8225_chan[channel])); mdelay(1); | |
28761 | + | |
28762 | + write_rtl8225(dev, 0x8, 0x3f); mdelay(1); | |
28763 | + | |
28764 | + write_rtl8225(dev, 0x9, 0x335); mdelay(1); | |
28765 | + | |
28766 | + write_rtl8225(dev, 0xa, 0x9d4); mdelay(1); | |
28767 | + | |
28768 | + write_rtl8225(dev, 0xb, 0x7bb); mdelay(1); | |
28769 | + | |
28770 | + write_rtl8225(dev, 0xc, 0x850); mdelay(1); | |
28771 | + | |
28772 | + | |
28773 | + write_rtl8225(dev, 0xd, 0xcdf); mdelay(1); | |
28774 | + | |
28775 | + write_rtl8225(dev, 0xe, 0x2b); mdelay(1); | |
28776 | + | |
28777 | + write_rtl8225(dev, 0xf, 0x114); | |
28778 | + | |
28779 | + | |
28780 | + mdelay(100); | |
28781 | + | |
28782 | + | |
28783 | + //if(priv->card_type != USB) /* maybe not needed even for 8185 */ | |
28784 | +// write_rtl8225(dev, 0x7, rtl8225_chan[channel]); | |
28785 | + | |
28786 | + write_rtl8225(dev, 0x0, 0x1b7); | |
28787 | + | |
28788 | + for(i=0;i<95;i++){ | |
28789 | + write_rtl8225(dev, 0x1, (u8)(i+1)); | |
28790 | + | |
28791 | + #if 0 | |
28792 | + if(priv->phy_ver == 1) | |
28793 | + /* version A */ | |
28794 | + write_rtl8225(dev, 0x2, rtl8225a_rxgain[i]); | |
28795 | + else | |
28796 | + #endif | |
28797 | + /* version B & C & D*/ | |
28798 | + | |
28799 | + write_rtl8225(dev, 0x2, rtl8225z2_rxgain[i]); | |
28800 | + } | |
28801 | + write_rtl8225(dev, 0x3, 0x80); | |
28802 | + write_rtl8225(dev, 0x5, 0x4); | |
28803 | + | |
28804 | + write_rtl8225(dev, 0x0, 0xb7); | |
28805 | + | |
28806 | + write_rtl8225(dev, 0x2, 0xc4d); | |
28807 | + | |
28808 | + if(priv->card_type == USB){ | |
28809 | + // force_pci_posting(dev); | |
28810 | + mdelay(200); | |
28811 | + | |
28812 | + write_rtl8225(dev, 0x2, 0x44d); | |
28813 | + | |
28814 | + // force_pci_posting(dev); | |
28815 | + mdelay(100); | |
28816 | + | |
28817 | + }//End of if(priv->card_type == USB) | |
28818 | + /* FIXME!! rtl8187 we have to check if calibrarion | |
28819 | + * is successful and eventually cal. again (repeat | |
28820 | + * the two write on reg 2) | |
28821 | + */ | |
28822 | + // Check for calibration status, 2005.11.17, | |
28823 | + data = read_rtl8225(dev, 6); | |
28824 | + if (!(data&0x00000080)) | |
28825 | + { | |
28826 | + write_rtl8225(dev, 0x02, 0x0c4d); | |
28827 | + force_pci_posting(dev); mdelay(200); | |
28828 | + write_rtl8225(dev, 0x02, 0x044d); | |
28829 | + force_pci_posting(dev); mdelay(100); | |
28830 | + data = read_rtl8225(dev, 6); | |
28831 | + if (!(data&0x00000080)) | |
28832 | + { | |
28833 | + DMESGW("RF Calibration Failed!!!!\n"); | |
28834 | + } | |
28835 | + } | |
28836 | + //force_pci_posting(dev); | |
28837 | + | |
28838 | + mdelay(200); //200 for 8187 | |
28839 | + | |
28840 | + | |
28841 | +// //if(priv->card_type != USB){ | |
28842 | +// write_rtl8225(dev, 0x2, 0x44d); | |
28843 | +// write_rtl8225(dev, 0x7, rtl8225_chan[channel]); | |
28844 | +// write_rtl8225(dev, 0x2, 0x47d); | |
28845 | +// | |
28846 | +// force_pci_posting(dev); | |
28847 | +// mdelay(100); | |
28848 | +// | |
28849 | +// write_rtl8225(dev, 0x2, 0x44d); | |
28850 | +// //} | |
28851 | + | |
28852 | + write_rtl8225(dev, 0x0, 0x2bf); | |
28853 | + | |
28854 | + if(priv->card_type != USB) | |
28855 | + rtl8185_rf_pins_enable(dev); | |
28856 | + //set up ZEBRA AGC table, 2005.11.17, | |
28857 | + for(i=0;i<128;i++){ | |
28858 | + data = rtl8225_agc[i]; | |
28859 | + | |
28860 | + addr = i + 0x80; //enable writing AGC table | |
28861 | + write_phy_ofdm(dev, 0xb, data); | |
28862 | + | |
28863 | + mdelay(1); | |
28864 | + write_phy_ofdm(dev, 0xa, addr); | |
28865 | + | |
28866 | + mdelay(1); | |
28867 | + } | |
28868 | +#if 0 | |
28869 | + for(i=0;i<128;i++){ | |
28870 | + write_phy_ofdm(dev, 0xb, rtl8225_agc[i]); | |
28871 | + | |
28872 | + mdelay(1); | |
28873 | + write_phy_ofdm(dev, 0xa, (u8)i+ 0x80); | |
28874 | + | |
28875 | + mdelay(1); | |
28876 | + } | |
28877 | +#endif | |
28878 | + | |
28879 | + force_pci_posting(dev); | |
28880 | + mdelay(1); | |
28881 | + | |
28882 | + write_phy_ofdm(dev, 0x0, 0x1); mdelay(1); | |
28883 | + write_phy_ofdm(dev, 0x1, 0x2); mdelay(1); | |
28884 | + write_phy_ofdm(dev, 0x2, ((priv->card_type == USB)? 0x42 : 0x62)); mdelay(1); | |
28885 | + write_phy_ofdm(dev, 0x3, 0x0); mdelay(1); | |
28886 | + write_phy_ofdm(dev, 0x4, 0x0); mdelay(1); | |
28887 | + write_phy_ofdm(dev, 0x5, 0x0); mdelay(1); | |
28888 | + write_phy_ofdm(dev, 0x6, 0x40); mdelay(1); | |
28889 | + write_phy_ofdm(dev, 0x7, 0x0); mdelay(1); | |
28890 | + write_phy_ofdm(dev, 0x8, 0x40); mdelay(1); | |
28891 | + write_phy_ofdm(dev, 0x9, 0xfe); mdelay(1); | |
28892 | + | |
28893 | + write_phy_ofdm(dev, 0xa, 0x8); mdelay(1); | |
28894 | + | |
28895 | + //write_phy_ofdm(dev, 0x18, 0xef); | |
28896 | + // } | |
28897 | + //} | |
28898 | + write_phy_ofdm(dev, 0xb, 0x80); mdelay(1); | |
28899 | + | |
28900 | + write_phy_ofdm(dev, 0xc, 0x1);mdelay(1); | |
28901 | + | |
28902 | + | |
28903 | + //if(priv->card_type != USB) | |
28904 | + write_phy_ofdm(dev, 0xd, 0x43); | |
28905 | + | |
28906 | + write_phy_ofdm(dev, 0xe, 0xd3);mdelay(1); | |
28907 | + | |
28908 | + | |
28909 | + #if 0 | |
28910 | + if(priv->card_8185 == 1){ | |
28911 | + if(priv->card_8185_Bversion) | |
28912 | + write_phy_ofdm(dev, 0xf, 0x20);/*ver B*/ | |
28913 | + else | |
28914 | + write_phy_ofdm(dev, 0xf, 0x28);/*ver C*/ | |
28915 | + }else{ | |
28916 | + #endif | |
28917 | + write_phy_ofdm(dev, 0xf, 0x38);mdelay(1); | |
28918 | +/*ver D & 8187*/ | |
28919 | +// } | |
28920 | + | |
28921 | +// if(priv->card_8185 == 1 && priv->card_8185_Bversion) | |
28922 | +// write_phy_ofdm(dev, 0x10, 0x04);/*ver B*/ | |
28923 | +// else | |
28924 | + write_phy_ofdm(dev, 0x10, 0x84);mdelay(1); | |
28925 | +/*ver C & D & 8187*/ | |
28926 | + | |
28927 | + write_phy_ofdm(dev, 0x11, 0x07);mdelay(1); | |
28928 | +/*agc resp time 700*/ | |
28929 | + | |
28930 | + | |
28931 | +// if(priv->card_8185 == 2){ | |
28932 | + /* Ver D & 8187*/ | |
28933 | + write_phy_ofdm(dev, 0x12, 0x20);mdelay(1); | |
28934 | + | |
28935 | + write_phy_ofdm(dev, 0x13, 0x20);mdelay(1); | |
28936 | + | |
28937 | +#if 0 | |
28938 | + }else{ | |
28939 | + /* Ver B & C*/ | |
28940 | + write_phy_ofdm(dev, 0x12, 0x0); | |
28941 | + write_phy_ofdm(dev, 0x13, 0x0); | |
28942 | + } | |
28943 | +#endif | |
28944 | + write_phy_ofdm(dev, 0x14, 0x0); mdelay(1); | |
28945 | + write_phy_ofdm(dev, 0x15, 0x40); mdelay(1); | |
28946 | + write_phy_ofdm(dev, 0x16, 0x0); mdelay(1); | |
28947 | + write_phy_ofdm(dev, 0x17, 0x40); mdelay(1); | |
28948 | + | |
28949 | +// if (priv->card_type == USB) | |
28950 | +// write_phy_ofdm(dev, 0x18, 0xef); | |
28951 | + | |
28952 | + write_phy_ofdm(dev, 0x18, 0xef);mdelay(1); | |
28953 | + | |
28954 | + | |
28955 | + write_phy_ofdm(dev, 0x19, 0x19); mdelay(1); | |
28956 | + write_phy_ofdm(dev, 0x1a, 0x20); mdelay(1); | |
28957 | + write_phy_ofdm(dev, 0x1b, 0x15);mdelay(1); | |
28958 | + | |
28959 | + write_phy_ofdm(dev, 0x1c, 0x4);mdelay(1); | |
28960 | + | |
28961 | + write_phy_ofdm(dev, 0x1d, 0xc5);mdelay(1); //2005.11.17, | |
28962 | + | |
28963 | + write_phy_ofdm(dev, 0x1e, 0x95);mdelay(1); | |
28964 | + | |
28965 | + write_phy_ofdm(dev, 0x1f, 0x75); mdelay(1); | |
28966 | + | |
28967 | +// } | |
28968 | + | |
28969 | + write_phy_ofdm(dev, 0x20, 0x1f);mdelay(1); | |
28970 | + | |
28971 | + write_phy_ofdm(dev, 0x21, 0x17);mdelay(1); | |
28972 | + | |
28973 | + write_phy_ofdm(dev, 0x22, 0x16);mdelay(1); | |
28974 | + | |
28975 | +// if(priv->card_type != USB) | |
28976 | + write_phy_ofdm(dev, 0x23, 0x80);mdelay(1); //FIXME maybe not needed // <> | |
28977 | + | |
28978 | + write_phy_ofdm(dev, 0x24, 0x46); mdelay(1); | |
28979 | + write_phy_ofdm(dev, 0x25, 0x00); mdelay(1); | |
28980 | + write_phy_ofdm(dev, 0x26, 0x90); mdelay(1); | |
28981 | + | |
28982 | + write_phy_ofdm(dev, 0x27, 0x88); mdelay(1); | |
28983 | + | |
28984 | + | |
28985 | + // <> Set init. gain to m74dBm. | |
28986 | + | |
28987 | + rtl8225z2_set_gain(dev,4); | |
28988 | + | |
28989 | + write_phy_cck(dev, 0x0, 0x98); mdelay(1); | |
28990 | + write_phy_cck(dev, 0x3, 0x20); mdelay(1); | |
28991 | + write_phy_cck(dev, 0x4, 0x7e); mdelay(1); | |
28992 | + write_phy_cck(dev, 0x5, 0x12); mdelay(1); | |
28993 | + write_phy_cck(dev, 0x6, 0xfc); mdelay(1); | |
28994 | + | |
28995 | + write_phy_cck(dev, 0x7, 0x78);mdelay(1); | |
28996 | + /* Ver C & D & 8187*/ | |
28997 | + | |
28998 | + write_phy_cck(dev, 0x8, 0x2e);mdelay(1); | |
28999 | + | |
29000 | + write_phy_cck(dev, 0x10, ((priv->card_type == USB) ? 0x9b: 0x93)); mdelay(1); | |
29001 | + write_phy_cck(dev, 0x11, 0x88); mdelay(1); | |
29002 | + write_phy_cck(dev, 0x12, 0x47); mdelay(1); | |
29003 | +#if 0 | |
29004 | + if(priv->card_8185 == 1 && priv->card_8185_Bversion) | |
29005 | + write_phy_cck(dev, 0x13, 0x98); /* Ver B */ | |
29006 | + else | |
29007 | +#endif | |
29008 | + write_phy_cck(dev, 0x13, 0xd0); /* Ver C & D & 8187*/ | |
29009 | + | |
29010 | + write_phy_cck(dev, 0x19, 0x0); | |
29011 | + write_phy_cck(dev, 0x1a, 0xa0); | |
29012 | + write_phy_cck(dev, 0x1b, 0x8); | |
29013 | + write_phy_cck(dev, 0x40, 0x86); /* CCK Carrier Sense Threshold */ | |
29014 | + | |
29015 | + write_phy_cck(dev, 0x41, 0x8d);mdelay(1); | |
29016 | + | |
29017 | + | |
29018 | + write_phy_cck(dev, 0x42, 0x15); mdelay(1); | |
29019 | + write_phy_cck(dev, 0x43, 0x18); mdelay(1); | |
29020 | + | |
29021 | + | |
29022 | + write_phy_cck(dev, 0x44, 0x36); mdelay(1); | |
29023 | + write_phy_cck(dev, 0x45, 0x35); mdelay(1); | |
29024 | + write_phy_cck(dev, 0x46, 0x2e); mdelay(1); | |
29025 | + write_phy_cck(dev, 0x47, 0x25); mdelay(1); | |
29026 | + write_phy_cck(dev, 0x48, 0x1c); mdelay(1); | |
29027 | + write_phy_cck(dev, 0x49, 0x12); mdelay(1); | |
29028 | + write_phy_cck(dev, 0x4a, 0x9); mdelay(1); | |
29029 | + write_phy_cck(dev, 0x4b, 0x4); mdelay(1); | |
29030 | + write_phy_cck(dev, 0x4c, 0x5);mdelay(1); | |
29031 | + | |
29032 | + | |
29033 | + write_nic_byte(dev, 0x5b, 0x0d); mdelay(1); | |
29034 | + | |
29035 | + | |
29036 | + | |
29037 | +// <> | |
29038 | +// // TESTR 0xb 8187 | |
29039 | +// write_phy_cck(dev, 0x10, 0x93);// & 0xfb); | |
29040 | +// | |
29041 | +// //if(priv->card_type != USB){ | |
29042 | +// write_phy_ofdm(dev, 0x2, 0x62); | |
29043 | +// write_phy_ofdm(dev, 0x6, 0x0); | |
29044 | +// write_phy_ofdm(dev, 0x8, 0x0); | |
29045 | +// //} | |
29046 | + | |
29047 | + rtl8225z2_SetTXPowerLevel(dev, channel); | |
29048 | +#ifdef CONFIG_RTL818X_S | |
29049 | + write_phy_cck(dev, 0x11, 0x9b); mdelay(1); /* Rx ant A, 0xdb for B */ | |
29050 | +#else | |
29051 | + write_phy_cck(dev, 0x10, 0x9b); mdelay(1); /* Rx ant A, 0xdb for B */ | |
29052 | +#endif | |
29053 | + write_phy_ofdm(dev, 0x26, 0x90); mdelay(1); /* Rx ant A, 0x10 for B */ | |
29054 | + | |
29055 | + rtl8185_tx_antenna(dev, 0x3); /* TX ant A, 0x0 for B */ | |
29056 | + | |
29057 | + /* switch to high-speed 3-wire | |
29058 | + * last digit. 2 for both cck and ofdm | |
29059 | + */ | |
29060 | + if(priv->card_type == USB) | |
29061 | + write_nic_dword(dev, 0x94, 0x3dc00002); | |
29062 | + else{ | |
29063 | + write_nic_dword(dev, 0x94, 0x15c00002); | |
29064 | + rtl8185_rf_pins_enable(dev); | |
29065 | + } | |
29066 | + | |
29067 | +// if(priv->card_type != USB) | |
29068 | +// rtl8225_set_gain(dev, 4); /* FIXME this '1' is random */ // <> | |
29069 | +// rtl8225_set_mode(dev, 1); /* FIXME start in B mode */ // <> | |
29070 | +// | |
29071 | +// /* make sure is waken up! */ | |
29072 | +// write_rtl8225(dev,0x4, 0x9ff); | |
29073 | +// rtl8180_set_anaparam(dev, RTL8225_ANAPARAM_ON); | |
29074 | +// rtl8185_set_anaparam2(dev, RTL8225_ANAPARAM2_ON); | |
29075 | + | |
29076 | + rtl8225_rf_set_chan(dev, priv->chan); | |
29077 | + | |
29078 | + //write_nic_word(dev,BRSR,brsr); | |
29079 | + | |
29080 | + //rtl8225z2_rf_set_mode(dev); | |
29081 | +} | |
29082 | + | |
29083 | +void rtl8225z2_rf_set_mode(struct net_device *dev) | |
29084 | +{ | |
29085 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
29086 | + | |
29087 | + if(priv->ieee80211->mode == IEEE_A) | |
29088 | + { | |
29089 | + write_rtl8225(dev, 0x5, 0x1865); | |
29090 | + write_nic_dword(dev, RF_PARA, 0x10084); | |
29091 | + write_nic_dword(dev, RF_TIMING, 0xa8008); | |
29092 | + write_phy_ofdm(dev, 0x0, 0x0); | |
29093 | + write_phy_ofdm(dev, 0xa, 0x6); | |
29094 | + write_phy_ofdm(dev, 0xb, 0x99); | |
29095 | + write_phy_ofdm(dev, 0xf, 0x20); | |
29096 | + write_phy_ofdm(dev, 0x11, 0x7); | |
29097 | + | |
29098 | + rtl8225z2_set_gain(dev,4); | |
29099 | + | |
29100 | + write_phy_ofdm(dev,0x15, 0x40); | |
29101 | + write_phy_ofdm(dev,0x17, 0x40); | |
29102 | + | |
29103 | + write_nic_dword(dev, 0x94,0x10000000); | |
29104 | + }else{ | |
29105 | + | |
29106 | + write_rtl8225(dev, 0x5, 0x1864); | |
29107 | + write_nic_dword(dev, RF_PARA, 0x10044); | |
29108 | + write_nic_dword(dev, RF_TIMING, 0xa8008); | |
29109 | + write_phy_ofdm(dev, 0x0, 0x1); | |
29110 | + write_phy_ofdm(dev, 0xa, 0x6); | |
29111 | + write_phy_ofdm(dev, 0xb, 0x99); | |
29112 | + write_phy_ofdm(dev, 0xf, 0x20); | |
29113 | + write_phy_ofdm(dev, 0x11, 0x7); | |
29114 | + | |
29115 | + rtl8225z2_set_gain(dev,4); | |
29116 | + | |
29117 | + write_phy_ofdm(dev,0x15, 0x40); | |
29118 | + write_phy_ofdm(dev,0x17, 0x40); | |
29119 | + | |
29120 | + write_nic_dword(dev, 0x94,0x04000002); | |
29121 | + } | |
29122 | +} | |
29123 | + | |
29124 | +//lzm mod 080826 | |
29125 | +//#define MAX_DOZE_WAITING_TIMES_85B 64 | |
29126 | +//#define MAX_POLLING_24F_TIMES_87SE 5 | |
29127 | +#define MAX_DOZE_WAITING_TIMES_85B 20 | |
29128 | +#define MAX_POLLING_24F_TIMES_87SE 10 | |
29129 | +#define LPS_MAX_SLEEP_WAITING_TIMES_87SE 5 | |
29130 | + | |
29131 | +bool | |
29132 | +SetZebraRFPowerState8185( | |
29133 | + struct net_device *dev, | |
29134 | + RT_RF_POWER_STATE eRFPowerState | |
29135 | + ) | |
29136 | +{ | |
29137 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
29138 | + u8 btCR9346, btConfig3; | |
29139 | + bool bActionAllowed= true, bTurnOffBB = true;//lzm mod 080826 | |
29140 | + //u32 DWordContent; | |
29141 | + u8 u1bTmp; | |
29142 | + int i; | |
29143 | + //u16 u2bTFPC = 0; | |
29144 | + bool bResult = true; | |
29145 | + u8 QueueID; | |
29146 | + | |
29147 | + if(priv->SetRFPowerStateInProgress == true) | |
29148 | + return false; | |
29149 | + | |
29150 | + priv->SetRFPowerStateInProgress = true; | |
29151 | + | |
29152 | + // enable EEM0 and EEM1 in 9346CR | |
29153 | + btCR9346 = read_nic_byte(dev, CR9346); | |
29154 | + write_nic_byte(dev, CR9346, (btCR9346|0xC0) ); | |
29155 | + // enable PARM_En in Config3 | |
29156 | + btConfig3 = read_nic_byte(dev, CONFIG3); | |
29157 | + write_nic_byte(dev, CONFIG3, (btConfig3|CONFIG3_PARM_En) ); | |
29158 | + | |
29159 | + switch( priv->rf_chip ) | |
29160 | + { | |
29161 | + case RF_ZEBRA2: | |
29162 | + switch( eRFPowerState ) | |
29163 | + { | |
29164 | + case eRfOn: | |
29165 | + RF_WriteReg(dev,0x4,0x9FF); | |
29166 | + | |
29167 | + write_nic_dword(dev, ANAPARAM, ANAPARM_ON); | |
29168 | + write_nic_dword(dev, ANAPARAM2, ANAPARM2_ON); | |
29169 | + | |
29170 | + write_nic_byte(dev, CONFIG4, priv->RFProgType); | |
29171 | + | |
29172 | + //Follow 87B, Isaiah 2007-04-27 | |
29173 | + u1bTmp = read_nic_byte(dev, 0x24E); | |
29174 | + write_nic_byte(dev, 0x24E, (u1bTmp & (~(BIT5|BIT6))) );// 070124 SD1 Alex: turn on CCK and OFDM. | |
29175 | + break; | |
29176 | + | |
29177 | + case eRfSleep: | |
29178 | + break; | |
29179 | + | |
29180 | + case eRfOff: | |
29181 | + break; | |
29182 | + | |
29183 | + default: | |
29184 | + bResult = false; | |
29185 | + break; | |
29186 | + } | |
29187 | + break; | |
29188 | + | |
29189 | + case RF_ZEBRA4: | |
29190 | + switch( eRFPowerState ) | |
29191 | + { | |
29192 | + case eRfOn: | |
29193 | + //printk("===================================power on@jiffies:%d\n",jiffies); | |
29194 | + write_nic_word(dev, 0x37C, 0x00EC); | |
29195 | + | |
29196 | + //turn on AFE | |
29197 | + write_nic_byte(dev, 0x54, 0x00); | |
29198 | + write_nic_byte(dev, 0x62, 0x00); | |
29199 | + | |
29200 | + //lzm mod 080826 | |
29201 | + //turn on RF | |
29202 | + //RF_WriteReg(dev, 0x0, 0x009f); //mdelay(1); | |
29203 | + //RF_WriteReg(dev, 0x4, 0x0972); //mdelay(1); | |
29204 | + RF_WriteReg(dev, 0x0, 0x009f); udelay(500); | |
29205 | + RF_WriteReg(dev, 0x4, 0x0972); udelay(500); | |
29206 | + //turn on RF again, suggested by SD3 stevenl. | |
29207 | + RF_WriteReg(dev, 0x0, 0x009f); udelay(500); | |
29208 | + RF_WriteReg(dev, 0x4, 0x0972); udelay(500); | |
29209 | + | |
29210 | + //turn on BB | |
29211 | +// write_nic_dword(dev, PhyAddr, 0x4090); //ofdm 10=00 | |
29212 | +// write_nic_dword(dev, PhyAddr, 0x4092); //ofdm 12=00 | |
29213 | + write_phy_ofdm(dev,0x10,0x40); | |
29214 | + write_phy_ofdm(dev,0x12,0x40); | |
29215 | + //Avoid power down at init time. | |
29216 | + write_nic_byte(dev, CONFIG4, priv->RFProgType); | |
29217 | + | |
29218 | + u1bTmp = read_nic_byte(dev, 0x24E); | |
29219 | + write_nic_byte(dev, 0x24E, (u1bTmp & (~(BIT5|BIT6))) ); | |
29220 | + | |
29221 | + break; | |
29222 | + | |
29223 | + case eRfSleep: | |
29224 | + // Make sure BusyQueue is empty befor turn off RFE pwoer. | |
29225 | + //printk("===================================power sleep@jiffies:%d\n",jiffies); | |
29226 | + | |
29227 | + for(QueueID = 0, i = 0; QueueID < 6; ) | |
29228 | + { | |
29229 | + if(get_curr_tx_free_desc(dev,QueueID) == priv->txringcount) | |
29230 | + { | |
29231 | + QueueID++; | |
29232 | + continue; | |
29233 | + } | |
29234 | +#if 0 //reserved amy | |
29235 | + else if(priv->NdisAdapter.CurrentPowerState != NdisDeviceStateD0) | |
29236 | + { | |
29237 | + RT_TRACE(COMP_POWER, DBG_LOUD, ("eRfSleep: %d times TcbBusyQueue[%d] !=0 but lower power state!\n", (pMgntInfo->TxPollingTimes+1), QueueID)); | |
29238 | + break; | |
29239 | + } | |
29240 | +#endif | |
29241 | + else//lzm mod 080826 | |
29242 | + { | |
29243 | + priv->TxPollingTimes ++; | |
29244 | + if(priv->TxPollingTimes >= LPS_MAX_SLEEP_WAITING_TIMES_87SE) | |
29245 | + { | |
29246 | + //RT_TRACE(COMP_POWER, DBG_WARNING, ("\n\n\n SetZebraRFPowerState8185B():eRfSleep: %d times TcbBusyQueue[%d] != 0 !!!\n\n\n", LPS_MAX_SLEEP_WAITING_TIMES_87SE, QueueID)); | |
29247 | + bActionAllowed=false; | |
29248 | + break; | |
29249 | + } | |
29250 | + else | |
29251 | + { | |
29252 | + udelay(10); // Windows may delay 3~16ms actually. | |
29253 | + //RT_TRACE(COMP_POWER, DBG_LOUD, ("eRfSleep: %d times TcbBusyQueue[%d] !=0 before doze!\n", (pMgntInfo->TxPollingTimes), QueueID)); | |
29254 | + } | |
29255 | + } | |
29256 | + | |
29257 | + //lzm del 080826 | |
29258 | + //if(i >= MAX_DOZE_WAITING_TIMES_85B) | |
29259 | + //{ | |
29260 | + //printk("\n\n\n SetZebraRFPowerState8185B(): %d times BusyQueue[%d] != 0 !!!\n\n\n", MAX_DOZE_WAITING_TIMES_85B, QueueID); | |
29261 | + //break; | |
29262 | + //} | |
29263 | + } | |
29264 | + | |
29265 | + if(bActionAllowed)//lzm add 080826 | |
29266 | + { | |
29267 | + //turn off BB RXIQ matrix to cut off rx signal | |
29268 | +// write_nic_dword(dev, PhyAddr, 0x0090); //ofdm 10=00 | |
29269 | +// write_nic_dword(dev, PhyAddr, 0x0092); //ofdm 12=00 | |
29270 | + write_phy_ofdm(dev,0x10,0x00); | |
29271 | + write_phy_ofdm(dev,0x12,0x00); | |
29272 | + //turn off RF | |
29273 | + RF_WriteReg(dev, 0x4, 0x0000); //mdelay(1); | |
29274 | + RF_WriteReg(dev, 0x0, 0x0000); //mdelay(1); | |
29275 | + //turn off AFE except PLL | |
29276 | + write_nic_byte(dev, 0x62, 0xff); | |
29277 | + write_nic_byte(dev, 0x54, 0xec); | |
29278 | +// mdelay(10); | |
29279 | + | |
29280 | +#if 1 | |
29281 | + mdelay(1); | |
29282 | + { | |
29283 | + int i = 0; | |
29284 | + while (true) | |
29285 | + { | |
29286 | + u8 tmp24F = read_nic_byte(dev, 0x24f); | |
29287 | + if ((tmp24F == 0x01) || (tmp24F == 0x09)) | |
29288 | + { | |
29289 | + bTurnOffBB = true; | |
29290 | + break; | |
29291 | + } | |
29292 | + else//lzm mod 080826 | |
29293 | + { | |
29294 | + udelay(10); | |
29295 | + i++; | |
29296 | + priv->TxPollingTimes++; | |
29297 | + | |
29298 | + if(priv->TxPollingTimes >= LPS_MAX_SLEEP_WAITING_TIMES_87SE) | |
29299 | + { | |
29300 | + //RT_TRACE(COMP_POWER, DBG_WARNING, ("\n\n\n SetZebraRFPowerState8185B(): eRfOff: %d times Rx Mac0x24F=0x%x !!!\n\n\n", i, u1bTmp24F)); | |
29301 | + bTurnOffBB=false; | |
29302 | + break; | |
29303 | + } | |
29304 | + else | |
29305 | + { | |
29306 | + udelay(10);// Windows may delay 3~16ms actually. | |
29307 | + //RT_TRACE(COMP_POWER, DBG_LOUD,("(%d)eRfSleep- u1bTmp24F= 0x%X\n", i, u1bTmp24F)); | |
29308 | + | |
29309 | + } | |
29310 | + } | |
29311 | + | |
29312 | + //lzm del 080826 | |
29313 | + //if (i > MAX_POLLING_24F_TIMES_87SE) | |
29314 | + // break; | |
29315 | + } | |
29316 | + } | |
29317 | +#endif | |
29318 | + if (bTurnOffBB)//lzm mod 080826 | |
29319 | + { | |
29320 | + //turn off BB | |
29321 | + u1bTmp = read_nic_byte(dev, 0x24E); | |
29322 | + write_nic_byte(dev, 0x24E, (u1bTmp|BIT5|BIT6)); | |
29323 | + | |
29324 | + //turn off AFE PLL | |
29325 | + //write_nic_byte(dev, 0x54, 0xec); | |
29326 | + //write_nic_word(dev, 0x37C, 0x00ec); | |
29327 | + write_nic_byte(dev, 0x54, 0xFC); //[ECS] FC-> EC->FC, asked by SD3 Stevenl | |
29328 | + write_nic_word(dev, 0x37C, 0x00FC);//[ECS] FC-> EC->FC, asked by SD3 Stevenl | |
29329 | + } | |
29330 | + } | |
29331 | + break; | |
29332 | + | |
29333 | + case eRfOff: | |
29334 | + // Make sure BusyQueue is empty befor turn off RFE pwoer. | |
29335 | + //printk("===================================power off@jiffies:%d\n",jiffies); | |
29336 | + for(QueueID = 0, i = 0; QueueID < 6; ) | |
29337 | + { | |
29338 | + if(get_curr_tx_free_desc(dev,QueueID) == priv->txringcount) | |
29339 | + { | |
29340 | + QueueID++; | |
29341 | + continue; | |
29342 | + } | |
29343 | +#if 0 | |
29344 | + else if(Adapter->NdisAdapter.CurrentPowerState != NdisDeviceStateD0) | |
29345 | + { | |
29346 | + RT_TRACE(COMP_POWER, DBG_LOUD, ("%d times TcbBusyQueue[%d] !=0 but lower power state!\n", (i+1), QueueID)); | |
29347 | + break; | |
29348 | + } | |
29349 | +#endif | |
29350 | + else | |
29351 | + { | |
29352 | + udelay(10); | |
29353 | + i++; | |
29354 | + } | |
29355 | + | |
29356 | + if(i >= MAX_DOZE_WAITING_TIMES_85B) | |
29357 | + { | |
29358 | + //printk("\n\n\n SetZebraRFPowerState8185B(): %d times BusyQueue[%d] != 0 !!!\n\n\n", MAX_DOZE_WAITING_TIMES_85B, QueueID); | |
29359 | + break; | |
29360 | + } | |
29361 | + } | |
29362 | + | |
29363 | + //turn off BB RXIQ matrix to cut off rx signal | |
29364 | +// write_nic_dword(dev, PhyAddr, 0x0090); //ofdm 10=00 | |
29365 | +// write_nic_dword(dev, PhyAddr, 0x0092); //ofdm 12=00 | |
29366 | + write_phy_ofdm(dev,0x10,0x00); | |
29367 | + write_phy_ofdm(dev,0x12,0x00); | |
29368 | + //turn off RF | |
29369 | + RF_WriteReg(dev, 0x4, 0x0000); //mdelay(1); | |
29370 | + RF_WriteReg(dev, 0x0, 0x0000); //mdelay(1); | |
29371 | + //turn off AFE except PLL | |
29372 | + write_nic_byte(dev, 0x62, 0xff); | |
29373 | + write_nic_byte(dev, 0x54, 0xec); | |
29374 | +// mdelay(10); | |
29375 | +#if 1 | |
29376 | + mdelay(1); | |
29377 | + { | |
29378 | + int i = 0; | |
29379 | + while (true) | |
29380 | + { | |
29381 | + u8 tmp24F = read_nic_byte(dev, 0x24f); | |
29382 | + if ((tmp24F == 0x01) || (tmp24F == 0x09)) | |
29383 | + { | |
29384 | + bTurnOffBB = true; | |
29385 | + break; | |
29386 | + } | |
29387 | + else | |
29388 | + { | |
29389 | + bTurnOffBB = false; | |
29390 | + udelay(10); | |
29391 | + i++; | |
29392 | + } | |
29393 | + if (i > MAX_POLLING_24F_TIMES_87SE) | |
29394 | + break; | |
29395 | + } | |
29396 | + } | |
29397 | +#endif | |
29398 | + if (bTurnOffBB)//lzm mod 080826 | |
29399 | + { | |
29400 | + | |
29401 | + //turn off BB | |
29402 | + u1bTmp = read_nic_byte(dev, 0x24E); | |
29403 | + write_nic_byte(dev, 0x24E, (u1bTmp|BIT5|BIT6)); | |
29404 | + //turn off AFE PLL (80M) | |
29405 | + //write_nic_byte(dev, 0x54, 0xec); | |
29406 | + //write_nic_word(dev, 0x37C, 0x00ec); | |
29407 | + write_nic_byte(dev, 0x54, 0xFC); //[ECS] FC-> EC->FC, asked by SD3 Stevenl | |
29408 | + write_nic_word(dev, 0x37C, 0x00FC); //[ECS] FC-> EC->FC, asked by SD3 Stevenl | |
29409 | + } | |
29410 | + | |
29411 | + break; | |
29412 | + | |
29413 | + default: | |
29414 | + bResult = false; | |
29415 | + printk("SetZebraRFPowerState8185(): unknow state to set: 0x%X!!!\n", eRFPowerState); | |
29416 | + break; | |
29417 | + } | |
29418 | + break; | |
29419 | + } | |
29420 | + | |
29421 | + // disable PARM_En in Config3 | |
29422 | + btConfig3 &= ~(CONFIG3_PARM_En); | |
29423 | + write_nic_byte(dev, CONFIG3, btConfig3); | |
29424 | + // disable EEM0 and EEM1 in 9346CR | |
29425 | + btCR9346 &= ~(0xC0); | |
29426 | + write_nic_byte(dev, CR9346, btCR9346); | |
29427 | + | |
29428 | + if(bResult && bActionAllowed)//lzm mod 080826 | |
29429 | + { | |
29430 | + // Update current RF state variable. | |
29431 | + priv->eRFPowerState = eRFPowerState; | |
29432 | +#if 0 | |
29433 | + switch(priv->eRFPowerState) | |
29434 | + { | |
29435 | + case eRfOff: | |
29436 | + // | |
29437 | + //If Rf off reason is from IPS, Led should blink with no link, by Maddest 071015 | |
29438 | + // | |
29439 | + if(priv->RfOffReason==RF_CHANGE_BY_IPS ) | |
29440 | + { | |
29441 | + Adapter->HalFunc.LedControlHandler(Adapter,LED_CTL_NO_LINK); | |
29442 | + } | |
29443 | + else | |
29444 | + { | |
29445 | + // Turn off LED if RF is not ON. | |
29446 | + Adapter->HalFunc.LedControlHandler(Adapter, LED_CTL_POWER_OFF); | |
29447 | + } | |
29448 | + break; | |
29449 | + | |
29450 | + case eRfOn: | |
29451 | + // Turn on RF we are still linked, which might happen when | |
29452 | + // we quickly turn off and on HW RF. 2006.05.12, by rcnjko. | |
29453 | + if( pMgntInfo->bMediaConnect == TRUE ) | |
29454 | + { | |
29455 | + Adapter->HalFunc.LedControlHandler(Adapter, LED_CTL_LINK); | |
29456 | + } | |
29457 | + break; | |
29458 | + | |
29459 | + default: | |
29460 | + // do nothing. | |
29461 | + break; | |
29462 | + } | |
29463 | +#endif | |
29464 | + | |
29465 | + } | |
29466 | + | |
29467 | + priv->SetRFPowerStateInProgress = false; | |
29468 | + | |
29469 | + return (bResult && bActionAllowed) ; | |
29470 | +} | |
29471 | +void rtl8225z4_rf_sleep(struct net_device *dev) | |
29472 | +{ | |
29473 | + // | |
29474 | + // Turn off RF power. | |
29475 | + // | |
29476 | + //printk("=========>%s()\n", __FUNCTION__); | |
29477 | + MgntActSet_RF_State(dev, eRfSleep, RF_CHANGE_BY_PS); | |
29478 | + //mdelay(2); //FIXME | |
29479 | +} | |
29480 | +void rtl8225z4_rf_wakeup(struct net_device *dev) | |
29481 | +{ | |
29482 | + // | |
29483 | + // Turn on RF power. | |
29484 | + // | |
29485 | + //printk("=========>%s()\n", __FUNCTION__); | |
29486 | + MgntActSet_RF_State(dev, eRfOn, RF_CHANGE_BY_PS); | |
29487 | +} | |
29488 | +#endif | |
29489 | + | |
29490 | --- /dev/null | |
29491 | +++ b/drivers/staging/rtl8187se/r8180_rtl8255.c | |
29492 | @@ -0,0 +1,1838 @@ | |
29493 | +/* | |
29494 | + This is part of the rtl8180-sa2400 driver | |
29495 | + released under the GPL (See file COPYING for details). | |
29496 | + Copyright (c) 2005 Andrea Merello <andreamrl@tiscali.it> | |
29497 | + | |
29498 | + This files contains programming code for the rtl8255 | |
29499 | + radio frontend. | |
29500 | + | |
29501 | + *Many* thanks to Realtek Corp. for their great support! | |
29502 | + | |
29503 | +*/ | |
29504 | + | |
29505 | +#define BAND_A 1 | |
29506 | +#define BAND_BG 2 | |
29507 | + | |
29508 | +#include "r8180.h" | |
29509 | +#include "r8180_hw.h" | |
29510 | +#include "r8180_rtl8255.h" | |
29511 | + | |
29512 | +u32 rtl8255_chan[] = { | |
29513 | + 0, //dummy channel 0 | |
29514 | + 0x13, //1 | |
29515 | + 0x115, //2 | |
29516 | + 0x217, //3 | |
29517 | + 0x219, //4 | |
29518 | + 0x31b, //5 | |
29519 | + 0x41d, //6 | |
29520 | + 0x41f, //7 | |
29521 | + 0x621, //8 | |
29522 | + 0x623, //9 | |
29523 | + 0x625, //10 | |
29524 | + 0x627, //11 | |
29525 | + 0x829, //12 | |
29526 | + 0x82b, //13 | |
29527 | + 0x92f, // 14 | |
29528 | +}; | |
29529 | + | |
29530 | +static short rtl8255_gain_2G[]={ | |
29531 | + 0x33, 0x17, 0x7c, 0xc5,//-78 | |
29532 | + 0x43, 0x17, 0x7a, 0xc5,//-74 | |
29533 | + 0x53, 0x17, 0x78, 0xc5,//-70 | |
29534 | + 0x63, 0x17, 0x76, 0xc5,//-66 | |
29535 | +}; | |
29536 | + | |
29537 | + | |
29538 | +static short rtl8255_agc[]={ | |
29539 | + 0x1, 0x1, 0x1, 0x1, 0x1, 0x1, 0x1, 0x1, 0x1, 0x1, | |
29540 | + | |
29541 | + 0x1, 0x1, 0x2, 0x2, 0x3, 0x3, 0x4, 0x4, 0x5, 0x5, | |
29542 | + 0x6, 0x6, 0x7, 0x7, 0x8, 0x8, 0x9, 0x9, 0xa, 0xa, | |
29543 | + 0xb, 0xb, 0xc, 0xc, 0xd, 0xd, 0xe, 0xe, 0xf, 0xf, | |
29544 | + | |
29545 | + 0x10, 0x10, 0x11, 0x11, 0x12, 0x12, 0x13, 0x13, 0x14, 0x14, | |
29546 | + 0x15, 0x15, 0x16, 0x16, 0x17, 0x17, 0x18, 0x18, 0x19, 0x19, | |
29547 | + 0x1a, 0x1a, 0x1b, 0x1b, 0x1c, 0x1c, 0x1d, 0x1d, 0x1e, 0x1e, | |
29548 | + 0x1f, 0x1f, | |
29549 | + | |
29550 | + 0x20, 0x20, 0x21, 0x21, 0x22, 0x22, 0x23, 0x23, 0x24, 0x24, | |
29551 | + 0x25, 0x25, 0x26, 0x26, 0x27, 0x27, 0x28, 0x28, 0x29, 0x29, | |
29552 | + 0x2a, 0x2a, | |
29553 | + | |
29554 | + 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, | |
29555 | + 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, | |
29556 | + 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, 0x2a, | |
29557 | + 0x2a, 0x2a, 0x2a, 0x2a | |
29558 | + | |
29559 | +}; | |
29560 | + | |
29561 | +void rtl8255_set_gain(struct net_device *dev, short gain) | |
29562 | +{ | |
29563 | + | |
29564 | +// struct r8180_priv *priv = ieee80211_priv(dev); | |
29565 | + | |
29566 | + write_phy_ofdm(dev, 0x0d, rtl8255_gain_2G[gain * 4]); | |
29567 | + write_phy_ofdm(dev, 0x23, rtl8255_gain_2G[gain * 4 + 1]); | |
29568 | + write_phy_ofdm(dev, 0x1b, rtl8255_gain_2G[gain * 4 + 2]); | |
29569 | + write_phy_ofdm(dev, 0x1d, rtl8255_gain_2G[gain * 4 + 3]); | |
29570 | + //rtl8225_set_gain_usb(dev, gain); | |
29571 | +} | |
29572 | + | |
29573 | +void write_rtl8255_reg0c(struct net_device *dev, u32 d1, u32 d2, u32 d3, u32 d4, | |
29574 | +u32 d5, u32 d6, u32 d7, u32 d8, u32 d9, u32 d10) | |
29575 | +{ | |
29576 | + int i,j; | |
29577 | + u16 out,select; | |
29578 | + u8 bit; | |
29579 | + u32 bangdata; | |
29580 | +// struct r8180_priv *priv = ieee80211_priv(dev); | |
29581 | + | |
29582 | + write_nic_word(dev,RFPinsEnable, | |
29583 | + (read_nic_word(dev,RFPinsEnable) | 0x7)); | |
29584 | + | |
29585 | + select = read_nic_word(dev, RFPinsSelect); | |
29586 | + | |
29587 | + write_nic_word(dev, RFPinsSelect, select | 0x7 | SW_CONTROL_GPIO); | |
29588 | + | |
29589 | + out = read_nic_word(dev, RFPinsOutput) & 0xfff3; | |
29590 | + | |
29591 | + write_nic_word(dev, RFPinsOutput, out | BB_HOST_BANG_EN );//| 0x1fff); | |
29592 | + | |
29593 | + force_pci_posting(dev); | |
29594 | + udelay(2); | |
29595 | + | |
29596 | + write_nic_word(dev, RFPinsOutput, out); | |
29597 | + | |
29598 | + force_pci_posting(dev); | |
29599 | + udelay(2); | |
29600 | + | |
29601 | + for(j=0;j<10;j++) | |
29602 | + { | |
29603 | + switch(j) | |
29604 | + { | |
29605 | + case 9: | |
29606 | + bangdata = d10 | 0x0c; | |
29607 | + break; | |
29608 | + case 8: | |
29609 | + bangdata = d9; | |
29610 | + break; | |
29611 | + case 7: | |
29612 | + bangdata = d8; | |
29613 | + break; | |
29614 | + case 6: | |
29615 | + bangdata = d7; | |
29616 | + break; | |
29617 | + case 5: | |
29618 | + bangdata = d6; | |
29619 | + break; | |
29620 | + case 4: | |
29621 | + bangdata = d5; | |
29622 | + break; | |
29623 | + case 3: | |
29624 | + bangdata = d4; | |
29625 | + break; | |
29626 | + case 2: | |
29627 | + bangdata = d3; | |
29628 | + break; | |
29629 | + case 1: | |
29630 | + bangdata = d2; | |
29631 | + break; | |
29632 | + case 0: | |
29633 | + bangdata = d1; | |
29634 | + break; | |
29635 | + default: | |
29636 | + bangdata=0xbadc0de; /* avoid gcc complaints */ | |
29637 | + break; | |
29638 | + } | |
29639 | + | |
29640 | + for(i=31; i>=0;i--){ | |
29641 | + | |
29642 | + bit = (bangdata & (1<<i)) >> i; | |
29643 | + | |
29644 | + write_nic_word(dev, RFPinsOutput, bit | out); | |
29645 | + force_pci_posting(dev); | |
29646 | + udelay(1); | |
29647 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
29648 | + force_pci_posting(dev); | |
29649 | + udelay(1); | |
29650 | + // write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
29651 | + i--; | |
29652 | + bit = (bangdata & (1<<i)) >> i; | |
29653 | + | |
29654 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
29655 | + force_pci_posting(dev); | |
29656 | + udelay(1); | |
29657 | + // write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
29658 | + write_nic_word(dev, RFPinsOutput, bit | out); | |
29659 | + force_pci_posting(dev); | |
29660 | + udelay(1); | |
29661 | + } | |
29662 | + } | |
29663 | + | |
29664 | + write_nic_word(dev, RFPinsOutput, out | BB_HOST_BANG_EN); | |
29665 | + force_pci_posting(dev); | |
29666 | + udelay(10); | |
29667 | + | |
29668 | +// write_nic_word(dev, RFPinsOutput, out | BB_HOST_BANG_EN); | |
29669 | + write_nic_word(dev, RFPinsSelect, select | SW_CONTROL_GPIO); | |
29670 | +// rtl8185_rf_pins_enable(dev); | |
29671 | + | |
29672 | +} | |
29673 | + | |
29674 | +void write_rtl8255(struct net_device *dev, u8 adr, u16 data) | |
29675 | +{ | |
29676 | + int i; | |
29677 | + u16 out,select; | |
29678 | + u8 bit; | |
29679 | + u32 bangdata = (data << 4) | (adr & 0xf); | |
29680 | +// struct r8180_priv *priv = ieee80211_priv(dev); | |
29681 | + | |
29682 | + out = read_nic_word(dev, RFPinsOutput) & 0xfff3; | |
29683 | + | |
29684 | + write_nic_word(dev,RFPinsEnable, | |
29685 | + (read_nic_word(dev,RFPinsEnable) | 0x7)); | |
29686 | + | |
29687 | + select = read_nic_word(dev, RFPinsSelect); | |
29688 | + | |
29689 | + write_nic_word(dev, RFPinsSelect, select | 0x7 | SW_CONTROL_GPIO); | |
29690 | + | |
29691 | + force_pci_posting(dev); | |
29692 | + udelay(10); | |
29693 | + | |
29694 | + write_nic_word(dev, RFPinsOutput, out | BB_HOST_BANG_EN );//| 0x1fff); | |
29695 | + | |
29696 | + force_pci_posting(dev); | |
29697 | + udelay(2); | |
29698 | + | |
29699 | + write_nic_word(dev, RFPinsOutput, out); | |
29700 | + | |
29701 | + force_pci_posting(dev); | |
29702 | + udelay(10); | |
29703 | + | |
29704 | + | |
29705 | + for(i=15; i>=0;i--){ | |
29706 | + | |
29707 | + bit = (bangdata & (1<<i)) >> i; | |
29708 | + | |
29709 | + write_nic_word(dev, RFPinsOutput, bit | out); | |
29710 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
29711 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
29712 | + i--; | |
29713 | + bit = (bangdata & (1<<i)) >> i; | |
29714 | + | |
29715 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
29716 | + write_nic_word(dev, RFPinsOutput, bit | out | BB_HOST_BANG_CLK); | |
29717 | + write_nic_word(dev, RFPinsOutput, bit | out); | |
29718 | + } | |
29719 | + | |
29720 | + | |
29721 | + write_nic_word(dev, RFPinsOutput, out | BB_HOST_BANG_EN); | |
29722 | + | |
29723 | + force_pci_posting(dev); | |
29724 | + udelay(10); | |
29725 | + | |
29726 | + write_nic_word(dev, RFPinsOutput, out | BB_HOST_BANG_EN); | |
29727 | + write_nic_word(dev, RFPinsSelect, select | SW_CONTROL_GPIO); | |
29728 | + | |
29729 | + rtl8185_rf_pins_enable(dev); | |
29730 | +} | |
29731 | + | |
29732 | +void rtl8255_rf_close(struct net_device *dev) | |
29733 | +{ | |
29734 | + | |
29735 | +// rtl8180_set_anaparam(dev, RTL8225_ANAPARAM_OFF); | |
29736 | +// rtl8185_set_anaparam2(dev, RTL8225_ANAPARAM2_OFF); | |
29737 | +} | |
29738 | + | |
29739 | +void rtl8255_SetTXPowerLevel(struct net_device *dev, short ch) | |
29740 | +{ | |
29741 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
29742 | + | |
29743 | + u8 cck_power_level = 0xff & priv->chtxpwr[ch]; | |
29744 | + u8 ofdm_power_level = 0xff & priv->chtxpwr_ofdm[ch]; | |
29745 | + write_nic_byte(dev, TX_GAIN_OFDM, ofdm_power_level); | |
29746 | + write_nic_byte(dev, TX_GAIN_CCK, cck_power_level); | |
29747 | + force_pci_posting(dev); | |
29748 | + mdelay(1); | |
29749 | + //write_nic_byte(dev, TX_AGC_CONTROL,4); | |
29750 | +} | |
29751 | +#if 0 | |
29752 | +/* switch between mode B and G */ | |
29753 | +void rtl8255_set_mode(struct net_device *dev, short modeb) | |
29754 | +{ | |
29755 | + write_phy_ofdm(dev, 0x15, (modeb ? 0x0 : 0x40)); | |
29756 | + write_phy_ofdm(dev, 0x17, (modeb ? 0x0 : 0x40)); | |
29757 | +} | |
29758 | +#endif | |
29759 | + | |
29760 | +void rtl8255_rf_set_chan(struct net_device *dev, short ch) | |
29761 | +{ | |
29762 | + //write_rtl8225(dev, 0x7, rtl8225_chan[1]); | |
29763 | + write_rtl8255(dev, 0x5, 0x65); | |
29764 | + write_rtl8255(dev, 0x6, rtl8255_chan[ch]); | |
29765 | + write_rtl8255(dev, 0x7, 0x7c); | |
29766 | + write_rtl8255(dev, 0x8, 0x6); | |
29767 | + | |
29768 | + | |
29769 | + force_pci_posting(dev); | |
29770 | + set_current_state(TASK_INTERRUPTIBLE); | |
29771 | + schedule_timeout(HZ); | |
29772 | +// rtl8225_set_mode_B(dev); | |
29773 | + | |
29774 | + rtl8255_SetTXPowerLevel(dev, ch); | |
29775 | + /* FIXME FIXME FIXME */ | |
29776 | + | |
29777 | + #if 0 | |
29778 | + write_nic_byte(dev,DIFS,0xe); //DIFS | |
29779 | + write_nic_byte(dev,SLOT,0x14); //SLOT | |
29780 | + write_nic_byte(dev,EIFS,0x5b); // EIFS | |
29781 | + //write_nic_byte(dev,0xbc,0); //CW CONFIG | |
29782 | + write_nic_byte(dev,0xbd,0xa4); //CW VALUE | |
29783 | + //write_nic_byte(dev,TX_AGC_CONTROL,4); | |
29784 | + //write_nic_byte(dev, 0x9d,7); | |
29785 | +//Apr 20 13:25:03 localhost kernel: w8. 409d<-7 // CCK AGC | |
29786 | + /*write_nic_word(dev,0x84,0x488); | |
29787 | + write_nic_byte(dev,0x91,0x3e); | |
29788 | + write_nic_byte(dev,0x90,0x30); | |
29789 | + write_nic_word(dev,0x84,0x488); | |
29790 | + write_nic_byte(dev,0x91,0x3e); | |
29791 | + write_nic_byte(dev,0x90,0x20); | |
29792 | + */ | |
29793 | + //mdelay(100); | |
29794 | + #endif | |
29795 | +} | |
29796 | + | |
29797 | +void rtl8255_init_BGband(struct net_device *dev) | |
29798 | +{ | |
29799 | + write_rtl8255(dev, 0x3, 0x0); | |
29800 | + write_rtl8255(dev, 0x1, 0x807); | |
29801 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x804187cf, 0x40000027, | |
29802 | + 0x92402ac0, 0xf0009, 0x28000, 0xc00, 0x0); | |
29803 | + write_rtl8255(dev, 0x1, 0x807); | |
29804 | + write_rtl8255(dev, 0x4, 0xc00); | |
29805 | + write_rtl8255(dev, 0x4, 0xe00); | |
29806 | + write_rtl8255(dev, 0x4, 0xc00); | |
29807 | + write_rtl8255(dev, 0x1, 0x0); | |
29808 | + write_rtl8255(dev, 0x4, 0x800); | |
29809 | + write_rtl8255(dev, 0x3, 0x0); | |
29810 | + write_rtl8255(dev, 0x2, 0x0); | |
29811 | + write_rtl8255(dev, 0x4, 0xa00); | |
29812 | + write_rtl8255(dev, 0x4, 0x800); | |
29813 | + write_rtl8255(dev, 0x4, 0x400); | |
29814 | + write_rtl8255(dev, 0x3, 0x26); | |
29815 | + write_rtl8255(dev, 0x2, 0x27); | |
29816 | + write_rtl8255(dev, 0x4, 0x600); | |
29817 | + write_rtl8255(dev, 0x4, 0x400); | |
29818 | + write_rtl8255(dev, 0x4, 0x400); | |
29819 | + write_rtl8255(dev, 0x3, 0x100); | |
29820 | + write_rtl8255(dev, 0x4, 0x600); | |
29821 | + write_rtl8255(dev, 0x4, 0x400); | |
29822 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x804187ce, 0x80000027, | |
29823 | + 0x92402ac0, 0xf0009, 0x28000, 0xc00, 0x0); | |
29824 | + write_rtl8255(dev, 0x1, 0x807); | |
29825 | + write_rtl8255(dev, 0x4, 0xc01); | |
29826 | + write_rtl8255(dev, 0x4, 0xe01); | |
29827 | + write_rtl8255(dev, 0x4, 0xc01); | |
29828 | + write_rtl8255(dev, 0x1, 0x0); | |
29829 | + write_rtl8255(dev, 0x4, 0x801); | |
29830 | + write_rtl8255(dev, 0x3, 0x0); | |
29831 | + write_rtl8255(dev, 0x2, 0x0); | |
29832 | + write_rtl8255(dev, 0x4, 0xa01); | |
29833 | + write_rtl8255(dev, 0x4, 0x801); | |
29834 | + write_rtl8255(dev, 0x4, 0x401); | |
29835 | + write_rtl8255(dev, 0x3, 0x26); | |
29836 | + write_rtl8255(dev, 0x2, 0x27); | |
29837 | + write_rtl8255(dev, 0x4, 0x601); | |
29838 | + write_rtl8255(dev, 0x4, 0x401); | |
29839 | + write_rtl8255(dev, 0x4, 0x401); | |
29840 | + write_rtl8255(dev, 0x3, 0x100); | |
29841 | + write_rtl8255(dev, 0x4, 0x601); | |
29842 | + write_rtl8255(dev, 0x4, 0x401); | |
29843 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80418bdf, 0x40000027, | |
29844 | + 0x92402ac4, 0xf0009, 0x28000, 0xc00, 0x0); | |
29845 | + write_rtl8255(dev, 0x1, 0x807); | |
29846 | + write_rtl8255(dev, 0x4, 0xc02); | |
29847 | + write_rtl8255(dev, 0x4, 0xe02); | |
29848 | + write_rtl8255(dev, 0x4, 0xc02); | |
29849 | + write_rtl8255(dev, 0x1, 0x0); | |
29850 | + write_rtl8255(dev, 0x4, 0x802); | |
29851 | + write_rtl8255(dev, 0x3, 0x0); | |
29852 | + write_rtl8255(dev, 0x2, 0x0); | |
29853 | + write_rtl8255(dev, 0x4, 0xa02); | |
29854 | + write_rtl8255(dev, 0x4, 0x802); | |
29855 | + write_rtl8255(dev, 0x4, 0x402); | |
29856 | + write_rtl8255(dev, 0x3, 0x26); | |
29857 | + write_rtl8255(dev, 0x2, 0x26); | |
29858 | + write_rtl8255(dev, 0x4, 0x602); | |
29859 | + write_rtl8255(dev, 0x4, 0x402); | |
29860 | + write_rtl8255(dev, 0x4, 0x402); | |
29861 | + write_rtl8255(dev, 0x3, 0x100); | |
29862 | + write_rtl8255(dev, 0x4, 0x602); | |
29863 | + write_rtl8255(dev, 0x4, 0x402); | |
29864 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80418bbf, 0x40000027, | |
29865 | + 0x92402ac4, 0xf0009, 0x28000, 0xc00, 0x0); | |
29866 | + write_rtl8255(dev, 0x1, 0x807); | |
29867 | + write_rtl8255(dev, 0x4, 0xc03); | |
29868 | + write_rtl8255(dev, 0x4, 0xe03); | |
29869 | + write_rtl8255(dev, 0x4, 0xc03); | |
29870 | + write_rtl8255(dev, 0x1, 0x0); | |
29871 | + write_rtl8255(dev, 0x4, 0x803); | |
29872 | + write_rtl8255(dev, 0x3, 0x0); | |
29873 | + write_rtl8255(dev, 0x2, 0x0); | |
29874 | + write_rtl8255(dev, 0x4, 0xa03); | |
29875 | + write_rtl8255(dev, 0x4, 0x803); | |
29876 | + write_rtl8255(dev, 0x4, 0x403); | |
29877 | + write_rtl8255(dev, 0x3, 0x26); | |
29878 | + write_rtl8255(dev, 0x2, 0x26); | |
29879 | + write_rtl8255(dev, 0x4, 0x603); | |
29880 | + write_rtl8255(dev, 0x4, 0x403); | |
29881 | + write_rtl8255(dev, 0x4, 0x403); | |
29882 | + write_rtl8255(dev, 0x3, 0x100); | |
29883 | + write_rtl8255(dev, 0x4, 0x603); | |
29884 | + write_rtl8255(dev, 0x4, 0x403); | |
29885 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80418b9f, 0x40000027, | |
29886 | + 0x92402ac8, 0xf0009, 0x28000, 0xc00, 0x0); | |
29887 | + write_rtl8255(dev, 0x1, 0x807); | |
29888 | + write_rtl8255(dev, 0x4, 0xc04); | |
29889 | + write_rtl8255(dev, 0x4, 0xe04); | |
29890 | + write_rtl8255(dev, 0x4, 0xc04); | |
29891 | + write_rtl8255(dev, 0x1, 0x0); | |
29892 | + write_rtl8255(dev, 0x4, 0x804); | |
29893 | + write_rtl8255(dev, 0x3, 0x0); | |
29894 | + write_rtl8255(dev, 0x2, 0x0); | |
29895 | + write_rtl8255(dev, 0x4, 0xa04); | |
29896 | + write_rtl8255(dev, 0x4, 0x804); | |
29897 | + write_rtl8255(dev, 0x4, 0x404); | |
29898 | + write_rtl8255(dev, 0x3, 0x26); | |
29899 | + write_rtl8255(dev, 0x2, 0x26); | |
29900 | + write_rtl8255(dev, 0x4, 0x604); | |
29901 | + write_rtl8255(dev, 0x4, 0x404); | |
29902 | + write_rtl8255(dev, 0x4, 0x404); | |
29903 | + write_rtl8255(dev, 0x3, 0x100); | |
29904 | + write_rtl8255(dev, 0x4, 0x604); | |
29905 | + write_rtl8255(dev, 0x4, 0x404); | |
29906 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x804183df, 0x40000027, | |
29907 | + 0x92402ac8, 0xf0009, 0x28000, 0xc00, 0x0); | |
29908 | + write_rtl8255(dev, 0x1, 0x807); | |
29909 | + write_rtl8255(dev, 0x4, 0xc05); | |
29910 | + write_rtl8255(dev, 0x4, 0xe05); | |
29911 | + write_rtl8255(dev, 0x4, 0xc05); | |
29912 | + write_rtl8255(dev, 0x1, 0x0); | |
29913 | + write_rtl8255(dev, 0x4, 0x805); | |
29914 | + write_rtl8255(dev, 0x3, 0x0); | |
29915 | + write_rtl8255(dev, 0x2, 0x0); | |
29916 | + write_rtl8255(dev, 0x4, 0xa05); | |
29917 | + write_rtl8255(dev, 0x4, 0x805); | |
29918 | + write_rtl8255(dev, 0x4, 0x405); | |
29919 | + write_rtl8255(dev, 0x3, 0x26); | |
29920 | + write_rtl8255(dev, 0x2, 0x26); | |
29921 | + write_rtl8255(dev, 0x4, 0x605); | |
29922 | + write_rtl8255(dev, 0x4, 0x405); | |
29923 | + write_rtl8255(dev, 0x4, 0x405); | |
29924 | + write_rtl8255(dev, 0x3, 0x100); | |
29925 | + write_rtl8255(dev, 0x4, 0x605); | |
29926 | + write_rtl8255(dev, 0x4, 0x405); | |
29927 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x804183cf, 0x27, | |
29928 | + 0x92402acc, 0xf0009, 0x28000, 0xc00, 0x0); | |
29929 | + write_rtl8255(dev, 0x1, 0x807); | |
29930 | + write_rtl8255(dev, 0x4, 0xc06); | |
29931 | + write_rtl8255(dev, 0x4, 0xe06); | |
29932 | + write_rtl8255(dev, 0x4, 0xc06); | |
29933 | + write_rtl8255(dev, 0x1, 0x0); | |
29934 | + write_rtl8255(dev, 0x4, 0x806); | |
29935 | + write_rtl8255(dev, 0x3, 0x0); | |
29936 | + write_rtl8255(dev, 0x2, 0x0); | |
29937 | + write_rtl8255(dev, 0x4, 0xa06); | |
29938 | + write_rtl8255(dev, 0x4, 0x806); | |
29939 | + write_rtl8255(dev, 0x4, 0x406); | |
29940 | + write_rtl8255(dev, 0x3, 0x25); | |
29941 | + write_rtl8255(dev, 0x2, 0x26); | |
29942 | + write_rtl8255(dev, 0x4, 0x606); | |
29943 | + write_rtl8255(dev, 0x4, 0x406); | |
29944 | + write_rtl8255(dev, 0x4, 0x406); | |
29945 | + write_rtl8255(dev, 0x3, 0x100); | |
29946 | + write_rtl8255(dev, 0x4, 0x606); | |
29947 | + write_rtl8255(dev, 0x4, 0x406); | |
29948 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x804183af, 0x27, | |
29949 | + 0x92402acc, 0xf0009, 0x28000, 0xc00, 0x0); | |
29950 | + write_rtl8255(dev, 0x1, 0x807); | |
29951 | + write_rtl8255(dev, 0x4, 0xc07); | |
29952 | + write_rtl8255(dev, 0x4, 0xe07); | |
29953 | + write_rtl8255(dev, 0x4, 0xc07); | |
29954 | + write_rtl8255(dev, 0x1, 0x0); | |
29955 | + write_rtl8255(dev, 0x4, 0x807); | |
29956 | + write_rtl8255(dev, 0x3, 0x0); | |
29957 | + write_rtl8255(dev, 0x2, 0x0); | |
29958 | + write_rtl8255(dev, 0x4, 0xa07); | |
29959 | + write_rtl8255(dev, 0x4, 0x807); | |
29960 | + write_rtl8255(dev, 0x4, 0x407); | |
29961 | + write_rtl8255(dev, 0x3, 0x25); | |
29962 | + write_rtl8255(dev, 0x2, 0x26); | |
29963 | + write_rtl8255(dev, 0x4, 0x607); | |
29964 | + write_rtl8255(dev, 0x4, 0x407); | |
29965 | + write_rtl8255(dev, 0x4, 0x407); | |
29966 | + write_rtl8255(dev, 0x3, 0x100); | |
29967 | + write_rtl8255(dev, 0x4, 0x607); | |
29968 | + write_rtl8255(dev, 0x4, 0x407); | |
29969 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x804083d7, 0x40000027, | |
29970 | + 0x92402ad0, 0xf0009, 0x28000, 0xc00, 0x0); | |
29971 | + write_rtl8255(dev, 0x1, 0x807); | |
29972 | + write_rtl8255(dev, 0x4, 0xc08); | |
29973 | + write_rtl8255(dev, 0x4, 0xe08); | |
29974 | + write_rtl8255(dev, 0x4, 0xc08); | |
29975 | + write_rtl8255(dev, 0x1, 0x0); | |
29976 | + write_rtl8255(dev, 0x4, 0x808); | |
29977 | + write_rtl8255(dev, 0x3, 0x0); | |
29978 | + write_rtl8255(dev, 0x2, 0x0); | |
29979 | + write_rtl8255(dev, 0x4, 0xa08); | |
29980 | + write_rtl8255(dev, 0x4, 0x808); | |
29981 | + write_rtl8255(dev, 0x4, 0x408); | |
29982 | + write_rtl8255(dev, 0x3, 0x25); | |
29983 | + write_rtl8255(dev, 0x2, 0x26); | |
29984 | + write_rtl8255(dev, 0x4, 0x608); | |
29985 | + write_rtl8255(dev, 0x4, 0x408); | |
29986 | + write_rtl8255(dev, 0x4, 0x408); | |
29987 | + write_rtl8255(dev, 0x3, 0x100); | |
29988 | + write_rtl8255(dev, 0x4, 0x608); | |
29989 | + write_rtl8255(dev, 0x4, 0x408); | |
29990 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x804083c7, 0x27, | |
29991 | + 0x92402ad0, 0xf0009, 0x28000, 0xc00, 0x0); | |
29992 | + write_rtl8255(dev, 0x1, 0x807); | |
29993 | + write_rtl8255(dev, 0x4, 0xc09); | |
29994 | + write_rtl8255(dev, 0x4, 0xe09); | |
29995 | + write_rtl8255(dev, 0x4, 0xc09); | |
29996 | + write_rtl8255(dev, 0x1, 0x0); | |
29997 | + write_rtl8255(dev, 0x4, 0x809); | |
29998 | + write_rtl8255(dev, 0x3, 0x0); | |
29999 | + write_rtl8255(dev, 0x2, 0x0); | |
30000 | + write_rtl8255(dev, 0x4, 0xa09); | |
30001 | + write_rtl8255(dev, 0x4, 0x809); | |
30002 | + write_rtl8255(dev, 0x4, 0x409); | |
30003 | + write_rtl8255(dev, 0x3, 0x25); | |
30004 | + write_rtl8255(dev, 0x2, 0x26); | |
30005 | + write_rtl8255(dev, 0x4, 0x609); | |
30006 | + write_rtl8255(dev, 0x4, 0x409); | |
30007 | + write_rtl8255(dev, 0x4, 0x409); | |
30008 | + write_rtl8255(dev, 0x3, 0x100); | |
30009 | + write_rtl8255(dev, 0x4, 0x609); | |
30010 | + write_rtl8255(dev, 0x4, 0x409); | |
30011 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x804043d7, 0x40000027, | |
30012 | + 0x92402ad4, 0xf0009, 0x28000, 0xc00, 0x0); | |
30013 | + write_rtl8255(dev, 0x1, 0x807); | |
30014 | + write_rtl8255(dev, 0x4, 0xc0a); | |
30015 | + write_rtl8255(dev, 0x4, 0xe0a); | |
30016 | + write_rtl8255(dev, 0x4, 0xc0a); | |
30017 | + write_rtl8255(dev, 0x1, 0x0); | |
30018 | + write_rtl8255(dev, 0x4, 0x80a); | |
30019 | + write_rtl8255(dev, 0x3, 0x0); | |
30020 | + write_rtl8255(dev, 0x2, 0x0); | |
30021 | + write_rtl8255(dev, 0x4, 0xa0a); | |
30022 | + write_rtl8255(dev, 0x4, 0x80a); | |
30023 | + write_rtl8255(dev, 0x4, 0x40a); | |
30024 | + write_rtl8255(dev, 0x3, 0x25); | |
30025 | + write_rtl8255(dev, 0x2, 0x26); | |
30026 | + write_rtl8255(dev, 0x4, 0x60a); | |
30027 | + write_rtl8255(dev, 0x4, 0x40a); | |
30028 | + write_rtl8255(dev, 0x4, 0x40a); | |
30029 | + write_rtl8255(dev, 0x3, 0x100); | |
30030 | + write_rtl8255(dev, 0x4, 0x60a); | |
30031 | + write_rtl8255(dev, 0x4, 0x40a); | |
30032 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x804043d7, 0x40000027, | |
30033 | + 0x92402ad4, 0xf0009, 0x28000, 0xc00, 0x0); | |
30034 | + write_rtl8255(dev, 0x1, 0x807); | |
30035 | + write_rtl8255(dev, 0x4, 0xc0b); | |
30036 | + write_rtl8255(dev, 0x4, 0xe0b); | |
30037 | + write_rtl8255(dev, 0x4, 0xc0b); | |
30038 | + write_rtl8255(dev, 0x1, 0x0); | |
30039 | + write_rtl8255(dev, 0x4, 0x80b); | |
30040 | + write_rtl8255(dev, 0x3, 0x0); | |
30041 | + write_rtl8255(dev, 0x2, 0x0); | |
30042 | + write_rtl8255(dev, 0x4, 0xa0b); | |
30043 | + write_rtl8255(dev, 0x4, 0x80b); | |
30044 | + write_rtl8255(dev, 0x4, 0x40b); | |
30045 | + write_rtl8255(dev, 0x3, 0x25); | |
30046 | + write_rtl8255(dev, 0x2, 0x26); | |
30047 | + write_rtl8255(dev, 0x4, 0x60b); | |
30048 | + write_rtl8255(dev, 0x4, 0x40b); | |
30049 | + write_rtl8255(dev, 0x4, 0x40b); | |
30050 | + write_rtl8255(dev, 0x3, 0x100); | |
30051 | + write_rtl8255(dev, 0x4, 0x60b); | |
30052 | + write_rtl8255(dev, 0x4, 0x40b); | |
30053 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x804043c7, 0x27, | |
30054 | + 0x92402ad8, 0xf0009, 0x28000, 0xc00, 0x0); | |
30055 | + write_rtl8255(dev, 0x1, 0x807); | |
30056 | + write_rtl8255(dev, 0x4, 0xc0c); | |
30057 | + write_rtl8255(dev, 0x4, 0xe0c); | |
30058 | + write_rtl8255(dev, 0x4, 0xc0c); | |
30059 | + write_rtl8255(dev, 0x1, 0x0); | |
30060 | + write_rtl8255(dev, 0x4, 0x80c); | |
30061 | + write_rtl8255(dev, 0x3, 0x0); | |
30062 | + write_rtl8255(dev, 0x2, 0x0); | |
30063 | + write_rtl8255(dev, 0x4, 0xa0c); | |
30064 | + write_rtl8255(dev, 0x4, 0x80c); | |
30065 | + write_rtl8255(dev, 0x4, 0x40c); | |
30066 | + write_rtl8255(dev, 0x3, 0x25); | |
30067 | + write_rtl8255(dev, 0x2, 0x26); | |
30068 | + write_rtl8255(dev, 0x4, 0x60c); | |
30069 | + write_rtl8255(dev, 0x4, 0x40c); | |
30070 | + write_rtl8255(dev, 0x4, 0x40c); | |
30071 | + write_rtl8255(dev, 0x3, 0x100); | |
30072 | + write_rtl8255(dev, 0x4, 0x60c); | |
30073 | + write_rtl8255(dev, 0x4, 0x40c); | |
30074 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x804043a7, 0x27, | |
30075 | + 0x92402ad8, 0xf0009, 0x28000, 0xc00, 0x0); | |
30076 | + write_rtl8255(dev, 0x1, 0x807); | |
30077 | + write_rtl8255(dev, 0x4, 0xc0d); | |
30078 | + write_rtl8255(dev, 0x4, 0xe0d); | |
30079 | + write_rtl8255(dev, 0x4, 0xc0d); | |
30080 | + write_rtl8255(dev, 0x1, 0x0); | |
30081 | + write_rtl8255(dev, 0x4, 0x80d); | |
30082 | + write_rtl8255(dev, 0x3, 0x0); | |
30083 | + write_rtl8255(dev, 0x2, 0x0); | |
30084 | + write_rtl8255(dev, 0x4, 0xa0d); | |
30085 | + write_rtl8255(dev, 0x4, 0x80d); | |
30086 | + write_rtl8255(dev, 0x4, 0x40d); | |
30087 | + write_rtl8255(dev, 0x3, 0x25); | |
30088 | + write_rtl8255(dev, 0x2, 0x26); | |
30089 | + write_rtl8255(dev, 0x4, 0x60d); | |
30090 | + write_rtl8255(dev, 0x4, 0x40d); | |
30091 | + write_rtl8255(dev, 0x4, 0x40d); | |
30092 | + write_rtl8255(dev, 0x3, 0x100); | |
30093 | + write_rtl8255(dev, 0x4, 0x60d); | |
30094 | + write_rtl8255(dev, 0x4, 0x40d); | |
30095 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404387, 0x27, | |
30096 | + 0x92402aa8, 0xf0009, 0x28000, 0xc00, 0x0); | |
30097 | + write_rtl8255(dev, 0x1, 0x807); | |
30098 | + write_rtl8255(dev, 0x4, 0xc0e); | |
30099 | + write_rtl8255(dev, 0x4, 0xe0e); | |
30100 | + write_rtl8255(dev, 0x4, 0xc0e); | |
30101 | + write_rtl8255(dev, 0x1, 0x0); | |
30102 | + write_rtl8255(dev, 0x4, 0x80e); | |
30103 | + write_rtl8255(dev, 0x3, 0x0); | |
30104 | + write_rtl8255(dev, 0x2, 0x0); | |
30105 | + write_rtl8255(dev, 0x4, 0xa0e); | |
30106 | + write_rtl8255(dev, 0x4, 0x80e); | |
30107 | + write_rtl8255(dev, 0x4, 0x40e); | |
30108 | + write_rtl8255(dev, 0x3, 0x25); | |
30109 | + write_rtl8255(dev, 0x2, 0x26); | |
30110 | + write_rtl8255(dev, 0x4, 0x60e); | |
30111 | + write_rtl8255(dev, 0x4, 0x40e); | |
30112 | + write_rtl8255(dev, 0x4, 0x40e); | |
30113 | + write_rtl8255(dev, 0x3, 0x100); | |
30114 | + write_rtl8255(dev, 0x4, 0x60e); | |
30115 | + write_rtl8255(dev, 0x4, 0x40e); | |
30116 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x804041c7, 0x27, | |
30117 | + 0x92402aa8, 0xf0009, 0x28000, 0xc00, 0x0); | |
30118 | + write_rtl8255(dev, 0x1, 0x807); | |
30119 | + write_rtl8255(dev, 0x4, 0xc0f); | |
30120 | + write_rtl8255(dev, 0x4, 0xe0f); | |
30121 | + write_rtl8255(dev, 0x4, 0xc0f); | |
30122 | + write_rtl8255(dev, 0x1, 0x0); | |
30123 | + write_rtl8255(dev, 0x4, 0x80f); | |
30124 | + write_rtl8255(dev, 0x3, 0x0); | |
30125 | + write_rtl8255(dev, 0x2, 0x0); | |
30126 | + write_rtl8255(dev, 0x4, 0xa0f); | |
30127 | + write_rtl8255(dev, 0x4, 0x80f); | |
30128 | + write_rtl8255(dev, 0x4, 0x40f); | |
30129 | + write_rtl8255(dev, 0x3, 0x25); | |
30130 | + write_rtl8255(dev, 0x2, 0x26); | |
30131 | + write_rtl8255(dev, 0x4, 0x60f); | |
30132 | + write_rtl8255(dev, 0x4, 0x40f); | |
30133 | + write_rtl8255(dev, 0x4, 0x40f); | |
30134 | + write_rtl8255(dev, 0x3, 0x100); | |
30135 | + write_rtl8255(dev, 0x4, 0x60f); | |
30136 | + write_rtl8255(dev, 0x4, 0x40f); | |
30137 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x804041a7, 0x27, | |
30138 | + 0x92402aac, 0xf0009, 0x28000, 0xc00, 0x0); | |
30139 | + write_rtl8255(dev, 0x1, 0x807); | |
30140 | + write_rtl8255(dev, 0x4, 0xc10); | |
30141 | + write_rtl8255(dev, 0x4, 0xe10); | |
30142 | + write_rtl8255(dev, 0x4, 0xc10); | |
30143 | + write_rtl8255(dev, 0x1, 0x0); | |
30144 | + write_rtl8255(dev, 0x4, 0x810); | |
30145 | + write_rtl8255(dev, 0x3, 0x0); | |
30146 | + write_rtl8255(dev, 0x2, 0x0); | |
30147 | + write_rtl8255(dev, 0x4, 0xa10); | |
30148 | + write_rtl8255(dev, 0x4, 0x810); | |
30149 | + write_rtl8255(dev, 0x4, 0x410); | |
30150 | + write_rtl8255(dev, 0x3, 0x25); | |
30151 | + write_rtl8255(dev, 0x2, 0x26); | |
30152 | + write_rtl8255(dev, 0x4, 0x610); | |
30153 | + write_rtl8255(dev, 0x4, 0x410); | |
30154 | + write_rtl8255(dev, 0x4, 0x410); | |
30155 | + write_rtl8255(dev, 0x3, 0x100); | |
30156 | + write_rtl8255(dev, 0x4, 0x610); | |
30157 | + write_rtl8255(dev, 0x4, 0x410); | |
30158 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404187, 0x27, | |
30159 | + 0x92402aac, 0xf0009, 0x28000, 0xc00, 0x0); | |
30160 | + write_rtl8255(dev, 0x1, 0x807); | |
30161 | + write_rtl8255(dev, 0x4, 0xc11); | |
30162 | + write_rtl8255(dev, 0x4, 0xe11); | |
30163 | + write_rtl8255(dev, 0x4, 0xc11); | |
30164 | + write_rtl8255(dev, 0x1, 0x0); | |
30165 | + write_rtl8255(dev, 0x4, 0x811); | |
30166 | + write_rtl8255(dev, 0x3, 0x0); | |
30167 | + write_rtl8255(dev, 0x2, 0x0); | |
30168 | + write_rtl8255(dev, 0x4, 0xa11); | |
30169 | + write_rtl8255(dev, 0x4, 0x811); | |
30170 | + write_rtl8255(dev, 0x4, 0x411); | |
30171 | + write_rtl8255(dev, 0x3, 0x25); | |
30172 | + write_rtl8255(dev, 0x2, 0x26); | |
30173 | + write_rtl8255(dev, 0x4, 0x611); | |
30174 | + write_rtl8255(dev, 0x4, 0x411); | |
30175 | + write_rtl8255(dev, 0x4, 0x411); | |
30176 | + write_rtl8255(dev, 0x3, 0x100); | |
30177 | + write_rtl8255(dev, 0x4, 0x611); | |
30178 | + write_rtl8255(dev, 0x4, 0x411); | |
30179 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404186, 0x80000027, | |
30180 | + 0x92402ab0, 0xf0009, 0x28000, 0xc00, 0x0); | |
30181 | + write_rtl8255(dev, 0x1, 0x807); | |
30182 | + write_rtl8255(dev, 0x4, 0xc12); | |
30183 | + write_rtl8255(dev, 0x4, 0xe12); | |
30184 | + write_rtl8255(dev, 0x4, 0xc12); | |
30185 | + write_rtl8255(dev, 0x1, 0x0); | |
30186 | + write_rtl8255(dev, 0x4, 0x812); | |
30187 | + write_rtl8255(dev, 0x3, 0x0); | |
30188 | + write_rtl8255(dev, 0x2, 0x0); | |
30189 | + write_rtl8255(dev, 0x4, 0xa12); | |
30190 | + write_rtl8255(dev, 0x4, 0x812); | |
30191 | + write_rtl8255(dev, 0x4, 0x412); | |
30192 | + write_rtl8255(dev, 0x3, 0x25); | |
30193 | + write_rtl8255(dev, 0x2, 0x26); | |
30194 | + write_rtl8255(dev, 0x4, 0x612); | |
30195 | + write_rtl8255(dev, 0x4, 0x412); | |
30196 | + write_rtl8255(dev, 0x4, 0x412); | |
30197 | + write_rtl8255(dev, 0x3, 0x100); | |
30198 | + write_rtl8255(dev, 0x4, 0x612); | |
30199 | + write_rtl8255(dev, 0x4, 0x412); | |
30200 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404186, 0x27, | |
30201 | + 0x92402ab0, 0xf0009, 0x28000, 0xc00, 0x0); | |
30202 | + write_rtl8255(dev, 0x1, 0x807); | |
30203 | + write_rtl8255(dev, 0x4, 0xc13); | |
30204 | + write_rtl8255(dev, 0x4, 0xe13); | |
30205 | + write_rtl8255(dev, 0x4, 0xc13); | |
30206 | + write_rtl8255(dev, 0x1, 0x0); | |
30207 | + write_rtl8255(dev, 0x4, 0x813); | |
30208 | + write_rtl8255(dev, 0x3, 0x0); | |
30209 | + write_rtl8255(dev, 0x2, 0x0); | |
30210 | + write_rtl8255(dev, 0x4, 0xa13); | |
30211 | + write_rtl8255(dev, 0x4, 0x813); | |
30212 | + write_rtl8255(dev, 0x4, 0x413); | |
30213 | + write_rtl8255(dev, 0x3, 0x25); | |
30214 | + write_rtl8255(dev, 0x2, 0x26); | |
30215 | + write_rtl8255(dev, 0x4, 0x613); | |
30216 | + write_rtl8255(dev, 0x4, 0x413); | |
30217 | + write_rtl8255(dev, 0x4, 0x413); | |
30218 | + write_rtl8255(dev, 0x3, 0x100); | |
30219 | + write_rtl8255(dev, 0x4, 0x613); | |
30220 | + write_rtl8255(dev, 0x4, 0x413); | |
30221 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404146, 0x27, | |
30222 | + 0x92402ab4, 0xf0009, 0x28000, 0xc00, 0x0); | |
30223 | + write_rtl8255(dev, 0x1, 0x807); | |
30224 | + write_rtl8255(dev, 0x4, 0xc14); | |
30225 | + write_rtl8255(dev, 0x4, 0xe14); | |
30226 | + write_rtl8255(dev, 0x4, 0xc14); | |
30227 | + write_rtl8255(dev, 0x1, 0x0); | |
30228 | + write_rtl8255(dev, 0x4, 0x814); | |
30229 | + write_rtl8255(dev, 0x3, 0x0); | |
30230 | + write_rtl8255(dev, 0x2, 0x0); | |
30231 | + write_rtl8255(dev, 0x4, 0xa14); | |
30232 | + write_rtl8255(dev, 0x4, 0x814); | |
30233 | + write_rtl8255(dev, 0x4, 0x414); | |
30234 | + write_rtl8255(dev, 0x3, 0x25); | |
30235 | + write_rtl8255(dev, 0x2, 0x26); | |
30236 | + write_rtl8255(dev, 0x4, 0x614); | |
30237 | + write_rtl8255(dev, 0x4, 0x414); | |
30238 | + write_rtl8255(dev, 0x4, 0x414); | |
30239 | + write_rtl8255(dev, 0x3, 0x100); | |
30240 | + write_rtl8255(dev, 0x4, 0x614); | |
30241 | + write_rtl8255(dev, 0x4, 0x414); | |
30242 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404126, 0x27, | |
30243 | + 0x92402ab4, 0xf0009, 0x28000, 0xc00, 0x0); | |
30244 | + write_rtl8255(dev, 0x1, 0x807); | |
30245 | + write_rtl8255(dev, 0x4, 0xc15); | |
30246 | + write_rtl8255(dev, 0x4, 0xe15); | |
30247 | + write_rtl8255(dev, 0x4, 0xc15); | |
30248 | + write_rtl8255(dev, 0x1, 0x0); | |
30249 | + write_rtl8255(dev, 0x4, 0x815); | |
30250 | + write_rtl8255(dev, 0x3, 0x0); | |
30251 | + write_rtl8255(dev, 0x2, 0x0); | |
30252 | + write_rtl8255(dev, 0x4, 0xa15); | |
30253 | + write_rtl8255(dev, 0x4, 0x815); | |
30254 | + write_rtl8255(dev, 0x4, 0x415); | |
30255 | + write_rtl8255(dev, 0x3, 0x25); | |
30256 | + write_rtl8255(dev, 0x2, 0x26); | |
30257 | + write_rtl8255(dev, 0x4, 0x615); | |
30258 | + write_rtl8255(dev, 0x4, 0x415); | |
30259 | + write_rtl8255(dev, 0x4, 0x415); | |
30260 | + write_rtl8255(dev, 0x3, 0x100); | |
30261 | + write_rtl8255(dev, 0x4, 0x615); | |
30262 | + write_rtl8255(dev, 0x4, 0x415); | |
30263 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404106, 0x27, | |
30264 | + 0x92402ab8, 0xf0009, 0x28000, 0xc00, 0x0); | |
30265 | + write_rtl8255(dev, 0x1, 0x807); | |
30266 | + write_rtl8255(dev, 0x4, 0xc16); | |
30267 | + write_rtl8255(dev, 0x4, 0xe16); | |
30268 | + write_rtl8255(dev, 0x4, 0xc16); | |
30269 | + write_rtl8255(dev, 0x1, 0x0); | |
30270 | + write_rtl8255(dev, 0x4, 0x816); | |
30271 | + write_rtl8255(dev, 0x3, 0x0); | |
30272 | + write_rtl8255(dev, 0x2, 0x0); | |
30273 | + write_rtl8255(dev, 0x4, 0xa16); | |
30274 | + write_rtl8255(dev, 0x4, 0x816); | |
30275 | + write_rtl8255(dev, 0x4, 0x416); | |
30276 | + write_rtl8255(dev, 0x3, 0x25); | |
30277 | + write_rtl8255(dev, 0x2, 0x26); | |
30278 | + write_rtl8255(dev, 0x4, 0x616); | |
30279 | + write_rtl8255(dev, 0x4, 0x416); | |
30280 | + write_rtl8255(dev, 0x4, 0x416); | |
30281 | + write_rtl8255(dev, 0x3, 0x100); | |
30282 | + write_rtl8255(dev, 0x4, 0x616); | |
30283 | + write_rtl8255(dev, 0x4, 0x416); | |
30284 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404105, 0x27, | |
30285 | + 0x92402ab8, 0xf0009, 0x28000, 0xc00, 0x0); | |
30286 | + write_rtl8255(dev, 0x1, 0x807); | |
30287 | + write_rtl8255(dev, 0x4, 0xc17); | |
30288 | + write_rtl8255(dev, 0x4, 0xe17); | |
30289 | + write_rtl8255(dev, 0x4, 0xc17); | |
30290 | + write_rtl8255(dev, 0x1, 0x0); | |
30291 | + write_rtl8255(dev, 0x4, 0x817); | |
30292 | + write_rtl8255(dev, 0x3, 0x0); | |
30293 | + write_rtl8255(dev, 0x2, 0x0); | |
30294 | + write_rtl8255(dev, 0x4, 0xa17); | |
30295 | + write_rtl8255(dev, 0x4, 0x817); | |
30296 | + write_rtl8255(dev, 0x4, 0x417); | |
30297 | + write_rtl8255(dev, 0x3, 0x25); | |
30298 | + write_rtl8255(dev, 0x2, 0x26); | |
30299 | + write_rtl8255(dev, 0x4, 0x617); | |
30300 | + write_rtl8255(dev, 0x4, 0x417); | |
30301 | + write_rtl8255(dev, 0x4, 0x417); | |
30302 | + write_rtl8255(dev, 0x3, 0x100); | |
30303 | + write_rtl8255(dev, 0x4, 0x617); | |
30304 | + write_rtl8255(dev, 0x4, 0x417); | |
30305 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404104, 0x80000027, | |
30306 | + 0x92402a88, 0xf0009, 0x28000, 0xc00, 0x0); | |
30307 | + write_rtl8255(dev, 0x1, 0x807); | |
30308 | + write_rtl8255(dev, 0x4, 0xc18); | |
30309 | + write_rtl8255(dev, 0x4, 0xe18); | |
30310 | + write_rtl8255(dev, 0x4, 0xc18); | |
30311 | + write_rtl8255(dev, 0x1, 0x0); | |
30312 | + write_rtl8255(dev, 0x4, 0x818); | |
30313 | + write_rtl8255(dev, 0x3, 0x0); | |
30314 | + write_rtl8255(dev, 0x2, 0x0); | |
30315 | + write_rtl8255(dev, 0x4, 0xa18); | |
30316 | + write_rtl8255(dev, 0x4, 0x818); | |
30317 | + write_rtl8255(dev, 0x4, 0x418); | |
30318 | + write_rtl8255(dev, 0x3, 0x25); | |
30319 | + write_rtl8255(dev, 0x2, 0x26); | |
30320 | + write_rtl8255(dev, 0x4, 0x618); | |
30321 | + write_rtl8255(dev, 0x4, 0x418); | |
30322 | + write_rtl8255(dev, 0x4, 0x418); | |
30323 | + write_rtl8255(dev, 0x3, 0x100); | |
30324 | + write_rtl8255(dev, 0x4, 0x618); | |
30325 | + write_rtl8255(dev, 0x4, 0x418); | |
30326 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404104, 0x27, | |
30327 | + 0x92402a88, 0xf0009, 0x28000, 0xc00, 0x0); | |
30328 | + write_rtl8255(dev, 0x1, 0x807); | |
30329 | + write_rtl8255(dev, 0x4, 0xc19); | |
30330 | + write_rtl8255(dev, 0x4, 0xe19); | |
30331 | + write_rtl8255(dev, 0x4, 0xc19); | |
30332 | + write_rtl8255(dev, 0x1, 0x0); | |
30333 | + write_rtl8255(dev, 0x4, 0x819); | |
30334 | + write_rtl8255(dev, 0x3, 0x0); | |
30335 | + write_rtl8255(dev, 0x2, 0x0); | |
30336 | + write_rtl8255(dev, 0x4, 0xa19); | |
30337 | + write_rtl8255(dev, 0x4, 0x819); | |
30338 | + write_rtl8255(dev, 0x4, 0x419); | |
30339 | + write_rtl8255(dev, 0x3, 0x25); | |
30340 | + write_rtl8255(dev, 0x2, 0x26); | |
30341 | + write_rtl8255(dev, 0x4, 0x619); | |
30342 | + write_rtl8255(dev, 0x4, 0x419); | |
30343 | + write_rtl8255(dev, 0x4, 0x419); | |
30344 | + write_rtl8255(dev, 0x3, 0x100); | |
30345 | + write_rtl8255(dev, 0x4, 0x619); | |
30346 | + write_rtl8255(dev, 0x4, 0x419); | |
30347 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404044, 0x27, | |
30348 | + 0x92402a8c, 0xf0009, 0x28000, 0xc00, 0x0); | |
30349 | + write_rtl8255(dev, 0x1, 0x807); | |
30350 | + write_rtl8255(dev, 0x4, 0xc1a); | |
30351 | + write_rtl8255(dev, 0x4, 0xe1a); | |
30352 | + write_rtl8255(dev, 0x4, 0xc1a); | |
30353 | + write_rtl8255(dev, 0x1, 0x0); | |
30354 | + write_rtl8255(dev, 0x4, 0x81a); | |
30355 | + write_rtl8255(dev, 0x3, 0x0); | |
30356 | + write_rtl8255(dev, 0x2, 0x0); | |
30357 | + write_rtl8255(dev, 0x4, 0xa1a); | |
30358 | + write_rtl8255(dev, 0x4, 0x81a); | |
30359 | + write_rtl8255(dev, 0x4, 0x41a); | |
30360 | + write_rtl8255(dev, 0x3, 0x25); | |
30361 | + write_rtl8255(dev, 0x2, 0x26); | |
30362 | + write_rtl8255(dev, 0x4, 0x61a); | |
30363 | + write_rtl8255(dev, 0x4, 0x41a); | |
30364 | + write_rtl8255(dev, 0x4, 0x41a); | |
30365 | + write_rtl8255(dev, 0x3, 0x100); | |
30366 | + write_rtl8255(dev, 0x4, 0x61a); | |
30367 | + write_rtl8255(dev, 0x4, 0x41a); | |
30368 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404024, 0x27, | |
30369 | + 0x92402a8c, 0xf0009, 0x28000, 0xc00, 0x0); | |
30370 | + write_rtl8255(dev, 0x1, 0x807); | |
30371 | + write_rtl8255(dev, 0x4, 0xc1b); | |
30372 | + write_rtl8255(dev, 0x4, 0xe1b); | |
30373 | + write_rtl8255(dev, 0x4, 0xc1b); | |
30374 | + write_rtl8255(dev, 0x1, 0x0); | |
30375 | + write_rtl8255(dev, 0x4, 0x81b); | |
30376 | + write_rtl8255(dev, 0x3, 0x0); | |
30377 | + write_rtl8255(dev, 0x2, 0x0); | |
30378 | + write_rtl8255(dev, 0x4, 0xa1b); | |
30379 | + write_rtl8255(dev, 0x4, 0x81b); | |
30380 | + write_rtl8255(dev, 0x4, 0x41b); | |
30381 | + write_rtl8255(dev, 0x3, 0x25); | |
30382 | + write_rtl8255(dev, 0x2, 0x26); | |
30383 | + write_rtl8255(dev, 0x4, 0x61b); | |
30384 | + write_rtl8255(dev, 0x4, 0x41b); | |
30385 | + write_rtl8255(dev, 0x4, 0x41b); | |
30386 | + write_rtl8255(dev, 0x3, 0x100); | |
30387 | + write_rtl8255(dev, 0x4, 0x61b); | |
30388 | + write_rtl8255(dev, 0x4, 0x41b); | |
30389 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404004, 0x27, | |
30390 | + 0x92402a90, 0xf0009, 0x28000, 0xc00, 0x0); | |
30391 | + write_rtl8255(dev, 0x1, 0x807); | |
30392 | + write_rtl8255(dev, 0x4, 0xc1c); | |
30393 | + write_rtl8255(dev, 0x4, 0xe1c); | |
30394 | + write_rtl8255(dev, 0x4, 0xc1c); | |
30395 | + write_rtl8255(dev, 0x1, 0x0); | |
30396 | + write_rtl8255(dev, 0x4, 0x81c); | |
30397 | + write_rtl8255(dev, 0x3, 0x0); | |
30398 | + write_rtl8255(dev, 0x2, 0x0); | |
30399 | + write_rtl8255(dev, 0x4, 0xa1c); | |
30400 | + write_rtl8255(dev, 0x4, 0x81c); | |
30401 | + write_rtl8255(dev, 0x4, 0x41c); | |
30402 | + write_rtl8255(dev, 0x3, 0x25); | |
30403 | + write_rtl8255(dev, 0x2, 0x26); | |
30404 | + write_rtl8255(dev, 0x4, 0x61c); | |
30405 | + write_rtl8255(dev, 0x4, 0x41c); | |
30406 | + write_rtl8255(dev, 0x4, 0x41c); | |
30407 | + write_rtl8255(dev, 0x3, 0x100); | |
30408 | + write_rtl8255(dev, 0x4, 0x61c); | |
30409 | + write_rtl8255(dev, 0x4, 0x41c); | |
30410 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404001, 0x27, | |
30411 | + 0x92402a90, 0xf0009, 0x28000, 0xc00, 0x0); | |
30412 | + write_rtl8255(dev, 0x1, 0x807); | |
30413 | + write_rtl8255(dev, 0x4, 0xc1d); | |
30414 | + write_rtl8255(dev, 0x4, 0xe1d); | |
30415 | + write_rtl8255(dev, 0x4, 0xc1d); | |
30416 | + write_rtl8255(dev, 0x1, 0x0); | |
30417 | + write_rtl8255(dev, 0x4, 0x81d); | |
30418 | + write_rtl8255(dev, 0x3, 0x0); | |
30419 | + write_rtl8255(dev, 0x2, 0x0); | |
30420 | + write_rtl8255(dev, 0x4, 0xa1d); | |
30421 | + write_rtl8255(dev, 0x4, 0x81d); | |
30422 | + write_rtl8255(dev, 0x4, 0x41d); | |
30423 | + write_rtl8255(dev, 0x3, 0x25); | |
30424 | + write_rtl8255(dev, 0x2, 0x26); | |
30425 | + write_rtl8255(dev, 0x4, 0x61d); | |
30426 | + write_rtl8255(dev, 0x4, 0x41d); | |
30427 | + write_rtl8255(dev, 0x4, 0x41d); | |
30428 | + write_rtl8255(dev, 0x3, 0x100); | |
30429 | + write_rtl8255(dev, 0x4, 0x61d); | |
30430 | + write_rtl8255(dev, 0x4, 0x41d); | |
30431 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30432 | + 0x92402a94, 0xf0009, 0x28000, 0xc00, 0x0); | |
30433 | + write_rtl8255(dev, 0x1, 0x807); | |
30434 | + write_rtl8255(dev, 0x4, 0xc1e); | |
30435 | + write_rtl8255(dev, 0x4, 0xe1e); | |
30436 | + write_rtl8255(dev, 0x4, 0xc1e); | |
30437 | + write_rtl8255(dev, 0x1, 0x0); | |
30438 | + write_rtl8255(dev, 0x4, 0x81e); | |
30439 | + write_rtl8255(dev, 0x3, 0x0); | |
30440 | + write_rtl8255(dev, 0x2, 0x0); | |
30441 | + write_rtl8255(dev, 0x4, 0xa1e); | |
30442 | + write_rtl8255(dev, 0x4, 0x81e); | |
30443 | + write_rtl8255(dev, 0x4, 0x41e); | |
30444 | + write_rtl8255(dev, 0x3, 0x25); | |
30445 | + write_rtl8255(dev, 0x2, 0x26); | |
30446 | + write_rtl8255(dev, 0x4, 0x61e); | |
30447 | + write_rtl8255(dev, 0x4, 0x41e); | |
30448 | + write_rtl8255(dev, 0x4, 0x41e); | |
30449 | + write_rtl8255(dev, 0x3, 0x100); | |
30450 | + write_rtl8255(dev, 0x4, 0x61e); | |
30451 | + write_rtl8255(dev, 0x4, 0x41e); | |
30452 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x27, | |
30453 | + 0x92402a94, 0xf0009, 0x28000, 0xc00, 0x0); | |
30454 | + write_rtl8255(dev, 0x1, 0x807); | |
30455 | + write_rtl8255(dev, 0x4, 0xc1f); | |
30456 | + write_rtl8255(dev, 0x4, 0xe1f); | |
30457 | + write_rtl8255(dev, 0x4, 0xc1f); | |
30458 | + write_rtl8255(dev, 0x1, 0x0); | |
30459 | + write_rtl8255(dev, 0x4, 0x81f); | |
30460 | + write_rtl8255(dev, 0x3, 0x0); | |
30461 | + write_rtl8255(dev, 0x2, 0x0); | |
30462 | + write_rtl8255(dev, 0x4, 0xa1f); | |
30463 | + write_rtl8255(dev, 0x4, 0x81f); | |
30464 | + write_rtl8255(dev, 0x4, 0x41f); | |
30465 | + write_rtl8255(dev, 0x3, 0x25); | |
30466 | + write_rtl8255(dev, 0x2, 0x26); | |
30467 | + write_rtl8255(dev, 0x4, 0x61f); | |
30468 | + write_rtl8255(dev, 0x4, 0x41f); | |
30469 | + write_rtl8255(dev, 0x4, 0x41f); | |
30470 | + write_rtl8255(dev, 0x3, 0x100); | |
30471 | + write_rtl8255(dev, 0x4, 0x61f); | |
30472 | + write_rtl8255(dev, 0x4, 0x41f); | |
30473 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404020, 0x80000027, | |
30474 | + 0x92402a98, 0xf8009, 0x28000, 0xc00, 0x0); | |
30475 | + write_rtl8255(dev, 0x1, 0x807); | |
30476 | + write_rtl8255(dev, 0x4, 0xc20); | |
30477 | + write_rtl8255(dev, 0x4, 0xe20); | |
30478 | + write_rtl8255(dev, 0x4, 0xc20); | |
30479 | + write_rtl8255(dev, 0x1, 0x0); | |
30480 | + write_rtl8255(dev, 0x4, 0x820); | |
30481 | + write_rtl8255(dev, 0x3, 0x0); | |
30482 | + write_rtl8255(dev, 0x2, 0x0); | |
30483 | + write_rtl8255(dev, 0x4, 0xa20); | |
30484 | + write_rtl8255(dev, 0x4, 0x820); | |
30485 | + write_rtl8255(dev, 0x4, 0x420); | |
30486 | + write_rtl8255(dev, 0x3, 0x25); | |
30487 | + write_rtl8255(dev, 0x2, 0x26); | |
30488 | + write_rtl8255(dev, 0x4, 0x620); | |
30489 | + write_rtl8255(dev, 0x4, 0x420); | |
30490 | + write_rtl8255(dev, 0x4, 0x420); | |
30491 | + write_rtl8255(dev, 0x3, 0x100); | |
30492 | + write_rtl8255(dev, 0x4, 0x620); | |
30493 | + write_rtl8255(dev, 0x4, 0x420); | |
30494 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404020, 0x27, | |
30495 | + 0x92402a98, 0xf8009, 0x28000, 0xc00, 0x0); | |
30496 | + write_rtl8255(dev, 0x1, 0x807); | |
30497 | + write_rtl8255(dev, 0x4, 0xc21); | |
30498 | + write_rtl8255(dev, 0x4, 0xe21); | |
30499 | + write_rtl8255(dev, 0x4, 0xc21); | |
30500 | + write_rtl8255(dev, 0x1, 0x0); | |
30501 | + write_rtl8255(dev, 0x4, 0x821); | |
30502 | + write_rtl8255(dev, 0x3, 0x0); | |
30503 | + write_rtl8255(dev, 0x2, 0x0); | |
30504 | + write_rtl8255(dev, 0x4, 0xa21); | |
30505 | + write_rtl8255(dev, 0x4, 0x821); | |
30506 | + write_rtl8255(dev, 0x4, 0x421); | |
30507 | + write_rtl8255(dev, 0x3, 0x25); | |
30508 | + write_rtl8255(dev, 0x2, 0x26); | |
30509 | + write_rtl8255(dev, 0x4, 0x621); | |
30510 | + write_rtl8255(dev, 0x4, 0x421); | |
30511 | + write_rtl8255(dev, 0x4, 0x421); | |
30512 | + write_rtl8255(dev, 0x3, 0x100); | |
30513 | + write_rtl8255(dev, 0x4, 0x621); | |
30514 | + write_rtl8255(dev, 0x4, 0x421); | |
30515 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30516 | + 0x92402a68, 0xf0009, 0x10028000, 0xc00, 0x0); | |
30517 | + write_rtl8255(dev, 0x1, 0x807); | |
30518 | + write_rtl8255(dev, 0x4, 0xc22); | |
30519 | + write_rtl8255(dev, 0x4, 0xe22); | |
30520 | + write_rtl8255(dev, 0x4, 0xc22); | |
30521 | + write_rtl8255(dev, 0x1, 0x0); | |
30522 | + write_rtl8255(dev, 0x4, 0x822); | |
30523 | + write_rtl8255(dev, 0x3, 0x0); | |
30524 | + write_rtl8255(dev, 0x2, 0x0); | |
30525 | + write_rtl8255(dev, 0x4, 0xa22); | |
30526 | + write_rtl8255(dev, 0x4, 0x822); | |
30527 | + write_rtl8255(dev, 0x4, 0x422); | |
30528 | + write_rtl8255(dev, 0x3, 0x25); | |
30529 | + write_rtl8255(dev, 0x2, 0x26); | |
30530 | + write_rtl8255(dev, 0x4, 0x622); | |
30531 | + write_rtl8255(dev, 0x4, 0x422); | |
30532 | + write_rtl8255(dev, 0x4, 0x422); | |
30533 | + write_rtl8255(dev, 0x3, 0x100); | |
30534 | + write_rtl8255(dev, 0x4, 0x622); | |
30535 | + write_rtl8255(dev, 0x4, 0x422); | |
30536 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404010, 0x80000027, | |
30537 | + 0x92402a68, 0xf0009, 0x20028000, 0xc00, 0x0); | |
30538 | + write_rtl8255(dev, 0x1, 0x807); | |
30539 | + write_rtl8255(dev, 0x4, 0xc23); | |
30540 | + write_rtl8255(dev, 0x4, 0xe23); | |
30541 | + write_rtl8255(dev, 0x4, 0xc23); | |
30542 | + write_rtl8255(dev, 0x1, 0x0); | |
30543 | + write_rtl8255(dev, 0x4, 0x823); | |
30544 | + write_rtl8255(dev, 0x3, 0x0); | |
30545 | + write_rtl8255(dev, 0x2, 0x0); | |
30546 | + write_rtl8255(dev, 0x4, 0xa23); | |
30547 | + write_rtl8255(dev, 0x4, 0x823); | |
30548 | + write_rtl8255(dev, 0x4, 0x423); | |
30549 | + write_rtl8255(dev, 0x3, 0x25); | |
30550 | + write_rtl8255(dev, 0x2, 0x26); | |
30551 | + write_rtl8255(dev, 0x4, 0x623); | |
30552 | + write_rtl8255(dev, 0x4, 0x423); | |
30553 | + write_rtl8255(dev, 0x4, 0x423); | |
30554 | + write_rtl8255(dev, 0x3, 0x100); | |
30555 | + write_rtl8255(dev, 0x4, 0x623); | |
30556 | + write_rtl8255(dev, 0x4, 0x423); | |
30557 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404010, 0x80000027, | |
30558 | + 0x92402a6c, 0xf0009, 0x30028000, 0xc00, 0x0); | |
30559 | + write_rtl8255(dev, 0x1, 0x807); | |
30560 | + write_rtl8255(dev, 0x4, 0xc24); | |
30561 | + write_rtl8255(dev, 0x4, 0xe24); | |
30562 | + write_rtl8255(dev, 0x4, 0xc24); | |
30563 | + write_rtl8255(dev, 0x1, 0x0); | |
30564 | + write_rtl8255(dev, 0x4, 0x824); | |
30565 | + write_rtl8255(dev, 0x3, 0x0); | |
30566 | + write_rtl8255(dev, 0x2, 0x0); | |
30567 | + write_rtl8255(dev, 0x4, 0xa24); | |
30568 | + write_rtl8255(dev, 0x4, 0x824); | |
30569 | + write_rtl8255(dev, 0x4, 0x424); | |
30570 | + write_rtl8255(dev, 0x3, 0x25); | |
30571 | + write_rtl8255(dev, 0x2, 0x26); | |
30572 | + write_rtl8255(dev, 0x4, 0x624); | |
30573 | + write_rtl8255(dev, 0x4, 0x424); | |
30574 | + write_rtl8255(dev, 0x4, 0x424); | |
30575 | + write_rtl8255(dev, 0x3, 0x100); | |
30576 | + write_rtl8255(dev, 0x4, 0x624); | |
30577 | + write_rtl8255(dev, 0x4, 0x424); | |
30578 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404010, 0x80000027, | |
30579 | + 0x92402a6c, 0xf0009, 0x40028000, 0xc00, 0x0); | |
30580 | + write_rtl8255(dev, 0x1, 0x807); | |
30581 | + write_rtl8255(dev, 0x4, 0xc25); | |
30582 | + write_rtl8255(dev, 0x4, 0xe25); | |
30583 | + write_rtl8255(dev, 0x4, 0xc25); | |
30584 | + write_rtl8255(dev, 0x1, 0x0); | |
30585 | + write_rtl8255(dev, 0x4, 0x825); | |
30586 | + write_rtl8255(dev, 0x3, 0x0); | |
30587 | + write_rtl8255(dev, 0x2, 0x0); | |
30588 | + write_rtl8255(dev, 0x4, 0xa25); | |
30589 | + write_rtl8255(dev, 0x4, 0x825); | |
30590 | + write_rtl8255(dev, 0x4, 0x425); | |
30591 | + write_rtl8255(dev, 0x3, 0x25); | |
30592 | + write_rtl8255(dev, 0x2, 0x26); | |
30593 | + write_rtl8255(dev, 0x4, 0x625); | |
30594 | + write_rtl8255(dev, 0x4, 0x425); | |
30595 | + write_rtl8255(dev, 0x4, 0x425); | |
30596 | + write_rtl8255(dev, 0x3, 0x100); | |
30597 | + write_rtl8255(dev, 0x4, 0x625); | |
30598 | + write_rtl8255(dev, 0x4, 0x425); | |
30599 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30600 | + 0x92402a70, 0xf0009, 0x60028000, 0xc00, 0x0); | |
30601 | + write_rtl8255(dev, 0x1, 0x807); | |
30602 | + write_rtl8255(dev, 0x4, 0xc26); | |
30603 | + write_rtl8255(dev, 0x4, 0xe26); | |
30604 | + write_rtl8255(dev, 0x4, 0xc26); | |
30605 | + write_rtl8255(dev, 0x1, 0x0); | |
30606 | + write_rtl8255(dev, 0x4, 0x826); | |
30607 | + write_rtl8255(dev, 0x3, 0x0); | |
30608 | + write_rtl8255(dev, 0x2, 0x0); | |
30609 | + write_rtl8255(dev, 0x4, 0xa26); | |
30610 | + write_rtl8255(dev, 0x4, 0x826); | |
30611 | + write_rtl8255(dev, 0x4, 0x426); | |
30612 | + write_rtl8255(dev, 0x3, 0x25); | |
30613 | + write_rtl8255(dev, 0x2, 0x26); | |
30614 | + write_rtl8255(dev, 0x4, 0x626); | |
30615 | + write_rtl8255(dev, 0x4, 0x426); | |
30616 | + write_rtl8255(dev, 0x4, 0x426); | |
30617 | + write_rtl8255(dev, 0x3, 0x100); | |
30618 | + write_rtl8255(dev, 0x4, 0x626); | |
30619 | + write_rtl8255(dev, 0x4, 0x426); | |
30620 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404031, 0x40000027, | |
30621 | + 0x92402a70, 0xf0011, 0x60028000, 0xc00, 0x0); | |
30622 | + write_rtl8255(dev, 0x1, 0x807); | |
30623 | + write_rtl8255(dev, 0x4, 0xc27); | |
30624 | + write_rtl8255(dev, 0x4, 0xe27); | |
30625 | + write_rtl8255(dev, 0x4, 0xc27); | |
30626 | + write_rtl8255(dev, 0x1, 0x0); | |
30627 | + write_rtl8255(dev, 0x4, 0x827); | |
30628 | + write_rtl8255(dev, 0x3, 0x0); | |
30629 | + write_rtl8255(dev, 0x2, 0x0); | |
30630 | + write_rtl8255(dev, 0x4, 0xa27); | |
30631 | + write_rtl8255(dev, 0x4, 0x827); | |
30632 | + write_rtl8255(dev, 0x4, 0x427); | |
30633 | + write_rtl8255(dev, 0x3, 0x25); | |
30634 | + write_rtl8255(dev, 0x2, 0x26); | |
30635 | + write_rtl8255(dev, 0x4, 0x627); | |
30636 | + write_rtl8255(dev, 0x4, 0x427); | |
30637 | + write_rtl8255(dev, 0x4, 0x427); | |
30638 | + write_rtl8255(dev, 0x3, 0x100); | |
30639 | + write_rtl8255(dev, 0x4, 0x627); | |
30640 | + write_rtl8255(dev, 0x4, 0x427); | |
30641 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404011, 0x40000027, | |
30642 | + 0x92402a74, 0xf0011, 0x60028000, 0xc00, 0x0); | |
30643 | + write_rtl8255(dev, 0x1, 0x807); | |
30644 | + write_rtl8255(dev, 0x4, 0xc28); | |
30645 | + write_rtl8255(dev, 0x4, 0xe28); | |
30646 | + write_rtl8255(dev, 0x4, 0xc28); | |
30647 | + write_rtl8255(dev, 0x1, 0x0); | |
30648 | + write_rtl8255(dev, 0x4, 0x828); | |
30649 | + write_rtl8255(dev, 0x3, 0x0); | |
30650 | + write_rtl8255(dev, 0x2, 0x0); | |
30651 | + write_rtl8255(dev, 0x4, 0xa28); | |
30652 | + write_rtl8255(dev, 0x4, 0x828); | |
30653 | + write_rtl8255(dev, 0x4, 0x428); | |
30654 | + write_rtl8255(dev, 0x3, 0x25); | |
30655 | + write_rtl8255(dev, 0x2, 0x26); | |
30656 | + write_rtl8255(dev, 0x4, 0x628); | |
30657 | + write_rtl8255(dev, 0x4, 0x428); | |
30658 | + write_rtl8255(dev, 0x4, 0x428); | |
30659 | + write_rtl8255(dev, 0x3, 0x100); | |
30660 | + write_rtl8255(dev, 0x4, 0x628); | |
30661 | + write_rtl8255(dev, 0x4, 0x428); | |
30662 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404010, 0xc0000027, | |
30663 | + 0x92402a74, 0xf0011, 0x60028000, 0xc00, 0x0); | |
30664 | + write_rtl8255(dev, 0x1, 0x807); | |
30665 | + write_rtl8255(dev, 0x4, 0xc29); | |
30666 | + write_rtl8255(dev, 0x4, 0xe29); | |
30667 | + write_rtl8255(dev, 0x4, 0xc29); | |
30668 | + write_rtl8255(dev, 0x1, 0x0); | |
30669 | + write_rtl8255(dev, 0x4, 0x829); | |
30670 | + write_rtl8255(dev, 0x3, 0x0); | |
30671 | + write_rtl8255(dev, 0x2, 0x0); | |
30672 | + write_rtl8255(dev, 0x4, 0xa29); | |
30673 | + write_rtl8255(dev, 0x4, 0x829); | |
30674 | + write_rtl8255(dev, 0x4, 0x429); | |
30675 | + write_rtl8255(dev, 0x3, 0x25); | |
30676 | + write_rtl8255(dev, 0x2, 0x26); | |
30677 | + write_rtl8255(dev, 0x4, 0x629); | |
30678 | + write_rtl8255(dev, 0x4, 0x429); | |
30679 | + write_rtl8255(dev, 0x4, 0x429); | |
30680 | + write_rtl8255(dev, 0x3, 0x100); | |
30681 | + write_rtl8255(dev, 0x4, 0x629); | |
30682 | + write_rtl8255(dev, 0x4, 0x429); | |
30683 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30684 | + 0x92402a78, 0xf0011, 0x60028000, 0xc00, 0x0); | |
30685 | + write_rtl8255(dev, 0x1, 0x807); | |
30686 | + write_rtl8255(dev, 0x4, 0xc2a); | |
30687 | + write_rtl8255(dev, 0x4, 0xe2a); | |
30688 | + write_rtl8255(dev, 0x4, 0xc2a); | |
30689 | + write_rtl8255(dev, 0x1, 0x0); | |
30690 | + write_rtl8255(dev, 0x4, 0x82a); | |
30691 | + write_rtl8255(dev, 0x3, 0x0); | |
30692 | + write_rtl8255(dev, 0x2, 0x0); | |
30693 | + write_rtl8255(dev, 0x4, 0xa2a); | |
30694 | + write_rtl8255(dev, 0x4, 0x82a); | |
30695 | + write_rtl8255(dev, 0x4, 0x42a); | |
30696 | + write_rtl8255(dev, 0x3, 0x24); | |
30697 | + write_rtl8255(dev, 0x2, 0x26); | |
30698 | + write_rtl8255(dev, 0x4, 0x62a); | |
30699 | + write_rtl8255(dev, 0x4, 0x42a); | |
30700 | + write_rtl8255(dev, 0x4, 0x42a); | |
30701 | + write_rtl8255(dev, 0x3, 0x100); | |
30702 | + write_rtl8255(dev, 0x4, 0x62a); | |
30703 | + write_rtl8255(dev, 0x4, 0x42a); | |
30704 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30705 | + 0x92402a78, 0xf0011, 0x70028000, 0xc00, 0x0); | |
30706 | + write_rtl8255(dev, 0x1, 0x807); | |
30707 | + write_rtl8255(dev, 0x4, 0xc2b); | |
30708 | + write_rtl8255(dev, 0x4, 0xe2b); | |
30709 | + write_rtl8255(dev, 0x4, 0xc2b); | |
30710 | + write_rtl8255(dev, 0x1, 0x0); | |
30711 | + write_rtl8255(dev, 0x4, 0x82b); | |
30712 | + write_rtl8255(dev, 0x3, 0x0); | |
30713 | + write_rtl8255(dev, 0x2, 0x0); | |
30714 | + write_rtl8255(dev, 0x4, 0xa2b); | |
30715 | + write_rtl8255(dev, 0x4, 0x82b); | |
30716 | + write_rtl8255(dev, 0x4, 0x42b); | |
30717 | + write_rtl8255(dev, 0x3, 0x24); | |
30718 | + write_rtl8255(dev, 0x2, 0x26); | |
30719 | + write_rtl8255(dev, 0x4, 0x62b); | |
30720 | + write_rtl8255(dev, 0x4, 0x42b); | |
30721 | + write_rtl8255(dev, 0x4, 0x42b); | |
30722 | + write_rtl8255(dev, 0x3, 0x100); | |
30723 | + write_rtl8255(dev, 0x4, 0x62b); | |
30724 | + write_rtl8255(dev, 0x4, 0x42b); | |
30725 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30726 | + 0x92402a48, 0xf0019, 0x70028000, 0xc00, 0x0); | |
30727 | + write_rtl8255(dev, 0x1, 0x807); | |
30728 | + write_rtl8255(dev, 0x4, 0xc2c); | |
30729 | + write_rtl8255(dev, 0x4, 0xe2c); | |
30730 | + write_rtl8255(dev, 0x4, 0xc2c); | |
30731 | + write_rtl8255(dev, 0x1, 0x0); | |
30732 | + write_rtl8255(dev, 0x4, 0x82c); | |
30733 | + write_rtl8255(dev, 0x3, 0x0); | |
30734 | + write_rtl8255(dev, 0x2, 0x0); | |
30735 | + write_rtl8255(dev, 0x4, 0xa2c); | |
30736 | + write_rtl8255(dev, 0x4, 0x82c); | |
30737 | + write_rtl8255(dev, 0x4, 0x42c); | |
30738 | + write_rtl8255(dev, 0x3, 0x24); | |
30739 | + write_rtl8255(dev, 0x2, 0x26); | |
30740 | + write_rtl8255(dev, 0x4, 0x62c); | |
30741 | + write_rtl8255(dev, 0x4, 0x42c); | |
30742 | + write_rtl8255(dev, 0x4, 0x42c); | |
30743 | + write_rtl8255(dev, 0x3, 0x100); | |
30744 | + write_rtl8255(dev, 0x4, 0x62c); | |
30745 | + write_rtl8255(dev, 0x4, 0x42c); | |
30746 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30747 | + 0x92402a48, 0xf8019, 0x70028000, 0xc00, 0x0); | |
30748 | + write_rtl8255(dev, 0x1, 0x807); | |
30749 | + write_rtl8255(dev, 0x4, 0xc2d); | |
30750 | + write_rtl8255(dev, 0x4, 0xe2d); | |
30751 | + write_rtl8255(dev, 0x4, 0xc2d); | |
30752 | + write_rtl8255(dev, 0x1, 0x0); | |
30753 | + write_rtl8255(dev, 0x4, 0x82d); | |
30754 | + write_rtl8255(dev, 0x3, 0x0); | |
30755 | + write_rtl8255(dev, 0x2, 0x0); | |
30756 | + write_rtl8255(dev, 0x4, 0xa2d); | |
30757 | + write_rtl8255(dev, 0x4, 0x82d); | |
30758 | + write_rtl8255(dev, 0x4, 0x42d); | |
30759 | + write_rtl8255(dev, 0x3, 0x24); | |
30760 | + write_rtl8255(dev, 0x2, 0x26); | |
30761 | + write_rtl8255(dev, 0x4, 0x62d); | |
30762 | + write_rtl8255(dev, 0x4, 0x42d); | |
30763 | + write_rtl8255(dev, 0x4, 0x42d); | |
30764 | + write_rtl8255(dev, 0x3, 0x100); | |
30765 | + write_rtl8255(dev, 0x4, 0x62d); | |
30766 | + write_rtl8255(dev, 0x4, 0x42d); | |
30767 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30768 | + 0x92402a4c, 0xf8019, 0x70028000, 0xc00, 0x0); | |
30769 | + write_rtl8255(dev, 0x1, 0x807); | |
30770 | + write_rtl8255(dev, 0x4, 0xc2e); | |
30771 | + write_rtl8255(dev, 0x4, 0xe2e); | |
30772 | + write_rtl8255(dev, 0x4, 0xc2e); | |
30773 | + write_rtl8255(dev, 0x1, 0x0); | |
30774 | + write_rtl8255(dev, 0x4, 0x82e); | |
30775 | + write_rtl8255(dev, 0x3, 0x0); | |
30776 | + write_rtl8255(dev, 0x2, 0x0); | |
30777 | + write_rtl8255(dev, 0x4, 0xa2e); | |
30778 | + write_rtl8255(dev, 0x4, 0x82e); | |
30779 | + write_rtl8255(dev, 0x4, 0x42e); | |
30780 | + write_rtl8255(dev, 0x3, 0x24); | |
30781 | + write_rtl8255(dev, 0x2, 0x26); | |
30782 | + write_rtl8255(dev, 0x4, 0x62e); | |
30783 | + write_rtl8255(dev, 0x4, 0x42e); | |
30784 | + write_rtl8255(dev, 0x4, 0x42e); | |
30785 | + write_rtl8255(dev, 0x3, 0x100); | |
30786 | + write_rtl8255(dev, 0x4, 0x62e); | |
30787 | + write_rtl8255(dev, 0x4, 0x42e); | |
30788 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30789 | + 0x92402a4c, 0xf8019, 0x70028000, 0xc00, 0x0); | |
30790 | + write_rtl8255(dev, 0x1, 0x807); | |
30791 | + write_rtl8255(dev, 0x4, 0xc2f); | |
30792 | + write_rtl8255(dev, 0x4, 0xe2f); | |
30793 | + write_rtl8255(dev, 0x4, 0xc2f); | |
30794 | + write_rtl8255(dev, 0x1, 0x0); | |
30795 | + write_rtl8255(dev, 0x4, 0x82f); | |
30796 | + write_rtl8255(dev, 0x3, 0x0); | |
30797 | + write_rtl8255(dev, 0x2, 0x0); | |
30798 | + write_rtl8255(dev, 0x4, 0xa2f); | |
30799 | + write_rtl8255(dev, 0x4, 0x82f); | |
30800 | + write_rtl8255(dev, 0x4, 0x42f); | |
30801 | + write_rtl8255(dev, 0x3, 0x24); | |
30802 | + write_rtl8255(dev, 0x2, 0x26); | |
30803 | + write_rtl8255(dev, 0x4, 0x62f); | |
30804 | + write_rtl8255(dev, 0x4, 0x42f); | |
30805 | + write_rtl8255(dev, 0x4, 0x42f); | |
30806 | + write_rtl8255(dev, 0x3, 0x100); | |
30807 | + write_rtl8255(dev, 0x4, 0x62f); | |
30808 | + write_rtl8255(dev, 0x4, 0x42f); | |
30809 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30810 | + 0x92402a50, 0xf8019, 0x70028000, 0xc00, 0x0); | |
30811 | + write_rtl8255(dev, 0x1, 0x807); | |
30812 | + write_rtl8255(dev, 0x4, 0xc30); | |
30813 | + write_rtl8255(dev, 0x4, 0xe30); | |
30814 | + write_rtl8255(dev, 0x4, 0xc30); | |
30815 | + write_rtl8255(dev, 0x1, 0x0); | |
30816 | + write_rtl8255(dev, 0x4, 0x830); | |
30817 | + write_rtl8255(dev, 0x3, 0x0); | |
30818 | + write_rtl8255(dev, 0x2, 0x0); | |
30819 | + write_rtl8255(dev, 0x4, 0xa30); | |
30820 | + write_rtl8255(dev, 0x4, 0x830); | |
30821 | + write_rtl8255(dev, 0x4, 0x430); | |
30822 | + write_rtl8255(dev, 0x3, 0x24); | |
30823 | + write_rtl8255(dev, 0x2, 0x26); | |
30824 | + write_rtl8255(dev, 0x4, 0x630); | |
30825 | + write_rtl8255(dev, 0x4, 0x430); | |
30826 | + write_rtl8255(dev, 0x4, 0x430); | |
30827 | + write_rtl8255(dev, 0x3, 0x100); | |
30828 | + write_rtl8255(dev, 0x4, 0x630); | |
30829 | + write_rtl8255(dev, 0x4, 0x430); | |
30830 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30831 | + 0x92402a50, 0xf8019, 0x70028000, 0xc00, 0x0); | |
30832 | + write_rtl8255(dev, 0x1, 0x807); | |
30833 | + write_rtl8255(dev, 0x4, 0xc31); | |
30834 | + write_rtl8255(dev, 0x4, 0xe31); | |
30835 | + write_rtl8255(dev, 0x4, 0xc31); | |
30836 | + write_rtl8255(dev, 0x1, 0x0); | |
30837 | + write_rtl8255(dev, 0x4, 0x831); | |
30838 | + write_rtl8255(dev, 0x3, 0x0); | |
30839 | + write_rtl8255(dev, 0x2, 0x0); | |
30840 | + write_rtl8255(dev, 0x4, 0xa31); | |
30841 | + write_rtl8255(dev, 0x4, 0x831); | |
30842 | + write_rtl8255(dev, 0x4, 0x431); | |
30843 | + write_rtl8255(dev, 0x3, 0x24); | |
30844 | + write_rtl8255(dev, 0x2, 0x26); | |
30845 | + write_rtl8255(dev, 0x4, 0x631); | |
30846 | + write_rtl8255(dev, 0x4, 0x431); | |
30847 | + write_rtl8255(dev, 0x4, 0x431); | |
30848 | + write_rtl8255(dev, 0x3, 0x100); | |
30849 | + write_rtl8255(dev, 0x4, 0x631); | |
30850 | + write_rtl8255(dev, 0x4, 0x431); | |
30851 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30852 | + 0x92402a54, 0xf8019, 0x70028000, 0xc00, 0x0); | |
30853 | + write_rtl8255(dev, 0x1, 0x807); | |
30854 | + write_rtl8255(dev, 0x4, 0xc32); | |
30855 | + write_rtl8255(dev, 0x4, 0xe32); | |
30856 | + write_rtl8255(dev, 0x4, 0xc32); | |
30857 | + write_rtl8255(dev, 0x1, 0x0); | |
30858 | + write_rtl8255(dev, 0x4, 0x832); | |
30859 | + write_rtl8255(dev, 0x3, 0x0); | |
30860 | + write_rtl8255(dev, 0x2, 0x0); | |
30861 | + write_rtl8255(dev, 0x4, 0xa32); | |
30862 | + write_rtl8255(dev, 0x4, 0x832); | |
30863 | + write_rtl8255(dev, 0x4, 0x432); | |
30864 | + write_rtl8255(dev, 0x3, 0x24); | |
30865 | + write_rtl8255(dev, 0x2, 0x26); | |
30866 | + write_rtl8255(dev, 0x4, 0x632); | |
30867 | + write_rtl8255(dev, 0x4, 0x432); | |
30868 | + write_rtl8255(dev, 0x4, 0x432); | |
30869 | + write_rtl8255(dev, 0x3, 0x100); | |
30870 | + write_rtl8255(dev, 0x4, 0x632); | |
30871 | + write_rtl8255(dev, 0x4, 0x432); | |
30872 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30873 | + 0x92402a54, 0xf8019, 0x70028000, 0xc00, 0x0); | |
30874 | + write_rtl8255(dev, 0x1, 0x807); | |
30875 | + write_rtl8255(dev, 0x4, 0xc33); | |
30876 | + write_rtl8255(dev, 0x4, 0xe33); | |
30877 | + write_rtl8255(dev, 0x4, 0xc33); | |
30878 | + write_rtl8255(dev, 0x1, 0x0); | |
30879 | + write_rtl8255(dev, 0x4, 0x833); | |
30880 | + write_rtl8255(dev, 0x3, 0x0); | |
30881 | + write_rtl8255(dev, 0x2, 0x0); | |
30882 | + write_rtl8255(dev, 0x4, 0xa33); | |
30883 | + write_rtl8255(dev, 0x4, 0x833); | |
30884 | + write_rtl8255(dev, 0x4, 0x433); | |
30885 | + write_rtl8255(dev, 0x3, 0x24); | |
30886 | + write_rtl8255(dev, 0x2, 0x26); | |
30887 | + write_rtl8255(dev, 0x4, 0x633); | |
30888 | + write_rtl8255(dev, 0x4, 0x433); | |
30889 | + write_rtl8255(dev, 0x4, 0x433); | |
30890 | + write_rtl8255(dev, 0x3, 0x100); | |
30891 | + write_rtl8255(dev, 0x4, 0x633); | |
30892 | + write_rtl8255(dev, 0x4, 0x433); | |
30893 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30894 | + 0x92402a58, 0xf8019, 0x70028000, 0xc00, 0x0); | |
30895 | + write_rtl8255(dev, 0x1, 0x807); | |
30896 | + write_rtl8255(dev, 0x4, 0xc34); | |
30897 | + write_rtl8255(dev, 0x4, 0xe34); | |
30898 | + write_rtl8255(dev, 0x4, 0xc34); | |
30899 | + write_rtl8255(dev, 0x1, 0x0); | |
30900 | + write_rtl8255(dev, 0x4, 0x834); | |
30901 | + write_rtl8255(dev, 0x3, 0x0); | |
30902 | + write_rtl8255(dev, 0x2, 0x0); | |
30903 | + write_rtl8255(dev, 0x4, 0xa34); | |
30904 | + write_rtl8255(dev, 0x4, 0x834); | |
30905 | + write_rtl8255(dev, 0x4, 0x434); | |
30906 | + write_rtl8255(dev, 0x3, 0x24); | |
30907 | + write_rtl8255(dev, 0x2, 0x26); | |
30908 | + write_rtl8255(dev, 0x4, 0x634); | |
30909 | + write_rtl8255(dev, 0x4, 0x434); | |
30910 | + write_rtl8255(dev, 0x4, 0x434); | |
30911 | + write_rtl8255(dev, 0x3, 0x100); | |
30912 | + write_rtl8255(dev, 0x4, 0x634); | |
30913 | + write_rtl8255(dev, 0x4, 0x434); | |
30914 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30915 | + 0x92402a58, 0xf8019, 0x70028000, 0xc00, 0x0); | |
30916 | + write_rtl8255(dev, 0x1, 0x807); | |
30917 | + write_rtl8255(dev, 0x4, 0xc35); | |
30918 | + write_rtl8255(dev, 0x4, 0xe35); | |
30919 | + write_rtl8255(dev, 0x4, 0xc35); | |
30920 | + write_rtl8255(dev, 0x1, 0x0); | |
30921 | + write_rtl8255(dev, 0x4, 0x835); | |
30922 | + write_rtl8255(dev, 0x3, 0x0); | |
30923 | + write_rtl8255(dev, 0x2, 0x0); | |
30924 | + write_rtl8255(dev, 0x4, 0xa35); | |
30925 | + write_rtl8255(dev, 0x4, 0x835); | |
30926 | + write_rtl8255(dev, 0x4, 0x435); | |
30927 | + write_rtl8255(dev, 0x3, 0x24); | |
30928 | + write_rtl8255(dev, 0x2, 0x26); | |
30929 | + write_rtl8255(dev, 0x4, 0x635); | |
30930 | + write_rtl8255(dev, 0x4, 0x435); | |
30931 | + write_rtl8255(dev, 0x4, 0x435); | |
30932 | + write_rtl8255(dev, 0x3, 0x100); | |
30933 | + write_rtl8255(dev, 0x4, 0x635); | |
30934 | + write_rtl8255(dev, 0x4, 0x435); | |
30935 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30936 | + 0x92402a24, 0xf8019, 0x70028000, 0xc00, 0x0); | |
30937 | + write_rtl8255(dev, 0x1, 0x807); | |
30938 | + write_rtl8255(dev, 0x4, 0xc36); | |
30939 | + write_rtl8255(dev, 0x4, 0xe36); | |
30940 | + write_rtl8255(dev, 0x4, 0xc36); | |
30941 | + write_rtl8255(dev, 0x1, 0x0); | |
30942 | + write_rtl8255(dev, 0x4, 0x836); | |
30943 | + write_rtl8255(dev, 0x3, 0x0); | |
30944 | + write_rtl8255(dev, 0x2, 0x0); | |
30945 | + write_rtl8255(dev, 0x4, 0xa36); | |
30946 | + write_rtl8255(dev, 0x4, 0x836); | |
30947 | + write_rtl8255(dev, 0x4, 0x436); | |
30948 | + write_rtl8255(dev, 0x3, 0x24); | |
30949 | + write_rtl8255(dev, 0x2, 0x25); | |
30950 | + write_rtl8255(dev, 0x4, 0x636); | |
30951 | + write_rtl8255(dev, 0x4, 0x436); | |
30952 | + write_rtl8255(dev, 0x4, 0x436); | |
30953 | + write_rtl8255(dev, 0x3, 0x100); | |
30954 | + write_rtl8255(dev, 0x4, 0x636); | |
30955 | + write_rtl8255(dev, 0x4, 0x436); | |
30956 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30957 | + 0x92402a24, 0xf8019, 0x70028000, 0xc00, 0x0); | |
30958 | + write_rtl8255(dev, 0x1, 0x807); | |
30959 | + write_rtl8255(dev, 0x4, 0xc37); | |
30960 | + write_rtl8255(dev, 0x4, 0xe37); | |
30961 | + write_rtl8255(dev, 0x4, 0xc37); | |
30962 | + write_rtl8255(dev, 0x1, 0x0); | |
30963 | + write_rtl8255(dev, 0x4, 0x837); | |
30964 | + write_rtl8255(dev, 0x3, 0x0); | |
30965 | + write_rtl8255(dev, 0x2, 0x0); | |
30966 | + write_rtl8255(dev, 0x4, 0xa37); | |
30967 | + write_rtl8255(dev, 0x4, 0x837); | |
30968 | + write_rtl8255(dev, 0x4, 0x437); | |
30969 | + write_rtl8255(dev, 0x3, 0x24); | |
30970 | + write_rtl8255(dev, 0x2, 0x25); | |
30971 | + write_rtl8255(dev, 0x4, 0x637); | |
30972 | + write_rtl8255(dev, 0x4, 0x437); | |
30973 | + write_rtl8255(dev, 0x4, 0x437); | |
30974 | + write_rtl8255(dev, 0x3, 0x100); | |
30975 | + write_rtl8255(dev, 0x4, 0x637); | |
30976 | + write_rtl8255(dev, 0x4, 0x437); | |
30977 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30978 | + 0x92402a28, 0xf8019, 0x70028000, 0xc00, 0x0); | |
30979 | + write_rtl8255(dev, 0x1, 0x807); | |
30980 | + write_rtl8255(dev, 0x4, 0xc38); | |
30981 | + write_rtl8255(dev, 0x4, 0xe38); | |
30982 | + write_rtl8255(dev, 0x4, 0xc38); | |
30983 | + write_rtl8255(dev, 0x1, 0x0); | |
30984 | + write_rtl8255(dev, 0x4, 0x838); | |
30985 | + write_rtl8255(dev, 0x3, 0x0); | |
30986 | + write_rtl8255(dev, 0x2, 0x0); | |
30987 | + write_rtl8255(dev, 0x4, 0xa38); | |
30988 | + write_rtl8255(dev, 0x4, 0x838); | |
30989 | + write_rtl8255(dev, 0x4, 0x438); | |
30990 | + write_rtl8255(dev, 0x3, 0x24); | |
30991 | + write_rtl8255(dev, 0x2, 0x25); | |
30992 | + write_rtl8255(dev, 0x4, 0x638); | |
30993 | + write_rtl8255(dev, 0x4, 0x438); | |
30994 | + write_rtl8255(dev, 0x4, 0x438); | |
30995 | + write_rtl8255(dev, 0x3, 0x100); | |
30996 | + write_rtl8255(dev, 0x4, 0x638); | |
30997 | + write_rtl8255(dev, 0x4, 0x438); | |
30998 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
30999 | + 0x92402a28, 0xf8019, 0x70028000, 0xc00, 0x0); | |
31000 | + write_rtl8255(dev, 0x1, 0x807); | |
31001 | + write_rtl8255(dev, 0x4, 0xc39); | |
31002 | + write_rtl8255(dev, 0x4, 0xe39); | |
31003 | + write_rtl8255(dev, 0x4, 0xc39); | |
31004 | + write_rtl8255(dev, 0x1, 0x0); | |
31005 | + write_rtl8255(dev, 0x4, 0x839); | |
31006 | + write_rtl8255(dev, 0x3, 0x0); | |
31007 | + write_rtl8255(dev, 0x2, 0x0); | |
31008 | + write_rtl8255(dev, 0x4, 0xa39); | |
31009 | + write_rtl8255(dev, 0x4, 0x839); | |
31010 | + write_rtl8255(dev, 0x4, 0x439); | |
31011 | + write_rtl8255(dev, 0x3, 0x24); | |
31012 | + write_rtl8255(dev, 0x2, 0x25); | |
31013 | + write_rtl8255(dev, 0x4, 0x639); | |
31014 | + write_rtl8255(dev, 0x4, 0x439); | |
31015 | + write_rtl8255(dev, 0x4, 0x439); | |
31016 | + write_rtl8255(dev, 0x3, 0x100); | |
31017 | + write_rtl8255(dev, 0x4, 0x639); | |
31018 | + write_rtl8255(dev, 0x4, 0x439); | |
31019 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
31020 | + 0x92402a00, 0xf8019, 0x70028000, 0xc00, 0x0); | |
31021 | + write_rtl8255(dev, 0x1, 0x807); | |
31022 | + write_rtl8255(dev, 0x4, 0xc3a); | |
31023 | + write_rtl8255(dev, 0x4, 0xe3a); | |
31024 | + write_rtl8255(dev, 0x4, 0xc3a); | |
31025 | + write_rtl8255(dev, 0x1, 0x0); | |
31026 | + write_rtl8255(dev, 0x4, 0x83a); | |
31027 | + write_rtl8255(dev, 0x3, 0x0); | |
31028 | + write_rtl8255(dev, 0x2, 0x0); | |
31029 | + write_rtl8255(dev, 0x4, 0xa3a); | |
31030 | + write_rtl8255(dev, 0x4, 0x83a); | |
31031 | + write_rtl8255(dev, 0x4, 0x43a); | |
31032 | + write_rtl8255(dev, 0x3, 0x0); | |
31033 | + write_rtl8255(dev, 0x2, 0x0); | |
31034 | + write_rtl8255(dev, 0x4, 0x63a); | |
31035 | + write_rtl8255(dev, 0x4, 0x43a); | |
31036 | + write_rtl8255(dev, 0x4, 0x43a); | |
31037 | + write_rtl8255(dev, 0x3, 0x100); | |
31038 | + write_rtl8255(dev, 0x4, 0x63a); | |
31039 | + write_rtl8255(dev, 0x4, 0x43a); | |
31040 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
31041 | + 0x92402a00, 0xf8019, 0x70028000, 0xc00, 0x0); | |
31042 | + write_rtl8255(dev, 0x1, 0x807); | |
31043 | + write_rtl8255(dev, 0x4, 0xc3b); | |
31044 | + write_rtl8255(dev, 0x4, 0xe3b); | |
31045 | + write_rtl8255(dev, 0x4, 0xc3b); | |
31046 | + write_rtl8255(dev, 0x1, 0x0); | |
31047 | + write_rtl8255(dev, 0x4, 0x83b); | |
31048 | + write_rtl8255(dev, 0x3, 0x0); | |
31049 | + write_rtl8255(dev, 0x2, 0x0); | |
31050 | + write_rtl8255(dev, 0x4, 0xa3b); | |
31051 | + write_rtl8255(dev, 0x4, 0x83b); | |
31052 | + write_rtl8255(dev, 0x4, 0x43b); | |
31053 | + write_rtl8255(dev, 0x3, 0x0); | |
31054 | + write_rtl8255(dev, 0x2, 0x0); | |
31055 | + write_rtl8255(dev, 0x4, 0x63b); | |
31056 | + write_rtl8255(dev, 0x4, 0x43b); | |
31057 | + write_rtl8255(dev, 0x4, 0x43b); | |
31058 | + write_rtl8255(dev, 0x3, 0x100); | |
31059 | + write_rtl8255(dev, 0x4, 0x63b); | |
31060 | + write_rtl8255(dev, 0x4, 0x43b); | |
31061 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
31062 | + 0x92402a00, 0xf8019, 0x70028000, 0xc00, 0x0); | |
31063 | + write_rtl8255(dev, 0x1, 0x807); | |
31064 | + write_rtl8255(dev, 0x4, 0xc3c); | |
31065 | + write_rtl8255(dev, 0x4, 0xe3c); | |
31066 | + write_rtl8255(dev, 0x4, 0xc3c); | |
31067 | + write_rtl8255(dev, 0x1, 0x0); | |
31068 | + write_rtl8255(dev, 0x4, 0x83c); | |
31069 | + write_rtl8255(dev, 0x3, 0x0); | |
31070 | + write_rtl8255(dev, 0x2, 0x0); | |
31071 | + write_rtl8255(dev, 0x4, 0xa3c); | |
31072 | + write_rtl8255(dev, 0x4, 0x83c); | |
31073 | + write_rtl8255(dev, 0x4, 0x43c); | |
31074 | + write_rtl8255(dev, 0x3, 0x0); | |
31075 | + write_rtl8255(dev, 0x2, 0x0); | |
31076 | + write_rtl8255(dev, 0x4, 0x63c); | |
31077 | + write_rtl8255(dev, 0x4, 0x43c); | |
31078 | + write_rtl8255(dev, 0x4, 0x43c); | |
31079 | + write_rtl8255(dev, 0x3, 0x100); | |
31080 | + write_rtl8255(dev, 0x4, 0x63c); | |
31081 | + write_rtl8255(dev, 0x4, 0x43c); | |
31082 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
31083 | + 0x92402a00, 0xf8019, 0x70028000, 0xc00, 0x0); | |
31084 | + write_rtl8255(dev, 0x1, 0x807); | |
31085 | + write_rtl8255(dev, 0x4, 0xc3d); | |
31086 | + write_rtl8255(dev, 0x4, 0xe3d); | |
31087 | + write_rtl8255(dev, 0x4, 0xc3d); | |
31088 | + write_rtl8255(dev, 0x1, 0x0); | |
31089 | + write_rtl8255(dev, 0x4, 0x83d); | |
31090 | + write_rtl8255(dev, 0x3, 0x0); | |
31091 | + write_rtl8255(dev, 0x2, 0x0); | |
31092 | + write_rtl8255(dev, 0x4, 0xa3d); | |
31093 | + write_rtl8255(dev, 0x4, 0x83d); | |
31094 | + write_rtl8255(dev, 0x4, 0x43d); | |
31095 | + write_rtl8255(dev, 0x3, 0x0); | |
31096 | + write_rtl8255(dev, 0x2, 0x0); | |
31097 | + write_rtl8255(dev, 0x4, 0x63d); | |
31098 | + write_rtl8255(dev, 0x4, 0x43d); | |
31099 | + write_rtl8255(dev, 0x4, 0x43d); | |
31100 | + write_rtl8255(dev, 0x3, 0x100); | |
31101 | + write_rtl8255(dev, 0x4, 0x63d); | |
31102 | + write_rtl8255(dev, 0x4, 0x43d); | |
31103 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
31104 | + 0x92402a00, 0xf8019, 0x70028000, 0xc00, 0x0); | |
31105 | + write_rtl8255(dev, 0x1, 0x807); | |
31106 | + write_rtl8255(dev, 0x4, 0xc3e); | |
31107 | + write_rtl8255(dev, 0x4, 0xe3e); | |
31108 | + write_rtl8255(dev, 0x4, 0xc3e); | |
31109 | + write_rtl8255(dev, 0x1, 0x0); | |
31110 | + write_rtl8255(dev, 0x4, 0x83e); | |
31111 | + write_rtl8255(dev, 0x3, 0x0); | |
31112 | + write_rtl8255(dev, 0x2, 0x0); | |
31113 | + write_rtl8255(dev, 0x4, 0xa3e); | |
31114 | + write_rtl8255(dev, 0x4, 0x83e); | |
31115 | + write_rtl8255(dev, 0x4, 0x43e); | |
31116 | + write_rtl8255(dev, 0x3, 0x0); | |
31117 | + write_rtl8255(dev, 0x2, 0x0); | |
31118 | + write_rtl8255(dev, 0x4, 0x63e); | |
31119 | + write_rtl8255(dev, 0x4, 0x43e); | |
31120 | + write_rtl8255(dev, 0x4, 0x43e); | |
31121 | + write_rtl8255(dev, 0x3, 0x100); | |
31122 | + write_rtl8255(dev, 0x4, 0x63e); | |
31123 | + write_rtl8255(dev, 0x4, 0x43e); | |
31124 | + write_rtl8255_reg0c(dev, 0x1554, 0xa800403b, 0xf6d44278, 0x80404000, 0x80000027, | |
31125 | + 0x92402a00, 0xf8011, 0x70028000, 0xc00, 0x0); | |
31126 | + write_rtl8255(dev, 0x1, 0x807); | |
31127 | + write_rtl8255(dev, 0x4, 0xc3f); | |
31128 | + write_rtl8255(dev, 0x4, 0xe3f); | |
31129 | + write_rtl8255(dev, 0x4, 0xc3f); | |
31130 | + write_rtl8255(dev, 0x1, 0x0); | |
31131 | + write_rtl8255(dev, 0x4, 0x83f); | |
31132 | + write_rtl8255(dev, 0x3, 0x0); | |
31133 | + write_rtl8255(dev, 0x2, 0x0); | |
31134 | + write_rtl8255(dev, 0x4, 0xa3f); | |
31135 | + write_rtl8255(dev, 0x4, 0x83f); | |
31136 | + write_rtl8255(dev, 0x4, 0x43f); | |
31137 | + write_rtl8255(dev, 0x3, 0x0); | |
31138 | + write_rtl8255(dev, 0x2, 0x0); | |
31139 | + write_rtl8255(dev, 0x4, 0x63f); | |
31140 | + write_rtl8255(dev, 0x4, 0x43f); | |
31141 | + write_rtl8255(dev, 0x4, 0x43f); | |
31142 | + write_rtl8255(dev, 0x3, 0x100); | |
31143 | + write_rtl8255(dev, 0x4, 0x63f); | |
31144 | + write_rtl8255(dev, 0x4, 0x43f); | |
31145 | + write_rtl8255(dev, 0x4, 0x0); | |
31146 | + write_rtl8255(dev, 0x1, 0x0); | |
31147 | + write_rtl8255_reg0c(dev, 0x3539, 0x70000c03, 0xfef46178, 0x408000, 0x403307, | |
31148 | + 0x924f80c0, 0xf955c, 0x8400, 0x429200, 0x1ce20); | |
31149 | + write_rtl8255(dev, 0x1, 0x1c7); | |
31150 | + write_rtl8255(dev, 0x2, 0x26); | |
31151 | + write_rtl8255(dev, 0x3, 0x27); | |
31152 | + write_rtl8255(dev, 0x1, 0x47); | |
31153 | + write_rtl8255(dev, 0x4, 0x98c); | |
31154 | + write_rtl8255(dev, 0x5, 0x65); | |
31155 | + write_rtl8255(dev, 0x6, 0x13); | |
31156 | + write_rtl8255(dev, 0x7, 0x7c); | |
31157 | + write_rtl8255(dev, 0x8, 0x6); | |
31158 | + write_rtl8255(dev, 0x8, 0x7); | |
31159 | + write_rtl8255(dev, 0x8, 0x6); | |
31160 | + write_rtl8255(dev, 0x9, 0xce2); | |
31161 | + write_rtl8255(dev, 0xb, 0x1c5); | |
31162 | + write_rtl8255(dev, 0xd, 0xd7f); | |
31163 | + write_rtl8255(dev, 0xe, 0x369); | |
31164 | + write_rtl8255(dev, 0xa, 0xd56); | |
31165 | + write_rtl8255(dev, 0xa, 0xd57); | |
31166 | + mdelay(20); | |
31167 | + write_rtl8255(dev, 0xd, 0xd7e); | |
31168 | + | |
31169 | +} | |
31170 | + | |
31171 | + | |
31172 | +void rtl8255_set_band_param(struct net_device *dev, short band) | |
31173 | +{ | |
31174 | + if(band != BAND_A){ | |
31175 | + write_nic_dword(dev, 0x94, 0x3dc00002); | |
31176 | + write_nic_dword(dev, 0x88, 0x00100040); | |
31177 | + | |
31178 | + write_phy_cck(dev, 0x13, 0xd0); | |
31179 | + | |
31180 | + write_phy_cck(dev, 0x41, 0x9d); | |
31181 | + write_nic_dword(dev, 0x8c, 0x00082205); | |
31182 | + write_nic_byte(dev, 0xb4, 0x66); | |
31183 | + } | |
31184 | +} | |
31185 | + | |
31186 | +void rtl8255_rf_init(struct net_device *dev) | |
31187 | +{ | |
31188 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31189 | + int i; | |
31190 | + u16 brsr; | |
31191 | +// short channel /*= priv->chan*/ = 1; | |
31192 | + priv->chan = 1; | |
31193 | + | |
31194 | + write_nic_word(dev, RFPinsOutput, 0x80); | |
31195 | + write_nic_word(dev, RFPinsSelect, 0x80 | SW_CONTROL_GPIO); | |
31196 | + write_nic_word(dev, RFPinsEnable, 0x80); | |
31197 | + write_nic_word(dev, RFPinsSelect, SW_CONTROL_GPIO); | |
31198 | + | |
31199 | + write_nic_dword(dev, RF_TIMING, 0x000f800f); | |
31200 | + | |
31201 | + brsr = read_nic_word(dev, BRSR); | |
31202 | + | |
31203 | + write_nic_word(dev, 0x2c, 0xffff); | |
31204 | + | |
31205 | + | |
31206 | + rtl8180_set_anaparam(dev, RTL8255_ANAPARAM_ON); | |
31207 | + rtl8185_set_anaparam2(dev, RTL8255_ANAPARAM2_ON); | |
31208 | + | |
31209 | + write_nic_dword(dev, 0x94, 0x11c00002); | |
31210 | + | |
31211 | + write_nic_dword(dev, RF_PARA, 0x100040); | |
31212 | + | |
31213 | + rtl8185_rf_pins_enable(dev); | |
31214 | + | |
31215 | + rtl8255_init_BGband(dev); | |
31216 | + rtl8255_set_band_param(dev,BAND_BG); | |
31217 | + | |
31218 | + write_phy_cck(dev, 0x0, 0x98); | |
31219 | + write_phy_cck(dev, 0x3, 0x20); | |
31220 | + write_phy_cck(dev, 0x4, 0x2e); | |
31221 | + write_phy_cck(dev, 0x5, 0x12); | |
31222 | + write_phy_cck(dev, 0x6, 0xfc); | |
31223 | + write_phy_cck(dev, 0x7, 0xd8); | |
31224 | + write_phy_cck(dev, 0x8, 0x2e); | |
31225 | + write_phy_cck(dev, 0x10, 0xd3); | |
31226 | + write_phy_cck(dev, 0x11, 0x88); | |
31227 | + write_phy_cck(dev, 0x12, 0x47); | |
31228 | + write_phy_cck(dev, 0x13, 0xd0); /* Ver C & D & 8187*/ | |
31229 | + | |
31230 | + write_phy_cck(dev, 0x19, 0x0); | |
31231 | + write_phy_cck(dev, 0x1a, 0xa0); | |
31232 | + write_phy_cck(dev, 0x1b, 0x8); | |
31233 | + write_phy_cck(dev, 0x40, 0x86); /* CCK Carrier Sense Threshold */ | |
31234 | + write_phy_cck(dev, 0x41, 0x9d); /* Energy Threshold */ | |
31235 | + //write_phy_cck(dev, 0x42, 0x0); | |
31236 | + write_phy_cck(dev, 0x43, 0x8); | |
31237 | + | |
31238 | + write_nic_byte(dev, TESTR,0x8); | |
31239 | + | |
31240 | + for(i=0;i<128;i++){ | |
31241 | + write_phy_ofdm(dev, 0x4b, rtl8255_agc[i]); | |
31242 | + write_phy_ofdm(dev, 0x4a, (u8)i+ 0x80); | |
31243 | + } | |
31244 | + | |
31245 | + | |
31246 | + write_phy_ofdm(dev, 0x0, 0x1); | |
31247 | + write_phy_ofdm(dev, 0x1, 0x2); | |
31248 | + write_phy_ofdm(dev, 0x2, 0x43); | |
31249 | + write_phy_ofdm(dev, 0x3, 0x0); | |
31250 | + write_phy_ofdm(dev, 0x4, 0x0); | |
31251 | + write_phy_ofdm(dev, 0x5, 0x0); | |
31252 | + write_phy_ofdm(dev, 0x6, 0x40); | |
31253 | + write_phy_ofdm(dev, 0x7, 0x0); | |
31254 | + write_phy_ofdm(dev, 0x8, 0x40); | |
31255 | + write_phy_ofdm(dev, 0x9, 0xfe); | |
31256 | + write_phy_ofdm(dev, 0xa, 0x9); | |
31257 | + write_phy_ofdm(dev, 0xb, 0x80); | |
31258 | + write_phy_ofdm(dev, 0xc, 0x1); | |
31259 | + write_phy_ofdm(dev, 0xd, 0x43); | |
31260 | + write_phy_ofdm(dev, 0xe, 0xd3); | |
31261 | + write_phy_ofdm(dev, 0xf, 0x38); | |
31262 | + write_phy_ofdm(dev, 0x10, 0x4); | |
31263 | + write_phy_ofdm(dev, 0x11, 0x06);/*agc resp time 700*/ | |
31264 | + write_phy_ofdm(dev, 0x12, 0x20); | |
31265 | + write_phy_ofdm(dev, 0x13, 0x20); | |
31266 | + write_phy_ofdm(dev, 0x14, 0x0); | |
31267 | + write_phy_ofdm(dev, 0x15, 0x40); | |
31268 | + write_phy_ofdm(dev, 0x16, 0x0); | |
31269 | + write_phy_ofdm(dev, 0x17, 0x40); | |
31270 | + write_phy_ofdm(dev, 0x18, 0xef); | |
31271 | + write_phy_ofdm(dev, 0x19, 0x25); | |
31272 | + write_phy_ofdm(dev, 0x1a, 0x20); | |
31273 | + write_phy_ofdm(dev, 0x1b, 0x7a); | |
31274 | + write_phy_ofdm(dev, 0x1c, 0x84); | |
31275 | + write_phy_ofdm(dev, 0x1e, 0x95); | |
31276 | + write_phy_ofdm(dev, 0x1f, 0x75); | |
31277 | + write_phy_ofdm(dev, 0x20, 0x1f); | |
31278 | + write_phy_ofdm(dev, 0x21, 0x17); | |
31279 | + write_phy_ofdm(dev, 0x22, 0x16); | |
31280 | + write_phy_ofdm(dev, 0x23, 0x70); //FIXME maybe not needed | |
31281 | + write_phy_ofdm(dev, 0x24, 0x70); | |
31282 | + write_phy_ofdm(dev, 0x25, 0x0); | |
31283 | + write_phy_ofdm(dev, 0x26, 0x10); | |
31284 | + write_phy_ofdm(dev, 0x27, 0x88); | |
31285 | + | |
31286 | + | |
31287 | + write_nic_dword(dev, 0x94, 0x3dc00002); //BAND DEPEND. | |
31288 | +// write_nic_dword(dev, 0x94, 0x15c00002); //BAND DEPEND. | |
31289 | + | |
31290 | + write_phy_cck(dev, 0x4, 0x18); | |
31291 | + write_phy_cck(dev, 0x43, 0x18); | |
31292 | + write_phy_cck(dev, 0x6, 0xdc); | |
31293 | + write_phy_cck(dev, 0x44, 0x2b); | |
31294 | + write_phy_cck(dev, 0x45, 0x2b); | |
31295 | + write_phy_cck(dev, 0x46, 0x25); | |
31296 | + write_phy_cck(dev, 0x47, 0x15); | |
31297 | + write_phy_cck(dev, 0x48, 0x0); | |
31298 | + write_phy_cck(dev, 0x49, 0x0); | |
31299 | + write_phy_cck(dev, 0x4a, 0x0); | |
31300 | + write_phy_cck(dev, 0x4b, 0x0); | |
31301 | +// write_phy_cck(dev, 0x4c, 0x5); | |
31302 | +#if 0 | |
31303 | + write_phy_cck(dev, 0x41, 0x9d); /* Energy Threshold */ | |
31304 | + // TESTR 0xb 8187 | |
31305 | + write_phy_cck(dev, 0x10, 0x93);// & 0xfb); | |
31306 | +#endif | |
31307 | + //rtl8255_set_gain(dev, 1); /* FIXME this '1' is random */ | |
31308 | + | |
31309 | + rtl8255_SetTXPowerLevel(dev, priv->chan); | |
31310 | + | |
31311 | + write_phy_cck(dev, 0x10, 0x93 |0x4); /* Rx ant B, 0xd3 for A */ | |
31312 | + write_phy_ofdm(dev, 0x26, 0x90); /* Rx ant B, 0x10 for A */ | |
31313 | + | |
31314 | + rtl8185_tx_antenna(dev, 0x3); /* TX ant B, 0x0 for A*/ | |
31315 | + /* make sure is waken up! */ | |
31316 | + rtl8180_set_anaparam(dev, RTL8255_ANAPARAM_ON); | |
31317 | + rtl8185_set_anaparam2(dev, RTL8255_ANAPARAM2_ON); | |
31318 | + | |
31319 | + rtl8255_set_band_param(dev,BAND_BG); | |
31320 | + | |
31321 | + write_phy_cck(dev, 0x41, 0x9d); | |
31322 | + | |
31323 | + rtl8255_set_gain(dev, 4); | |
31324 | + //rtl8255_set_energy_threshold(dev); | |
31325 | + write_phy_cck(dev, 0x41, 0x9d); | |
31326 | + rtl8255_rf_set_chan(dev, priv->chan); | |
31327 | + | |
31328 | + write_nic_word(dev, BRSR, brsr); | |
31329 | +} | |
31330 | + | |
31331 | --- /dev/null | |
31332 | +++ b/drivers/staging/rtl8187se/r8180_rtl8255.h | |
31333 | @@ -0,0 +1,19 @@ | |
31334 | +/* | |
31335 | + This is part of the rtl8180-sa2400 driver | |
31336 | + released under the GPL (See file COPYING for details). | |
31337 | + Copyright (c) 2005 Andrea Merello <andreamrl@tiscali.it> | |
31338 | + | |
31339 | + This files contains programming code for the rtl8255 | |
31340 | + radio frontend. | |
31341 | + | |
31342 | + *Many* thanks to Realtek Corp. for their great support! | |
31343 | + | |
31344 | +*/ | |
31345 | + | |
31346 | +#define RTL8255_ANAPARAM_ON 0xa0000b59 | |
31347 | +#define RTL8255_ANAPARAM2_ON 0x840cf311 | |
31348 | + | |
31349 | + | |
31350 | +void rtl8255_rf_init(struct net_device *dev); | |
31351 | +void rtl8255_rf_set_chan(struct net_device *dev,short ch); | |
31352 | +void rtl8255_rf_close(struct net_device *dev); | |
31353 | --- /dev/null | |
31354 | +++ b/drivers/staging/rtl8187se/r8180_sa2400.c | |
31355 | @@ -0,0 +1,233 @@ | |
31356 | +/* | |
31357 | + This files contains PHILIPS SA2400 radio frontend programming routines. | |
31358 | + | |
31359 | + This is part of rtl8180 OpenSource driver | |
31360 | + Copyright (C) Andrea Merello 2004-2005 <andreamrl@tiscali.it> | |
31361 | + Released under the terms of GPL (General Public Licence) | |
31362 | + | |
31363 | + Parts of this driver are based on the GPL part of the | |
31364 | + official realtek driver | |
31365 | + | |
31366 | + Parts of this driver are based on the rtl8180 driver skeleton | |
31367 | + from Patric Schenke & Andres Salomon | |
31368 | + | |
31369 | + Parts of this driver are based on the Intel Pro Wireless 2100 GPL driver. | |
31370 | + | |
31371 | + Code at http://che.ojctech.com/~dyoung/rtw/ has been useful to me to | |
31372 | + understand some things. | |
31373 | + | |
31374 | + Code from rtl8181 project has been useful to me to understand some things. | |
31375 | + | |
31376 | + We want to tanks the Authors of such projects and the Ndiswrapper | |
31377 | + project Authors. | |
31378 | +*/ | |
31379 | + | |
31380 | + | |
31381 | +#include "r8180.h" | |
31382 | +#include "r8180_hw.h" | |
31383 | +#include "r8180_sa2400.h" | |
31384 | + | |
31385 | + | |
31386 | +//#define DEBUG_SA2400 | |
31387 | + | |
31388 | +u32 sa2400_chan[] = { | |
31389 | + 0x0, //dummy channel 0 | |
31390 | + 0x00096c, //1 | |
31391 | + 0x080970, //2 | |
31392 | + 0x100974, //3 | |
31393 | + 0x180978, //4 | |
31394 | + 0x000980, //5 | |
31395 | + 0x080984, //6 | |
31396 | + 0x100988, //7 | |
31397 | + 0x18098c, //8 | |
31398 | + 0x000994, //9 | |
31399 | + 0x080998, //10 | |
31400 | + 0x10099c, //11 | |
31401 | + 0x1809a0, //12 | |
31402 | + 0x0009a8, //13 | |
31403 | + 0x0009b4, //14 | |
31404 | +}; | |
31405 | + | |
31406 | + | |
31407 | +void rf_stabilize(struct net_device *dev) | |
31408 | +{ | |
31409 | + force_pci_posting(dev); | |
31410 | + mdelay(3); //for now use a great value.. we may optimize in future | |
31411 | +} | |
31412 | + | |
31413 | + | |
31414 | +void write_sa2400(struct net_device *dev,u8 adr, u32 data) | |
31415 | +{ | |
31416 | +// struct r8180_priv *priv = ieee80211_priv(dev); | |
31417 | + u32 phy_config; | |
31418 | + | |
31419 | + // philips sa2400 expects 24 bits data | |
31420 | + | |
31421 | + /*if(adr == 4 && priv->digphy){ | |
31422 | + phy_config=0x60000000; | |
31423 | + }else{ | |
31424 | + phy_config=0xb0000000; | |
31425 | + }*/ | |
31426 | + | |
31427 | + phy_config = 0xb0000000; // MAC will bang bits to the sa2400 | |
31428 | + | |
31429 | + phy_config |= (((u32)(adr&0xf))<< 24); | |
31430 | + phy_config |= (data & 0xffffff); | |
31431 | + write_nic_dword(dev,PHY_CONFIG,phy_config); | |
31432 | +#ifdef DEBUG_SA2400 | |
31433 | + DMESG("Writing sa2400: %x (adr %x)",phy_config,adr); | |
31434 | +#endif | |
31435 | + rf_stabilize(dev); | |
31436 | +} | |
31437 | + | |
31438 | + | |
31439 | + | |
31440 | +void sa2400_write_phy_antenna(struct net_device *dev,short ch) | |
31441 | +{ | |
31442 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31443 | + u8 ant; | |
31444 | + | |
31445 | + ant = SA2400_ANTENNA; | |
31446 | + if(priv->antb) /*default antenna is antenna B */ | |
31447 | + ant |= BB_ANTENNA_B; | |
31448 | + if(ch == 14) | |
31449 | + ant |= BB_ANTATTEN_CHAN14; | |
31450 | + write_phy(dev,0x10,ant); | |
31451 | + //DMESG("BB antenna %x ",ant); | |
31452 | +} | |
31453 | + | |
31454 | + | |
31455 | +/* from the rtl8181 embedded driver */ | |
31456 | +short sa2400_rf_set_sens(struct net_device *dev, short sens) | |
31457 | +{ | |
31458 | + u8 finetune = 0; | |
31459 | + if ((sens > 85) || (sens < 54)) return -1; | |
31460 | + | |
31461 | + write_sa2400(dev,5,0x1dfb | (sens-54) << 15 |(finetune<<20)); // AGC 0xc9dfb | |
31462 | + | |
31463 | + return 0; | |
31464 | +} | |
31465 | + | |
31466 | + | |
31467 | +void sa2400_rf_set_chan(struct net_device *dev, short ch) | |
31468 | +{ | |
31469 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31470 | + u32 txpw = 0xff & priv->chtxpwr[ch]; | |
31471 | + u32 chan = sa2400_chan[ch]; | |
31472 | + | |
31473 | + write_sa2400(dev,7,txpw); | |
31474 | + //write_phy(dev,0x10,0xd1); | |
31475 | + sa2400_write_phy_antenna(dev,ch); | |
31476 | + write_sa2400(dev,0,chan); | |
31477 | + write_sa2400(dev,1,0xbb50); | |
31478 | + write_sa2400(dev,2,0x80); | |
31479 | + write_sa2400(dev,3,0); | |
31480 | +} | |
31481 | + | |
31482 | + | |
31483 | +void sa2400_rf_close(struct net_device *dev) | |
31484 | +{ | |
31485 | + write_sa2400(dev, 4, 0); | |
31486 | +} | |
31487 | + | |
31488 | + | |
31489 | +void sa2400_rf_init(struct net_device *dev) | |
31490 | +{ | |
31491 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31492 | + u32 anaparam; | |
31493 | + u8 firdac; | |
31494 | + | |
31495 | + write_nic_byte(dev,PHY_DELAY,0x6); //this is general | |
31496 | + write_nic_byte(dev,CARRIER_SENSE_COUNTER,0x4c); //this is general | |
31497 | + | |
31498 | + /*these are philips sa2400 specific*/ | |
31499 | + anaparam = read_nic_dword(dev,ANAPARAM); | |
31500 | + anaparam = anaparam &~ (1<<ANAPARAM_TXDACOFF_SHIFT); | |
31501 | + | |
31502 | + anaparam = anaparam &~ANAPARAM_PWR1_MASK; | |
31503 | + anaparam = anaparam &~ANAPARAM_PWR0_MASK; | |
31504 | + if(priv->digphy){ | |
31505 | + anaparam |= (SA2400_DIG_ANAPARAM_PWR1_ON<<ANAPARAM_PWR1_SHIFT); | |
31506 | + anaparam |= (SA2400_ANAPARAM_PWR0_ON<<ANAPARAM_PWR0_SHIFT); | |
31507 | + }else{ | |
31508 | + anaparam |= (SA2400_ANA_ANAPARAM_PWR1_ON<<ANAPARAM_PWR1_SHIFT); | |
31509 | + } | |
31510 | + | |
31511 | + rtl8180_set_anaparam(dev,anaparam); | |
31512 | + | |
31513 | + firdac = (priv->digphy) ? (1<<SA2400_REG4_FIRDAC_SHIFT) : 0; | |
31514 | + write_sa2400(dev,0,sa2400_chan[priv->chan]); | |
31515 | + write_sa2400(dev,1,0xbb50); | |
31516 | + write_sa2400(dev,2,0x80); | |
31517 | + write_sa2400(dev,3,0); | |
31518 | + write_sa2400(dev,4,0x19340 | firdac); | |
31519 | + write_sa2400(dev,5,0xc9dfb); // AGC | |
31520 | + write_sa2400(dev,4,0x19348 | firdac); //calibrates VCO | |
31521 | + | |
31522 | + if(priv->digphy) | |
31523 | + write_sa2400(dev,4,0x1938c); /*???*/ | |
31524 | + | |
31525 | + write_sa2400(dev,4,0x19340 | firdac); | |
31526 | + | |
31527 | + write_sa2400(dev,0,sa2400_chan[priv->chan]); | |
31528 | + write_sa2400(dev,1,0xbb50); | |
31529 | + write_sa2400(dev,2,0x80); | |
31530 | + write_sa2400(dev,3,0); | |
31531 | + write_sa2400(dev,4,0x19344 | firdac); //calibrates filter | |
31532 | + | |
31533 | + /* new from rtl8180 embedded driver (rtl8181 project) */ | |
31534 | + write_sa2400(dev,6,0x13ff | (1<<23)); // MANRX | |
31535 | + write_sa2400(dev,8,0); //VCO | |
31536 | + | |
31537 | + if(!priv->digphy) | |
31538 | + { | |
31539 | + rtl8180_set_anaparam(dev, anaparam | \ | |
31540 | + (1<<ANAPARAM_TXDACOFF_SHIFT)); | |
31541 | + | |
31542 | + rtl8180_conttx_enable(dev); | |
31543 | + | |
31544 | + write_sa2400(dev, 4, 0x19341); // calibrates DC | |
31545 | + | |
31546 | + /* a 5us sleep is required here, | |
31547 | + we rely on the 3ms delay introduced in write_sa2400 | |
31548 | + */ | |
31549 | + write_sa2400(dev, 4, 0x19345); | |
31550 | + /* a 20us sleep is required here, | |
31551 | + we rely on the 3ms delay introduced in write_sa2400 | |
31552 | + */ | |
31553 | + rtl8180_conttx_disable(dev); | |
31554 | + | |
31555 | + rtl8180_set_anaparam(dev, anaparam); | |
31556 | + } | |
31557 | + /* end new */ | |
31558 | + | |
31559 | + write_sa2400(dev,4,0x19341 | firdac ); //RTX MODE | |
31560 | + | |
31561 | + // Set tx power level !? | |
31562 | + | |
31563 | + | |
31564 | + /*baseband configuration*/ | |
31565 | + write_phy(dev,0,0x98); | |
31566 | + write_phy(dev,3,0x38); | |
31567 | + write_phy(dev,4,0xe0); | |
31568 | + write_phy(dev,5,0x90); | |
31569 | + write_phy(dev,6,0x1a); | |
31570 | + write_phy(dev,7,0x64); | |
31571 | + | |
31572 | + /*Should be done something more here??*/ | |
31573 | + | |
31574 | + sa2400_write_phy_antenna(dev,priv->chan); | |
31575 | + | |
31576 | + write_phy(dev,0x11,0x80); | |
31577 | + if(priv->diversity) | |
31578 | + write_phy(dev,0x12,0xc7); | |
31579 | + else | |
31580 | + write_phy(dev,0x12,0x47); | |
31581 | + | |
31582 | + write_phy(dev,0x13,0x90 | priv->cs_treshold ); | |
31583 | + | |
31584 | + write_phy(dev,0x19,0x0); | |
31585 | + write_phy(dev,0x1a,0xa0); | |
31586 | + | |
31587 | + sa2400_rf_set_chan(dev,priv->chan); | |
31588 | +} | |
31589 | --- /dev/null | |
31590 | +++ b/drivers/staging/rtl8187se/r8180_sa2400.h | |
31591 | @@ -0,0 +1,26 @@ | |
31592 | +/* | |
31593 | + This is part of rtl8180 OpenSource driver - v 0.7 | |
31594 | + Copyright (C) Andrea Merello 2004 <andreamrl@tiscali.it> | |
31595 | + Released under the terms of GPL (General Public Licence) | |
31596 | + | |
31597 | + Parts of this driver are based on the GPL part of the official realtek driver | |
31598 | + Parts of this driver are based on the rtl8180 driver skeleton from Patric Schenke & Andres Salomon | |
31599 | + Parts of this driver are based on the Intel Pro Wireless 2100 GPL driver | |
31600 | + | |
31601 | + We want to tanks the Authors of such projects and the Ndiswrapper project Authors. | |
31602 | +*/ | |
31603 | + | |
31604 | +#define SA2400_ANTENNA 0x91 | |
31605 | +#define SA2400_DIG_ANAPARAM_PWR1_ON 0x8 | |
31606 | +#define SA2400_ANA_ANAPARAM_PWR1_ON 0x28 | |
31607 | +#define SA2400_ANAPARAM_PWR0_ON 0x3 | |
31608 | + | |
31609 | +#define SA2400_RF_MAX_SENS 85 | |
31610 | +#define SA2400_RF_DEF_SENS 80 | |
31611 | + | |
31612 | +#define SA2400_REG4_FIRDAC_SHIFT 7 | |
31613 | + | |
31614 | +void sa2400_rf_init(struct net_device *dev); | |
31615 | +void sa2400_rf_set_chan(struct net_device *dev,short ch); | |
31616 | +short sa2400_rf_set_sens(struct net_device *dev,short sens); | |
31617 | +void sa2400_rf_close(struct net_device *dev); | |
31618 | --- /dev/null | |
31619 | +++ b/drivers/staging/rtl8187se/r8180_wx.c | |
31620 | @@ -0,0 +1,1644 @@ | |
31621 | +/* | |
31622 | + This file contains wireless extension handlers. | |
31623 | + | |
31624 | + This is part of rtl8180 OpenSource driver. | |
31625 | + Copyright (C) Andrea Merello 2004-2005 <andreamrl@tiscali.it> | |
31626 | + Released under the terms of GPL (General Public Licence) | |
31627 | + | |
31628 | + Parts of this driver are based on the GPL part | |
31629 | + of the official realtek driver. | |
31630 | + | |
31631 | + Parts of this driver are based on the rtl8180 driver skeleton | |
31632 | + from Patric Schenke & Andres Salomon. | |
31633 | + | |
31634 | + Parts of this driver are based on the Intel Pro Wireless 2100 GPL driver. | |
31635 | + | |
31636 | + We want to tanks the Authors of those projects and the Ndiswrapper | |
31637 | + project Authors. | |
31638 | +*/ | |
31639 | + | |
31640 | + | |
31641 | +#include "r8180.h" | |
31642 | +#include "r8180_hw.h" | |
31643 | +#include "r8180_sa2400.h" | |
31644 | + | |
31645 | +#ifdef ENABLE_DOT11D | |
31646 | +#include "dot11d.h" | |
31647 | +#endif | |
31648 | + | |
31649 | +//#define RATE_COUNT 4 | |
31650 | +u32 rtl8180_rates[] = {1000000,2000000,5500000,11000000, | |
31651 | + 6000000,9000000,12000000,18000000,24000000,36000000,48000000,54000000}; | |
31652 | + | |
31653 | +#define RATE_COUNT (sizeof(rtl8180_rates)/sizeof(rtl8180_rates[0])) | |
31654 | + | |
31655 | +static CHANNEL_LIST DefaultChannelPlan[] = { | |
31656 | +// {{1,2,3,4,5,6,7,8,9,10,11,12,13,14},14}, //Default channel plan | |
31657 | + {{1,2,3,4,5,6,7,8,9,10,11,36,40,44,48,52,56,60,64},19}, //FCC | |
31658 | + {{1,2,3,4,5,6,7,8,9,10,11},11}, //IC | |
31659 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64},21}, //ETSI | |
31660 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64},21}, //Spain. Change to ETSI. | |
31661 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64},21}, //France. Change to ETSI. | |
31662 | + {{14,36,40,44,48,52,56,60,64},9}, //MKK | |
31663 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,14, 36,40,44,48,52,56,60,64},22},//MKK1 | |
31664 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,36,40,44,48,52,56,60,64},21}, //Israel. | |
31665 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,34,38,42,46},17}, // For 11a , TELEC | |
31666 | + {{1,2,3,4,5,6,7,8,9,10,11,12,13,14},14} //For Global Domain. 1-11:active scan, 12-14 passive scan. //+YJ, 080626 | |
31667 | +}; | |
31668 | +static int r8180_wx_get_freq(struct net_device *dev, | |
31669 | + struct iw_request_info *a, | |
31670 | + union iwreq_data *wrqu, char *b) | |
31671 | +{ | |
31672 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31673 | + | |
31674 | + return ieee80211_wx_get_freq(priv->ieee80211, a, wrqu, b); | |
31675 | +} | |
31676 | + | |
31677 | + | |
31678 | +int r8180_wx_set_key(struct net_device *dev, struct iw_request_info *info, | |
31679 | + union iwreq_data *wrqu, char *key) | |
31680 | +{ | |
31681 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31682 | + struct iw_point *erq = &(wrqu->encoding); | |
31683 | + | |
31684 | + if(priv->ieee80211->bHwRadioOff) | |
31685 | + return 0; | |
31686 | + | |
31687 | + if (erq->flags & IW_ENCODE_DISABLED) { | |
31688 | + } | |
31689 | + | |
31690 | + | |
31691 | +/* i = erq->flags & IW_ENCODE_INDEX; | |
31692 | + if (i < 1 || i > 4) | |
31693 | +*/ | |
31694 | + | |
31695 | + if (erq->length > 0) { | |
31696 | + | |
31697 | + //int len = erq->length <= 5 ? 5 : 13; | |
31698 | + | |
31699 | + u32* tkey= (u32*) key; | |
31700 | + priv->key0[0] = tkey[0]; | |
31701 | + priv->key0[1] = tkey[1]; | |
31702 | + priv->key0[2] = tkey[2]; | |
31703 | + priv->key0[3] = tkey[3] &0xff; | |
31704 | + DMESG("Setting wep key to %x %x %x %x", | |
31705 | + tkey[0],tkey[1],tkey[2],tkey[3]); | |
31706 | + rtl8180_set_hw_wep(dev); | |
31707 | + } | |
31708 | + return 0; | |
31709 | +} | |
31710 | + | |
31711 | + | |
31712 | +static int r8180_wx_set_beaconinterval(struct net_device *dev, struct iw_request_info *aa, | |
31713 | + union iwreq_data *wrqu, char *b) | |
31714 | +{ | |
31715 | + int *parms = (int *)b; | |
31716 | + int bi = parms[0]; | |
31717 | + | |
31718 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31719 | + | |
31720 | + if(priv->ieee80211->bHwRadioOff) | |
31721 | + return 0; | |
31722 | + | |
31723 | + down(&priv->wx_sem); | |
31724 | + DMESG("setting beacon interval to %x",bi); | |
31725 | + | |
31726 | + priv->ieee80211->current_network.beacon_interval=bi; | |
31727 | + rtl8180_commit(dev); | |
31728 | + up(&priv->wx_sem); | |
31729 | + | |
31730 | + return 0; | |
31731 | +} | |
31732 | + | |
31733 | + | |
31734 | + | |
31735 | +static int r8180_wx_get_mode(struct net_device *dev, struct iw_request_info *a, | |
31736 | + union iwreq_data *wrqu, char *b) | |
31737 | +{ | |
31738 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31739 | + return ieee80211_wx_get_mode(priv->ieee80211,a,wrqu,b); | |
31740 | +} | |
31741 | + | |
31742 | + | |
31743 | + | |
31744 | +static int r8180_wx_get_rate(struct net_device *dev, | |
31745 | + struct iw_request_info *info, | |
31746 | + union iwreq_data *wrqu, char *extra) | |
31747 | +{ | |
31748 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31749 | + return ieee80211_wx_get_rate(priv->ieee80211,info,wrqu,extra); | |
31750 | +} | |
31751 | + | |
31752 | + | |
31753 | + | |
31754 | +static int r8180_wx_set_rate(struct net_device *dev, | |
31755 | + struct iw_request_info *info, | |
31756 | + union iwreq_data *wrqu, char *extra) | |
31757 | +{ | |
31758 | + int ret; | |
31759 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31760 | + | |
31761 | + | |
31762 | + if(priv->ieee80211->bHwRadioOff) | |
31763 | + return 0; | |
31764 | + | |
31765 | + down(&priv->wx_sem); | |
31766 | + | |
31767 | + ret = ieee80211_wx_set_rate(priv->ieee80211,info,wrqu,extra); | |
31768 | + | |
31769 | + up(&priv->wx_sem); | |
31770 | + | |
31771 | + return ret; | |
31772 | +} | |
31773 | + | |
31774 | + | |
31775 | +static int r8180_wx_set_crcmon(struct net_device *dev, | |
31776 | + struct iw_request_info *info, | |
31777 | + union iwreq_data *wrqu, char *extra) | |
31778 | +{ | |
31779 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31780 | + int *parms = (int *)extra; | |
31781 | + int enable = (parms[0] > 0); | |
31782 | + short prev = priv->crcmon; | |
31783 | + | |
31784 | + | |
31785 | + if(priv->ieee80211->bHwRadioOff) | |
31786 | + return 0; | |
31787 | + | |
31788 | + down(&priv->wx_sem); | |
31789 | + | |
31790 | + if(enable) | |
31791 | + priv->crcmon=1; | |
31792 | + else | |
31793 | + priv->crcmon=0; | |
31794 | + | |
31795 | + DMESG("bad CRC in monitor mode are %s", | |
31796 | + priv->crcmon ? "accepted" : "rejected"); | |
31797 | + | |
31798 | + if(prev != priv->crcmon && priv->up){ | |
31799 | + rtl8180_down(dev); | |
31800 | + rtl8180_up(dev); | |
31801 | + } | |
31802 | + | |
31803 | + up(&priv->wx_sem); | |
31804 | + | |
31805 | + return 0; | |
31806 | +} | |
31807 | + | |
31808 | + | |
31809 | +static int r8180_wx_set_mode(struct net_device *dev, struct iw_request_info *a, | |
31810 | + union iwreq_data *wrqu, char *b) | |
31811 | +{ | |
31812 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31813 | + int ret; | |
31814 | + | |
31815 | + | |
31816 | + if(priv->ieee80211->bHwRadioOff) | |
31817 | + return 0; | |
31818 | + | |
31819 | + down(&priv->wx_sem); | |
31820 | +#ifdef ENABLE_IPS | |
31821 | +// printk("set mode ENABLE_IPS\n"); | |
31822 | + if(priv->bInactivePs){ | |
31823 | + if(wrqu->mode == IW_MODE_ADHOC) | |
31824 | + IPSLeave(dev); | |
31825 | + } | |
31826 | +#endif | |
31827 | + ret = ieee80211_wx_set_mode(priv->ieee80211,a,wrqu,b); | |
31828 | + | |
31829 | + //rtl8180_commit(dev); | |
31830 | + | |
31831 | + up(&priv->wx_sem); | |
31832 | + return ret; | |
31833 | +} | |
31834 | + | |
31835 | +//YJ,add,080819,for hidden ap | |
31836 | +struct iw_range_with_scan_capa | |
31837 | +{ | |
31838 | + /* Informative stuff (to choose between different interface) */ | |
31839 | + __u32 throughput; /* To give an idea... */ | |
31840 | + /* In theory this value should be the maximum benchmarked | |
31841 | + * TCP/IP throughput, because with most of these devices the | |
31842 | + * bit rate is meaningless (overhead an co) to estimate how | |
31843 | + * fast the connection will go and pick the fastest one. | |
31844 | + * I suggest people to play with Netperf or any benchmark... | |
31845 | + */ | |
31846 | + | |
31847 | + /* NWID (or domain id) */ | |
31848 | + __u32 min_nwid; /* Minimal NWID we are able to set */ | |
31849 | + __u32 max_nwid; /* Maximal NWID we are able to set */ | |
31850 | + | |
31851 | + /* Old Frequency (backward compat - moved lower ) */ | |
31852 | + __u16 old_num_channels; | |
31853 | + __u8 old_num_frequency; | |
31854 | + | |
31855 | + /* Scan capabilities */ | |
31856 | + __u8 scan_capa; | |
31857 | +}; | |
31858 | +//YJ,add,080819,for hidden ap | |
31859 | + | |
31860 | + | |
31861 | +static int rtl8180_wx_get_range(struct net_device *dev, | |
31862 | + struct iw_request_info *info, | |
31863 | + union iwreq_data *wrqu, char *extra) | |
31864 | +{ | |
31865 | + struct iw_range *range = (struct iw_range *)extra; | |
31866 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31867 | + u16 val; | |
31868 | + int i; | |
31869 | + //struct iw_range_with_scan_capa* tmp = (struct iw_range_with_scan_capa*)range; //YJ,add,080819,for hidden ap | |
31870 | + | |
31871 | + wrqu->data.length = sizeof(*range); | |
31872 | + memset(range, 0, sizeof(*range)); | |
31873 | + | |
31874 | + /* Let's try to keep this struct in the same order as in | |
31875 | + * linux/include/wireless.h | |
31876 | + */ | |
31877 | + | |
31878 | + /* TODO: See what values we can set, and remove the ones we can't | |
31879 | + * set, or fill them with some default data. | |
31880 | + */ | |
31881 | + | |
31882 | + /* ~5 Mb/s real (802.11b) */ | |
31883 | + range->throughput = 5 * 1000 * 1000; | |
31884 | + | |
31885 | + // TODO: Not used in 802.11b? | |
31886 | +// range->min_nwid; /* Minimal NWID we are able to set */ | |
31887 | + // TODO: Not used in 802.11b? | |
31888 | +// range->max_nwid; /* Maximal NWID we are able to set */ | |
31889 | + | |
31890 | + /* Old Frequency (backward compat - moved lower ) */ | |
31891 | +// range->old_num_channels; | |
31892 | +// range->old_num_frequency; | |
31893 | +// range->old_freq[6]; /* Filler to keep "version" at the same offset */ | |
31894 | + if(priv->rf_set_sens != NULL) | |
31895 | + range->sensitivity = priv->max_sens; /* signal level threshold range */ | |
31896 | + | |
31897 | + range->max_qual.qual = 100; | |
31898 | + /* TODO: Find real max RSSI and stick here */ | |
31899 | + range->max_qual.level = 0; | |
31900 | + range->max_qual.noise = -98; | |
31901 | + range->max_qual.updated = 7; /* Updated all three */ | |
31902 | + | |
31903 | + range->avg_qual.qual = 92; /* > 8% missed beacons is 'bad' */ | |
31904 | + /* TODO: Find real 'good' to 'bad' threshol value for RSSI */ | |
31905 | + range->avg_qual.level = 20 + -98; | |
31906 | + range->avg_qual.noise = 0; | |
31907 | + range->avg_qual.updated = 7; /* Updated all three */ | |
31908 | + | |
31909 | + range->num_bitrates = RATE_COUNT; | |
31910 | + | |
31911 | + for (i = 0; i < RATE_COUNT && i < IW_MAX_BITRATES; i++) { | |
31912 | + range->bitrate[i] = rtl8180_rates[i]; | |
31913 | + } | |
31914 | + | |
31915 | + range->min_frag = MIN_FRAG_THRESHOLD; | |
31916 | + range->max_frag = MAX_FRAG_THRESHOLD; | |
31917 | + | |
31918 | + range->pm_capa = 0; | |
31919 | + | |
31920 | + range->we_version_compiled = WIRELESS_EXT; | |
31921 | + range->we_version_source = 16; | |
31922 | + | |
31923 | +// range->retry_capa; /* What retry options are supported */ | |
31924 | +// range->retry_flags; /* How to decode max/min retry limit */ | |
31925 | +// range->r_time_flags; /* How to decode max/min retry life */ | |
31926 | +// range->min_retry; /* Minimal number of retries */ | |
31927 | +// range->max_retry; /* Maximal number of retries */ | |
31928 | +// range->min_r_time; /* Minimal retry lifetime */ | |
31929 | +// range->max_r_time; /* Maximal retry lifetime */ | |
31930 | + | |
31931 | + range->num_channels = 14; | |
31932 | + | |
31933 | + for (i = 0, val = 0; i < 14; i++) { | |
31934 | + | |
31935 | + // Include only legal frequencies for some countries | |
31936 | +#ifdef ENABLE_DOT11D | |
31937 | + if ((GET_DOT11D_INFO(priv->ieee80211)->channel_map)[i+1]) { | |
31938 | +#else | |
31939 | + if ((priv->ieee80211->channel_map)[i+1]) { | |
31940 | +#endif | |
31941 | + range->freq[val].i = i + 1; | |
31942 | + range->freq[val].m = ieee80211_wlan_frequencies[i] * 100000; | |
31943 | + range->freq[val].e = 1; | |
31944 | + val++; | |
31945 | + } else { | |
31946 | + // FIXME: do we need to set anything for channels | |
31947 | + // we don't use ? | |
31948 | + } | |
31949 | + | |
31950 | + if (val == IW_MAX_FREQUENCIES) | |
31951 | + break; | |
31952 | + } | |
31953 | + | |
31954 | + range->num_frequency = val; | |
31955 | + range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 | | |
31956 | + IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP; | |
31957 | + | |
31958 | + //tmp->scan_capa = 0x01; //YJ,add,080819,for hidden ap | |
31959 | + | |
31960 | + return 0; | |
31961 | +} | |
31962 | + | |
31963 | + | |
31964 | +static int r8180_wx_set_scan(struct net_device *dev, struct iw_request_info *a, | |
31965 | + union iwreq_data *wrqu, char *b) | |
31966 | +{ | |
31967 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
31968 | + int ret; | |
31969 | + struct ieee80211_device* ieee = priv->ieee80211; | |
31970 | + | |
31971 | + | |
31972 | + if(priv->ieee80211->bHwRadioOff) | |
31973 | + return 0; | |
31974 | + | |
31975 | +//YJ,add,080819, for hidden ap | |
31976 | + //printk("==*&*&*&==>%s in\n", __func__); | |
31977 | + //printk("=*&*&*&*===>flag:%x, %x\n", wrqu->data.flags, IW_SCAN_THIS_ESSID); | |
31978 | + if (wrqu->data.flags & IW_SCAN_THIS_ESSID) | |
31979 | + { | |
31980 | + struct iw_scan_req* req = (struct iw_scan_req*)b; | |
31981 | + if (req->essid_len) | |
31982 | + { | |
31983 | + //printk("==**&*&*&**===>scan set ssid:%s\n", req->essid); | |
31984 | + ieee->current_network.ssid_len = req->essid_len; | |
31985 | + memcpy(ieee->current_network.ssid, req->essid, req->essid_len); | |
31986 | + //printk("=====>network ssid:%s\n", ieee->current_network.ssid); | |
31987 | + } | |
31988 | + } | |
31989 | +//YJ,add,080819, for hidden ap, end | |
31990 | + | |
31991 | + down(&priv->wx_sem); | |
31992 | + if(priv->up){ | |
31993 | +#ifdef ENABLE_IPS | |
31994 | +// printk("set scan ENABLE_IPS\n"); | |
31995 | + priv->ieee80211->actscanning = true; | |
31996 | + if(priv->bInactivePs && (priv->ieee80211->state != IEEE80211_LINKED)){ | |
31997 | + IPSLeave(dev); | |
31998 | +// down(&priv->ieee80211->wx_sem); | |
31999 | + | |
32000 | +// if (priv->ieee80211->iw_mode == IW_MODE_MONITOR || !(priv->ieee80211->proto_started)){ | |
32001 | +// ret = -1; | |
32002 | +// up(&priv->ieee80211->wx_sem); | |
32003 | +// up(&priv->wx_sem); | |
32004 | +// return ret; | |
32005 | +// } | |
32006 | + | |
32007 | + // queue_work(priv->ieee80211->wq, &priv->ieee80211->wx_sync_scan_wq); | |
32008 | + //printk("start scan============================>\n"); | |
32009 | + ieee80211_softmac_ips_scan_syncro(priv->ieee80211); | |
32010 | +//ieee80211_start_scan(priv->ieee80211); | |
32011 | + /* intentionally forget to up sem */ | |
32012 | +// up(&priv->ieee80211->wx_sem); | |
32013 | + ret = 0; | |
32014 | + } | |
32015 | + else | |
32016 | +#endif | |
32017 | + { | |
32018 | + //YJ,add,080828, prevent scan in BusyTraffic | |
32019 | + //FIXME: Need to consider last scan time | |
32020 | + if ((priv->link_detect.bBusyTraffic) && (true)) | |
32021 | + { | |
32022 | + ret = 0; | |
32023 | + printk("Now traffic is busy, please try later!\n"); | |
32024 | + } | |
32025 | + else | |
32026 | + //YJ,add,080828, prevent scan in BusyTraffic,end | |
32027 | + ret = ieee80211_wx_set_scan(priv->ieee80211,a,wrqu,b); | |
32028 | + } | |
32029 | + } | |
32030 | + else | |
32031 | + ret = -1; | |
32032 | + | |
32033 | + up(&priv->wx_sem); | |
32034 | + | |
32035 | + return ret; | |
32036 | +} | |
32037 | + | |
32038 | + | |
32039 | +static int r8180_wx_get_scan(struct net_device *dev, struct iw_request_info *a, | |
32040 | + union iwreq_data *wrqu, char *b) | |
32041 | +{ | |
32042 | + | |
32043 | + int ret; | |
32044 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32045 | + | |
32046 | + down(&priv->wx_sem); | |
32047 | + if(priv->up) | |
32048 | + ret = ieee80211_wx_get_scan(priv->ieee80211,a,wrqu,b); | |
32049 | + else | |
32050 | + ret = -1; | |
32051 | + | |
32052 | + up(&priv->wx_sem); | |
32053 | + return ret; | |
32054 | +} | |
32055 | + | |
32056 | + | |
32057 | +static int r8180_wx_set_essid(struct net_device *dev, | |
32058 | + struct iw_request_info *a, | |
32059 | + union iwreq_data *wrqu, char *b) | |
32060 | +{ | |
32061 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32062 | + | |
32063 | + int ret; | |
32064 | + | |
32065 | + if(priv->ieee80211->bHwRadioOff) | |
32066 | + return 0; | |
32067 | + | |
32068 | + down(&priv->wx_sem); | |
32069 | +#ifdef ENABLE_IPS | |
32070 | + //printk("set essid ENABLE_IPS\n"); | |
32071 | + if(priv->bInactivePs) | |
32072 | + IPSLeave(dev); | |
32073 | +#endif | |
32074 | +// printk("haha:set essid %s essid_len = %d essid_flgs = %d\n",b, wrqu->essid.length, wrqu->essid.flags); | |
32075 | + | |
32076 | + ret = ieee80211_wx_set_essid(priv->ieee80211,a,wrqu,b); | |
32077 | + | |
32078 | + up(&priv->wx_sem); | |
32079 | + return ret; | |
32080 | +} | |
32081 | + | |
32082 | + | |
32083 | +static int r8180_wx_get_essid(struct net_device *dev, | |
32084 | + struct iw_request_info *a, | |
32085 | + union iwreq_data *wrqu, char *b) | |
32086 | +{ | |
32087 | + int ret; | |
32088 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32089 | + | |
32090 | + down(&priv->wx_sem); | |
32091 | + | |
32092 | + ret = ieee80211_wx_get_essid(priv->ieee80211, a, wrqu, b); | |
32093 | + | |
32094 | + up(&priv->wx_sem); | |
32095 | + | |
32096 | + return ret; | |
32097 | +} | |
32098 | + | |
32099 | + | |
32100 | +static int r8180_wx_set_freq(struct net_device *dev, struct iw_request_info *a, | |
32101 | + union iwreq_data *wrqu, char *b) | |
32102 | +{ | |
32103 | + int ret; | |
32104 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32105 | + | |
32106 | + | |
32107 | + if(priv->ieee80211->bHwRadioOff) | |
32108 | + return 0; | |
32109 | + | |
32110 | + down(&priv->wx_sem); | |
32111 | + | |
32112 | + ret = ieee80211_wx_set_freq(priv->ieee80211, a, wrqu, b); | |
32113 | + | |
32114 | + up(&priv->wx_sem); | |
32115 | + return ret; | |
32116 | +} | |
32117 | + | |
32118 | + | |
32119 | +static int r8180_wx_get_name(struct net_device *dev, | |
32120 | + struct iw_request_info *info, | |
32121 | + union iwreq_data *wrqu, char *extra) | |
32122 | +{ | |
32123 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32124 | + return ieee80211_wx_get_name(priv->ieee80211, info, wrqu, extra); | |
32125 | +} | |
32126 | + | |
32127 | +static int r8180_wx_set_frag(struct net_device *dev, | |
32128 | + struct iw_request_info *info, | |
32129 | + union iwreq_data *wrqu, char *extra) | |
32130 | +{ | |
32131 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32132 | + | |
32133 | + if(priv->ieee80211->bHwRadioOff) | |
32134 | + return 0; | |
32135 | + | |
32136 | + if (wrqu->frag.disabled) | |
32137 | + priv->ieee80211->fts = DEFAULT_FRAG_THRESHOLD; | |
32138 | + else { | |
32139 | + if (wrqu->frag.value < MIN_FRAG_THRESHOLD || | |
32140 | + wrqu->frag.value > MAX_FRAG_THRESHOLD) | |
32141 | + return -EINVAL; | |
32142 | + | |
32143 | + priv->ieee80211->fts = wrqu->frag.value & ~0x1; | |
32144 | + } | |
32145 | + | |
32146 | + return 0; | |
32147 | +} | |
32148 | + | |
32149 | + | |
32150 | +static int r8180_wx_get_frag(struct net_device *dev, | |
32151 | + struct iw_request_info *info, | |
32152 | + union iwreq_data *wrqu, char *extra) | |
32153 | +{ | |
32154 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32155 | + | |
32156 | + wrqu->frag.value = priv->ieee80211->fts; | |
32157 | + wrqu->frag.fixed = 0; /* no auto select */ | |
32158 | + wrqu->frag.disabled = (wrqu->frag.value == DEFAULT_FRAG_THRESHOLD); | |
32159 | + | |
32160 | + return 0; | |
32161 | +} | |
32162 | + | |
32163 | + | |
32164 | +static int r8180_wx_set_wap(struct net_device *dev, | |
32165 | + struct iw_request_info *info, | |
32166 | + union iwreq_data *awrq, | |
32167 | + char *extra) | |
32168 | +{ | |
32169 | + int ret; | |
32170 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32171 | + | |
32172 | + if(priv->ieee80211->bHwRadioOff) | |
32173 | + return 0; | |
32174 | + | |
32175 | + down(&priv->wx_sem); | |
32176 | + | |
32177 | + ret = ieee80211_wx_set_wap(priv->ieee80211,info,awrq,extra); | |
32178 | + | |
32179 | + up(&priv->wx_sem); | |
32180 | + return ret; | |
32181 | + | |
32182 | +} | |
32183 | + | |
32184 | + | |
32185 | +static int r8180_wx_get_wap(struct net_device *dev, | |
32186 | + struct iw_request_info *info, | |
32187 | + union iwreq_data *wrqu, char *extra) | |
32188 | +{ | |
32189 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32190 | + | |
32191 | + return ieee80211_wx_get_wap(priv->ieee80211,info,wrqu,extra); | |
32192 | +} | |
32193 | + | |
32194 | + | |
32195 | +static int r8180_wx_set_enc(struct net_device *dev, | |
32196 | + struct iw_request_info *info, | |
32197 | + union iwreq_data *wrqu, char *key) | |
32198 | +{ | |
32199 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32200 | + int ret; | |
32201 | + | |
32202 | + if(priv->ieee80211->bHwRadioOff) | |
32203 | + return 0; | |
32204 | + | |
32205 | + | |
32206 | + down(&priv->wx_sem); | |
32207 | + | |
32208 | + if(priv->hw_wep) ret = r8180_wx_set_key(dev,info,wrqu,key); | |
32209 | + else{ | |
32210 | + DMESG("Setting SW wep key"); | |
32211 | + ret = ieee80211_wx_set_encode(priv->ieee80211,info,wrqu,key); | |
32212 | + } | |
32213 | + | |
32214 | + up(&priv->wx_sem); | |
32215 | + return ret; | |
32216 | +} | |
32217 | + | |
32218 | + | |
32219 | +static int r8180_wx_get_enc(struct net_device *dev, | |
32220 | + struct iw_request_info *info, | |
32221 | + union iwreq_data *wrqu, char *key) | |
32222 | +{ | |
32223 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32224 | + | |
32225 | + return ieee80211_wx_get_encode(priv->ieee80211, info, wrqu, key); | |
32226 | +} | |
32227 | + | |
32228 | + | |
32229 | +static int r8180_wx_set_scan_type(struct net_device *dev, struct iw_request_info *aa, union | |
32230 | + iwreq_data *wrqu, char *p){ | |
32231 | + | |
32232 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32233 | + int *parms=(int*)p; | |
32234 | + int mode=parms[0]; | |
32235 | + | |
32236 | + if(priv->ieee80211->bHwRadioOff) | |
32237 | + return 0; | |
32238 | + | |
32239 | + priv->ieee80211->active_scan = mode; | |
32240 | + | |
32241 | + return 1; | |
32242 | +} | |
32243 | + | |
32244 | + | |
32245 | +/* added by christian */ | |
32246 | +/* | |
32247 | +static int r8180_wx_set_monitor_type(struct net_device *dev, struct iw_request_info *aa, union | |
32248 | + iwreq_data *wrqu, char *p){ | |
32249 | + | |
32250 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32251 | + int *parms=(int*)p; | |
32252 | + int mode=parms[0]; | |
32253 | + | |
32254 | + if(priv->ieee80211->iw_mode != IW_MODE_MONITOR) return -1; | |
32255 | + priv->prism_hdr = mode; | |
32256 | + if(!mode)dev->type=ARPHRD_IEEE80211; | |
32257 | + else dev->type=ARPHRD_IEEE80211_PRISM; | |
32258 | + DMESG("using %s RX encap", mode ? "AVS":"80211"); | |
32259 | + return 0; | |
32260 | + | |
32261 | +} | |
32262 | +*/ | |
32263 | +//of r8180_wx_set_monitor_type | |
32264 | +/* end added christian */ | |
32265 | + | |
32266 | +static int r8180_wx_set_retry(struct net_device *dev, | |
32267 | + struct iw_request_info *info, | |
32268 | + union iwreq_data *wrqu, char *extra) | |
32269 | +{ | |
32270 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32271 | + int err = 0; | |
32272 | + | |
32273 | + if(priv->ieee80211->bHwRadioOff) | |
32274 | + return 0; | |
32275 | + | |
32276 | + down(&priv->wx_sem); | |
32277 | + | |
32278 | + if (wrqu->retry.flags & IW_RETRY_LIFETIME || | |
32279 | + wrqu->retry.disabled){ | |
32280 | + err = -EINVAL; | |
32281 | + goto exit; | |
32282 | + } | |
32283 | + if (!(wrqu->retry.flags & IW_RETRY_LIMIT)){ | |
32284 | + err = -EINVAL; | |
32285 | + goto exit; | |
32286 | + } | |
32287 | + | |
32288 | + if(wrqu->retry.value > R8180_MAX_RETRY){ | |
32289 | + err= -EINVAL; | |
32290 | + goto exit; | |
32291 | + } | |
32292 | + if (wrqu->retry.flags & IW_RETRY_MAX) { | |
32293 | + priv->retry_rts = wrqu->retry.value; | |
32294 | + DMESG("Setting retry for RTS/CTS data to %d", wrqu->retry.value); | |
32295 | + | |
32296 | + }else { | |
32297 | + priv->retry_data = wrqu->retry.value; | |
32298 | + DMESG("Setting retry for non RTS/CTS data to %d", wrqu->retry.value); | |
32299 | + } | |
32300 | + | |
32301 | + /* FIXME ! | |
32302 | + * We might try to write directly the TX config register | |
32303 | + * or to restart just the (R)TX process. | |
32304 | + * I'm unsure if whole reset is really needed | |
32305 | + */ | |
32306 | + | |
32307 | + rtl8180_commit(dev); | |
32308 | + /* | |
32309 | + if(priv->up){ | |
32310 | + rtl8180_rtx_disable(dev); | |
32311 | + rtl8180_rx_enable(dev); | |
32312 | + rtl8180_tx_enable(dev); | |
32313 | + | |
32314 | + } | |
32315 | + */ | |
32316 | +exit: | |
32317 | + up(&priv->wx_sem); | |
32318 | + | |
32319 | + return err; | |
32320 | +} | |
32321 | + | |
32322 | +static int r8180_wx_get_retry(struct net_device *dev, | |
32323 | + struct iw_request_info *info, | |
32324 | + union iwreq_data *wrqu, char *extra) | |
32325 | +{ | |
32326 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32327 | + | |
32328 | + | |
32329 | + wrqu->retry.disabled = 0; /* can't be disabled */ | |
32330 | + | |
32331 | + if ((wrqu->retry.flags & IW_RETRY_TYPE) == | |
32332 | + IW_RETRY_LIFETIME) | |
32333 | + return -EINVAL; | |
32334 | + | |
32335 | + if (wrqu->retry.flags & IW_RETRY_MAX) { | |
32336 | + wrqu->retry.flags = IW_RETRY_LIMIT & IW_RETRY_MAX; | |
32337 | + wrqu->retry.value = priv->retry_rts; | |
32338 | + } else { | |
32339 | + wrqu->retry.flags = IW_RETRY_LIMIT & IW_RETRY_MIN; | |
32340 | + wrqu->retry.value = priv->retry_data; | |
32341 | + } | |
32342 | + //DMESG("returning %d",wrqu->retry.value); | |
32343 | + | |
32344 | + | |
32345 | + return 0; | |
32346 | +} | |
32347 | + | |
32348 | +static int r8180_wx_get_sens(struct net_device *dev, | |
32349 | + struct iw_request_info *info, | |
32350 | + union iwreq_data *wrqu, char *extra) | |
32351 | +{ | |
32352 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32353 | + if(priv->rf_set_sens == NULL) | |
32354 | + return -1; /* we have not this support for this radio */ | |
32355 | + wrqu->sens.value = priv->sens; | |
32356 | + return 0; | |
32357 | +} | |
32358 | + | |
32359 | + | |
32360 | +static int r8180_wx_set_sens(struct net_device *dev, | |
32361 | + struct iw_request_info *info, | |
32362 | + union iwreq_data *wrqu, char *extra) | |
32363 | +{ | |
32364 | + | |
32365 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32366 | + | |
32367 | + short err = 0; | |
32368 | + | |
32369 | + if(priv->ieee80211->bHwRadioOff) | |
32370 | + return 0; | |
32371 | + | |
32372 | + down(&priv->wx_sem); | |
32373 | + //DMESG("attempt to set sensivity to %ddb",wrqu->sens.value); | |
32374 | + if(priv->rf_set_sens == NULL) { | |
32375 | + err= -1; /* we have not this support for this radio */ | |
32376 | + goto exit; | |
32377 | + } | |
32378 | + if(priv->rf_set_sens(dev, wrqu->sens.value) == 0) | |
32379 | + priv->sens = wrqu->sens.value; | |
32380 | + else | |
32381 | + err= -EINVAL; | |
32382 | + | |
32383 | +exit: | |
32384 | + up(&priv->wx_sem); | |
32385 | + | |
32386 | + return err; | |
32387 | +} | |
32388 | + | |
32389 | + | |
32390 | +static int r8180_wx_set_rawtx(struct net_device *dev, | |
32391 | + struct iw_request_info *info, | |
32392 | + union iwreq_data *wrqu, char *extra) | |
32393 | +{ | |
32394 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32395 | + int ret; | |
32396 | + | |
32397 | + if(priv->ieee80211->bHwRadioOff) | |
32398 | + return 0; | |
32399 | + | |
32400 | + down(&priv->wx_sem); | |
32401 | + | |
32402 | + ret = ieee80211_wx_set_rawtx(priv->ieee80211, info, wrqu, extra); | |
32403 | + | |
32404 | + up(&priv->wx_sem); | |
32405 | + | |
32406 | + return ret; | |
32407 | + | |
32408 | +} | |
32409 | + | |
32410 | +static int r8180_wx_get_power(struct net_device *dev, | |
32411 | + struct iw_request_info *info, | |
32412 | + union iwreq_data *wrqu, char *extra) | |
32413 | +{ | |
32414 | + int ret; | |
32415 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32416 | + | |
32417 | + down(&priv->wx_sem); | |
32418 | + | |
32419 | + ret = ieee80211_wx_get_power(priv->ieee80211, info, wrqu, extra); | |
32420 | + | |
32421 | + up(&priv->wx_sem); | |
32422 | + | |
32423 | + return ret; | |
32424 | +} | |
32425 | + | |
32426 | +static int r8180_wx_set_power(struct net_device *dev, | |
32427 | + struct iw_request_info *info, | |
32428 | + union iwreq_data *wrqu, char *extra) | |
32429 | +{ | |
32430 | + int ret; | |
32431 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32432 | + | |
32433 | + | |
32434 | + if(priv->ieee80211->bHwRadioOff) | |
32435 | + return 0; | |
32436 | + | |
32437 | + down(&priv->wx_sem); | |
32438 | + printk("=>>>>>>>>>>=============================>set power:%d,%d!\n",wrqu->power.disabled, wrqu->power.flags); | |
32439 | + if (wrqu->power.disabled==0) { | |
32440 | + wrqu->power.flags|=IW_POWER_ALL_R; | |
32441 | + wrqu->power.flags|=IW_POWER_TIMEOUT; | |
32442 | + wrqu->power.value =1000; | |
32443 | + } | |
32444 | + | |
32445 | + ret = ieee80211_wx_set_power(priv->ieee80211, info, wrqu, extra); | |
32446 | + | |
32447 | + up(&priv->wx_sem); | |
32448 | + | |
32449 | + return ret; | |
32450 | +} | |
32451 | + | |
32452 | +static int r8180_wx_set_rts(struct net_device *dev, | |
32453 | + struct iw_request_info *info, | |
32454 | + union iwreq_data *wrqu, char *extra) | |
32455 | +{ | |
32456 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32457 | + | |
32458 | + | |
32459 | + if(priv->ieee80211->bHwRadioOff) | |
32460 | + return 0; | |
32461 | + | |
32462 | + if (wrqu->rts.disabled) | |
32463 | + priv->rts = DEFAULT_RTS_THRESHOLD; | |
32464 | + else { | |
32465 | + if (wrqu->rts.value < MIN_RTS_THRESHOLD || | |
32466 | + wrqu->rts.value > MAX_RTS_THRESHOLD) | |
32467 | + return -EINVAL; | |
32468 | + | |
32469 | + priv->rts = wrqu->rts.value; | |
32470 | + } | |
32471 | + | |
32472 | + return 0; | |
32473 | +} | |
32474 | +static int r8180_wx_get_rts(struct net_device *dev, | |
32475 | + struct iw_request_info *info, | |
32476 | + union iwreq_data *wrqu, char *extra) | |
32477 | +{ | |
32478 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32479 | + | |
32480 | + | |
32481 | + | |
32482 | + wrqu->rts.value = priv->rts; | |
32483 | + wrqu->rts.fixed = 0; /* no auto select */ | |
32484 | + wrqu->rts.disabled = (wrqu->rts.value == 0); | |
32485 | + | |
32486 | + return 0; | |
32487 | +} | |
32488 | +static int dummy(struct net_device *dev, struct iw_request_info *a, | |
32489 | + union iwreq_data *wrqu,char *b) | |
32490 | +{ | |
32491 | + return -1; | |
32492 | +} | |
32493 | + | |
32494 | +/* | |
32495 | +static int r8180_wx_get_psmode(struct net_device *dev, | |
32496 | + struct iw_request_info *info, | |
32497 | + union iwreq_data *wrqu, char *extra) | |
32498 | +{ | |
32499 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32500 | + struct ieee80211_device *ieee; | |
32501 | + int ret = 0; | |
32502 | + | |
32503 | + | |
32504 | + | |
32505 | + down(&priv->wx_sem); | |
32506 | + | |
32507 | + if(priv) { | |
32508 | + ieee = priv->ieee80211; | |
32509 | + if(ieee->ps == IEEE80211_PS_DISABLED) { | |
32510 | + *((unsigned int *)extra) = IEEE80211_PS_DISABLED; | |
32511 | + goto exit; | |
32512 | + } | |
32513 | + *((unsigned int *)extra) = IW_POWER_TIMEOUT; | |
32514 | + if (ieee->ps & IEEE80211_PS_MBCAST) | |
32515 | + *((unsigned int *)extra) |= IW_POWER_ALL_R; | |
32516 | + else | |
32517 | + *((unsigned int *)extra) |= IW_POWER_UNICAST_R; | |
32518 | + } else | |
32519 | + ret = -1; | |
32520 | +exit: | |
32521 | + up(&priv->wx_sem); | |
32522 | + | |
32523 | + return ret; | |
32524 | +} | |
32525 | +static int r8180_wx_set_psmode(struct net_device *dev, | |
32526 | + struct iw_request_info *info, | |
32527 | + union iwreq_data *wrqu, char *extra) | |
32528 | +{ | |
32529 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32530 | + //struct ieee80211_device *ieee; | |
32531 | + int ret = 0; | |
32532 | + | |
32533 | + | |
32534 | + | |
32535 | + down(&priv->wx_sem); | |
32536 | + | |
32537 | + ret = ieee80211_wx_set_power(priv->ieee80211, info, wrqu, extra); | |
32538 | + | |
32539 | + up(&priv->wx_sem); | |
32540 | + | |
32541 | + return ret; | |
32542 | + | |
32543 | +} | |
32544 | +*/ | |
32545 | + | |
32546 | +static int r8180_wx_get_iwmode(struct net_device *dev, | |
32547 | + struct iw_request_info *info, | |
32548 | + union iwreq_data *wrqu, char *extra) | |
32549 | +{ | |
32550 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32551 | + struct ieee80211_device *ieee; | |
32552 | + int ret = 0; | |
32553 | + | |
32554 | + | |
32555 | + | |
32556 | + down(&priv->wx_sem); | |
32557 | + | |
32558 | + ieee = priv->ieee80211; | |
32559 | + | |
32560 | + strcpy(extra, "802.11"); | |
32561 | + if(ieee->modulation & IEEE80211_CCK_MODULATION) { | |
32562 | + strcat(extra, "b"); | |
32563 | + if(ieee->modulation & IEEE80211_OFDM_MODULATION) | |
32564 | + strcat(extra, "/g"); | |
32565 | + } else if(ieee->modulation & IEEE80211_OFDM_MODULATION) | |
32566 | + strcat(extra, "g"); | |
32567 | + | |
32568 | + up(&priv->wx_sem); | |
32569 | + | |
32570 | + return ret; | |
32571 | +} | |
32572 | +static int r8180_wx_set_iwmode(struct net_device *dev, | |
32573 | + struct iw_request_info *info, | |
32574 | + union iwreq_data *wrqu, char *extra) | |
32575 | +{ | |
32576 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32577 | + struct ieee80211_device *ieee = priv->ieee80211; | |
32578 | + int *param = (int *)extra; | |
32579 | + int ret = 0; | |
32580 | + int modulation = 0, mode = 0; | |
32581 | + | |
32582 | + | |
32583 | + if(priv->ieee80211->bHwRadioOff) | |
32584 | + return 0; | |
32585 | + | |
32586 | + down(&priv->wx_sem); | |
32587 | + | |
32588 | + if (*param == 1) { | |
32589 | + modulation |= IEEE80211_CCK_MODULATION; | |
32590 | + mode = IEEE_B; | |
32591 | + printk(KERN_INFO "B mode!\n"); | |
32592 | + } else if (*param == 2) { | |
32593 | + modulation |= IEEE80211_OFDM_MODULATION; | |
32594 | + mode = IEEE_G; | |
32595 | + printk(KERN_INFO "G mode!\n"); | |
32596 | + } else if (*param == 3) { | |
32597 | + modulation |= IEEE80211_CCK_MODULATION; | |
32598 | + modulation |= IEEE80211_OFDM_MODULATION; | |
32599 | + mode = IEEE_B|IEEE_G; | |
32600 | + printk(KERN_INFO "B/G mode!\n"); | |
32601 | + } | |
32602 | + | |
32603 | + if(ieee->proto_started) { | |
32604 | + ieee80211_stop_protocol(ieee); | |
32605 | + ieee->mode = mode; | |
32606 | + ieee->modulation = modulation; | |
32607 | + ieee80211_start_protocol(ieee); | |
32608 | + } else { | |
32609 | + ieee->mode = mode; | |
32610 | + ieee->modulation = modulation; | |
32611 | +// ieee80211_start_protocol(ieee); | |
32612 | + } | |
32613 | + | |
32614 | + up(&priv->wx_sem); | |
32615 | + | |
32616 | + return ret; | |
32617 | +} | |
32618 | +static int r8180_wx_get_preamble(struct net_device *dev, | |
32619 | + struct iw_request_info *info, | |
32620 | + union iwreq_data *wrqu, char *extra) | |
32621 | +{ | |
32622 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32623 | + | |
32624 | + | |
32625 | + | |
32626 | + down(&priv->wx_sem); | |
32627 | + | |
32628 | + | |
32629 | + | |
32630 | + *extra = (char) priv->plcp_preamble_mode; // 0:auto 1:short 2:long | |
32631 | + up(&priv->wx_sem); | |
32632 | + | |
32633 | + return 0; | |
32634 | +} | |
32635 | +static int r8180_wx_set_preamble(struct net_device *dev, | |
32636 | + struct iw_request_info *info, | |
32637 | + union iwreq_data *wrqu, char *extra) | |
32638 | +{ | |
32639 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32640 | + int ret = 0; | |
32641 | + | |
32642 | + | |
32643 | + if(priv->ieee80211->bHwRadioOff) | |
32644 | + return 0; | |
32645 | + | |
32646 | + down(&priv->wx_sem); | |
32647 | + if (*extra<0||*extra>2) | |
32648 | + ret = -1; | |
32649 | + else | |
32650 | + priv->plcp_preamble_mode = *((short *)extra) ; | |
32651 | + | |
32652 | + | |
32653 | + | |
32654 | + up(&priv->wx_sem); | |
32655 | + | |
32656 | + return ret; | |
32657 | +} | |
32658 | +static int r8180_wx_get_siglevel(struct net_device *dev, | |
32659 | + struct iw_request_info *info, | |
32660 | + union iwreq_data *wrqu, char *extra) | |
32661 | +{ | |
32662 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32663 | + //struct ieee80211_network *network = &(priv->ieee80211->current_network); | |
32664 | + int ret = 0; | |
32665 | + | |
32666 | + | |
32667 | + | |
32668 | + down(&priv->wx_sem); | |
32669 | + // Modify by hikaru 6.5 | |
32670 | + *((int *)extra) = priv->wstats.qual.level;//for interface test ,it should be the priv->wstats.qual.level; | |
32671 | + | |
32672 | + | |
32673 | + | |
32674 | + up(&priv->wx_sem); | |
32675 | + | |
32676 | + return ret; | |
32677 | +} | |
32678 | +static int r8180_wx_get_sigqual(struct net_device *dev, | |
32679 | + struct iw_request_info *info, | |
32680 | + union iwreq_data *wrqu, char *extra) | |
32681 | +{ | |
32682 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32683 | + //struct ieee80211_network *network = &(priv->ieee80211->current_network); | |
32684 | + int ret = 0; | |
32685 | + | |
32686 | + | |
32687 | + | |
32688 | + down(&priv->wx_sem); | |
32689 | + // Modify by hikaru 6.5 | |
32690 | + *((int *)extra) = priv->wstats.qual.qual;//for interface test ,it should be the priv->wstats.qual.qual; | |
32691 | + | |
32692 | + | |
32693 | + | |
32694 | + up(&priv->wx_sem); | |
32695 | + | |
32696 | + return ret; | |
32697 | +} | |
32698 | +static int r8180_wx_reset_stats(struct net_device *dev, | |
32699 | + struct iw_request_info *info, | |
32700 | + union iwreq_data *wrqu, char *extra) | |
32701 | +{ | |
32702 | + struct r8180_priv *priv =ieee80211_priv(dev); | |
32703 | + down(&priv->wx_sem); | |
32704 | + | |
32705 | + priv->stats.txrdu = 0; | |
32706 | + priv->stats.rxrdu = 0; | |
32707 | + priv->stats.rxnolast = 0; | |
32708 | + priv->stats.rxnodata = 0; | |
32709 | + priv->stats.rxnopointer = 0; | |
32710 | + priv->stats.txnperr = 0; | |
32711 | + priv->stats.txresumed = 0; | |
32712 | + priv->stats.rxerr = 0; | |
32713 | + priv->stats.rxoverflow = 0; | |
32714 | + priv->stats.rxint = 0; | |
32715 | + | |
32716 | + priv->stats.txnpokint = 0; | |
32717 | + priv->stats.txhpokint = 0; | |
32718 | + priv->stats.txhperr = 0; | |
32719 | + priv->stats.ints = 0; | |
32720 | + priv->stats.shints = 0; | |
32721 | + priv->stats.txoverflow = 0; | |
32722 | + priv->stats.rxdmafail = 0; | |
32723 | + priv->stats.txbeacon = 0; | |
32724 | + priv->stats.txbeaconerr = 0; | |
32725 | + priv->stats.txlpokint = 0; | |
32726 | + priv->stats.txlperr = 0; | |
32727 | + priv->stats.txretry =0;//20060601 | |
32728 | + priv->stats.rxcrcerrmin=0; | |
32729 | + priv->stats.rxcrcerrmid=0; | |
32730 | + priv->stats.rxcrcerrmax=0; | |
32731 | + priv->stats.rxicverr=0; | |
32732 | + | |
32733 | + up(&priv->wx_sem); | |
32734 | + | |
32735 | + return 0; | |
32736 | + | |
32737 | +} | |
32738 | +static int r8180_wx_radio_on(struct net_device *dev, | |
32739 | + struct iw_request_info *info, | |
32740 | + union iwreq_data *wrqu, char *extra) | |
32741 | +{ | |
32742 | + struct r8180_priv *priv =ieee80211_priv(dev); | |
32743 | + | |
32744 | + if(priv->ieee80211->bHwRadioOff) | |
32745 | + return 0; | |
32746 | + | |
32747 | + | |
32748 | + down(&priv->wx_sem); | |
32749 | + priv->rf_wakeup(dev); | |
32750 | + | |
32751 | + up(&priv->wx_sem); | |
32752 | + | |
32753 | + return 0; | |
32754 | + | |
32755 | +} | |
32756 | + | |
32757 | +static int r8180_wx_radio_off(struct net_device *dev, | |
32758 | + struct iw_request_info *info, | |
32759 | + union iwreq_data *wrqu, char *extra) | |
32760 | +{ | |
32761 | + struct r8180_priv *priv =ieee80211_priv(dev); | |
32762 | + | |
32763 | + if(priv->ieee80211->bHwRadioOff) | |
32764 | + return 0; | |
32765 | + | |
32766 | + | |
32767 | + down(&priv->wx_sem); | |
32768 | + priv->rf_sleep(dev); | |
32769 | + | |
32770 | + up(&priv->wx_sem); | |
32771 | + | |
32772 | + return 0; | |
32773 | + | |
32774 | +} | |
32775 | +static int r8180_wx_get_channelplan(struct net_device *dev, | |
32776 | + struct iw_request_info *info, | |
32777 | + union iwreq_data *wrqu, char *extra) | |
32778 | +{ | |
32779 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32780 | + | |
32781 | + | |
32782 | + | |
32783 | + down(&priv->wx_sem); | |
32784 | + *extra = priv->channel_plan; | |
32785 | + | |
32786 | + | |
32787 | + | |
32788 | + up(&priv->wx_sem); | |
32789 | + | |
32790 | + return 0; | |
32791 | +} | |
32792 | +static int r8180_wx_set_channelplan(struct net_device *dev, | |
32793 | + struct iw_request_info *info, | |
32794 | + union iwreq_data *wrqu, char *extra) | |
32795 | +{ | |
32796 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32797 | + //struct ieee80211_device *ieee = netdev_priv(dev); | |
32798 | + int *val = (int *)extra; | |
32799 | + int i; | |
32800 | + printk("-----in fun %s\n", __FUNCTION__); | |
32801 | + | |
32802 | + if(priv->ieee80211->bHwRadioOff) | |
32803 | + return 0; | |
32804 | + | |
32805 | + //unsigned long flags; | |
32806 | + down(&priv->wx_sem); | |
32807 | + if (DefaultChannelPlan[*val].Len != 0){ | |
32808 | + priv ->channel_plan = *val; | |
32809 | + // Clear old channel map | |
32810 | + for (i=1;i<=MAX_CHANNEL_NUMBER;i++) | |
32811 | + { | |
32812 | +#ifdef ENABLE_DOT11D | |
32813 | + GET_DOT11D_INFO(priv->ieee80211)->channel_map[i] = 0; | |
32814 | +#else | |
32815 | + priv->ieee80211->channel_map[i] = 0; | |
32816 | +#endif | |
32817 | + } | |
32818 | + // Set new channel map | |
32819 | + for (i=1;i<=DefaultChannelPlan[*val].Len;i++) | |
32820 | + { | |
32821 | +#ifdef ENABLE_DOT11D | |
32822 | + GET_DOT11D_INFO(priv->ieee80211)->channel_map[DefaultChannelPlan[*val].Channel[i-1]] = 1; | |
32823 | +#else | |
32824 | + priv->ieee80211->channel_map[DefaultChannelPlan[*val].Channel[i-1]] = 1; | |
32825 | +#endif | |
32826 | + } | |
32827 | + } | |
32828 | + up(&priv->wx_sem); | |
32829 | + | |
32830 | + return 0; | |
32831 | +} | |
32832 | + | |
32833 | +static int r8180_wx_get_version(struct net_device *dev, | |
32834 | + struct iw_request_info *info, | |
32835 | + union iwreq_data *wrqu, char *extra) | |
32836 | +{ | |
32837 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32838 | + //struct ieee80211_device *ieee; | |
32839 | + | |
32840 | + down(&priv->wx_sem); | |
32841 | + strcpy(extra, "1020.0808"); | |
32842 | + up(&priv->wx_sem); | |
32843 | + | |
32844 | + return 0; | |
32845 | +} | |
32846 | + | |
32847 | +//added by amy 080818 | |
32848 | +//receive datarate from user typing valid rate is from 2 to 108 (1 - 54M), if input 0, return to normal rate adaptive. | |
32849 | +static int r8180_wx_set_forcerate(struct net_device *dev, | |
32850 | + struct iw_request_info *info, | |
32851 | + union iwreq_data *wrqu, char *extra) | |
32852 | +{ | |
32853 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32854 | + u8 forcerate = *extra; | |
32855 | + | |
32856 | + down(&priv->wx_sem); | |
32857 | + | |
32858 | + printk("==============>%s(): forcerate is %d\n",__FUNCTION__,forcerate); | |
32859 | + if((forcerate == 2) || (forcerate == 4) || (forcerate == 11) || (forcerate == 22) || (forcerate == 12) || | |
32860 | + (forcerate == 18) || (forcerate == 24) || (forcerate == 36) || (forcerate == 48) || (forcerate == 72) || | |
32861 | + (forcerate == 96) || (forcerate == 108)) | |
32862 | + { | |
32863 | + priv->ForcedDataRate = 1; | |
32864 | + priv->ieee80211->rate = forcerate * 5; | |
32865 | + } | |
32866 | + else if(forcerate == 0) | |
32867 | + { | |
32868 | + priv->ForcedDataRate = 0; | |
32869 | + printk("OK! return rate adaptive\n"); | |
32870 | + } | |
32871 | + else | |
32872 | + printk("ERR: wrong rate\n"); | |
32873 | + up(&priv->wx_sem); | |
32874 | + return 0; | |
32875 | +} | |
32876 | + | |
32877 | +static int r8180_wx_set_enc_ext(struct net_device *dev, | |
32878 | + struct iw_request_info *info, | |
32879 | + union iwreq_data *wrqu, char *extra) | |
32880 | +{ | |
32881 | + | |
32882 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32883 | + //printk("===>%s()\n", __FUNCTION__); | |
32884 | + | |
32885 | + int ret=0; | |
32886 | + | |
32887 | + if(priv->ieee80211->bHwRadioOff) | |
32888 | + return 0; | |
32889 | + | |
32890 | + down(&priv->wx_sem); | |
32891 | + ret = ieee80211_wx_set_encode_ext(priv->ieee80211, info, wrqu, extra); | |
32892 | + up(&priv->wx_sem); | |
32893 | + return ret; | |
32894 | + | |
32895 | +} | |
32896 | +static int r8180_wx_set_auth(struct net_device *dev, | |
32897 | + struct iw_request_info *info, | |
32898 | + struct iw_param *data, char *extra) | |
32899 | +{ | |
32900 | + //printk("====>%s()\n", __FUNCTION__); | |
32901 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32902 | + int ret=0; | |
32903 | + | |
32904 | + if(priv->ieee80211->bHwRadioOff) | |
32905 | + return 0; | |
32906 | + | |
32907 | + down(&priv->wx_sem); | |
32908 | + ret = ieee80211_wx_set_auth(priv->ieee80211, info, data, extra); | |
32909 | + up(&priv->wx_sem); | |
32910 | + return ret; | |
32911 | +} | |
32912 | + | |
32913 | +static int r8180_wx_set_mlme(struct net_device *dev, | |
32914 | + struct iw_request_info *info, | |
32915 | + union iwreq_data *wrqu, char *extra) | |
32916 | +{ | |
32917 | + //printk("====>%s()\n", __FUNCTION__); | |
32918 | + | |
32919 | + int ret=0; | |
32920 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32921 | + | |
32922 | + | |
32923 | + if(priv->ieee80211->bHwRadioOff) | |
32924 | + return 0; | |
32925 | + | |
32926 | + | |
32927 | + down(&priv->wx_sem); | |
32928 | +#if 1 | |
32929 | + ret = ieee80211_wx_set_mlme(priv->ieee80211, info, wrqu, extra); | |
32930 | +#endif | |
32931 | + up(&priv->wx_sem); | |
32932 | + return ret; | |
32933 | +} | |
32934 | +static int r8180_wx_set_gen_ie(struct net_device *dev, | |
32935 | + struct iw_request_info *info, | |
32936 | + struct iw_point *data, char *extra) | |
32937 | +{ | |
32938 | +// printk("====>%s(), len:%d\n", __FUNCTION__, data->length); | |
32939 | + int ret=0; | |
32940 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
32941 | + | |
32942 | + | |
32943 | + if(priv->ieee80211->bHwRadioOff) | |
32944 | + return 0; | |
32945 | + | |
32946 | + down(&priv->wx_sem); | |
32947 | +#if 1 | |
32948 | + ret = ieee80211_wx_set_gen_ie(priv->ieee80211, extra, data->length); | |
32949 | +#endif | |
32950 | + up(&priv->wx_sem); | |
32951 | + //printk("<======%s(), ret:%d\n", __FUNCTION__, ret); | |
32952 | + return ret; | |
32953 | + | |
32954 | + | |
32955 | +} | |
32956 | +static iw_handler r8180_wx_handlers[] = | |
32957 | +{ | |
32958 | + NULL, /* SIOCSIWCOMMIT */ | |
32959 | + r8180_wx_get_name, /* SIOCGIWNAME */ | |
32960 | + dummy, /* SIOCSIWNWID */ | |
32961 | + dummy, /* SIOCGIWNWID */ | |
32962 | + r8180_wx_set_freq, /* SIOCSIWFREQ */ | |
32963 | + r8180_wx_get_freq, /* SIOCGIWFREQ */ | |
32964 | + r8180_wx_set_mode, /* SIOCSIWMODE */ | |
32965 | + r8180_wx_get_mode, /* SIOCGIWMODE */ | |
32966 | + r8180_wx_set_sens, /* SIOCSIWSENS */ | |
32967 | + r8180_wx_get_sens, /* SIOCGIWSENS */ | |
32968 | + NULL, /* SIOCSIWRANGE */ | |
32969 | + rtl8180_wx_get_range, /* SIOCGIWRANGE */ | |
32970 | + NULL, /* SIOCSIWPRIV */ | |
32971 | + NULL, /* SIOCGIWPRIV */ | |
32972 | + NULL, /* SIOCSIWSTATS */ | |
32973 | + NULL, /* SIOCGIWSTATS */ | |
32974 | + dummy, /* SIOCSIWSPY */ | |
32975 | + dummy, /* SIOCGIWSPY */ | |
32976 | + NULL, /* SIOCGIWTHRSPY */ | |
32977 | + NULL, /* SIOCWIWTHRSPY */ | |
32978 | + r8180_wx_set_wap, /* SIOCSIWAP */ | |
32979 | + r8180_wx_get_wap, /* SIOCGIWAP */ | |
32980 | + r8180_wx_set_mlme, /* SIOCSIWMLME*/ | |
32981 | + dummy, /* SIOCGIWAPLIST -- depricated */ | |
32982 | + r8180_wx_set_scan, /* SIOCSIWSCAN */ | |
32983 | + r8180_wx_get_scan, /* SIOCGIWSCAN */ | |
32984 | + r8180_wx_set_essid, /* SIOCSIWESSID */ | |
32985 | + r8180_wx_get_essid, /* SIOCGIWESSID */ | |
32986 | + dummy, /* SIOCSIWNICKN */ | |
32987 | + dummy, /* SIOCGIWNICKN */ | |
32988 | + NULL, /* -- hole -- */ | |
32989 | + NULL, /* -- hole -- */ | |
32990 | + r8180_wx_set_rate, /* SIOCSIWRATE */ | |
32991 | + r8180_wx_get_rate, /* SIOCGIWRATE */ | |
32992 | + r8180_wx_set_rts, /* SIOCSIWRTS */ | |
32993 | + r8180_wx_get_rts, /* SIOCGIWRTS */ | |
32994 | + r8180_wx_set_frag, /* SIOCSIWFRAG */ | |
32995 | + r8180_wx_get_frag, /* SIOCGIWFRAG */ | |
32996 | + dummy, /* SIOCSIWTXPOW */ | |
32997 | + dummy, /* SIOCGIWTXPOW */ | |
32998 | + r8180_wx_set_retry, /* SIOCSIWRETRY */ | |
32999 | + r8180_wx_get_retry, /* SIOCGIWRETRY */ | |
33000 | + r8180_wx_set_enc, /* SIOCSIWENCODE */ | |
33001 | + r8180_wx_get_enc, /* SIOCGIWENCODE */ | |
33002 | + r8180_wx_set_power, /* SIOCSIWPOWER */ | |
33003 | + r8180_wx_get_power, /* SIOCGIWPOWER */ | |
33004 | + NULL, /*---hole---*/ | |
33005 | + NULL, /*---hole---*/ | |
33006 | + r8180_wx_set_gen_ie, /* SIOCSIWGENIE */ | |
33007 | + NULL, /* SIOCSIWGENIE */ | |
33008 | + r8180_wx_set_auth, /* SIOCSIWAUTH */ | |
33009 | + NULL, /* SIOCSIWAUTH */ | |
33010 | + r8180_wx_set_enc_ext, /* SIOCSIWENCODEEXT */ | |
33011 | + NULL, /* SIOCSIWENCODEEXT */ | |
33012 | + NULL, /* SIOCSIWPMKSA */ | |
33013 | + NULL, /*---hole---*/ | |
33014 | +}; | |
33015 | + | |
33016 | + | |
33017 | +static const struct iw_priv_args r8180_private_args[] = { | |
33018 | + { | |
33019 | + SIOCIWFIRSTPRIV + 0x0, | |
33020 | + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "badcrc" | |
33021 | + }, | |
33022 | + { SIOCIWFIRSTPRIV + 0x1, | |
33023 | + 0, 0, "dummy" | |
33024 | + | |
33025 | + }, | |
33026 | + { | |
33027 | + SIOCIWFIRSTPRIV + 0x2, | |
33028 | + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "beaconint" | |
33029 | + }, | |
33030 | + { SIOCIWFIRSTPRIV + 0x3, | |
33031 | + 0, 0, "dummy" | |
33032 | + | |
33033 | + }, | |
33034 | + /* added by christian */ | |
33035 | + //{ | |
33036 | + // SIOCIWFIRSTPRIV + 0x2, | |
33037 | + // IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "prismhdr" | |
33038 | + //}, | |
33039 | + /* end added by christian */ | |
33040 | + { | |
33041 | + SIOCIWFIRSTPRIV + 0x4, | |
33042 | + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "activescan" | |
33043 | + | |
33044 | + }, | |
33045 | + { SIOCIWFIRSTPRIV + 0x5, | |
33046 | + 0, 0, "dummy" | |
33047 | + | |
33048 | + }, | |
33049 | + { | |
33050 | + SIOCIWFIRSTPRIV + 0x6, | |
33051 | + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "rawtx" | |
33052 | + | |
33053 | + }, | |
33054 | + { SIOCIWFIRSTPRIV + 0x7, | |
33055 | + 0, 0, "dummy" | |
33056 | + | |
33057 | + }, | |
33058 | +// { | |
33059 | +// SIOCIWFIRSTPRIV + 0x5, | |
33060 | +// 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "getpsmode" | |
33061 | +// }, | |
33062 | +// { | |
33063 | +// SIOCIWFIRSTPRIV + 0x6, | |
33064 | +// IW_PRIV_SIZE_FIXED, 0, "setpsmode" | |
33065 | +// }, | |
33066 | +//set/get mode have been realized in public handlers | |
33067 | + | |
33068 | + { | |
33069 | + SIOCIWFIRSTPRIV + 0x8, | |
33070 | + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "setiwmode" | |
33071 | + }, | |
33072 | + { | |
33073 | + SIOCIWFIRSTPRIV + 0x9, | |
33074 | + 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 32, "getiwmode" | |
33075 | + }, | |
33076 | + { | |
33077 | + SIOCIWFIRSTPRIV + 0xA, | |
33078 | + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "setpreamble" | |
33079 | + }, | |
33080 | + { | |
33081 | + SIOCIWFIRSTPRIV + 0xB, | |
33082 | + 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "getpreamble" | |
33083 | + }, | |
33084 | + { SIOCIWFIRSTPRIV + 0xC, | |
33085 | + 0, 0, "dummy" | |
33086 | + }, | |
33087 | + { | |
33088 | + SIOCIWFIRSTPRIV + 0xD, | |
33089 | + 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "getrssi" | |
33090 | + }, | |
33091 | + { SIOCIWFIRSTPRIV + 0xE, | |
33092 | + 0, 0, "dummy" | |
33093 | + }, | |
33094 | + { | |
33095 | + SIOCIWFIRSTPRIV + 0xF, | |
33096 | + 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "getlinkqual" | |
33097 | + }, | |
33098 | + { | |
33099 | + SIOCIWFIRSTPRIV + 0x10, | |
33100 | + 0, 0, "resetstats" | |
33101 | + }, | |
33102 | + { | |
33103 | + SIOCIWFIRSTPRIV + 0x11, | |
33104 | + 0,0, "dummy" | |
33105 | + }, | |
33106 | + { | |
33107 | + SIOCIWFIRSTPRIV + 0x12, | |
33108 | + 0, 0, "radioon" | |
33109 | + }, | |
33110 | + { | |
33111 | + SIOCIWFIRSTPRIV + 0x13, | |
33112 | + 0, 0, "radiooff" | |
33113 | + }, | |
33114 | + { | |
33115 | + SIOCIWFIRSTPRIV + 0x14, | |
33116 | + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "setchannel" | |
33117 | + }, | |
33118 | + { | |
33119 | + SIOCIWFIRSTPRIV + 0x15, | |
33120 | + 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, "getchannel" | |
33121 | + }, | |
33122 | + { | |
33123 | + SIOCIWFIRSTPRIV + 0x16, | |
33124 | + 0,0, "dummy" | |
33125 | + }, | |
33126 | + { | |
33127 | + SIOCIWFIRSTPRIV + 0x17, | |
33128 | + 0,IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 32, "getversion" | |
33129 | + }, | |
33130 | + { | |
33131 | + SIOCIWFIRSTPRIV + 0x18, | |
33132 | + IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "setrate" | |
33133 | + }, | |
33134 | +}; | |
33135 | + | |
33136 | + | |
33137 | +static iw_handler r8180_private_handler[] = { | |
33138 | + r8180_wx_set_crcmon, /*SIOCIWSECONDPRIV*/ | |
33139 | + dummy, | |
33140 | + r8180_wx_set_beaconinterval, | |
33141 | + dummy, | |
33142 | + //r8180_wx_set_monitor_type, | |
33143 | + r8180_wx_set_scan_type, | |
33144 | + dummy, | |
33145 | + r8180_wx_set_rawtx, | |
33146 | + dummy, | |
33147 | + r8180_wx_set_iwmode, | |
33148 | + r8180_wx_get_iwmode, | |
33149 | + r8180_wx_set_preamble, | |
33150 | + r8180_wx_get_preamble, | |
33151 | + dummy, | |
33152 | + r8180_wx_get_siglevel, | |
33153 | + dummy, | |
33154 | + r8180_wx_get_sigqual, | |
33155 | + r8180_wx_reset_stats, | |
33156 | + dummy,//r8180_wx_get_stats | |
33157 | + r8180_wx_radio_on, | |
33158 | + r8180_wx_radio_off, | |
33159 | + r8180_wx_set_channelplan, | |
33160 | + r8180_wx_get_channelplan, | |
33161 | + dummy, | |
33162 | + r8180_wx_get_version, | |
33163 | + r8180_wx_set_forcerate, | |
33164 | +}; | |
33165 | + | |
33166 | +#if WIRELESS_EXT >= 17 | |
33167 | +static inline int is_same_network(struct ieee80211_network *src, | |
33168 | + struct ieee80211_network *dst, | |
33169 | + struct ieee80211_device *ieee) | |
33170 | +{ | |
33171 | + /* A network is only a duplicate if the channel, BSSID, ESSID | |
33172 | + * and the capability field (in particular IBSS and BSS) all match. | |
33173 | + * We treat all <hidden> with the same BSSID and channel | |
33174 | + * as one network */ | |
33175 | + return (((src->ssid_len == dst->ssid_len)||(ieee->iw_mode == IW_MODE_INFRA)) && //YJ,mod, 080819,for hidden ap | |
33176 | + //((src->ssid_len == dst->ssid_len) && | |
33177 | + (src->channel == dst->channel) && | |
33178 | + !memcmp(src->bssid, dst->bssid, ETH_ALEN) && | |
33179 | + (!memcmp(src->ssid, dst->ssid, src->ssid_len)||(ieee->iw_mode == IW_MODE_INFRA)) && //YJ,mod, 080819,for hidden ap | |
33180 | + //!memcmp(src->ssid, dst->ssid, src->ssid_len) && | |
33181 | + ((src->capability & WLAN_CAPABILITY_IBSS) == | |
33182 | + (dst->capability & WLAN_CAPABILITY_IBSS)) && | |
33183 | + ((src->capability & WLAN_CAPABILITY_BSS) == | |
33184 | + (dst->capability & WLAN_CAPABILITY_BSS))); | |
33185 | +} | |
33186 | + | |
33187 | +//WB modefied to show signal to GUI on 18-01-2008 | |
33188 | +static struct iw_statistics *r8180_get_wireless_stats(struct net_device *dev) | |
33189 | +{ | |
33190 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
33191 | + struct ieee80211_device* ieee = priv->ieee80211; | |
33192 | + struct iw_statistics* wstats = &priv->wstats; | |
33193 | + //struct ieee80211_network* target = NULL; | |
33194 | + int tmp_level = 0; | |
33195 | + int tmp_qual = 0; | |
33196 | + int tmp_noise = 0; | |
33197 | + //unsigned long flag; | |
33198 | + | |
33199 | + if (ieee->state < IEEE80211_LINKED) | |
33200 | + { | |
33201 | + wstats->qual.qual = 0; | |
33202 | + wstats->qual.level = 0; | |
33203 | + wstats->qual.noise = 0; | |
33204 | + wstats->qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM; | |
33205 | + return wstats; | |
33206 | + } | |
33207 | +#if 0 | |
33208 | + spin_lock_irqsave(&ieee->lock, flag); | |
33209 | + list_for_each_entry(target, &ieee->network_list, list) | |
33210 | + { | |
33211 | + if (is_same_network(target, &ieee->current_network, ieee)) | |
33212 | + { | |
33213 | + printk("it's same network:%s\n", target->ssid); | |
33214 | +#if 0 | |
33215 | + if (!tmp_level) | |
33216 | + { | |
33217 | + tmp_level = target->stats.signalstrength; | |
33218 | + tmp_qual = target->stats.signal; | |
33219 | + } | |
33220 | + else | |
33221 | + { | |
33222 | + | |
33223 | + tmp_level = (15*tmp_level + target->stats.signalstrength)/16; | |
33224 | + tmp_qual = (15*tmp_qual + target->stats.signal)/16; | |
33225 | + } | |
33226 | +#else | |
33227 | + tmp_level = target->stats.signal; | |
33228 | + tmp_qual = target->stats.signalstrength; | |
33229 | + tmp_noise = target->stats.noise; | |
33230 | + printk("level:%d, qual:%d, noise:%d\n", tmp_level, tmp_qual, tmp_noise); | |
33231 | +#endif | |
33232 | + break; | |
33233 | + } | |
33234 | + } | |
33235 | + spin_unlock_irqrestore(&ieee->lock, flag); | |
33236 | +#endif | |
33237 | + tmp_level = (&ieee->current_network)->stats.signal; | |
33238 | + tmp_qual = (&ieee->current_network)->stats.signalstrength; | |
33239 | + tmp_noise = (&ieee->current_network)->stats.noise; | |
33240 | + //printk("level:%d, qual:%d, noise:%d\n", tmp_level, tmp_qual, tmp_noise); | |
33241 | + | |
33242 | +// printk("level:%d\n", tmp_level); | |
33243 | + wstats->qual.level = tmp_level; | |
33244 | + wstats->qual.qual = tmp_qual; | |
33245 | + wstats->qual.noise = tmp_noise; | |
33246 | + wstats->qual.updated = IW_QUAL_ALL_UPDATED| IW_QUAL_DBM; | |
33247 | + return wstats; | |
33248 | +} | |
33249 | +#endif | |
33250 | + | |
33251 | + | |
33252 | +struct iw_handler_def r8180_wx_handlers_def={ | |
33253 | + .standard = r8180_wx_handlers, | |
33254 | + .num_standard = sizeof(r8180_wx_handlers) / sizeof(iw_handler), | |
33255 | + .private = r8180_private_handler, | |
33256 | + .num_private = sizeof(r8180_private_handler) / sizeof(iw_handler), | |
33257 | + .num_private_args = sizeof(r8180_private_args) / sizeof(struct iw_priv_args), | |
33258 | +#if WIRELESS_EXT >= 17 | |
33259 | + .get_wireless_stats = r8180_get_wireless_stats, | |
33260 | +#endif | |
33261 | + .private_args = (struct iw_priv_args *)r8180_private_args, | |
33262 | +}; | |
33263 | + | |
33264 | + | |
33265 | --- /dev/null | |
33266 | +++ b/drivers/staging/rtl8187se/r8180_wx.h | |
33267 | @@ -0,0 +1,21 @@ | |
33268 | +/* | |
33269 | + This is part of rtl8180 OpenSource driver - v 0.3 | |
33270 | + Copyright (C) Andrea Merello 2004 <andreamrl@tiscali.it> | |
33271 | + Released under the terms of GPL (General Public Licence) | |
33272 | + | |
33273 | + Parts of this driver are based on the GPL part of the official realtek driver | |
33274 | + Parts of this driver are based on the rtl8180 driver skeleton from Patric Schenke & Andres Salomon | |
33275 | + Parts of this driver are based on the Intel Pro Wireless 2100 GPL driver | |
33276 | + | |
33277 | + We want to tanks the Authors of such projects and the Ndiswrapper project Authors. | |
33278 | +*/ | |
33279 | + | |
33280 | +/* this file (will) contains wireless extension handlers*/ | |
33281 | + | |
33282 | +#ifndef R8180_WX_H | |
33283 | +#define R8180_WX_H | |
33284 | +#include <linux/wireless.h> | |
33285 | +#include "ieee80211.h" | |
33286 | +extern struct iw_handler_def r8180_wx_handlers_def; | |
33287 | + | |
33288 | +#endif | |
33289 | --- /dev/null | |
33290 | +++ b/drivers/staging/rtl8187se/r8185b_init.c | |
33291 | @@ -0,0 +1,3342 @@ | |
33292 | +/*++ | |
33293 | +Copyright (c) Realtek Semiconductor Corp. All rights reserved. | |
33294 | + | |
33295 | +Module Name: | |
33296 | + r8185b_init.c | |
33297 | + | |
33298 | +Abstract: | |
33299 | + Hardware Initialization and Hardware IO for RTL8185B | |
33300 | + | |
33301 | +Major Change History: | |
33302 | + When Who What | |
33303 | + ---------- --------------- ------------------------------- | |
33304 | + 2006-11-15 Xiong Created | |
33305 | + | |
33306 | +Notes: | |
33307 | + This file is ported from RTL8185B Windows driver. | |
33308 | + | |
33309 | + | |
33310 | +--*/ | |
33311 | + | |
33312 | +/*--------------------------Include File------------------------------------*/ | |
33313 | +#include <linux/spinlock.h> | |
33314 | +#include "r8180_hw.h" | |
33315 | +#include "r8180.h" | |
33316 | +#include "r8180_sa2400.h" /* PHILIPS Radio frontend */ | |
33317 | +#include "r8180_max2820.h" /* MAXIM Radio frontend */ | |
33318 | +#include "r8180_gct.h" /* GCT Radio frontend */ | |
33319 | +#include "r8180_rtl8225.h" /* RTL8225 Radio frontend */ | |
33320 | +#include "r8180_rtl8255.h" /* RTL8255 Radio frontend */ | |
33321 | +#include "r8180_93cx6.h" /* Card EEPROM */ | |
33322 | +#include "r8180_wx.h" | |
33323 | + | |
33324 | +#ifdef CONFIG_RTL8180_PM | |
33325 | +#include "r8180_pm.h" | |
33326 | +#endif | |
33327 | + | |
33328 | +#ifdef ENABLE_DOT11D | |
33329 | +#include "dot11d.h" | |
33330 | +#endif | |
33331 | + | |
33332 | +#ifdef CONFIG_RTL8185B | |
33333 | + | |
33334 | +//#define CONFIG_RTL8180_IO_MAP | |
33335 | + | |
33336 | +#define TC_3W_POLL_MAX_TRY_CNT 5 | |
33337 | +#ifdef CONFIG_RTL818X_S | |
33338 | +static u8 MAC_REG_TABLE[][2]={ | |
33339 | + //PAGA 0: | |
33340 | + // 0x34(BRSR), 0xBE(RATE_FALLBACK_CTL), 0x1E0(ARFR) would set in HwConfigureRTL8185() | |
33341 | + // 0x272(RFSW_CTRL), 0x1CE(AESMSK_QC) set in InitializeAdapter8185(). | |
33342 | + // 0x1F0~0x1F8 set in MacConfig_85BASIC() | |
33343 | + {0x08, 0xae}, {0x0a, 0x72}, {0x5b, 0x42}, | |
33344 | + {0x84, 0x88}, {0x85, 0x24}, {0x88, 0x54}, {0x8b, 0xb8}, {0x8c, 0x03}, | |
33345 | + {0x8d, 0x40}, {0x8e, 0x00}, {0x8f, 0x00}, {0x5b, 0x18}, {0x91, 0x03}, | |
33346 | + {0x94, 0x0F}, {0x95, 0x32}, | |
33347 | + {0x96, 0x00}, {0x97, 0x07}, {0xb4, 0x22}, {0xdb, 0x00}, | |
33348 | + {0xf0, 0x32}, {0xf1, 0x32}, {0xf2, 0x00}, {0xf3, 0x00}, {0xf4, 0x32}, | |
33349 | + {0xf5, 0x43}, {0xf6, 0x00}, {0xf7, 0x00}, {0xf8, 0x46}, {0xf9, 0xa4}, | |
33350 | + {0xfa, 0x00}, {0xfb, 0x00}, {0xfc, 0x96}, {0xfd, 0xa4}, {0xfe, 0x00}, | |
33351 | + {0xff, 0x00}, | |
33352 | + | |
33353 | + //PAGE 1: | |
33354 | + // For Flextronics system Logo PCIHCT failure: | |
33355 | + // 0x1C4~0x1CD set no-zero value to avoid PCI configuration space 0x45[7]=1 | |
33356 | + {0x5e, 0x01}, | |
33357 | + {0x58, 0x00}, {0x59, 0x00}, {0x5a, 0x04}, {0x5b, 0x00}, {0x60, 0x24}, | |
33358 | + {0x61, 0x97}, {0x62, 0xF0}, {0x63, 0x09}, {0x80, 0x0F}, {0x81, 0xFF}, | |
33359 | + {0x82, 0xFF}, {0x83, 0x03}, | |
33360 | + {0xC4, 0x22}, {0xC5, 0x22}, {0xC6, 0x22}, {0xC7, 0x22}, {0xC8, 0x22}, //lzm add 080826 | |
33361 | + {0xC9, 0x22}, {0xCA, 0x22}, {0xCB, 0x22}, {0xCC, 0x22}, {0xCD, 0x22},//lzm add 080826 | |
33362 | + {0xe2, 0x00}, | |
33363 | + | |
33364 | + | |
33365 | + //PAGE 2: | |
33366 | + {0x5e, 0x02}, | |
33367 | + {0x0c, 0x04}, {0x4c, 0x30}, {0x4d, 0x08}, {0x50, 0x05}, {0x51, 0xf5}, | |
33368 | + {0x52, 0x04}, {0x53, 0xa0}, {0x54, 0xff}, {0x55, 0xff}, {0x56, 0xff}, | |
33369 | + {0x57, 0xff}, {0x58, 0x08}, {0x59, 0x08}, {0x5a, 0x08}, {0x5b, 0x08}, | |
33370 | + {0x60, 0x08}, {0x61, 0x08}, {0x62, 0x08}, {0x63, 0x08}, {0x64, 0x2f}, | |
33371 | + {0x8c, 0x3f}, {0x8d, 0x3f}, {0x8e, 0x3f}, | |
33372 | + {0x8f, 0x3f}, {0xc4, 0xff}, {0xc5, 0xff}, {0xc6, 0xff}, {0xc7, 0xff}, | |
33373 | + {0xc8, 0x00}, {0xc9, 0x00}, {0xca, 0x80}, {0xcb, 0x00}, | |
33374 | + | |
33375 | + //PAGA 0: | |
33376 | + {0x5e, 0x00},{0x9f, 0x03} | |
33377 | + }; | |
33378 | + | |
33379 | + | |
33380 | +static u8 ZEBRA_AGC[]={ | |
33381 | + 0, | |
33382 | + 0x7E,0x7E,0x7E,0x7E,0x7D,0x7C,0x7B,0x7A,0x79,0x78,0x77,0x76,0x75,0x74,0x73,0x72, | |
33383 | + 0x71,0x70,0x6F,0x6E,0x6D,0x6C,0x6B,0x6A,0x69,0x68,0x67,0x66,0x65,0x64,0x63,0x62, | |
33384 | + 0x48,0x47,0x46,0x45,0x44,0x29,0x28,0x27,0x26,0x25,0x24,0x23,0x22,0x21,0x08,0x07, | |
33385 | + 0x06,0x05,0x04,0x03,0x02,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00, | |
33386 | + 0x0f,0x0f,0x0f,0x0f,0x0f,0x0f,0x0f,0x0f,0x0f,0x0f,0x10,0x11,0x12,0x13,0x15,0x16, | |
33387 | + 0x17,0x17,0x18,0x18,0x19,0x1a,0x1a,0x1b,0x1b,0x1c,0x1c,0x1d,0x1d,0x1d,0x1e,0x1e, | |
33388 | + 0x1f,0x1f,0x1f,0x20,0x20,0x20,0x20,0x21,0x21,0x21,0x22,0x22,0x22,0x23,0x23,0x24, | |
33389 | + 0x24,0x25,0x25,0x25,0x26,0x26,0x27,0x27,0x2F,0x2F,0x2F,0x2F,0x2F,0x2F,0x2F,0x2F | |
33390 | + }; | |
33391 | + | |
33392 | +static u32 ZEBRA_RF_RX_GAIN_TABLE[]={ | |
33393 | + 0x0096,0x0076,0x0056,0x0036,0x0016,0x01f6,0x01d6,0x01b6, | |
33394 | + 0x0196,0x0176,0x00F7,0x00D7,0x00B7,0x0097,0x0077,0x0057, | |
33395 | + 0x0037,0x00FB,0x00DB,0x00BB,0x00FF,0x00E3,0x00C3,0x00A3, | |
33396 | + 0x0083,0x0063,0x0043,0x0023,0x0003,0x01E3,0x01C3,0x01A3, | |
33397 | + 0x0183,0x0163,0x0143,0x0123,0x0103 | |
33398 | + }; | |
33399 | + | |
33400 | +static u8 OFDM_CONFIG[]={ | |
33401 | + // OFDM reg0x06[7:0]=0xFF: Enable power saving mode in RX | |
33402 | + // OFDM reg0x3C[4]=1'b1: Enable RX power saving mode | |
33403 | + // ofdm 0x3a = 0x7b ,(original : 0xfb) For ECS shielding room TP test | |
33404 | + | |
33405 | + // 0x00 | |
33406 | + 0x10, 0x0F, 0x0A, 0x0C, 0x14, 0xFA, 0xFF, 0x50, | |
33407 | + 0x00, 0x50, 0x00, 0x00, 0x00, 0x5C, 0x00, 0x00, | |
33408 | + // 0x10 | |
33409 | + 0x40, 0x00, 0x40, 0x00, 0x00, 0x00, 0xA8, 0x26, | |
33410 | + 0x32, 0x33, 0x06, 0xA5, 0x6F, 0x55, 0xC8, 0xBB, | |
33411 | + // 0x20 | |
33412 | + 0x0A, 0xE1, 0x2C, 0x4A, 0x86, 0x83, 0x34, 0x00, | |
33413 | + 0x4F, 0x24, 0x6F, 0xC2, 0x03, 0x40, 0x80, 0x00, | |
33414 | + // 0x30 | |
33415 | + 0xC0, 0xC1, 0x58, 0xF1, 0x00, 0xC4, 0x90, 0x3e, | |
33416 | + 0xD8, 0x3C, 0x7B, 0x10, 0x10 | |
33417 | + }; | |
33418 | +#else | |
33419 | + static u8 MAC_REG_TABLE[][2]={ | |
33420 | + //PAGA 0: | |
33421 | + {0xf0, 0x32}, {0xf1, 0x32}, {0xf2, 0x00}, {0xf3, 0x00}, {0xf4, 0x32}, | |
33422 | + {0xf5, 0x43}, {0xf6, 0x00}, {0xf7, 0x00}, {0xf8, 0x46}, {0xf9, 0xa4}, | |
33423 | + {0xfa, 0x00}, {0xfb, 0x00}, {0xfc, 0x96}, {0xfd, 0xa4}, {0xfe, 0x00}, | |
33424 | + {0xff, 0x00}, | |
33425 | + | |
33426 | + //PAGE 1: | |
33427 | + {0x5e, 0x01}, | |
33428 | + {0x58, 0x4b}, {0x59, 0x00}, {0x5a, 0x4b}, {0x5b, 0x00}, {0x60, 0x4b}, | |
33429 | + {0x61, 0x09}, {0x62, 0x4b}, {0x63, 0x09}, {0xce, 0x0f}, {0xcf, 0x00}, | |
33430 | + {0xe0, 0xff}, {0xe1, 0x0f}, {0xe2, 0x00}, {0xf0, 0x4e}, {0xf1, 0x01}, | |
33431 | + {0xf2, 0x02}, {0xf3, 0x03}, {0xf4, 0x04}, {0xf5, 0x05}, {0xf6, 0x06}, | |
33432 | + {0xf7, 0x07}, {0xf8, 0x08}, | |
33433 | + | |
33434 | + | |
33435 | + //PAGE 2: | |
33436 | + {0x5e, 0x02}, | |
33437 | + {0x0c, 0x04}, {0x21, 0x61}, {0x22, 0x68}, {0x23, 0x6f}, {0x24, 0x76}, | |
33438 | + {0x25, 0x7d}, {0x26, 0x84}, {0x27, 0x8d}, {0x4d, 0x08}, {0x4e, 0x00}, | |
33439 | + {0x50, 0x05}, {0x51, 0xf5}, {0x52, 0x04}, {0x53, 0xa0}, {0x54, 0x1f}, | |
33440 | + {0x55, 0x23}, {0x56, 0x45}, {0x57, 0x67}, {0x58, 0x08}, {0x59, 0x08}, | |
33441 | + {0x5a, 0x08}, {0x5b, 0x08}, {0x60, 0x08}, {0x61, 0x08}, {0x62, 0x08}, | |
33442 | + {0x63, 0x08}, {0x64, 0xcf}, {0x72, 0x56}, {0x73, 0x9a}, | |
33443 | + | |
33444 | + //PAGA 0: | |
33445 | + {0x5e, 0x00}, | |
33446 | + {0x34, 0xff}, {0x35, 0x0f}, {0x5b, 0x40}, {0x84, 0x88}, {0x85, 0x24}, | |
33447 | + {0x88, 0x54}, {0x8b, 0xb8}, {0x8c, 0x07}, {0x8d, 0x00}, {0x94, 0x1b}, | |
33448 | + {0x95, 0x12}, {0x96, 0x00}, {0x97, 0x06}, {0x9d, 0x1a}, {0x9f, 0x10}, | |
33449 | + {0xb4, 0x22}, {0xbe, 0x80}, {0xdb, 0x00}, {0xee, 0x00}, {0x5b, 0x42}, | |
33450 | + {0x91, 0x03}, | |
33451 | + | |
33452 | + //PAGE 2: | |
33453 | + {0x5e, 0x02}, | |
33454 | + {0x4c, 0x03}, | |
33455 | + | |
33456 | + //PAGE 0: | |
33457 | + {0x5e, 0x00}, | |
33458 | + | |
33459 | + //PAGE 3: | |
33460 | + {0x5e, 0x03}, | |
33461 | + {0x9f, 0x00}, | |
33462 | + | |
33463 | + //PAGE 0: | |
33464 | + {0x5e, 0x00}, | |
33465 | + {0x8c, 0x01}, {0x8d, 0x10},{0x8e, 0x08}, {0x8f, 0x00} | |
33466 | + }; | |
33467 | + | |
33468 | + | |
33469 | +static u8 ZEBRA_AGC[]={ | |
33470 | + 0, | |
33471 | + 0x5e,0x5e,0x5e,0x5e,0x5d,0x5b,0x59,0x57,0x55,0x53,0x51,0x4f,0x4d,0x4b,0x49,0x47, | |
33472 | + 0x45,0x43,0x41,0x3f,0x3d,0x3b,0x39,0x37,0x35,0x33,0x31,0x2f,0x2d,0x2b,0x29,0x27, | |
33473 | + 0x25,0x23,0x21,0x1f,0x1d,0x1b,0x19,0x17,0x15,0x13,0x11,0x0f,0x0d,0x0b,0x09,0x07, | |
33474 | + 0x05,0x03,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01,0x01, | |
33475 | + 0x19,0x19,0x19,0x019,0x19,0x19,0x19,0x19,0x19,0x19,0x1e,0x1f,0x20,0x21,0x21,0x22, | |
33476 | + 0x23,0x24,0x24,0x25,0x25,0x26,0x26,0x27,0x27,0x28,0x28,0x28,0x29,0x2a,0x2a,0x2b, | |
33477 | + 0x2b,0x2b,0x2c,0x2c,0x2c,0x2d,0x2d,0x2d,0x2e,0x2e,0x2f,0x30,0x31,0x31,0x31,0x31, | |
33478 | + 0x31,0x31,0x31,0x31,0x31,0x31,0x31,0x31,0x31,0x31,0x31,0x31,0x31,0x31,0x31,0x31 | |
33479 | + }; | |
33480 | + | |
33481 | +static u32 ZEBRA_RF_RX_GAIN_TABLE[]={ | |
33482 | + 0, | |
33483 | + 0x0400,0x0401,0x0402,0x0403,0x0404,0x0405,0x0408,0x0409, | |
33484 | + 0x040a,0x040b,0x0502,0x0503,0x0504,0x0505,0x0540,0x0541, | |
33485 | + 0x0542,0x0543,0x0544,0x0545,0x0580,0x0581,0x0582,0x0583, | |
33486 | + 0x0584,0x0585,0x0588,0x0589,0x058a,0x058b,0x0643,0x0644, | |
33487 | + 0x0645,0x0680,0x0681,0x0682,0x0683,0x0684,0x0685,0x0688, | |
33488 | + 0x0689,0x068a,0x068b,0x068c,0x0742,0x0743,0x0744,0x0745, | |
33489 | + 0x0780,0x0781,0x0782,0x0783,0x0784,0x0785,0x0788,0x0789, | |
33490 | + 0x078a,0x078b,0x078c,0x078d,0x0790,0x0791,0x0792,0x0793, | |
33491 | + 0x0794,0x0795,0x0798,0x0799,0x079a,0x079b,0x079c,0x079d, | |
33492 | + 0x07a0,0x07a1,0x07a2,0x07a3,0x07a4,0x07a5,0x07a8,0x07a9, | |
33493 | + 0x03aa,0x03ab,0x03ac,0x03ad,0x03b0,0x03b1,0x03b2,0x03b3, | |
33494 | + 0x03b4,0x03b5,0x03b8,0x03b9,0x03ba,0x03bb,0x03bb | |
33495 | +}; | |
33496 | + | |
33497 | +// 2006.07.13, SD3 szuyitasi: | |
33498 | +// OFDM.0x03=0x0C (original is 0x0F) | |
33499 | +// Use the new SD3 given param, by shien chang, 2006.07.14 | |
33500 | +static u8 OFDM_CONFIG[]={ | |
33501 | + 0x10, 0x0d, 0x01, 0x0C, 0x14, 0xfb, 0x0f, 0x60, 0x00, 0x60, | |
33502 | + 0x00, 0x00, 0x00, 0x5c, 0x00, 0x00, 0x40, 0x00, 0x40, 0x00, | |
33503 | + 0x00, 0x00, 0xa8, 0x46, 0xb2, 0x33, 0x07, 0xa5, 0x6f, 0x55, | |
33504 | + 0xc8, 0xb3, 0x0a, 0xe1, 0x1c, 0x8a, 0xb6, 0x83, 0x34, 0x0f, | |
33505 | + 0x4f, 0x23, 0x6f, 0xc2, 0x6b, 0x40, 0x80, 0x00, 0xc0, 0xc1, | |
33506 | + 0x58, 0xf1, 0x00, 0xe4, 0x90, 0x3e, 0x6d, 0x3c, 0xff, 0x07 | |
33507 | +}; | |
33508 | +#endif | |
33509 | + | |
33510 | +/*--------------------------------------------------------------- | |
33511 | + * Hardware IO | |
33512 | + * the code is ported from Windows source code | |
33513 | + ----------------------------------------------------------------*/ | |
33514 | + | |
33515 | +void | |
33516 | +PlatformIOWrite1Byte( | |
33517 | + struct net_device *dev, | |
33518 | + u32 offset, | |
33519 | + u8 data | |
33520 | + ) | |
33521 | +{ | |
33522 | +#ifndef CONFIG_RTL8180_IO_MAP | |
33523 | + write_nic_byte(dev, offset, data); | |
33524 | + read_nic_byte(dev, offset); // To make sure write operation is completed, 2005.11.09, by rcnjko. | |
33525 | + | |
33526 | +#else // Port IO | |
33527 | + u32 Page = (offset >> 8); | |
33528 | + | |
33529 | + switch(Page) | |
33530 | + { | |
33531 | + case 0: // Page 0 | |
33532 | + write_nic_byte(dev, offset, data); | |
33533 | + break; | |
33534 | + | |
33535 | + case 1: // Page 1 | |
33536 | + case 2: // Page 2 | |
33537 | + case 3: // Page 3 | |
33538 | + { | |
33539 | + u8 psr = read_nic_byte(dev, PSR); | |
33540 | + | |
33541 | + write_nic_byte(dev, PSR, ((psr & 0xfc) | (u8)Page)); // Switch to page N. | |
33542 | + write_nic_byte(dev, (offset & 0xff), data); | |
33543 | + write_nic_byte(dev, PSR, (psr & 0xfc)); // Switch to page 0. | |
33544 | + } | |
33545 | + break; | |
33546 | + | |
33547 | + default: | |
33548 | + // Illegal page number. | |
33549 | + DMESGE("PlatformIOWrite1Byte(): illegal page number: %d, offset: %#X", Page, offset); | |
33550 | + break; | |
33551 | + } | |
33552 | +#endif | |
33553 | +} | |
33554 | + | |
33555 | +void | |
33556 | +PlatformIOWrite2Byte( | |
33557 | + struct net_device *dev, | |
33558 | + u32 offset, | |
33559 | + u16 data | |
33560 | + ) | |
33561 | +{ | |
33562 | +#ifndef CONFIG_RTL8180_IO_MAP | |
33563 | + write_nic_word(dev, offset, data); | |
33564 | + read_nic_word(dev, offset); // To make sure write operation is completed, 2005.11.09, by rcnjko. | |
33565 | + | |
33566 | + | |
33567 | +#else // Port IO | |
33568 | + u32 Page = (offset >> 8); | |
33569 | + | |
33570 | + switch(Page) | |
33571 | + { | |
33572 | + case 0: // Page 0 | |
33573 | + write_nic_word(dev, offset, data); | |
33574 | + break; | |
33575 | + | |
33576 | + case 1: // Page 1 | |
33577 | + case 2: // Page 2 | |
33578 | + case 3: // Page 3 | |
33579 | + { | |
33580 | + u8 psr = read_nic_byte(dev, PSR); | |
33581 | + | |
33582 | + write_nic_byte(dev, PSR, ((psr & 0xfc) | (u8)Page)); // Switch to page N. | |
33583 | + write_nic_word(dev, (offset & 0xff), data); | |
33584 | + write_nic_byte(dev, PSR, (psr & 0xfc)); // Switch to page 0. | |
33585 | + } | |
33586 | + break; | |
33587 | + | |
33588 | + default: | |
33589 | + // Illegal page number. | |
33590 | + DMESGE("PlatformIOWrite2Byte(): illegal page number: %d, offset: %#X", Page, offset); | |
33591 | + break; | |
33592 | + } | |
33593 | +#endif | |
33594 | +} | |
33595 | +u8 PlatformIORead1Byte(struct net_device *dev, u32 offset); | |
33596 | + | |
33597 | +void | |
33598 | +PlatformIOWrite4Byte( | |
33599 | + struct net_device *dev, | |
33600 | + u32 offset, | |
33601 | + u32 data | |
33602 | + ) | |
33603 | +{ | |
33604 | +#ifndef CONFIG_RTL8180_IO_MAP | |
33605 | +//{by amy 080312 | |
33606 | +if (offset == PhyAddr) | |
33607 | + {//For Base Band configuration. | |
33608 | + unsigned char cmdByte; | |
33609 | + unsigned long dataBytes; | |
33610 | + unsigned char idx; | |
33611 | + u8 u1bTmp; | |
33612 | + | |
33613 | + cmdByte = (u8)(data & 0x000000ff); | |
33614 | + dataBytes = data>>8; | |
33615 | + | |
33616 | + // | |
33617 | + // 071010, rcnjko: | |
33618 | + // The critical section is only BB read/write race condition. | |
33619 | + // Assumption: | |
33620 | + // 1. We assume NO one will access BB at DIRQL, otherwise, system will crash for | |
33621 | + // acquiring the spinlock in such context. | |
33622 | + // 2. PlatformIOWrite4Byte() MUST NOT be recursive. | |
33623 | + // | |
33624 | +// NdisAcquireSpinLock( &(pDevice->IoSpinLock) ); | |
33625 | + | |
33626 | + for(idx = 0; idx < 30; idx++) | |
33627 | + { // Make sure command bit is clear before access it. | |
33628 | + u1bTmp = PlatformIORead1Byte(dev, PhyAddr); | |
33629 | + if((u1bTmp & BIT7) == 0) | |
33630 | + break; | |
33631 | + else | |
33632 | + mdelay(10); | |
33633 | + } | |
33634 | + | |
33635 | + for(idx=0; idx < 3; idx++) | |
33636 | + { | |
33637 | + PlatformIOWrite1Byte(dev,offset+1+idx,((u8*)&dataBytes)[idx] ); | |
33638 | + } | |
33639 | + write_nic_byte(dev, offset, cmdByte); | |
33640 | + | |
33641 | +// NdisReleaseSpinLock( &(pDevice->IoSpinLock) ); | |
33642 | + } | |
33643 | +//by amy 080312} | |
33644 | + else{ | |
33645 | + write_nic_dword(dev, offset, data); | |
33646 | + read_nic_dword(dev, offset); // To make sure write operation is completed, 2005.11.09, by rcnjko. | |
33647 | + } | |
33648 | +#else // Port IO | |
33649 | + u32 Page = (offset >> 8); | |
33650 | + | |
33651 | + switch(Page) | |
33652 | + { | |
33653 | + case 0: // Page 0 | |
33654 | + write_nic_word(dev, offset, data); | |
33655 | + break; | |
33656 | + | |
33657 | + case 1: // Page 1 | |
33658 | + case 2: // Page 2 | |
33659 | + case 3: // Page 3 | |
33660 | + { | |
33661 | + u8 psr = read_nic_byte(dev, PSR); | |
33662 | + | |
33663 | + write_nic_byte(dev, PSR, ((psr & 0xfc) | (u8)Page)); // Switch to page N. | |
33664 | + write_nic_dword(dev, (offset & 0xff), data); | |
33665 | + write_nic_byte(dev, PSR, (psr & 0xfc)); // Switch to page 0. | |
33666 | + } | |
33667 | + break; | |
33668 | + | |
33669 | + default: | |
33670 | + // Illegal page number. | |
33671 | + DMESGE("PlatformIOWrite4Byte(): illegal page number: %d, offset: %#X", Page, offset); | |
33672 | + break; | |
33673 | + } | |
33674 | +#endif | |
33675 | +} | |
33676 | + | |
33677 | +u8 | |
33678 | +PlatformIORead1Byte( | |
33679 | + struct net_device *dev, | |
33680 | + u32 offset | |
33681 | + ) | |
33682 | +{ | |
33683 | + u8 data = 0; | |
33684 | + | |
33685 | +#ifndef CONFIG_RTL8180_IO_MAP | |
33686 | + data = read_nic_byte(dev, offset); | |
33687 | + | |
33688 | +#else // Port IO | |
33689 | + u32 Page = (offset >> 8); | |
33690 | + | |
33691 | + switch(Page) | |
33692 | + { | |
33693 | + case 0: // Page 0 | |
33694 | + data = read_nic_byte(dev, offset); | |
33695 | + break; | |
33696 | + | |
33697 | + case 1: // Page 1 | |
33698 | + case 2: // Page 2 | |
33699 | + case 3: // Page 3 | |
33700 | + { | |
33701 | + u8 psr = read_nic_byte(dev, PSR); | |
33702 | + | |
33703 | + write_nic_byte(dev, PSR, ((psr & 0xfc) | (u8)Page)); // Switch to page N. | |
33704 | + data = read_nic_byte(dev, (offset & 0xff)); | |
33705 | + write_nic_byte(dev, PSR, (psr & 0xfc)); // Switch to page 0. | |
33706 | + } | |
33707 | + break; | |
33708 | + | |
33709 | + default: | |
33710 | + // Illegal page number. | |
33711 | + DMESGE("PlatformIORead1Byte(): illegal page number: %d, offset: %#X", Page, offset); | |
33712 | + break; | |
33713 | + } | |
33714 | +#endif | |
33715 | + | |
33716 | + return data; | |
33717 | +} | |
33718 | + | |
33719 | +u16 | |
33720 | +PlatformIORead2Byte( | |
33721 | + struct net_device *dev, | |
33722 | + u32 offset | |
33723 | + ) | |
33724 | +{ | |
33725 | + u16 data = 0; | |
33726 | + | |
33727 | +#ifndef CONFIG_RTL8180_IO_MAP | |
33728 | + data = read_nic_word(dev, offset); | |
33729 | + | |
33730 | +#else // Port IO | |
33731 | + u32 Page = (offset >> 8); | |
33732 | + | |
33733 | + switch(Page) | |
33734 | + { | |
33735 | + case 0: // Page 0 | |
33736 | + data = read_nic_word(dev, offset); | |
33737 | + break; | |
33738 | + | |
33739 | + case 1: // Page 1 | |
33740 | + case 2: // Page 2 | |
33741 | + case 3: // Page 3 | |
33742 | + { | |
33743 | + u8 psr = read_nic_byte(dev, PSR); | |
33744 | + | |
33745 | + write_nic_byte(dev, PSR, ((psr & 0xfc) | (u8)Page)); // Switch to page N. | |
33746 | + data = read_nic_word(dev, (offset & 0xff)); | |
33747 | + write_nic_byte(dev, PSR, (psr & 0xfc)); // Switch to page 0. | |
33748 | + } | |
33749 | + break; | |
33750 | + | |
33751 | + default: | |
33752 | + // Illegal page number. | |
33753 | + DMESGE("PlatformIORead2Byte(): illegal page number: %d, offset: %#X", Page, offset); | |
33754 | + break; | |
33755 | + } | |
33756 | +#endif | |
33757 | + | |
33758 | + return data; | |
33759 | +} | |
33760 | + | |
33761 | +u32 | |
33762 | +PlatformIORead4Byte( | |
33763 | + struct net_device *dev, | |
33764 | + u32 offset | |
33765 | + ) | |
33766 | +{ | |
33767 | + u32 data = 0; | |
33768 | + | |
33769 | +#ifndef CONFIG_RTL8180_IO_MAP | |
33770 | + data = read_nic_dword(dev, offset); | |
33771 | + | |
33772 | +#else // Port IO | |
33773 | + u32 Page = (offset >> 8); | |
33774 | + | |
33775 | + switch(Page) | |
33776 | + { | |
33777 | + case 0: // Page 0 | |
33778 | + data = read_nic_dword(dev, offset); | |
33779 | + break; | |
33780 | + | |
33781 | + case 1: // Page 1 | |
33782 | + case 2: // Page 2 | |
33783 | + case 3: // Page 3 | |
33784 | + { | |
33785 | + u8 psr = read_nic_byte(dev, PSR); | |
33786 | + | |
33787 | + write_nic_byte(dev, PSR, ((psr & 0xfc) | (u8)Page)); // Switch to page N. | |
33788 | + data = read_nic_dword(dev, (offset & 0xff)); | |
33789 | + write_nic_byte(dev, PSR, (psr & 0xfc)); // Switch to page 0. | |
33790 | + } | |
33791 | + break; | |
33792 | + | |
33793 | + default: | |
33794 | + // Illegal page number. | |
33795 | + DMESGE("PlatformIORead4Byte(): illegal page number: %d, offset: %#X\n", Page, offset); | |
33796 | + break; | |
33797 | + } | |
33798 | +#endif | |
33799 | + | |
33800 | + return data; | |
33801 | +} | |
33802 | + | |
33803 | +void | |
33804 | +SetOutputEnableOfRfPins( | |
33805 | + struct net_device *dev | |
33806 | + ) | |
33807 | +{ | |
33808 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
33809 | + | |
33810 | + switch(priv->rf_chip) | |
33811 | + { | |
33812 | + case RFCHIPID_RTL8225: | |
33813 | + case RF_ZEBRA2: | |
33814 | + case RF_ZEBRA4: | |
33815 | + write_nic_word(dev, RFPinsEnable, 0x1bff); | |
33816 | + //write_nic_word(dev, RFPinsEnable, 0x1fff); | |
33817 | + break; | |
33818 | + } | |
33819 | +} | |
33820 | + | |
33821 | +void | |
33822 | +ZEBRA_RFSerialWrite( | |
33823 | + struct net_device *dev, | |
33824 | + u32 data2Write, | |
33825 | + u8 totalLength, | |
33826 | + u8 low2high | |
33827 | + ) | |
33828 | +{ | |
33829 | + ThreeWireReg twreg; | |
33830 | + int i; | |
33831 | + u16 oval,oval2,oval3; | |
33832 | + u32 mask; | |
33833 | + u16 UshortBuffer; | |
33834 | + | |
33835 | + u8 u1bTmp; | |
33836 | +#ifdef CONFIG_RTL818X_S | |
33837 | + // RTL8187S HSSI Read/Write Function | |
33838 | + u1bTmp = read_nic_byte(dev, RF_SW_CONFIG); | |
33839 | + u1bTmp |= RF_SW_CFG_SI; //reg08[1]=1 Serial Interface(SI) | |
33840 | + write_nic_byte(dev, RF_SW_CONFIG, u1bTmp); | |
33841 | +#endif | |
33842 | + UshortBuffer = read_nic_word(dev, RFPinsOutput); | |
33843 | + oval = UshortBuffer & 0xfff8; // We shall clear bit0, 1, 2 first, 2005.10.28, by rcnjko. | |
33844 | + | |
33845 | + oval2 = read_nic_word(dev, RFPinsEnable); | |
33846 | + oval3 = read_nic_word(dev, RFPinsSelect); | |
33847 | + | |
33848 | + // <RJ_NOTE> 3-wire should be controled by HW when we finish SW 3-wire programming. 2005.08.10, by rcnjko. | |
33849 | + oval3 &= 0xfff8; | |
33850 | + | |
33851 | + write_nic_word(dev, RFPinsEnable, (oval2|0x0007)); // Set To Output Enable | |
33852 | + write_nic_word(dev, RFPinsSelect, (oval3|0x0007)); // Set To SW Switch | |
33853 | + udelay(10); | |
33854 | + | |
33855 | + // Add this to avoid hardware and software 3-wire conflict. | |
33856 | + // 2005.03.01, by rcnjko. | |
33857 | + twreg.longData = 0; | |
33858 | + twreg.struc.enableB = 1; | |
33859 | + write_nic_word(dev, RFPinsOutput, (twreg.longData|oval)); // Set SI_EN (RFLE) | |
33860 | + udelay(2); | |
33861 | + twreg.struc.enableB = 0; | |
33862 | + write_nic_word(dev, RFPinsOutput, (twreg.longData|oval)); // Clear SI_EN (RFLE) | |
33863 | + udelay(10); | |
33864 | + | |
33865 | + mask = (low2high)?0x01:((u32)0x01<<(totalLength-1)); | |
33866 | + | |
33867 | + for(i=0; i<totalLength/2; i++) | |
33868 | + { | |
33869 | + twreg.struc.data = ((data2Write&mask)!=0) ? 1 : 0; | |
33870 | + write_nic_word(dev, RFPinsOutput, (twreg.longData|oval)); | |
33871 | + twreg.struc.clk = 1; | |
33872 | + write_nic_word(dev, RFPinsOutput, (twreg.longData|oval)); | |
33873 | + write_nic_word(dev, RFPinsOutput, (twreg.longData|oval)); | |
33874 | + | |
33875 | + mask = (low2high)?(mask<<1):(mask>>1); | |
33876 | + twreg.struc.data = ((data2Write&mask)!=0) ? 1 : 0; | |
33877 | + write_nic_word(dev, RFPinsOutput, (twreg.longData|oval)); | |
33878 | + write_nic_word(dev, RFPinsOutput, (twreg.longData|oval)); | |
33879 | + twreg.struc.clk = 0; | |
33880 | + write_nic_word(dev, RFPinsOutput, (twreg.longData|oval)); | |
33881 | + mask = (low2high)?(mask<<1):(mask>>1); | |
33882 | + } | |
33883 | + | |
33884 | + twreg.struc.enableB = 1; | |
33885 | + twreg.struc.clk = 0; | |
33886 | + twreg.struc.data = 0; | |
33887 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); | |
33888 | + udelay(10); | |
33889 | + | |
33890 | + write_nic_word(dev, RFPinsOutput, oval|0x0004); | |
33891 | + write_nic_word(dev, RFPinsSelect, oval3|0x0000); | |
33892 | + | |
33893 | + SetOutputEnableOfRfPins(dev); | |
33894 | +} | |
33895 | +//by amy | |
33896 | + | |
33897 | + | |
33898 | +int | |
33899 | +HwHSSIThreeWire( | |
33900 | + struct net_device *dev, | |
33901 | + u8 *pDataBuf, | |
33902 | + u8 nDataBufBitCnt, | |
33903 | + int bSI, | |
33904 | + int bWrite | |
33905 | + ) | |
33906 | +{ | |
33907 | + int bResult = 1; | |
33908 | + u8 TryCnt; | |
33909 | + u8 u1bTmp; | |
33910 | + | |
33911 | + do | |
33912 | + { | |
33913 | + // Check if WE and RE are cleared. | |
33914 | + for(TryCnt = 0; TryCnt < TC_3W_POLL_MAX_TRY_CNT; TryCnt++) | |
33915 | + { | |
33916 | + u1bTmp = read_nic_byte(dev, SW_3W_CMD1); | |
33917 | + if( (u1bTmp & (SW_3W_CMD1_RE|SW_3W_CMD1_WE)) == 0 ) | |
33918 | + { | |
33919 | + break; | |
33920 | + } | |
33921 | + udelay(10); | |
33922 | + } | |
33923 | + if (TryCnt == TC_3W_POLL_MAX_TRY_CNT) | |
33924 | + panic("HwThreeWire(): CmdReg: %#X RE|WE bits are not clear!!\n", u1bTmp); | |
33925 | + | |
33926 | + // RTL8187S HSSI Read/Write Function | |
33927 | + u1bTmp = read_nic_byte(dev, RF_SW_CONFIG); | |
33928 | + | |
33929 | + if(bSI) | |
33930 | + { | |
33931 | + u1bTmp |= RF_SW_CFG_SI; //reg08[1]=1 Serial Interface(SI) | |
33932 | + }else | |
33933 | + { | |
33934 | + u1bTmp &= ~RF_SW_CFG_SI; //reg08[1]=0 Parallel Interface(PI) | |
33935 | + } | |
33936 | + | |
33937 | + write_nic_byte(dev, RF_SW_CONFIG, u1bTmp); | |
33938 | + | |
33939 | + if(bSI) | |
33940 | + { | |
33941 | + // jong: HW SI read must set reg84[3]=0. | |
33942 | + u1bTmp = read_nic_byte(dev, RFPinsSelect); | |
33943 | + u1bTmp &= ~BIT3; | |
33944 | + write_nic_byte(dev, RFPinsSelect, u1bTmp ); | |
33945 | + } | |
33946 | + // Fill up data buffer for write operation. | |
33947 | + | |
33948 | + if(bWrite) | |
33949 | + { | |
33950 | + if(nDataBufBitCnt == 16) | |
33951 | + { | |
33952 | + write_nic_word(dev, SW_3W_DB0, *((u16*)pDataBuf)); | |
33953 | + } | |
33954 | + else if(nDataBufBitCnt == 64) // RTL8187S shouldn't enter this case | |
33955 | + { | |
33956 | + write_nic_dword(dev, SW_3W_DB0, *((u32*)pDataBuf)); | |
33957 | + write_nic_dword(dev, SW_3W_DB1, *((u32*)(pDataBuf + 4))); | |
33958 | + } | |
33959 | + else | |
33960 | + { | |
33961 | + int idx; | |
33962 | + int ByteCnt = nDataBufBitCnt / 8; | |
33963 | + //printk("%d\n",nDataBufBitCnt); | |
33964 | + if ((nDataBufBitCnt % 8) != 0) | |
33965 | + panic("HwThreeWire(): nDataBufBitCnt(%d) should be multiple of 8!!!\n", | |
33966 | + nDataBufBitCnt); | |
33967 | + | |
33968 | + if (nDataBufBitCnt > 64) | |
33969 | + panic("HwThreeWire(): nDataBufBitCnt(%d) should <= 64!!!\n", | |
33970 | + nDataBufBitCnt); | |
33971 | + | |
33972 | + for(idx = 0; idx < ByteCnt; idx++) | |
33973 | + { | |
33974 | + write_nic_byte(dev, (SW_3W_DB0+idx), *(pDataBuf+idx)); | |
33975 | + } | |
33976 | + } | |
33977 | + } | |
33978 | + else //read | |
33979 | + { | |
33980 | + if(bSI) | |
33981 | + { | |
33982 | + // SI - reg274[3:0] : RF register's Address | |
33983 | + write_nic_word(dev, SW_3W_DB0, *((u16*)pDataBuf) ); | |
33984 | + } | |
33985 | + else | |
33986 | + { | |
33987 | + // PI - reg274[15:12] : RF register's Address | |
33988 | + write_nic_word(dev, SW_3W_DB0, (*((u16*)pDataBuf)) << 12); | |
33989 | + } | |
33990 | + } | |
33991 | + | |
33992 | + // Set up command: WE or RE. | |
33993 | + if(bWrite) | |
33994 | + { | |
33995 | + write_nic_byte(dev, SW_3W_CMD1, SW_3W_CMD1_WE); | |
33996 | + } | |
33997 | + else | |
33998 | + { | |
33999 | + write_nic_byte(dev, SW_3W_CMD1, SW_3W_CMD1_RE); | |
34000 | + } | |
34001 | + | |
34002 | + // Check if DONE is set. | |
34003 | + for(TryCnt = 0; TryCnt < TC_3W_POLL_MAX_TRY_CNT; TryCnt++) | |
34004 | + { | |
34005 | + u1bTmp = read_nic_byte(dev, SW_3W_CMD1); | |
34006 | + if( (u1bTmp & SW_3W_CMD1_DONE) != 0 ) | |
34007 | + { | |
34008 | + break; | |
34009 | + } | |
34010 | + udelay(10); | |
34011 | + } | |
34012 | + | |
34013 | + write_nic_byte(dev, SW_3W_CMD1, 0); | |
34014 | + | |
34015 | + // Read back data for read operation. | |
34016 | + if(bWrite == 0) | |
34017 | + { | |
34018 | + if(bSI) | |
34019 | + { | |
34020 | + //Serial Interface : reg363_362[11:0] | |
34021 | + *((u16*)pDataBuf) = read_nic_word(dev, SI_DATA_READ) ; | |
34022 | + } | |
34023 | + else | |
34024 | + { | |
34025 | + //Parallel Interface : reg361_360[11:0] | |
34026 | + *((u16*)pDataBuf) = read_nic_word(dev, PI_DATA_READ); | |
34027 | + } | |
34028 | + | |
34029 | + *((u16*)pDataBuf) &= 0x0FFF; | |
34030 | + } | |
34031 | + | |
34032 | + }while(0); | |
34033 | + | |
34034 | + return bResult; | |
34035 | +} | |
34036 | +//by amy | |
34037 | + | |
34038 | +int | |
34039 | +HwThreeWire( | |
34040 | + struct net_device *dev, | |
34041 | + u8 *pDataBuf, | |
34042 | + u8 nDataBufBitCnt, | |
34043 | + int bHold, | |
34044 | + int bWrite | |
34045 | + ) | |
34046 | +{ | |
34047 | + int bResult = 1; | |
34048 | + u8 TryCnt; | |
34049 | + u8 u1bTmp; | |
34050 | + | |
34051 | + do | |
34052 | + { | |
34053 | + // Check if WE and RE are cleared. | |
34054 | + for(TryCnt = 0; TryCnt < TC_3W_POLL_MAX_TRY_CNT; TryCnt++) | |
34055 | + { | |
34056 | + u1bTmp = read_nic_byte(dev, SW_3W_CMD1); | |
34057 | + if( (u1bTmp & (SW_3W_CMD1_RE|SW_3W_CMD1_WE)) == 0 ) | |
34058 | + { | |
34059 | + break; | |
34060 | + } | |
34061 | + udelay(10); | |
34062 | + } | |
34063 | + if (TryCnt == TC_3W_POLL_MAX_TRY_CNT) | |
34064 | + panic("HwThreeWire(): CmdReg: %#X RE|WE bits are not clear!!\n", u1bTmp); | |
34065 | + | |
34066 | + // Fill up data buffer for write operation. | |
34067 | + if(nDataBufBitCnt == 16) | |
34068 | + { | |
34069 | + write_nic_word(dev, SW_3W_DB0, *((u16 *)pDataBuf)); | |
34070 | + } | |
34071 | + else if(nDataBufBitCnt == 64) | |
34072 | + { | |
34073 | + write_nic_dword(dev, SW_3W_DB0, *((u32 *)pDataBuf)); | |
34074 | + write_nic_dword(dev, SW_3W_DB1, *((u32 *)(pDataBuf + 4))); | |
34075 | + } | |
34076 | + else | |
34077 | + { | |
34078 | + int idx; | |
34079 | + int ByteCnt = nDataBufBitCnt / 8; | |
34080 | + | |
34081 | + if ((nDataBufBitCnt % 8) != 0) | |
34082 | + panic("HwThreeWire(): nDataBufBitCnt(%d) should be multiple of 8!!!\n", | |
34083 | + nDataBufBitCnt); | |
34084 | + | |
34085 | + if (nDataBufBitCnt > 64) | |
34086 | + panic("HwThreeWire(): nDataBufBitCnt(%d) should <= 64!!!\n", | |
34087 | + nDataBufBitCnt); | |
34088 | + | |
34089 | + for(idx = 0; idx < ByteCnt; idx++) | |
34090 | + { | |
34091 | + write_nic_byte(dev, (SW_3W_DB0+idx), *(pDataBuf+idx)); | |
34092 | + } | |
34093 | + } | |
34094 | + | |
34095 | + // Fill up length field. | |
34096 | + u1bTmp = (u8)(nDataBufBitCnt - 1); // Number of bits - 1. | |
34097 | + if(bHold) | |
34098 | + u1bTmp |= SW_3W_CMD0_HOLD; | |
34099 | + write_nic_byte(dev, SW_3W_CMD0, u1bTmp); | |
34100 | + | |
34101 | + // Set up command: WE or RE. | |
34102 | + if(bWrite) | |
34103 | + { | |
34104 | + write_nic_byte(dev, SW_3W_CMD1, SW_3W_CMD1_WE); | |
34105 | + } | |
34106 | + else | |
34107 | + { | |
34108 | + write_nic_byte(dev, SW_3W_CMD1, SW_3W_CMD1_RE); | |
34109 | + } | |
34110 | + | |
34111 | + // Check if WE and RE are cleared and DONE is set. | |
34112 | + for(TryCnt = 0; TryCnt < TC_3W_POLL_MAX_TRY_CNT; TryCnt++) | |
34113 | + { | |
34114 | + u1bTmp = read_nic_byte(dev, SW_3W_CMD1); | |
34115 | + if( (u1bTmp & (SW_3W_CMD1_RE|SW_3W_CMD1_WE)) == 0 && | |
34116 | + (u1bTmp & SW_3W_CMD1_DONE) != 0 ) | |
34117 | + { | |
34118 | + break; | |
34119 | + } | |
34120 | + udelay(10); | |
34121 | + } | |
34122 | + if(TryCnt == TC_3W_POLL_MAX_TRY_CNT) | |
34123 | + { | |
34124 | + //RT_ASSERT(TryCnt != TC_3W_POLL_MAX_TRY_CNT, | |
34125 | + // ("HwThreeWire(): CmdReg: %#X RE|WE bits are not clear or DONE is not set!!\n", u1bTmp)); | |
34126 | + // Workaround suggested by wcchu: clear WE here. 2006.07.07, by rcnjko. | |
34127 | + write_nic_byte(dev, SW_3W_CMD1, 0); | |
34128 | + } | |
34129 | + | |
34130 | + // Read back data for read operation. | |
34131 | + // <RJ_TODO> I am not sure if this is correct output format of a read operation. | |
34132 | + if(bWrite == 0) | |
34133 | + { | |
34134 | + if(nDataBufBitCnt == 16) | |
34135 | + { | |
34136 | + *((u16 *)pDataBuf) = read_nic_word(dev, SW_3W_DB0); | |
34137 | + } | |
34138 | + else if(nDataBufBitCnt == 64) | |
34139 | + { | |
34140 | + *((u32 *)pDataBuf) = read_nic_dword(dev, SW_3W_DB0); | |
34141 | + *((u32 *)(pDataBuf + 4)) = read_nic_dword(dev, SW_3W_DB1); | |
34142 | + } | |
34143 | + else | |
34144 | + { | |
34145 | + int idx; | |
34146 | + int ByteCnt = nDataBufBitCnt / 8; | |
34147 | + | |
34148 | + if ((nDataBufBitCnt % 8) != 0) | |
34149 | + panic("HwThreeWire(): nDataBufBitCnt(%d) should be multiple of 8!!!\n", | |
34150 | + nDataBufBitCnt); | |
34151 | + | |
34152 | + if (nDataBufBitCnt > 64) | |
34153 | + panic("HwThreeWire(): nDataBufBitCnt(%d) should <= 64!!!\n", | |
34154 | + nDataBufBitCnt); | |
34155 | + | |
34156 | + for(idx = 0; idx < ByteCnt; idx++) | |
34157 | + { | |
34158 | + *(pDataBuf+idx) = read_nic_byte(dev, (SW_3W_DB0+idx)); | |
34159 | + } | |
34160 | + } | |
34161 | + } | |
34162 | + | |
34163 | + }while(0); | |
34164 | + | |
34165 | + return bResult; | |
34166 | +} | |
34167 | + | |
34168 | + | |
34169 | +void | |
34170 | +RF_WriteReg( | |
34171 | + struct net_device *dev, | |
34172 | + u8 offset, | |
34173 | + u32 data | |
34174 | + ) | |
34175 | +{ | |
34176 | + //RFReg reg; | |
34177 | + u32 data2Write; | |
34178 | + u8 len; | |
34179 | + u8 low2high; | |
34180 | + //u32 RF_Read = 0; | |
34181 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
34182 | + | |
34183 | + | |
34184 | + switch(priv->rf_chip) | |
34185 | + { | |
34186 | + case RFCHIPID_RTL8225: | |
34187 | + case RF_ZEBRA2: // Annie 2006-05-12. | |
34188 | + case RF_ZEBRA4: //by amy | |
34189 | + switch(priv->RegThreeWireMode) | |
34190 | + { | |
34191 | + case SW_THREE_WIRE: | |
34192 | + { // Perform SW 3-wire programming by driver. | |
34193 | + data2Write = (data << 4) | (u32)(offset & 0x0f); | |
34194 | + len = 16; | |
34195 | + low2high = 0; | |
34196 | + ZEBRA_RFSerialWrite(dev, data2Write, len, low2high); | |
34197 | + } | |
34198 | + break; | |
34199 | + | |
34200 | + case HW_THREE_WIRE: | |
34201 | + { // Pure HW 3-wire. | |
34202 | + data2Write = (data << 4) | (u32)(offset & 0x0f); | |
34203 | + len = 16; | |
34204 | + HwThreeWire( | |
34205 | + dev, | |
34206 | + (u8 *)(&data2Write), // pDataBuf, | |
34207 | + len, // nDataBufBitCnt, | |
34208 | + 0, // bHold, | |
34209 | + 1); // bWrite | |
34210 | + } | |
34211 | + break; | |
34212 | + #ifdef CONFIG_RTL818X_S | |
34213 | + case HW_THREE_WIRE_PI: //Parallel Interface | |
34214 | + { // Pure HW 3-wire. | |
34215 | + data2Write = (data << 4) | (u32)(offset & 0x0f); | |
34216 | + len = 16; | |
34217 | + HwHSSIThreeWire( | |
34218 | + dev, | |
34219 | + (u8*)(&data2Write), // pDataBuf, | |
34220 | + len, // nDataBufBitCnt, | |
34221 | + 0, // bSI | |
34222 | + 1); // bWrite | |
34223 | + | |
34224 | + //printk("33333\n"); | |
34225 | + } | |
34226 | + break; | |
34227 | + | |
34228 | + case HW_THREE_WIRE_SI: //Serial Interface | |
34229 | + { // Pure HW 3-wire. | |
34230 | + data2Write = (data << 4) | (u32)(offset & 0x0f); | |
34231 | + len = 16; | |
34232 | +// printk(" enter ZEBRA_RFSerialWrite\n "); | |
34233 | +// low2high = 0; | |
34234 | +// ZEBRA_RFSerialWrite(dev, data2Write, len, low2high); | |
34235 | + | |
34236 | + HwHSSIThreeWire( | |
34237 | + dev, | |
34238 | + (u8*)(&data2Write), // pDataBuf, | |
34239 | + len, // nDataBufBitCnt, | |
34240 | + 1, // bSI | |
34241 | + 1); // bWrite | |
34242 | + | |
34243 | +// printk(" exit ZEBRA_RFSerialWrite\n "); | |
34244 | + } | |
34245 | + break; | |
34246 | + #endif | |
34247 | + | |
34248 | + | |
34249 | + default: | |
34250 | + DMESGE("RF_WriteReg(): invalid RegThreeWireMode(%d) !!!", priv->RegThreeWireMode); | |
34251 | + break; | |
34252 | + } | |
34253 | + break; | |
34254 | + | |
34255 | + default: | |
34256 | + DMESGE("RF_WriteReg(): unknown RFChipID: %#X", priv->rf_chip); | |
34257 | + break; | |
34258 | + } | |
34259 | +} | |
34260 | + | |
34261 | + | |
34262 | +void | |
34263 | +ZEBRA_RFSerialRead( | |
34264 | + struct net_device *dev, | |
34265 | + u32 data2Write, | |
34266 | + u8 wLength, | |
34267 | + u32 *data2Read, | |
34268 | + u8 rLength, | |
34269 | + u8 low2high | |
34270 | + ) | |
34271 | +{ | |
34272 | + ThreeWireReg twreg; | |
34273 | + int i; | |
34274 | + u16 oval,oval2,oval3,tmp, wReg80; | |
34275 | + u32 mask; | |
34276 | + u8 u1bTmp; | |
34277 | + ThreeWireReg tdata; | |
34278 | + //PHAL_DATA_8187 pHalData = GetHalData8187(pAdapter); | |
34279 | +#ifdef CONFIG_RTL818X_S | |
34280 | + { // RTL8187S HSSI Read/Write Function | |
34281 | + u1bTmp = read_nic_byte(dev, RF_SW_CONFIG); | |
34282 | + u1bTmp |= RF_SW_CFG_SI; //reg08[1]=1 Serial Interface(SI) | |
34283 | + write_nic_byte(dev, RF_SW_CONFIG, u1bTmp); | |
34284 | + } | |
34285 | +#endif | |
34286 | + | |
34287 | + wReg80 = oval = read_nic_word(dev, RFPinsOutput); | |
34288 | + oval2 = read_nic_word(dev, RFPinsEnable); | |
34289 | + oval3 = read_nic_word(dev, RFPinsSelect); | |
34290 | + | |
34291 | + write_nic_word(dev, RFPinsEnable, oval2|0xf); | |
34292 | + write_nic_word(dev, RFPinsSelect, oval3|0xf); | |
34293 | + | |
34294 | + *data2Read = 0; | |
34295 | + | |
34296 | + // We must clear BIT0-3 here, otherwise, | |
34297 | + // SW_Enalbe will be true when we first call ZEBRA_RFSerialRead() after 8187MPVC open, | |
34298 | + // which will cause the value read become 0. 2005.04.11, by rcnjko. | |
34299 | + oval &= ~0xf; | |
34300 | + | |
34301 | + // Avoid collision with hardware three-wire. | |
34302 | + twreg.longData = 0; | |
34303 | + twreg.struc.enableB = 1; | |
34304 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(4); | |
34305 | + | |
34306 | + twreg.longData = 0; | |
34307 | + twreg.struc.enableB = 0; | |
34308 | + twreg.struc.clk = 0; | |
34309 | + twreg.struc.read_write = 0; | |
34310 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(5); | |
34311 | + | |
34312 | + mask = (low2high) ? 0x01 : ((u32)0x01<<(32-1)); | |
34313 | + for(i = 0; i < wLength/2; i++) | |
34314 | + { | |
34315 | + twreg.struc.data = ((data2Write&mask) != 0) ? 1 : 0; | |
34316 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(1); | |
34317 | + twreg.struc.clk = 1; | |
34318 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(2); | |
34319 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(2); | |
34320 | + | |
34321 | + mask = (low2high) ? (mask<<1): (mask>>1); | |
34322 | + | |
34323 | + if(i == 2) | |
34324 | + { | |
34325 | + // Commented out by Jackie, 2004.08.26. <RJ_NOTE> We must comment out the following two lines for we cannot pull down VCOPDN during RF Serail Read. | |
34326 | + //PlatformEFIOWrite2Byte(pAdapter, RFPinsEnable, 0xe); // turn off data enable | |
34327 | + //PlatformEFIOWrite2Byte(pAdapter, RFPinsSelect, 0xe); | |
34328 | + | |
34329 | + twreg.struc.read_write=1; | |
34330 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(2); | |
34331 | + twreg.struc.clk = 0; | |
34332 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(2); | |
34333 | + break; | |
34334 | + } | |
34335 | + twreg.struc.data = ((data2Write&mask) != 0) ? 1: 0; | |
34336 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(2); | |
34337 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(2); | |
34338 | + | |
34339 | + twreg.struc.clk = 0; | |
34340 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(1); | |
34341 | + | |
34342 | + mask = (low2high) ? (mask<<1) : (mask>>1); | |
34343 | + } | |
34344 | + | |
34345 | + twreg.struc.clk = 0; | |
34346 | + twreg.struc.data = 0; | |
34347 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(2); | |
34348 | + mask = (low2high) ? 0x01 : ((u32)0x01 << (12-1)); | |
34349 | + | |
34350 | + // | |
34351 | + // 061016, by rcnjko: | |
34352 | + // We must set data pin to HW controled, otherwise RF can't driver it and | |
34353 | + // value RF register won't be able to read back properly. | |
34354 | + // | |
34355 | + write_nic_word(dev, RFPinsEnable, ( ((oval2|0x0E) & (~0x01))) ); | |
34356 | + | |
34357 | + for(i = 0; i < rLength; i++) | |
34358 | + { | |
34359 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(1); | |
34360 | + twreg.struc.clk = 1; | |
34361 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(2); | |
34362 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(2); | |
34363 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(2); | |
34364 | + tmp = read_nic_word(dev, RFPinsInput); | |
34365 | + tdata.longData = tmp; | |
34366 | + *data2Read |= tdata.struc.clk ? mask : 0; | |
34367 | + | |
34368 | + twreg.struc.clk = 0; | |
34369 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(2); | |
34370 | + | |
34371 | + mask = (low2high) ? (mask<<1) : (mask>>1); | |
34372 | + } | |
34373 | + twreg.struc.enableB = 1; | |
34374 | + twreg.struc.clk = 0; | |
34375 | + twreg.struc.data = 0; | |
34376 | + twreg.struc.read_write = 1; | |
34377 | + write_nic_word(dev, RFPinsOutput, twreg.longData|oval); udelay(2); | |
34378 | + | |
34379 | + //PlatformEFIOWrite2Byte(pAdapter, RFPinsEnable, oval2|0x8); // Set To Output Enable | |
34380 | + write_nic_word(dev, RFPinsEnable, oval2); // Set To Output Enable, <RJ_NOTE> We cannot enable BIT3 here, otherwise, we will failed to switch channel. 2005.04.12. | |
34381 | + //PlatformEFIOWrite2Byte(pAdapter, RFPinsEnable, 0x1bff); | |
34382 | + write_nic_word(dev, RFPinsSelect, oval3); // Set To SW Switch | |
34383 | + //PlatformEFIOWrite2Byte(pAdapter, RFPinsSelect, 0x0488); | |
34384 | + write_nic_word(dev, RFPinsOutput, 0x3a0); | |
34385 | + //PlatformEFIOWrite2Byte(pAdapter, RFPinsOutput, 0x0480); | |
34386 | +} | |
34387 | + | |
34388 | + | |
34389 | +u32 | |
34390 | +RF_ReadReg( | |
34391 | + struct net_device *dev, | |
34392 | + u8 offset | |
34393 | + ) | |
34394 | +{ | |
34395 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
34396 | + u32 data2Write; | |
34397 | + u8 wlen; | |
34398 | + u8 rlen; | |
34399 | + u8 low2high; | |
34400 | + u32 dataRead; | |
34401 | + | |
34402 | + switch(priv->rf_chip) | |
34403 | + { | |
34404 | + case RFCHIPID_RTL8225: | |
34405 | + case RF_ZEBRA2: | |
34406 | + case RF_ZEBRA4: | |
34407 | + switch(priv->RegThreeWireMode) | |
34408 | + { | |
34409 | +#ifdef CONFIG_RTL818X_S | |
34410 | + case HW_THREE_WIRE_PI: // For 87S Parallel Interface. | |
34411 | + { | |
34412 | + data2Write = ((u32)(offset&0x0f)); | |
34413 | + wlen=16; | |
34414 | + HwHSSIThreeWire( | |
34415 | + dev, | |
34416 | + (u8*)(&data2Write), // pDataBuf, | |
34417 | + wlen, // nDataBufBitCnt, | |
34418 | + 0, // bSI | |
34419 | + 0); // bWrite | |
34420 | + dataRead= data2Write; | |
34421 | + } | |
34422 | + break; | |
34423 | + | |
34424 | + case HW_THREE_WIRE_SI: // For 87S Serial Interface. | |
34425 | + { | |
34426 | + data2Write = ((u32)(offset&0x0f)) ; | |
34427 | + wlen=16; | |
34428 | + HwHSSIThreeWire( | |
34429 | + dev, | |
34430 | + (u8*)(&data2Write), // pDataBuf, | |
34431 | + wlen, // nDataBufBitCnt, | |
34432 | + 1, // bSI | |
34433 | + 0 // bWrite | |
34434 | + ); | |
34435 | + dataRead= data2Write; | |
34436 | + } | |
34437 | + break; | |
34438 | + | |
34439 | +#endif | |
34440 | + // Perform SW 3-wire programming by driver. | |
34441 | + default: | |
34442 | + { | |
34443 | + data2Write = ((u32)(offset&0x1f)) << 27; // For Zebra E-cut. 2005.04.11, by rcnjko. | |
34444 | + wlen = 6; | |
34445 | + rlen = 12; | |
34446 | + low2high = 0; | |
34447 | + ZEBRA_RFSerialRead(dev, data2Write, wlen,&dataRead,rlen, low2high); | |
34448 | + } | |
34449 | + break; | |
34450 | + } | |
34451 | + break; | |
34452 | + default: | |
34453 | + dataRead = 0; | |
34454 | + break; | |
34455 | + } | |
34456 | + | |
34457 | + return dataRead; | |
34458 | +} | |
34459 | + | |
34460 | + | |
34461 | +// by Owen on 04/07/14 for writing BB register successfully | |
34462 | +void | |
34463 | +WriteBBPortUchar( | |
34464 | + struct net_device *dev, | |
34465 | + u32 Data | |
34466 | + ) | |
34467 | +{ | |
34468 | + //u8 TimeoutCounter; | |
34469 | + u8 RegisterContent; | |
34470 | + u8 UCharData; | |
34471 | + | |
34472 | + UCharData = (u8)((Data & 0x0000ff00) >> 8); | |
34473 | + PlatformIOWrite4Byte(dev, PhyAddr, Data); | |
34474 | + //for(TimeoutCounter = 10; TimeoutCounter > 0; TimeoutCounter--) | |
34475 | + { | |
34476 | + PlatformIOWrite4Byte(dev, PhyAddr, Data & 0xffffff7f); | |
34477 | + RegisterContent = PlatformIORead1Byte(dev, PhyDataR); | |
34478 | + //if(UCharData == RegisterContent) | |
34479 | + // break; | |
34480 | + } | |
34481 | +} | |
34482 | + | |
34483 | +u8 | |
34484 | +ReadBBPortUchar( | |
34485 | + struct net_device *dev, | |
34486 | + u32 addr | |
34487 | + ) | |
34488 | +{ | |
34489 | + //u8 TimeoutCounter; | |
34490 | + u8 RegisterContent; | |
34491 | + | |
34492 | + PlatformIOWrite4Byte(dev, PhyAddr, addr & 0xffffff7f); | |
34493 | + RegisterContent = PlatformIORead1Byte(dev, PhyDataR); | |
34494 | + | |
34495 | + return RegisterContent; | |
34496 | +} | |
34497 | +//{by amy 080312 | |
34498 | +#ifdef CONFIG_RTL818X_S | |
34499 | +// | |
34500 | +// Description: | |
34501 | +// Perform Antenna settings with antenna diversity on 87SE. | |
34502 | +// Created by Roger, 2008.01.25. | |
34503 | +// | |
34504 | +bool | |
34505 | +SetAntennaConfig87SE( | |
34506 | + struct net_device *dev, | |
34507 | + u8 DefaultAnt, // 0: Main, 1: Aux. | |
34508 | + bool bAntDiversity // 1:Enable, 0: Disable. | |
34509 | +) | |
34510 | +{ | |
34511 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
34512 | + bool bAntennaSwitched = true; | |
34513 | + | |
34514 | + //printk("SetAntennaConfig87SE(): DefaultAnt(%d), bAntDiversity(%d)\n", DefaultAnt, bAntDiversity); | |
34515 | + | |
34516 | + // Threshold for antenna diversity. | |
34517 | + write_phy_cck(dev, 0x0c, 0x09); // Reg0c : 09 | |
34518 | + | |
34519 | + if( bAntDiversity ) // Enable Antenna Diversity. | |
34520 | + { | |
34521 | + if( DefaultAnt == 1 ) // aux antenna | |
34522 | + { | |
34523 | + // Mac register, aux antenna | |
34524 | + write_nic_byte(dev, ANTSEL, 0x00); | |
34525 | + | |
34526 | + // Config CCK RX antenna. | |
34527 | + write_phy_cck(dev, 0x11, 0xbb); // Reg11 : bb | |
34528 | + write_phy_cck(dev, 0x01, 0xc7); // Reg01 : c7 | |
34529 | + | |
34530 | + // Config OFDM RX antenna. | |
34531 | + write_phy_ofdm(dev, 0x0D, 0x54); // Reg0d : 54 | |
34532 | + write_phy_ofdm(dev, 0x18, 0xb2); // Reg18 : b2 | |
34533 | + } | |
34534 | + else // use main antenna | |
34535 | + { | |
34536 | + // Mac register, main antenna | |
34537 | + write_nic_byte(dev, ANTSEL, 0x03); | |
34538 | + //base band | |
34539 | + // Config CCK RX antenna. | |
34540 | + write_phy_cck(dev, 0x11, 0x9b); // Reg11 : 9b | |
34541 | + write_phy_cck(dev, 0x01, 0xc7); // Reg01 : c7 | |
34542 | + | |
34543 | + // Config OFDM RX antenna. | |
34544 | + write_phy_ofdm(dev, 0x0d, 0x5c); // Reg0d : 5c | |
34545 | + write_phy_ofdm(dev, 0x18, 0xb2); // Reg18 : b2 | |
34546 | + } | |
34547 | + } | |
34548 | + else // Disable Antenna Diversity. | |
34549 | + { | |
34550 | + if( DefaultAnt == 1 ) // aux Antenna | |
34551 | + { | |
34552 | + // Mac register, aux antenna | |
34553 | + write_nic_byte(dev, ANTSEL, 0x00); | |
34554 | + | |
34555 | + // Config CCK RX antenna. | |
34556 | + write_phy_cck(dev, 0x11, 0xbb); // Reg11 : bb | |
34557 | + write_phy_cck(dev, 0x01, 0x47); // Reg01 : 47 | |
34558 | + | |
34559 | + // Config OFDM RX antenna. | |
34560 | + write_phy_ofdm(dev, 0x0D, 0x54); // Reg0d : 54 | |
34561 | + write_phy_ofdm(dev, 0x18, 0x32); // Reg18 : 32 | |
34562 | + } | |
34563 | + else // main Antenna | |
34564 | + { | |
34565 | + // Mac register, main antenna | |
34566 | + write_nic_byte(dev, ANTSEL, 0x03); | |
34567 | + | |
34568 | + // Config CCK RX antenna. | |
34569 | + write_phy_cck(dev, 0x11, 0x9b); // Reg11 : 9b | |
34570 | + write_phy_cck(dev, 0x01, 0x47); // Reg01 : 47 | |
34571 | + | |
34572 | + // Config OFDM RX antenna. | |
34573 | + write_phy_ofdm(dev, 0x0D, 0x5c); // Reg0d : 5c | |
34574 | + write_phy_ofdm(dev, 0x18, 0x32); // Reg18 : 32 | |
34575 | + } | |
34576 | + } | |
34577 | + priv->CurrAntennaIndex = DefaultAnt; // Update default settings. | |
34578 | + return bAntennaSwitched; | |
34579 | +} | |
34580 | +#endif | |
34581 | +//by amy 080312 | |
34582 | +/*--------------------------------------------------------------- | |
34583 | + * Hardware Initialization. | |
34584 | + * the code is ported from Windows source code | |
34585 | + ----------------------------------------------------------------*/ | |
34586 | + | |
34587 | +void | |
34588 | +ZEBRA_Config_85BASIC_HardCode( | |
34589 | + struct net_device *dev | |
34590 | + ) | |
34591 | +{ | |
34592 | + | |
34593 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
34594 | + u32 i; | |
34595 | + u32 addr,data; | |
34596 | + u32 u4bRegOffset, u4bRegValue, u4bRF23, u4bRF24; | |
34597 | + u8 u1b24E; | |
34598 | + | |
34599 | +#ifdef CONFIG_RTL818X_S | |
34600 | + | |
34601 | + //============================================================================= | |
34602 | + // 87S_PCIE :: RADIOCFG.TXT | |
34603 | + //============================================================================= | |
34604 | + | |
34605 | + | |
34606 | + // Page1 : reg16-reg30 | |
34607 | + RF_WriteReg(dev, 0x00, 0x013f); mdelay(1); // switch to page1 | |
34608 | + u4bRF23= RF_ReadReg(dev, 0x08); mdelay(1); | |
34609 | + u4bRF24= RF_ReadReg(dev, 0x09); mdelay(1); | |
34610 | + | |
34611 | + if (u4bRF23==0x818 && u4bRF24==0x70C && priv->card_8185 == VERSION_8187S_C) | |
34612 | + priv->card_8185 = VERSION_8187S_D; | |
34613 | + | |
34614 | + // Page0 : reg0-reg15 | |
34615 | + | |
34616 | +// RF_WriteReg(dev, 0x00, 0x003f); mdelay(1);//1 | |
34617 | + RF_WriteReg(dev, 0x00, 0x009f); mdelay(1);// 1 | |
34618 | + | |
34619 | + RF_WriteReg(dev, 0x01, 0x06e0); mdelay(1); | |
34620 | + | |
34621 | +// RF_WriteReg(dev, 0x02, 0x004c); mdelay(1);//2 | |
34622 | + RF_WriteReg(dev, 0x02, 0x004d); mdelay(1);// 2 | |
34623 | + | |
34624 | +// RF_WriteReg(dev, 0x03, 0x0000); mdelay(1);//3 | |
34625 | + RF_WriteReg(dev, 0x03, 0x07f1); mdelay(1);// 3 | |
34626 | + | |
34627 | + RF_WriteReg(dev, 0x04, 0x0975); mdelay(1); | |
34628 | + RF_WriteReg(dev, 0x05, 0x0c72); mdelay(1); | |
34629 | + RF_WriteReg(dev, 0x06, 0x0ae6); mdelay(1); | |
34630 | + RF_WriteReg(dev, 0x07, 0x00ca); mdelay(1); | |
34631 | + RF_WriteReg(dev, 0x08, 0x0e1c); mdelay(1); | |
34632 | + RF_WriteReg(dev, 0x09, 0x02f0); mdelay(1); | |
34633 | + RF_WriteReg(dev, 0x0a, 0x09d0); mdelay(1); | |
34634 | + RF_WriteReg(dev, 0x0b, 0x01ba); mdelay(1); | |
34635 | + RF_WriteReg(dev, 0x0c, 0x0640); mdelay(1); | |
34636 | + RF_WriteReg(dev, 0x0d, 0x08df); mdelay(1); | |
34637 | + RF_WriteReg(dev, 0x0e, 0x0020); mdelay(1); | |
34638 | + RF_WriteReg(dev, 0x0f, 0x0990); mdelay(1); | |
34639 | + | |
34640 | + | |
34641 | + // Page1 : reg16-reg30 | |
34642 | + RF_WriteReg(dev, 0x00, 0x013f); mdelay(1); | |
34643 | + | |
34644 | + RF_WriteReg(dev, 0x03, 0x0806); mdelay(1); | |
34645 | + | |
34646 | + if(priv->card_8185 < VERSION_8187S_C) | |
34647 | + { | |
34648 | + RF_WriteReg(dev, 0x04, 0x03f7); mdelay(1); | |
34649 | + RF_WriteReg(dev, 0x05, 0x05ab); mdelay(1); | |
34650 | + RF_WriteReg(dev, 0x06, 0x00c1); mdelay(1); | |
34651 | + } | |
34652 | + else | |
34653 | + { | |
34654 | + RF_WriteReg(dev, 0x04, 0x03a7); mdelay(1); | |
34655 | + RF_WriteReg(dev, 0x05, 0x059b); mdelay(1); | |
34656 | + RF_WriteReg(dev, 0x06, 0x0081); mdelay(1); | |
34657 | + } | |
34658 | + | |
34659 | + | |
34660 | + RF_WriteReg(dev, 0x07, 0x01A0); mdelay(1); | |
34661 | +// Don't write RF23/RF24 to make a difference between 87S C cut and D cut. asked by SD3 stevenl. | |
34662 | +// RF_WriteReg(dev, 0x08, 0x0597); mdelay(1); | |
34663 | +// RF_WriteReg(dev, 0x09, 0x050a); mdelay(1); | |
34664 | + RF_WriteReg(dev, 0x0a, 0x0001); mdelay(1); | |
34665 | + RF_WriteReg(dev, 0x0b, 0x0418); mdelay(1); | |
34666 | + | |
34667 | + if(priv->card_8185 == VERSION_8187S_D) | |
34668 | + { | |
34669 | + RF_WriteReg(dev, 0x0c, 0x0fbe); mdelay(1); | |
34670 | + RF_WriteReg(dev, 0x0d, 0x0008); mdelay(1); | |
34671 | + RF_WriteReg(dev, 0x0e, 0x0807); mdelay(1); // RX LO buffer | |
34672 | + } | |
34673 | + else | |
34674 | + { | |
34675 | + RF_WriteReg(dev, 0x0c, 0x0fbe); mdelay(1); | |
34676 | + RF_WriteReg(dev, 0x0d, 0x0008); mdelay(1); | |
34677 | + RF_WriteReg(dev, 0x0e, 0x0806); mdelay(1); // RX LO buffer | |
34678 | + } | |
34679 | + | |
34680 | + RF_WriteReg(dev, 0x0f, 0x0acc); mdelay(1); | |
34681 | + | |
34682 | +// RF_WriteReg(dev, 0x00, 0x017f); mdelay(1);//6 | |
34683 | + RF_WriteReg(dev, 0x00, 0x01d7); mdelay(1);// 6 | |
34684 | + | |
34685 | + RF_WriteReg(dev, 0x03, 0x0e00); mdelay(1); | |
34686 | + RF_WriteReg(dev, 0x04, 0x0e50); mdelay(1); | |
34687 | + for(i=0;i<=36;i++) | |
34688 | + { | |
34689 | + RF_WriteReg(dev, 0x01, i); mdelay(1); | |
34690 | + RF_WriteReg(dev, 0x02, ZEBRA_RF_RX_GAIN_TABLE[i]); mdelay(1); | |
34691 | + //DbgPrint("RF - 0x%x = 0x%x", i, ZEBRA_RF_RX_GAIN_TABLE[i]); | |
34692 | + } | |
34693 | + | |
34694 | + RF_WriteReg(dev, 0x05, 0x0203); mdelay(1); /// 203, 343 | |
34695 | + //RF_WriteReg(dev, 0x06, 0x0300); mdelay(1); // 400 | |
34696 | + RF_WriteReg(dev, 0x06, 0x0200); mdelay(1); // 400 | |
34697 | + | |
34698 | + RF_WriteReg(dev, 0x00, 0x0137); mdelay(1); // switch to reg16-reg30, and HSSI disable 137 | |
34699 | + mdelay(10); // Deay 10 ms. //0xfd | |
34700 | + | |
34701 | +// RF_WriteReg(dev, 0x0c, 0x09be); mdelay(1); // 7 | |
34702 | + //RF_WriteReg(dev, 0x0c, 0x07be); mdelay(1); | |
34703 | + //mdelay(10); // Deay 10 ms. //0xfd | |
34704 | + | |
34705 | + RF_WriteReg(dev, 0x0d, 0x0008); mdelay(1); // Z4 synthesizer loop filter setting, 392 | |
34706 | + mdelay(10); // Deay 10 ms. //0xfd | |
34707 | + | |
34708 | + RF_WriteReg(dev, 0x00, 0x0037); mdelay(1); // switch to reg0-reg15, and HSSI disable | |
34709 | + mdelay(10); // Deay 10 ms. //0xfd | |
34710 | + | |
34711 | + RF_WriteReg(dev, 0x04, 0x0160); mdelay(1); // CBC on, Tx Rx disable, High gain | |
34712 | + mdelay(10); // Deay 10 ms. //0xfd | |
34713 | + | |
34714 | + RF_WriteReg(dev, 0x07, 0x0080); mdelay(1); // Z4 setted channel 1 | |
34715 | + mdelay(10); // Deay 10 ms. //0xfd | |
34716 | + | |
34717 | + RF_WriteReg(dev, 0x02, 0x088D); mdelay(1); // LC calibration | |
34718 | + mdelay(200); // Deay 200 ms. //0xfd | |
34719 | + mdelay(10); // Deay 10 ms. //0xfd | |
34720 | + mdelay(10); // Deay 10 ms. //0xfd | |
34721 | + | |
34722 | + RF_WriteReg(dev, 0x00, 0x0137); mdelay(1); // switch to reg16-reg30 137, and HSSI disable 137 | |
34723 | + mdelay(10); // Deay 10 ms. //0xfd | |
34724 | + | |
34725 | + RF_WriteReg(dev, 0x07, 0x0000); mdelay(1); | |
34726 | + RF_WriteReg(dev, 0x07, 0x0180); mdelay(1); | |
34727 | + RF_WriteReg(dev, 0x07, 0x0220); mdelay(1); | |
34728 | + RF_WriteReg(dev, 0x07, 0x03E0); mdelay(1); | |
34729 | + | |
34730 | + // DAC calibration off 20070702 | |
34731 | + RF_WriteReg(dev, 0x06, 0x00c1); mdelay(1); | |
34732 | + RF_WriteReg(dev, 0x0a, 0x0001); mdelay(1); | |
34733 | +//{by amy 080312 | |
34734 | + // For crystal calibration, added by Roger, 2007.12.11. | |
34735 | + if( priv->bXtalCalibration ) // reg 30. | |
34736 | + { // enable crystal calibration. | |
34737 | + // RF Reg[30], (1)Xin:[12:9], Xout:[8:5], addr[4:0]. | |
34738 | + // (2)PA Pwr delay timer[15:14], default: 2.4us, set BIT15=0 | |
34739 | + // (3)RF signal on/off when calibration[13], default: on, set BIT13=0. | |
34740 | + // So we should minus 4 BITs offset. | |
34741 | + RF_WriteReg(dev, 0x0f, (priv->XtalCal_Xin<<5)|(priv->XtalCal_Xout<<1)|BIT11|BIT9); mdelay(1); | |
34742 | + printk("ZEBRA_Config_85BASIC_HardCode(): (%02x)\n", | |
34743 | + (priv->XtalCal_Xin<<5) | (priv->XtalCal_Xout<<1) | BIT11| BIT9); | |
34744 | + } | |
34745 | + else | |
34746 | + { // using default value. Xin=6, Xout=6. | |
34747 | + RF_WriteReg(dev, 0x0f, 0x0acc); mdelay(1); | |
34748 | + } | |
34749 | +//by amy 080312 | |
34750 | +// RF_WriteReg(dev, 0x0f, 0x0acc); mdelay(1); //-by amy 080312 | |
34751 | + | |
34752 | + RF_WriteReg(dev, 0x00, 0x00bf); mdelay(1); // switch to reg0-reg15, and HSSI enable | |
34753 | +// RF_WriteReg(dev, 0x0d, 0x009f); mdelay(1); // Rx BB start calibration, 00c//-edward | |
34754 | + RF_WriteReg(dev, 0x0d, 0x08df); mdelay(1); // Rx BB start calibration, 00c//+edward | |
34755 | + RF_WriteReg(dev, 0x02, 0x004d); mdelay(1); // temperature meter off | |
34756 | + RF_WriteReg(dev, 0x04, 0x0975); mdelay(1); // Rx mode | |
34757 | + mdelay(10); // Deay 10 ms. //0xfe | |
34758 | + mdelay(10); // Deay 10 ms. //0xfe | |
34759 | + mdelay(10); // Deay 10 ms. //0xfe | |
34760 | + RF_WriteReg(dev, 0x00, 0x0197); mdelay(1); // Rx mode//+edward | |
34761 | + RF_WriteReg(dev, 0x05, 0x05ab); mdelay(1); // Rx mode//+edward | |
34762 | + RF_WriteReg(dev, 0x00, 0x009f); mdelay(1); // Rx mode//+edward | |
34763 | + | |
34764 | +#if 0//-edward | |
34765 | + RF_WriteReg(dev, 0x00, 0x0197); mdelay(1); | |
34766 | + RF_WriteReg(dev, 0x05, 0x05ab); mdelay(1); | |
34767 | + RF_WriteReg(dev, 0x00, 0x009F); mdelay(1); | |
34768 | +#endif | |
34769 | + RF_WriteReg(dev, 0x01, 0x0000); mdelay(1); // Rx mode//+edward | |
34770 | + RF_WriteReg(dev, 0x02, 0x0000); mdelay(1); // Rx mode//+edward | |
34771 | + //power save parameters. | |
34772 | + u1b24E = read_nic_byte(dev, 0x24E); | |
34773 | + write_nic_byte(dev, 0x24E, (u1b24E & (~(BIT5|BIT6)))); | |
34774 | + | |
34775 | + //============================================================================= | |
34776 | + | |
34777 | + //============================================================================= | |
34778 | + // CCKCONF.TXT | |
34779 | + //============================================================================= | |
34780 | + | |
34781 | + /* [POWER SAVE] Power Saving Parameters by jong. 2007-11-27 | |
34782 | + CCK reg0x00[7]=1'b1 :power saving for TX (default) | |
34783 | + CCK reg0x00[6]=1'b1: power saving for RX (default) | |
34784 | + CCK reg0x06[4]=1'b1: turn off channel estimation related circuits if not doing channel estimation. | |
34785 | + CCK reg0x06[3]=1'b1: turn off unused circuits before cca = 1 | |
34786 | + CCK reg0x06[2]=1'b1: turn off cck's circuit if macrst =0 | |
34787 | + */ | |
34788 | +#if 0 | |
34789 | + write_nic_dword(dev, PHY_ADR, 0x0100c880); | |
34790 | + write_nic_dword(dev, PHY_ADR, 0x01001c86); | |
34791 | + write_nic_dword(dev, PHY_ADR, 0x01007890); | |
34792 | + write_nic_dword(dev, PHY_ADR, 0x0100d0ae); | |
34793 | + write_nic_dword(dev, PHY_ADR, 0x010006af); | |
34794 | + write_nic_dword(dev, PHY_ADR, 0x01004681); | |
34795 | +#endif | |
34796 | + write_phy_cck(dev,0x00,0xc8); | |
34797 | + write_phy_cck(dev,0x06,0x1c); | |
34798 | + write_phy_cck(dev,0x10,0x78); | |
34799 | + write_phy_cck(dev,0x2e,0xd0); | |
34800 | + write_phy_cck(dev,0x2f,0x06); | |
34801 | + write_phy_cck(dev,0x01,0x46); | |
34802 | + | |
34803 | + // power control | |
34804 | + write_nic_byte(dev, CCK_TXAGC, 0x10); | |
34805 | + write_nic_byte(dev, OFDM_TXAGC, 0x1B); | |
34806 | + write_nic_byte(dev, ANTSEL, 0x03); | |
34807 | +#else | |
34808 | + //============================================================================= | |
34809 | + // RADIOCFG.TXT | |
34810 | + //============================================================================= | |
34811 | + | |
34812 | + RF_WriteReg(dev, 0x00, 0x00b7); mdelay(1); | |
34813 | + RF_WriteReg(dev, 0x01, 0x0ee0); mdelay(1); | |
34814 | + RF_WriteReg(dev, 0x02, 0x044d); mdelay(1); | |
34815 | + RF_WriteReg(dev, 0x03, 0x0441); mdelay(1); | |
34816 | + RF_WriteReg(dev, 0x04, 0x08c3); mdelay(1); | |
34817 | + RF_WriteReg(dev, 0x05, 0x0c72); mdelay(1); | |
34818 | + RF_WriteReg(dev, 0x06, 0x00e6); mdelay(1); | |
34819 | + RF_WriteReg(dev, 0x07, 0x082a); mdelay(1); | |
34820 | + RF_WriteReg(dev, 0x08, 0x003f); mdelay(1); | |
34821 | + RF_WriteReg(dev, 0x09, 0x0335); mdelay(1); | |
34822 | + RF_WriteReg(dev, 0x0a, 0x09d4); mdelay(1); | |
34823 | + RF_WriteReg(dev, 0x0b, 0x07bb); mdelay(1); | |
34824 | + RF_WriteReg(dev, 0x0c, 0x0850); mdelay(1); | |
34825 | + RF_WriteReg(dev, 0x0d, 0x0cdf); mdelay(1); | |
34826 | + RF_WriteReg(dev, 0x0e, 0x002b); mdelay(1); | |
34827 | + RF_WriteReg(dev, 0x0f, 0x0114); mdelay(1); | |
34828 | + | |
34829 | + RF_WriteReg(dev, 0x00, 0x01b7); mdelay(1); | |
34830 | + | |
34831 | + | |
34832 | + for(i=1;i<=95;i++) | |
34833 | + { | |
34834 | + RF_WriteReg(dev, 0x01, i); mdelay(1); | |
34835 | + RF_WriteReg(dev, 0x02, ZEBRA_RF_RX_GAIN_TABLE[i]); mdelay(1); | |
34836 | + //DbgPrint("RF - 0x%x = 0x%x", i, ZEBRA_RF_RX_GAIN_TABLE[i]); | |
34837 | + } | |
34838 | + | |
34839 | + RF_WriteReg(dev, 0x03, 0x0080); mdelay(1); // write reg 18 | |
34840 | + RF_WriteReg(dev, 0x05, 0x0004); mdelay(1); // write reg 20 | |
34841 | + RF_WriteReg(dev, 0x00, 0x00b7); mdelay(1); // switch to reg0-reg15 | |
34842 | + //0xfd | |
34843 | + //0xfd | |
34844 | + //0xfd | |
34845 | + RF_WriteReg(dev, 0x02, 0x0c4d); mdelay(1); | |
34846 | + mdelay(100); // Deay 100 ms. //0xfe | |
34847 | + mdelay(100); // Deay 100 ms. //0xfe | |
34848 | + RF_WriteReg(dev, 0x02, 0x044d); mdelay(1); | |
34849 | + RF_WriteReg(dev, 0x00, 0x02bf); mdelay(1); //0x002f disable 6us corner change, 06f--> enable | |
34850 | + | |
34851 | + //============================================================================= | |
34852 | + | |
34853 | + //============================================================================= | |
34854 | + // CCKCONF.TXT | |
34855 | + //============================================================================= | |
34856 | + | |
34857 | + //============================================================================= | |
34858 | + | |
34859 | + //============================================================================= | |
34860 | + // Follow WMAC RTL8225_Config() | |
34861 | + //============================================================================= | |
34862 | + | |
34863 | + // power control | |
34864 | + write_nic_byte(dev, CCK_TXAGC, 0x03); | |
34865 | + write_nic_byte(dev, OFDM_TXAGC, 0x07); | |
34866 | + write_nic_byte(dev, ANTSEL, 0x03); | |
34867 | + | |
34868 | + //============================================================================= | |
34869 | + | |
34870 | + // OFDM BBP setup | |
34871 | +// SetOutputEnableOfRfPins(dev);//by amy | |
34872 | +#endif | |
34873 | + | |
34874 | + | |
34875 | + | |
34876 | + //============================================================================= | |
34877 | + // AGC.txt | |
34878 | + //============================================================================= | |
34879 | + | |
34880 | +// PlatformIOWrite4Byte( dev, PhyAddr, 0x00001280); // Annie, 2006-05-05 | |
34881 | + write_phy_ofdm(dev, 0x00, 0x12); | |
34882 | + //WriteBBPortUchar(dev, 0x00001280); | |
34883 | + | |
34884 | + for (i=0; i<128; i++) | |
34885 | + { | |
34886 | + //DbgPrint("AGC - [%x+1] = 0x%x\n", i, ZEBRA_AGC[i+1]); | |
34887 | + | |
34888 | + data = ZEBRA_AGC[i+1]; | |
34889 | + data = data << 8; | |
34890 | + data = data | 0x0000008F; | |
34891 | + | |
34892 | + addr = i + 0x80; //enable writing AGC table | |
34893 | + addr = addr << 8; | |
34894 | + addr = addr | 0x0000008E; | |
34895 | + | |
34896 | + WriteBBPortUchar(dev, data); | |
34897 | + WriteBBPortUchar(dev, addr); | |
34898 | + WriteBBPortUchar(dev, 0x0000008E); | |
34899 | + } | |
34900 | + | |
34901 | + PlatformIOWrite4Byte( dev, PhyAddr, 0x00001080); // Annie, 2006-05-05 | |
34902 | + //WriteBBPortUchar(dev, 0x00001080); | |
34903 | + | |
34904 | + //============================================================================= | |
34905 | + | |
34906 | + //============================================================================= | |
34907 | + // OFDMCONF.TXT | |
34908 | + //============================================================================= | |
34909 | + | |
34910 | + for(i=0; i<60; i++) | |
34911 | + { | |
34912 | + u4bRegOffset=i; | |
34913 | + u4bRegValue=OFDM_CONFIG[i]; | |
34914 | + | |
34915 | + //DbgPrint("OFDM - 0x%x = 0x%x\n", u4bRegOffset, u4bRegValue); | |
34916 | + | |
34917 | + WriteBBPortUchar(dev, | |
34918 | + (0x00000080 | | |
34919 | + (u4bRegOffset & 0x7f) | | |
34920 | + ((u4bRegValue & 0xff) << 8))); | |
34921 | + } | |
34922 | + | |
34923 | + //============================================================================= | |
34924 | +//by amy for antenna | |
34925 | + //============================================================================= | |
34926 | +//{by amy 080312 | |
34927 | +#ifdef CONFIG_RTL818X_S | |
34928 | + // Config Sw/Hw Combinational Antenna Diversity. Added by Roger, 2008.02.26. | |
34929 | + SetAntennaConfig87SE(dev, priv->bDefaultAntenna1, priv->bSwAntennaDiverity); | |
34930 | +#endif | |
34931 | +//by amy 080312} | |
34932 | +#if 0 | |
34933 | + // Config Sw/Hw Antenna Diversity | |
34934 | + if( priv->bSwAntennaDiverity ) // Use SW+Hw Antenna Diversity | |
34935 | + { | |
34936 | + if( priv->bDefaultAntenna1 == true ) // aux antenna | |
34937 | + { | |
34938 | + // Mac register, aux antenna | |
34939 | + write_nic_byte(dev, ANTSEL, 0x00); | |
34940 | + // Config CCK RX antenna. | |
34941 | + write_phy_cck(dev, 0x11, 0xbb); // Reg11 : bb | |
34942 | + write_phy_cck(dev, 0x0c, 0x09); // Reg0c : 09 | |
34943 | + write_phy_cck(dev, 0x01, 0xc7); // Reg01 : c7 | |
34944 | + // Config OFDM RX antenna. | |
34945 | + write_phy_ofdm(dev, 0x0d, 0x54); // Reg0d : 54 | |
34946 | + write_phy_ofdm(dev, 0x18, 0xb2); // Reg18 : b2 | |
34947 | + } | |
34948 | + else // main antenna | |
34949 | + { | |
34950 | + // Mac register, main antenna | |
34951 | + write_nic_byte(dev, ANTSEL, 0x03); | |
34952 | + //base band | |
34953 | + // Config CCK RX antenna. | |
34954 | + write_phy_cck(dev, 0x11, 0x9b); // Reg11 : 9b | |
34955 | + write_phy_cck(dev, 0x0c, 0x09); // Reg0c : 09 | |
34956 | + write_phy_cck(dev, 0x01, 0xc7); // Reg01 : c7 | |
34957 | + // Config OFDM RX antenna. | |
34958 | + write_phy_ofdm(dev, 0x0d, 0x5c); // Reg0d : 5c | |
34959 | + write_phy_ofdm(dev, 0x18, 0xb2); // Reg18 : b2 | |
34960 | + } | |
34961 | + } | |
34962 | + else // Disable Antenna Diversity | |
34963 | + { | |
34964 | + if( priv->bDefaultAntenna1 == true ) // aux Antenna | |
34965 | + { | |
34966 | + // Mac register, aux antenna | |
34967 | + write_nic_byte(dev, ANTSEL, 0x00); | |
34968 | + // Config CCK RX antenna. | |
34969 | + write_phy_cck(dev, 0x11, 0xbb); // Reg11 : bb | |
34970 | + write_phy_cck(dev, 0x0c, 0x09); // Reg0c : 09 | |
34971 | + write_phy_cck(dev, 0x01, 0x47); // Reg01 : 47 | |
34972 | + // Config OFDM RX antenna. | |
34973 | + write_phy_ofdm(dev, 0x0d, 0x54); // Reg0d : 54 | |
34974 | + write_phy_ofdm(dev, 0x18, 0x32); // Reg18 : 32 | |
34975 | + } | |
34976 | + else // main Antenna | |
34977 | + { | |
34978 | + // Mac register, main antenna | |
34979 | + write_nic_byte(dev, ANTSEL, 0x03); | |
34980 | + // Config CCK RX antenna. | |
34981 | + write_phy_cck(dev, 0x11, 0x9b); // Reg11 : 9b | |
34982 | + write_phy_cck(dev, 0x0c, 0x09); // Reg0c : 09 | |
34983 | + write_phy_cck(dev, 0x01, 0x47); // Reg01 : 47 | |
34984 | + // Config OFDM RX antenna. | |
34985 | + write_phy_ofdm(dev, 0x0d, 0x5c); // Reg0d : 5c | |
34986 | + write_phy_ofdm(dev, 0x18, 0x32); // Reg18 : 32 | |
34987 | + } | |
34988 | + } | |
34989 | +#endif | |
34990 | +//by amy for antenna | |
34991 | +} | |
34992 | + | |
34993 | + | |
34994 | +void | |
34995 | +UpdateInitialGain( | |
34996 | + struct net_device *dev | |
34997 | + ) | |
34998 | +{ | |
34999 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
35000 | + //unsigned char* IGTable; | |
35001 | + //u8 DIG_CurrentInitialGain = 4; | |
35002 | + //unsigned char u1Tmp; | |
35003 | + | |
35004 | + //lzm add 080826 | |
35005 | + if(priv->eRFPowerState != eRfOn) | |
35006 | + { | |
35007 | + //Don't access BB/RF under disable PLL situation. | |
35008 | + //RT_TRACE(COMP_DIG, DBG_LOUD, ("UpdateInitialGain - pHalData->eRFPowerState!=eRfOn\n")); | |
35009 | + // Back to the original state | |
35010 | + priv->InitialGain= priv->InitialGainBackUp; | |
35011 | + return; | |
35012 | + } | |
35013 | + | |
35014 | + switch(priv->rf_chip) | |
35015 | + { | |
35016 | +#if 0 | |
35017 | + case RF_ZEBRA2: | |
35018 | + // Dynamic set initial gain, by shien chang, 2006.07.14 | |
35019 | + switch(priv->InitialGain) | |
35020 | + { | |
35021 | + case 1: //m861dBm | |
35022 | + DMESG("RTL8185B + 8225 Initial Gain State 1: -82 dBm \n"); | |
35023 | + write_nic_dword(dev, PhyAddr, 0x2697); mdelay(1); | |
35024 | + write_nic_dword(dev, PhyAddr, 0x86a4); mdelay(1); | |
35025 | + write_nic_dword(dev, PhyAddr, 0xfa85); mdelay(1); | |
35026 | + break; | |
35027 | + | |
35028 | + case 2: //m862dBm | |
35029 | + DMESG("RTL8185B + 8225 Initial Gain State 2: -82 dBm \n"); | |
35030 | + write_nic_dword(dev, PhyAddr, 0x2697); mdelay(1); | |
35031 | + write_nic_dword(dev, PhyAddr, 0x86a4); mdelay(1); | |
35032 | + write_nic_dword(dev, PhyAddr, 0xfb85); mdelay(1); | |
35033 | + break; | |
35034 | + | |
35035 | + case 3: //m863dBm | |
35036 | + DMESG("RTL8185B + 8225 Initial Gain State 3: -82 dBm \n"); | |
35037 | + write_nic_dword(dev, PhyAddr, 0x2697); mdelay(1); | |
35038 | + write_nic_dword(dev, PhyAddr, 0x96a4); mdelay(1); | |
35039 | + write_nic_dword(dev, PhyAddr, 0xfb85); mdelay(1); | |
35040 | + break; | |
35041 | + | |
35042 | + case 4: //m864dBm | |
35043 | + DMESG("RTL8185B + 8225 Initial Gain State 4: -78 dBm \n"); | |
35044 | + write_nic_dword(dev, PhyAddr, 0x2697); mdelay(1); | |
35045 | + write_nic_dword(dev, PhyAddr, 0xa6a4); mdelay(1); | |
35046 | + write_nic_dword(dev, PhyAddr, 0xfb85); mdelay(1); | |
35047 | + break; | |
35048 | + | |
35049 | + case 5: //m82dBm | |
35050 | + DMESG("RTL8185B + 8225 Initial Gain State 5: -74 dBm \n"); | |
35051 | + write_nic_dword(dev, PhyAddr, 0x3697); mdelay(1); | |
35052 | + write_nic_dword(dev, PhyAddr, 0xa6a4); mdelay(1); | |
35053 | + write_nic_dword(dev, PhyAddr, 0xfb85); mdelay(1); | |
35054 | + break; | |
35055 | + | |
35056 | + case 6: //m78dBm | |
35057 | + DMESG("RTL8185B + 8225 Initial Gain State 6: -70 dBm \n"); | |
35058 | + write_nic_dword(dev, PhyAddr, 0x4697); mdelay(1); | |
35059 | + write_nic_dword(dev, PhyAddr, 0xa6a4); mdelay(1); | |
35060 | + write_nic_dword(dev, PhyAddr, 0xfb85); mdelay(1); | |
35061 | + break; | |
35062 | + | |
35063 | + case 7: //m74dBm | |
35064 | + DMESG("RTL8185B + 8225 Initial Gain State 7: -66 dBm \n"); | |
35065 | + write_nic_dword(dev, PhyAddr, 0x5697); mdelay(1); | |
35066 | + write_nic_dword(dev, PhyAddr, 0xa6a4); mdelay(1); | |
35067 | + write_nic_dword(dev, PhyAddr, 0xfb85); mdelay(1); | |
35068 | + break; | |
35069 | + | |
35070 | + default: //MP | |
35071 | + DMESG("RTL8185B + 8225 Initial Gain State 1: -82 dBm (default)\n"); | |
35072 | + write_nic_dword(dev, PhyAddr, 0x2697); mdelay(1); | |
35073 | + write_nic_dword(dev, PhyAddr, 0x86a4); mdelay(1); | |
35074 | + write_nic_dword(dev, PhyAddr, 0xfa85); mdelay(1); | |
35075 | + break; | |
35076 | + } | |
35077 | + break; | |
35078 | +#endif | |
35079 | + case RF_ZEBRA4: | |
35080 | + // Dynamic set initial gain, follow 87B | |
35081 | + switch(priv->InitialGain) | |
35082 | + { | |
35083 | + case 1: //m861dBm | |
35084 | + //DMESG("RTL8187 + 8225 Initial Gain State 1: -82 dBm \n"); | |
35085 | + write_phy_ofdm(dev, 0x17, 0x26); mdelay(1); | |
35086 | + write_phy_ofdm(dev, 0x24, 0x86); mdelay(1); | |
35087 | + write_phy_ofdm(dev, 0x05, 0xfa); mdelay(1); | |
35088 | + break; | |
35089 | + | |
35090 | + case 2: //m862dBm | |
35091 | + //DMESG("RTL8187 + 8225 Initial Gain State 2: -82 dBm \n"); | |
35092 | + write_phy_ofdm(dev, 0x17, 0x36); mdelay(1); | |
35093 | + write_phy_ofdm(dev, 0x24, 0x86); mdelay(1); | |
35094 | + write_phy_ofdm(dev, 0x05, 0xfa); mdelay(1); | |
35095 | + break; | |
35096 | + | |
35097 | + case 3: //m863dBm | |
35098 | + //DMESG("RTL8187 + 8225 Initial Gain State 3: -82 dBm \n"); | |
35099 | + write_phy_ofdm(dev, 0x17, 0x36); mdelay(1); | |
35100 | + write_phy_ofdm(dev, 0x24, 0x86); mdelay(1); | |
35101 | + write_phy_ofdm(dev, 0x05, 0xfb); mdelay(1); | |
35102 | + break; | |
35103 | + | |
35104 | + case 4: //m864dBm | |
35105 | + //DMESG("RTL8187 + 8225 Initial Gain State 4: -78 dBm \n"); | |
35106 | + write_phy_ofdm(dev, 0x17, 0x46); mdelay(1); | |
35107 | + write_phy_ofdm(dev, 0x24, 0x86); mdelay(1); | |
35108 | + write_phy_ofdm(dev, 0x05, 0xfb); mdelay(1); | |
35109 | + break; | |
35110 | + | |
35111 | + case 5: //m82dBm | |
35112 | + //DMESG("RTL8187 + 8225 Initial Gain State 5: -74 dBm \n"); | |
35113 | + write_phy_ofdm(dev, 0x17, 0x46); mdelay(1); | |
35114 | + write_phy_ofdm(dev, 0x24, 0x96); mdelay(1); | |
35115 | + write_phy_ofdm(dev, 0x05, 0xfb); mdelay(1); | |
35116 | + break; | |
35117 | + | |
35118 | + case 6: //m78dBm | |
35119 | + //DMESG ("RTL8187 + 8225 Initial Gain State 6: -70 dBm \n"); | |
35120 | + write_phy_ofdm(dev, 0x17, 0x56); mdelay(1); | |
35121 | + write_phy_ofdm(dev, 0x24, 0x96); mdelay(1); | |
35122 | + write_phy_ofdm(dev, 0x05, 0xfc); mdelay(1); | |
35123 | + break; | |
35124 | + | |
35125 | + case 7: //m74dBm | |
35126 | + //DMESG("RTL8187 + 8225 Initial Gain State 7: -66 dBm \n"); | |
35127 | + write_phy_ofdm(dev, 0x17, 0x56); mdelay(1); | |
35128 | + write_phy_ofdm(dev, 0x24, 0xa6); mdelay(1); | |
35129 | + write_phy_ofdm(dev, 0x05, 0xfc); mdelay(1); | |
35130 | + break; | |
35131 | + | |
35132 | + case 8: | |
35133 | + //DMESG("RTL8187 + 8225 Initial Gain State 8:\n"); | |
35134 | + write_phy_ofdm(dev, 0x17, 0x66); mdelay(1); | |
35135 | + write_phy_ofdm(dev, 0x24, 0xb6); mdelay(1); | |
35136 | + write_phy_ofdm(dev, 0x05, 0xfc); mdelay(1); | |
35137 | + break; | |
35138 | + | |
35139 | + | |
35140 | + default: //MP | |
35141 | + //DMESG("RTL8187 + 8225 Initial Gain State 1: -82 dBm (default)\n"); | |
35142 | + write_phy_ofdm(dev, 0x17, 0x26); mdelay(1); | |
35143 | + write_phy_ofdm(dev, 0x24, 0x86); mdelay(1); | |
35144 | + write_phy_ofdm(dev, 0x05, 0xfa); mdelay(1); | |
35145 | + break; | |
35146 | + } | |
35147 | + break; | |
35148 | + | |
35149 | + | |
35150 | + default: | |
35151 | + DMESG("UpdateInitialGain(): unknown RFChipID: %#X\n", priv->rf_chip); | |
35152 | + break; | |
35153 | + } | |
35154 | +} | |
35155 | +#ifdef CONFIG_RTL818X_S | |
35156 | +// | |
35157 | +// Description: | |
35158 | +// Tx Power tracking mechanism routine on 87SE. | |
35159 | +// Created by Roger, 2007.12.11. | |
35160 | +// | |
35161 | +void | |
35162 | +InitTxPwrTracking87SE( | |
35163 | + struct net_device *dev | |
35164 | +) | |
35165 | +{ | |
35166 | + //struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
35167 | + u32 u4bRfReg; | |
35168 | + | |
35169 | + u4bRfReg = RF_ReadReg(dev, 0x02); | |
35170 | + | |
35171 | + // Enable Thermal meter indication. | |
35172 | + //printk("InitTxPwrTracking87SE(): Enable thermal meter indication, Write RF[0x02] = %#x", u4bRfReg|PWR_METER_EN); | |
35173 | + RF_WriteReg(dev, 0x02, u4bRfReg|PWR_METER_EN); mdelay(1); | |
35174 | +} | |
35175 | + | |
35176 | +#endif | |
35177 | +void | |
35178 | +PhyConfig8185( | |
35179 | + struct net_device *dev | |
35180 | + ) | |
35181 | +{ | |
35182 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
35183 | + write_nic_dword(dev, RCR, priv->ReceiveConfig); | |
35184 | + priv->RFProgType = read_nic_byte(dev, CONFIG4) & 0x03; | |
35185 | + // RF config | |
35186 | + switch(priv->rf_chip) | |
35187 | + { | |
35188 | + case RF_ZEBRA2: | |
35189 | + case RF_ZEBRA4: | |
35190 | + ZEBRA_Config_85BASIC_HardCode( dev); | |
35191 | + break; | |
35192 | + } | |
35193 | +//{by amy 080312 | |
35194 | +#ifdef CONFIG_RTL818X_S | |
35195 | + // Set default initial gain state to 4, approved by SD3 DZ, by Bruce, 2007-06-06. | |
35196 | + if(priv->bDigMechanism) | |
35197 | + { | |
35198 | + if(priv->InitialGain == 0) | |
35199 | + priv->InitialGain = 4; | |
35200 | + //printk("PhyConfig8185(): DIG is enabled, set default initial gain index to %d\n", priv->InitialGain); | |
35201 | + } | |
35202 | + | |
35203 | + // | |
35204 | + // Enable thermal meter indication to implement TxPower tracking on 87SE. | |
35205 | + // We initialize thermal meter here to avoid unsuccessful configuration. | |
35206 | + // Added by Roger, 2007.12.11. | |
35207 | + // | |
35208 | + if(priv->bTxPowerTrack) | |
35209 | + InitTxPwrTracking87SE(dev); | |
35210 | + | |
35211 | +#endif | |
35212 | +//by amy 080312} | |
35213 | + priv->InitialGainBackUp= priv->InitialGain; | |
35214 | + UpdateInitialGain(dev); | |
35215 | + | |
35216 | + return; | |
35217 | +} | |
35218 | + | |
35219 | + | |
35220 | + | |
35221 | + | |
35222 | +void | |
35223 | +HwConfigureRTL8185( | |
35224 | + struct net_device *dev | |
35225 | + ) | |
35226 | +{ | |
35227 | + //RTL8185_TODO: Determine Retrylimit, TxAGC, AutoRateFallback control. | |
35228 | +// u8 bUNIVERSAL_CONTROL_RL = 1; | |
35229 | + u8 bUNIVERSAL_CONTROL_RL = 0; | |
35230 | + | |
35231 | + u8 bUNIVERSAL_CONTROL_AGC = 1; | |
35232 | + u8 bUNIVERSAL_CONTROL_ANT = 1; | |
35233 | + u8 bAUTO_RATE_FALLBACK_CTL = 1; | |
35234 | + u8 val8; | |
35235 | + //struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
35236 | + //struct ieee80211_device *ieee = priv->ieee80211; | |
35237 | + //if(IS_WIRELESS_MODE_A(dev) || IS_WIRELESS_MODE_G(dev)) | |
35238 | +//{by amy 080312 if((ieee->mode == IEEE_G)||(ieee->mode == IEEE_A)) | |
35239 | +// { | |
35240 | +// write_nic_word(dev, BRSR, 0xffff); | |
35241 | +// } | |
35242 | +// else | |
35243 | +// { | |
35244 | +// write_nic_word(dev, BRSR, 0x000f); | |
35245 | +// } | |
35246 | +//by amy 080312} | |
35247 | + write_nic_word(dev, BRSR, 0x0fff); | |
35248 | + // Retry limit | |
35249 | + val8 = read_nic_byte(dev, CW_CONF); | |
35250 | + | |
35251 | + if(bUNIVERSAL_CONTROL_RL) | |
35252 | + val8 = val8 & 0xfd; | |
35253 | + else | |
35254 | + val8 = val8 | 0x02; | |
35255 | + | |
35256 | + write_nic_byte(dev, CW_CONF, val8); | |
35257 | + | |
35258 | + // Tx AGC | |
35259 | + val8 = read_nic_byte(dev, TXAGC_CTL); | |
35260 | + if(bUNIVERSAL_CONTROL_AGC) | |
35261 | + { | |
35262 | + write_nic_byte(dev, CCK_TXAGC, 128); | |
35263 | + write_nic_byte(dev, OFDM_TXAGC, 128); | |
35264 | + val8 = val8 & 0xfe; | |
35265 | + } | |
35266 | + else | |
35267 | + { | |
35268 | + val8 = val8 | 0x01 ; | |
35269 | + } | |
35270 | + | |
35271 | + | |
35272 | + write_nic_byte(dev, TXAGC_CTL, val8); | |
35273 | + | |
35274 | + // Tx Antenna including Feedback control | |
35275 | + val8 = read_nic_byte(dev, TXAGC_CTL ); | |
35276 | + | |
35277 | + if(bUNIVERSAL_CONTROL_ANT) | |
35278 | + { | |
35279 | + write_nic_byte(dev, ANTSEL, 0x00); | |
35280 | + val8 = val8 & 0xfd; | |
35281 | + } | |
35282 | + else | |
35283 | + { | |
35284 | + val8 = val8 & (val8|0x02); //xiong-2006-11-15 | |
35285 | + } | |
35286 | + | |
35287 | + write_nic_byte(dev, TXAGC_CTL, val8); | |
35288 | + | |
35289 | + // Auto Rate fallback control | |
35290 | + val8 = read_nic_byte(dev, RATE_FALLBACK); | |
35291 | + val8 &= 0x7c; | |
35292 | + if( bAUTO_RATE_FALLBACK_CTL ) | |
35293 | + { | |
35294 | + val8 |= RATE_FALLBACK_CTL_ENABLE | RATE_FALLBACK_CTL_AUTO_STEP1; | |
35295 | + | |
35296 | + // <RJ_TODO_8185B> We shall set up the ARFR according to user's setting. | |
35297 | + //write_nic_word(dev, ARFR, 0x0fff); // set 1M ~ 54M | |
35298 | +//by amy | |
35299 | +#if 0 | |
35300 | + PlatformIOWrite2Byte(dev, ARFR, 0x0fff); // set 1M ~ 54M | |
35301 | +#endif | |
35302 | +#ifdef CONFIG_RTL818X_S | |
35303 | + // Aadded by Roger, 2007.11.15. | |
35304 | + PlatformIOWrite2Byte(dev, ARFR, 0x0fff); //set 1M ~ 54Mbps. | |
35305 | +#else | |
35306 | + PlatformIOWrite2Byte(dev, ARFR, 0x0c00); //set 48Mbps, 54Mbps. | |
35307 | + // By SD3 szuyi's request. by Roger, 2007.03.26. | |
35308 | +#endif | |
35309 | +//by amy | |
35310 | + } | |
35311 | + else | |
35312 | + { | |
35313 | + } | |
35314 | + write_nic_byte(dev, RATE_FALLBACK, val8); | |
35315 | +} | |
35316 | + | |
35317 | + | |
35318 | + | |
35319 | +static void | |
35320 | +MacConfig_85BASIC_HardCode( | |
35321 | + struct net_device *dev) | |
35322 | +{ | |
35323 | + //============================================================================ | |
35324 | + // MACREG.TXT | |
35325 | + //============================================================================ | |
35326 | + int nLinesRead = 0; | |
35327 | + | |
35328 | + u32 u4bRegOffset, u4bRegValue,u4bPageIndex = 0; | |
35329 | + int i; | |
35330 | + | |
35331 | + nLinesRead=sizeof(MAC_REG_TABLE)/2; | |
35332 | + | |
35333 | + for(i = 0; i < nLinesRead; i++) //nLinesRead=101 | |
35334 | + { | |
35335 | + u4bRegOffset=MAC_REG_TABLE[i][0]; | |
35336 | + u4bRegValue=MAC_REG_TABLE[i][1]; | |
35337 | + | |
35338 | + if(u4bRegOffset == 0x5e) | |
35339 | + { | |
35340 | + u4bPageIndex = u4bRegValue; | |
35341 | + } | |
35342 | + else | |
35343 | + { | |
35344 | + u4bRegOffset |= (u4bPageIndex << 8); | |
35345 | + } | |
35346 | + //DbgPrint("MAC - 0x%x = 0x%x\n", u4bRegOffset, u4bRegValue); | |
35347 | + write_nic_byte(dev, u4bRegOffset, (u8)u4bRegValue); | |
35348 | + } | |
35349 | + //============================================================================ | |
35350 | +} | |
35351 | + | |
35352 | + | |
35353 | + | |
35354 | +static void | |
35355 | +MacConfig_85BASIC( | |
35356 | + struct net_device *dev) | |
35357 | +{ | |
35358 | + | |
35359 | + u8 u1DA; | |
35360 | + MacConfig_85BASIC_HardCode(dev); | |
35361 | + | |
35362 | + //============================================================================ | |
35363 | + | |
35364 | + // Follow TID_AC_MAP of WMac. | |
35365 | + write_nic_word(dev, TID_AC_MAP, 0xfa50); | |
35366 | + | |
35367 | + // Interrupt Migration, Jong suggested we use set 0x0000 first, 2005.12.14, by rcnjko. | |
35368 | + write_nic_word(dev, IntMig, 0x0000); | |
35369 | + | |
35370 | + // Prevent TPC to cause CRC error. Added by Annie, 2006-06-10. | |
35371 | + PlatformIOWrite4Byte(dev, 0x1F0, 0x00000000); | |
35372 | + PlatformIOWrite4Byte(dev, 0x1F4, 0x00000000); | |
35373 | + PlatformIOWrite1Byte(dev, 0x1F8, 0x00); | |
35374 | + | |
35375 | + // Asked for by SD3 CM Lin, 2006.06.27, by rcnjko. | |
35376 | + //PlatformIOWrite4Byte(dev, RFTiming, 0x00004001); | |
35377 | +//by amy | |
35378 | +#if 0 | |
35379 | + write_nic_dword(dev, RFTiming, 0x00004001); | |
35380 | +#endif | |
35381 | +#ifdef CONFIG_RTL818X_S | |
35382 | + // power save parameter based on "87SE power save parameters 20071127.doc", as follow. | |
35383 | + | |
35384 | + //Enable DA10 TX power saving | |
35385 | + u1DA = read_nic_byte(dev, PHYPR); | |
35386 | + write_nic_byte(dev, PHYPR, (u1DA | BIT2) ); | |
35387 | + | |
35388 | + //POWER: | |
35389 | + write_nic_word(dev, 0x360, 0x1000); | |
35390 | + write_nic_word(dev, 0x362, 0x1000); | |
35391 | + | |
35392 | + // AFE. | |
35393 | + write_nic_word(dev, 0x370, 0x0560); | |
35394 | + write_nic_word(dev, 0x372, 0x0560); | |
35395 | + write_nic_word(dev, 0x374, 0x0DA4); | |
35396 | + write_nic_word(dev, 0x376, 0x0DA4); | |
35397 | + write_nic_word(dev, 0x378, 0x0560); | |
35398 | + write_nic_word(dev, 0x37A, 0x0560); | |
35399 | + write_nic_word(dev, 0x37C, 0x00EC); | |
35400 | +// write_nic_word(dev, 0x37E, 0x00FE);//-edward | |
35401 | + write_nic_word(dev, 0x37E, 0x00EC);//+edward | |
35402 | +#else | |
35403 | + write_nic_dword(dev, RFTiming, 0x00004003); | |
35404 | +#endif | |
35405 | + write_nic_byte(dev, 0x24E,0x01); | |
35406 | +//by amy | |
35407 | + | |
35408 | +} | |
35409 | + | |
35410 | + | |
35411 | + | |
35412 | + | |
35413 | +u8 | |
35414 | +GetSupportedWirelessMode8185( | |
35415 | + struct net_device *dev | |
35416 | +) | |
35417 | +{ | |
35418 | + u8 btSupportedWirelessMode = 0; | |
35419 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
35420 | + | |
35421 | + switch(priv->rf_chip) | |
35422 | + { | |
35423 | + case RF_ZEBRA2: | |
35424 | + case RF_ZEBRA4: | |
35425 | + btSupportedWirelessMode = (WIRELESS_MODE_B | WIRELESS_MODE_G); | |
35426 | + break; | |
35427 | + default: | |
35428 | + btSupportedWirelessMode = WIRELESS_MODE_B; | |
35429 | + break; | |
35430 | + } | |
35431 | + | |
35432 | + return btSupportedWirelessMode; | |
35433 | +} | |
35434 | + | |
35435 | +void | |
35436 | +ActUpdateChannelAccessSetting( | |
35437 | + struct net_device *dev, | |
35438 | + WIRELESS_MODE WirelessMode, | |
35439 | + PCHANNEL_ACCESS_SETTING ChnlAccessSetting | |
35440 | + ) | |
35441 | +{ | |
35442 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
35443 | + struct ieee80211_device *ieee = priv->ieee80211; | |
35444 | + AC_CODING eACI; | |
35445 | + AC_PARAM AcParam; | |
35446 | + //PSTA_QOS pStaQos = Adapter->MgntInfo.pStaQos; | |
35447 | + u8 bFollowLegacySetting = 0; | |
35448 | + u8 u1bAIFS; | |
35449 | + | |
35450 | + // | |
35451 | + // <RJ_TODO_8185B> | |
35452 | + // TODO: We still don't know how to set up these registers, just follow WMAC to | |
35453 | + // verify 8185B FPAG. | |
35454 | + // | |
35455 | + // <RJ_TODO_8185B> | |
35456 | + // Jong said CWmin/CWmax register are not functional in 8185B, | |
35457 | + // so we shall fill channel access realted register into AC parameter registers, | |
35458 | + // even in nQBss. | |
35459 | + // | |
35460 | + ChnlAccessSetting->SIFS_Timer = 0x22; // Suggested by Jong, 2005.12.08. | |
35461 | + ChnlAccessSetting->DIFS_Timer = 0x1C; // 2006.06.02, by rcnjko. | |
35462 | + ChnlAccessSetting->SlotTimeTimer = 9; // 2006.06.02, by rcnjko. | |
35463 | + ChnlAccessSetting->EIFS_Timer = 0x5B; // Suggested by wcchu, it is the default value of EIFS register, 2005.12.08. | |
35464 | + ChnlAccessSetting->CWminIndex = 3; // 2006.06.02, by rcnjko. | |
35465 | + ChnlAccessSetting->CWmaxIndex = 7; // 2006.06.02, by rcnjko. | |
35466 | + | |
35467 | + write_nic_byte(dev, SIFS, ChnlAccessSetting->SIFS_Timer); | |
35468 | + //Adapter->HalFunc.SetHwRegHandler( Adapter, HW_VAR_SLOT_TIME, &ChnlAccessSetting->SlotTimeTimer ); // Rewrited from directly use PlatformEFIOWrite1Byte(), by Annie, 2006-03-29. | |
35469 | + write_nic_byte(dev, SLOT, ChnlAccessSetting->SlotTimeTimer); // Rewrited from directly use PlatformEFIOWrite1Byte(), by Annie, 2006-03-29. | |
35470 | + | |
35471 | + u1bAIFS = aSifsTime + (2 * ChnlAccessSetting->SlotTimeTimer ); | |
35472 | + | |
35473 | + //write_nic_byte(dev, AC_VO_PARAM, u1bAIFS); | |
35474 | + //write_nic_byte(dev, AC_VI_PARAM, u1bAIFS); | |
35475 | + //write_nic_byte(dev, AC_BE_PARAM, u1bAIFS); | |
35476 | + //write_nic_byte(dev, AC_BK_PARAM, u1bAIFS); | |
35477 | + | |
35478 | + write_nic_byte(dev, EIFS, ChnlAccessSetting->EIFS_Timer); | |
35479 | + | |
35480 | + write_nic_byte(dev, AckTimeOutReg, 0x5B); // <RJ_EXPR_QOS> Suggested by wcchu, it is the default value of EIFS register, 2005.12.08. | |
35481 | + | |
35482 | +#ifdef TODO | |
35483 | + // <RJ_TODO_NOW_8185B> Update ECWmin/ECWmax, AIFS, TXOP Limit of each AC to the value defined by SPEC. | |
35484 | + if( pStaQos->CurrentQosMode > QOS_DISABLE ) | |
35485 | + { // QoS mode. | |
35486 | + if(pStaQos->QBssWirelessMode == WirelessMode) | |
35487 | + { | |
35488 | + // Follow AC Parameters of the QBSS. | |
35489 | + for(eACI = 0; eACI < AC_MAX; eACI++) | |
35490 | + { | |
35491 | + Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_AC_PARAM, (pu1Byte)(&(pStaQos->WMMParamEle.AcParam[eACI])) ); | |
35492 | + } | |
35493 | + } | |
35494 | + else | |
35495 | + { | |
35496 | + // Follow Default WMM AC Parameters. | |
35497 | + bFollowLegacySetting = 1; | |
35498 | + } | |
35499 | + } | |
35500 | + else | |
35501 | +#endif | |
35502 | + { // Legacy 802.11. | |
35503 | + bFollowLegacySetting = 1; | |
35504 | + | |
35505 | + } | |
35506 | + | |
35507 | + // this setting is copied from rtl8187B. xiong-2006-11-13 | |
35508 | + if(bFollowLegacySetting) | |
35509 | + { | |
35510 | + | |
35511 | + | |
35512 | + // | |
35513 | + // Follow 802.11 seeting to AC parameter, all AC shall use the same parameter. | |
35514 | + // 2005.12.01, by rcnjko. | |
35515 | + // | |
35516 | + AcParam.longData = 0; | |
35517 | + AcParam.f.AciAifsn.f.AIFSN = 2; // Follow 802.11 DIFS. | |
35518 | + AcParam.f.AciAifsn.f.ACM = 0; | |
35519 | + AcParam.f.Ecw.f.ECWmin = ChnlAccessSetting->CWminIndex; // Follow 802.11 CWmin. | |
35520 | + AcParam.f.Ecw.f.ECWmax = ChnlAccessSetting->CWmaxIndex; // Follow 802.11 CWmax. | |
35521 | + AcParam.f.TXOPLimit = 0; | |
35522 | + | |
35523 | + //lzm reserved 080826 | |
35524 | +#if 1 | |
35525 | +#ifdef THOMAS_TURBO | |
35526 | + // For turbo mode setting. port from 87B by Isaiah 2008-08-01 | |
35527 | + if( ieee->current_network.Turbo_Enable == 1 ) | |
35528 | + AcParam.f.TXOPLimit = 0x01FF; | |
35529 | +#endif | |
35530 | + // For 87SE with Intel 4965 Ad-Hoc mode have poor throughput (19MB) | |
35531 | + if (ieee->iw_mode == IW_MODE_ADHOC) | |
35532 | + AcParam.f.TXOPLimit = 0x0020; | |
35533 | +#endif | |
35534 | + | |
35535 | + for(eACI = 0; eACI < AC_MAX; eACI++) | |
35536 | + { | |
35537 | + AcParam.f.AciAifsn.f.ACI = (u8)eACI; | |
35538 | + { | |
35539 | + PAC_PARAM pAcParam = (PAC_PARAM)(&AcParam); | |
35540 | + AC_CODING eACI; | |
35541 | + u8 u1bAIFS; | |
35542 | + u32 u4bAcParam; | |
35543 | + | |
35544 | + // Retrive paramters to udpate. | |
35545 | + eACI = pAcParam->f.AciAifsn.f.ACI; | |
35546 | + u1bAIFS = pAcParam->f.AciAifsn.f.AIFSN * ChnlAccessSetting->SlotTimeTimer + aSifsTime; | |
35547 | + u4bAcParam = ( (((u32)(pAcParam->f.TXOPLimit)) << AC_PARAM_TXOP_LIMIT_OFFSET) | | |
35548 | + (((u32)(pAcParam->f.Ecw.f.ECWmax)) << AC_PARAM_ECW_MAX_OFFSET) | | |
35549 | + (((u32)(pAcParam->f.Ecw.f.ECWmin)) << AC_PARAM_ECW_MIN_OFFSET) | | |
35550 | + (((u32)u1bAIFS) << AC_PARAM_AIFS_OFFSET)); | |
35551 | + | |
35552 | + switch(eACI) | |
35553 | + { | |
35554 | + case AC1_BK: | |
35555 | + //write_nic_dword(dev, AC_BK_PARAM, u4bAcParam); | |
35556 | + break; | |
35557 | + | |
35558 | + case AC0_BE: | |
35559 | + //write_nic_dword(dev, AC_BE_PARAM, u4bAcParam); | |
35560 | + break; | |
35561 | + | |
35562 | + case AC2_VI: | |
35563 | + //write_nic_dword(dev, AC_VI_PARAM, u4bAcParam); | |
35564 | + break; | |
35565 | + | |
35566 | + case AC3_VO: | |
35567 | + //write_nic_dword(dev, AC_VO_PARAM, u4bAcParam); | |
35568 | + break; | |
35569 | + | |
35570 | + default: | |
35571 | + DMESGW( "SetHwReg8185(): invalid ACI: %d !\n", eACI); | |
35572 | + break; | |
35573 | + } | |
35574 | + | |
35575 | + // Cehck ACM bit. | |
35576 | + // If it is set, immediately set ACM control bit to downgrading AC for passing WMM testplan. Annie, 2005-12-13. | |
35577 | + //write_nic_byte(dev, ACM_CONTROL, pAcParam->f.AciAifsn); | |
35578 | + { | |
35579 | + PACI_AIFSN pAciAifsn = (PACI_AIFSN)(&pAcParam->f.AciAifsn); | |
35580 | + AC_CODING eACI = pAciAifsn->f.ACI; | |
35581 | + | |
35582 | + //modified Joseph | |
35583 | + //for 8187B AsynIORead issue | |
35584 | +#ifdef TODO | |
35585 | + u8 AcmCtrl = pHalData->AcmControl; | |
35586 | +#else | |
35587 | + u8 AcmCtrl = 0; | |
35588 | +#endif | |
35589 | + if( pAciAifsn->f.ACM ) | |
35590 | + { // ACM bit is 1. | |
35591 | + switch(eACI) | |
35592 | + { | |
35593 | + case AC0_BE: | |
35594 | + AcmCtrl |= (BEQ_ACM_EN|BEQ_ACM_CTL|ACM_HW_EN); // or 0x21 | |
35595 | + break; | |
35596 | + | |
35597 | + case AC2_VI: | |
35598 | + AcmCtrl |= (VIQ_ACM_EN|VIQ_ACM_CTL|ACM_HW_EN); // or 0x42 | |
35599 | + break; | |
35600 | + | |
35601 | + case AC3_VO: | |
35602 | + AcmCtrl |= (VOQ_ACM_EN|VOQ_ACM_CTL|ACM_HW_EN); // or 0x84 | |
35603 | + break; | |
35604 | + | |
35605 | + default: | |
35606 | + DMESGW("SetHwReg8185(): [HW_VAR_ACM_CTRL] ACM set failed: eACI is %d\n", eACI ); | |
35607 | + break; | |
35608 | + } | |
35609 | + } | |
35610 | + else | |
35611 | + { // ACM bit is 0. | |
35612 | + switch(eACI) | |
35613 | + { | |
35614 | + case AC0_BE: | |
35615 | + AcmCtrl &= ( (~BEQ_ACM_EN) & (~BEQ_ACM_CTL) & (~ACM_HW_EN) ); // and 0xDE | |
35616 | + break; | |
35617 | + | |
35618 | + case AC2_VI: | |
35619 | + AcmCtrl &= ( (~VIQ_ACM_EN) & (~VIQ_ACM_CTL) & (~ACM_HW_EN) ); // and 0xBD | |
35620 | + break; | |
35621 | + | |
35622 | + case AC3_VO: | |
35623 | + AcmCtrl &= ( (~VOQ_ACM_EN) & (~VOQ_ACM_CTL) & (~ACM_HW_EN) ); // and 0x7B | |
35624 | + break; | |
35625 | + | |
35626 | + default: | |
35627 | + break; | |
35628 | + } | |
35629 | + } | |
35630 | + | |
35631 | + //printk(KERN_WARNING "SetHwReg8185(): [HW_VAR_ACM_CTRL] Write 0x%X\n", AcmCtrl); | |
35632 | + | |
35633 | +#ifdef TO_DO | |
35634 | + pHalData->AcmControl = AcmCtrl; | |
35635 | +#endif | |
35636 | + //write_nic_byte(dev, ACM_CONTROL, AcmCtrl); | |
35637 | + write_nic_byte(dev, ACM_CONTROL, 0); | |
35638 | + } | |
35639 | + } | |
35640 | + } | |
35641 | + | |
35642 | + | |
35643 | + } | |
35644 | +} | |
35645 | + | |
35646 | +void | |
35647 | +ActSetWirelessMode8185( | |
35648 | + struct net_device *dev, | |
35649 | + u8 btWirelessMode | |
35650 | + ) | |
35651 | +{ | |
35652 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
35653 | + struct ieee80211_device *ieee = priv->ieee80211; | |
35654 | + //PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); | |
35655 | + u8 btSupportedWirelessMode = GetSupportedWirelessMode8185(dev); | |
35656 | + | |
35657 | + if( (btWirelessMode & btSupportedWirelessMode) == 0 ) | |
35658 | + { // Don't switch to unsupported wireless mode, 2006.02.15, by rcnjko. | |
35659 | + DMESGW("ActSetWirelessMode8185(): WirelessMode(%d) is not supported (%d)!\n", | |
35660 | + btWirelessMode, btSupportedWirelessMode); | |
35661 | + return; | |
35662 | + } | |
35663 | + | |
35664 | + // 1. Assign wireless mode to swtich if necessary. | |
35665 | + if (btWirelessMode == WIRELESS_MODE_AUTO) | |
35666 | + { | |
35667 | + if((btSupportedWirelessMode & WIRELESS_MODE_A)) | |
35668 | + { | |
35669 | + btWirelessMode = WIRELESS_MODE_A; | |
35670 | + } | |
35671 | + else if((btSupportedWirelessMode & WIRELESS_MODE_G)) | |
35672 | + { | |
35673 | + btWirelessMode = WIRELESS_MODE_G; | |
35674 | + } | |
35675 | + else if((btSupportedWirelessMode & WIRELESS_MODE_B)) | |
35676 | + { | |
35677 | + btWirelessMode = WIRELESS_MODE_B; | |
35678 | + } | |
35679 | + else | |
35680 | + { | |
35681 | + DMESGW("ActSetWirelessMode8185(): No valid wireless mode supported, btSupportedWirelessMode(%x)!!!\n", | |
35682 | + btSupportedWirelessMode); | |
35683 | + btWirelessMode = WIRELESS_MODE_B; | |
35684 | + } | |
35685 | + } | |
35686 | + | |
35687 | + | |
35688 | + // 2. Swtich band: RF or BB specific actions, | |
35689 | + // for example, refresh tables in omc8255, or change initial gain if necessary. | |
35690 | + switch(priv->rf_chip) | |
35691 | + { | |
35692 | + case RF_ZEBRA2: | |
35693 | + case RF_ZEBRA4: | |
35694 | + { | |
35695 | + // Nothing to do for Zebra to switch band. | |
35696 | + // Update current wireless mode if we swtich to specified band successfully. | |
35697 | + ieee->mode = (WIRELESS_MODE)btWirelessMode; | |
35698 | + } | |
35699 | + break; | |
35700 | + | |
35701 | + default: | |
35702 | + DMESGW("ActSetWirelessMode8185(): unsupported RF: 0x%X !!!\n", priv->rf_chip); | |
35703 | + break; | |
35704 | + } | |
35705 | + | |
35706 | + // 3. Change related setting. | |
35707 | + if( ieee->mode == WIRELESS_MODE_A ){ | |
35708 | + DMESG("WIRELESS_MODE_A\n"); | |
35709 | + } | |
35710 | + else if( ieee->mode == WIRELESS_MODE_B ){ | |
35711 | + DMESG("WIRELESS_MODE_B\n"); | |
35712 | + } | |
35713 | + else if( ieee->mode == WIRELESS_MODE_G ){ | |
35714 | + DMESG("WIRELESS_MODE_G\n"); | |
35715 | + } | |
35716 | + | |
35717 | + ActUpdateChannelAccessSetting( dev, ieee->mode, &priv->ChannelAccessSetting); | |
35718 | +} | |
35719 | + | |
35720 | +void rtl8185b_irq_enable(struct net_device *dev) | |
35721 | +{ | |
35722 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
35723 | + | |
35724 | + priv->irq_enabled = 1; | |
35725 | + write_nic_dword(dev, IMR, priv->IntrMask); | |
35726 | +} | |
35727 | +//by amy for power save | |
35728 | +void | |
35729 | +DrvIFIndicateDisassociation( | |
35730 | + struct net_device *dev, | |
35731 | + u16 reason | |
35732 | + ) | |
35733 | +{ | |
35734 | + //printk("==> DrvIFIndicateDisassociation()\n"); | |
35735 | + | |
35736 | + // nothing is needed after disassociation request. | |
35737 | + | |
35738 | + //printk("<== DrvIFIndicateDisassociation()\n"); | |
35739 | +} | |
35740 | +void | |
35741 | +MgntDisconnectIBSS( | |
35742 | + struct net_device *dev | |
35743 | +) | |
35744 | +{ | |
35745 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
35746 | + u8 i; | |
35747 | + | |
35748 | + //printk("XXXXXXXXXX MgntDisconnect IBSS\n"); | |
35749 | + | |
35750 | + DrvIFIndicateDisassociation(dev, unspec_reason); | |
35751 | + | |
35752 | +// PlatformZeroMemory( pMgntInfo->Bssid, 6 ); | |
35753 | + for(i=0;i<6;i++) priv->ieee80211->current_network.bssid[i] = 0x55; | |
35754 | + | |
35755 | + priv->ieee80211->state = IEEE80211_NOLINK; | |
35756 | + | |
35757 | + //Stop Beacon. | |
35758 | + | |
35759 | + // Vista add a Adhoc profile, HW radio off untill OID_DOT11_RESET_REQUEST | |
35760 | + // Driver would set MSR=NO_LINK, then HW Radio ON, MgntQueue Stuck. | |
35761 | + // Because Bcn DMA isn't complete, mgnt queue would stuck until Bcn packet send. | |
35762 | + | |
35763 | + // Disable Beacon Queue Own bit, suggested by jong | |
35764 | +// Adapter->HalFunc.SetTxDescOWNHandler(Adapter, BEACON_QUEUE, 0, 0); | |
35765 | + ieee80211_stop_send_beacons(priv->ieee80211); | |
35766 | + | |
35767 | + priv->ieee80211->link_change(dev); | |
35768 | + notify_wx_assoc_event(priv->ieee80211); | |
35769 | + | |
35770 | + // Stop SW Beacon.Use hw beacon so do not need to do so.by amy | |
35771 | +#if 0 | |
35772 | + if(pMgntInfo->bEnableSwBeaconTimer) | |
35773 | + { | |
35774 | + // SwBeaconTimer will stop if pMgntInfo->mIbss==FALSE, see SwBeaconCallback() for details. | |
35775 | +// comment out by haich, 2007.10.01 | |
35776 | +//#if DEV_BUS_TYPE==USB_INTERFACE | |
35777 | + PlatformCancelTimer( Adapter, &pMgntInfo->SwBeaconTimer); | |
35778 | +//#endif | |
35779 | + } | |
35780 | +#endif | |
35781 | + | |
35782 | +// MgntIndicateMediaStatus( Adapter, RT_MEDIA_DISCONNECT, GENERAL_INDICATE ); | |
35783 | + | |
35784 | +} | |
35785 | +void | |
35786 | +MlmeDisassociateRequest( | |
35787 | + struct net_device *dev, | |
35788 | + u8* asSta, | |
35789 | + u8 asRsn | |
35790 | + ) | |
35791 | +{ | |
35792 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
35793 | + u8 i; | |
35794 | + | |
35795 | + SendDisassociation(priv->ieee80211, asSta, asRsn ); | |
35796 | + | |
35797 | + if( memcmp(priv->ieee80211->current_network.bssid, asSta, 6 ) == 0 ){ | |
35798 | + //ShuChen TODO: change media status. | |
35799 | + //ShuChen TODO: What to do when disassociate. | |
35800 | + DrvIFIndicateDisassociation(dev, unspec_reason); | |
35801 | + | |
35802 | + | |
35803 | + // pMgntInfo->AsocTimestamp = 0; | |
35804 | + for(i=0;i<6;i++) priv->ieee80211->current_network.bssid[i] = 0x22; | |
35805 | +// pMgntInfo->mBrates.Length = 0; | |
35806 | +// Adapter->HalFunc.SetHwRegHandler( Adapter, HW_VAR_BASIC_RATE, (pu1Byte)(&pMgntInfo->mBrates) ); | |
35807 | + | |
35808 | + ieee80211_disassociate(priv->ieee80211); | |
35809 | + | |
35810 | + | |
35811 | + } | |
35812 | + | |
35813 | +} | |
35814 | + | |
35815 | +void | |
35816 | +MgntDisconnectAP( | |
35817 | + struct net_device *dev, | |
35818 | + u8 asRsn | |
35819 | +) | |
35820 | +{ | |
35821 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
35822 | + | |
35823 | +// | |
35824 | +// Commented out by rcnjko, 2005.01.27: | |
35825 | +// I move SecClearAllKeys() to MgntActSet_802_11_DISASSOCIATE(). | |
35826 | +// | |
35827 | +// //2004/09/15, kcwu, the key should be cleared, or the new handshaking will not success | |
35828 | +// SecClearAllKeys(Adapter); | |
35829 | + | |
35830 | + // In WPA WPA2 need to Clear all key ... because new key will set after new handshaking. | |
35831 | +#ifdef TODO | |
35832 | + if( pMgntInfo->SecurityInfo.AuthMode > RT_802_11AuthModeAutoSwitch || | |
35833 | + (pMgntInfo->bAPSuportCCKM && pMgntInfo->bCCX8021xenable) ) // In CCKM mode will Clear key | |
35834 | + { | |
35835 | + SecClearAllKeys(Adapter); | |
35836 | + RT_TRACE(COMP_SEC, DBG_LOUD,("======>CCKM clear key...")) | |
35837 | + } | |
35838 | +#endif | |
35839 | + // 2004.10.11, by rcnjko. | |
35840 | + //MlmeDisassociateRequest( Adapter, pMgntInfo->Bssid, disas_lv_ss ); | |
35841 | + MlmeDisassociateRequest( dev, priv->ieee80211->current_network.bssid, asRsn ); | |
35842 | + | |
35843 | + priv->ieee80211->state = IEEE80211_NOLINK; | |
35844 | +// pMgntInfo->AsocTimestamp = 0; | |
35845 | +} | |
35846 | +bool | |
35847 | +MgntDisconnect( | |
35848 | + struct net_device *dev, | |
35849 | + u8 asRsn | |
35850 | +) | |
35851 | +{ | |
35852 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
35853 | + // | |
35854 | + // Schedule an workitem to wake up for ps mode, 070109, by rcnjko. | |
35855 | + // | |
35856 | +#ifdef TODO | |
35857 | + if(pMgntInfo->mPss != eAwake) | |
35858 | + { | |
35859 | + // | |
35860 | + // Using AwkaeTimer to prevent mismatch ps state. | |
35861 | + // In the timer the state will be changed according to the RF is being awoke or not. By Bruce, 2007-10-31. | |
35862 | + // | |
35863 | + // PlatformScheduleWorkItem( &(pMgntInfo->AwakeWorkItem) ); | |
35864 | + PlatformSetTimer( Adapter, &(pMgntInfo->AwakeTimer), 0 ); | |
35865 | + } | |
35866 | +#endif | |
35867 | + | |
35868 | + // Indication of disassociation event. | |
35869 | + //DrvIFIndicateDisassociation(Adapter, asRsn); | |
35870 | +#ifdef ENABLE_DOT11D | |
35871 | + if(IS_DOT11D_ENABLE(priv->ieee80211)) | |
35872 | + Dot11d_Reset(priv->ieee80211); | |
35873 | +#endif | |
35874 | + // In adhoc mode, update beacon frame. | |
35875 | + if( priv->ieee80211->state == IEEE80211_LINKED ) | |
35876 | + { | |
35877 | + if( priv->ieee80211->iw_mode == IW_MODE_ADHOC ) | |
35878 | + { | |
35879 | +// RT_TRACE(COMP_MLME, DBG_LOUD, ("MgntDisconnect() ===> MgntDisconnectIBSS\n")); | |
35880 | + //printk("MgntDisconnect() ===> MgntDisconnectIBSS\n"); | |
35881 | + MgntDisconnectIBSS(dev); | |
35882 | + } | |
35883 | + if( priv->ieee80211->iw_mode == IW_MODE_INFRA ) | |
35884 | + { | |
35885 | + // We clear key here instead of MgntDisconnectAP() because that | |
35886 | + // MgntActSet_802_11_DISASSOCIATE() is an interface called by OS, | |
35887 | + // e.g. OID_802_11_DISASSOCIATE in Windows while as MgntDisconnectAP() is | |
35888 | + // used to handle disassociation related things to AP, e.g. send Disassoc | |
35889 | + // frame to AP. 2005.01.27, by rcnjko. | |
35890 | +// SecClearAllKeys(Adapter); | |
35891 | + | |
35892 | +// RT_TRACE(COMP_MLME, DBG_LOUD, ("MgntDisconnect() ===> MgntDisconnectAP\n")); | |
35893 | + //printk("MgntDisconnect() ===> MgntDisconnectAP\n"); | |
35894 | + MgntDisconnectAP(dev, asRsn); | |
35895 | + } | |
35896 | + | |
35897 | + // Inidicate Disconnect, 2005.02.23, by rcnjko. | |
35898 | +// MgntIndicateMediaStatus( Adapter, RT_MEDIA_DISCONNECT, GENERAL_INDICATE); | |
35899 | + } | |
35900 | + | |
35901 | + return true; | |
35902 | +} | |
35903 | +// | |
35904 | +// Description: | |
35905 | +// Chang RF Power State. | |
35906 | +// Note that, only MgntActSet_RF_State() is allowed to set HW_VAR_RF_STATE. | |
35907 | +// | |
35908 | +// Assumption: | |
35909 | +// PASSIVE LEVEL. | |
35910 | +// | |
35911 | +bool | |
35912 | +SetRFPowerState( | |
35913 | + struct net_device *dev, | |
35914 | + RT_RF_POWER_STATE eRFPowerState | |
35915 | + ) | |
35916 | +{ | |
35917 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
35918 | + bool bResult = false; | |
35919 | + | |
35920 | +// printk("---------> SetRFPowerState(): eRFPowerState(%d)\n", eRFPowerState); | |
35921 | + if(eRFPowerState == priv->eRFPowerState) | |
35922 | + { | |
35923 | +// printk("<--------- SetRFPowerState(): discard the request for eRFPowerState(%d) is the same.\n", eRFPowerState); | |
35924 | + return bResult; | |
35925 | + } | |
35926 | + | |
35927 | + switch(priv->rf_chip) | |
35928 | + { | |
35929 | + case RF_ZEBRA2: | |
35930 | + case RF_ZEBRA4: | |
35931 | + bResult = SetZebraRFPowerState8185(dev, eRFPowerState); | |
35932 | + break; | |
35933 | + | |
35934 | + default: | |
35935 | + printk("SetRFPowerState8185(): unknown RFChipID: 0x%X!!!\n", priv->rf_chip); | |
35936 | + break;; | |
35937 | +} | |
35938 | +// printk("<--------- SetRFPowerState(): bResult(%d)\n", bResult); | |
35939 | + | |
35940 | + return bResult; | |
35941 | +} | |
35942 | +void | |
35943 | +HalEnableRx8185Dummy( | |
35944 | + struct net_device *dev | |
35945 | + ) | |
35946 | +{ | |
35947 | +} | |
35948 | +void | |
35949 | +HalDisableRx8185Dummy( | |
35950 | + struct net_device *dev | |
35951 | + ) | |
35952 | +{ | |
35953 | +} | |
35954 | + | |
35955 | +bool | |
35956 | +MgntActSet_RF_State( | |
35957 | + struct net_device *dev, | |
35958 | + RT_RF_POWER_STATE StateToSet, | |
35959 | + u32 ChangeSource | |
35960 | + ) | |
35961 | +{ | |
35962 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
35963 | + bool bActionAllowed = false; | |
35964 | + bool bConnectBySSID = false; | |
35965 | + RT_RF_POWER_STATE rtState; | |
35966 | + u16 RFWaitCounter = 0; | |
35967 | + unsigned long flag; | |
35968 | +// printk("===>MgntActSet_RF_State(): StateToSet(%d), ChangeSource(0x%x)\n",StateToSet, ChangeSource); | |
35969 | + // | |
35970 | + // Prevent the race condition of RF state change. By Bruce, 2007-11-28. | |
35971 | + // Only one thread can change the RF state at one time, and others should wait to be executed. | |
35972 | + // | |
35973 | +#if 1 | |
35974 | + while(true) | |
35975 | + { | |
35976 | +// down(&priv->rf_state); | |
35977 | + spin_lock_irqsave(&priv->rf_ps_lock,flag); | |
35978 | + if(priv->RFChangeInProgress) | |
35979 | + { | |
35980 | +// printk("====================>haha111111111\n"); | |
35981 | +// up(&priv->rf_state); | |
35982 | +// RT_TRACE(COMP_RF, DBG_LOUD, ("MgntActSet_RF_State(): RF Change in progress! Wait to set..StateToSet(%d).\n", StateToSet)); | |
35983 | + spin_unlock_irqrestore(&priv->rf_ps_lock,flag); | |
35984 | + // Set RF after the previous action is done. | |
35985 | + while(priv->RFChangeInProgress) | |
35986 | + { | |
35987 | + RFWaitCounter ++; | |
35988 | +// RT_TRACE(COMP_RF, DBG_LOUD, ("MgntActSet_RF_State(): Wait 1 ms (%d times)...\n", RFWaitCounter)); | |
35989 | + udelay(1000); // 1 ms | |
35990 | + | |
35991 | + // Wait too long, return FALSE to avoid to be stuck here. | |
35992 | + if(RFWaitCounter > 1000) // 1sec | |
35993 | + { | |
35994 | +// RT_ASSERT(FALSE, ("MgntActSet_RF_State(): Wait too logn to set RF\n")); | |
35995 | + printk("MgntActSet_RF_State(): Wait too long to set RF\n"); | |
35996 | + // TODO: Reset RF state? | |
35997 | + return false; | |
35998 | + } | |
35999 | + } | |
36000 | + } | |
36001 | + else | |
36002 | + { | |
36003 | +// printk("========================>haha2\n"); | |
36004 | + priv->RFChangeInProgress = true; | |
36005 | +// up(&priv->rf_state); | |
36006 | + spin_unlock_irqrestore(&priv->rf_ps_lock,flag); | |
36007 | + break; | |
36008 | + } | |
36009 | + } | |
36010 | +#endif | |
36011 | + rtState = priv->eRFPowerState; | |
36012 | + | |
36013 | + | |
36014 | + switch(StateToSet) | |
36015 | + { | |
36016 | + case eRfOn: | |
36017 | + // | |
36018 | + // Turn On RF no matter the IPS setting because we need to update the RF state to Ndis under Vista, or | |
36019 | + // the Windows does not allow the driver to perform site survey any more. By Bruce, 2007-10-02. | |
36020 | + // | |
36021 | + priv->RfOffReason &= (~ChangeSource); | |
36022 | + | |
36023 | + if(! priv->RfOffReason) | |
36024 | + { | |
36025 | + priv->RfOffReason = 0; | |
36026 | + bActionAllowed = true; | |
36027 | + | |
36028 | + if(rtState == eRfOff && ChangeSource >=RF_CHANGE_BY_HW && !priv->bInHctTest) | |
36029 | + { | |
36030 | + bConnectBySSID = true; | |
36031 | + } | |
36032 | + } | |
36033 | + else | |
36034 | +// RT_TRACE(COMP_RF, DBG_LOUD, ("MgntActSet_RF_State - eRfon reject pMgntInfo->RfOffReason= 0x%x, ChangeSource=0x%X\n", pMgntInfo->RfOffReason, ChangeSource)); | |
36035 | + ; | |
36036 | + break; | |
36037 | + | |
36038 | + case eRfOff: | |
36039 | + // 070125, rcnjko: we always keep connected in AP mode. | |
36040 | + | |
36041 | + if (priv->RfOffReason > RF_CHANGE_BY_IPS) | |
36042 | + { | |
36043 | + // | |
36044 | + // 060808, Annie: | |
36045 | + // Disconnect to current BSS when radio off. Asked by QuanTa. | |
36046 | + // | |
36047 | + | |
36048 | + // | |
36049 | + // Calling MgntDisconnect() instead of MgntActSet_802_11_DISASSOCIATE(), | |
36050 | + // because we do NOT need to set ssid to dummy ones. | |
36051 | + // Revised by Roger, 2007.12.04. | |
36052 | + // | |
36053 | + MgntDisconnect( dev, disas_lv_ss ); | |
36054 | + | |
36055 | + // Clear content of bssDesc[] and bssDesc4Query[] to avoid reporting old bss to UI. | |
36056 | + // 2007.05.28, by shien chang. | |
36057 | +// PlatformZeroMemory( pMgntInfo->bssDesc, sizeof(RT_WLAN_BSS)*MAX_BSS_DESC ); | |
36058 | +// pMgntInfo->NumBssDesc = 0; | |
36059 | +// PlatformZeroMemory( pMgntInfo->bssDesc4Query, sizeof(RT_WLAN_BSS)*MAX_BSS_DESC ); | |
36060 | +// pMgntInfo->NumBssDesc4Query = 0; | |
36061 | + } | |
36062 | + | |
36063 | + | |
36064 | + | |
36065 | + priv->RfOffReason |= ChangeSource; | |
36066 | + bActionAllowed = true; | |
36067 | + break; | |
36068 | + | |
36069 | + case eRfSleep: | |
36070 | + priv->RfOffReason |= ChangeSource; | |
36071 | + bActionAllowed = true; | |
36072 | + break; | |
36073 | + | |
36074 | + default: | |
36075 | + break; | |
36076 | + } | |
36077 | + | |
36078 | + if(bActionAllowed) | |
36079 | + { | |
36080 | +// RT_TRACE(COMP_RF, DBG_LOUD, ("MgntActSet_RF_State(): Action is allowed.... StateToSet(%d), RfOffReason(%#X)\n", StateToSet, pMgntInfo->RfOffReason)); | |
36081 | + // Config HW to the specified mode. | |
36082 | +// printk("MgntActSet_RF_State(): Action is allowed.... StateToSet(%d), RfOffReason(%#X)\n", StateToSet, priv->RfOffReason); | |
36083 | + SetRFPowerState(dev, StateToSet); | |
36084 | + | |
36085 | + // Turn on RF. | |
36086 | + if(StateToSet == eRfOn) | |
36087 | + { | |
36088 | + HalEnableRx8185Dummy(dev); | |
36089 | + if(bConnectBySSID) | |
36090 | + { | |
36091 | + // by amy not supported | |
36092 | +// MgntActSet_802_11_SSID(Adapter, Adapter->MgntInfo.Ssid.Octet, Adapter->MgntInfo.Ssid.Length, TRUE ); | |
36093 | + } | |
36094 | + } | |
36095 | + // Turn off RF. | |
36096 | + else if(StateToSet == eRfOff) | |
36097 | + { | |
36098 | + HalDisableRx8185Dummy(dev); | |
36099 | + } | |
36100 | + } | |
36101 | + else | |
36102 | + { | |
36103 | + // printk("MgntActSet_RF_State(): Action is rejected.... StateToSet(%d), ChangeSource(%#X), RfOffReason(%#X)\n", StateToSet, ChangeSource, priv->RfOffReason); | |
36104 | + } | |
36105 | + | |
36106 | + // Release RF spinlock | |
36107 | +// down(&priv->rf_state); | |
36108 | + spin_lock_irqsave(&priv->rf_ps_lock,flag); | |
36109 | + priv->RFChangeInProgress = false; | |
36110 | +// up(&priv->rf_state); | |
36111 | + spin_unlock_irqrestore(&priv->rf_ps_lock,flag); | |
36112 | +// printk("<===MgntActSet_RF_State()\n"); | |
36113 | + return bActionAllowed; | |
36114 | +} | |
36115 | +void | |
36116 | +InactivePowerSave( | |
36117 | + struct net_device *dev | |
36118 | + ) | |
36119 | +{ | |
36120 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
36121 | + //u8 index = 0; | |
36122 | + | |
36123 | + // | |
36124 | + // This flag "bSwRfProcessing", indicates the status of IPS procedure, should be set if the IPS workitem | |
36125 | + // is really scheduled. | |
36126 | + // The old code, sets this flag before scheduling the IPS workitem and however, at the same time the | |
36127 | + // previous IPS workitem did not end yet, fails to schedule the current workitem. Thus, bSwRfProcessing | |
36128 | + // blocks the IPS procedure of switching RF. | |
36129 | + // By Bruce, 2007-12-25. | |
36130 | + // | |
36131 | + priv->bSwRfProcessing = true; | |
36132 | + | |
36133 | + MgntActSet_RF_State(dev, priv->eInactivePowerState, RF_CHANGE_BY_IPS); | |
36134 | + | |
36135 | + // | |
36136 | + // To solve CAM values miss in RF OFF, rewrite CAM values after RF ON. By Bruce, 2007-09-20. | |
36137 | + // | |
36138 | +#if 0 | |
36139 | + while( index < 4 ) | |
36140 | + { | |
36141 | + if( ( pMgntInfo->SecurityInfo.PairwiseEncAlgorithm == WEP104_Encryption ) || | |
36142 | + (pMgntInfo->SecurityInfo.PairwiseEncAlgorithm == WEP40_Encryption) ) | |
36143 | + { | |
36144 | + if( pMgntInfo->SecurityInfo.KeyLen[index] != 0) | |
36145 | + pAdapter->HalFunc.SetKeyHandler(pAdapter, index, 0, FALSE, pMgntInfo->SecurityInfo.PairwiseEncAlgorithm, TRUE, FALSE); | |
36146 | + | |
36147 | + } | |
36148 | + index++; | |
36149 | + } | |
36150 | +#endif | |
36151 | + priv->bSwRfProcessing = false; | |
36152 | +} | |
36153 | + | |
36154 | +// | |
36155 | +// Description: | |
36156 | +// Enter the inactive power save mode. RF will be off | |
36157 | +// 2007.08.17, by shien chang. | |
36158 | +// | |
36159 | +void | |
36160 | +IPSEnter( | |
36161 | + struct net_device *dev | |
36162 | + ) | |
36163 | +{ | |
36164 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
36165 | + RT_RF_POWER_STATE rtState; | |
36166 | + //printk("==============================>enter IPS\n"); | |
36167 | + if (priv->bInactivePs) | |
36168 | + { | |
36169 | + rtState = priv->eRFPowerState; | |
36170 | + | |
36171 | + // | |
36172 | + // Added by Bruce, 2007-12-25. | |
36173 | + // Do not enter IPS in the following conditions: | |
36174 | + // (1) RF is already OFF or Sleep | |
36175 | + // (2) bSwRfProcessing (indicates the IPS is still under going) | |
36176 | + // (3) Connectted (only disconnected can trigger IPS) | |
36177 | + // (4) IBSS (send Beacon) | |
36178 | + // (5) AP mode (send Beacon) | |
36179 | + // | |
36180 | + if (rtState == eRfOn && !priv->bSwRfProcessing | |
36181 | + && (priv->ieee80211->state != IEEE80211_LINKED )) | |
36182 | + { | |
36183 | + // printk("IPSEnter(): Turn off RF.\n"); | |
36184 | + priv->eInactivePowerState = eRfOff; | |
36185 | + InactivePowerSave(dev); | |
36186 | + } | |
36187 | + } | |
36188 | +// printk("priv->eRFPowerState is %d\n",priv->eRFPowerState); | |
36189 | +} | |
36190 | +void | |
36191 | +IPSLeave( | |
36192 | + struct net_device *dev | |
36193 | + ) | |
36194 | +{ | |
36195 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
36196 | + RT_RF_POWER_STATE rtState; | |
36197 | + //printk("===================================>leave IPS\n"); | |
36198 | + if (priv->bInactivePs) | |
36199 | + { | |
36200 | + rtState = priv->eRFPowerState; | |
36201 | + if ((rtState == eRfOff || rtState == eRfSleep) && (!priv->bSwRfProcessing) && priv->RfOffReason <= RF_CHANGE_BY_IPS) | |
36202 | + { | |
36203 | +// printk("IPSLeave(): Turn on RF.\n"); | |
36204 | + priv->eInactivePowerState = eRfOn; | |
36205 | + InactivePowerSave(dev); | |
36206 | + } | |
36207 | + } | |
36208 | +// printk("priv->eRFPowerState is %d\n",priv->eRFPowerState); | |
36209 | +} | |
36210 | +//by amy for power save | |
36211 | +void rtl8185b_adapter_start(struct net_device *dev) | |
36212 | +{ | |
36213 | + struct r8180_priv *priv = ieee80211_priv(dev); | |
36214 | + struct ieee80211_device *ieee = priv->ieee80211; | |
36215 | + | |
36216 | + u8 SupportedWirelessMode; | |
36217 | + u8 InitWirelessMode; | |
36218 | + u8 bInvalidWirelessMode = 0; | |
36219 | + //int i; | |
36220 | + u8 tmpu8; | |
36221 | + //u8 u1tmp,u2tmp; | |
36222 | + u8 btCR9346; | |
36223 | + u8 TmpU1b; | |
36224 | + u8 btPSR; | |
36225 | + | |
36226 | + //rtl8180_rtx_disable(dev); | |
36227 | +//{by amy 080312 | |
36228 | + write_nic_byte(dev,0x24e, (BIT5|BIT6|BIT0)); | |
36229 | +//by amy 080312} | |
36230 | + rtl8180_reset(dev); | |
36231 | + | |
36232 | + priv->dma_poll_mask = 0; | |
36233 | + priv->dma_poll_stop_mask = 0; | |
36234 | + | |
36235 | + //rtl8180_beacon_tx_disable(dev); | |
36236 | + | |
36237 | + HwConfigureRTL8185(dev); | |
36238 | + | |
36239 | + write_nic_dword(dev, MAC0, ((u32*)dev->dev_addr)[0]); | |
36240 | + write_nic_word(dev, MAC4, ((u32*)dev->dev_addr)[1] & 0xffff ); | |
36241 | + | |
36242 | + write_nic_byte(dev, MSR, read_nic_byte(dev, MSR) & 0xf3); // default network type to 'No Link' | |
36243 | + | |
36244 | + //write_nic_byte(dev, BRSR, 0x0); // Set BRSR= 1M | |
36245 | + | |
36246 | + write_nic_word(dev, BcnItv, 100); | |
36247 | + write_nic_word(dev, AtimWnd, 2); | |
36248 | + | |
36249 | + //PlatformEFIOWrite2Byte(dev, FEMR, 0xFFFF); | |
36250 | + PlatformIOWrite2Byte(dev, FEMR, 0xFFFF); | |
36251 | + | |
36252 | + write_nic_byte(dev, WPA_CONFIG, 0); | |
36253 | + | |
36254 | + MacConfig_85BASIC(dev); | |
36255 | + | |
36256 | + // Override the RFSW_CTRL (MAC offset 0x272-0x273), 2006.06.07, by rcnjko. | |
36257 | + // BT_DEMO_BOARD type | |
36258 | + PlatformIOWrite2Byte(dev, RFSW_CTRL, 0x569a); | |
36259 | +//by amy | |
36260 | +//#ifdef CONFIG_RTL818X_S | |
36261 | + // for jong required | |
36262 | +// PlatformIOWrite2Byte(dev, RFSW_CTRL, 0x9a56); | |
36263 | +//#endif | |
36264 | +//by amy | |
36265 | + //BT_QA_BOARD | |
36266 | + //PlatformIOWrite2Byte(dev, RFSW_CTRL, 0x9a56); | |
36267 | + | |
36268 | + //----------------------------------------------------------------------------- | |
36269 | + // Set up PHY related. | |
36270 | + //----------------------------------------------------------------------------- | |
36271 | + // Enable Config3.PARAM_En to revise AnaaParm. | |
36272 | + write_nic_byte(dev, CR9346, 0xc0); // enable config register write | |
36273 | +//by amy | |
36274 | + tmpu8 = read_nic_byte(dev, CONFIG3); | |
36275 | +#ifdef CONFIG_RTL818X_S | |
36276 | + write_nic_byte(dev, CONFIG3, (tmpu8 |CONFIG3_PARM_En) ); | |
36277 | +#else | |
36278 | + write_nic_byte(dev, CONFIG3, (tmpu8 |CONFIG3_PARM_En | CONFIG3_CLKRUN_En) ); | |
36279 | +#endif | |
36280 | +//by amy | |
36281 | + // Turn on Analog power. | |
36282 | + // Asked for by William, otherwise, MAC 3-wire can't work, 2006.06.27, by rcnjko. | |
36283 | + write_nic_dword(dev, ANAPARAM2, ANAPARM2_ASIC_ON); | |
36284 | + write_nic_dword(dev, ANAPARAM, ANAPARM_ASIC_ON); | |
36285 | +//by amy | |
36286 | +#ifdef CONFIG_RTL818X_S | |
36287 | + write_nic_word(dev, ANAPARAM3, 0x0010); | |
36288 | +#else | |
36289 | + write_nic_byte(dev, ANAPARAM3, 0x00); | |
36290 | +#endif | |
36291 | +//by amy | |
36292 | + | |
36293 | + write_nic_byte(dev, CONFIG3, tmpu8); | |
36294 | + write_nic_byte(dev, CR9346, 0x00); | |
36295 | +//{by amy 080312 for led | |
36296 | + // enable EEM0 and EEM1 in 9346CR | |
36297 | + btCR9346 = read_nic_byte(dev, CR9346); | |
36298 | + write_nic_byte(dev, CR9346, (btCR9346|0xC0) ); | |
36299 | + | |
36300 | + // B cut use LED1 to control HW RF on/off | |
36301 | + TmpU1b = read_nic_byte(dev, CONFIG5); | |
36302 | + TmpU1b = TmpU1b & ~BIT3; | |
36303 | + write_nic_byte(dev,CONFIG5, TmpU1b); | |
36304 | + | |
36305 | + // disable EEM0 and EEM1 in 9346CR | |
36306 | + btCR9346 &= ~(0xC0); | |
36307 | + write_nic_byte(dev, CR9346, btCR9346); | |
36308 | + | |
36309 | + //Enable Led (suggested by Jong) | |
36310 | + // B-cut RF Radio on/off 5e[3]=0 | |
36311 | + btPSR = read_nic_byte(dev, PSR); | |
36312 | + write_nic_byte(dev, PSR, (btPSR | BIT3)); | |
36313 | +//by amy 080312 for led} | |
36314 | + // setup initial timing for RFE. | |
36315 | + write_nic_word(dev, RFPinsOutput, 0x0480); | |
36316 | + SetOutputEnableOfRfPins(dev); | |
36317 | + write_nic_word(dev, RFPinsSelect, 0x2488); | |
36318 | + | |
36319 | + // PHY config. | |
36320 | + PhyConfig8185(dev); | |
36321 | + | |
36322 | + // We assume RegWirelessMode has already been initialized before, | |
36323 | + // however, we has to validate the wireless mode here and provide a reasonble | |
36324 | + // initialized value if necessary. 2005.01.13, by rcnjko. | |
36325 | + SupportedWirelessMode = GetSupportedWirelessMode8185(dev); | |
36326 | + if( (ieee->mode != WIRELESS_MODE_B) && | |
36327 | + (ieee->mode != WIRELESS_MODE_G) && | |
36328 | + (ieee->mode != WIRELESS_MODE_A) && | |
36329 | + (ieee->mode != WIRELESS_MODE_AUTO)) | |
36330 | + { // It should be one of B, G, A, or AUTO. | |
36331 | + bInvalidWirelessMode = 1; | |
36332 | + } | |
36333 | + else | |
36334 | + { // One of B, G, A, or AUTO. | |
36335 | + // Check if the wireless mode is supported by RF. | |
36336 | + if( (ieee->mode != WIRELESS_MODE_AUTO) && | |
36337 | + (ieee->mode & SupportedWirelessMode) == 0 ) | |
36338 | + { | |
36339 | + bInvalidWirelessMode = 1; | |
36340 | + } | |
36341 | + } | |
36342 | + | |
36343 | + if(bInvalidWirelessMode || ieee->mode==WIRELESS_MODE_AUTO) | |
36344 | + { // Auto or other invalid value. | |
36345 | + // Assigne a wireless mode to initialize. | |
36346 | + if((SupportedWirelessMode & WIRELESS_MODE_A)) | |
36347 | + { | |
36348 | + InitWirelessMode = WIRELESS_MODE_A; | |
36349 | + } | |
36350 | + else if((SupportedWirelessMode & WIRELESS_MODE_G)) | |
36351 | + { | |
36352 | + InitWirelessMode = WIRELESS_MODE_G; | |
36353 | + } | |
36354 | + else if((SupportedWirelessMode & WIRELESS_MODE_B)) | |
36355 | + { | |
36356 | + InitWirelessMode = WIRELESS_MODE_B; | |
36357 | + } | |
36358 | + else | |
36359 | + { | |
36360 | + DMESGW("InitializeAdapter8185(): No valid wireless mode supported, SupportedWirelessMode(%x)!!!\n", | |
36361 | + SupportedWirelessMode); | |
36362 | + InitWirelessMode = WIRELESS_MODE_B; | |
36363 | + } | |
36364 | + | |
36365 | + // Initialize RegWirelessMode if it is not a valid one. | |
36366 | + if(bInvalidWirelessMode) | |
36367 | + { | |
36368 | + ieee->mode = (WIRELESS_MODE)InitWirelessMode; | |
36369 | + } | |
36370 | + } | |
36371 | + else | |
36372 | + { // One of B, G, A. | |
36373 | + InitWirelessMode = ieee->mode; | |
36374 | + } | |
36375 | +//by amy for power save | |
36376 | +#ifdef ENABLE_IPS | |
36377 | +// printk("initialize ENABLE_IPS\n"); | |
36378 | + priv->eRFPowerState = eRfOff; | |
36379 | + priv->RfOffReason = 0; | |
36380 | + { | |
36381 | + // u32 tmp2; | |
36382 | + // u32 tmp = jiffies; | |
36383 | + MgntActSet_RF_State(dev, eRfOn, 0); | |
36384 | + // tmp2 = jiffies; | |
36385 | + // printk("rf on cost jiffies:%lx\n", (tmp2-tmp)*1000/HZ); | |
36386 | + } | |
36387 | +// DrvIFIndicateCurrentPhyStatus(priv); | |
36388 | + // | |
36389 | + // If inactive power mode is enabled, disable rf while in disconnected state. | |
36390 | + // 2007.07.16, by shien chang. | |
36391 | + // | |
36392 | + if (priv->bInactivePs) | |
36393 | + { | |
36394 | + // u32 tmp2; | |
36395 | + // u32 tmp = jiffies; | |
36396 | + MgntActSet_RF_State(dev,eRfOff, RF_CHANGE_BY_IPS); | |
36397 | + // tmp2 = jiffies; | |
36398 | + // printk("rf off cost jiffies:%lx\n", (tmp2-tmp)*1000/HZ); | |
36399 | + | |
36400 | + } | |
36401 | +#endif | |
36402 | +// IPSEnter(dev); | |
36403 | +//by amy for power save | |
36404 | +#ifdef TODO | |
36405 | + // Turn off RF if necessary. 2005.08.23, by rcnjko. | |
36406 | + // We shall turn off RF after setting CMDR, otherwise, | |
36407 | + // RF will be turnned on after we enable MAC Tx/Rx. | |
36408 | + if(Adapter->MgntInfo.RegRfOff == TRUE) | |
36409 | + { | |
36410 | + SetRFPowerState8185(Adapter, RF_OFF); | |
36411 | + } | |
36412 | + else | |
36413 | + { | |
36414 | + SetRFPowerState8185(Adapter, RF_ON); | |
36415 | + } | |
36416 | +#endif | |
36417 | + | |
36418 | +/* //these is equal with above TODO. | |
36419 | + write_nic_byte(dev, CR9346, 0xc0); // enable config register write | |
36420 | + write_nic_byte(dev, CONFIG3, read_nic_byte(dev, CONFIG3) | CONFIG3_PARM_En); | |
36421 | + RF_WriteReg(dev, 0x4, 0x9FF); | |
36422 | + write_nic_dword(dev, ANAPARAM2, ANAPARM2_ASIC_ON); | |
36423 | + write_nic_dword(dev, ANAPARAM, ANAPARM_ASIC_ON); | |
36424 | + write_nic_byte(dev, CONFIG3, (read_nic_byte(dev, CONFIG3)&(~CONFIG3_PARM_En))); | |
36425 | + write_nic_byte(dev, CR9346, 0x00); | |
36426 | +*/ | |
36427 | + | |
36428 | + ActSetWirelessMode8185(dev, (u8)(InitWirelessMode)); | |
36429 | + | |
36430 | + //----------------------------------------------------------------------------- | |
36431 | + | |
36432 | + rtl8185b_irq_enable(dev); | |
36433 | + | |
36434 | + netif_start_queue(dev); | |
36435 | + | |
36436 | + } | |
36437 | + | |
36438 | + | |
36439 | +void rtl8185b_rx_enable(struct net_device *dev) | |
36440 | +{ | |
36441 | + u8 cmd; | |
36442 | + //u32 rxconf; | |
36443 | + /* for now we accept data, management & ctl frame*/ | |
36444 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
36445 | +#if 0 | |
36446 | + rxconf=read_nic_dword(dev,RX_CONF); | |
36447 | + rxconf = rxconf &~ MAC_FILTER_MASK; | |
36448 | + rxconf = rxconf | (1<<ACCEPT_MNG_FRAME_SHIFT); | |
36449 | + rxconf = rxconf | (1<<ACCEPT_DATA_FRAME_SHIFT); | |
36450 | + rxconf = rxconf | (1<<ACCEPT_BCAST_FRAME_SHIFT); | |
36451 | + rxconf = rxconf | (1<<ACCEPT_MCAST_FRAME_SHIFT); | |
36452 | +// rxconf = rxconf | (1<<ACCEPT_CRCERR_FRAME_SHIFT); | |
36453 | + if (dev->flags & IFF_PROMISC) DMESG ("NIC in promisc mode"); | |
36454 | + | |
36455 | + if(priv->ieee80211->iw_mode == IW_MODE_MONITOR || \ | |
36456 | + dev->flags & IFF_PROMISC){ | |
36457 | + rxconf = rxconf | (1<<ACCEPT_ALLMAC_FRAME_SHIFT); | |
36458 | + }else{ | |
36459 | + rxconf = rxconf | (1<<ACCEPT_NICMAC_FRAME_SHIFT); | |
36460 | + if(priv->card_8185 == 0) | |
36461 | + rxconf = rxconf | (1<<RX_CHECK_BSSID_SHIFT); | |
36462 | + } | |
36463 | + | |
36464 | + /*if(priv->ieee80211->iw_mode == IW_MODE_MASTER){ | |
36465 | + rxconf = rxconf | (1<<ACCEPT_ALLMAC_FRAME_SHIFT); | |
36466 | + rxconf = rxconf | (1<<RX_CHECK_BSSID_SHIFT); | |
36467 | + }*/ | |
36468 | + | |
36469 | + if(priv->ieee80211->iw_mode == IW_MODE_MONITOR){ | |
36470 | + rxconf = rxconf | (1<<ACCEPT_CTL_FRAME_SHIFT); | |
36471 | + rxconf = rxconf | (1<<ACCEPT_ICVERR_FRAME_SHIFT); | |
36472 | + rxconf = rxconf | (1<<ACCEPT_PWR_FRAME_SHIFT); | |
36473 | + } | |
36474 | + | |
36475 | + if( priv->crcmon == 1 && priv->ieee80211->iw_mode == IW_MODE_MONITOR) | |
36476 | + rxconf = rxconf | (1<<ACCEPT_CRCERR_FRAME_SHIFT); | |
36477 | + | |
36478 | + //if(!priv->card_8185){ | |
36479 | + rxconf = rxconf &~ RX_FIFO_THRESHOLD_MASK; | |
36480 | + rxconf = rxconf | (RX_FIFO_THRESHOLD_NONE<<RX_FIFO_THRESHOLD_SHIFT); | |
36481 | + //} | |
36482 | + | |
36483 | + rxconf = rxconf | (1<<RX_AUTORESETPHY_SHIFT); | |
36484 | + rxconf = rxconf &~ MAX_RX_DMA_MASK; | |
36485 | + rxconf = rxconf | (MAX_RX_DMA_2048<<MAX_RX_DMA_SHIFT); | |
36486 | + | |
36487 | + //if(!priv->card_8185) | |
36488 | + rxconf = rxconf | RCR_ONLYERLPKT; | |
36489 | + | |
36490 | + rxconf = rxconf &~ RCR_CS_MASK; | |
36491 | + if(!priv->card_8185) | |
36492 | + rxconf |= (priv->rcr_csense<<RCR_CS_SHIFT); | |
36493 | +// rxconf &=~ 0xfff00000; | |
36494 | +// rxconf |= 0x90100000;//9014f76f; | |
36495 | + write_nic_dword(dev, RX_CONF, rxconf); | |
36496 | +#endif | |
36497 | + | |
36498 | + if (dev->flags & IFF_PROMISC) DMESG ("NIC in promisc mode"); | |
36499 | + | |
36500 | + if(priv->ieee80211->iw_mode == IW_MODE_MONITOR || \ | |
36501 | + dev->flags & IFF_PROMISC){ | |
36502 | + priv->ReceiveConfig = priv->ReceiveConfig & (~RCR_APM); | |
36503 | + priv->ReceiveConfig = priv->ReceiveConfig | RCR_AAP; | |
36504 | + } | |
36505 | + | |
36506 | + /*if(priv->ieee80211->iw_mode == IW_MODE_MASTER){ | |
36507 | + rxconf = rxconf | (1<<ACCEPT_ALLMAC_FRAME_SHIFT); | |
36508 | + rxconf = rxconf | (1<<RX_CHECK_BSSID_SHIFT); | |
36509 | + }*/ | |
36510 | + | |
36511 | + if(priv->ieee80211->iw_mode == IW_MODE_MONITOR){ | |
36512 | + priv->ReceiveConfig = priv->ReceiveConfig | RCR_ACF | RCR_APWRMGT | RCR_AICV; | |
36513 | + } | |
36514 | + | |
36515 | + if( priv->crcmon == 1 && priv->ieee80211->iw_mode == IW_MODE_MONITOR) | |
36516 | + priv->ReceiveConfig = priv->ReceiveConfig | RCR_ACRC32; | |
36517 | + | |
36518 | + write_nic_dword(dev, RCR, priv->ReceiveConfig); | |
36519 | + | |
36520 | + fix_rx_fifo(dev); | |
36521 | + | |
36522 | +#ifdef DEBUG_RX | |
36523 | + DMESG("rxconf: %x %x",priv->ReceiveConfig ,read_nic_dword(dev,RCR)); | |
36524 | +#endif | |
36525 | + cmd=read_nic_byte(dev,CMD); | |
36526 | + write_nic_byte(dev,CMD,cmd | (1<<CMD_RX_ENABLE_SHIFT)); | |
36527 | + | |
36528 | +} | |
36529 | + | |
36530 | +void rtl8185b_tx_enable(struct net_device *dev) | |
36531 | +{ | |
36532 | + u8 cmd; | |
36533 | + //u8 tx_agc_ctl; | |
36534 | + u8 byte; | |
36535 | + //u32 txconf; | |
36536 | + struct r8180_priv *priv = (struct r8180_priv *)ieee80211_priv(dev); | |
36537 | + | |
36538 | +#if 0 | |
36539 | + txconf= read_nic_dword(dev,TX_CONF); | |
36540 | + if(priv->card_8185){ | |
36541 | + | |
36542 | + | |
36543 | + byte = read_nic_byte(dev,CW_CONF); | |
36544 | + byte &= ~(1<<CW_CONF_PERPACKET_CW_SHIFT); | |
36545 | + byte &= ~(1<<CW_CONF_PERPACKET_RETRY_SHIFT); | |
36546 | + write_nic_byte(dev, CW_CONF, byte); | |
36547 | + | |
36548 | + tx_agc_ctl = read_nic_byte(dev, TX_AGC_CTL); | |
36549 | + tx_agc_ctl &= ~(1<<TX_AGC_CTL_PERPACKET_GAIN_SHIFT); | |
36550 | + tx_agc_ctl &= ~(1<<TX_AGC_CTL_PERPACKET_ANTSEL_SHIFT); | |
36551 | + tx_agc_ctl |=(1<<TX_AGC_CTL_FEEDBACK_ANT); | |
36552 | + write_nic_byte(dev, TX_AGC_CTL, tx_agc_ctl); | |
36553 | + /* | |
36554 | + write_nic_word(dev, 0x5e, 0x01); | |
36555 | + force_pci_posting(dev); | |
36556 | + mdelay(1); | |
36557 | + write_nic_word(dev, 0xfe, 0x10); | |
36558 | + force_pci_posting(dev); | |
36559 | + mdelay(1); | |
36560 | + write_nic_word(dev, 0x5e, 0x00); | |
36561 | + force_pci_posting(dev); | |
36562 | + mdelay(1); | |
36563 | + */ | |
36564 | + write_nic_byte(dev, 0xec, 0x3f); /* Disable early TX */ | |
36565 | + } | |
36566 | + | |
36567 | + if(priv->card_8185){ | |
36568 | + | |
36569 | + txconf = txconf &~ (1<<TCR_PROBE_NOTIMESTAMP_SHIFT); | |
36570 | + | |
36571 | + }else{ | |
36572 | + | |
36573 | + if(hwseqnum) | |
36574 | + txconf= txconf &~ (1<<TX_CONF_HEADER_AUTOICREMENT_SHIFT); | |
36575 | + else | |
36576 | + txconf= txconf | (1<<TX_CONF_HEADER_AUTOICREMENT_SHIFT); | |
36577 | + } | |
36578 | + | |
36579 | + txconf = txconf &~ TX_LOOPBACK_MASK; | |
36580 | + txconf = txconf | (TX_LOOPBACK_NONE <<TX_LOOPBACK_SHIFT); | |
36581 | + txconf = txconf &~ TCR_DPRETRY_MASK; | |
36582 | + txconf = txconf &~ TCR_RTSRETRY_MASK; | |
36583 | + txconf = txconf | (priv->retry_data<<TX_DPRETRY_SHIFT); | |
36584 | + txconf = txconf | (priv->retry_rts<<TX_RTSRETRY_SHIFT); | |
36585 | + txconf = txconf &~ (1<<TX_NOCRC_SHIFT); | |
36586 | + | |
36587 | + if(priv->card_8185){ | |
36588 | + if(priv->hw_plcp_len) | |
36589 | + txconf = txconf &~ TCR_PLCP_LEN; | |
36590 | + else | |
36591 | + txconf = txconf | TCR_PLCP_LEN; | |
36592 | + }else{ | |
36593 | + txconf = txconf &~ TCR_SAT; | |
36594 | + } | |
36595 | + txconf = txconf &~ TCR_MXDMA_MASK; | |
36596 | + txconf = txconf | (TCR_MXDMA_2048<<TCR_MXDMA_SHIFT); | |
36597 | + txconf = txconf | TCR_CWMIN; | |
36598 | + txconf = txconf | TCR_DISCW; | |
36599 | + | |
36600 | +// if(priv->ieee80211->hw_wep) | |
36601 | +// txconf=txconf &~ (1<<TX_NOICV_SHIFT); | |
36602 | +// else | |
36603 | + txconf=txconf | (1<<TX_NOICV_SHIFT); | |
36604 | + | |
36605 | + write_nic_dword(dev,TX_CONF,txconf); | |
36606 | +#endif | |
36607 | + | |
36608 | + write_nic_dword(dev, TCR, priv->TransmitConfig); | |
36609 | + byte = read_nic_byte(dev, MSR); | |
36610 | + byte |= MSR_LINK_ENEDCA; | |
36611 | + write_nic_byte(dev, MSR, byte); | |
36612 | + | |
36613 | + fix_tx_fifo(dev); | |
36614 | + | |
36615 | +#ifdef DEBUG_TX | |
36616 | + DMESG("txconf: %x %x",priv->TransmitConfig,read_nic_dword(dev,TCR)); | |
36617 | +#endif | |
36618 | + | |
36619 | + cmd=read_nic_byte(dev,CMD); | |
36620 | + write_nic_byte(dev,CMD,cmd | (1<<CMD_TX_ENABLE_SHIFT)); | |
36621 | + | |
36622 | + //write_nic_dword(dev,TX_CONF,txconf); | |
36623 | + | |
36624 | + | |
36625 | +/* | |
36626 | + rtl8180_set_mode(dev,EPROM_CMD_CONFIG); | |
36627 | + write_nic_byte(dev, TX_DMA_POLLING, priv->dma_poll_mask); | |
36628 | + rtl8180_set_mode(dev,EPROM_CMD_NORMAL); | |
36629 | + */ | |
36630 | +} | |
36631 | + | |
36632 | + | |
36633 | +#endif |